sys/dev/ixgbe/ixgbe_82599.c

   1 /******************************************************************************
   2   SPDX-License-Identifier: BSD-3-Clause
   3
   4   Copyright (c) 2001-2017, Intel Corporation
   5   All rights reserved.
   6
   7   Redistribution and use in source and binary forms, with or without
   8   modification, are permitted provided that the following conditions are met:
   9
  10    1. Redistributions of source code must retain the above copyright notice,
  11       this list of conditions and the following disclaimer.
  12
  13    2. Redistributions in binary form must reproduce the above copyright
  14       notice, this list of conditions and the following disclaimer in the
  15       documentation and/or other materials provided with the distribution.
  16
  17    3. Neither the name of the Intel Corporation nor the names of its
  18       contributors may be used to endorse or promote products derived from
  19       this software without specific prior written permission.
  20
  21   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  22   AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  23   IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  24   ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
  25   LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  26   CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  27   SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  28   INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  29   CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  30   ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  31   POSSIBILITY OF SUCH DAMAGE.
  32
  33 ******************************************************************************/
  34 /*$FreeBSD$*/
  35
  36 #include "ixgbe_type.h"
  37 #include "ixgbe_82599.h"
  38 #include "ixgbe_api.h"
  39 #include "ixgbe_common.h"
  40 #include "ixgbe_phy.h"
  41
  42 #define IXGBE_82599_MAX_TX_QUEUES 128
  43 #define IXGBE_82599_MAX_RX_QUEUES 128
  44 #define IXGBE_82599_RAR_ENTRIES   128
  45 #define IXGBE_82599_MC_TBL_SIZE   128
  46 #define IXGBE_82599_VFT_TBL_SIZE  128
  47 #define IXGBE_82599_RX_PB_SIZE    512
  48
  49 static s32 ixgbe_setup_copper_link_82599(struct ixgbe_hw *hw,
  50                                          ixgbe_link_speed speed,
  51                                          bool autoneg_wait_to_complete);
  52 static s32 ixgbe_verify_fw_version_82599(struct ixgbe_hw *hw);
  53 static s32 ixgbe_read_eeprom_82599(struct ixgbe_hw *hw,
  54                                    u16 offset, u16 *data);
  55 static s32 ixgbe_read_eeprom_buffer_82599(struct ixgbe_hw *hw, u16 offset,
  56                                           u16 words, u16 *data);
  57 static s32 ixgbe_read_i2c_byte_82599(struct ixgbe_hw *hw, u8 byte_offset,
  58                                         u8 dev_addr, u8 *data);
  59 static s32 ixgbe_write_i2c_byte_82599(struct ixgbe_hw *hw, u8 byte_offset,
  60                                         u8 dev_addr, u8 data);
  61
  62 void ixgbe_init_mac_link_ops_82599(struct ixgbe_hw *hw)
  63 {
  64         struct ixgbe_mac_info *mac = &hw->mac;
  65
  66         DEBUGFUNC("ixgbe_init_mac_link_ops_82599");
  67
  68         /*
  69          * enable the laser control functions for SFP+ fiber
  70          * and MNG not enabled
  71          */
  72         if ((mac->ops.get_media_type(hw) == ixgbe_media_type_fiber) &&
  73             !ixgbe_mng_enabled(hw)) {
  74                 mac->ops.disable_tx_laser =
  75                                        ixgbe_disable_tx_laser_multispeed_fiber;
  76                 mac->ops.enable_tx_laser =
  77                                         ixgbe_enable_tx_laser_multispeed_fiber;
  78                 mac->ops.flap_tx_laser = ixgbe_flap_tx_laser_multispeed_fiber;
  79
  80         } else {
  81                 mac->ops.disable_tx_laser = NULL;
  82                 mac->ops.enable_tx_laser = NULL;
  83                 mac->ops.flap_tx_laser = NULL;
  84         }
  85
  86         if (hw->phy.multispeed_fiber) {
  87                 /* Set up dual speed SFP+ support */
  88                 mac->ops.setup_link = ixgbe_setup_mac_link_multispeed_fiber;
  89                 mac->ops.setup_mac_link = ixgbe_setup_mac_link_82599;
  90                 mac->ops.set_rate_select_speed =
  91                                                ixgbe_set_hard_rate_select_speed;
  92                 if (ixgbe_get_media_type(hw) == ixgbe_media_type_fiber_fixed)
  93                         mac->ops.set_rate_select_speed =
  94                                                ixgbe_set_soft_rate_select_speed;
  95         } else {
  96                 if ((ixgbe_get_media_type(hw) == ixgbe_media_type_backplane) &&
  97                      (hw->phy.smart_speed == ixgbe_smart_speed_auto ||
  98                       hw->phy.smart_speed == ixgbe_smart_speed_on) &&
  99                       !ixgbe_verify_lesm_fw_enabled_82599(hw)) {
 100                         mac->ops.setup_link = ixgbe_setup_mac_link_smartspeed;
 101                 } else {
 102                         mac->ops.setup_link = ixgbe_setup_mac_link_82599;
 103                 }
 104         }
 105 }
 106
 107 /**
 108  *  ixgbe_init_phy_ops_82599 - PHY/SFP specific init
 109  *  @hw: pointer to hardware structure
 110  *
 111  *  Initialize any function pointers that were not able to be
 112  *  set during init_shared_code because the PHY/SFP type was
 113  *  not known.  Perform the SFP init if necessary.
 114  *
 115  **/
 116 s32 ixgbe_init_phy_ops_82599(struct ixgbe_hw *hw)
 117 {
 118         struct ixgbe_mac_info *mac = &hw->mac;
 119         struct ixgbe_phy_info *phy = &hw->phy;
 120         s32 ret_val = IXGBE_SUCCESS;
 121         u32 esdp;
 122
 123         DEBUGFUNC("ixgbe_init_phy_ops_82599");
 124
 125         if (hw->device_id == IXGBE_DEV_ID_82599_QSFP_SF_QP) {
 126                 /* Store flag indicating I2C bus access control unit. */
 127                 hw->phy.qsfp_shared_i2c_bus = TRUE;
 128
 129                 /* Initialize access to QSFP+ I2C bus */
 130                 esdp = IXGBE_READ_REG(hw, IXGBE_ESDP);
 131                 esdp |= IXGBE_ESDP_SDP0_DIR;
 132                 esdp &= ~IXGBE_ESDP_SDP1_DIR;
 133                 esdp &= ~IXGBE_ESDP_SDP0;
 134                 esdp &= ~IXGBE_ESDP_SDP0_NATIVE;
 135                 esdp &= ~IXGBE_ESDP_SDP1_NATIVE;
 136                 IXGBE_WRITE_REG(hw, IXGBE_ESDP, esdp);
 137                 IXGBE_WRITE_FLUSH(hw);
 138
 139                 phy->ops.read_i2c_byte = ixgbe_read_i2c_byte_82599;
 140                 phy->ops.write_i2c_byte = ixgbe_write_i2c_byte_82599;
 141         }
 142         /* Identify the PHY or SFP module */
 143         ret_val = phy->ops.identify(hw);
 144         if (ret_val == IXGBE_ERR_SFP_NOT_SUPPORTED)
 145                 goto init_phy_ops_out;
 146
 147         /* Setup function pointers based on detected SFP module and speeds */
 148         ixgbe_init_mac_link_ops_82599(hw);
 149         if (hw->phy.sfp_type != ixgbe_sfp_type_unknown)
 150                 hw->phy.ops.reset = NULL;
 151
 152         /* If copper media, overwrite with copper function pointers */
 153         if (mac->ops.get_media_type(hw) == ixgbe_media_type_copper) {
 154                 mac->ops.setup_link = ixgbe_setup_copper_link_82599;
 155                 mac->ops.get_link_capabilities =
 156                                   ixgbe_get_copper_link_capabilities_generic;
 157         }
 158
 159         /* Set necessary function pointers based on PHY type */
 160         switch (hw->phy.type) {
 161         case ixgbe_phy_tn:
 162                 phy->ops.setup_link = ixgbe_setup_phy_link_tnx;
 163                 phy->ops.check_link = ixgbe_check_phy_link_tnx;
 164                 phy->ops.get_firmware_version =
 165                              ixgbe_get_phy_firmware_version_tnx;
 166                 break;
 167         default:
 168                 break;
 169         }
 170 init_phy_ops_out:
 171         return ret_val;
 172 }
 173
 174 s32 ixgbe_setup_sfp_modules_82599(struct ixgbe_hw *hw)
 175 {
 176         s32 ret_val = IXGBE_SUCCESS;
 177         u16 list_offset, data_offset, data_value;
 178
 179         DEBUGFUNC("ixgbe_setup_sfp_modules_82599");
 180
 181         if (hw->phy.sfp_type != ixgbe_sfp_type_unknown) {
 182                 ixgbe_init_mac_link_ops_82599(hw);
 183
 184                 hw->phy.ops.reset = NULL;
 185
 186                 ret_val = ixgbe_get_sfp_init_sequence_offsets(hw, &list_offset,
 187                                                               &data_offset);
 188                 if (ret_val != IXGBE_SUCCESS)
 189                         goto setup_sfp_out;
 190
 191                 /* PHY config will finish before releasing the semaphore */
 192                 ret_val = hw->mac.ops.acquire_swfw_sync(hw,
 193                                                         IXGBE_GSSR_MAC_CSR_SM);
 194                 if (ret_val != IXGBE_SUCCESS) {
 195                         ret_val = IXGBE_ERR_SWFW_SYNC;
 196                         goto setup_sfp_out;
 197                 }
 198
 199                 if (hw->eeprom.ops.read(hw, ++data_offset, &data_value))
 200                         goto setup_sfp_err;
 201                 while (data_value != 0xffff) {
 202                         IXGBE_WRITE_REG(hw, IXGBE_CORECTL, data_value);
 203                         IXGBE_WRITE_FLUSH(hw);
 204                         if (hw->eeprom.ops.read(hw, ++data_offset, &data_value))
 205                                 goto setup_sfp_err;
 206                 }
 207
 208                 /* Release the semaphore */
 209                 hw->mac.ops.release_swfw_sync(hw, IXGBE_GSSR_MAC_CSR_SM);
 210                 /* Delay obtaining semaphore again to allow FW access
 211                  * prot_autoc_write uses the semaphore too.
 212                  */
 213                 msec_delay(hw->eeprom.semaphore_delay);
 214
 215                 /* Restart DSP and set SFI mode */
 216                 ret_val = hw->mac.ops.prot_autoc_write(hw,
 217                         hw->mac.orig_autoc | IXGBE_AUTOC_LMS_10G_SERIAL,
 218                         FALSE);
 219
 220                 if (ret_val) {
 221                         DEBUGOUT("sfp module setup not complete\n");
 222                         ret_val = IXGBE_ERR_SFP_SETUP_NOT_COMPLETE;
 223                         goto setup_sfp_out;
 224                 }
 225
 226         }
 227
 228 setup_sfp_out:
 229         return ret_val;
 230
 231 setup_sfp_err:
 232         /* Release the semaphore */
 233         hw->mac.ops.release_swfw_sync(hw, IXGBE_GSSR_MAC_CSR_SM);
 234         /* Delay obtaining semaphore again to allow FW access */
 235         msec_delay(hw->eeprom.semaphore_delay);
 236         ERROR_REPORT2(IXGBE_ERROR_INVALID_STATE,
 237                       "eeprom read at offset %d failed", data_offset);
 238         return IXGBE_ERR_PHY;
 239 }
 240
 241 /**
 242  *  prot_autoc_read_82599 - Hides MAC differences needed for AUTOC read
 243  *  @hw: pointer to hardware structure
 244  *  @locked: Return the if we locked for this read.
 245  *  @reg_val: Value we read from AUTOC
 246  *
 247  *  For this part (82599) we need to wrap read-modify-writes with a possible
 248  *  FW/SW lock.  It is assumed this lock will be freed with the next
 249  *  prot_autoc_write_82599().
 250  */
 251 s32 prot_autoc_read_82599(struct ixgbe_hw *hw, bool *locked, u32 *reg_val)
 252 {
 253         s32 ret_val;
 254
 255         *locked = FALSE;
 256          /* If LESM is on then we need to hold the SW/FW semaphore. */
 257         if (ixgbe_verify_lesm_fw_enabled_82599(hw)) {
 258                 ret_val = hw->mac.ops.acquire_swfw_sync(hw,
 259                                         IXGBE_GSSR_MAC_CSR_SM);
 260                 if (ret_val != IXGBE_SUCCESS)
 261                         return IXGBE_ERR_SWFW_SYNC;
 262
 263                 *locked = TRUE;
 264         }
 265
 266         *reg_val = IXGBE_READ_REG(hw, IXGBE_AUTOC);
 267         return IXGBE_SUCCESS;
 268 }
 269
 270 /**
 271  * prot_autoc_write_82599 - Hides MAC differences needed for AUTOC write
 272  * @hw: pointer to hardware structure
 273  * @autoc: value to write to AUTOC
 274  * @locked: bool to indicate whether the SW/FW lock was already taken by
 275  *           previous proc_autoc_read_82599.
 276  *
 277  * This part (82599) may need to hold the SW/FW lock around all writes to
 278  * AUTOC. Likewise after a write we need to do a pipeline reset.
 279  */
 280 s32 prot_autoc_write_82599(struct ixgbe_hw *hw, u32 autoc, bool locked)
 281 {
 282         s32 ret_val = IXGBE_SUCCESS;
 283
 284         /* Blocked by MNG FW so bail */
 285         if (ixgbe_check_reset_blocked(hw))
 286                 goto out;
 287
 288         /* We only need to get the lock if:
 289          *  - We didn't do it already (in the read part of a read-modify-write)
 290          *  - LESM is enabled.
 291          */
 292         if (!locked && ixgbe_verify_lesm_fw_enabled_82599(hw)) {
 293                 ret_val = hw->mac.ops.acquire_swfw_sync(hw,
 294                                         IXGBE_GSSR_MAC_CSR_SM);
 295                 if (ret_val != IXGBE_SUCCESS)
 296                         return IXGBE_ERR_SWFW_SYNC;
 297
 298                 locked = TRUE;
 299         }
 300
 301         IXGBE_WRITE_REG(hw, IXGBE_AUTOC, autoc);
 302         ret_val = ixgbe_reset_pipeline_82599(hw);
 303
 304 out:
 305         /* Free the SW/FW semaphore as we either grabbed it here or
 306          * already had it when this function was called.
 307          */
 308         if (locked)
 309                 hw->mac.ops.release_swfw_sync(hw, IXGBE_GSSR_MAC_CSR_SM);
 310
 311         return ret_val;
 312 }
 313
 314 /**
 315  *  ixgbe_init_ops_82599 - Inits func ptrs and MAC type
 316  *  @hw: pointer to hardware structure
 317  *
 318  *  Initialize the function pointers and assign the MAC type for 82599.
 319  *  Does not touch the hardware.
 320  **/
 321
 322 s32 ixgbe_init_ops_82599(struct ixgbe_hw *hw)
 323 {
 324         struct ixgbe_mac_info *mac = &hw->mac;
 325         struct ixgbe_phy_info *phy = &hw->phy;
 326         struct ixgbe_eeprom_info *eeprom = &hw->eeprom;
 327         s32 ret_val;
 328
 329         DEBUGFUNC("ixgbe_init_ops_82599");
 330
 331         ixgbe_init_phy_ops_generic(hw);
 332         ret_val = ixgbe_init_ops_generic(hw);
 333
 334         /* PHY */
 335         phy->ops.identify = ixgbe_identify_phy_82599;
 336         phy->ops.init = ixgbe_init_phy_ops_82599;
 337
 338         /* MAC */
 339         mac->ops.reset_hw = ixgbe_reset_hw_82599;
 340         mac->ops.enable_relaxed_ordering = ixgbe_enable_relaxed_ordering_gen2;
 341         mac->ops.get_media_type = ixgbe_get_media_type_82599;
 342         mac->ops.get_supported_physical_layer =
 343                                     ixgbe_get_supported_physical_layer_82599;
 344         mac->ops.disable_sec_rx_path = ixgbe_disable_sec_rx_path_generic;
 345         mac->ops.enable_sec_rx_path = ixgbe_enable_sec_rx_path_generic;
 346         mac->ops.enable_rx_dma = ixgbe_enable_rx_dma_82599;
 347         mac->ops.read_analog_reg8 = ixgbe_read_analog_reg8_82599;
 348         mac->ops.write_analog_reg8 = ixgbe_write_analog_reg8_82599;
 349         mac->ops.start_hw = ixgbe_start_hw_82599;
 350         mac->ops.get_san_mac_addr = ixgbe_get_san_mac_addr_generic;
 351         mac->ops.set_san_mac_addr = ixgbe_set_san_mac_addr_generic;
 352         mac->ops.get_device_caps = ixgbe_get_device_caps_generic;
 353         mac->ops.get_wwn_prefix = ixgbe_get_wwn_prefix_generic;
 354         mac->ops.get_fcoe_boot_status = ixgbe_get_fcoe_boot_status_generic;
 355         mac->ops.prot_autoc_read = prot_autoc_read_82599;
 356         mac->ops.prot_autoc_write = prot_autoc_write_82599;
 357
 358         /* RAR, Multicast, VLAN */
 359         mac->ops.set_vmdq = ixgbe_set_vmdq_generic;
 360         mac->ops.set_vmdq_san_mac = ixgbe_set_vmdq_san_mac_generic;
 361         mac->ops.clear_vmdq = ixgbe_clear_vmdq_generic;
 362         mac->ops.insert_mac_addr = ixgbe_insert_mac_addr_generic;
 363         mac->rar_highwater = 1;
 364         mac->ops.set_vfta = ixgbe_set_vfta_generic;
 365         mac->ops.set_vlvf = ixgbe_set_vlvf_generic;
 366         mac->ops.clear_vfta = ixgbe_clear_vfta_generic;
 367         mac->ops.init_uta_tables = ixgbe_init_uta_tables_generic;
 368         mac->ops.setup_sfp = ixgbe_setup_sfp_modules_82599;
 369         mac->ops.set_mac_anti_spoofing = ixgbe_set_mac_anti_spoofing;
 370         mac->ops.set_vlan_anti_spoofing = ixgbe_set_vlan_anti_spoofing;
 371
 372         /* Link */
 373         mac->ops.get_link_capabilities = ixgbe_get_link_capabilities_82599;
 374         mac->ops.check_link = ixgbe_check_mac_link_generic;
 375         mac->ops.setup_rxpba = ixgbe_set_rxpba_generic;
 376         ixgbe_init_mac_link_ops_82599(hw);
 377
 378         mac->mcft_size          = IXGBE_82599_MC_TBL_SIZE;
 379         mac->vft_size           = IXGBE_82599_VFT_TBL_SIZE;
 380         mac->num_rar_entries    = IXGBE_82599_RAR_ENTRIES;
 381         mac->rx_pb_size         = IXGBE_82599_RX_PB_SIZE;
 382         mac->max_rx_queues      = IXGBE_82599_MAX_RX_QUEUES;
 383         mac->max_tx_queues      = IXGBE_82599_MAX_TX_QUEUES;
 384         mac->max_msix_vectors   = ixgbe_get_pcie_msix_count_generic(hw);
 385
 386         mac->arc_subsystem_valid = !!(IXGBE_READ_REG(hw, IXGBE_FWSM_BY_MAC(hw))
 387                                       & IXGBE_FWSM_MODE_MASK);
 388
 389         hw->mbx.ops.init_params = ixgbe_init_mbx_params_pf;
 390
 391         /* EEPROM */
 392         eeprom->ops.read = ixgbe_read_eeprom_82599;
 393         eeprom->ops.read_buffer = ixgbe_read_eeprom_buffer_82599;
 394
 395         /* Manageability interface */
 396         mac->ops.set_fw_drv_ver = ixgbe_set_fw_drv_ver_generic;
 397
 398         mac->ops.bypass_rw = ixgbe_bypass_rw_generic;
 399         mac->ops.bypass_valid_rd = ixgbe_bypass_valid_rd_generic;
 400         mac->ops.bypass_set = ixgbe_bypass_set_generic;
 401         mac->ops.bypass_rd_eep = ixgbe_bypass_rd_eep_generic;
 402
 403         mac->ops.get_rtrup2tc = ixgbe_dcb_get_rtrup2tc_generic;
 404
 405         return ret_val;
 406 }
 407
 408 /**
 409  *  ixgbe_get_link_capabilities_82599 - Determines link capabilities
 410  *  @hw: pointer to hardware structure
 411  *  @speed: pointer to link speed
 412  *  @autoneg: TRUE when autoneg or autotry is enabled
 413  *
 414  *  Determines the link capabilities by reading the AUTOC register.
 415  **/
 416 s32 ixgbe_get_link_capabilities_82599(struct ixgbe_hw *hw,
 417                                       ixgbe_link_speed *speed,
 418                                       bool *autoneg)
 419 {
 420         s32 status = IXGBE_SUCCESS;
 421         u32 autoc = 0;
 422
 423         DEBUGFUNC("ixgbe_get_link_capabilities_82599");
 424
 425
 426         /* Check if 1G SFP module. */
 427         if (hw->phy.sfp_type == ixgbe_sfp_type_1g_cu_core0 ||
 428             hw->phy.sfp_type == ixgbe_sfp_type_1g_cu_core1 ||
 429             hw->phy.sfp_type == ixgbe_sfp_type_1g_lx_core0 ||
 430             hw->phy.sfp_type == ixgbe_sfp_type_1g_lx_core1 ||
 431             hw->phy.sfp_type == ixgbe_sfp_type_1g_sx_core0 ||
 432             hw->phy.sfp_type == ixgbe_sfp_type_1g_sx_core1) {
 433                 *speed = IXGBE_LINK_SPEED_1GB_FULL;
 434                 *autoneg = TRUE;
 435                 goto out;
 436         }
 437
 438         /*
 439          * Determine link capabilities based on the stored value of AUTOC,
 440          * which represents EEPROM defaults.  If AUTOC value has not
 441          * been stored, use the current register values.
 442          */
 443         if (hw->mac.orig_link_settings_stored)
 444                 autoc = hw->mac.orig_autoc;
 445         else
 446                 autoc = IXGBE_READ_REG(hw, IXGBE_AUTOC);
 447
 448         switch (autoc & IXGBE_AUTOC_LMS_MASK) {
 449         case IXGBE_AUTOC_LMS_1G_LINK_NO_AN:
 450                 *speed = IXGBE_LINK_SPEED_1GB_FULL;
 451                 *autoneg = FALSE;
 452                 break;
 453
 454         case IXGBE_AUTOC_LMS_10G_LINK_NO_AN:
 455                 *speed = IXGBE_LINK_SPEED_10GB_FULL;
 456                 *autoneg = FALSE;
 457                 break;
 458
 459         case IXGBE_AUTOC_LMS_1G_AN:
 460                 *speed = IXGBE_LINK_SPEED_1GB_FULL;
 461                 *autoneg = TRUE;
 462                 break;
 463
 464         case IXGBE_AUTOC_LMS_10G_SERIAL:
 465                 *speed = IXGBE_LINK_SPEED_10GB_FULL;
 466                 *autoneg = FALSE;
 467                 break;
 468
 469         case IXGBE_AUTOC_LMS_KX4_KX_KR:
 470         case IXGBE_AUTOC_LMS_KX4_KX_KR_1G_AN:
 471                 *speed = IXGBE_LINK_SPEED_UNKNOWN;
 472                 if (autoc & IXGBE_AUTOC_KR_SUPP)
 473                         *speed |= IXGBE_LINK_SPEED_10GB_FULL;
 474                 if (autoc & IXGBE_AUTOC_KX4_SUPP)
 475                         *speed |= IXGBE_LINK_SPEED_10GB_FULL;
 476                 if (autoc & IXGBE_AUTOC_KX_SUPP)
 477                         *speed |= IXGBE_LINK_SPEED_1GB_FULL;
 478                 *autoneg = TRUE;
 479                 break;
 480
 481         case IXGBE_AUTOC_LMS_KX4_KX_KR_SGMII:
 482                 *speed = IXGBE_LINK_SPEED_100_FULL;
 483                 if (autoc & IXGBE_AUTOC_KR_SUPP)
 484                         *speed |= IXGBE_LINK_SPEED_10GB_FULL;
 485                 if (autoc & IXGBE_AUTOC_KX4_SUPP)
 486                         *speed |= IXGBE_LINK_SPEED_10GB_FULL;
 487                 if (autoc & IXGBE_AUTOC_KX_SUPP)
 488                         *speed |= IXGBE_LINK_SPEED_1GB_FULL;
 489                 *autoneg = TRUE;
 490                 break;
 491
 492         case IXGBE_AUTOC_LMS_SGMII_1G_100M:
 493                 *speed = IXGBE_LINK_SPEED_1GB_FULL | IXGBE_LINK_SPEED_100_FULL;
 494                 *autoneg = FALSE;
 495                 break;
 496
 497         default:
 498                 status = IXGBE_ERR_LINK_SETUP;
 499                 goto out;
 500                 break;
 501         }
 502
 503         if (hw->phy.multispeed_fiber) {
 504                 *speed |= IXGBE_LINK_SPEED_10GB_FULL |
 505                           IXGBE_LINK_SPEED_1GB_FULL;
 506
 507                 /* QSFP must not enable full auto-negotiation
 508                  * Limited autoneg is enabled at 1G
 509                  */
 510                 if (hw->phy.media_type == ixgbe_media_type_fiber_qsfp)
 511                         *autoneg = FALSE;
 512                 else
 513                         *autoneg = TRUE;
 514         }
 515
 516 out:
 517         return status;
 518 }
 519
 520 /**
 521  *  ixgbe_get_media_type_82599 - Get media type
 522  *  @hw: pointer to hardware structure
 523  *
 524  *  Returns the media type (fiber, copper, backplane)
 525  **/
 526 enum ixgbe_media_type ixgbe_get_media_type_82599(struct ixgbe_hw *hw)
 527 {
 528         enum ixgbe_media_type media_type;
 529
 530         DEBUGFUNC("ixgbe_get_media_type_82599");
 531
 532         /* Detect if there is a copper PHY attached. */
 533         switch (hw->phy.type) {
 534         case ixgbe_phy_cu_unknown:
 535         case ixgbe_phy_tn:
 536                 media_type = ixgbe_media_type_copper;
 537                 goto out;
 538         default:
 539                 break;
 540         }
 541
 542         switch (hw->device_id) {
 543         case IXGBE_DEV_ID_82599_KX4:
 544         case IXGBE_DEV_ID_82599_KX4_MEZZ:
 545         case IXGBE_DEV_ID_82599_COMBO_BACKPLANE:
 546         case IXGBE_DEV_ID_82599_KR:
 547         case IXGBE_DEV_ID_82599_BACKPLANE_FCOE:
 548         case IXGBE_DEV_ID_82599_XAUI_LOM:
 549                 /* Default device ID is mezzanine card KX/KX4 */
 550                 media_type = ixgbe_media_type_backplane;
 551                 break;
 552         case IXGBE_DEV_ID_82599_SFP:
 553         case IXGBE_DEV_ID_82599_SFP_FCOE:
 554         case IXGBE_DEV_ID_82599_SFP_EM:
 555         case IXGBE_DEV_ID_82599_SFP_SF2:
 556         case IXGBE_DEV_ID_82599_SFP_SF_QP:
 557         case IXGBE_DEV_ID_82599EN_SFP:
 558                 media_type = ixgbe_media_type_fiber;
 559                 break;
 560         case IXGBE_DEV_ID_82599_CX4:
 561                 media_type = ixgbe_media_type_cx4;
 562                 break;
 563         case IXGBE_DEV_ID_82599_T3_LOM:
 564                 media_type = ixgbe_media_type_copper;
 565                 break;
 566         case IXGBE_DEV_ID_82599_QSFP_SF_QP:
 567                 media_type = ixgbe_media_type_fiber_qsfp;
 568                 break;
 569         case IXGBE_DEV_ID_82599_BYPASS:
 570                 media_type = ixgbe_media_type_fiber_fixed;
 571                 hw->phy.multispeed_fiber = TRUE;
 572                 break;
 573         default:
 574                 media_type = ixgbe_media_type_unknown;
 575                 break;
 576         }
 577 out:
 578         return media_type;
 579 }
 580
 581 /**
 582  *  ixgbe_stop_mac_link_on_d3_82599 - Disables link on D3
 583  *  @hw: pointer to hardware structure
 584  *
 585  *  Disables link during D3 power down sequence.
 586  *
 587  **/
 588 void ixgbe_stop_mac_link_on_d3_82599(struct ixgbe_hw *hw)
 589 {
 590         u32 autoc2_reg;
 591         u16 ee_ctrl_2 = 0;
 592
 593         DEBUGFUNC("ixgbe_stop_mac_link_on_d3_82599");
 594         ixgbe_read_eeprom(hw, IXGBE_EEPROM_CTRL_2, &ee_ctrl_2);
 595
 596         if (!ixgbe_mng_present(hw) && !hw->wol_enabled &&
 597             ee_ctrl_2 & IXGBE_EEPROM_CCD_BIT) {
 598                 autoc2_reg = IXGBE_READ_REG(hw, IXGBE_AUTOC2);
 599                 autoc2_reg |= IXGBE_AUTOC2_LINK_DISABLE_ON_D3_MASK;
 600                 IXGBE_WRITE_REG(hw, IXGBE_AUTOC2, autoc2_reg);
 601         }
 602 }
 603
 604 /**
 605  *  ixgbe_start_mac_link_82599 - Setup MAC link settings
 606  *  @hw: pointer to hardware structure
 607  *  @autoneg_wait_to_complete: TRUE when waiting for completion is needed
 608  *
 609  *  Configures link settings based on values in the ixgbe_hw struct.
 610  *  Restarts the link.  Performs autonegotiation if needed.
 611  **/
 612 s32 ixgbe_start_mac_link_82599(struct ixgbe_hw *hw,
 613                                bool autoneg_wait_to_complete)
 614 {
 615         u32 autoc_reg;
 616         u32 links_reg;
 617         u32 i;
 618         s32 status = IXGBE_SUCCESS;
 619         bool got_lock = FALSE;
 620
 621         DEBUGFUNC("ixgbe_start_mac_link_82599");
 622
 623
 624         /*  reset_pipeline requires us to hold this lock as it writes to
 625          *  AUTOC.
 626          */
 627         if (ixgbe_verify_lesm_fw_enabled_82599(hw)) {
 628                 status = hw->mac.ops.acquire_swfw_sync(hw,
 629                                                        IXGBE_GSSR_MAC_CSR_SM);
 630                 if (status != IXGBE_SUCCESS)
 631                         goto out;
 632
 633                 got_lock = TRUE;
 634         }
 635
 636         /* Restart link */
 637         ixgbe_reset_pipeline_82599(hw);
 638
 639         if (got_lock)
 640                 hw->mac.ops.release_swfw_sync(hw, IXGBE_GSSR_MAC_CSR_SM);
 641
 642         /* Only poll for autoneg to complete if specified to do so */
 643         if (autoneg_wait_to_complete) {
 644                 autoc_reg = IXGBE_READ_REG(hw, IXGBE_AUTOC);
 645                 if ((autoc_reg & IXGBE_AUTOC_LMS_MASK) ==
 646                      IXGBE_AUTOC_LMS_KX4_KX_KR ||
 647                     (autoc_reg & IXGBE_AUTOC_LMS_MASK) ==
 648                      IXGBE_AUTOC_LMS_KX4_KX_KR_1G_AN ||
 649                     (autoc_reg & IXGBE_AUTOC_LMS_MASK) ==
 650                      IXGBE_AUTOC_LMS_KX4_KX_KR_SGMII) {
 651                         links_reg = 0; /* Just in case Autoneg time = 0 */
 652                         for (i = 0; i < IXGBE_AUTO_NEG_TIME; i++) {
 653                                 links_reg = IXGBE_READ_REG(hw, IXGBE_LINKS);
 654                                 if (links_reg & IXGBE_LINKS_KX_AN_COMP)
 655                                         break;
 656                                 msec_delay(100);
 657                         }
 658                         if (!(links_reg & IXGBE_LINKS_KX_AN_COMP)) {
 659                                 status = IXGBE_ERR_AUTONEG_NOT_COMPLETE;
 660                                 DEBUGOUT("Autoneg did not complete.\n");
 661                         }
 662                 }
 663         }
 664
 665         /* Add delay to filter out noises during initial link setup */
 666         msec_delay(50);
 667
 668 out:
 669         return status;
 670 }
 671
 672 /**
 673  *  ixgbe_disable_tx_laser_multispeed_fiber - Disable Tx laser
 674  *  @hw: pointer to hardware structure
 675  *
 676  *  The base drivers may require better control over SFP+ module
 677  *  PHY states.  This includes selectively shutting down the Tx
 678  *  laser on the PHY, effectively halting physical link.
 679  **/
 680 void ixgbe_disable_tx_laser_multispeed_fiber(struct ixgbe_hw *hw)
 681 {
 682         u32 esdp_reg = IXGBE_READ_REG(hw, IXGBE_ESDP);
 683
 684         /* Blocked by MNG FW so bail */
 685         if (ixgbe_check_reset_blocked(hw))
 686                 return;
 687
 688         /* Disable Tx laser; allow 100us to go dark per spec */
 689         esdp_reg |= IXGBE_ESDP_SDP3;
 690         IXGBE_WRITE_REG(hw, IXGBE_ESDP, esdp_reg);
 691         IXGBE_WRITE_FLUSH(hw);
 692         usec_delay(100);
 693 }
 694
 695 /**
 696  *  ixgbe_enable_tx_laser_multispeed_fiber - Enable Tx laser
 697  *  @hw: pointer to hardware structure
 698  *
 699  *  The base drivers may require better control over SFP+ module
 700  *  PHY states.  This includes selectively turning on the Tx
 701  *  laser on the PHY, effectively starting physical link.
 702  **/
 703 void ixgbe_enable_tx_laser_multispeed_fiber(struct ixgbe_hw *hw)
 704 {
 705         u32 esdp_reg = IXGBE_READ_REG(hw, IXGBE_ESDP);
 706
 707         /* Enable Tx laser; allow 100ms to light up */
 708         esdp_reg &= ~IXGBE_ESDP_SDP3;
 709         IXGBE_WRITE_REG(hw, IXGBE_ESDP, esdp_reg);
 710         IXGBE_WRITE_FLUSH(hw);
 711         msec_delay(100);
 712 }
 713
 714 /**
 715  *  ixgbe_flap_tx_laser_multispeed_fiber - Flap Tx laser
 716  *  @hw: pointer to hardware structure
 717  *
 718  *  When the driver changes the link speeds that it can support,
 719  *  it sets autotry_restart to TRUE to indicate that we need to
 720  *  initiate a new autotry session with the link partner.  To do
 721  *  so, we set the speed then disable and re-enable the Tx laser, to
 722  *  alert the link partner that it also needs to restart autotry on its
 723  *  end.  This is consistent with TRUE clause 37 autoneg, which also
 724  *  involves a loss of signal.
 725  **/
 726 void ixgbe_flap_tx_laser_multispeed_fiber(struct ixgbe_hw *hw)
 727 {
 728         DEBUGFUNC("ixgbe_flap_tx_laser_multispeed_fiber");
 729
 730         /* Blocked by MNG FW so bail */
 731         if (ixgbe_check_reset_blocked(hw))
 732                 return;
 733
 734         if (hw->mac.autotry_restart) {
 735                 ixgbe_disable_tx_laser_multispeed_fiber(hw);
 736                 ixgbe_enable_tx_laser_multispeed_fiber(hw);
 737                 hw->mac.autotry_restart = FALSE;
 738         }
 739 }
 740
 741 /**
 742  *  ixgbe_set_hard_rate_select_speed - Set module link speed
 743  *  @hw: pointer to hardware structure
 744  *  @speed: link speed to set
 745  *
 746  *  Set module link speed via RS0/RS1 rate select pins.
 747  */
 748 void ixgbe_set_hard_rate_select_speed(struct ixgbe_hw *hw,
 749                                         ixgbe_link_speed speed)
 750 {
 751         u32 esdp_reg = IXGBE_READ_REG(hw, IXGBE_ESDP);
 752
 753         switch (speed) {
 754         case IXGBE_LINK_SPEED_10GB_FULL:
 755                 esdp_reg |= (IXGBE_ESDP_SDP5_DIR | IXGBE_ESDP_SDP5);
 756                 break;
 757         case IXGBE_LINK_SPEED_1GB_FULL:
 758                 esdp_reg &= ~IXGBE_ESDP_SDP5;
 759                 esdp_reg |= IXGBE_ESDP_SDP5_DIR;
 760                 break;
 761         default:
 762                 DEBUGOUT("Invalid fixed module speed\n");
 763                 return;
 764         }
 765
 766         IXGBE_WRITE_REG(hw, IXGBE_ESDP, esdp_reg);
 767         IXGBE_WRITE_FLUSH(hw);
 768 }
 769
 770 /**
 771  *  ixgbe_setup_mac_link_smartspeed - Set MAC link speed using SmartSpeed
 772  *  @hw: pointer to hardware structure
 773  *  @speed: new link speed
 774  *  @autoneg_wait_to_complete: TRUE when waiting for completion is needed
 775  *
 776  *  Implements the Intel SmartSpeed algorithm.
 777  **/
 778 s32 ixgbe_setup_mac_link_smartspeed(struct ixgbe_hw *hw,
 779                                     ixgbe_link_speed speed,
 780                                     bool autoneg_wait_to_complete)
 781 {
 782         s32 status = IXGBE_SUCCESS;
 783         ixgbe_link_speed link_speed = IXGBE_LINK_SPEED_UNKNOWN;
 784         s32 i, j;
 785         bool link_up = FALSE;
 786         u32 autoc_reg = IXGBE_READ_REG(hw, IXGBE_AUTOC);
 787
 788         DEBUGFUNC("ixgbe_setup_mac_link_smartspeed");
 789
 790          /* Set autoneg_advertised value based on input link speed */
 791         hw->phy.autoneg_advertised = 0;
 792
 793         if (speed & IXGBE_LINK_SPEED_10GB_FULL)
 794                 hw->phy.autoneg_advertised |= IXGBE_LINK_SPEED_10GB_FULL;
 795
 796         if (speed & IXGBE_LINK_SPEED_1GB_FULL)
 797                 hw->phy.autoneg_advertised |= IXGBE_LINK_SPEED_1GB_FULL;
 798
 799         if (speed & IXGBE_LINK_SPEED_100_FULL)
 800                 hw->phy.autoneg_advertised |= IXGBE_LINK_SPEED_100_FULL;
 801
 802         /*
 803          * Implement Intel SmartSpeed algorithm.  SmartSpeed will reduce the
 804          * autoneg advertisement if link is unable to be established at the
 805          * highest negotiated rate.  This can sometimes happen due to integrity
 806          * issues with the physical media connection.
 807          */
 808
 809         /* First, try to get link with full advertisement */
 810         hw->phy.smart_speed_active = FALSE;
 811         for (j = 0; j < IXGBE_SMARTSPEED_MAX_RETRIES; j++) {
 812                 status = ixgbe_setup_mac_link_82599(hw, speed,
 813                                                     autoneg_wait_to_complete);
 814                 if (status != IXGBE_SUCCESS)
 815                         goto out;
 816
 817                 /*
 818                  * Wait for the controller to acquire link.  Per IEEE 802.3ap,
 819                  * Section 73.10.2, we may have to wait up to 500ms if KR is
 820                  * attempted, or 200ms if KX/KX4/BX/BX4 is attempted, per
 821                  * Table 9 in the AN MAS.
 822                  */
 823                 for (i = 0; i < 5; i++) {
 824                         msec_delay(100);
 825
 826                         /* If we have link, just jump out */
 827                         status = ixgbe_check_link(hw, &link_speed, &link_up,
 828                                                   FALSE);
 829                         if (status != IXGBE_SUCCESS)
 830                                 goto out;
 831
 832                         if (link_up)
 833                                 goto out;
 834                 }
 835         }
 836
 837         /*
 838          * We didn't get link.  If we advertised KR plus one of KX4/KX
 839          * (or BX4/BX), then disable KR and try again.
 840          */
 841         if (((autoc_reg & IXGBE_AUTOC_KR_SUPP) == 0) ||
 842             ((autoc_reg & IXGBE_AUTOC_KX4_KX_SUPP_MASK) == 0))
 843                 goto out;
 844
 845         /* Turn SmartSpeed on to disable KR support */
 846         hw->phy.smart_speed_active = TRUE;
 847         status = ixgbe_setup_mac_link_82599(hw, speed,
 848                                             autoneg_wait_to_complete);
 849         if (status != IXGBE_SUCCESS)
 850                 goto out;
 851
 852         /*
 853          * Wait for the controller to acquire link.  600ms will allow for
 854          * the AN link_fail_inhibit_timer as well for multiple cycles of
 855          * parallel detect, both 10g and 1g. This allows for the maximum
 856          * connect attempts as defined in the AN MAS table 73-7.
 857          */
 858         for (i = 0; i < 6; i++) {
 859                 msec_delay(100);
 860
 861                 /* If we have link, just jump out */
 862                 status = ixgbe_check_link(hw, &link_speed, &link_up, FALSE);
 863                 if (status != IXGBE_SUCCESS)
 864                         goto out;
 865
 866                 if (link_up)
 867                         goto out;
 868         }
 869
 870         /* We didn't get link.  Turn SmartSpeed back off. */
 871         hw->phy.smart_speed_active = FALSE;
 872         status = ixgbe_setup_mac_link_82599(hw, speed,
 873                                             autoneg_wait_to_complete);
 874
 875 out:
 876         if (link_up && (link_speed == IXGBE_LINK_SPEED_1GB_FULL))
 877                 DEBUGOUT("Smartspeed has downgraded the link speed "
 878                 "from the maximum advertised\n");
 879         return status;
 880 }
 881
 882 /**
 883  *  ixgbe_setup_mac_link_82599 - Set MAC link speed
 884  *  @hw: pointer to hardware structure
 885  *  @speed: new link speed
 886  *  @autoneg_wait_to_complete: TRUE when waiting for completion is needed
 887  *
 888  *  Set the link speed in the AUTOC register and restarts link.
 889  **/
 890 s32 ixgbe_setup_mac_link_82599(struct ixgbe_hw *hw,
 891                                ixgbe_link_speed speed,
 892                                bool autoneg_wait_to_complete)
 893 {
 894         bool autoneg = FALSE;
 895         s32 status = IXGBE_SUCCESS;
 896         u32 pma_pmd_1g, link_mode;
 897         u32 current_autoc = IXGBE_READ_REG(hw, IXGBE_AUTOC); /* holds the value of AUTOC register at this current point in time */
 898         u32 orig_autoc = 0; /* holds the cached value of AUTOC register */
 899         u32 autoc = current_autoc; /* Temporary variable used for comparison purposes */
 900         u32 autoc2 = IXGBE_READ_REG(hw, IXGBE_AUTOC2);
 901         u32 pma_pmd_10g_serial = autoc2 & IXGBE_AUTOC2_10G_SERIAL_PMA_PMD_MASK;
 902         u32 links_reg;
 903         u32 i;
 904         ixgbe_link_speed link_capabilities = IXGBE_LINK_SPEED_UNKNOWN;
 905
 906         DEBUGFUNC("ixgbe_setup_mac_link_82599");
 907
 908         /* Check to see if speed passed in is supported. */
 909         status = ixgbe_get_link_capabilities(hw, &link_capabilities, &autoneg);
 910         if (status)
 911                 goto out;
 912
 913         speed &= link_capabilities;
 914
 915         if (speed == IXGBE_LINK_SPEED_UNKNOWN) {
 916                 status = IXGBE_ERR_LINK_SETUP;
 917                 goto out;
 918         }
 919
 920         /* Use stored value (EEPROM defaults) of AUTOC to find KR/KX4 support*/
 921         if (hw->mac.orig_link_settings_stored)
 922                 orig_autoc = hw->mac.orig_autoc;
 923         else
 924                 orig_autoc = autoc;
 925
 926         link_mode = autoc & IXGBE_AUTOC_LMS_MASK;
 927         pma_pmd_1g = autoc & IXGBE_AUTOC_1G_PMA_PMD_MASK;
 928
 929         if (link_mode == IXGBE_AUTOC_LMS_KX4_KX_KR ||
 930             link_mode == IXGBE_AUTOC_LMS_KX4_KX_KR_1G_AN ||
 931             link_mode == IXGBE_AUTOC_LMS_KX4_KX_KR_SGMII) {
 932                 /* Set KX4/KX/KR support according to speed requested */
 933                 autoc &= ~(IXGBE_AUTOC_KX4_KX_SUPP_MASK | IXGBE_AUTOC_KR_SUPP);
 934                 if (speed & IXGBE_LINK_SPEED_10GB_FULL) {
 935                         if (orig_autoc & IXGBE_AUTOC_KX4_SUPP)
 936                                 autoc |= IXGBE_AUTOC_KX4_SUPP;
 937                         if ((orig_autoc & IXGBE_AUTOC_KR_SUPP) &&
 938                             (hw->phy.smart_speed_active == FALSE))
 939                                 autoc |= IXGBE_AUTOC_KR_SUPP;
 940                 }
 941                 if (speed & IXGBE_LINK_SPEED_1GB_FULL)
 942                         autoc |= IXGBE_AUTOC_KX_SUPP;
 943         } else if ((pma_pmd_1g == IXGBE_AUTOC_1G_SFI) &&
 944                    (link_mode == IXGBE_AUTOC_LMS_1G_LINK_NO_AN ||
 945                     link_mode == IXGBE_AUTOC_LMS_1G_AN)) {
 946                 /* Switch from 1G SFI to 10G SFI if requested */
 947                 if ((speed == IXGBE_LINK_SPEED_10GB_FULL) &&
 948                     (pma_pmd_10g_serial == IXGBE_AUTOC2_10G_SFI)) {
 949                         autoc &= ~IXGBE_AUTOC_LMS_MASK;
 950                         autoc |= IXGBE_AUTOC_LMS_10G_SERIAL;
 951                 }
 952         } else if ((pma_pmd_10g_serial == IXGBE_AUTOC2_10G_SFI) &&
 953                    (link_mode == IXGBE_AUTOC_LMS_10G_SERIAL)) {
 954                 /* Switch from 10G SFI to 1G SFI if requested */
 955                 if ((speed == IXGBE_LINK_SPEED_1GB_FULL) &&
 956                     (pma_pmd_1g == IXGBE_AUTOC_1G_SFI)) {
 957                         autoc &= ~IXGBE_AUTOC_LMS_MASK;
 958                         if (autoneg || hw->phy.type == ixgbe_phy_qsfp_intel)
 959                                 autoc |= IXGBE_AUTOC_LMS_1G_AN;
 960                         else
 961                                 autoc |= IXGBE_AUTOC_LMS_1G_LINK_NO_AN;
 962                 }
 963         }
 964
 965         if (autoc != current_autoc) {
 966                 /* Restart link */
 967                 status = hw->mac.ops.prot_autoc_write(hw, autoc, FALSE);
 968                 if (status != IXGBE_SUCCESS)
 969                         goto out;
 970
 971                 /* Only poll for autoneg to complete if specified to do so */
 972                 if (autoneg_wait_to_complete) {
 973                         if (link_mode == IXGBE_AUTOC_LMS_KX4_KX_KR ||
 974                             link_mode == IXGBE_AUTOC_LMS_KX4_KX_KR_1G_AN ||
 975                             link_mode == IXGBE_AUTOC_LMS_KX4_KX_KR_SGMII) {
 976                                 links_reg = 0; /*Just in case Autoneg time=0*/
 977                                 for (i = 0; i < IXGBE_AUTO_NEG_TIME; i++) {
 978                                         links_reg =
 979                                                IXGBE_READ_REG(hw, IXGBE_LINKS);
 980                                         if (links_reg & IXGBE_LINKS_KX_AN_COMP)
 981                                                 break;
 982                                         msec_delay(100);
 983                                 }
 984                                 if (!(links_reg & IXGBE_LINKS_KX_AN_COMP)) {
 985                                         status =
 986                                                 IXGBE_ERR_AUTONEG_NOT_COMPLETE;
 987                                         DEBUGOUT("Autoneg did not complete.\n");
 988                                 }
 989                         }
 990                 }
 991
 992                 /* Add delay to filter out noises during initial link setup */
 993                 msec_delay(50);
 994         }
 995
 996 out:
 997         return status;
 998 }
 999
1000 /**
1001  *  ixgbe_setup_copper_link_82599 - Set the PHY autoneg advertised field
1002  *  @hw: pointer to hardware structure
1003  *  @speed: new link speed
1004  *  @autoneg_wait_to_complete: TRUE if waiting is needed to complete
1005  *
1006  *  Restarts link on PHY and MAC based on settings passed in.
1007  **/
1008 static s32 ixgbe_setup_copper_link_82599(struct ixgbe_hw *hw,
1009                                          ixgbe_link_speed speed,
1010                                          bool autoneg_wait_to_complete)
1011 {
1012         s32 status;
1013
1014         DEBUGFUNC("ixgbe_setup_copper_link_82599");
1015
1016         /* Setup the PHY according to input speed */
1017         status = hw->phy.ops.setup_link_speed(hw, speed,
1018                                               autoneg_wait_to_complete);
1019         /* Set up MAC */
1020         ixgbe_start_mac_link_82599(hw, autoneg_wait_to_complete);
1021
1022         return status;
1023 }
1024
1025 /**
1026  *  ixgbe_reset_hw_82599 - Perform hardware reset
1027  *  @hw: pointer to hardware structure
1028  *
1029  *  Resets the hardware by resetting the transmit and receive units, masks
1030  *  and clears all interrupts, perform a PHY reset, and perform a link (MAC)
1031  *  reset.
1032  **/
1033 s32 ixgbe_reset_hw_82599(struct ixgbe_hw *hw)
1034 {
1035         ixgbe_link_speed link_speed;
1036         s32 status;
1037         u32 ctrl = 0;
1038         u32 i, autoc, autoc2;
1039         u32 curr_lms;
1040         bool link_up = FALSE;
1041
1042         DEBUGFUNC("ixgbe_reset_hw_82599");
1043
1044         /* Call adapter stop to disable tx/rx and clear interrupts */
1045         status = hw->mac.ops.stop_adapter(hw);
1046         if (status != IXGBE_SUCCESS)
1047                 goto reset_hw_out;
1048
1049         /* flush pending Tx transactions */
1050         ixgbe_clear_tx_pending(hw);
1051
1052         /* PHY ops must be identified and initialized prior to reset */
1053
1054         /* Identify PHY and related function pointers */
1055         status = hw->phy.ops.init(hw);
1056
1057         if (status == IXGBE_ERR_SFP_NOT_SUPPORTED)
1058                 goto reset_hw_out;
1059
1060         /* Setup SFP module if there is one present. */
1061         if (hw->phy.sfp_setup_needed) {
1062                 status = hw->mac.ops.setup_sfp(hw);
1063                 hw->phy.sfp_setup_needed = FALSE;
1064         }
1065
1066         if (status == IXGBE_ERR_SFP_NOT_SUPPORTED)
1067                 goto reset_hw_out;
1068
1069         /* Reset PHY */
1070         if (hw->phy.reset_disable == FALSE && hw->phy.ops.reset != NULL)
1071                 hw->phy.ops.reset(hw);
1072
1073         /* remember AUTOC from before we reset */
1074         curr_lms = IXGBE_READ_REG(hw, IXGBE_AUTOC) & IXGBE_AUTOC_LMS_MASK;
1075
1076 mac_reset_top:
1077         /*
1078          * Issue global reset to the MAC.  Needs to be SW reset if link is up.
1079          * If link reset is used when link is up, it might reset the PHY when
1080          * mng is using it.  If link is down or the flag to force full link
1081          * reset is set, then perform link reset.
1082          */
1083         ctrl = IXGBE_CTRL_LNK_RST;
1084         if (!hw->force_full_reset) {
1085                 hw->mac.ops.check_link(hw, &link_speed, &link_up, FALSE);
1086                 if (link_up)
1087                         ctrl = IXGBE_CTRL_RST;
1088         }
1089
1090         ctrl |= IXGBE_READ_REG(hw, IXGBE_CTRL);
1091         IXGBE_WRITE_REG(hw, IXGBE_CTRL, ctrl);
1092         IXGBE_WRITE_FLUSH(hw);
1093
1094         /* Poll for reset bit to self-clear meaning reset is complete */
1095         for (i = 0; i < 10; i++) {
1096                 usec_delay(1);
1097                 ctrl = IXGBE_READ_REG(hw, IXGBE_CTRL);
1098                 if (!(ctrl & IXGBE_CTRL_RST_MASK))
1099                         break;
1100         }
1101
1102         if (ctrl & IXGBE_CTRL_RST_MASK) {
1103                 status = IXGBE_ERR_RESET_FAILED;
1104                 DEBUGOUT("Reset polling failed to complete.\n");
1105         }
1106
1107         msec_delay(50);
1108
1109         /*
1110          * Double resets are required for recovery from certain error
1111          * conditions.  Between resets, it is necessary to stall to
1112          * allow time for any pending HW events to complete.
1113          */
1114         if (hw->mac.flags & IXGBE_FLAGS_DOUBLE_RESET_REQUIRED) {
1115                 hw->mac.flags &= ~IXGBE_FLAGS_DOUBLE_RESET_REQUIRED;
1116                 goto mac_reset_top;
1117         }
1118
1119         /*
1120          * Store the original AUTOC/AUTOC2 values if they have not been
1121          * stored off yet.  Otherwise restore the stored original
1122          * values since the reset operation sets back to defaults.
1123          */
1124         autoc = IXGBE_READ_REG(hw, IXGBE_AUTOC);
1125         autoc2 = IXGBE_READ_REG(hw, IXGBE_AUTOC2);
1126
1127         /* Enable link if disabled in NVM */
1128         if (autoc2 & IXGBE_AUTOC2_LINK_DISABLE_MASK) {
1129                 autoc2 &= ~IXGBE_AUTOC2_LINK_DISABLE_MASK;
1130                 IXGBE_WRITE_REG(hw, IXGBE_AUTOC2, autoc2);
1131                 IXGBE_WRITE_FLUSH(hw);
1132         }
1133
1134         if (hw->mac.orig_link_settings_stored == FALSE) {
1135                 hw->mac.orig_autoc = autoc;
1136                 hw->mac.orig_autoc2 = autoc2;
1137                 hw->mac.orig_link_settings_stored = TRUE;
1138         } else {
1139
1140                 /* If MNG FW is running on a multi-speed device that
1141                  * doesn't autoneg with out driver support we need to
1142                  * leave LMS in the state it was before we MAC reset.
1143                  * Likewise if we support WoL we don't want change the
1144                  * LMS state.
1145                  */
1146                 if ((hw->phy.multispeed_fiber && ixgbe_mng_enabled(hw)) ||
1147                     hw->wol_enabled)
1148                         hw->mac.orig_autoc =
1149                                 (hw->mac.orig_autoc & ~IXGBE_AUTOC_LMS_MASK) |
1150                                 curr_lms;
1151
1152                 if (autoc != hw->mac.orig_autoc) {
1153                         status = hw->mac.ops.prot_autoc_write(hw,
1154                                                         hw->mac.orig_autoc,
1155                                                         FALSE);
1156                         if (status != IXGBE_SUCCESS)
1157                                 goto reset_hw_out;
1158                 }
1159
1160                 if ((autoc2 & IXGBE_AUTOC2_UPPER_MASK) !=
1161                     (hw->mac.orig_autoc2 & IXGBE_AUTOC2_UPPER_MASK)) {
1162                         autoc2 &= ~IXGBE_AUTOC2_UPPER_MASK;
1163                         autoc2 |= (hw->mac.orig_autoc2 &
1164                                    IXGBE_AUTOC2_UPPER_MASK);
1165                         IXGBE_WRITE_REG(hw, IXGBE_AUTOC2, autoc2);
1166                 }
1167         }
1168
1169         /* Store the permanent mac address */
1170         hw->mac.ops.get_mac_addr(hw, hw->mac.perm_addr);
1171
1172         /*
1173          * Store MAC address from RAR0, clear receive address registers, and
1174          * clear the multicast table.  Also reset num_rar_entries to 128,
1175          * since we modify this value when programming the SAN MAC address.
1176          */
1177         hw->mac.num_rar_entries = 128;
1178         hw->mac.ops.init_rx_addrs(hw);
1179
1180         /* Store the permanent SAN mac address */
1181         hw->mac.ops.get_san_mac_addr(hw, hw->mac.san_addr);
1182
1183         /* Add the SAN MAC address to the RAR only if it's a valid address */
1184         if (ixgbe_validate_mac_addr(hw->mac.san_addr) == 0) {
1185                 /* Save the SAN MAC RAR index */
1186                 hw->mac.san_mac_rar_index = hw->mac.num_rar_entries - 1;
1187
1188                 hw->mac.ops.set_rar(hw, hw->mac.san_mac_rar_index,
1189                                     hw->mac.san_addr, 0, IXGBE_RAH_AV);
1190
1191                 /* clear VMDq pool/queue selection for this RAR */
1192                 hw->mac.ops.clear_vmdq(hw, hw->mac.san_mac_rar_index,
1193                                        IXGBE_CLEAR_VMDQ_ALL);
1194
1195                 /* Reserve the last RAR for the SAN MAC address */
1196                 hw->mac.num_rar_entries--;
1197         }
1198
1199         /* Store the alternative WWNN/WWPN prefix */
1200         hw->mac.ops.get_wwn_prefix(hw, &hw->mac.wwnn_prefix,
1201                                    &hw->mac.wwpn_prefix);
1202
1203 reset_hw_out:
1204         return status;
1205 }
1206
1207 /**
1208  * ixgbe_fdir_check_cmd_complete - poll to check whether FDIRCMD is complete
1209  * @hw: pointer to hardware structure
1210  * @fdircmd: current value of FDIRCMD register
1211  */
1212 static s32 ixgbe_fdir_check_cmd_complete(struct ixgbe_hw *hw, u32 *fdircmd)
1213 {
1214         int i;
1215
1216         for (i = 0; i < IXGBE_FDIRCMD_CMD_POLL; i++) {
1217                 *fdircmd = IXGBE_READ_REG(hw, IXGBE_FDIRCMD);
1218                 if (!(*fdircmd & IXGBE_FDIRCMD_CMD_MASK))
1219                         return IXGBE_SUCCESS;
1220                 usec_delay(10);
1221         }
1222
1223         return IXGBE_ERR_FDIR_CMD_INCOMPLETE;
1224 }
1225
1226 /**
1227  *  ixgbe_reinit_fdir_tables_82599 - Reinitialize Flow Director tables.
1228  *  @hw: pointer to hardware structure
1229  **/
1230 s32 ixgbe_reinit_fdir_tables_82599(struct ixgbe_hw *hw)
1231 {
1232         s32 err;
1233         int i;
1234         u32 fdirctrl = IXGBE_READ_REG(hw, IXGBE_FDIRCTRL);
1235         u32 fdircmd;
1236         fdirctrl &= ~IXGBE_FDIRCTRL_INIT_DONE;
1237
1238         DEBUGFUNC("ixgbe_reinit_fdir_tables_82599");
1239
1240         /*
1241          * Before starting reinitialization process,
1242          * FDIRCMD.CMD must be zero.
1243          */
1244         err = ixgbe_fdir_check_cmd_complete(hw, &fdircmd);
1245         if (err) {
1246                 DEBUGOUT("Flow Director previous command did not complete, aborting table re-initialization.\n");
1247                 return err;
1248         }
1249
1250         IXGBE_WRITE_REG(hw, IXGBE_FDIRFREE, 0);
1251         IXGBE_WRITE_FLUSH(hw);
1252         /*
1253          * 82599 adapters flow director init flow cannot be restarted,
1254          * Workaround 82599 silicon errata by performing the following steps
1255          * before re-writing the FDIRCTRL control register with the same value.
1256          * - write 1 to bit 8 of FDIRCMD register &
1257          * - write 0 to bit 8 of FDIRCMD register
1258          */
1259         IXGBE_WRITE_REG(hw, IXGBE_FDIRCMD,
1260                         (IXGBE_READ_REG(hw, IXGBE_FDIRCMD) |
1261                          IXGBE_FDIRCMD_CLEARHT));
1262         IXGBE_WRITE_FLUSH(hw);
1263         IXGBE_WRITE_REG(hw, IXGBE_FDIRCMD,
1264                         (IXGBE_READ_REG(hw, IXGBE_FDIRCMD) &
1265                          ~IXGBE_FDIRCMD_CLEARHT));
1266         IXGBE_WRITE_FLUSH(hw);
1267         /*
1268          * Clear FDIR Hash register to clear any leftover hashes
1269          * waiting to be programmed.
1270          */
1271         IXGBE_WRITE_REG(hw, IXGBE_FDIRHASH, 0x00);
1272         IXGBE_WRITE_FLUSH(hw);
1273
1274         IXGBE_WRITE_REG(hw, IXGBE_FDIRCTRL, fdirctrl);
1275         IXGBE_WRITE_FLUSH(hw);
1276
1277         /* Poll init-done after we write FDIRCTRL register */
1278         for (i = 0; i < IXGBE_FDIR_INIT_DONE_POLL; i++) {
1279                 if (IXGBE_READ_REG(hw, IXGBE_FDIRCTRL) &
1280                                    IXGBE_FDIRCTRL_INIT_DONE)
1281                         break;
1282                 msec_delay(1);
1283         }
1284         if (i >= IXGBE_FDIR_INIT_DONE_POLL) {
1285                 DEBUGOUT("Flow Director Signature poll time exceeded!\n");
1286                 return IXGBE_ERR_FDIR_REINIT_FAILED;
1287         }
1288
1289         /* Clear FDIR statistics registers (read to clear) */
1290         IXGBE_READ_REG(hw, IXGBE_FDIRUSTAT);
1291         IXGBE_READ_REG(hw, IXGBE_FDIRFSTAT);
1292         IXGBE_READ_REG(hw, IXGBE_FDIRMATCH);
1293         IXGBE_READ_REG(hw, IXGBE_FDIRMISS);
1294         IXGBE_READ_REG(hw, IXGBE_FDIRLEN);
1295
1296         return IXGBE_SUCCESS;
1297 }
1298
1299 /**
1300  *  ixgbe_fdir_enable_82599 - Initialize Flow Director control registers
1301  *  @hw: pointer to hardware structure
1302  *  @fdirctrl: value to write to flow director control register
1303  **/
1304 static void ixgbe_fdir_enable_82599(struct ixgbe_hw *hw, u32 fdirctrl)
1305 {
1306         int i;
1307
1308         DEBUGFUNC("ixgbe_fdir_enable_82599");
1309
1310         /* Prime the keys for hashing */
1311         IXGBE_WRITE_REG(hw, IXGBE_FDIRHKEY, IXGBE_ATR_BUCKET_HASH_KEY);
1312         IXGBE_WRITE_REG(hw, IXGBE_FDIRSKEY, IXGBE_ATR_SIGNATURE_HASH_KEY);
1313
1314         /*
1315          * Poll init-done after we write the register.  Estimated times:
1316          *      10G: PBALLOC = 11b, timing is 60us
1317          *       1G: PBALLOC = 11b, timing is 600us
1318          *     100M: PBALLOC = 11b, timing is 6ms
1319          *
1320          *     Multiple these timings by 4 if under full Rx load
1321          *
1322          * So we'll poll for IXGBE_FDIR_INIT_DONE_POLL times, sleeping for
1323          * 1 msec per poll time.  If we're at line rate and drop to 100M, then
1324          * this might not finish in our poll time, but we can live with that
1325          * for now.
1326          */
1327         IXGBE_WRITE_REG(hw, IXGBE_FDIRCTRL, fdirctrl);
1328         IXGBE_WRITE_FLUSH(hw);
1329         for (i = 0; i < IXGBE_FDIR_INIT_DONE_POLL; i++) {
1330                 if (IXGBE_READ_REG(hw, IXGBE_FDIRCTRL) &
1331                                    IXGBE_FDIRCTRL_INIT_DONE)
1332                         break;
1333                 msec_delay(1);
1334         }
1335
1336         if (i >= IXGBE_FDIR_INIT_DONE_POLL)
1337                 DEBUGOUT("Flow Director poll time exceeded!\n");
1338 }
1339
1340 /**
1341  *  ixgbe_init_fdir_signature_82599 - Initialize Flow Director signature filters
1342  *  @hw: pointer to hardware structure
1343  *  @fdirctrl: value to write to flow director control register, initially
1344  *           contains just the value of the Rx packet buffer allocation
1345  **/
1346 s32 ixgbe_init_fdir_signature_82599(struct ixgbe_hw *hw, u32 fdirctrl)
1347 {
1348         DEBUGFUNC("ixgbe_init_fdir_signature_82599");
1349
1350         /*
1351          * Continue setup of fdirctrl register bits:
1352          *  Move the flexible bytes to use the ethertype - shift 6 words
1353          *  Set the maximum length per hash bucket to 0xA filters
1354          *  Send interrupt when 64 filters are left
1355          */
1356         fdirctrl |= (0x6 << IXGBE_FDIRCTRL_FLEX_SHIFT) |
1357                     (0xA << IXGBE_FDIRCTRL_MAX_LENGTH_SHIFT) |
1358                     (4 << IXGBE_FDIRCTRL_FULL_THRESH_SHIFT);
1359
1360         /* write hashes and fdirctrl register, poll for completion */
1361         ixgbe_fdir_enable_82599(hw, fdirctrl);
1362
1363         return IXGBE_SUCCESS;
1364 }
1365
1366 /**
1367  *  ixgbe_init_fdir_perfect_82599 - Initialize Flow Director perfect filters
1368  *  @hw: pointer to hardware structure
1369  *  @fdirctrl: value to write to flow director control register, initially
1370  *           contains just the value of the Rx packet buffer allocation
1371  *  @cloud_mode: TRUE - cloud mode, FALSE - other mode
1372  **/
1373 s32 ixgbe_init_fdir_perfect_82599(struct ixgbe_hw *hw, u32 fdirctrl,
1374                         bool cloud_mode)
1375 {
1376         UNREFERENCED_1PARAMETER(cloud_mode);
1377         DEBUGFUNC("ixgbe_init_fdir_perfect_82599");
1378
1379         /*
1380          * Continue setup of fdirctrl register bits:
1381          *  Turn perfect match filtering on
1382          *  Report hash in RSS field of Rx wb descriptor
1383          *  Initialize the drop queue to queue 127
1384          *  Move the flexible bytes to use the ethertype - shift 6 words
1385          *  Set the maximum length per hash bucket to 0xA filters
1386          *  Send interrupt when 64 (0x4 * 16) filters are left
1387          */
1388         fdirctrl |= IXGBE_FDIRCTRL_PERFECT_MATCH |
1389                     IXGBE_FDIRCTRL_REPORT_STATUS |
1390                     (IXGBE_FDIR_DROP_QUEUE << IXGBE_FDIRCTRL_DROP_Q_SHIFT) |
1391                     (0x6 << IXGBE_FDIRCTRL_FLEX_SHIFT) |
1392                     (0xA << IXGBE_FDIRCTRL_MAX_LENGTH_SHIFT) |
1393                     (4 << IXGBE_FDIRCTRL_FULL_THRESH_SHIFT);
1394
1395         if (cloud_mode)
1396                 fdirctrl |=(IXGBE_FDIRCTRL_FILTERMODE_CLOUD <<
1397                                         IXGBE_FDIRCTRL_FILTERMODE_SHIFT);
1398
1399         /* write hashes and fdirctrl register, poll for completion */
1400         ixgbe_fdir_enable_82599(hw, fdirctrl);
1401
1402         return IXGBE_SUCCESS;
1403 }
1404
1405 /**
1406  *  ixgbe_set_fdir_drop_queue_82599 - Set Flow Director drop queue
1407  *  @hw: pointer to hardware structure
1408  *  @dropqueue: Rx queue index used for the dropped packets
1409  **/
1410 void ixgbe_set_fdir_drop_queue_82599(struct ixgbe_hw *hw, u8 dropqueue)
1411 {
1412         u32 fdirctrl;
1413
1414         DEBUGFUNC("ixgbe_set_fdir_drop_queue_82599");
1415         /* Clear init done bit and drop queue field */
1416         fdirctrl = IXGBE_READ_REG(hw, IXGBE_FDIRCTRL);
1417         fdirctrl &= ~(IXGBE_FDIRCTRL_DROP_Q_MASK | IXGBE_FDIRCTRL_INIT_DONE);
1418
1419         /* Set drop queue */
1420         fdirctrl |= (dropqueue << IXGBE_FDIRCTRL_DROP_Q_SHIFT);
1421         if ((hw->mac.type == ixgbe_mac_X550) ||
1422             (hw->mac.type == ixgbe_mac_X550EM_x) ||
1423             (hw->mac.type == ixgbe_mac_X550EM_a))
1424                 fdirctrl |= IXGBE_FDIRCTRL_DROP_NO_MATCH;
1425
1426         IXGBE_WRITE_REG(hw, IXGBE_FDIRCMD,
1427                         (IXGBE_READ_REG(hw, IXGBE_FDIRCMD) |
1428                          IXGBE_FDIRCMD_CLEARHT));
1429         IXGBE_WRITE_FLUSH(hw);
1430         IXGBE_WRITE_REG(hw, IXGBE_FDIRCMD,
1431                         (IXGBE_READ_REG(hw, IXGBE_FDIRCMD) &
1432                          ~IXGBE_FDIRCMD_CLEARHT));
1433         IXGBE_WRITE_FLUSH(hw);
1434
1435         /* write hashes and fdirctrl register, poll for completion */
1436         ixgbe_fdir_enable_82599(hw, fdirctrl);
1437 }
1438
1439 /*
1440  * These defines allow us to quickly generate all of the necessary instructions
1441  * in the function below by simply calling out IXGBE_COMPUTE_SIG_HASH_ITERATION
1442  * for values 0 through 15
1443  */
1444 #define IXGBE_ATR_COMMON_HASH_KEY \
1445                 (IXGBE_ATR_BUCKET_HASH_KEY & IXGBE_ATR_SIGNATURE_HASH_KEY)
1446 #define IXGBE_COMPUTE_SIG_HASH_ITERATION(_n) \
1447 do { \
1448         u32 n = (_n); \
1449         if (IXGBE_ATR_COMMON_HASH_KEY & (0x01 << n)) \
1450                 common_hash ^= lo_hash_dword >> n; \
1451         else if (IXGBE_ATR_BUCKET_HASH_KEY & (0x01 << n)) \
1452                 bucket_hash ^= lo_hash_dword >> n; \
1453         else if (IXGBE_ATR_SIGNATURE_HASH_KEY & (0x01 << n)) \
1454                 sig_hash ^= lo_hash_dword << (16 - n); \
1455         if (IXGBE_ATR_COMMON_HASH_KEY & (0x01 << (n + 16))) \
1456                 common_hash ^= hi_hash_dword >> n; \
1457         else if (IXGBE_ATR_BUCKET_HASH_KEY & (0x01 << (n + 16))) \
1458                 bucket_hash ^= hi_hash_dword >> n; \
1459         else if (IXGBE_ATR_SIGNATURE_HASH_KEY & (0x01 << (n + 16))) \
1460                 sig_hash ^= hi_hash_dword << (16 - n); \
1461 } while (0)
1462
1463 /**
1464  *  ixgbe_atr_compute_sig_hash_82599 - Compute the signature hash
1465  *  @input: input bitstream to compute the hash on
1466  *  @common: compressed common input dword
1467  *
1468  *  This function is almost identical to the function above but contains
1469  *  several optimizations such as unwinding all of the loops, letting the
1470  *  compiler work out all of the conditional ifs since the keys are static
1471  *  defines, and computing two keys at once since the hashed dword stream
1472  *  will be the same for both keys.
1473  **/
1474 u32 ixgbe_atr_compute_sig_hash_82599(union ixgbe_atr_hash_dword input,
1475                                      union ixgbe_atr_hash_dword common)
1476 {
1477         u32 hi_hash_dword, lo_hash_dword, flow_vm_vlan;
1478         u32 sig_hash = 0, bucket_hash = 0, common_hash = 0;
1479
1480         /* record the flow_vm_vlan bits as they are a key part to the hash */
1481         flow_vm_vlan = IXGBE_NTOHL(input.dword);
1482
1483         /* generate common hash dword */
1484         hi_hash_dword = IXGBE_NTOHL(common.dword);
1485
1486         /* low dword is word swapped version of common */
1487         lo_hash_dword = (hi_hash_dword >> 16) | (hi_hash_dword << 16);
1488
1489         /* apply flow ID/VM pool/VLAN ID bits to hash words */
1490         hi_hash_dword ^= flow_vm_vlan ^ (flow_vm_vlan >> 16);
1491
1492         /* Process bits 0 and 16 */
1493         IXGBE_COMPUTE_SIG_HASH_ITERATION(0);
1494
1495         /*
1496          * apply flow ID/VM pool/VLAN ID bits to lo hash dword, we had to
1497          * delay this because bit 0 of the stream should not be processed
1498          * so we do not add the VLAN until after bit 0 was processed
1499          */
1500         lo_hash_dword ^= flow_vm_vlan ^ (flow_vm_vlan << 16);
1501
1502         /* Process remaining 30 bit of the key */
1503         IXGBE_COMPUTE_SIG_HASH_ITERATION(1);
1504         IXGBE_COMPUTE_SIG_HASH_ITERATION(2);
1505         IXGBE_COMPUTE_SIG_HASH_ITERATION(3);
1506         IXGBE_COMPUTE_SIG_HASH_ITERATION(4);
1507         IXGBE_COMPUTE_SIG_HASH_ITERATION(5);
1508         IXGBE_COMPUTE_SIG_HASH_ITERATION(6);
1509         IXGBE_COMPUTE_SIG_HASH_ITERATION(7);
1510         IXGBE_COMPUTE_SIG_HASH_ITERATION(8);
1511         IXGBE_COMPUTE_SIG_HASH_ITERATION(9);
1512         IXGBE_COMPUTE_SIG_HASH_ITERATION(10);
1513         IXGBE_COMPUTE_SIG_HASH_ITERATION(11);
1514         IXGBE_COMPUTE_SIG_HASH_ITERATION(12);
1515         IXGBE_COMPUTE_SIG_HASH_ITERATION(13);
1516         IXGBE_COMPUTE_SIG_HASH_ITERATION(14);
1517         IXGBE_COMPUTE_SIG_HASH_ITERATION(15);
1518
1519         /* combine common_hash result with signature and bucket hashes */
1520         bucket_hash ^= common_hash;
1521         bucket_hash &= IXGBE_ATR_HASH_MASK;
1522
1523         sig_hash ^= common_hash << 16;
1524         sig_hash &= IXGBE_ATR_HASH_MASK << 16;
1525
1526         /* return completed signature hash */
1527         return sig_hash ^ bucket_hash;
1528 }
1529
1530 /**
1531  *  ixgbe_atr_add_signature_filter_82599 - Adds a signature hash filter
1532  *  @hw: pointer to hardware structure
1533  *  @input: unique input dword
1534  *  @common: compressed common input dword
1535  *  @queue: queue index to direct traffic to
1536  *
1537  * Note that the tunnel bit in input must not be set when the hardware
1538  * tunneling support does not exist.
1539  **/
1540 void ixgbe_fdir_add_signature_filter_82599(struct ixgbe_hw *hw,
1541                                            union ixgbe_atr_hash_dword input,
1542                                            union ixgbe_atr_hash_dword common,
1543                                            u8 queue)
1544 {
1545         u64 fdirhashcmd;
1546         u8 flow_type;
1547         bool tunnel;
1548         u32 fdircmd;
1549
1550         DEBUGFUNC("ixgbe_fdir_add_signature_filter_82599");
1551
1552         /*
1553          * Get the flow_type in order to program FDIRCMD properly
1554          * lowest 2 bits are FDIRCMD.L4TYPE, third lowest bit is FDIRCMD.IPV6
1555          * fifth is FDIRCMD.TUNNEL_FILTER
1556          */
1557         tunnel = !!(input.formatted.flow_type & IXGBE_ATR_L4TYPE_TUNNEL_MASK);
1558         flow_type = input.formatted.flow_type &
1559                     (IXGBE_ATR_L4TYPE_TUNNEL_MASK - 1);
1560         switch (flow_type) {
1561         case IXGBE_ATR_FLOW_TYPE_TCPV4:
1562         case IXGBE_ATR_FLOW_TYPE_UDPV4:
1563         case IXGBE_ATR_FLOW_TYPE_SCTPV4:
1564         case IXGBE_ATR_FLOW_TYPE_TCPV6:
1565         case IXGBE_ATR_FLOW_TYPE_UDPV6:
1566         case IXGBE_ATR_FLOW_TYPE_SCTPV6:
1567                 break;
1568         default:
1569                 DEBUGOUT(" Error on flow type input\n");
1570                 return;
1571         }
1572
1573         /* configure FDIRCMD register */
1574         fdircmd = IXGBE_FDIRCMD_CMD_ADD_FLOW | IXGBE_FDIRCMD_FILTER_UPDATE |
1575                   IXGBE_FDIRCMD_LAST | IXGBE_FDIRCMD_QUEUE_EN;
1576         fdircmd |= (u32)flow_type << IXGBE_FDIRCMD_FLOW_TYPE_SHIFT;
1577         fdircmd |= (u32)queue << IXGBE_FDIRCMD_RX_QUEUE_SHIFT;
1578         if (tunnel)
1579                 fdircmd |= IXGBE_FDIRCMD_TUNNEL_FILTER;
1580
1581         /*
1582          * The lower 32-bits of fdirhashcmd is for FDIRHASH, the upper 32-bits
1583          * is for FDIRCMD.  Then do a 64-bit register write from FDIRHASH.
1584          */
1585         fdirhashcmd = (u64)fdircmd << 32;
1586         fdirhashcmd |= ixgbe_atr_compute_sig_hash_82599(input, common);
1587         IXGBE_WRITE_REG64(hw, IXGBE_FDIRHASH, fdirhashcmd);
1588
1589         DEBUGOUT2("Tx Queue=%x hash=%x\n", queue, (u32)fdirhashcmd);
1590
1591         return;
1592 }
1593
1594 #define IXGBE_COMPUTE_BKT_HASH_ITERATION(_n) \
1595 do { \
1596         u32 n = (_n); \
1597         if (IXGBE_ATR_BUCKET_HASH_KEY & (0x01 << n)) \
1598                 bucket_hash ^= lo_hash_dword >> n; \
1599         if (IXGBE_ATR_BUCKET_HASH_KEY & (0x01 << (n + 16))) \
1600                 bucket_hash ^= hi_hash_dword >> n; \
1601 } while (0)
1602
1603 /**
1604  *  ixgbe_atr_compute_perfect_hash_82599 - Compute the perfect filter hash
1605  *  @input: input bitstream to compute the hash on
1606  *  @input_mask: mask for the input bitstream
1607  *
1608  *  This function serves two main purposes.  First it applies the input_mask
1609  *  to the atr_input resulting in a cleaned up atr_input data stream.
1610  *  Secondly it computes the hash and stores it in the bkt_hash field at
1611  *  the end of the input byte stream.  This way it will be available for
1612  *  future use without needing to recompute the hash.
1613  **/
1614 void ixgbe_atr_compute_perfect_hash_82599(union ixgbe_atr_input *input,
1615                                           union ixgbe_atr_input *input_mask)
1616 {
1617
1618         u32 hi_hash_dword, lo_hash_dword, flow_vm_vlan;
1619         u32 bucket_hash = 0;
1620         u32 hi_dword = 0;
1621         u32 i = 0;
1622
1623         /* Apply masks to input data */
1624         for (i = 0; i < 14; i++)
1625                 input->dword_stream[i]  &= input_mask->dword_stream[i];
1626
1627         /* record the flow_vm_vlan bits as they are a key part to the hash */
1628         flow_vm_vlan = IXGBE_NTOHL(input->dword_stream[0]);
1629
1630         /* generate common hash dword */
1631         for (i = 1; i <= 13; i++)
1632                 hi_dword ^= input->dword_stream[i];
1633         hi_hash_dword = IXGBE_NTOHL(hi_dword);
1634
1635         /* low dword is word swapped version of common */
1636         lo_hash_dword = (hi_hash_dword >> 16) | (hi_hash_dword << 16);
1637
1638         /* apply flow ID/VM pool/VLAN ID bits to hash words */
1639         hi_hash_dword ^= flow_vm_vlan ^ (flow_vm_vlan >> 16);
1640
1641         /* Process bits 0 and 16 */
1642         IXGBE_COMPUTE_BKT_HASH_ITERATION(0);
1643
1644         /*
1645          * apply flow ID/VM pool/VLAN ID bits to lo hash dword, we had to
1646          * delay this because bit 0 of the stream should not be processed
1647          * so we do not add the VLAN until after bit 0 was processed
1648          */
1649         lo_hash_dword ^= flow_vm_vlan ^ (flow_vm_vlan << 16);
1650
1651         /* Process remaining 30 bit of the key */
1652         for (i = 1; i <= 15; i++)
1653                 IXGBE_COMPUTE_BKT_HASH_ITERATION(i);
1654
1655         /*
1656          * Limit hash to 13 bits since max bucket count is 8K.
1657          * Store result at the end of the input stream.
1658          */
1659         input->formatted.bkt_hash = bucket_hash & 0x1FFF;
1660 }
1661
1662 /**
1663  *  ixgbe_get_fdirtcpm_82599 - generate a TCP port from atr_input_masks
1664  *  @input_mask: mask to be bit swapped
1665  *
1666  *  The source and destination port masks for flow director are bit swapped
1667  *  in that bit 15 effects bit 0, 14 effects 1, 13, 2 etc.  In order to
1668  *  generate a correctly swapped value we need to bit swap the mask and that
1669  *  is what is accomplished by this function.
1670  **/
1671 static u32 ixgbe_get_fdirtcpm_82599(union ixgbe_atr_input *input_mask)
1672 {
1673         u32 mask = IXGBE_NTOHS(input_mask->formatted.dst_port);
1674         mask <<= IXGBE_FDIRTCPM_DPORTM_SHIFT;
1675         mask |= IXGBE_NTOHS(input_mask->formatted.src_port);
1676         mask = ((mask & 0x55555555) << 1) | ((mask & 0xAAAAAAAA) >> 1);
1677         mask = ((mask & 0x33333333) << 2) | ((mask & 0xCCCCCCCC) >> 2);
1678         mask = ((mask & 0x0F0F0F0F) << 4) | ((mask & 0xF0F0F0F0) >> 4);
1679         return ((mask & 0x00FF00FF) << 8) | ((mask & 0xFF00FF00) >> 8);
1680 }
1681
1682 /*
1683  * These two macros are meant to address the fact that we have registers
1684  * that are either all or in part big-endian.  As a result on big-endian
1685  * systems we will end up byte swapping the value to little-endian before
1686  * it is byte swapped again and written to the hardware in the original
1687  * big-endian format.
1688  */
1689 #define IXGBE_STORE_AS_BE32(_value) \
1690         (((u32)(_value) >> 24) | (((u32)(_value) & 0x00FF0000) >> 8) | \
1691          (((u32)(_value) & 0x0000FF00) << 8) | ((u32)(_value) << 24))
1692
1693 #define IXGBE_WRITE_REG_BE32(a, reg, value) \
1694         IXGBE_WRITE_REG((a), (reg), IXGBE_STORE_AS_BE32(IXGBE_NTOHL(value)))
1695
1696 #define IXGBE_STORE_AS_BE16(_value) \
1697         IXGBE_NTOHS(((u16)(_value) >> 8) | ((u16)(_value) << 8))
1698
1699 s32 ixgbe_fdir_set_input_mask_82599(struct ixgbe_hw *hw,
1700                                     union ixgbe_atr_input *input_mask, bool cloud_mode)
1701 {
1702         /* mask IPv6 since it is currently not supported */
1703         u32 fdirm = IXGBE_FDIRM_DIPv6;
1704         u32 fdirtcpm;
1705         u32 fdirip6m;
1706         UNREFERENCED_1PARAMETER(cloud_mode);
1707         DEBUGFUNC("ixgbe_fdir_set_atr_input_mask_82599");
1708
1709         /*
1710          * Program the relevant mask registers.  If src/dst_port or src/dst_addr
1711          * are zero, then assume a full mask for that field.  Also assume that
1712          * a VLAN of 0 is unspecified, so mask that out as well.  L4type
1713          * cannot be masked out in this implementation.
1714          *
1715          * This also assumes IPv4 only.  IPv6 masking isn't supported at this
1716          * point in time.
1717          */
1718
1719         /* verify bucket hash is cleared on hash generation */
1720         if (input_mask->formatted.bkt_hash)
1721                 DEBUGOUT(" bucket hash should always be 0 in mask\n");
1722
1723         /* Program FDIRM and verify partial masks */
1724         switch (input_mask->formatted.vm_pool & 0x7F) {
1725         case 0x0:
1726                 fdirm |= IXGBE_FDIRM_POOL;
1727         case 0x7F:
1728                 break;
1729         default:
1730                 DEBUGOUT(" Error on vm pool mask\n");
1731                 return IXGBE_ERR_CONFIG;
1732         }
1733
1734         switch (input_mask->formatted.flow_type & IXGBE_ATR_L4TYPE_MASK) {
1735         case 0x0:
1736                 fdirm |= IXGBE_FDIRM_L4P;
1737                 if (input_mask->formatted.dst_port ||
1738                     input_mask->formatted.src_port) {
1739                         DEBUGOUT(" Error on src/dst port mask\n");
1740                         return IXGBE_ERR_CONFIG;
1741                 }
1742         case IXGBE_ATR_L4TYPE_MASK:
1743                 break;
1744         default:
1745                 DEBUGOUT(" Error on flow type mask\n");
1746                 return IXGBE_ERR_CONFIG;
1747         }
1748
1749         switch (IXGBE_NTOHS(input_mask->formatted.vlan_id) & 0xEFFF) {
1750         case 0x0000:
1751                 /* mask VLAN ID */
1752                 fdirm |= IXGBE_FDIRM_VLANID;
1753                 /* FALLTHROUGH */
1754         case 0x0FFF:
1755                 /* mask VLAN priority */
1756                 fdirm |= IXGBE_FDIRM_VLANP;
1757                 break;
1758         case 0xE000:
1759                 /* mask VLAN ID only */
1760                 fdirm |= IXGBE_FDIRM_VLANID;
1761                 /* fall through */
1762         case 0xEFFF:
1763                 /* no VLAN fields masked */
1764                 break;
1765         default:
1766                 DEBUGOUT(" Error on VLAN mask\n");
1767                 return IXGBE_ERR_CONFIG;
1768         }
1769
1770         switch (input_mask->formatted.flex_bytes & 0xFFFF) {
1771         case 0x0000:
1772                 /* Mask Flex Bytes */
1773                 fdirm |= IXGBE_FDIRM_FLEX;
1774                 /* fall through */
1775         case 0xFFFF:
1776                 break;
1777         default:
1778                 DEBUGOUT(" Error on flexible byte mask\n");
1779                 return IXGBE_ERR_CONFIG;
1780         }
1781
1782         if (cloud_mode) {
1783                 fdirm |= IXGBE_FDIRM_L3P;
1784                 fdirip6m = ((u32) 0xFFFFU << IXGBE_FDIRIP6M_DIPM_SHIFT);
1785                 fdirip6m |= IXGBE_FDIRIP6M_ALWAYS_MASK;
1786
1787                 switch (input_mask->formatted.inner_mac[0] & 0xFF) {
1788                 case 0x00:
1789                         /* Mask inner MAC, fall through */
1790                         fdirip6m |= IXGBE_FDIRIP6M_INNER_MAC;
1791                 case 0xFF:
1792                         break;
1793                 default:
1794                         DEBUGOUT(" Error on inner_mac byte mask\n");
1795                         return IXGBE_ERR_CONFIG;
1796                 }
1797
1798                 switch (input_mask->formatted.tni_vni & 0xFFFFFFFF) {
1799                 case 0x0:
1800                         /* Mask vxlan id */
1801                         fdirip6m |= IXGBE_FDIRIP6M_TNI_VNI;
1802                         break;
1803                 case 0x00FFFFFF:
1804                         fdirip6m |= IXGBE_FDIRIP6M_TNI_VNI_24;
1805                         break;
1806                 case 0xFFFFFFFF:
1807                         break;
1808                 default:
1809                         DEBUGOUT(" Error on TNI/VNI byte mask\n");
1810                         return IXGBE_ERR_CONFIG;
1811                 }
1812
1813                 switch (input_mask->formatted.tunnel_type & 0xFFFF) {
1814                 case 0x0:
1815                         /* Mask turnnel type, fall through */
1816                         fdirip6m |= IXGBE_FDIRIP6M_TUNNEL_TYPE;
1817                 case 0xFFFF:
1818                         break;
1819                 default:
1820                         DEBUGOUT(" Error on tunnel type byte mask\n");
1821                         return IXGBE_ERR_CONFIG;
1822                 }
1823                 IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRIP6M, fdirip6m);
1824
1825                 /* Set all bits in FDIRTCPM, FDIRUDPM, FDIRSCTPM,
1826                  * FDIRSIP4M and FDIRDIP4M in cloud mode to allow
1827                  * L3/L3 packets to tunnel.
1828                  */
1829                 IXGBE_WRITE_REG(hw, IXGBE_FDIRTCPM, 0xFFFFFFFF);
1830                 IXGBE_WRITE_REG(hw, IXGBE_FDIRUDPM, 0xFFFFFFFF);
1831                 IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRDIP4M, 0xFFFFFFFF);
1832                 IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRSIP4M, 0xFFFFFFFF);
1833                 switch (hw->mac.type) {
1834                 case ixgbe_mac_X550:
1835                 case ixgbe_mac_X550EM_x:
1836                 case ixgbe_mac_X550EM_a:
1837                         IXGBE_WRITE_REG(hw, IXGBE_FDIRSCTPM, 0xFFFFFFFF);
1838                         break;
1839                 default:
1840                         break;
1841                 }
1842         }
1843
1844         /* Now mask VM pool and destination IPv6 - bits 5 and 2 */
1845         IXGBE_WRITE_REG(hw, IXGBE_FDIRM, fdirm);
1846
1847         if (!cloud_mode) {
1848                 /* store the TCP/UDP port masks, bit reversed from port
1849                  * layout */
1850                 fdirtcpm = ixgbe_get_fdirtcpm_82599(input_mask);
1851
1852                 /* write both the same so that UDP and TCP use the same mask */
1853                 IXGBE_WRITE_REG(hw, IXGBE_FDIRTCPM, ~fdirtcpm);
1854                 IXGBE_WRITE_REG(hw, IXGBE_FDIRUDPM, ~fdirtcpm);
1855                 /* also use it for SCTP */
1856                 switch (hw->mac.type) {
1857                 case ixgbe_mac_X550:
1858                 case ixgbe_mac_X550EM_x:
1859                 case ixgbe_mac_X550EM_a:
1860                         IXGBE_WRITE_REG(hw, IXGBE_FDIRSCTPM, ~fdirtcpm);
1861                         break;
1862                 default:
1863                         break;
1864                 }
1865
1866                 /* store source and destination IP masks (big-enian) */
1867                 IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRSIP4M,
1868                                      ~input_mask->formatted.src_ip[0]);
1869                 IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRDIP4M,
1870                                      ~input_mask->formatted.dst_ip[0]);
1871         }
1872         return IXGBE_SUCCESS;
1873 }
1874
1875 s32 ixgbe_fdir_write_perfect_filter_82599(struct ixgbe_hw *hw,
1876                                           union ixgbe_atr_input *input,
1877                                           u16 soft_id, u8 queue, bool cloud_mode)
1878 {
1879         u32 fdirport, fdirvlan, fdirhash, fdircmd;
1880         u32 addr_low, addr_high;
1881         u32 cloud_type = 0;
1882         s32 err;
1883         UNREFERENCED_1PARAMETER(cloud_mode);
1884
1885         DEBUGFUNC("ixgbe_fdir_write_perfect_filter_82599");
1886         if (!cloud_mode) {
1887                 /* currently IPv6 is not supported, must be programmed with 0 */
1888                 IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRSIPv6(0),
1889                                      input->formatted.src_ip[0]);
1890                 IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRSIPv6(1),
1891                                      input->formatted.src_ip[1]);
1892                 IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRSIPv6(2),
1893                                      input->formatted.src_ip[2]);
1894
1895                 /* record the source address (big-endian) */
1896                 IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRIPSA,
1897                         input->formatted.src_ip[0]);
1898
1899                 /* record the first 32 bits of the destination address
1900                  * (big-endian) */
1901                 IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRIPDA,
1902                         input->formatted.dst_ip[0]);
1903
1904                 /* record source and destination port (little-endian)*/
1905                 fdirport = IXGBE_NTOHS(input->formatted.dst_port);
1906                 fdirport <<= IXGBE_FDIRPORT_DESTINATION_SHIFT;
1907                 fdirport |= IXGBE_NTOHS(input->formatted.src_port);
1908                 IXGBE_WRITE_REG(hw, IXGBE_FDIRPORT, fdirport);
1909         }
1910
1911         /* record VLAN (little-endian) and flex_bytes(big-endian) */
1912         fdirvlan = IXGBE_STORE_AS_BE16(input->formatted.flex_bytes);
1913         fdirvlan <<= IXGBE_FDIRVLAN_FLEX_SHIFT;
1914         fdirvlan |= IXGBE_NTOHS(input->formatted.vlan_id);
1915         IXGBE_WRITE_REG(hw, IXGBE_FDIRVLAN, fdirvlan);
1916
1917         if (cloud_mode) {
1918                 if (input->formatted.tunnel_type != 0)
1919                         cloud_type = 0x80000000;
1920
1921                 addr_low = ((u32)input->formatted.inner_mac[0] |
1922                                 ((u32)input->formatted.inner_mac[1] << 8) |
1923                                 ((u32)input->formatted.inner_mac[2] << 16) |
1924                                 ((u32)input->formatted.inner_mac[3] << 24));
1925                 addr_high = ((u32)input->formatted.inner_mac[4] |
1926                                 ((u32)input->formatted.inner_mac[5] << 8));
1927                 cloud_type |= addr_high;
1928                 IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRSIPv6(0), addr_low);
1929                 IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRSIPv6(1), cloud_type);
1930                 IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRSIPv6(2), input->formatted.tni_vni);
1931         }
1932
1933         /* configure FDIRHASH register */
1934         fdirhash = input->formatted.bkt_hash;
1935         fdirhash |= soft_id << IXGBE_FDIRHASH_SIG_SW_INDEX_SHIFT;
1936         IXGBE_WRITE_REG(hw, IXGBE_FDIRHASH, fdirhash);
1937
1938         /*
1939          * flush all previous writes to make certain registers are
1940          * programmed prior to issuing the command
1941          */
1942         IXGBE_WRITE_FLUSH(hw);
1943
1944         /* configure FDIRCMD register */
1945         fdircmd = IXGBE_FDIRCMD_CMD_ADD_FLOW | IXGBE_FDIRCMD_FILTER_UPDATE |
1946                   IXGBE_FDIRCMD_LAST | IXGBE_FDIRCMD_QUEUE_EN;
1947         if (queue == IXGBE_FDIR_DROP_QUEUE)
1948                 fdircmd |= IXGBE_FDIRCMD_DROP;
1949         if (input->formatted.flow_type & IXGBE_ATR_L4TYPE_TUNNEL_MASK)
1950                 fdircmd |= IXGBE_FDIRCMD_TUNNEL_FILTER;
1951         fdircmd |= input->formatted.flow_type << IXGBE_FDIRCMD_FLOW_TYPE_SHIFT;
1952         fdircmd |= (u32)queue << IXGBE_FDIRCMD_RX_QUEUE_SHIFT;
1953         fdircmd |= (u32)input->formatted.vm_pool << IXGBE_FDIRCMD_VT_POOL_SHIFT;
1954
1955         IXGBE_WRITE_REG(hw, IXGBE_FDIRCMD, fdircmd);
1956         err = ixgbe_fdir_check_cmd_complete(hw, &fdircmd);
1957         if (err) {
1958                 DEBUGOUT("Flow Director command did not complete!\n");
1959                 return err;
1960         }
1961
1962         return IXGBE_SUCCESS;
1963 }
1964
1965 s32 ixgbe_fdir_erase_perfect_filter_82599(struct ixgbe_hw *hw,
1966                                           union ixgbe_atr_input *input,
1967                                           u16 soft_id)
1968 {
1969         u32 fdirhash;
1970         u32 fdircmd;
1971         s32 err;
1972
1973         /* configure FDIRHASH register */
1974         fdirhash = input->formatted.bkt_hash;
1975         fdirhash |= soft_id << IXGBE_FDIRHASH_SIG_SW_INDEX_SHIFT;
1976         IXGBE_WRITE_REG(hw, IXGBE_FDIRHASH, fdirhash);
1977
1978         /* flush hash to HW */
1979         IXGBE_WRITE_FLUSH(hw);
1980
1981         /* Query if filter is present */
1982         IXGBE_WRITE_REG(hw, IXGBE_FDIRCMD, IXGBE_FDIRCMD_CMD_QUERY_REM_FILT);
1983
1984         err = ixgbe_fdir_check_cmd_complete(hw, &fdircmd);
1985         if (err) {
1986                 DEBUGOUT("Flow Director command did not complete!\n");
1987                 return err;
1988         }
1989
1990         /* if filter exists in hardware then remove it */
1991         if (fdircmd & IXGBE_FDIRCMD_FILTER_VALID) {
1992                 IXGBE_WRITE_REG(hw, IXGBE_FDIRHASH, fdirhash);
1993                 IXGBE_WRITE_FLUSH(hw);
1994                 IXGBE_WRITE_REG(hw, IXGBE_FDIRCMD,
1995                                 IXGBE_FDIRCMD_CMD_REMOVE_FLOW);
1996         }
1997
1998         return IXGBE_SUCCESS;
1999 }
2000
2001 /**
2002  *  ixgbe_fdir_add_perfect_filter_82599 - Adds a perfect filter
2003  *  @hw: pointer to hardware structure
2004  *  @input: input bitstream
2005  *  @input_mask: mask for the input bitstream
2006  *  @soft_id: software index for the filters
2007  *  @queue: queue index to direct traffic to
2008  *  @cloud_mode: unused
2009  *
2010  *  Note that the caller to this function must lock before calling, since the
2011  *  hardware writes must be protected from one another.
2012  **/
2013 s32 ixgbe_fdir_add_perfect_filter_82599(struct ixgbe_hw *hw,
2014                                         union ixgbe_atr_input *input,
2015                                         union ixgbe_atr_input *input_mask,
2016                                         u16 soft_id, u8 queue, bool cloud_mode)
2017 {
2018         s32 err = IXGBE_ERR_CONFIG;
2019         UNREFERENCED_1PARAMETER(cloud_mode);
2020
2021         DEBUGFUNC("ixgbe_fdir_add_perfect_filter_82599");
2022
2023         /*
2024          * Check flow_type formatting, and bail out before we touch the hardware
2025          * if there's a configuration issue
2026          */
2027         switch (input->formatted.flow_type) {
2028         case IXGBE_ATR_FLOW_TYPE_IPV4:
2029         case IXGBE_ATR_FLOW_TYPE_TUNNELED_IPV4:
2030                 input_mask->formatted.flow_type = IXGBE_ATR_L4TYPE_IPV6_MASK;
2031                 if (input->formatted.dst_port || input->formatted.src_port) {
2032                         DEBUGOUT(" Error on src/dst port\n");
2033                         return IXGBE_ERR_CONFIG;
2034                 }
2035                 break;
2036         case IXGBE_ATR_FLOW_TYPE_SCTPV4:
2037         case IXGBE_ATR_FLOW_TYPE_TUNNELED_SCTPV4:
2038                 if (input->formatted.dst_port || input->formatted.src_port) {
2039                         DEBUGOUT(" Error on src/dst port\n");
2040                         return IXGBE_ERR_CONFIG;
2041                 }
2042                 /* FALLTHROUGH */
2043         case IXGBE_ATR_FLOW_TYPE_TCPV4:
2044         case IXGBE_ATR_FLOW_TYPE_TUNNELED_TCPV4:
2045         case IXGBE_ATR_FLOW_TYPE_UDPV4:
2046         case IXGBE_ATR_FLOW_TYPE_TUNNELED_UDPV4:
2047                 input_mask->formatted.flow_type = IXGBE_ATR_L4TYPE_IPV6_MASK |
2048                                                   IXGBE_ATR_L4TYPE_MASK;
2049                 break;
2050         default:
2051                 DEBUGOUT(" Error on flow type input\n");
2052                 return err;
2053         }
2054
2055         /* program input mask into the HW */
2056         err = ixgbe_fdir_set_input_mask_82599(hw, input_mask, cloud_mode);
2057         if (err)
2058                 return err;
2059
2060         /* apply mask and compute/store hash */
2061         ixgbe_atr_compute_perfect_hash_82599(input, input_mask);
2062
2063         /* program filters to filter memory */
2064         return ixgbe_fdir_write_perfect_filter_82599(hw, input,
2065                                                      soft_id, queue, cloud_mode);
2066 }
2067
2068 /**
2069  *  ixgbe_read_analog_reg8_82599 - Reads 8 bit Omer analog register
2070  *  @hw: pointer to hardware structure
2071  *  @reg: analog register to read
2072  *  @val: read value
2073  *
2074  *  Performs read operation to Omer analog register specified.
2075  **/
2076 s32 ixgbe_read_analog_reg8_82599(struct ixgbe_hw *hw, u32 reg, u8 *val)
2077 {
2078         u32  core_ctl;
2079
2080         DEBUGFUNC("ixgbe_read_analog_reg8_82599");
2081
2082         IXGBE_WRITE_REG(hw, IXGBE_CORECTL, IXGBE_CORECTL_WRITE_CMD |
2083                         (reg << 8));
2084         IXGBE_WRITE_FLUSH(hw);
2085         usec_delay(10);
2086         core_ctl = IXGBE_READ_REG(hw, IXGBE_CORECTL);
2087         *val = (u8)core_ctl;
2088
2089         return IXGBE_SUCCESS;
2090 }
2091
2092 /**
2093  *  ixgbe_write_analog_reg8_82599 - Writes 8 bit Omer analog register
2094  *  @hw: pointer to hardware structure
2095  *  @reg: atlas register to write
2096  *  @val: value to write
2097  *
2098  *  Performs write operation to Omer analog register specified.
2099  **/
2100 s32 ixgbe_write_analog_reg8_82599(struct ixgbe_hw *hw, u32 reg, u8 val)
2101 {
2102         u32  core_ctl;
2103
2104         DEBUGFUNC("ixgbe_write_analog_reg8_82599");
2105
2106         core_ctl = (reg << 8) | val;
2107         IXGBE_WRITE_REG(hw, IXGBE_CORECTL, core_ctl);
2108         IXGBE_WRITE_FLUSH(hw);
2109         usec_delay(10);
2110
2111         return IXGBE_SUCCESS;
2112 }
2113
2114 /**
2115  *  ixgbe_start_hw_82599 - Prepare hardware for Tx/Rx
2116  *  @hw: pointer to hardware structure
2117  *
2118  *  Starts the hardware using the generic start_hw function
2119  *  and the generation start_hw function.
2120  *  Then performs revision-specific operations, if any.
2121  **/
2122 s32 ixgbe_start_hw_82599(struct ixgbe_hw *hw)
2123 {
2124         s32 ret_val = IXGBE_SUCCESS;
2125
2126         DEBUGFUNC("ixgbe_start_hw_82599");
2127
2128         ret_val = ixgbe_start_hw_generic(hw);
2129         if (ret_val != IXGBE_SUCCESS)
2130                 goto out;
2131
2132         ret_val = ixgbe_start_hw_gen2(hw);
2133         if (ret_val != IXGBE_SUCCESS)
2134                 goto out;
2135
2136         /* We need to run link autotry after the driver loads */
2137         hw->mac.autotry_restart = TRUE;
2138
2139         if (ret_val == IXGBE_SUCCESS)
2140                 ret_val = ixgbe_verify_fw_version_82599(hw);
2141 out:
2142         return ret_val;
2143 }
2144
2145 /**
2146  *  ixgbe_identify_phy_82599 - Get physical layer module
2147  *  @hw: pointer to hardware structure
2148  *
2149  *  Determines the physical layer module found on the current adapter.
2150  *  If PHY already detected, maintains current PHY type in hw struct,
2151  *  otherwise executes the PHY detection routine.
2152  **/
2153 s32 ixgbe_identify_phy_82599(struct ixgbe_hw *hw)
2154 {
2155         s32 status;
2156
2157         DEBUGFUNC("ixgbe_identify_phy_82599");
2158
2159         /* Detect PHY if not unknown - returns success if already detected. */
2160         status = ixgbe_identify_phy_generic(hw);
2161         if (status != IXGBE_SUCCESS) {
2162                 /* 82599 10GBASE-T requires an external PHY */
2163                 if (hw->mac.ops.get_media_type(hw) == ixgbe_media_type_copper)
2164                         return status;
2165                 else
2166                         status = ixgbe_identify_module_generic(hw);
2167         }
2168
2169         /* Set PHY type none if no PHY detected */
2170         if (hw->phy.type == ixgbe_phy_unknown) {
2171                 hw->phy.type = ixgbe_phy_none;
2172                 return IXGBE_SUCCESS;
2173         }
2174
2175         /* Return error if SFP module has been detected but is not supported */
2176         if (hw->phy.type == ixgbe_phy_sfp_unsupported)
2177                 return IXGBE_ERR_SFP_NOT_SUPPORTED;
2178
2179         return status;
2180 }
2181
2182 /**
2183  *  ixgbe_get_supported_physical_layer_82599 - Returns physical layer type
2184  *  @hw: pointer to hardware structure
2185  *
2186  *  Determines physical layer capabilities of the current configuration.
2187  **/
2188 u64 ixgbe_get_supported_physical_layer_82599(struct ixgbe_hw *hw)
2189 {
2190         u64 physical_layer = IXGBE_PHYSICAL_LAYER_UNKNOWN;
2191         u32 autoc = IXGBE_READ_REG(hw, IXGBE_AUTOC);
2192         u32 autoc2 = IXGBE_READ_REG(hw, IXGBE_AUTOC2);
2193         u32 pma_pmd_10g_serial = autoc2 & IXGBE_AUTOC2_10G_SERIAL_PMA_PMD_MASK;
2194         u32 pma_pmd_10g_parallel = autoc & IXGBE_AUTOC_10G_PMA_PMD_MASK;
2195         u32 pma_pmd_1g = autoc & IXGBE_AUTOC_1G_PMA_PMD_MASK;
2196         u16 ext_ability = 0;
2197
2198         DEBUGFUNC("ixgbe_get_support_physical_layer_82599");
2199
2200         hw->phy.ops.identify(hw);
2201
2202         switch (hw->phy.type) {
2203         case ixgbe_phy_tn:
2204         case ixgbe_phy_cu_unknown:
2205                 hw->phy.ops.read_reg(hw, IXGBE_MDIO_PHY_EXT_ABILITY,
2206                 IXGBE_MDIO_PMA_PMD_DEV_TYPE, &ext_ability);
2207                 if (ext_ability & IXGBE_MDIO_PHY_10GBASET_ABILITY)
2208                         physical_layer |= IXGBE_PHYSICAL_LAYER_10GBASE_T;
2209                 if (ext_ability & IXGBE_MDIO_PHY_1000BASET_ABILITY)
2210                         physical_layer |= IXGBE_PHYSICAL_LAYER_1000BASE_T;
2211                 if (ext_ability & IXGBE_MDIO_PHY_100BASETX_ABILITY)
2212                         physical_layer |= IXGBE_PHYSICAL_LAYER_100BASE_TX;
2213                 goto out;
2214         default:
2215                 break;
2216         }
2217
2218         switch (autoc & IXGBE_AUTOC_LMS_MASK) {
2219         case IXGBE_AUTOC_LMS_1G_AN:
2220         case IXGBE_AUTOC_LMS_1G_LINK_NO_AN:
2221                 if (pma_pmd_1g == IXGBE_AUTOC_1G_KX_BX) {
2222                         physical_layer = IXGBE_PHYSICAL_LAYER_1000BASE_KX |
2223                             IXGBE_PHYSICAL_LAYER_1000BASE_BX;
2224                         goto out;
2225                 } else
2226                         /* SFI mode so read SFP module */
2227                         goto sfp_check;
2228                 break;
2229         case IXGBE_AUTOC_LMS_10G_LINK_NO_AN:
2230                 if (pma_pmd_10g_parallel == IXGBE_AUTOC_10G_CX4)
2231                         physical_layer = IXGBE_PHYSICAL_LAYER_10GBASE_CX4;
2232                 else if (pma_pmd_10g_parallel == IXGBE_AUTOC_10G_KX4)
2233                         physical_layer = IXGBE_PHYSICAL_LAYER_10GBASE_KX4;
2234                 else if (pma_pmd_10g_parallel == IXGBE_AUTOC_10G_XAUI)
2235                         physical_layer = IXGBE_PHYSICAL_LAYER_10GBASE_XAUI;
2236                 goto out;
2237                 break;
2238         case IXGBE_AUTOC_LMS_10G_SERIAL:
2239                 if (pma_pmd_10g_serial == IXGBE_AUTOC2_10G_KR) {
2240                         physical_layer = IXGBE_PHYSICAL_LAYER_10GBASE_KR;
2241                         goto out;
2242                 } else if (pma_pmd_10g_serial == IXGBE_AUTOC2_10G_SFI)
2243                         goto sfp_check;
2244                 break;
2245         case IXGBE_AUTOC_LMS_KX4_KX_KR:
2246         case IXGBE_AUTOC_LMS_KX4_KX_KR_1G_AN:
2247                 if (autoc & IXGBE_AUTOC_KX_SUPP)
2248                         physical_layer |= IXGBE_PHYSICAL_LAYER_1000BASE_KX;
2249                 if (autoc & IXGBE_AUTOC_KX4_SUPP)
2250                         physical_layer |= IXGBE_PHYSICAL_LAYER_10GBASE_KX4;
2251                 if (autoc & IXGBE_AUTOC_KR_SUPP)
2252                         physical_layer |= IXGBE_PHYSICAL_LAYER_10GBASE_KR;
2253                 goto out;
2254                 break;
2255         default:
2256                 goto out;
2257                 break;
2258         }
2259
2260 sfp_check:
2261         /* SFP check must be done last since DA modules are sometimes used to
2262          * test KR mode -  we need to id KR mode correctly before SFP module.
2263          * Call identify_sfp because the pluggable module may have changed */
2264         physical_layer = ixgbe_get_supported_phy_sfp_layer_generic(hw);
2265 out:
2266         return physical_layer;
2267 }
2268
2269 /**
2270  *  ixgbe_enable_rx_dma_82599 - Enable the Rx DMA unit on 82599
2271  *  @hw: pointer to hardware structure
2272  *  @regval: register value to write to RXCTRL
2273  *
2274  *  Enables the Rx DMA unit for 82599
2275  **/
2276 s32 ixgbe_enable_rx_dma_82599(struct ixgbe_hw *hw, u32 regval)
2277 {
2278
2279         DEBUGFUNC("ixgbe_enable_rx_dma_82599");
2280
2281         /*
2282          * Workaround for 82599 silicon errata when enabling the Rx datapath.
2283          * If traffic is incoming before we enable the Rx unit, it could hang
2284          * the Rx DMA unit.  Therefore, make sure the security engine is
2285          * completely disabled prior to enabling the Rx unit.
2286          */
2287
2288         hw->mac.ops.disable_sec_rx_path(hw);
2289
2290         if (regval & IXGBE_RXCTRL_RXEN)
2291                 ixgbe_enable_rx(hw);
2292         else
2293                 ixgbe_disable_rx(hw);
2294
2295         hw->mac.ops.enable_sec_rx_path(hw);
2296
2297         return IXGBE_SUCCESS;
2298 }
2299
2300 /**
2301  *  ixgbe_verify_fw_version_82599 - verify FW version for 82599
2302  *  @hw: pointer to hardware structure
2303  *
2304  *  Verifies that installed the firmware version is 0.6 or higher
2305  *  for SFI devices. All 82599 SFI devices should have version 0.6 or higher.
2306  *
2307  *  Returns IXGBE_ERR_EEPROM_VERSION if the FW is not present or
2308  *  if the FW version is not supported.
2309  **/
2310 static s32 ixgbe_verify_fw_version_82599(struct ixgbe_hw *hw)
2311 {
2312         s32 status = IXGBE_ERR_EEPROM_VERSION;
2313         u16 fw_offset, fw_ptp_cfg_offset;
2314         u16 fw_version;
2315
2316         DEBUGFUNC("ixgbe_verify_fw_version_82599");
2317
2318         /* firmware check is only necessary for SFI devices */
2319         if (hw->phy.media_type != ixgbe_media_type_fiber) {
2320                 status = IXGBE_SUCCESS;
2321                 goto fw_version_out;
2322         }
2323
2324         /* get the offset to the Firmware Module block */
2325         if (hw->eeprom.ops.read(hw, IXGBE_FW_PTR, &fw_offset)) {
2326                 ERROR_REPORT2(IXGBE_ERROR_INVALID_STATE,
2327                               "eeprom read at offset %d failed", IXGBE_FW_PTR);
2328                 return IXGBE_ERR_EEPROM_VERSION;
2329         }
2330
2331         if ((fw_offset == 0) || (fw_offset == 0xFFFF))
2332                 goto fw_version_out;
2333
2334         /* get the offset to the Pass Through Patch Configuration block */
2335         if (hw->eeprom.ops.read(hw, (fw_offset +
2336                                  IXGBE_FW_PASSTHROUGH_PATCH_CONFIG_PTR),
2337                                  &fw_ptp_cfg_offset)) {
2338                 ERROR_REPORT2(IXGBE_ERROR_INVALID_STATE,
2339                               "eeprom read at offset %d failed",
2340                               fw_offset +
2341                               IXGBE_FW_PASSTHROUGH_PATCH_CONFIG_PTR);
2342                 return IXGBE_ERR_EEPROM_VERSION;
2343         }
2344
2345         if ((fw_ptp_cfg_offset == 0) || (fw_ptp_cfg_offset == 0xFFFF))
2346                 goto fw_version_out;
2347
2348         /* get the firmware version */
2349         if (hw->eeprom.ops.read(hw, (fw_ptp_cfg_offset +
2350                             IXGBE_FW_PATCH_VERSION_4), &fw_version)) {
2351                 ERROR_REPORT2(IXGBE_ERROR_INVALID_STATE,
2352                               "eeprom read at offset %d failed",
2353                               fw_ptp_cfg_offset + IXGBE_FW_PATCH_VERSION_4);
2354                 return IXGBE_ERR_EEPROM_VERSION;
2355         }
2356
2357         if (fw_version > 0x5)
2358                 status = IXGBE_SUCCESS;
2359
2360 fw_version_out:
2361         return status;
2362 }
2363
2364 /**
2365  *  ixgbe_verify_lesm_fw_enabled_82599 - Checks LESM FW module state.
2366  *  @hw: pointer to hardware structure
2367  *
2368  *  Returns TRUE if the LESM FW module is present and enabled. Otherwise
2369  *  returns FALSE. Smart Speed must be disabled if LESM FW module is enabled.
2370  **/
2371 bool ixgbe_verify_lesm_fw_enabled_82599(struct ixgbe_hw *hw)
2372 {
2373         bool lesm_enabled = FALSE;
2374         u16 fw_offset, fw_lesm_param_offset, fw_lesm_state;
2375         s32 status;
2376
2377         DEBUGFUNC("ixgbe_verify_lesm_fw_enabled_82599");
2378
2379         /* get the offset to the Firmware Module block */
2380         status = hw->eeprom.ops.read(hw, IXGBE_FW_PTR, &fw_offset);
2381
2382         if ((status != IXGBE_SUCCESS) ||
2383             (fw_offset == 0) || (fw_offset == 0xFFFF))
2384                 goto out;
2385
2386         /* get the offset to the LESM Parameters block */
2387         status = hw->eeprom.ops.read(hw, (fw_offset +
2388                                      IXGBE_FW_LESM_PARAMETERS_PTR),
2389                                      &fw_lesm_param_offset);
2390
2391         if ((status != IXGBE_SUCCESS) ||
2392             (fw_lesm_param_offset == 0) || (fw_lesm_param_offset == 0xFFFF))
2393                 goto out;
2394
2395         /* get the LESM state word */
2396         status = hw->eeprom.ops.read(hw, (fw_lesm_param_offset +
2397                                      IXGBE_FW_LESM_STATE_1),
2398                                      &fw_lesm_state);
2399
2400         if ((status == IXGBE_SUCCESS) &&
2401             (fw_lesm_state & IXGBE_FW_LESM_STATE_ENABLED))
2402                 lesm_enabled = TRUE;
2403
2404 out:
2405         return lesm_enabled;
2406 }
2407
2408 /**
2409  *  ixgbe_read_eeprom_buffer_82599 - Read EEPROM word(s) using
2410  *  fastest available method
2411  *
2412  *  @hw: pointer to hardware structure
2413  *  @offset: offset of  word in EEPROM to read
2414  *  @words: number of words
2415  *  @data: word(s) read from the EEPROM
2416  *
2417  *  Retrieves 16 bit word(s) read from EEPROM
2418  **/
2419 static s32 ixgbe_read_eeprom_buffer_82599(struct ixgbe_hw *hw, u16 offset,
2420                                           u16 words, u16 *data)
2421 {
2422         struct ixgbe_eeprom_info *eeprom = &hw->eeprom;
2423         s32 ret_val = IXGBE_ERR_CONFIG;
2424
2425         DEBUGFUNC("ixgbe_read_eeprom_buffer_82599");
2426
2427         /*
2428          * If EEPROM is detected and can be addressed using 14 bits,
2429          * use EERD otherwise use bit bang
2430          */
2431         if ((eeprom->type == ixgbe_eeprom_spi) &&
2432             (offset + (words - 1) <= IXGBE_EERD_MAX_ADDR))
2433                 ret_val = ixgbe_read_eerd_buffer_generic(hw, offset, words,
2434                                                          data);
2435         else
2436                 ret_val = ixgbe_read_eeprom_buffer_bit_bang_generic(hw, offset,
2437                                                                     words,
2438                                                                     data);
2439
2440         return ret_val;
2441 }
2442
2443 /**
2444  *  ixgbe_read_eeprom_82599 - Read EEPROM word using
2445  *  fastest available method
2446  *
2447  *  @hw: pointer to hardware structure
2448  *  @offset: offset of  word in the EEPROM to read
2449  *  @data: word read from the EEPROM
2450  *
2451  *  Reads a 16 bit word from the EEPROM
2452  **/
2453 static s32 ixgbe_read_eeprom_82599(struct ixgbe_hw *hw,
2454                                    u16 offset, u16 *data)
2455 {
2456         struct ixgbe_eeprom_info *eeprom = &hw->eeprom;
2457         s32 ret_val = IXGBE_ERR_CONFIG;
2458
2459         DEBUGFUNC("ixgbe_read_eeprom_82599");
2460
2461         /*
2462          * If EEPROM is detected and can be addressed using 14 bits,
2463          * use EERD otherwise use bit bang
2464          */
2465         if ((eeprom->type == ixgbe_eeprom_spi) &&
2466             (offset <= IXGBE_EERD_MAX_ADDR))
2467                 ret_val = ixgbe_read_eerd_generic(hw, offset, data);
2468         else
2469                 ret_val = ixgbe_read_eeprom_bit_bang_generic(hw, offset, data);
2470
2471         return ret_val;
2472 }
2473
2474 /**
2475  * ixgbe_reset_pipeline_82599 - perform pipeline reset
2476  *
2477  *  @hw: pointer to hardware structure
2478  *
2479  * Reset pipeline by asserting Restart_AN together with LMS change to ensure
2480  * full pipeline reset.  This function assumes the SW/FW lock is held.
2481  **/
2482 s32 ixgbe_reset_pipeline_82599(struct ixgbe_hw *hw)
2483 {
2484         s32 ret_val;
2485         u32 anlp1_reg = 0;
2486         u32 i, autoc_reg, autoc2_reg;
2487
2488         /* Enable link if disabled in NVM */
2489         autoc2_reg = IXGBE_READ_REG(hw, IXGBE_AUTOC2);
2490         if (autoc2_reg & IXGBE_AUTOC2_LINK_DISABLE_MASK) {
2491                 autoc2_reg &= ~IXGBE_AUTOC2_LINK_DISABLE_MASK;
2492                 IXGBE_WRITE_REG(hw, IXGBE_AUTOC2, autoc2_reg);
2493                 IXGBE_WRITE_FLUSH(hw);
2494         }
2495
2496         autoc_reg = IXGBE_READ_REG(hw, IXGBE_AUTOC);
2497         autoc_reg |= IXGBE_AUTOC_AN_RESTART;
2498         /* Write AUTOC register with toggled LMS[2] bit and Restart_AN */
2499         IXGBE_WRITE_REG(hw, IXGBE_AUTOC,
2500                         autoc_reg ^ (0x4 << IXGBE_AUTOC_LMS_SHIFT));
2501         /* Wait for AN to leave state 0 */
2502         for (i = 0; i < 10; i++) {
2503                 msec_delay(4);
2504                 anlp1_reg = IXGBE_READ_REG(hw, IXGBE_ANLP1);
2505                 if (anlp1_reg & IXGBE_ANLP1_AN_STATE_MASK)
2506                         break;
2507         }
2508
2509         if (!(anlp1_reg & IXGBE_ANLP1_AN_STATE_MASK)) {
2510                 DEBUGOUT("auto negotiation not completed\n");
2511                 ret_val = IXGBE_ERR_RESET_FAILED;
2512                 goto reset_pipeline_out;
2513         }
2514
2515         ret_val = IXGBE_SUCCESS;
2516
2517 reset_pipeline_out:
2518         /* Write AUTOC register with original LMS field and Restart_AN */
2519         IXGBE_WRITE_REG(hw, IXGBE_AUTOC, autoc_reg);
2520         IXGBE_WRITE_FLUSH(hw);
2521
2522         return ret_val;
2523 }
2524
2525 /**
2526  *  ixgbe_read_i2c_byte_82599 - Reads 8 bit word over I2C
2527  *  @hw: pointer to hardware structure
2528  *  @byte_offset: byte offset to read
2529  *  @dev_addr: address to read from
2530  *  @data: value read
2531  *
2532  *  Performs byte read operation to SFP module's EEPROM over I2C interface at
2533  *  a specified device address.
2534  **/
2535 static s32 ixgbe_read_i2c_byte_82599(struct ixgbe_hw *hw, u8 byte_offset,
2536                                 u8 dev_addr, u8 *data)
2537 {
2538         u32 esdp;
2539         s32 status;
2540         s32 timeout = 200;
2541
2542         DEBUGFUNC("ixgbe_read_i2c_byte_82599");
2543
2544         if (hw->phy.qsfp_shared_i2c_bus == TRUE) {
2545                 /* Acquire I2C bus ownership. */
2546                 esdp = IXGBE_READ_REG(hw, IXGBE_ESDP);
2547                 esdp |= IXGBE_ESDP_SDP0;
2548                 IXGBE_WRITE_REG(hw, IXGBE_ESDP, esdp);
2549                 IXGBE_WRITE_FLUSH(hw);
2550
2551                 while (timeout) {
2552                         esdp = IXGBE_READ_REG(hw, IXGBE_ESDP);
2553                         if (esdp & IXGBE_ESDP_SDP1)
2554                                 break;
2555
2556                         msec_delay(5);
2557                         timeout--;
2558                 }
2559
2560                 if (!timeout) {
2561                         DEBUGOUT("Driver can't access resource,"
2562                                  " acquiring I2C bus timeout.\n");
2563                         status = IXGBE_ERR_I2C;
2564                         goto release_i2c_access;
2565                 }
2566         }
2567
2568         status = ixgbe_read_i2c_byte_generic(hw, byte_offset, dev_addr, data);
2569
2570 release_i2c_access:
2571
2572         if (hw->phy.qsfp_shared_i2c_bus == TRUE) {
2573                 /* Release I2C bus ownership. */
2574                 esdp = IXGBE_READ_REG(hw, IXGBE_ESDP);
2575                 esdp &= ~IXGBE_ESDP_SDP0;
2576                 IXGBE_WRITE_REG(hw, IXGBE_ESDP, esdp);
2577                 IXGBE_WRITE_FLUSH(hw);
2578         }
2579
2580         return status;
2581 }
2582
2583 /**
2584  *  ixgbe_write_i2c_byte_82599 - Writes 8 bit word over I2C
2585  *  @hw: pointer to hardware structure
2586  *  @byte_offset: byte offset to write
2587  *  @dev_addr: address to read from
2588  *  @data: value to write
2589  *
2590  *  Performs byte write operation to SFP module's EEPROM over I2C interface at
2591  *  a specified device address.
2592  **/
2593 static s32 ixgbe_write_i2c_byte_82599(struct ixgbe_hw *hw, u8 byte_offset,
2594                                  u8 dev_addr, u8 data)
2595 {
2596         u32 esdp;
2597         s32 status;
2598         s32 timeout = 200;
2599
2600         DEBUGFUNC("ixgbe_write_i2c_byte_82599");
2601
2602         if (hw->phy.qsfp_shared_i2c_bus == TRUE) {
2603                 /* Acquire I2C bus ownership. */
2604                 esdp = IXGBE_READ_REG(hw, IXGBE_ESDP);
2605                 esdp |= IXGBE_ESDP_SDP0;
2606                 IXGBE_WRITE_REG(hw, IXGBE_ESDP, esdp);
2607                 IXGBE_WRITE_FLUSH(hw);
2608
2609                 while (timeout) {
2610                         esdp = IXGBE_READ_REG(hw, IXGBE_ESDP);
2611                         if (esdp & IXGBE_ESDP_SDP1)
2612                                 break;
2613
2614                         msec_delay(5);
2615                         timeout--;
2616                 }
2617
2618                 if (!timeout) {
2619                         DEBUGOUT("Driver can't access resource,"
2620                                  " acquiring I2C bus timeout.\n");
2621                         status = IXGBE_ERR_I2C;
2622                         goto release_i2c_access;
2623                 }
2624         }
2625
2626         status = ixgbe_write_i2c_byte_generic(hw, byte_offset, dev_addr, data);
2627
2628 release_i2c_access:
2629
2630         if (hw->phy.qsfp_shared_i2c_bus == TRUE) {
2631                 /* Release I2C bus ownership. */
2632                 esdp = IXGBE_READ_REG(hw, IXGBE_ESDP);
2633                 esdp &= ~IXGBE_ESDP_SDP0;
2634                 IXGBE_WRITE_REG(hw, IXGBE_ESDP, esdp);
2635                 IXGBE_WRITE_FLUSH(hw);
2636         }
2637
2638         return status;
2639 }