net: dsa: Add support for switch EEPROM access

On some chips it is possible to access the switch eeprom.
Add infrastructure support for it.

Signed-off-by: Guenter Roeck <linux@roeck-us.net>
Signed-off-by: David S. Miller <davem@davemloft.net>

2 files changed, 45 insertions, 0 deletions

diff --git a/net/dsa/dsa.c b/net/dsa/dsa.c
index 5edbbca89f1f..b51ef592f0a2 100644
--- a/net/dsa/dsa.c
+++ b/net/dsa/dsa.c
@@ -575,6 +575,7 @@ static int dsa_of_probe(struct platform_device *pdev)
         const char *port_name;
         int chip_index, port_index;
         const unsigned int *sw_addr, *port_reg;
+        u32 eeprom_len;
         int ret;
 
         mdio = of_parse_phandle(np, "dsa,mii-bus", 0);
@@ -626,6 +627,9 @@ static int dsa_of_probe(struct platform_device *pdev)
                 if (cd->sw_addr > PHY_MAX_ADDR)
                         continue;
 
+                if (!of_property_read_u32(np, "eeprom-length", &eeprom_len))
+                        cd->eeprom_len = eeprom_len;
+
                 for_each_available_child_of_node(child, port) {
                         port_reg = of_get_property(port, "reg", NULL);
                         if (!port_reg)
diff --git a/net/dsa/slave.c b/net/dsa/slave.c
index 6d1817449c36..ff2fbe79bc57 100644
--- a/net/dsa/slave.c
+++ b/net/dsa/slave.c
@@ -271,6 +271,44 @@ static u32 dsa_slave_get_link(struct net_device *dev)
         return -EOPNOTSUPP;
 }
 
+static int dsa_slave_get_eeprom_len(struct net_device *dev)
+{
+        struct dsa_slave_priv *p = netdev_priv(dev);
+        struct dsa_switch *ds = p->parent;
+
+        if (ds->pd->eeprom_len)
+                return ds->pd->eeprom_len;
+
+        if (ds->drv->get_eeprom_len)
+                return ds->drv->get_eeprom_len(ds);
+
+        return 0;
+}
+
+static int dsa_slave_get_eeprom(struct net_device *dev,
+                                struct ethtool_eeprom *eeprom, u8 *data)
+{
+        struct dsa_slave_priv *p = netdev_priv(dev);
+        struct dsa_switch *ds = p->parent;
+
+        if (ds->drv->get_eeprom)
+                return ds->drv->get_eeprom(ds, eeprom, data);
+
+        return -EOPNOTSUPP;
+}
+
+static int dsa_slave_set_eeprom(struct net_device *dev,
+                                struct ethtool_eeprom *eeprom, u8 *data)
+{
+        struct dsa_slave_priv *p = netdev_priv(dev);
+        struct dsa_switch *ds = p->parent;
+
+        if (ds->drv->set_eeprom)
+                return ds->drv->set_eeprom(ds, eeprom, data);
+
+        return -EOPNOTSUPP;
+}
+
 static void dsa_slave_get_strings(struct net_device *dev,
                                   uint32_t stringset, uint8_t *data)
 {
@@ -387,6 +425,9 @@ static const struct ethtool_ops dsa_slave_ethtool_ops = {
         .get_drvinfo            = dsa_slave_get_drvinfo,
         .nway_reset             = dsa_slave_nway_reset,
         .get_link               = dsa_slave_get_link,
+        .get_eeprom_len         = dsa_slave_get_eeprom_len,
+        .get_eeprom             = dsa_slave_get_eeprom,
+        .set_eeprom             = dsa_slave_set_eeprom,
         .get_strings            = dsa_slave_get_strings,
         .get_ethtool_stats      = dsa_slave_get_ethtool_stats,
         .get_sset_count         = dsa_slave_get_sset_count,