Skip to content

Commit

Permalink
net: dsa: mv88e6xxx: Support multiple MDIO busses
Browse files Browse the repository at this point in the history 
The mv88e6390 has multiple MDIO busses. Generalize the parsing of the
device tree to support multiple mdio nodes. The external mdio bus has
a compatible strings to indicate it is external.

Keep a linked list of busses, placing the external mdio bus at the
tail of the list. When within the driver an mdio bus is needed,
e.g. for EEE or SERDES, use the head of the list which should be the
internal bus.

Signed-off-by: Andrew Lunn <[email protected]>
Signed-off-by: David S. Miller <[email protected]>
  • Loading branch information
@lunn @davem330
lunn authored and davem330 committed Jan 24, 2017
1 parent 0dd12d5 commit a3c53be
Show file tree
Hide file tree
Showing 3 changed files with 126 additions and 35 deletions.
41 changes: 39 additions & 2 deletions Documentation/devicetree/bindings/net/dsa/marvell.txt
View file
Original file line number Diff line number Diff line change
Expand Up @@ -26,8 +26,12 @@ Optional properties:
- interrupt-controller : Indicates the switch is itself an interrupt
controller. This is used for the PHY interrupts.
#interrupt-cells = <2> : Controller uses two cells, number and flag
- mdio : container of PHY and devices on the switches MDIO
bus
- mdio : Container of PHY and devices on the switches MDIO
bus.
- mdio? : Container of PHYs and devices on the external MDIO
bus. The node must contains a compatible string of
"marvell,mv88e6xxx-mdio-external"

Example:

mdio {
Expand All @@ -53,3 +57,36 @@ Example:
};
};
};

mdio {
#address-cells = <1>;
#size-cells = <0>;
interrupt-parent = <&gpio0>;
interrupts = <27 IRQ_TYPE_LEVEL_LOW>;
interrupt-controller;
#interrupt-cells = <2>;

switch0: switch@0 {
compatible = "marvell,mv88e6390";
reg = <0>;
reset-gpios = <&gpio5 1 GPIO_ACTIVE_LOW>;
};
mdio {
#address-cells = <1>;
#size-cells = <0>;
switch1phy0: switch1phy0@0 {
reg = <0>;
interrupt-parent = <&switch0>;
interrupts = <0 IRQ_TYPE_LEVEL_HIGH>;
};
};

mdio1 {
compatible = "marvell,mv88e6xxx-mdio-external";
#address-cells = <1>;
#size-cells = <0>;
switch1phy9: switch1phy0@9 {
reg = <9>;
};
};
};
110 changes: 82 additions & 28 deletions drivers/net/dsa/mv88e6xxx/chip.c
View file
Original file line number Diff line number Diff line change
Expand Up @@ -236,16 +236,29 @@ static int mv88e6165_phy_write(struct mv88e6xxx_chip *chip,
return mv88e6xxx_write(chip, addr, reg, val);
}

static struct mii_bus *mv88e6xxx_default_mdio_bus(struct mv88e6xxx_chip *chip)
{
struct mv88e6xxx_mdio_bus *mdio_bus;

mdio_bus = list_first_entry(&chip->mdios, struct mv88e6xxx_mdio_bus,
list);
if (!mdio_bus)
return NULL;

return mdio_bus->bus;
}

static int mv88e6xxx_phy_read(struct mv88e6xxx_chip *chip, int phy,
int reg, u16 *val)
{
int addr = phy; /* PHY devices addresses start at 0x0 */
struct mii_bus *bus = chip->mdio_bus;
struct mii_bus *bus;

if (!chip->info->ops->phy_read)
bus = mv88e6xxx_default_mdio_bus(chip);
if (!bus)
return -EOPNOTSUPP;

if (!bus)
if (!chip->info->ops->phy_read)
return -EOPNOTSUPP;

return chip->info->ops->phy_read(chip, bus, addr, reg, val);
Expand All @@ -255,12 +268,13 @@ static int mv88e6xxx_phy_write(struct mv88e6xxx_chip *chip, int phy,
int reg, u16 val)
{
int addr = phy; /* PHY devices addresses start at 0x0 */
struct mii_bus *bus = chip->mdio_bus;
struct mii_bus *bus;

if (!chip->info->ops->phy_write)
bus = mv88e6xxx_default_mdio_bus(chip);
if (!bus)
return -EOPNOTSUPP;

if (!bus)
if (!chip->info->ops->phy_write)
return -EOPNOTSUPP;

return chip->info->ops->phy_write(chip, bus, addr, reg, val);
Expand Down Expand Up @@ -2845,7 +2859,7 @@ static int mv88e6xxx_setup(struct dsa_switch *ds)
int i;

chip->ds = ds;
ds->slave_mii_bus = chip->mdio_bus;
ds->slave_mii_bus = mv88e6xxx_default_mdio_bus(chip);

mutex_lock(&chip->reg_lock);

Expand Down Expand Up @@ -2940,22 +2954,23 @@ static int mv88e6xxx_mdio_write(struct mii_bus *bus, int phy, int reg, u16 val)
}

static int mv88e6xxx_mdio_register(struct mv88e6xxx_chip *chip,
struct device_node *np)
struct device_node *np,
bool external)
{
static int index;
struct mv88e6xxx_mdio_bus *mdio_bus;
struct mii_bus *bus;
int err;

if (np)
chip->mdio_np = of_get_child_by_name(np, "mdio");

bus = devm_mdiobus_alloc_size(chip->dev, sizeof(*mdio_bus));
if (!bus)
return -ENOMEM;

mdio_bus = bus->priv;
mdio_bus->bus = bus;
mdio_bus->chip = chip;
INIT_LIST_HEAD(&mdio_bus->list);
mdio_bus->external = external;

if (np) {
bus->name = np->full_name;
Expand All @@ -2969,34 +2984,72 @@ static int mv88e6xxx_mdio_register(struct mv88e6xxx_chip *chip,
bus->write = mv88e6xxx_mdio_write;
bus->parent = chip->dev;

if (chip->mdio_np)
err = of_mdiobus_register(bus, chip->mdio_np);
if (np)
err = of_mdiobus_register(bus, np);
else
err = mdiobus_register(bus);
if (err) {
dev_err(chip->dev, "Cannot register MDIO bus (%d)\n", err);
goto out;
return err;
}
chip->mdio_bus = bus;

if (external)
list_add_tail(&mdio_bus->list, &chip->mdios);
else
list_add(&mdio_bus->list, &chip->mdios);

return 0;
}

out:
if (chip->mdio_np)
of_node_put(chip->mdio_np);
static const struct of_device_id mv88e6xxx_mdio_external_match[] = {
{ .compatible = "marvell,mv88e6xxx-mdio-external",
.data = (void *)true },
{ },
};

return err;
static int mv88e6xxx_mdios_register(struct mv88e6xxx_chip *chip,
struct device_node *np)
{
const struct of_device_id *match;
struct device_node *child;
int err;

/* Always register one mdio bus for the internal/default mdio
* bus. This maybe represented in the device tree, but is
* optional.
*/
child = of_get_child_by_name(np, "mdio");
err = mv88e6xxx_mdio_register(chip, child, false);
if (err)
return err;

/* Walk the device tree, and see if there are any other nodes
* which say they are compatible with the external mdio
* bus.
*/
for_each_available_child_of_node(np, child) {
match = of_match_node(mv88e6xxx_mdio_external_match, child);
if (match) {
err = mv88e6xxx_mdio_register(chip, child, true);
if (err)
return err;
}
}

return 0;
}

static void mv88e6xxx_mdio_unregister(struct mv88e6xxx_chip *chip)
static void mv88e6xxx_mdios_unregister(struct mv88e6xxx_chip *chip)

{
struct mii_bus *bus = chip->mdio_bus;
struct mv88e6xxx_mdio_bus *mdio_bus;
struct mii_bus *bus;

mdiobus_unregister(bus);
list_for_each_entry(mdio_bus, &chip->mdios, list) {
bus = mdio_bus->bus;

if (chip->mdio_np)
of_node_put(chip->mdio_np);
mdiobus_unregister(bus);
}
}

static int mv88e6xxx_get_eeprom_len(struct dsa_switch *ds)
Expand Down Expand Up @@ -4123,6 +4176,7 @@ static struct mv88e6xxx_chip *mv88e6xxx_alloc_chip(struct device *dev)
chip->dev = dev;

mutex_init(&chip->reg_lock);
INIT_LIST_HEAD(&chip->mdios);

return chip;
}
Expand Down Expand Up @@ -4197,7 +4251,7 @@ static const char *mv88e6xxx_drv_probe(struct device *dsa_dev,

mv88e6xxx_phy_init(chip);

err = mv88e6xxx_mdio_register(chip, NULL);
err = mv88e6xxx_mdios_register(chip, NULL);
if (err)
goto free;

Expand Down Expand Up @@ -4398,7 +4452,7 @@ static int mv88e6xxx_probe(struct mdio_device *mdiodev)
}
}

err = mv88e6xxx_mdio_register(chip, np);
err = mv88e6xxx_mdios_register(chip, np);
if (err)
goto out_g2_irq;

Expand All @@ -4409,7 +4463,7 @@ static int mv88e6xxx_probe(struct mdio_device *mdiodev)
return 0;

out_mdio:
mv88e6xxx_mdio_unregister(chip);
mv88e6xxx_mdios_unregister(chip);
out_g2_irq:
if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G2_INT) && chip->irq > 0)
mv88e6xxx_g2_irq_free(chip);
Expand All @@ -4430,7 +4484,7 @@ static void mv88e6xxx_remove(struct mdio_device *mdiodev)

mv88e6xxx_phy_destroy(chip);
mv88e6xxx_unregister_switch(chip);
mv88e6xxx_mdio_unregister(chip);
mv88e6xxx_mdios_unregister(chip);

if (chip->irq > 0) {
if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G2_INT))
Expand Down
10 changes: 5 additions & 5 deletions drivers/net/dsa/mv88e6xxx/mv88e6xxx.h
View file
Original file line number Diff line number Diff line change
Expand Up @@ -730,11 +730,8 @@ struct mv88e6xxx_chip {
/* set to size of eeprom if supported by the switch */
int eeprom_len;

/* Device node for the MDIO bus */
struct device_node *mdio_np;

/* And the MDIO bus itself */
struct mii_bus *mdio_bus;
/* List of mdio busses */
struct list_head mdios;

/* There can be two interrupt controllers, which are chained
* off a GPIO as interrupt source
Expand All @@ -751,7 +748,10 @@ struct mv88e6xxx_bus_ops {
};

struct mv88e6xxx_mdio_bus {
struct mii_bus *bus;
struct mv88e6xxx_chip *chip;
struct list_head list;
bool external;
};

struct mv88e6xxx_ops {
Expand Down

0 comments on commit a3c53be

Please sign in to comment.