[PATCH net-next] liquidio: copperhead LED identification

[Felix Manlunas]

From: Raghu Vatsavayi <raghu.vatsav...@cavium.com>

Add LED identification support for liquidio TP copperhead cards.

Signed-off-by: Raghu Vatsavayi <raghu.vatsav...@cavium.com>
Acked-by: Derek Chickles <derek.chick...@cavium.com>
Signed-off-by: Felix Manlunas <felix.manlu...@cavium.com>
---
 drivers/net/ethernet/cavium/liquidio/lio_ethtool.c | 27 ++++++++++++++++++----
 .../net/ethernet/cavium/liquidio/liquidio_common.h |  1 +
 2 files changed, 23 insertions(+), 5 deletions(-)

diff --git a/drivers/net/ethernet/cavium/liquidio/lio_ethtool.c 
b/drivers/net/ethernet/cavium/liquidio/lio_ethtool.c
index 06f7449..807ea2c 100644
--- a/drivers/net/ethernet/cavium/liquidio/lio_ethtool.c
+++ b/drivers/net/ethernet/cavium/liquidio/lio_ethtool.c
@@ -857,7 +857,14 @@ static int lio_set_phys_id(struct net_device *netdev,
 {
        struct lio *lio = GET_LIO(netdev);
        struct octeon_device *oct = lio->oct_dev;
+       struct oct_link_info *linfo;
        int value, ret;
+       u32 cur_ver;
+
+       linfo = &lio->linfo;
+       cur_ver = OCT_FW_VER(oct->fw_info.ver.maj,
+                            oct->fw_info.ver.min,
+                            oct->fw_info.ver.rev);
 
        switch (state) {
        case ETHTOOL_ID_ACTIVE:
@@ -896,16 +903,22 @@ static int lio_set_phys_id(struct net_device *netdev,
                                return ret;
                } else if (oct->chip_id == OCTEON_CN23XX_PF_VID) {
                        octnet_id_active(netdev, LED_IDENTIFICATION_ON);
-
-                       /* returns 0 since updates are asynchronous */
-                       return 0;
+                       if (linfo->link.s.phy_type == LIO_PHY_PORT_TP &&
+                           cur_ver > OCT_FW_VER(1, 7, 2))
+                               return 2;
+                       else
+                               return 0;
                } else {
                        return -EINVAL;
                }
                break;
 
        case ETHTOOL_ID_ON:
-               if (oct->chip_id == OCTEON_CN66XX)
+               if (oct->chip_id == OCTEON_CN23XX_PF_VID &&
+                   linfo->link.s.phy_type == LIO_PHY_PORT_TP &&
+                   cur_ver > OCT_FW_VER(1, 7, 2))
+                       octnet_id_active(netdev, LED_IDENTIFICATION_ON);
+               else if (oct->chip_id == OCTEON_CN66XX)
                        octnet_gpio_access(netdev, VITESSE_PHY_GPIO_CFG,
                                           VITESSE_PHY_GPIO_HIGH);
                else
@@ -914,7 +927,11 @@ static int lio_set_phys_id(struct net_device *netdev,
                break;
 
        case ETHTOOL_ID_OFF:
-               if (oct->chip_id == OCTEON_CN66XX)
+               if (oct->chip_id == OCTEON_CN23XX_PF_VID &&
+                   linfo->link.s.phy_type == LIO_PHY_PORT_TP &&
+                   cur_ver > OCT_FW_VER(1, 7, 2))
+                       octnet_id_active(netdev, LED_IDENTIFICATION_OFF);
+               else if (oct->chip_id == OCTEON_CN66XX)
                        octnet_gpio_access(netdev, VITESSE_PHY_GPIO_CFG,
                                           VITESSE_PHY_GPIO_LOW);
                else
diff --git a/drivers/net/ethernet/cavium/liquidio/liquidio_common.h 
b/drivers/net/ethernet/cavium/liquidio/liquidio_common.h
index 690424b..7407fcd 100644
--- a/drivers/net/ethernet/cavium/liquidio/liquidio_common.h
+++ b/drivers/net/ethernet/cavium/liquidio/liquidio_common.h
@@ -907,6 +907,7 @@ static inline int opcode_slow_path(union octeon_rh *rh)
 #define VITESSE_PHY_GPIO_LOW      0x3
 #define LED_IDENTIFICATION_ON     0x1
 #define LED_IDENTIFICATION_OFF    0x0
+#define LIO23XX_COPPERHEAD_LED_GPIO 0x2
 
 struct oct_mdio_cmd {
        u64 op;