bnx2x: link module eeprom

Add the ethtool functionality of accessing optic modules'
information and eeprom to the bnx2x driver.

Signed-off-by: Yuval Mintz <yuvalmin@broadcom.com>
Signed-off-by: Yaniv Rosner <yaniv.rosner@broadcom.com>
Signed-off-by: Eilon Greenstein <eilong@broadcom.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

3 files changed, 67 insertions, 4 deletions

diff --git a/drivers/net/ethernet/broadcom/bnx2x/bnx2x_ethtool.c b/drivers/net/ethernet/broadcom/bnx2x/bnx2x_ethtool.c
index 819170ee152a..1f8c1561cdec 100644
--- a/drivers/net/ethernet/broadcom/bnx2x/bnx2x_ethtool.c
+++ b/drivers/net/ethernet/broadcom/bnx2x/bnx2x_ethtool.c
@@ -1160,6 +1160,65 @@ static int bnx2x_get_eeprom(struct net_device *dev,
         return rc;
 }
 
+static int bnx2x_get_module_eeprom(struct net_device *dev,
+                                   struct ethtool_eeprom *ee,
+                                   u8 *data)
+{
+        struct bnx2x *bp = netdev_priv(dev);
+        int rc = 0, phy_idx;
+        u8 *user_data = data;
+        int remaining_len = ee->len, xfer_size;
+        unsigned int page_off = ee->offset;
+
+        if (!netif_running(dev)) {
+                DP(BNX2X_MSG_ETHTOOL | BNX2X_MSG_NVM,
+                   "cannot access eeprom when the interface is down\n");
+                return -EAGAIN;
+        }
+
+        phy_idx = bnx2x_get_cur_phy_idx(bp);
+        bnx2x_acquire_phy_lock(bp);
+        while (!rc && remaining_len > 0) {
+                xfer_size = (remaining_len > SFP_EEPROM_PAGE_SIZE) ?
+                        SFP_EEPROM_PAGE_SIZE : remaining_len;
+                rc = bnx2x_read_sfp_module_eeprom(&bp->link_params.phy[phy_idx],
+                                                  &bp->link_params,
+                                                  page_off,
+                                                  xfer_size,
+                                                  user_data);
+                remaining_len -= xfer_size;
+                user_data += xfer_size;
+                page_off += xfer_size;
+        }
+
+        bnx2x_release_phy_lock(bp);
+        return rc;
+}
+
+static int bnx2x_get_module_info(struct net_device *dev,
+                                 struct ethtool_modinfo *modinfo)
+{
+        struct bnx2x *bp = netdev_priv(dev);
+        int phy_idx;
+        if (!netif_running(dev)) {
+                DP(BNX2X_MSG_ETHTOOL  | BNX2X_MSG_NVM,
+                   "cannot access eeprom when the interface is down\n");
+                return -EAGAIN;
+        }
+
+        phy_idx = bnx2x_get_cur_phy_idx(bp);
+        switch (bp->link_params.phy[phy_idx].media_type) {
+        case ETH_PHY_SFPP_10G_FIBER:
+        case ETH_PHY_SFP_1G_FIBER:
+        case ETH_PHY_DA_TWINAX:
+                modinfo->type = ETH_MODULE_SFF_8079;
+                modinfo->eeprom_len = ETH_MODULE_SFF_8079_LEN;
+                return 0;
+        default:
+                return -EOPNOTSUPP;
+        }
+}
+
 static int bnx2x_nvram_write_dword(struct bnx2x *bp, u32 offset, u32 val,
                                    u32 cmd_flags)
 {
@@ -2915,6 +2974,8 @@ static const struct ethtool_ops bnx2x_ethtool_ops = {
         .set_rxfh_indir         = bnx2x_set_rxfh_indir,
         .get_channels           = bnx2x_get_channels,
         .set_channels           = bnx2x_set_channels,
+        .get_module_info        = bnx2x_get_module_info,
+        .get_module_eeprom      = bnx2x_get_module_eeprom,
         .get_eee                = bnx2x_get_eee,
         .set_eee                = bnx2x_set_eee,
 };
diff --git a/drivers/net/ethernet/broadcom/bnx2x/bnx2x_link.c b/drivers/net/ethernet/broadcom/bnx2x/bnx2x_link.c
index b21a6be81032..3e662bf7e5d8 100644
--- a/drivers/net/ethernet/broadcom/bnx2x/bnx2x_link.c
+++ b/drivers/net/ethernet/broadcom/bnx2x/bnx2x_link.c
@@ -7695,7 +7695,7 @@ static int bnx2x_8726_read_sfp_module_eeprom(struct bnx2x_phy *phy,
         struct bnx2x *bp = params->bp;
         u16 val = 0;
         u16 i;
-        if (byte_cnt > 16) {
+        if (byte_cnt > SFP_EEPROM_PAGE_SIZE) {
                 DP(NETIF_MSG_LINK,
                    "Reading from eeprom is limited to 0xf\n");
                 return -EINVAL;
@@ -7764,7 +7764,8 @@ static int bnx2x_warpcore_read_sfp_module_eeprom(struct bnx2x_phy *phy,
         u32 data_array[4];
         u16 addr32;
         struct bnx2x *bp = params->bp;
-        if (byte_cnt > 16) {
+
+        if (byte_cnt > SFP_EEPROM_PAGE_SIZE) {
                 DP(NETIF_MSG_LINK,
                    "Reading from eeprom is limited to 16 bytes\n");
                 return -EINVAL;
@@ -7794,7 +7795,7 @@ static int bnx2x_8727_read_sfp_module_eeprom(struct bnx2x_phy *phy,
         struct bnx2x *bp = params->bp;
         u16 val, i;
 
-        if (byte_cnt > 16) {
+        if (byte_cnt > SFP_EEPROM_PAGE_SIZE) {
                 DP(NETIF_MSG_LINK,
                    "Reading from eeprom is limited to 0xf\n");
                 return -EINVAL;
@@ -7877,7 +7878,7 @@ int bnx2x_read_sfp_module_eeprom(struct bnx2x_phy *phy,
                                  struct link_params *params, u16 addr,
                                  u8 byte_cnt, u8 *o_buf)
 {
-        int rc = -EINVAL;
+        int rc = -EOPNOTSUPP;
         switch (phy->type) {
         case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8726:
                 rc = bnx2x_8726_read_sfp_module_eeprom(phy, params, addr,
diff --git a/drivers/net/ethernet/broadcom/bnx2x/bnx2x_link.h b/drivers/net/ethernet/broadcom/bnx2x/bnx2x_link.h
index 017236bee323..c05f9d94938f 100644
--- a/drivers/net/ethernet/broadcom/bnx2x/bnx2x_link.h
+++ b/drivers/net/ethernet/broadcom/bnx2x/bnx2x_link.h
@@ -41,6 +41,7 @@
 #define SPEED_AUTO_NEG          0
 #define SPEED_20000             20000
 
+#define SFP_EEPROM_PAGE_SIZE                    16
 #define SFP_EEPROM_VENDOR_NAME_ADDR             0x14
 #define SFP_EEPROM_VENDOR_NAME_SIZE             16
 #define SFP_EEPROM_VENDOR_OUI_ADDR              0x25