提交 a3c53be5 编写于 作者: A Andrew Lunn 提交者: David S. Miller

net: dsa: mv88e6xxx: Support multiple MDIO busses

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: NAndrew Lunn <andrew@lunn.ch>
Signed-off-by: NDavid S. Miller <davem@davemloft.net>
上级 0dd12d54
...@@ -26,8 +26,12 @@ Optional properties: ...@@ -26,8 +26,12 @@ Optional properties:
- interrupt-controller : Indicates the switch is itself an interrupt - interrupt-controller : Indicates the switch is itself an interrupt
controller. This is used for the PHY interrupts. controller. This is used for the PHY interrupts.
#interrupt-cells = <2> : Controller uses two cells, number and flag #interrupt-cells = <2> : Controller uses two cells, number and flag
- mdio : container of PHY and devices on the switches MDIO - mdio : Container of PHY and devices on the switches MDIO
bus 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: Example:
mdio { mdio {
...@@ -53,3 +57,36 @@ Example: ...@@ -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>;
};
};
};
...@@ -236,16 +236,29 @@ static int mv88e6165_phy_write(struct mv88e6xxx_chip *chip, ...@@ -236,16 +236,29 @@ static int mv88e6165_phy_write(struct mv88e6xxx_chip *chip,
return mv88e6xxx_write(chip, addr, reg, val); 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, static int mv88e6xxx_phy_read(struct mv88e6xxx_chip *chip, int phy,
int reg, u16 *val) int reg, u16 *val)
{ {
int addr = phy; /* PHY devices addresses start at 0x0 */ 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; return -EOPNOTSUPP;
if (!bus) if (!chip->info->ops->phy_read)
return -EOPNOTSUPP; return -EOPNOTSUPP;
return chip->info->ops->phy_read(chip, bus, addr, reg, val); return chip->info->ops->phy_read(chip, bus, addr, reg, val);
...@@ -255,12 +268,13 @@ static int mv88e6xxx_phy_write(struct mv88e6xxx_chip *chip, int phy, ...@@ -255,12 +268,13 @@ static int mv88e6xxx_phy_write(struct mv88e6xxx_chip *chip, int phy,
int reg, u16 val) int reg, u16 val)
{ {
int addr = phy; /* PHY devices addresses start at 0x0 */ 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; return -EOPNOTSUPP;
if (!bus) if (!chip->info->ops->phy_write)
return -EOPNOTSUPP; return -EOPNOTSUPP;
return chip->info->ops->phy_write(chip, bus, addr, reg, val); return chip->info->ops->phy_write(chip, bus, addr, reg, val);
...@@ -2845,7 +2859,7 @@ static int mv88e6xxx_setup(struct dsa_switch *ds) ...@@ -2845,7 +2859,7 @@ static int mv88e6xxx_setup(struct dsa_switch *ds)
int i; int i;
chip->ds = ds; chip->ds = ds;
ds->slave_mii_bus = chip->mdio_bus; ds->slave_mii_bus = mv88e6xxx_default_mdio_bus(chip);
mutex_lock(&chip->reg_lock); mutex_lock(&chip->reg_lock);
...@@ -2940,22 +2954,23 @@ static int mv88e6xxx_mdio_write(struct mii_bus *bus, int phy, int reg, u16 val) ...@@ -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, static int mv88e6xxx_mdio_register(struct mv88e6xxx_chip *chip,
struct device_node *np) struct device_node *np,
bool external)
{ {
static int index; static int index;
struct mv88e6xxx_mdio_bus *mdio_bus; struct mv88e6xxx_mdio_bus *mdio_bus;
struct mii_bus *bus; struct mii_bus *bus;
int err; int err;
if (np)
chip->mdio_np = of_get_child_by_name(np, "mdio");
bus = devm_mdiobus_alloc_size(chip->dev, sizeof(*mdio_bus)); bus = devm_mdiobus_alloc_size(chip->dev, sizeof(*mdio_bus));
if (!bus) if (!bus)
return -ENOMEM; return -ENOMEM;
mdio_bus = bus->priv; mdio_bus = bus->priv;
mdio_bus->bus = bus;
mdio_bus->chip = chip; mdio_bus->chip = chip;
INIT_LIST_HEAD(&mdio_bus->list);
mdio_bus->external = external;
if (np) { if (np) {
bus->name = np->full_name; bus->name = np->full_name;
...@@ -2969,34 +2984,72 @@ static int mv88e6xxx_mdio_register(struct mv88e6xxx_chip *chip, ...@@ -2969,34 +2984,72 @@ static int mv88e6xxx_mdio_register(struct mv88e6xxx_chip *chip,
bus->write = mv88e6xxx_mdio_write; bus->write = mv88e6xxx_mdio_write;
bus->parent = chip->dev; bus->parent = chip->dev;
if (chip->mdio_np) if (np)
err = of_mdiobus_register(bus, chip->mdio_np); err = of_mdiobus_register(bus, np);
else else
err = mdiobus_register(bus); err = mdiobus_register(bus);
if (err) { if (err) {
dev_err(chip->dev, "Cannot register MDIO bus (%d)\n", 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; return 0;
}
out: static const struct of_device_id mv88e6xxx_mdio_external_match[] = {
if (chip->mdio_np) { .compatible = "marvell,mv88e6xxx-mdio-external",
of_node_put(chip->mdio_np); .data = (void *)true },
{ },
};
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; 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) mdiobus_unregister(bus);
of_node_put(chip->mdio_np); }
} }
static int mv88e6xxx_get_eeprom_len(struct dsa_switch *ds) static int mv88e6xxx_get_eeprom_len(struct dsa_switch *ds)
...@@ -4123,6 +4176,7 @@ static struct mv88e6xxx_chip *mv88e6xxx_alloc_chip(struct device *dev) ...@@ -4123,6 +4176,7 @@ static struct mv88e6xxx_chip *mv88e6xxx_alloc_chip(struct device *dev)
chip->dev = dev; chip->dev = dev;
mutex_init(&chip->reg_lock); mutex_init(&chip->reg_lock);
INIT_LIST_HEAD(&chip->mdios);
return chip; return chip;
} }
...@@ -4197,7 +4251,7 @@ static const char *mv88e6xxx_drv_probe(struct device *dsa_dev, ...@@ -4197,7 +4251,7 @@ static const char *mv88e6xxx_drv_probe(struct device *dsa_dev,
mv88e6xxx_phy_init(chip); mv88e6xxx_phy_init(chip);
err = mv88e6xxx_mdio_register(chip, NULL); err = mv88e6xxx_mdios_register(chip, NULL);
if (err) if (err)
goto free; goto free;
...@@ -4398,7 +4452,7 @@ static int mv88e6xxx_probe(struct mdio_device *mdiodev) ...@@ -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) if (err)
goto out_g2_irq; goto out_g2_irq;
...@@ -4409,7 +4463,7 @@ static int mv88e6xxx_probe(struct mdio_device *mdiodev) ...@@ -4409,7 +4463,7 @@ static int mv88e6xxx_probe(struct mdio_device *mdiodev)
return 0; return 0;
out_mdio: out_mdio:
mv88e6xxx_mdio_unregister(chip); mv88e6xxx_mdios_unregister(chip);
out_g2_irq: out_g2_irq:
if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G2_INT) && chip->irq > 0) if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G2_INT) && chip->irq > 0)
mv88e6xxx_g2_irq_free(chip); mv88e6xxx_g2_irq_free(chip);
...@@ -4430,7 +4484,7 @@ static void mv88e6xxx_remove(struct mdio_device *mdiodev) ...@@ -4430,7 +4484,7 @@ static void mv88e6xxx_remove(struct mdio_device *mdiodev)
mv88e6xxx_phy_destroy(chip); mv88e6xxx_phy_destroy(chip);
mv88e6xxx_unregister_switch(chip); mv88e6xxx_unregister_switch(chip);
mv88e6xxx_mdio_unregister(chip); mv88e6xxx_mdios_unregister(chip);
if (chip->irq > 0) { if (chip->irq > 0) {
if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G2_INT)) if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G2_INT))
......
...@@ -730,11 +730,8 @@ struct mv88e6xxx_chip { ...@@ -730,11 +730,8 @@ struct mv88e6xxx_chip {
/* set to size of eeprom if supported by the switch */ /* set to size of eeprom if supported by the switch */
int eeprom_len; int eeprom_len;
/* Device node for the MDIO bus */ /* List of mdio busses */
struct device_node *mdio_np; struct list_head mdios;
/* And the MDIO bus itself */
struct mii_bus *mdio_bus;
/* There can be two interrupt controllers, which are chained /* There can be two interrupt controllers, which are chained
* off a GPIO as interrupt source * off a GPIO as interrupt source
...@@ -751,7 +748,10 @@ struct mv88e6xxx_bus_ops { ...@@ -751,7 +748,10 @@ struct mv88e6xxx_bus_ops {
}; };
struct mv88e6xxx_mdio_bus { struct mv88e6xxx_mdio_bus {
struct mii_bus *bus;
struct mv88e6xxx_chip *chip; struct mv88e6xxx_chip *chip;
struct list_head list;
bool external;
}; };
struct mv88e6xxx_ops { struct mv88e6xxx_ops {
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册