net/i40e: fix DCB initialization
[dpdk.git] / drivers / net / axgbe / axgbe_phy_impl.c
index 19bd4be..02236ec 100644 (file)
 /* Rate-change complete wait/retry count */
 #define AXGBE_RATECHANGE_COUNT         500
 
+/* CDR delay values for KR support (in usec) */
+#define AXGBE_CDR_DELAY_INIT           10000
+#define AXGBE_CDR_DELAY_INC            10000
+#define AXGBE_CDR_DELAY_MAX            100000
+
 enum axgbe_port_mode {
        AXGBE_PORT_MODE_RSVD = 0,
        AXGBE_PORT_MODE_BACKPLANE,
@@ -237,6 +242,10 @@ struct axgbe_phy_data {
        unsigned int redrv_addr;
        unsigned int redrv_lane;
        unsigned int redrv_model;
+
+       /* KR AN support */
+       unsigned int phy_cdr_notrack;
+       unsigned int phy_cdr_delay;
 };
 
 static enum axgbe_an_mode axgbe_phy_an_mode(struct axgbe_port *pdata);
@@ -403,15 +412,15 @@ static int axgbe_phy_get_comm_ownership(struct axgbe_port *pdata)
        uint64_t timeout;
        unsigned int mutex_id;
 
-       if (phy_data->comm_owned)
-               return 0;
-
        /* The I2C and MDIO/GPIO bus is multiplexed between multiple devices,
         * the driver needs to take the software mutex and then the hardware
         * mutexes before being able to use the busses.
         */
        pthread_mutex_lock(&pdata->phy_mutex);
 
+       if (phy_data->comm_owned)
+               return 0;
+
        /* Clear the mutexes */
        XP_IOWRITE(pdata, XP_I2C_MUTEX, AXGBE_MUTEX_RELEASE);
        XP_IOWRITE(pdata, XP_MDIO_MUTEX, AXGBE_MUTEX_RELEASE);
@@ -565,11 +574,11 @@ static bool axgbe_phy_belfuse_parse_quirks(struct axgbe_port *pdata)
        struct axgbe_sfp_eeprom *sfp_eeprom = &phy_data->sfp_eeprom;
 
        if (memcmp(&sfp_eeprom->base[AXGBE_SFP_BASE_VENDOR_NAME],
-                  AXGBE_BEL_FUSE_VENDOR, AXGBE_SFP_BASE_VENDOR_NAME_LEN))
+                  AXGBE_BEL_FUSE_VENDOR, strlen(AXGBE_BEL_FUSE_VENDOR)))
                return false;
 
        if (!memcmp(&sfp_eeprom->base[AXGBE_SFP_BASE_VENDOR_PN],
-                   AXGBE_BEL_FUSE_PARTNO, AXGBE_SFP_BASE_VENDOR_PN_LEN)) {
+                   AXGBE_BEL_FUSE_PARTNO, strlen(AXGBE_BEL_FUSE_PARTNO))) {
                phy_data->sfp_base = AXGBE_SFP_BASE_1000_SX;
                phy_data->sfp_cable = AXGBE_SFP_CABLE_ACTIVE;
                phy_data->sfp_speed = AXGBE_SFP_SPEED_1000;
@@ -601,8 +610,7 @@ static void axgbe_phy_sfp_parse_eeprom(struct axgbe_port *pdata)
        if (sfp_base[AXGBE_SFP_BASE_EXT_ID] != AXGBE_SFP_EXT_ID_SFP)
                return;
 
-       if (axgbe_phy_sfp_parse_quirks(pdata))
-               return;
+       axgbe_phy_sfp_parse_quirks(pdata);
 
        /* Assume ACTIVE cable unless told it is PASSIVE */
        if (sfp_base[AXGBE_SFP_BASE_CABLE] & AXGBE_SFP_BASE_CABLE_PASSIVE) {
@@ -782,6 +790,32 @@ static void axgbe_phy_sfp_reset(struct axgbe_phy_data *phy_data)
        phy_data->sfp_speed = AXGBE_SFP_SPEED_UNKNOWN;
 }
 
+static const char *axgbe_base_as_string(enum axgbe_sfp_base sfp_base)
+{
+       switch (sfp_base) {
+       case AXGBE_SFP_BASE_1000_T:
+               return "1G_T";
+       case AXGBE_SFP_BASE_1000_SX:
+               return "1G_SX";
+       case AXGBE_SFP_BASE_1000_LX:
+               return "1G_LX";
+       case AXGBE_SFP_BASE_1000_CX:
+               return "1G_CX";
+       case AXGBE_SFP_BASE_10000_SR:
+               return "10G_SR";
+       case AXGBE_SFP_BASE_10000_LR:
+               return "10G_LR";
+       case AXGBE_SFP_BASE_10000_LRM:
+               return "10G_LRM";
+       case AXGBE_SFP_BASE_10000_ER:
+               return "10G_ER";
+       case AXGBE_SFP_BASE_10000_CR:
+               return "10G_CR";
+       default:
+               return "Unknown";
+       }
+}
+
 static void axgbe_phy_sfp_detect(struct axgbe_port *pdata)
 {
        struct axgbe_phy_data *phy_data = pdata->phy_data;
@@ -812,6 +846,9 @@ static void axgbe_phy_sfp_detect(struct axgbe_port *pdata)
        axgbe_phy_sfp_parse_eeprom(pdata);
        axgbe_phy_sfp_external_phy(pdata);
 
+       PMD_DRV_LOG(DEBUG, "SFP Base: %s\n",
+                   axgbe_base_as_string(phy_data->sfp_base));
+
 put:
        axgbe_phy_sfp_phy_settings(pdata);
        axgbe_phy_put_comm_ownership(pdata);
@@ -949,6 +986,41 @@ static enum axgbe_mode axgbe_phy_an73_outcome(struct axgbe_port *pdata)
        return mode;
 }
 
+static enum axgbe_mode axgbe_phy_an37_sgmii_outcome(struct axgbe_port *pdata)
+{
+       enum axgbe_mode mode;
+
+       pdata->phy.lp_advertising |= ADVERTISED_Autoneg;
+       pdata->phy.lp_advertising |= ADVERTISED_1000baseT_Full;
+
+       if (pdata->phy.pause_autoneg)
+               axgbe_phy_phydev_flowctrl(pdata);
+
+       switch (pdata->an_status & AXGBE_SGMII_AN_LINK_SPEED) {
+       case AXGBE_SGMII_AN_LINK_SPEED_100:
+               if (pdata->an_status & AXGBE_SGMII_AN_LINK_DUPLEX) {
+                       pdata->phy.lp_advertising |= ADVERTISED_100baseT_Full;
+                       mode = AXGBE_MODE_SGMII_100;
+               } else {
+                       mode = AXGBE_MODE_UNKNOWN;
+               }
+               break;
+       case AXGBE_SGMII_AN_LINK_SPEED_1000:
+               if (pdata->an_status & AXGBE_SGMII_AN_LINK_DUPLEX) {
+                       pdata->phy.lp_advertising |= ADVERTISED_1000baseT_Full;
+                       mode = AXGBE_MODE_SGMII_1000;
+               } else {
+                       /* Half-duplex not supported */
+                       mode = AXGBE_MODE_UNKNOWN;
+               }
+               break;
+       default:
+               mode = AXGBE_MODE_UNKNOWN;
+               break;
+       }
+       return mode;
+}
+
 static enum axgbe_mode axgbe_phy_an_outcome(struct axgbe_port *pdata)
 {
        switch (pdata->an_mode) {
@@ -958,6 +1030,7 @@ static enum axgbe_mode axgbe_phy_an_outcome(struct axgbe_port *pdata)
                return axgbe_phy_an73_redrv_outcome(pdata);
        case AXGBE_AN_MODE_CL37:
        case AXGBE_AN_MODE_CL37_SGMII:
+               return axgbe_phy_an37_sgmii_outcome(pdata);
        default:
                return AXGBE_MODE_UNKNOWN;
        }
@@ -1125,7 +1198,10 @@ static void axgbe_phy_set_redrv_mode(struct axgbe_port *pdata)
 
 static void axgbe_phy_start_ratechange(struct axgbe_port *pdata)
 {
-       if (!XP_IOREAD_BITS(pdata, XP_DRIVER_INT_RO, STATUS))
+       /* Log if a previous command did not complete */
+       if (XP_IOREAD_BITS(pdata, XP_DRIVER_INT_RO, STATUS))
+               PMD_DRV_LOG(NOTICE, "firmware mailbox not ready for command\n");
+       else
                return;
 }
 
@@ -1141,6 +1217,7 @@ static void axgbe_phy_complete_ratechange(struct axgbe_port *pdata)
 
                rte_delay_us(1500);
        }
+       PMD_DRV_LOG(NOTICE, "firmware mailbox command did not complete\n");
 }
 
 static void axgbe_phy_rrc(struct axgbe_port *pdata)
@@ -1160,6 +1237,8 @@ static void axgbe_phy_rrc(struct axgbe_port *pdata)
        XP_IOWRITE_BITS(pdata, XP_DRIVER_INT_REQ, REQUEST, 1);
 
        axgbe_phy_complete_ratechange(pdata);
+
+       PMD_DRV_LOG(DEBUG, "receiver reset complete\n");
 }
 
 static void axgbe_phy_power_off(struct axgbe_port *pdata)
@@ -1174,6 +1253,8 @@ static void axgbe_phy_power_off(struct axgbe_port *pdata)
        XP_IOWRITE_BITS(pdata, XP_DRIVER_INT_REQ, REQUEST, 1);
        axgbe_phy_complete_ratechange(pdata);
        phy_data->cur_mode = AXGBE_MODE_UNKNOWN;
+
+       PMD_DRV_LOG(DEBUG, "phy powered off\n");
 }
 
 static void axgbe_phy_sfi_mode(struct axgbe_port *pdata)
@@ -1205,6 +1286,8 @@ static void axgbe_phy_sfi_mode(struct axgbe_port *pdata)
        XP_IOWRITE_BITS(pdata, XP_DRIVER_INT_REQ, REQUEST, 1);
        axgbe_phy_complete_ratechange(pdata);
        phy_data->cur_mode = AXGBE_MODE_SFI;
+
+       PMD_DRV_LOG(DEBUG, "10GbE SFI mode set\n");
 }
 
 static void axgbe_phy_kr_mode(struct axgbe_port *pdata)
@@ -1227,6 +1310,49 @@ static void axgbe_phy_kr_mode(struct axgbe_port *pdata)
        XP_IOWRITE_BITS(pdata, XP_DRIVER_INT_REQ, REQUEST, 1);
        axgbe_phy_complete_ratechange(pdata);
        phy_data->cur_mode = AXGBE_MODE_KR;
+
+       PMD_DRV_LOG(DEBUG, "10GbE KR mode set\n");
+}
+
+static void axgbe_phy_kx_2500_mode(struct axgbe_port *pdata)
+{
+       struct axgbe_phy_data *phy_data = pdata->phy_data;
+       unsigned int s0;
+
+       axgbe_phy_set_redrv_mode(pdata);
+       /* 2.5G/KX */
+       axgbe_phy_start_ratechange(pdata);
+       s0 = 0;
+       XP_SET_BITS(s0, XP_DRIVER_SCRATCH_0, COMMAND, 2);
+       XP_SET_BITS(s0, XP_DRIVER_SCRATCH_0, SUB_COMMAND, 0);
+
+       XP_IOWRITE(pdata, XP_DRIVER_SCRATCH_0, s0);
+       XP_IOWRITE(pdata, XP_DRIVER_SCRATCH_1, 0);
+
+       XP_IOWRITE_BITS(pdata, XP_DRIVER_INT_REQ, REQUEST, 1);
+
+       phy_data->cur_mode = AXGBE_MODE_KX_2500;
+}
+
+static void axgbe_phy_sgmii_1000_mode(struct axgbe_port *pdata)
+{
+       struct axgbe_phy_data *phy_data = pdata->phy_data;
+       unsigned int s0;
+
+       axgbe_phy_set_redrv_mode(pdata);
+
+       /* 1G/SGMII */
+       axgbe_phy_start_ratechange(pdata);
+       s0 = 0;
+       XP_SET_BITS(s0, XP_DRIVER_SCRATCH_0, COMMAND, 1);
+       XP_SET_BITS(s0, XP_DRIVER_SCRATCH_0, SUB_COMMAND, 2);
+
+       XP_IOWRITE(pdata, XP_DRIVER_SCRATCH_0, s0);
+       XP_IOWRITE(pdata, XP_DRIVER_SCRATCH_1, 0);
+
+       XP_IOWRITE_BITS(pdata, XP_DRIVER_INT_REQ, REQUEST, 1);
+
+       phy_data->cur_mode = AXGBE_MODE_SGMII_1000;
 }
 
 static enum axgbe_mode axgbe_phy_cur_mode(struct axgbe_port *pdata)
@@ -1399,6 +1525,12 @@ static void axgbe_phy_set_mode(struct axgbe_port *pdata, enum axgbe_mode mode)
        case AXGBE_MODE_SFI:
                axgbe_phy_sfi_mode(pdata);
                break;
+       case AXGBE_MODE_KX_2500:
+               axgbe_phy_kx_2500_mode(pdata);
+               break;
+       case AXGBE_MODE_SGMII_1000:
+               axgbe_phy_sgmii_1000_mode(pdata);
+               break;
        default:
                break;
        }
@@ -1766,6 +1898,100 @@ static bool axgbe_phy_port_enabled(struct axgbe_port *pdata)
        return true;
 }
 
+static void axgbe_phy_cdr_track(struct axgbe_port *pdata)
+{
+       struct axgbe_phy_data *phy_data = pdata->phy_data;
+
+       if (!pdata->vdata->an_cdr_workaround)
+               return;
+
+       if (!phy_data->phy_cdr_notrack)
+               return;
+
+       rte_delay_us(phy_data->phy_cdr_delay + 400);
+
+       XMDIO_WRITE_BITS(pdata, MDIO_MMD_PMAPMD, MDIO_VEND2_PMA_CDR_CONTROL,
+                        AXGBE_PMA_CDR_TRACK_EN_MASK,
+                        AXGBE_PMA_CDR_TRACK_EN_ON);
+
+       phy_data->phy_cdr_notrack = 0;
+}
+
+static void axgbe_phy_cdr_notrack(struct axgbe_port *pdata)
+{
+       struct axgbe_phy_data *phy_data = pdata->phy_data;
+
+       if (!pdata->vdata->an_cdr_workaround)
+               return;
+
+       if (phy_data->phy_cdr_notrack)
+               return;
+
+       XMDIO_WRITE_BITS(pdata, MDIO_MMD_PMAPMD, MDIO_VEND2_PMA_CDR_CONTROL,
+                        AXGBE_PMA_CDR_TRACK_EN_MASK,
+                        AXGBE_PMA_CDR_TRACK_EN_OFF);
+
+       axgbe_phy_rrc(pdata);
+
+       phy_data->phy_cdr_notrack = 1;
+}
+
+static void axgbe_phy_kr_training_post(struct axgbe_port *pdata)
+{
+       if (!pdata->cdr_track_early)
+               axgbe_phy_cdr_track(pdata);
+}
+
+static void axgbe_phy_kr_training_pre(struct axgbe_port *pdata)
+{
+       if (pdata->cdr_track_early)
+               axgbe_phy_cdr_track(pdata);
+}
+
+static void axgbe_phy_an_post(struct axgbe_port *pdata)
+{
+       struct axgbe_phy_data *phy_data = pdata->phy_data;
+
+       switch (pdata->an_mode) {
+       case AXGBE_AN_MODE_CL73:
+       case AXGBE_AN_MODE_CL73_REDRV:
+               if (phy_data->cur_mode != AXGBE_MODE_KR)
+                       break;
+
+               axgbe_phy_cdr_track(pdata);
+
+               switch (pdata->an_result) {
+               case AXGBE_AN_READY:
+               case AXGBE_AN_COMPLETE:
+                       break;
+               default:
+                       if (phy_data->phy_cdr_delay < AXGBE_CDR_DELAY_MAX)
+                               phy_data->phy_cdr_delay += AXGBE_CDR_DELAY_INC;
+                       break;
+               }
+               break;
+       default:
+               break;
+       }
+}
+
+static void axgbe_phy_an_pre(struct axgbe_port *pdata)
+{
+       struct axgbe_phy_data *phy_data = pdata->phy_data;
+
+       switch (pdata->an_mode) {
+       case AXGBE_AN_MODE_CL73:
+       case AXGBE_AN_MODE_CL73_REDRV:
+               if (phy_data->cur_mode != AXGBE_MODE_KR)
+                       break;
+
+               axgbe_phy_cdr_notrack(pdata);
+               break;
+       default:
+               break;
+       }
+}
+
 static void axgbe_phy_stop(struct axgbe_port *pdata)
 {
        struct axgbe_phy_data *phy_data = pdata->phy_data;
@@ -1774,6 +2000,9 @@ static void axgbe_phy_stop(struct axgbe_port *pdata)
        axgbe_phy_sfp_reset(phy_data);
        axgbe_phy_sfp_mod_absent(pdata);
 
+       /* Reset CDR support */
+       axgbe_phy_cdr_track(pdata);
+
        /* Power off the PHY */
        axgbe_phy_power_off(pdata);
 
@@ -1794,6 +2023,9 @@ static int axgbe_phy_start(struct axgbe_port *pdata)
        /* Start in highest supported mode */
        axgbe_phy_set_mode(pdata, phy_data->start_mode);
 
+       /* Reset CDR support */
+       axgbe_phy_cdr_track(pdata);
+
        /* After starting the I2C controller, we can check for an SFP */
        switch (phy_data->port_mode) {
        case AXGBE_PORT_MODE_SFP:
@@ -1802,6 +2034,7 @@ static int axgbe_phy_start(struct axgbe_port *pdata)
        default:
                break;
        }
+       pdata->phy.advertising &= axgbe_phy_an_advertising(pdata);
 
        return ret;
 }
@@ -2051,6 +2284,8 @@ static int axgbe_phy_init(struct axgbe_port *pdata)
                        return -EINVAL;
                }
        }
+
+       phy_data->phy_cdr_delay = AXGBE_CDR_DELAY_INIT;
        return 0;
 }
 void axgbe_init_function_ptrs_phy_v2(struct axgbe_phy_if *phy_if)
@@ -2071,4 +2306,10 @@ void axgbe_init_function_ptrs_phy_v2(struct axgbe_phy_if *phy_if)
        phy_impl->an_config             = axgbe_phy_an_config;
        phy_impl->an_advertising        = axgbe_phy_an_advertising;
        phy_impl->an_outcome            = axgbe_phy_an_outcome;
+
+       phy_impl->an_pre                = axgbe_phy_an_pre;
+       phy_impl->an_post               = axgbe_phy_an_post;
+
+       phy_impl->kr_training_pre       = axgbe_phy_kr_training_pre;
+       phy_impl->kr_training_post      = axgbe_phy_kr_training_post;
 }