Merge pull request #986 from muthukumars-arrcus/soft_select

 Enhanced sfpi.c for AS7535-28XB-O-AC-F to support ONLP_SFP_CONTROL for 'Soft Rate_Select Select'

Author: sonoble

packages/platforms/accton/x86-64/as7535-28xb/onlp/builds/x86_64_accton_as7535_28xb/module/src/sfpi.c

@@ -51,6 +51,17 @@
 #define MODULE_PRESENT_ALL_ATTR    "/sys/bus/i2c/devices/12-0061/module_present_all"
 #define MODULE_RXLOS_ALL_ATTR      "/sys/bus/i2c/devices/12-0061/module_rx_los_all"
 
+/* Definitions for Soft_Rate_Select*/
+#define PORT_EEPROM_DEVADDR 0X51
+#define MULTIRATE_OFFSET 0x6E
+#define MBIT_IDENTIFIER_ADDR 0x50
+#define MBIT_OFFSET 0x0d
+#define RATE_SELECT 0x02
+
+/* Macro for Multirate Bit*/
+#define SET_RATE_SELECT_BIT(x,RS_BIT_pos)  (x | (1<<RS_BIT_pos))
+#define RESET_RATE_SELECT_BIT(x,RS_BIT_pos)  (x & ~(1<<RS_BIT_pos))
+
 #define NUM_OF_SFP_PORT 28
 static const int port_bus_index[NUM_OF_SFP_PORT] = {
     23, 21, 24, 22, 25, 26, 27, 28, 29, 30,
@@ -276,6 +287,9 @@ onlp_sfpi_dev_writew(int port, uint8_t devaddr, uint8_t addr, uint16_t value)
 int
 onlp_sfpi_control_set(int port, onlp_sfp_control_t control, int value)
 {
+    int present = 0;
+    int mbit_identifier;
+    int mbit_value;
     switch(control) {
     case ONLP_SFP_CONTROL_TX_DISABLE: {
         VALIDATE_SFP(port);
@@ -308,6 +322,42 @@ onlp_sfpi_control_set(int port, onlp_sfp_control_t control, int value)
             return ONLP_STATUS_OK;
         }
     }
+    case ONLP_SFP_CONTROL_SOFT_RATE_SELECT: {
+        VALIDATE_SFP(port);
+
+        present = onlp_sfpi_is_present(port);
+        if (present == 1) {
+            mbit_identifier = onlp_sfpi_dev_readb(port, MBIT_IDENTIFIER_ADDR, MBIT_OFFSET);
+            if (mbit_identifier == RATE_SELECT) {
+                mbit_value = onlp_sfpi_dev_readb(port, PORT_EEPROM_DEVADDR, MULTIRATE_OFFSET);
+                if (value == 0x0) {
+                    mbit_value = RESET_RATE_SELECT_BIT(mbit_value,3);
+                    if (onlp_sfpi_dev_writeb(port, PORT_EEPROM_DEVADDR, MULTIRATE_OFFSET, mbit_value) < 0){
+                        AIM_LOG_ERROR("Unable to write multirate status to port(%d)\r\n", port);
+                        return ONLP_STATUS_E_INTERNAL;
+                    }
+                    return ONLP_STATUS_OK;
+                }
+                else if(value == 0x1) {
+                    mbit_value = SET_RATE_SELECT_BIT(mbit_value,3);
+                    if (onlp_sfpi_dev_writeb(port, PORT_EEPROM_DEVADDR, MULTIRATE_OFFSET, mbit_value) < 0){
+                        AIM_LOG_ERROR("Unable to write multirate status to port(%d)\r\n", port);
+                        return ONLP_STATUS_E_INTERNAL;
+                    }
+                    return ONLP_STATUS_OK;
+                }
+                return ONLP_STATUS_E_INTERNAL;
+            }
+            else {
+                AIM_LOG_ERROR("Unable to support multirate for the port(%d)\r\n", port);
+                return ONLP_STATUS_E_UNSUPPORTED;
+            }
+        }
+        else {
+            AIM_LOG_ERROR("Unable to write multirate status to port(%d)\r\n", port);
+            return ONLP_STATUS_E_INTERNAL;
+        }
+    }
     default:
         break;
     }
@@ -318,6 +368,9 @@ onlp_sfpi_control_set(int port, onlp_sfp_control_t control, int value)
 int
 onlp_sfpi_control_get(int port, onlp_sfp_control_t control, int* value)
 {
+    int present = 0;
+    int multirate = 0;
+    int mbit_identifier;
     switch(control) {
     case ONLP_SFP_CONTROL_RX_LOS: {
         VALIDATE_SFP(port);
@@ -371,6 +424,31 @@ onlp_sfpi_control_get(int port, onlp_sfp_control_t control, int* value)
 
         return ONLP_STATUS_OK;
     }
+    case ONLP_SFP_CONTROL_SOFT_RATE_SELECT: {
+        VALIDATE_SFP(port);
+
+        present = onlp_sfpi_is_present(port);
+        if(present == 1) {
+            mbit_identifier = onlp_sfpi_dev_readb(port, MBIT_IDENTIFIER_ADDR, MBIT_OFFSET);
+            if(mbit_identifier == RATE_SELECT) {
+                multirate = onlp_sfpi_dev_readb(port, PORT_EEPROM_DEVADDR, MULTIRATE_OFFSET);
+                if (multirate < 0) {
+                    return ONLP_STATUS_E_INTERNAL;
+                }
+                else{
+                    *value = multirate;
+                    return ONLP_STATUS_OK;
+                }
+            }
+            else {
+                AIM_LOG_ERROR("Unable to read multirate status from port(%d)\r\n", port);
+                return ONLP_STATUS_E_UNSUPPORTED;
+            }
+        }
+        else {
+            return ONLP_STATUS_E_INTERNAL;
+        }
+    }
     default:
         break;
     }