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

Signed-off-by: Guenter Roeck <li...@roeck-us.net>
---
v3:
- Fix bug seen if devicetree is enabled; eeprom-length property is
  attached to switch devicetree node, not to dsa node.
v2:
- Add support for configuring switch EEPROM size through platform data
  or devicetree data
- Do not compare new pointers against NULL
- Check if get_eeprom pointer is set before calling it

 include/net/dsa.h | 10 ++++++++++
 net/dsa/dsa.c     |  4 ++++
 net/dsa/slave.c   | 41 +++++++++++++++++++++++++++++++++++++++++
 3 files changed, 55 insertions(+)

diff --git a/include/net/dsa.h b/include/net/dsa.h
index 55e75e7..37856a2 100644
--- a/include/net/dsa.h
+++ b/include/net/dsa.h
@@ -38,6 +38,9 @@ struct dsa_chip_data {
        struct device   *host_dev;
        int             sw_addr;
 
+       /* set to size of eeprom if supported by the switch */
+       int             eeprom_len;
+
        /* Device tree node pointer for this specific switch chip
         * used during switch setup in case additional properties
         * and resources needs to be used
@@ -258,6 +261,13 @@ struct dsa_switch_driver {
        int     (*set_temp_limit)(struct dsa_switch *ds, int temp);
        int     (*get_temp_alarm)(struct dsa_switch *ds, bool *alarm);
 #endif
+
+       /* EEPROM access */
+       int     (*get_eeprom_len)(struct dsa_switch *ds);
+       int     (*get_eeprom)(struct dsa_switch *ds,
+                             struct ethtool_eeprom *eeprom, u8 *data);
+       int     (*set_eeprom)(struct dsa_switch *ds,
+                             struct ethtool_eeprom *eeprom, u8 *data);
 };
 
 void register_switch_driver(struct dsa_switch_driver *type);
diff --git a/net/dsa/dsa.c b/net/dsa/dsa.c
index 5edbbca..b51ef592 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 6d18174..ff2fbe7 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,
-- 
1.9.1

--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html
Please read the FAQ at  http://www.tux.org/lkml/

Reply via email to