Commit c9acece0 authored by Rasmus Villemoes's avatar Rasmus Villemoes Committed by David S. Miller
Browse files

net: dsa: mv88e6xxx: introduce helpers for handling chip->reg_lock 



This is a no-op that simply moves all locking and unlocking of
->reg_lock into trivial helpers. I did that to be able to easily add
some ad hoc instrumentation to those helpers to get some information
on contention and hold times of the mutex. Perhaps others want to do
something similar at some point, so this frees them from doing the
'sed -i' yoga, and have a much smaller 'git diff' while fiddling.

Signed-off-by: default avatarRasmus Villemoes <rasmus.villemoes@prevas.dk>
Reviewed-by: default avatarVivien Didelot <vivien.didelot@gmail.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 3e5bfb18

drivers/net/dsa/mv88e6xxx/chip.c

+88 −88
Original line number Diff line number Diff line
@@ -118,9 +118,9 @@ static irqreturn_t mv88e6xxx_g1_irq_thread_work(struct mv88e6xxx_chip *chip) 
	u16 ctl1;

	int err;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = mv88e6xxx_g1_read(chip, MV88E6XXX_G1_STS, &reg);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	if (err)

		goto out;
@@ -135,13 +135,13 @@ static irqreturn_t mv88e6xxx_g1_irq_thread_work(struct mv88e6xxx_chip *chip) 
			}

		}



		mutex_lock(&chip->reg_lock);

		mv88e6xxx_reg_lock(chip);

		err = mv88e6xxx_g1_read(chip, MV88E6XXX_G1_CTL1, &ctl1);

		if (err)

			goto unlock;

		err = mv88e6xxx_g1_read(chip, MV88E6XXX_G1_STS, &reg);

unlock:

		mutex_unlock(&chip->reg_lock);

		mv88e6xxx_reg_unlock(chip);

		if (err)

			goto out;

		ctl1 &= GENMASK(chip->g1_irq.nirqs, 0);
@@ -162,7 +162,7 @@ static void mv88e6xxx_g1_irq_bus_lock(struct irq_data *d) 
{

	struct mv88e6xxx_chip *chip = irq_data_get_irq_chip_data(d);



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

}



static void mv88e6xxx_g1_irq_bus_sync_unlock(struct irq_data *d)
@@ -184,7 +184,7 @@ static void mv88e6xxx_g1_irq_bus_sync_unlock(struct irq_data *d) 
		goto out;



out:

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);

}



static const struct irq_chip mv88e6xxx_g1_irq_chip = {
@@ -239,9 +239,9 @@ static void mv88e6xxx_g1_irq_free(struct mv88e6xxx_chip *chip) 
	 */

	free_irq(chip->irq, chip);



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	mv88e6xxx_g1_irq_free_common(chip);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);

}



static int mv88e6xxx_g1_irq_setup_common(struct mv88e6xxx_chip *chip)
@@ -310,12 +310,12 @@ static int mv88e6xxx_g1_irq_setup(struct mv88e6xxx_chip *chip) 
	 */

	irq_set_lockdep_class(chip->irq, &lock_key, &request_key);



	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);

	err = request_threaded_irq(chip->irq, NULL,

				   mv88e6xxx_g1_irq_thread_fn,

				   IRQF_ONESHOT | IRQF_SHARED,

				   dev_name(chip->dev), chip);

	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	if (err)

		mv88e6xxx_g1_irq_free_common(chip);
@@ -359,9 +359,9 @@ static void mv88e6xxx_irq_poll_free(struct mv88e6xxx_chip *chip) 
	kthread_cancel_delayed_work_sync(&chip->irq_poll_work);

	kthread_destroy_worker(chip->kworker);



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	mv88e6xxx_g1_irq_free_common(chip);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);

}



int mv88e6xxx_wait(struct mv88e6xxx_chip *chip, int addr, int reg, u16 mask)
@@ -496,11 +496,11 @@ static void mv88e6xxx_adjust_link(struct dsa_switch *ds, int port, 
	    mv88e6xxx_phy_is_internal(ds, port))

		return;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = mv88e6xxx_port_setup_mac(chip, port, phydev->link, phydev->speed,

				       phydev->duplex, phydev->pause,

				       phydev->interface);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	if (err && err != -EOPNOTSUPP)

		dev_err(ds->dev, "p%d: failed to configure MAC\n", port);
@@ -616,12 +616,12 @@ static int mv88e6xxx_link_state(struct dsa_switch *ds, int port, 
	struct mv88e6xxx_chip *chip = ds->priv;

	int err;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	if (chip->info->ops->port_link_state)

		err = chip->info->ops->port_link_state(chip, port, state);

	else

		err = -EOPNOTSUPP;

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return err;

}
@@ -651,10 +651,10 @@ static void mv88e6xxx_mac_config(struct dsa_switch *ds, int port, 
	}

	pause = !!phylink_test(state->advertising, Pause);



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = mv88e6xxx_port_setup_mac(chip, port, link, speed, duplex, pause,

				       state->interface);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	if (err && err != -EOPNOTSUPP)

		dev_err(ds->dev, "p%d: failed to configure MAC\n", port);
@@ -665,9 +665,9 @@ static void mv88e6xxx_mac_link_force(struct dsa_switch *ds, int port, int link) 
	struct mv88e6xxx_chip *chip = ds->priv;

	int err;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = chip->info->ops->port_set_link(chip, port, link);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	if (err)

		dev_err(chip->dev, "p%d: failed to force MAC link\n", port);
@@ -865,7 +865,7 @@ static void mv88e6xxx_get_strings(struct dsa_switch *ds, int port, 
	if (stringset != ETH_SS_STATS)

		return;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);



	if (chip->info->ops->stats_get_strings)

		count = chip->info->ops->stats_get_strings(chip, data);
@@ -878,7 +878,7 @@ static void mv88e6xxx_get_strings(struct dsa_switch *ds, int port, 
	data += count * ETH_GSTRING_LEN;

	mv88e6xxx_atu_vtu_get_strings(data);



	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);

}



static int mv88e6xxx_stats_get_sset_count(struct mv88e6xxx_chip *chip,
@@ -921,7 +921,7 @@ static int mv88e6xxx_get_sset_count(struct dsa_switch *ds, int port, int sset) 
	if (sset != ETH_SS_STATS)

		return 0;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	if (chip->info->ops->stats_get_sset_count)

		count = chip->info->ops->stats_get_sset_count(chip);

	if (count < 0)
@@ -938,7 +938,7 @@ static int mv88e6xxx_get_sset_count(struct dsa_switch *ds, int port, int sset) 
	count += ARRAY_SIZE(mv88e6xxx_atu_vtu_stats_strings);



out:

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return count;

}
@@ -953,11 +953,11 @@ static int mv88e6xxx_stats_get_stats(struct mv88e6xxx_chip *chip, int port, 
	for (i = 0, j = 0; i < ARRAY_SIZE(mv88e6xxx_hw_stats); i++) {

		stat = &mv88e6xxx_hw_stats[i];

		if (stat->type & types) {

			mutex_lock(&chip->reg_lock);

			mv88e6xxx_reg_lock(chip);

			data[j] = _mv88e6xxx_get_ethtool_stat(chip, stat, port,

							      bank1_select,

							      histogram);

			mutex_unlock(&chip->reg_lock);

			mv88e6xxx_reg_unlock(chip);



			j++;

		}
@@ -1016,14 +1016,14 @@ static void mv88e6xxx_get_stats(struct mv88e6xxx_chip *chip, int port, 
	if (chip->info->ops->stats_get_stats)

		count = chip->info->ops->stats_get_stats(chip, port, data);



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	if (chip->info->ops->serdes_get_stats) {

		data += count;

		count = chip->info->ops->serdes_get_stats(chip, port, data);

	}

	data += count;

	mv88e6xxx_atu_vtu_get_stats(chip, port, data);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);

}



static void mv88e6xxx_get_ethtool_stats(struct dsa_switch *ds, int port,
@@ -1032,10 +1032,10 @@ static void mv88e6xxx_get_ethtool_stats(struct dsa_switch *ds, int port, 
	struct mv88e6xxx_chip *chip = ds->priv;

	int ret;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);



	ret = mv88e6xxx_stats_snapshot(chip, port);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	if (ret < 0)

		return;
@@ -1062,7 +1062,7 @@ static void mv88e6xxx_get_regs(struct dsa_switch *ds, int port, 


	memset(p, 0xff, 32 * sizeof(u16));



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);



	for (i = 0; i < 32; i++) {
@@ -1071,7 +1071,7 @@ static void mv88e6xxx_get_regs(struct dsa_switch *ds, int port, 
			p[i] = reg;

	}



	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);

}



static int mv88e6xxx_get_mac_eee(struct dsa_switch *ds, int port,
@@ -1137,9 +1137,9 @@ static void mv88e6xxx_port_stp_state_set(struct dsa_switch *ds, int port, 
	struct mv88e6xxx_chip *chip = ds->priv;

	int err;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = mv88e6xxx_port_set_state(chip, port, state);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	if (err)

		dev_err(ds->dev, "p%d: failed to update state\n", port);
@@ -1324,9 +1324,9 @@ static void mv88e6xxx_port_fast_age(struct dsa_switch *ds, int port) 
	struct mv88e6xxx_chip *chip = ds->priv;

	int err;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = mv88e6xxx_g1_atu_remove(chip, 0, port, false);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	if (err)

		dev_err(ds->dev, "p%d: failed to flush ATU\n", port);
@@ -1454,7 +1454,7 @@ static int mv88e6xxx_port_check_hw_vlan(struct dsa_switch *ds, int port, 
	if (!vid_begin)

		return -EOPNOTSUPP;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);



	do {

		err = mv88e6xxx_vtu_getnext(chip, &vlan);
@@ -1494,7 +1494,7 @@ static int mv88e6xxx_port_check_hw_vlan(struct dsa_switch *ds, int port, 
	} while (vlan.vid < vid_end);



unlock:

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return err;

}
@@ -1510,9 +1510,9 @@ static int mv88e6xxx_port_vlan_filtering(struct dsa_switch *ds, int port, 
	if (!chip->info->max_vid)

		return -EOPNOTSUPP;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = mv88e6xxx_port_set_8021q_mode(chip, port, mode);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return err;

}
@@ -1646,7 +1646,7 @@ static void mv88e6xxx_port_vlan_add(struct dsa_switch *ds, int port, 
	else

		member = MV88E6XXX_G1_VTU_DATA_MEMBER_TAG_TAGGED;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);



	for (vid = vlan->vid_begin; vid <= vlan->vid_end; ++vid)

		if (_mv88e6xxx_port_vlan_add(chip, port, vid, member))
@@ -1657,7 +1657,7 @@ static void mv88e6xxx_port_vlan_add(struct dsa_switch *ds, int port, 
		dev_err(ds->dev, "p%d: failed to set PVID %d\n", port,

			vlan->vid_end);



	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);

}



static int _mv88e6xxx_port_vlan_del(struct mv88e6xxx_chip *chip,
@@ -1703,7 +1703,7 @@ static int mv88e6xxx_port_vlan_del(struct dsa_switch *ds, int port, 
	if (!chip->info->max_vid)

		return -EOPNOTSUPP;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);



	err = mv88e6xxx_port_get_pvid(chip, port, &pvid);

	if (err)
@@ -1722,7 +1722,7 @@ static int mv88e6xxx_port_vlan_del(struct dsa_switch *ds, int port, 
	}



unlock:

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return err;

}
@@ -1733,10 +1733,10 @@ static int mv88e6xxx_port_fdb_add(struct dsa_switch *ds, int port, 
	struct mv88e6xxx_chip *chip = ds->priv;

	int err;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = mv88e6xxx_port_db_load_purge(chip, port, addr, vid,

					   MV88E6XXX_G1_ATU_DATA_STATE_UC_STATIC);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return err;

}
@@ -1747,10 +1747,10 @@ static int mv88e6xxx_port_fdb_del(struct dsa_switch *ds, int port, 
	struct mv88e6xxx_chip *chip = ds->priv;

	int err;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = mv88e6xxx_port_db_load_purge(chip, port, addr, vid,

					   MV88E6XXX_G1_ATU_DATA_STATE_UNUSED);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return err;

}
@@ -1832,9 +1832,9 @@ static int mv88e6xxx_port_fdb_dump(struct dsa_switch *ds, int port, 
	struct mv88e6xxx_chip *chip = ds->priv;

	int err;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = mv88e6xxx_port_db_dump(chip, port, cb, data);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return err;

}
@@ -1883,9 +1883,9 @@ static int mv88e6xxx_port_bridge_join(struct dsa_switch *ds, int port, 
	struct mv88e6xxx_chip *chip = ds->priv;

	int err;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = mv88e6xxx_bridge_map(chip, br);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return err;

}
@@ -1895,11 +1895,11 @@ static void mv88e6xxx_port_bridge_leave(struct dsa_switch *ds, int port, 
{

	struct mv88e6xxx_chip *chip = ds->priv;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	if (mv88e6xxx_bridge_map(chip, br) ||

	    mv88e6xxx_port_vlan_map(chip, port))

		dev_err(ds->dev, "failed to remap in-chip Port VLAN\n");

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);

}



static int mv88e6xxx_crosschip_bridge_join(struct dsa_switch *ds, int dev,
@@ -1911,9 +1911,9 @@ static int mv88e6xxx_crosschip_bridge_join(struct dsa_switch *ds, int dev, 
	if (!mv88e6xxx_has_pvt(chip))

		return 0;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = mv88e6xxx_pvt_map(chip, dev, port);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return err;

}
@@ -1926,10 +1926,10 @@ static void mv88e6xxx_crosschip_bridge_leave(struct dsa_switch *ds, int dev, 
	if (!mv88e6xxx_has_pvt(chip))

		return;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	if (mv88e6xxx_pvt_map(chip, dev, port))

		dev_err(ds->dev, "failed to remap cross-chip Port VLAN\n");

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);

}



static int mv88e6xxx_software_reset(struct mv88e6xxx_chip *chip)
@@ -2280,14 +2280,14 @@ static int mv88e6xxx_port_enable(struct dsa_switch *ds, int port, 
	struct mv88e6xxx_chip *chip = ds->priv;

	int err;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);



	err = mv88e6xxx_serdes_power(chip, port, true);



	if (!err && chip->info->ops->serdes_irq_setup)

		err = chip->info->ops->serdes_irq_setup(chip, port);



	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return err;

}
@@ -2296,7 +2296,7 @@ static void mv88e6xxx_port_disable(struct dsa_switch *ds, int port) 
{

	struct mv88e6xxx_chip *chip = ds->priv;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);



	if (mv88e6xxx_port_set_state(chip, port, BR_STATE_DISABLED))

		dev_err(chip->dev, "failed to disable port\n");
@@ -2307,7 +2307,7 @@ static void mv88e6xxx_port_disable(struct dsa_switch *ds, int port) 
	if (mv88e6xxx_serdes_power(chip, port, false))

		dev_err(chip->dev, "failed to power off SERDES\n");



	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);

}



static int mv88e6xxx_set_ageing_time(struct dsa_switch *ds,
@@ -2316,9 +2316,9 @@ static int mv88e6xxx_set_ageing_time(struct dsa_switch *ds, 
	struct mv88e6xxx_chip *chip = ds->priv;

	int err;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = mv88e6xxx_g1_atu_set_age_time(chip, ageing_time);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return err;

}
@@ -2448,7 +2448,7 @@ static int mv88e6xxx_setup(struct dsa_switch *ds) 
	chip->ds = ds;

	ds->slave_mii_bus = mv88e6xxx_default_mdio_bus(chip);



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);



	if (chip->info->ops->setup_errata) {

		err = chip->info->ops->setup_errata(chip);
@@ -2555,7 +2555,7 @@ static int mv88e6xxx_setup(struct dsa_switch *ds) 
		goto unlock;



unlock:

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return err;

}
@@ -2570,9 +2570,9 @@ static int mv88e6xxx_mdio_read(struct mii_bus *bus, int phy, int reg) 
	if (!chip->info->ops->phy_read)

		return -EOPNOTSUPP;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = chip->info->ops->phy_read(chip, bus, phy, reg, &val);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	if (reg == MII_PHYSID2) {

		/* Some internal PHYs don't have a model number. */
@@ -2605,9 +2605,9 @@ static int mv88e6xxx_mdio_write(struct mii_bus *bus, int phy, int reg, u16 val) 
	if (!chip->info->ops->phy_write)

		return -EOPNOTSUPP;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = chip->info->ops->phy_write(chip, bus, phy, reg, val);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return err;

}
@@ -2622,9 +2622,9 @@ static int mv88e6xxx_mdio_register(struct mv88e6xxx_chip *chip, 
	int err;



	if (external) {

		mutex_lock(&chip->reg_lock);

		mv88e6xxx_reg_lock(chip);

		err = mv88e6xxx_g2_scratch_gpio_set_smi(chip, true);

		mutex_unlock(&chip->reg_lock);

		mv88e6xxx_reg_unlock(chip);



		if (err)

			return err;
@@ -2745,9 +2745,9 @@ static int mv88e6xxx_get_eeprom(struct dsa_switch *ds, 
	if (!chip->info->ops->get_eeprom)

		return -EOPNOTSUPP;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = chip->info->ops->get_eeprom(chip, eeprom, data);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	if (err)

		return err;
@@ -2769,9 +2769,9 @@ static int mv88e6xxx_set_eeprom(struct dsa_switch *ds, 
	if (eeprom->magic != 0xc3ec4951)

		return -EINVAL;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = chip->info->ops->set_eeprom(chip, eeprom, data);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return err;

}
@@ -4532,9 +4532,9 @@ static int mv88e6xxx_detect(struct mv88e6xxx_chip *chip) 
	u16 id;

	int err;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = mv88e6xxx_port_read(chip, 0, MV88E6XXX_PORT_SWITCH_ID, &id);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);

	if (err)

		return err;
@@ -4597,12 +4597,12 @@ static void mv88e6xxx_port_mdb_add(struct dsa_switch *ds, int port, 
{

	struct mv88e6xxx_chip *chip = ds->priv;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	if (mv88e6xxx_port_db_load_purge(chip, port, mdb->addr, mdb->vid,

					 MV88E6XXX_G1_ATU_DATA_STATE_MC_STATIC))

		dev_err(ds->dev, "p%d: failed to load multicast MAC address\n",

			port);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);

}



static int mv88e6xxx_port_mdb_del(struct dsa_switch *ds, int port,
@@ -4611,10 +4611,10 @@ static int mv88e6xxx_port_mdb_del(struct dsa_switch *ds, int port, 
	struct mv88e6xxx_chip *chip = ds->priv;

	int err;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = mv88e6xxx_port_db_load_purge(chip, port, mdb->addr, mdb->vid,

					   MV88E6XXX_G1_ATU_DATA_STATE_UNUSED);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return err;

}
@@ -4625,12 +4625,12 @@ static int mv88e6xxx_port_egress_floods(struct dsa_switch *ds, int port, 
	struct mv88e6xxx_chip *chip = ds->priv;

	int err = -EOPNOTSUPP;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	if (chip->info->ops->port_set_egress_floods)

		err = chip->info->ops->port_set_egress_floods(chip, port,

							      unicast,

							      multicast);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return err;

}
@@ -4801,9 +4801,9 @@ static int mv88e6xxx_probe(struct mdio_device *mdiodev) 
			chip->eeprom_len = pdata->eeprom_len;

	}



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = mv88e6xxx_switch_reset(chip);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);

	if (err)

		goto out;
@@ -4822,12 +4822,12 @@ static int mv88e6xxx_probe(struct mdio_device *mdiodev) 
	 * the PHYs will link their interrupts to these interrupt

	 * controllers

	 */

	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	if (chip->irq > 0)

		err = mv88e6xxx_g1_irq_setup(chip);

	else

		err = mv88e6xxx_irq_poll_setup(chip);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	if (err)

		goto out;

drivers/net/dsa/mv88e6xxx/chip.h

+10 −0
Original line number Diff line number Diff line
@@ -580,4 +580,14 @@ int mv88e6xxx_port_setup_mac(struct mv88e6xxx_chip *chip, int port, int link, 
			     phy_interface_t mode);

struct mii_bus *mv88e6xxx_default_mdio_bus(struct mv88e6xxx_chip *chip);



static inline void mv88e6xxx_reg_lock(struct mv88e6xxx_chip *chip)

{

	mutex_lock(&chip->reg_lock);

}



static inline void mv88e6xxx_reg_unlock(struct mv88e6xxx_chip *chip)

{

	mutex_unlock(&chip->reg_lock);

}



#endif /* _MV88E6XXX_CHIP_H */

drivers/net/dsa/mv88e6xxx/global1_atu.c

+3 −3
Original line number Diff line number Diff line
@@ -317,7 +317,7 @@ static irqreturn_t mv88e6xxx_g1_atu_prob_irq_thread_fn(int irq, void *dev_id) 
	int err;

	u16 val;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);



	err = mv88e6xxx_g1_atu_op(chip, 0,

				  MV88E6XXX_G1_ATU_OP_GET_CLR_VIOLATION);
@@ -364,12 +364,12 @@ static irqreturn_t mv88e6xxx_g1_atu_prob_irq_thread_fn(int irq, void *dev_id) 
				    entry.mac, entry.portvec, spid);

		chip->ports[spid].atu_full_violation++;

	}

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return IRQ_HANDLED;



out:

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	dev_err(chip->dev, "ATU problem: error %d while handling interrupt\n",

		err);

drivers/net/dsa/mv88e6xxx/global1_vtu.c

+3 −3
Original line number Diff line number Diff line
@@ -579,7 +579,7 @@ static irqreturn_t mv88e6xxx_g1_vtu_prob_irq_thread_fn(int irq, void *dev_id) 
	int err;

	u16 val;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);



	err = mv88e6xxx_g1_vtu_op(chip, MV88E6XXX_G1_VTU_OP_GET_CLR_VIOLATION);

	if (err)
@@ -607,12 +607,12 @@ static irqreturn_t mv88e6xxx_g1_vtu_prob_irq_thread_fn(int irq, void *dev_id) 
		chip->ports[spid].vtu_miss_violation++;

	}



	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return IRQ_HANDLED;



out:

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	dev_err(chip->dev, "VTU problem: error %d while handling interrupt\n",

		err);

drivers/net/dsa/mv88e6xxx/global2.c

+10 −10
Original line number Diff line number Diff line
@@ -893,20 +893,20 @@ static irqreturn_t mv88e6xxx_g2_watchdog_thread_fn(int irq, void *dev_id) 
	struct mv88e6xxx_chip *chip = dev_id;

	irqreturn_t ret = IRQ_NONE;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	if (chip->info->ops->watchdog_ops->irq_action)

		ret = chip->info->ops->watchdog_ops->irq_action(chip, irq);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return ret;

}



static void mv88e6xxx_g2_watchdog_free(struct mv88e6xxx_chip *chip)

{

	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	if (chip->info->ops->watchdog_ops->irq_free)

		chip->info->ops->watchdog_ops->irq_free(chip);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	free_irq(chip->watchdog_irq, chip);

	irq_dispose_mapping(chip->watchdog_irq);
@@ -928,10 +928,10 @@ static int mv88e6xxx_g2_watchdog_setup(struct mv88e6xxx_chip *chip) 
	if (err)

		return err;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	if (chip->info->ops->watchdog_ops->irq_setup)

		err = chip->info->ops->watchdog_ops->irq_setup(chip);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);



	return err;

}
@@ -986,9 +986,9 @@ static irqreturn_t mv88e6xxx_g2_irq_thread_fn(int irq, void *dev_id) 
	int err;

	u16 reg;



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

	err = mv88e6xxx_g2_int_source(chip, &reg);

	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);

	if (err)

		goto out;
@@ -1007,7 +1007,7 @@ static void mv88e6xxx_g2_irq_bus_lock(struct irq_data *d) 
{

	struct mv88e6xxx_chip *chip = irq_data_get_irq_chip_data(d);



	mutex_lock(&chip->reg_lock);

	mv88e6xxx_reg_lock(chip);

}



static void mv88e6xxx_g2_irq_bus_sync_unlock(struct irq_data *d)
@@ -1019,7 +1019,7 @@ static void mv88e6xxx_g2_irq_bus_sync_unlock(struct irq_data *d) 
	if (err)

		dev_err(chip->dev, "failed to mask interrupts\n");



	mutex_unlock(&chip->reg_lock);

	mv88e6xxx_reg_unlock(chip);

}



static const struct irq_chip mv88e6xxx_g2_irq_chip = {

CRA Git | Maintained and supported by SUSTech CRA and CCSE