i40e: fix offloading of outer checksum for IPIP tunnel
[dpdk.git] / lib / librte_pmd_e1000 / e1000 / e1000_82575.c
index 60e870d..25fa672 100644 (file)
@@ -1,6 +1,6 @@
 /*******************************************************************************
 
-Copyright (c) 2001-2012, Intel Corporation
+Copyright (c) 2001-2014, Intel Corporation
 All rights reserved.
 
 Redistribution and use in source and binary forms, with or without
@@ -37,9 +37,12 @@ POSSIBILITY OF SUCH DAMAGE.
  * 82575GB Gigabit Network Connection
  * 82576 Gigabit Network Connection
  * 82576 Quad Port Gigabit Mezzanine Adapter
+ * 82580 Gigabit Network Connection
+ * I350 Gigabit Network Connection
  */
 
 #include "e1000_api.h"
+#include "e1000_i210.h"
 
 STATIC s32  e1000_init_phy_params_82575(struct e1000_hw *hw);
 STATIC s32  e1000_init_mac_params_82575(struct e1000_hw *hw);
@@ -48,37 +51,39 @@ STATIC void e1000_release_phy_82575(struct e1000_hw *hw);
 STATIC s32  e1000_acquire_nvm_82575(struct e1000_hw *hw);
 STATIC void e1000_release_nvm_82575(struct e1000_hw *hw);
 STATIC s32  e1000_check_for_link_82575(struct e1000_hw *hw);
+STATIC s32  e1000_check_for_link_media_swap(struct e1000_hw *hw);
 STATIC s32  e1000_get_cfg_done_82575(struct e1000_hw *hw);
 STATIC s32  e1000_get_link_up_info_82575(struct e1000_hw *hw, u16 *speed,
-                                         u16 *duplex);
-STATIC s32  e1000_init_hw_82575(struct e1000_hw *hw);
+                                        u16 *duplex);
 STATIC s32  e1000_phy_hw_reset_sgmii_82575(struct e1000_hw *hw);
 STATIC s32  e1000_read_phy_reg_sgmii_82575(struct e1000_hw *hw, u32 offset,
-                                           u16 *data);
+                                          u16 *data);
 STATIC s32  e1000_reset_hw_82575(struct e1000_hw *hw);
 STATIC s32  e1000_reset_hw_82580(struct e1000_hw *hw);
 STATIC s32  e1000_read_phy_reg_82580(struct e1000_hw *hw,
-                                    u32 offset, u16 *data);
+                                    u32 offset, u16 *data);
 STATIC s32  e1000_write_phy_reg_82580(struct e1000_hw *hw,
-                                     u32 offset, u16 data);
+                                     u32 offset, u16 data);
 STATIC s32  e1000_set_d0_lplu_state_82580(struct e1000_hw *hw,
-                                          bool active);
+                                         bool active);
 STATIC s32  e1000_set_d3_lplu_state_82580(struct e1000_hw *hw,
-                                          bool active);
+                                         bool active);
 STATIC s32  e1000_set_d0_lplu_state_82575(struct e1000_hw *hw,
-                                          bool active);
+                                         bool active);
 STATIC s32  e1000_setup_copper_link_82575(struct e1000_hw *hw);
 STATIC s32  e1000_setup_serdes_link_82575(struct e1000_hw *hw);
+STATIC s32  e1000_get_media_type_82575(struct e1000_hw *hw);
+STATIC s32  e1000_set_sfp_media_type_82575(struct e1000_hw *hw);
 STATIC s32  e1000_valid_led_default_82575(struct e1000_hw *hw, u16 *data);
 STATIC s32  e1000_write_phy_reg_sgmii_82575(struct e1000_hw *hw,
-                                            u32 offset, u16 data);
+                                           u32 offset, u16 data);
 STATIC void e1000_clear_hw_cntrs_82575(struct e1000_hw *hw);
 STATIC s32  e1000_acquire_swfw_sync_82575(struct e1000_hw *hw, u16 mask);
-static s32  e1000_get_pcs_speed_and_duplex_82575(struct e1000_hw *hw,
-                                                 u16 *speed, u16 *duplex);
-static s32  e1000_get_phy_id_82575(struct e1000_hw *hw);
+STATIC s32  e1000_get_pcs_speed_and_duplex_82575(struct e1000_hw *hw,
+                                                u16 *speed, u16 *duplex);
+STATIC s32  e1000_get_phy_id_82575(struct e1000_hw *hw);
 STATIC void e1000_release_swfw_sync_82575(struct e1000_hw *hw, u16 mask);
-static bool e1000_sgmii_active_82575(struct e1000_hw *hw);
+STATIC bool e1000_sgmii_active_82575(struct e1000_hw *hw);
 STATIC s32  e1000_reset_init_script_82575(struct e1000_hw *hw);
 STATIC s32  e1000_read_mac_addr_82575(struct e1000_hw *hw);
 STATIC void e1000_config_collision_dist_82575(struct e1000_hw *hw);
@@ -90,17 +95,31 @@ STATIC s32 e1000_reset_mdicnfg_82580(struct e1000_hw *hw);
 STATIC s32 e1000_validate_nvm_checksum_82580(struct e1000_hw *hw);
 STATIC s32 e1000_update_nvm_checksum_82580(struct e1000_hw *hw);
 STATIC s32 e1000_update_nvm_checksum_with_offset(struct e1000_hw *hw,
-                                               u16 offset);
+                                                u16 offset);
 STATIC s32 e1000_validate_nvm_checksum_with_offset(struct e1000_hw *hw,
-                                               u16 offset);
+                                                  u16 offset);
 STATIC s32 e1000_validate_nvm_checksum_i350(struct e1000_hw *hw);
 STATIC s32 e1000_update_nvm_checksum_i350(struct e1000_hw *hw);
-
-static const u16 e1000_82580_rxpbs_table[] =
-       { 36, 72, 144, 1, 2, 4, 8, 16,
-         35, 70, 140 };
+STATIC void e1000_write_vfta_i350(struct e1000_hw *hw, u32 offset, u32 value);
+STATIC void e1000_clear_vfta_i350(struct e1000_hw *hw);
+
+STATIC void e1000_i2c_start(struct e1000_hw *hw);
+STATIC void e1000_i2c_stop(struct e1000_hw *hw);
+STATIC s32 e1000_clock_in_i2c_byte(struct e1000_hw *hw, u8 *data);
+STATIC s32 e1000_clock_out_i2c_byte(struct e1000_hw *hw, u8 data);
+STATIC s32 e1000_get_i2c_ack(struct e1000_hw *hw);
+STATIC s32 e1000_clock_in_i2c_bit(struct e1000_hw *hw, bool *data);
+STATIC s32 e1000_clock_out_i2c_bit(struct e1000_hw *hw, bool data);
+STATIC void e1000_raise_i2c_clk(struct e1000_hw *hw, u32 *i2cctl);
+STATIC void e1000_lower_i2c_clk(struct e1000_hw *hw, u32 *i2cctl);
+STATIC s32 e1000_set_i2c_data(struct e1000_hw *hw, u32 *i2cctl, bool data);
+STATIC bool e1000_get_i2c_data(u32 *i2cctl);
+
+STATIC const u16 e1000_82580_rxpbs_table[] = {
+       36, 72, 144, 1, 2, 4, 8, 16, 35, 70, 140 };
 #define E1000_82580_RXPBS_TABLE_SIZE \
-       (sizeof(e1000_82580_rxpbs_table)/sizeof(u16))
+       (sizeof(e1000_82580_rxpbs_table) / \
+        sizeof(e1000_82580_rxpbs_table[0]))
 
 
 /**
@@ -125,6 +144,9 @@ STATIC bool e1000_sgmii_uses_mdio_82575(struct e1000_hw *hw)
                break;
        case e1000_82580:
        case e1000_i350:
+       case e1000_i354:
+       case e1000_i210:
+       case e1000_i211:
                reg = E1000_READ_REG(hw, E1000_MDICNFG);
                ext_mdio = !!(reg & E1000_MDICNFG_EXT_MDIO);
                break;
@@ -146,6 +168,9 @@ STATIC s32 e1000_init_phy_params_82575(struct e1000_hw *hw)
 
        DEBUGFUNC("e1000_init_phy_params_82575");
 
+       phy->ops.read_i2c_byte = e1000_read_i2c_byte_generic;
+       phy->ops.write_i2c_byte = e1000_write_i2c_byte_generic;
+
        if (hw->phy.media_type != e1000_media_type_copper) {
                phy->type = e1000_phy_none;
                goto out;
@@ -154,22 +179,22 @@ STATIC s32 e1000_init_phy_params_82575(struct e1000_hw *hw)
        phy->ops.power_up   = e1000_power_up_phy_copper;
        phy->ops.power_down = e1000_power_down_phy_copper_82575;
 
-       phy->autoneg_mask           = AUTONEG_ADVERTISE_SPEED_DEFAULT;
-       phy->reset_delay_us         = 100;
+       phy->autoneg_mask       = AUTONEG_ADVERTISE_SPEED_DEFAULT;
+       phy->reset_delay_us     = 100;
 
-       phy->ops.acquire            = e1000_acquire_phy_82575;
-       phy->ops.check_reset_block  = e1000_check_reset_block_generic;
-       phy->ops.commit             = e1000_phy_sw_reset_generic;
-       phy->ops.get_cfg_done       = e1000_get_cfg_done_82575;
-       phy->ops.release            = e1000_release_phy_82575;
+       phy->ops.acquire        = e1000_acquire_phy_82575;
+       phy->ops.check_reset_block = e1000_check_reset_block_generic;
+       phy->ops.commit         = e1000_phy_sw_reset_generic;
+       phy->ops.get_cfg_done   = e1000_get_cfg_done_82575;
+       phy->ops.release        = e1000_release_phy_82575;
 
        ctrl_ext = E1000_READ_REG(hw, E1000_CTRL_EXT);
 
        if (e1000_sgmii_active_82575(hw)) {
-               phy->ops.reset      = e1000_phy_hw_reset_sgmii_82575;
+               phy->ops.reset = e1000_phy_hw_reset_sgmii_82575;
                ctrl_ext |= E1000_CTRL_I2C_ENA;
        } else {
-               phy->ops.reset      = e1000_phy_hw_reset_generic;
+               phy->ops.reset = e1000_phy_hw_reset_generic;
                ctrl_ext &= ~E1000_CTRL_I2C_ENA;
        }
 
@@ -177,14 +202,25 @@ STATIC s32 e1000_init_phy_params_82575(struct e1000_hw *hw)
        e1000_reset_mdicnfg_82580(hw);
 
        if (e1000_sgmii_active_82575(hw) && !e1000_sgmii_uses_mdio_82575(hw)) {
-               phy->ops.read_reg   = e1000_read_phy_reg_sgmii_82575;
-               phy->ops.write_reg  = e1000_write_phy_reg_sgmii_82575;
-       } else if (hw->mac.type >= e1000_82580) {
-               phy->ops.read_reg   = e1000_read_phy_reg_82580;
-               phy->ops.write_reg  = e1000_write_phy_reg_82580;
+               phy->ops.read_reg = e1000_read_phy_reg_sgmii_82575;
+               phy->ops.write_reg = e1000_write_phy_reg_sgmii_82575;
        } else {
-               phy->ops.read_reg   = e1000_read_phy_reg_igp;
-               phy->ops.write_reg  = e1000_write_phy_reg_igp;
+               switch (hw->mac.type) {
+               case e1000_82580:
+               case e1000_i350:
+               case e1000_i354:
+                       phy->ops.read_reg = e1000_read_phy_reg_82580;
+                       phy->ops.write_reg = e1000_write_phy_reg_82580;
+                       break;
+               case e1000_i210:
+               case e1000_i211:
+                       phy->ops.read_reg = e1000_read_phy_reg_gs40g;
+                       phy->ops.write_reg = e1000_write_phy_reg_gs40g;
+                       break;
+               default:
+                       phy->ops.read_reg = e1000_read_phy_reg_igp;
+                       phy->ops.write_reg = e1000_write_phy_reg_igp;
+               }
        }
 
        /* Set phy->phy_addr and phy->id. */
@@ -192,42 +228,85 @@ STATIC s32 e1000_init_phy_params_82575(struct e1000_hw *hw)
 
        /* Verify phy id and set remaining function pointers */
        switch (phy->id) {
+       case M88E1543_E_PHY_ID:
+       case M88E1512_E_PHY_ID:
        case I347AT4_E_PHY_ID:
        case M88E1112_E_PHY_ID:
        case M88E1340M_E_PHY_ID:
        case M88E1111_I_PHY_ID:
-               phy->type                   = e1000_phy_m88;
-               phy->ops.check_polarity     = e1000_check_polarity_m88;
-               phy->ops.get_info           = e1000_get_phy_info_m88;
+               phy->type               = e1000_phy_m88;
+               phy->ops.check_polarity = e1000_check_polarity_m88;
+               phy->ops.get_info       = e1000_get_phy_info_m88;
                if (phy->id == I347AT4_E_PHY_ID ||
                    phy->id == M88E1112_E_PHY_ID ||
                    phy->id == M88E1340M_E_PHY_ID)
                        phy->ops.get_cable_length =
                                         e1000_get_cable_length_m88_gen2;
+               else if (phy->id == M88E1543_E_PHY_ID ||
+                        phy->id == M88E1512_E_PHY_ID)
+                       phy->ops.get_cable_length =
+                                        e1000_get_cable_length_m88_gen2;
                else
                        phy->ops.get_cable_length = e1000_get_cable_length_m88;
                phy->ops.force_speed_duplex = e1000_phy_force_speed_duplex_m88;
+               /* Check if this PHY is confgured for media swap. */
+               if (phy->id == M88E1112_E_PHY_ID) {
+                       u16 data;
+
+                       ret_val = phy->ops.write_reg(hw,
+                                                    E1000_M88E1112_PAGE_ADDR,
+                                                    2);
+                       if (ret_val)
+                               goto out;
+
+                       ret_val = phy->ops.read_reg(hw,
+                                                   E1000_M88E1112_MAC_CTRL_1,
+                                                   &data);
+                       if (ret_val)
+                               goto out;
+
+                       data = (data & E1000_M88E1112_MAC_CTRL_1_MODE_MASK) >>
+                              E1000_M88E1112_MAC_CTRL_1_MODE_SHIFT;
+                       if (data == E1000_M88E1112_AUTO_COPPER_SGMII ||
+                           data == E1000_M88E1112_AUTO_COPPER_BASEX)
+                               hw->mac.ops.check_for_link =
+                                               e1000_check_for_link_media_swap;
+               }
+               if (phy->id == M88E1512_E_PHY_ID) {
+                       ret_val = e1000_initialize_M88E1512_phy(hw);
+                       if (ret_val)
+                               goto out;
+               }
                break;
        case IGP03E1000_E_PHY_ID:
        case IGP04E1000_E_PHY_ID:
-               phy->type                   = e1000_phy_igp_3;
-               phy->ops.check_polarity     = e1000_check_polarity_igp;
-               phy->ops.get_info           = e1000_get_phy_info_igp;
-               phy->ops.get_cable_length   = e1000_get_cable_length_igp_2;
+               phy->type = e1000_phy_igp_3;
+               phy->ops.check_polarity = e1000_check_polarity_igp;
+               phy->ops.get_info = e1000_get_phy_info_igp;
+               phy->ops.get_cable_length = e1000_get_cable_length_igp_2;
                phy->ops.force_speed_duplex = e1000_phy_force_speed_duplex_igp;
-               phy->ops.set_d0_lplu_state  = e1000_set_d0_lplu_state_82575;
-               phy->ops.set_d3_lplu_state  = e1000_set_d3_lplu_state_generic;
+               phy->ops.set_d0_lplu_state = e1000_set_d0_lplu_state_82575;
+               phy->ops.set_d3_lplu_state = e1000_set_d3_lplu_state_generic;
                break;
        case I82580_I_PHY_ID:
        case I350_I_PHY_ID:
-               phy->type                   = e1000_phy_82580;
-               phy->ops.check_polarity     = e1000_check_polarity_82577;
+               phy->type = e1000_phy_82580;
+               phy->ops.check_polarity = e1000_check_polarity_82577;
                phy->ops.force_speed_duplex =
                                         e1000_phy_force_speed_duplex_82577;
-               phy->ops.get_cable_length   = e1000_get_cable_length_82577;
-               phy->ops.get_info           = e1000_get_phy_info_82577;
-               phy->ops.set_d0_lplu_state  = e1000_set_d0_lplu_state_82580;
-               phy->ops.set_d3_lplu_state  = e1000_set_d3_lplu_state_82580;
+               phy->ops.get_cable_length = e1000_get_cable_length_82577;
+               phy->ops.get_info = e1000_get_phy_info_82577;
+               phy->ops.set_d0_lplu_state = e1000_set_d0_lplu_state_82580;
+               phy->ops.set_d3_lplu_state = e1000_set_d3_lplu_state_82580;
+               break;
+       case I210_I_PHY_ID:
+               phy->type               = e1000_phy_i210;
+               phy->ops.check_polarity = e1000_check_polarity_m88;
+               phy->ops.get_info       = e1000_get_phy_info_m88;
+               phy->ops.get_cable_length = e1000_get_cable_length_m88_gen2;
+               phy->ops.set_d0_lplu_state = e1000_set_d0_lplu_state_82580;
+               phy->ops.set_d3_lplu_state = e1000_set_d3_lplu_state_82580;
+               phy->ops.force_speed_duplex = e1000_phy_force_speed_duplex_m88;
                break;
        default:
                ret_val = -E1000_ERR_PHY;
@@ -251,49 +330,59 @@ s32 e1000_init_nvm_params_82575(struct e1000_hw *hw)
        DEBUGFUNC("e1000_init_nvm_params_82575");
 
        size = (u16)((eecd & E1000_EECD_SIZE_EX_MASK) >>
-                    E1000_EECD_SIZE_EX_SHIFT);
+                    E1000_EECD_SIZE_EX_SHIFT);
        /*
         * Added to a constant, "size" becomes the left-shift value
         * for setting word_size.
         */
        size += NVM_WORD_SIZE_BASE_SHIFT;
 
+       /* Just in case size is out of range, cap it to the largest
+        * EEPROM size supported
+        */
+       if (size > 15)
+               size = 15;
+
        nvm->word_size = 1 << size;
-       nvm->opcode_bits        = 8;
-       nvm->delay_usec         = 1;
-       switch (nvm->override) {
-       case e1000_nvm_override_spi_large:
-               nvm->page_size    = 32;
-               nvm->address_bits = 16;
-               break;
-       case e1000_nvm_override_spi_small:
-               nvm->page_size    = 8;
-               nvm->address_bits = 8;
-               break;
-       default:
-               nvm->page_size    = eecd & E1000_EECD_ADDR_BITS ? 32 : 8;
+       if (hw->mac.type < e1000_i210) {
+               nvm->opcode_bits = 8;
+               nvm->delay_usec = 1;
+
+               switch (nvm->override) {
+               case e1000_nvm_override_spi_large:
+                       nvm->page_size = 32;
+                       nvm->address_bits = 16;
+                       break;
+               case e1000_nvm_override_spi_small:
+                       nvm->page_size = 8;
+                       nvm->address_bits = 8;
+                       break;
+               default:
+                       nvm->page_size = eecd & E1000_EECD_ADDR_BITS ? 32 : 8;
                        nvm->address_bits = eecd & E1000_EECD_ADDR_BITS ?
                                            16 : 8;
-               break;
-       }
-
-       nvm->type = e1000_nvm_eeprom_spi;
+                       break;
+               }
+               if (nvm->word_size == (1 << 15))
+                       nvm->page_size = 128;
 
-       if (nvm->word_size == (1 << 15))
-               nvm->page_size = 128;
+               nvm->type = e1000_nvm_eeprom_spi;
+       } else {
+               nvm->type = e1000_nvm_flash_hw;
+       }
 
        /* Function Pointers */
-       nvm->ops.acquire    = e1000_acquire_nvm_82575;
-       nvm->ops.release    = e1000_release_nvm_82575;
+       nvm->ops.acquire = e1000_acquire_nvm_82575;
+       nvm->ops.release = e1000_release_nvm_82575;
        if (nvm->word_size < (1 << 15))
-               nvm->ops.read    = e1000_read_nvm_eerd;
+               nvm->ops.read = e1000_read_nvm_eerd;
        else
-               nvm->ops.read    = e1000_read_nvm_spi;
+               nvm->ops.read = e1000_read_nvm_spi;
 
-       nvm->ops.write              = e1000_write_nvm_spi;
-       nvm->ops.validate           = e1000_validate_nvm_checksum_generic;
-       nvm->ops.update             = e1000_update_nvm_checksum_generic;
-       nvm->ops.valid_led_default  = e1000_valid_led_default_82575;
+       nvm->ops.write = e1000_write_nvm_spi;
+       nvm->ops.validate = e1000_validate_nvm_checksum_generic;
+       nvm->ops.update = e1000_update_nvm_checksum_generic;
+       nvm->ops.valid_led_default = e1000_valid_led_default_82575;
 
        /* override generic family function pointers for specific descendants */
        switch (hw->mac.type) {
@@ -302,6 +391,7 @@ s32 e1000_init_nvm_params_82575(struct e1000_hw *hw)
                nvm->ops.update = e1000_update_nvm_checksum_82580;
                break;
        case e1000_i350:
+       case e1000_i354:
                nvm->ops.validate = e1000_validate_nvm_checksum_i350;
                nvm->ops.update = e1000_update_nvm_checksum_i350;
                break;
@@ -320,34 +410,11 @@ STATIC s32 e1000_init_mac_params_82575(struct e1000_hw *hw)
 {
        struct e1000_mac_info *mac = &hw->mac;
        struct e1000_dev_spec_82575 *dev_spec = &hw->dev_spec._82575;
-       u32 ctrl_ext = 0;
 
        DEBUGFUNC("e1000_init_mac_params_82575");
 
-       /* Set media type */
-        /*
-        * The 82575 uses bits 22:23 for link mode. The mode can be changed
-         * based on the EEPROM. We cannot rely upon device ID. There
-         * is no distinguishable difference between fiber and internal
-         * SerDes mode on the 82575. There can be an external PHY attached
-         * on the SGMII interface. For this, we'll set sgmii_active to TRUE.
-         */
-       hw->phy.media_type = e1000_media_type_copper;
-       dev_spec->sgmii_active = FALSE;
-
-       ctrl_ext = E1000_READ_REG(hw, E1000_CTRL_EXT);
-       switch (ctrl_ext & E1000_CTRL_EXT_LINK_MODE_MASK) {
-       case E1000_CTRL_EXT_LINK_MODE_SGMII:
-               dev_spec->sgmii_active = TRUE;
-               break;
-       case E1000_CTRL_EXT_LINK_MODE_1000BASE_KX:
-       case E1000_CTRL_EXT_LINK_MODE_PCIE_SERDES:
-               hw->phy.media_type = e1000_media_type_internal_serdes;
-               break;
-       default:
-               break;
-       }
-
+       /* Derives media type */
+       e1000_get_media_type_82575(hw);
        /* Set mta register count */
        mac->mta_reg_count = 128;
        /* Set uta register count */
@@ -358,11 +425,16 @@ STATIC s32 e1000_init_mac_params_82575(struct e1000_hw *hw)
                mac->rar_entry_count = E1000_RAR_ENTRIES_82576;
        if (mac->type == e1000_82580)
                mac->rar_entry_count = E1000_RAR_ENTRIES_82580;
-       if (mac->type == e1000_i350) {
+       if (mac->type == e1000_i350 || mac->type == e1000_i354)
                mac->rar_entry_count = E1000_RAR_ENTRIES_I350;
-               /* Enable EEE default settings for i350 */
+
+       /* Enable EEE default settings for EEE supported devices */
+       if (mac->type >= e1000_i350)
                dev_spec->eee_disable = false;
-       }
+
+       /* Allow a single clear of the SW semaphore on I210 and newer */
+       if (mac->type >= e1000_i210)
+               dev_spec->clear_semaphore_once = true;
 
        /* Set if part includes ASF firmware */
        mac->asf_firmware_present = true;
@@ -382,12 +454,15 @@ STATIC s32 e1000_init_mac_params_82575(struct e1000_hw *hw)
        else
        mac->ops.reset_hw = e1000_reset_hw_82575;
        /* hw initialization */
+       if ((mac->type == e1000_i210) || (mac->type == e1000_i211))
+               mac->ops.init_hw = e1000_init_hw_i210;
+       else
        mac->ops.init_hw = e1000_init_hw_82575;
        /* link setup */
        mac->ops.setup_link = e1000_setup_link_generic;
        /* physical interface link setup */
        mac->ops.setup_physical_interface =
-               (hw->phy.media_type == e1000_media_type_copper)
+               (hw->phy.media_type == e1000_media_type_copper)
                ? e1000_setup_copper_link_82575 : e1000_setup_serdes_link_82575;
        /* physical interface shutdown */
        mac->ops.shutdown_serdes = e1000_shutdown_serdes_link_82575;
@@ -395,18 +470,26 @@ STATIC s32 e1000_init_mac_params_82575(struct e1000_hw *hw)
        mac->ops.power_up_serdes = e1000_power_up_serdes_link_82575;
        /* check for link */
        mac->ops.check_for_link = e1000_check_for_link_82575;
-       /* receive address register setting */
-       mac->ops.rar_set = e1000_rar_set_generic;
        /* read mac address */
        mac->ops.read_mac_addr = e1000_read_mac_addr_82575;
        /* configure collision distance */
        mac->ops.config_collision_dist = e1000_config_collision_dist_82575;
        /* multicast address update */
        mac->ops.update_mc_addr_list = e1000_update_mc_addr_list_generic;
-       /* writing VFTA */
-       mac->ops.write_vfta = e1000_write_vfta_generic;
-       /* clearing VFTA */
-       mac->ops.clear_vfta = e1000_clear_vfta_generic;
+       if (hw->mac.type == e1000_i350 || mac->type == e1000_i354) {
+               /* writing VFTA */
+               mac->ops.write_vfta = e1000_write_vfta_i350;
+               /* clearing VFTA */
+               mac->ops.clear_vfta = e1000_clear_vfta_i350;
+       } else {
+               /* writing VFTA */
+               mac->ops.write_vfta = e1000_write_vfta_generic;
+               /* clearing VFTA */
+               mac->ops.clear_vfta = e1000_clear_vfta_generic;
+       }
+       if (hw->mac.type >= e1000_82580)
+               mac->ops.validate_mdi_setting =
+                               e1000_validate_mdi_setting_crossover_generic;
        /* ID LED init */
        mac->ops.id_led_init = e1000_id_led_init_generic;
        /* blink LED */
@@ -422,6 +505,13 @@ STATIC s32 e1000_init_mac_params_82575(struct e1000_hw *hw)
        mac->ops.clear_hw_cntrs = e1000_clear_hw_cntrs_82575;
        /* link info */
        mac->ops.get_link_up_info = e1000_get_link_up_info_82575;
+       /* acquire SW_FW sync */
+       mac->ops.acquire_swfw_sync = e1000_acquire_swfw_sync_82575;
+       mac->ops.release_swfw_sync = e1000_release_swfw_sync_82575;
+       if (mac->type >= e1000_i210) {
+               mac->ops.acquire_swfw_sync = e1000_acquire_swfw_sync_i210;
+               mac->ops.release_swfw_sync = e1000_release_swfw_sync_i210;
+       }
 
        /* set lan id for port to determine which phy lock to use */
        hw->mac.ops.set_lan_id(hw);
@@ -464,7 +554,7 @@ STATIC s32 e1000_acquire_phy_82575(struct e1000_hw *hw)
        else if (hw->bus.func == E1000_FUNC_3)
                mask = E1000_SWFW_PHY3_SM;
 
-       return e1000_acquire_swfw_sync_82575(hw, mask);
+       return hw->mac.ops.acquire_swfw_sync(hw, mask);
 }
 
 /**
@@ -486,7 +576,7 @@ STATIC void e1000_release_phy_82575(struct e1000_hw *hw)
        else if (hw->bus.func == E1000_FUNC_3)
                mask = E1000_SWFW_PHY3_SM;
 
-       e1000_release_swfw_sync_82575(hw, mask);
+       hw->mac.ops.release_swfw_sync(hw, mask);
 }
 
 /**
@@ -499,7 +589,7 @@ STATIC void e1000_release_phy_82575(struct e1000_hw *hw)
  *  interface and stores the retrieved information in data.
  **/
 STATIC s32 e1000_read_phy_reg_sgmii_82575(struct e1000_hw *hw, u32 offset,
-                                          u16 *data)
+                                         u16 *data)
 {
        s32 ret_val = -E1000_ERR_PARAM;
 
@@ -532,7 +622,7 @@ out:
  *  media independent interface.
  **/
 STATIC s32 e1000_write_phy_reg_sgmii_82575(struct e1000_hw *hw, u32 offset,
-                                           u16 data)
+                                          u16 data)
 {
        s32 ret_val = -E1000_ERR_PARAM;
 
@@ -572,6 +662,10 @@ STATIC s32 e1000_get_phy_id_82575(struct e1000_hw *hw)
 
        DEBUGFUNC("e1000_get_phy_id_82575");
 
+       /* some i354 devices need an extra read for phy id */
+       if (hw->mac.type == e1000_i354)
+               e1000_get_phy_id(hw);
+
        /*
         * For SGMII PHYs, we try the list of possible addresses until
         * we find one that works.  For non-SGMII PHYs
@@ -595,6 +689,9 @@ STATIC s32 e1000_get_phy_id_82575(struct e1000_hw *hw)
                        break;
                case e1000_82580:
                case e1000_i350:
+               case e1000_i354:
+               case e1000_i210:
+               case e1000_i211:
                        mdic = E1000_READ_REG(hw, E1000_MDICNFG);
                        mdic &= E1000_MDICNFG_PHY_MASK;
                        phy->addr = mdic >> E1000_MDICNFG_PHY_SHIFT;
@@ -611,7 +708,7 @@ STATIC s32 e1000_get_phy_id_82575(struct e1000_hw *hw)
        /* Power on sgmii phy if it is disabled */
        ctrl_ext = E1000_READ_REG(hw, E1000_CTRL_EXT);
        E1000_WRITE_REG(hw, E1000_CTRL_EXT,
-                       ctrl_ext & ~E1000_CTRL_EXT_SDP3_DATA);
+                       ctrl_ext & ~E1000_CTRL_EXT_SDP3_DATA);
        E1000_WRITE_FLUSH(hw);
        msec_delay(300);
 
@@ -632,7 +729,7 @@ STATIC s32 e1000_get_phy_id_82575(struct e1000_hw *hw)
                                break;
                } else {
                        DEBUGOUT1("PHY address %u was unreadable\n",
-                                 phy->addr);
+                                 phy->addr);
                }
        }
 
@@ -660,6 +757,7 @@ out:
 STATIC s32 e1000_phy_hw_reset_sgmii_82575(struct e1000_hw *hw)
 {
        s32 ret_val = E1000_SUCCESS;
+       struct e1000_phy_info *phy = &hw->phy;
 
        DEBUGFUNC("e1000_phy_hw_reset_sgmii_82575");
 
@@ -682,7 +780,11 @@ STATIC s32 e1000_phy_hw_reset_sgmii_82575(struct e1000_hw *hw)
                goto out;
 
        ret_val = hw->phy.ops.commit(hw);
+       if (ret_val)
+               goto out;
 
+       if (phy->id == M88E1512_E_PHY_ID)
+               ret_val = e1000_initialize_M88E1512_phy(hw);
 out:
        return ret_val;
 }
@@ -718,22 +820,22 @@ STATIC s32 e1000_set_d0_lplu_state_82575(struct e1000_hw *hw, bool active)
        if (active) {
                data |= IGP02E1000_PM_D0_LPLU;
                ret_val = phy->ops.write_reg(hw, IGP02E1000_PHY_POWER_MGMT,
-                                            data);
+                                            data);
                if (ret_val)
                        goto out;
 
                /* When LPLU is enabled, we should disable SmartSpeed */
                ret_val = phy->ops.read_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
-                                           &data);
+                                           &data);
                data &= ~IGP01E1000_PSCFR_SMART_SPEED;
                ret_val = phy->ops.write_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
-                                            data);
+                                            data);
                if (ret_val)
                        goto out;
        } else {
                data &= ~IGP02E1000_PM_D0_LPLU;
                ret_val = phy->ops.write_reg(hw, IGP02E1000_PHY_POWER_MGMT,
-                                            data);
+                                            data);
                /*
                 * LPLU and SmartSpeed are mutually exclusive.  LPLU is used
                 * during Dx states where the power conservation is most
@@ -742,28 +844,28 @@ STATIC s32 e1000_set_d0_lplu_state_82575(struct e1000_hw *hw, bool active)
                 */
                if (phy->smart_speed == e1000_smart_speed_on) {
                        ret_val = phy->ops.read_reg(hw,
-                                                   IGP01E1000_PHY_PORT_CONFIG,
-                                                   &data);
+                                                   IGP01E1000_PHY_PORT_CONFIG,
+                                                   &data);
                        if (ret_val)
                                goto out;
 
                        data |= IGP01E1000_PSCFR_SMART_SPEED;
                        ret_val = phy->ops.write_reg(hw,
-                                                    IGP01E1000_PHY_PORT_CONFIG,
-                                                    data);
+                                                    IGP01E1000_PHY_PORT_CONFIG,
+                                                    data);
                        if (ret_val)
                                goto out;
                } else if (phy->smart_speed == e1000_smart_speed_off) {
                        ret_val = phy->ops.read_reg(hw,
-                                                   IGP01E1000_PHY_PORT_CONFIG,
-                                                   &data);
+                                                   IGP01E1000_PHY_PORT_CONFIG,
+                                                   &data);
                        if (ret_val)
                                goto out;
 
                        data &= ~IGP01E1000_PSCFR_SMART_SPEED;
                        ret_val = phy->ops.write_reg(hw,
-                                                    IGP01E1000_PHY_PORT_CONFIG,
-                                                    data);
+                                                    IGP01E1000_PHY_PORT_CONFIG,
+                                                    data);
                        if (ret_val)
                                goto out;
                }
@@ -790,7 +892,7 @@ STATIC s32 e1000_set_d0_lplu_state_82580(struct e1000_hw *hw, bool active)
 {
        struct e1000_phy_info *phy = &hw->phy;
        s32 ret_val = E1000_SUCCESS;
-       u16 data;
+       u32 data;
 
        DEBUGFUNC("e1000_set_d0_lplu_state_82580");
 
@@ -814,7 +916,7 @@ STATIC s32 e1000_set_d0_lplu_state_82580(struct e1000_hw *hw, bool active)
                        data |= E1000_82580_PM_SPD;
                else if (phy->smart_speed == e1000_smart_speed_off)
                        data &= ~E1000_82580_PM_SPD;
-               }
+       }
 
        E1000_WRITE_REG(hw, E1000_82580_PHY_POWER_MGMT, data);
        return ret_val;
@@ -838,7 +940,7 @@ s32 e1000_set_d3_lplu_state_82580(struct e1000_hw *hw, bool active)
 {
        struct e1000_phy_info *phy = &hw->phy;
        s32 ret_val = E1000_SUCCESS;
-       u16 data;
+       u32 data;
 
        DEBUGFUNC("e1000_set_d3_lplu_state_82580");
 
@@ -857,8 +959,8 @@ s32 e1000_set_d3_lplu_state_82580(struct e1000_hw *hw, bool active)
                else if (phy->smart_speed == e1000_smart_speed_off)
                        data &= ~E1000_82580_PM_SPD;
        } else if ((phy->autoneg_advertised == E1000_ALL_SPEED_DUPLEX) ||
-                  (phy->autoneg_advertised == E1000_ALL_NOT_GIG) ||
-                  (phy->autoneg_advertised == E1000_ALL_10_SPEED)) {
+                  (phy->autoneg_advertised == E1000_ALL_NOT_GIG) ||
+                  (phy->autoneg_advertised == E1000_ALL_10_SPEED)) {
                data |= E1000_82580_PM_D3_LPLU;
                /* When LPLU is enabled, we should disable SmartSpeed */
                data &= ~E1000_82580_PM_SPD;
@@ -931,6 +1033,8 @@ STATIC void e1000_release_nvm_82575(struct e1000_hw *hw)
 {
        DEBUGFUNC("e1000_release_nvm_82575");
 
+       e1000_release_nvm_generic(hw);
+
        e1000_release_swfw_sync_82575(hw, E1000_SWFW_EEP_SM);
 }
 
@@ -1062,7 +1166,7 @@ STATIC s32 e1000_get_cfg_done_82575(struct e1000_hw *hw)
  *  Otherwise, use the generic function to get the link speed and duplex info.
  **/
 STATIC s32 e1000_get_link_up_info_82575(struct e1000_hw *hw, u16 *speed,
-                                        u16 *duplex)
+                                       u16 *duplex)
 {
        s32 ret_val;
 
@@ -1070,10 +1174,10 @@ STATIC s32 e1000_get_link_up_info_82575(struct e1000_hw *hw, u16 *speed,
 
        if (hw->phy.media_type != e1000_media_type_copper)
                ret_val = e1000_get_pcs_speed_and_duplex_82575(hw, speed,
-                                                              duplex);
+                                                              duplex);
        else
                ret_val = e1000_get_speed_and_duplex_copper_generic(hw, speed,
-                                                                   duplex);
+                                                                   duplex);
 
        return ret_val;
 }
@@ -1094,13 +1198,23 @@ STATIC s32 e1000_check_for_link_82575(struct e1000_hw *hw)
 
        if (hw->phy.media_type != e1000_media_type_copper) {
                ret_val = e1000_get_pcs_speed_and_duplex_82575(hw, &speed,
-                                                              &duplex);
+                                                              &duplex);
                /*
                 * Use this flag to determine if link needs to be checked or
                 * not.  If we have link clear the flag so that we do not
                 * continue to check for link.
                 */
                hw->mac.get_link_status = !hw->mac.serdes_has_link;
+
+               /*
+                * Configure Flow Control now that Auto-Neg has completed.
+                * First, we need to restore the desired flow control
+                * settings because we may have had to re-autoneg with a
+                * different link partner.
+                */
+               ret_val = e1000_config_fc_after_link_up_generic(hw);
+               if (ret_val)
+                       DEBUGOUT("Error configuring flow control\n");
        } else {
                ret_val = e1000_check_for_copper_link_generic(hw);
        }
@@ -1108,6 +1222,61 @@ STATIC s32 e1000_check_for_link_82575(struct e1000_hw *hw)
        return ret_val;
 }
 
+/**
+ *  e1000_check_for_link_media_swap - Check which M88E1112 interface linked
+ *  @hw: pointer to the HW structure
+ *
+ *  Poll the M88E1112 interfaces to see which interface achieved link.
+ */
+STATIC s32 e1000_check_for_link_media_swap(struct e1000_hw *hw)
+{
+       struct e1000_phy_info *phy = &hw->phy;
+       s32 ret_val;
+       u16 data;
+       u8 port = 0;
+
+       DEBUGFUNC("e1000_check_for_link_media_swap");
+
+       /* Check the copper medium. */
+       ret_val = phy->ops.write_reg(hw, E1000_M88E1112_PAGE_ADDR, 0);
+       if (ret_val)
+               return ret_val;
+
+       ret_val = phy->ops.read_reg(hw, E1000_M88E1112_STATUS, &data);
+       if (ret_val)
+               return ret_val;
+
+       if (data & E1000_M88E1112_STATUS_LINK)
+               port = E1000_MEDIA_PORT_COPPER;
+
+       /* Check the other medium. */
+       ret_val = phy->ops.write_reg(hw, E1000_M88E1112_PAGE_ADDR, 1);
+       if (ret_val)
+               return ret_val;
+
+       ret_val = phy->ops.read_reg(hw, E1000_M88E1112_STATUS, &data);
+       if (ret_val)
+               return ret_val;
+
+       /* reset page to 0 */
+       ret_val = phy->ops.write_reg(hw, E1000_M88E1112_PAGE_ADDR, 0);
+       if (ret_val)
+               return ret_val;
+
+       if (data & E1000_M88E1112_STATUS_LINK)
+               port = E1000_MEDIA_PORT_OTHER;
+
+       /* Determine if a swap needs to happen. */
+       if (port && (hw->dev_spec._82575.media_port != port)) {
+               hw->dev_spec._82575.media_port = port;
+               hw->dev_spec._82575.media_changed = true;
+       } else {
+               ret_val = e1000_check_for_link_82575(hw);
+       }
+
+       return E1000_SUCCESS;
+}
+
 /**
  *  e1000_power_up_serdes_link_82575 - Power up the serdes link after shutdown
  *  @hw: pointer to the HW structure
@@ -1146,19 +1315,15 @@ STATIC void e1000_power_up_serdes_link_82575(struct e1000_hw *hw)
  *  Using the physical coding sub-layer (PCS), retrieve the current speed and
  *  duplex, then store the values in the pointers provided.
  **/
-static s32 e1000_get_pcs_speed_and_duplex_82575(struct e1000_hw *hw,
-                                                u16 *speed, u16 *duplex)
+STATIC s32 e1000_get_pcs_speed_and_duplex_82575(struct e1000_hw *hw,
+                                               u16 *speed, u16 *duplex)
 {
        struct e1000_mac_info *mac = &hw->mac;
        u32 pcs;
+       u32 status;
 
        DEBUGFUNC("e1000_get_pcs_speed_and_duplex_82575");
 
-       /* Set up defaults for the return values of this function */
-       mac->serdes_has_link = FALSE;
-       *speed = 0;
-       *duplex = 0;
-
        /*
         * Read the PCS Status register for link state. For non-copper mode,
         * the status register is not accurate. The PCS status register is
@@ -1167,12 +1332,10 @@ static s32 e1000_get_pcs_speed_and_duplex_82575(struct e1000_hw *hw,
        pcs = E1000_READ_REG(hw, E1000_PCS_LSTAT);
 
        /*
-        * The link up bit determines when link is up on autoneg. The sync ok
-        * gets set once both sides sync up and agree upon link. Stable link
-        * can be determined by checking for both link up and link sync ok
+        * The link up bit determines when link is up on autoneg.
         */
-       if ((pcs & E1000_PCS_LSTS_LINK_OK) && (pcs & E1000_PCS_LSTS_SYNK_OK)) {
-               mac->serdes_has_link = TRUE;
+       if (pcs & E1000_PCS_LSTS_LINK_OK) {
+               mac->serdes_has_link = true;
 
                /* Detect and store PCS speed */
                if (pcs & E1000_PCS_LSTS_SPEED_1000)
@@ -1187,8 +1350,25 @@ static s32 e1000_get_pcs_speed_and_duplex_82575(struct e1000_hw *hw,
                        *duplex = FULL_DUPLEX;
                else
                        *duplex = HALF_DUPLEX;
+
+               /* Check if it is an I354 2.5Gb backplane connection. */
+               if (mac->type == e1000_i354) {
+                       status = E1000_READ_REG(hw, E1000_STATUS);
+                       if ((status & E1000_STATUS_2P5_SKU) &&
+                           !(status & E1000_STATUS_2P5_SKU_OVER)) {
+                               *speed = SPEED_2500;
+                               *duplex = FULL_DUPLEX;
+                               DEBUGOUT("2500 Mbs, ");
+                               DEBUGOUT("Full Duplex\n");
+                       }
                }
 
+       } else {
+               mac->serdes_has_link = false;
+               *speed = 0;
+               *duplex = 0;
+       }
+
        return E1000_SUCCESS;
 }
 
@@ -1298,7 +1478,7 @@ STATIC s32 e1000_reset_hw_82575(struct e1000_hw *hw)
  *
  *  This inits the hardware readying it for operation.
  **/
-STATIC s32 e1000_init_hw_82575(struct e1000_hw *hw)
+s32 e1000_init_hw_82575(struct e1000_hw *hw)
 {
        struct e1000_mac_info *mac = &hw->mac;
        s32 ret_val;
@@ -1333,6 +1513,9 @@ STATIC s32 e1000_init_hw_82575(struct e1000_hw *hw)
        /* Setup link and flow control */
        ret_val = mac->ops.setup_link(hw);
 
+       /* Set the default MTU size */
+       hw->dev_spec._82575.mtu = 1500;
+
        /*
         * Clear all of the statistics registers (clear on read).  It is
         * important that we do this after we have tried to establish link
@@ -1355,7 +1538,8 @@ STATIC s32 e1000_init_hw_82575(struct e1000_hw *hw)
 STATIC s32 e1000_setup_copper_link_82575(struct e1000_hw *hw)
 {
        u32 ctrl;
-       s32  ret_val;
+       s32 ret_val;
+       u32 phpm_reg;
 
        DEBUGFUNC("e1000_setup_copper_link_82575");
 
@@ -1364,11 +1548,25 @@ STATIC s32 e1000_setup_copper_link_82575(struct e1000_hw *hw)
        ctrl &= ~(E1000_CTRL_FRCSPD | E1000_CTRL_FRCDPX);
        E1000_WRITE_REG(hw, E1000_CTRL, ctrl);
 
+       /* Clear Go Link Disconnect bit on supported devices */
+       switch (hw->mac.type) {
+       case e1000_82580:
+       case e1000_i350:
+       case e1000_i210:
+       case e1000_i211:
+               phpm_reg = E1000_READ_REG(hw, E1000_82580_PHY_POWER_MGMT);
+               phpm_reg &= ~E1000_82580_PM_GO_LINKD;
+               E1000_WRITE_REG(hw, E1000_82580_PHY_POWER_MGMT, phpm_reg);
+               break;
+       default:
+               break;
+       }
+
        ret_val = e1000_setup_serdes_link_82575(hw);
        if (ret_val)
                goto out;
 
-       if (e1000_sgmii_active_82575(hw) && !hw->phy.reset_disable) {
+       if (e1000_sgmii_active_82575(hw)) {
                /* allow time for SFP cage time to power up phy */
                msec_delay(300);
 
@@ -1379,13 +1577,21 @@ STATIC s32 e1000_setup_copper_link_82575(struct e1000_hw *hw)
                }
        }
        switch (hw->phy.type) {
+       case e1000_phy_i210:
        case e1000_phy_m88:
-               if (hw->phy.id == I347AT4_E_PHY_ID ||
-                   hw->phy.id == M88E1112_E_PHY_ID ||
-                   hw->phy.id == M88E1340M_E_PHY_ID)
+               switch (hw->phy.id) {
+               case I347AT4_E_PHY_ID:
+               case M88E1112_E_PHY_ID:
+               case M88E1340M_E_PHY_ID:
+               case M88E1543_E_PHY_ID:
+               case M88E1512_E_PHY_ID:
+               case I210_I_PHY_ID:
                        ret_val = e1000_copper_link_setup_m88_gen2(hw);
-               else
+                       break;
+               default:
                        ret_val = e1000_copper_link_setup_m88(hw);
+                       break;
+               }
                break;
        case e1000_phy_igp_3:
                ret_val = e1000_copper_link_setup_igp(hw);
@@ -1417,14 +1623,16 @@ out:
  **/
 STATIC s32 e1000_setup_serdes_link_82575(struct e1000_hw *hw)
 {
-       u32 ctrl_ext, ctrl_reg, reg;
+       u32 ctrl_ext, ctrl_reg, reg, anadv_reg;
        bool pcs_autoneg;
+       s32 ret_val = E1000_SUCCESS;
+       u16 data;
 
        DEBUGFUNC("e1000_setup_serdes_link_82575");
 
        if ((hw->phy.media_type != e1000_media_type_internal_serdes) &&
            !e1000_sgmii_active_82575(hw))
-               return E1000_SUCCESS;
+               return ret_val;
 
        /*
         * On the 82575, SerDes loopback mode persists until it is
@@ -1463,13 +1671,25 @@ STATIC s32 e1000_setup_serdes_link_82575(struct e1000_hw *hw)
                pcs_autoneg = false;
                /* fall through to default case */
        default:
+               if (hw->mac.type == e1000_82575 ||
+                   hw->mac.type == e1000_82576) {
+                       ret_val = hw->nvm.ops.read(hw, NVM_COMPAT, 1, &data);
+                       if (ret_val) {
+                               DEBUGOUT("NVM Read Error\n");
+                               return ret_val;
+                       }
+
+                       if (data & E1000_EEPROM_PCS_AUTONEG_DISABLE_BIT)
+                               pcs_autoneg = false;
+               }
+
                /*
                 * non-SGMII modes only supports a speed of 1000/Full for the
                 * link so it is best to just force the MAC and let the pcs
                 * link either autoneg or be forced to 1000/Full
                 */
                ctrl_reg |= E1000_CTRL_SPD_1000 | E1000_CTRL_FRCSPD |
-                           E1000_CTRL_FD | E1000_CTRL_FRCDPX;
+                           E1000_CTRL_FD | E1000_CTRL_FRCDPX;
 
                /* set speed of 1000/Full if speed/duplex is forced */
                reg |= E1000_PCS_LCTL_FSV_1000 | E1000_PCS_LCTL_FDV_FULL;
@@ -1485,31 +1705,203 @@ STATIC s32 e1000_setup_serdes_link_82575(struct e1000_hw *hw)
         * However, both are supported by the hardware and some drivers/tools.
         */
        reg &= ~(E1000_PCS_LCTL_AN_ENABLE | E1000_PCS_LCTL_FLV_LINK_UP |
-                E1000_PCS_LCTL_FSD | E1000_PCS_LCTL_FORCE_LINK);
-
-       /*
-        * We force flow control to prevent the CTRL register values from being
-        * overwritten by the autonegotiated flow control values
-        */
-       reg |= E1000_PCS_LCTL_FORCE_FCTRL;
+                E1000_PCS_LCTL_FSD | E1000_PCS_LCTL_FORCE_LINK);
 
        if (pcs_autoneg) {
                /* Set PCS register for autoneg */
                reg |= E1000_PCS_LCTL_AN_ENABLE | /* Enable Autoneg */
                       E1000_PCS_LCTL_AN_RESTART; /* Restart autoneg */
+
+               /* Disable force flow control for autoneg */
+               reg &= ~E1000_PCS_LCTL_FORCE_FCTRL;
+
+               /* Configure flow control advertisement for autoneg */
+               anadv_reg = E1000_READ_REG(hw, E1000_PCS_ANADV);
+               anadv_reg &= ~(E1000_TXCW_ASM_DIR | E1000_TXCW_PAUSE);
+
+               switch (hw->fc.requested_mode) {
+               case e1000_fc_full:
+               case e1000_fc_rx_pause:
+                       anadv_reg |= E1000_TXCW_ASM_DIR;
+                       anadv_reg |= E1000_TXCW_PAUSE;
+                       break;
+               case e1000_fc_tx_pause:
+                       anadv_reg |= E1000_TXCW_ASM_DIR;
+                       break;
+               default:
+                       break;
+               }
+
+               E1000_WRITE_REG(hw, E1000_PCS_ANADV, anadv_reg);
+
                DEBUGOUT1("Configuring Autoneg:PCS_LCTL=0x%08X\n", reg);
        } else {
                /* Set PCS register for forced link */
-               reg |= E1000_PCS_LCTL_FSD;        /* Force Speed */
+               reg |= E1000_PCS_LCTL_FSD;      /* Force Speed */
+
+               /* Force flow control for forced link */
+               reg |= E1000_PCS_LCTL_FORCE_FCTRL;
+
                DEBUGOUT1("Configuring Forced Link:PCS_LCTL=0x%08X\n", reg);
        }
 
        E1000_WRITE_REG(hw, E1000_PCS_LCTL, reg);
 
-       if (!e1000_sgmii_active_82575(hw))
+       if (!pcs_autoneg && !e1000_sgmii_active_82575(hw))
                e1000_force_mac_fc_generic(hw);
 
-       return E1000_SUCCESS;
+       return ret_val;
+}
+
+/**
+ *  e1000_get_media_type_82575 - derives current media type.
+ *  @hw: pointer to the HW structure
+ *
+ *  The media type is chosen reflecting few settings.
+ *  The following are taken into account:
+ *  - link mode set in the current port Init Control Word #3
+ *  - current link mode settings in CSR register
+ *  - MDIO vs. I2C PHY control interface chosen
+ *  - SFP module media type
+ **/
+STATIC s32 e1000_get_media_type_82575(struct e1000_hw *hw)
+{
+       struct e1000_dev_spec_82575 *dev_spec = &hw->dev_spec._82575;
+       s32 ret_val = E1000_SUCCESS;
+       u32 ctrl_ext = 0;
+       u32 link_mode = 0;
+
+       /* Set internal phy as default */
+       dev_spec->sgmii_active = false;
+       dev_spec->module_plugged = false;
+
+       /* Get CSR setting */
+       ctrl_ext = E1000_READ_REG(hw, E1000_CTRL_EXT);
+
+       /* extract link mode setting */
+       link_mode = ctrl_ext & E1000_CTRL_EXT_LINK_MODE_MASK;
+
+       switch (link_mode) {
+       case E1000_CTRL_EXT_LINK_MODE_1000BASE_KX:
+               hw->phy.media_type = e1000_media_type_internal_serdes;
+               break;
+       case E1000_CTRL_EXT_LINK_MODE_GMII:
+               hw->phy.media_type = e1000_media_type_copper;
+               break;
+       case E1000_CTRL_EXT_LINK_MODE_SGMII:
+               /* Get phy control interface type set (MDIO vs. I2C)*/
+               if (e1000_sgmii_uses_mdio_82575(hw)) {
+                       hw->phy.media_type = e1000_media_type_copper;
+                       dev_spec->sgmii_active = true;
+                       break;
+               }
+               /* fall through for I2C based SGMII */
+       case E1000_CTRL_EXT_LINK_MODE_PCIE_SERDES:
+               /* read media type from SFP EEPROM */
+               ret_val = e1000_set_sfp_media_type_82575(hw);
+               if ((ret_val != E1000_SUCCESS) ||
+                   (hw->phy.media_type == e1000_media_type_unknown)) {
+                       /*
+                        * If media type was not identified then return media
+                        * type defined by the CTRL_EXT settings.
+                        */
+                       hw->phy.media_type = e1000_media_type_internal_serdes;
+
+                       if (link_mode == E1000_CTRL_EXT_LINK_MODE_SGMII) {
+                               hw->phy.media_type = e1000_media_type_copper;
+                               dev_spec->sgmii_active = true;
+                       }
+
+                       break;
+               }
+
+               /* do not change link mode for 100BaseFX */
+               if (dev_spec->eth_flags.e100_base_fx)
+                       break;
+
+               /* change current link mode setting */
+               ctrl_ext &= ~E1000_CTRL_EXT_LINK_MODE_MASK;
+
+               if (hw->phy.media_type == e1000_media_type_copper)
+                       ctrl_ext |= E1000_CTRL_EXT_LINK_MODE_SGMII;
+               else
+                       ctrl_ext |= E1000_CTRL_EXT_LINK_MODE_PCIE_SERDES;
+
+               E1000_WRITE_REG(hw, E1000_CTRL_EXT, ctrl_ext);
+
+               break;
+       }
+
+       return ret_val;
+}
+
+/**
+ *  e1000_set_sfp_media_type_82575 - derives SFP module media type.
+ *  @hw: pointer to the HW structure
+ *
+ *  The media type is chosen based on SFP module.
+ *  compatibility flags retrieved from SFP ID EEPROM.
+ **/
+STATIC s32 e1000_set_sfp_media_type_82575(struct e1000_hw *hw)
+{
+       s32 ret_val = E1000_ERR_CONFIG;
+       u32 ctrl_ext = 0;
+       struct e1000_dev_spec_82575 *dev_spec = &hw->dev_spec._82575;
+       struct sfp_e1000_flags *eth_flags = &dev_spec->eth_flags;
+       u8 tranceiver_type = 0;
+       s32 timeout = 3;
+
+       /* Turn I2C interface ON and power on sfp cage */
+       ctrl_ext = E1000_READ_REG(hw, E1000_CTRL_EXT);
+       ctrl_ext &= ~E1000_CTRL_EXT_SDP3_DATA;
+       E1000_WRITE_REG(hw, E1000_CTRL_EXT, ctrl_ext | E1000_CTRL_I2C_ENA);
+
+       E1000_WRITE_FLUSH(hw);
+
+       /* Read SFP module data */
+       while (timeout) {
+               ret_val = e1000_read_sfp_data_byte(hw,
+                       E1000_I2CCMD_SFP_DATA_ADDR(E1000_SFF_IDENTIFIER_OFFSET),
+                       &tranceiver_type);
+               if (ret_val == E1000_SUCCESS)
+                       break;
+               msec_delay(100);
+               timeout--;
+       }
+       if (ret_val != E1000_SUCCESS)
+               goto out;
+
+       ret_val = e1000_read_sfp_data_byte(hw,
+                       E1000_I2CCMD_SFP_DATA_ADDR(E1000_SFF_ETH_FLAGS_OFFSET),
+                       (u8 *)eth_flags);
+       if (ret_val != E1000_SUCCESS)
+               goto out;
+
+       /* Check if there is some SFP module plugged and powered */
+       if ((tranceiver_type == E1000_SFF_IDENTIFIER_SFP) ||
+           (tranceiver_type == E1000_SFF_IDENTIFIER_SFF)) {
+               dev_spec->module_plugged = true;
+               if (eth_flags->e1000_base_lx || eth_flags->e1000_base_sx) {
+                       hw->phy.media_type = e1000_media_type_internal_serdes;
+               } else if (eth_flags->e100_base_fx) {
+                       dev_spec->sgmii_active = true;
+                       hw->phy.media_type = e1000_media_type_internal_serdes;
+               } else if (eth_flags->e1000_base_t) {
+                       dev_spec->sgmii_active = true;
+                       hw->phy.media_type = e1000_media_type_copper;
+               } else {
+                       hw->phy.media_type = e1000_media_type_unknown;
+                       DEBUGOUT("PHY module has not been recognized\n");
+                       goto out;
+               }
+       } else {
+               hw->phy.media_type = e1000_media_type_unknown;
+       }
+       ret_val = E1000_SUCCESS;
+out:
+       /* Restore I2C interface setting */
+       E1000_WRITE_REG(hw, E1000_CTRL_EXT, ctrl_ext);
+       return ret_val;
 }
 
 /**
@@ -1555,7 +1947,7 @@ out:
  *  which can be enabled for use in the embedded applications.  Simply
  *  return the current state of the sgmii interface.
  **/
-static bool e1000_sgmii_active_82575(struct e1000_hw *hw)
+STATIC bool e1000_sgmii_active_82575(struct e1000_hw *hw)
 {
        struct e1000_dev_spec_82575 *dev_spec = &hw->dev_spec._82575;
        return dev_spec->sgmii_active;
@@ -1605,7 +1997,7 @@ STATIC s32 e1000_reset_init_script_82575(struct e1000_hw *hw)
  **/
 STATIC s32 e1000_read_mac_addr_82575(struct e1000_hw *hw)
 {
-       s32 ret_val = E1000_SUCCESS;
+       s32 ret_val;
 
        DEBUGFUNC("e1000_read_mac_addr_82575");
 
@@ -1755,7 +2147,7 @@ void e1000_rx_fifo_flush_82575(struct e1000_hw *hw)
        for (i = 0; i < 4; i++) {
                rxdctl[i] = E1000_READ_REG(hw, E1000_RXDCTL(i));
                E1000_WRITE_REG(hw, E1000_RXDCTL(i),
-                               rxdctl[i] & ~E1000_RXDCTL_QUEUE_ENABLE);
+                               rxdctl[i] & ~E1000_RXDCTL_QUEUE_ENABLE);
        }
        /* Poll all queues to verify they have shut down */
        for (ms_wait = 0; ms_wait < 10; ms_wait++) {
@@ -1841,14 +2233,14 @@ STATIC s32 e1000_set_pcie_completion_timeout(struct e1000_hw *hw)
         * 16ms to 55ms
         */
        ret_val = e1000_read_pcie_cap_reg(hw, PCIE_DEVICE_CONTROL2,
-                                         &pcie_devctl2);
+                                         &pcie_devctl2);
        if (ret_val)
                goto out;
 
        pcie_devctl2 |= PCIE_DEVICE_CONTROL2_16ms;
 
        ret_val = e1000_write_pcie_cap_reg(hw, PCIE_DEVICE_CONTROL2,
-                                          &pcie_devctl2);
+                                          &pcie_devctl2);
 out:
        /* disable completion timeout resend */
        gcr &= ~E1000_GCR_CMPL_TMOUT_RESEND;
@@ -1867,40 +2259,33 @@ out:
  **/
 void e1000_vmdq_set_anti_spoofing_pf(struct e1000_hw *hw, bool enable, int pf)
 {
-       u32 dtxswc;
+       u32 reg_val, reg_offset;
 
        switch (hw->mac.type) {
        case e1000_82576:
-               dtxswc = E1000_READ_REG(hw, E1000_DTXSWC);
-               if (enable) {
-                       dtxswc |= (E1000_DTXSWC_MAC_SPOOF_MASK |
-                                  E1000_DTXSWC_VLAN_SPOOF_MASK);
-                       /* The PF can spoof - it has to in order to
-                        * support emulation mode NICs */
-                       dtxswc ^= (1 << pf | 1 << (pf + MAX_NUM_VFS));
-               } else {
-                       dtxswc &= ~(E1000_DTXSWC_MAC_SPOOF_MASK |
-                                   E1000_DTXSWC_VLAN_SPOOF_MASK);
-               }
-               E1000_WRITE_REG(hw, E1000_DTXSWC, dtxswc);
+               reg_offset = E1000_DTXSWC;
                break;
        case e1000_i350:
-               dtxswc = E1000_READ_REG(hw, E1000_TXSWC);
-               if (enable) {
-                       dtxswc |= (E1000_DTXSWC_MAC_SPOOF_MASK |
-                                  E1000_DTXSWC_VLAN_SPOOF_MASK);
-                       /* The PF can spoof - it has to in order to
-                        * support emulation mode NICs
-                        */
-                       dtxswc ^= (1 << pf | 1 << (pf + MAX_NUM_VFS));
-               } else {
-                       dtxswc &= ~(E1000_DTXSWC_MAC_SPOOF_MASK |
-                                   E1000_DTXSWC_VLAN_SPOOF_MASK);
-               }
-               E1000_WRITE_REG(hw, E1000_TXSWC, dtxswc);
-       default:
+       case e1000_i354:
+               reg_offset = E1000_TXSWC;
                break;
+       default:
+               return;
        }
+
+       reg_val = E1000_READ_REG(hw, reg_offset);
+       if (enable) {
+               reg_val |= (E1000_DTXSWC_MAC_SPOOF_MASK |
+                            E1000_DTXSWC_VLAN_SPOOF_MASK);
+               /* The PF can spoof - it has to in order to
+                * support emulation mode NICs
+                */
+               reg_val ^= (1 << pf | 1 << (pf + MAX_NUM_VFS));
+       } else {
+               reg_val &= ~(E1000_DTXSWC_MAC_SPOOF_MASK |
+                            E1000_DTXSWC_VLAN_SPOOF_MASK);
+       }
+       E1000_WRITE_REG(hw, reg_offset, reg_val);
 }
 
 /**
@@ -1924,6 +2309,7 @@ void e1000_vmdq_set_loopback_pf(struct e1000_hw *hw, bool enable)
                E1000_WRITE_REG(hw, E1000_DTXSWC, dtxswc);
                break;
        case e1000_i350:
+       case e1000_i354:
                dtxswc = E1000_READ_REG(hw, E1000_TXSWC);
                if (enable)
                        dtxswc |= E1000_DTXSWC_VMDQ_LOOPBACK_EN;
@@ -2033,8 +2419,8 @@ STATIC s32 e1000_reset_mdicnfg_82580(struct e1000_hw *hw)
                goto out;
 
        ret_val = hw->nvm.ops.read(hw, NVM_INIT_CONTROL3_PORT_A +
-                                  NVM_82580_LAN_FUNC_OFFSET(hw->bus.func), 1,
-                                  &nvm_data);
+                                  NVM_82580_LAN_FUNC_OFFSET(hw->bus.func), 1,
+                                  &nvm_data);
        if (ret_val) {
                DEBUGOUT("NVM Read Error\n");
                goto out;
@@ -2069,6 +2455,10 @@ STATIC s32 e1000_reset_hw_82580(struct e1000_hw *hw)
 
        hw->dev_spec._82575.global_device_reset = false;
 
+       /* 82580 does not reliably do global_device_reset due to hw errata */
+       if (hw->mac.type == e1000_82580)
+               global_device_reset = false;
+
        /* Get current control state. */
        ctrl = E1000_READ_REG(hw, E1000_CTRL);
 
@@ -2089,17 +2479,18 @@ STATIC s32 e1000_reset_hw_82580(struct e1000_hw *hw)
        msec_delay(10);
 
        /* Determine whether or not a global dev reset is requested */
-       if (global_device_reset &&
-               e1000_acquire_swfw_sync_82575(hw, swmbsw_mask))
-                       global_device_reset = FALSE;
+       if (global_device_reset && hw->mac.ops.acquire_swfw_sync(hw,
+           swmbsw_mask))
+                       global_device_reset = false;
 
-       if (global_device_reset &&
-               !(E1000_READ_REG(hw, E1000_STATUS) & E1000_STAT_DEV_RST_SET))
+       if (global_device_reset && !(E1000_READ_REG(hw, E1000_STATUS) &
+           E1000_STAT_DEV_RST_SET))
                ctrl |= E1000_CTRL_DEV_RST;
        else
                ctrl |= E1000_CTRL_RST;
 
        E1000_WRITE_REG(hw, E1000_CTRL, ctrl);
+       E1000_WRITE_FLUSH(hw);
 
        /* Add delay to insure DEV_RST has time to complete */
        if (global_device_reset)
@@ -2115,10 +2506,6 @@ STATIC s32 e1000_reset_hw_82580(struct e1000_hw *hw)
                DEBUGOUT("Auto Read Done did not complete\n");
        }
 
-       /* If EEPROM is not present, run manual init scripts */
-       if (!(E1000_READ_REG(hw, E1000_EECD) & E1000_EECD_PRES))
-               e1000_reset_init_script_82575(hw);
-
        /* clear global device reset status bit */
        E1000_WRITE_REG(hw, E1000_STATUS, E1000_STAT_DEV_RST_SET);
 
@@ -2135,7 +2522,7 @@ STATIC s32 e1000_reset_hw_82580(struct e1000_hw *hw)
 
        /* Release semaphore */
        if (global_device_reset)
-               e1000_release_swfw_sync_82575(hw, swmbsw_mask);
+               hw->mac.ops.release_swfw_sync(hw, swmbsw_mask);
 
        return ret_val;
 }
@@ -2224,7 +2611,7 @@ s32 e1000_update_nvm_checksum_with_offset(struct e1000_hw *hw, u16 offset)
        }
        checksum = (u16) NVM_SUM - checksum;
        ret_val = hw->nvm.ops.write(hw, (NVM_CHECKSUM_REG + offset), 1,
-                               &checksum);
+                                   &checksum);
        if (ret_val)
                DEBUGOUT("NVM Write Error while updating checksum.\n");
 
@@ -2242,7 +2629,7 @@ out:
  **/
 STATIC s32 e1000_validate_nvm_checksum_82580(struct e1000_hw *hw)
 {
-       s32 ret_val = E1000_SUCCESS;
+       s32 ret_val;
        u16 eeprom_regions_count = 1;
        u16 j, nvm_data;
        u16 nvm_offset;
@@ -2264,7 +2651,7 @@ STATIC s32 e1000_validate_nvm_checksum_82580(struct e1000_hw *hw)
        for (j = 0; j < eeprom_regions_count; j++) {
                nvm_offset = NVM_82580_LAN_FUNC_OFFSET(j);
                ret_val = e1000_validate_nvm_checksum_with_offset(hw,
-                                                               nvm_offset);
+                                                                 nvm_offset);
                if (ret_val != E1000_SUCCESS)
                        goto out;
        }
@@ -2299,7 +2686,7 @@ STATIC s32 e1000_update_nvm_checksum_82580(struct e1000_hw *hw)
                /* set compatibility bit to validate checksums appropriately */
                nvm_data = nvm_data | NVM_COMPATIBILITY_BIT_MASK;
                ret_val = hw->nvm.ops.write(hw, NVM_COMPATIBILITY_REG_3, 1,
-                                       &nvm_data);
+                                           &nvm_data);
                if (ret_val) {
                        DEBUGOUT("NVM Write Error while updating checksum compatibility bit.\n");
                        goto out;
@@ -2311,7 +2698,7 @@ STATIC s32 e1000_update_nvm_checksum_82580(struct e1000_hw *hw)
                ret_val = e1000_update_nvm_checksum_with_offset(hw, nvm_offset);
                if (ret_val)
                        goto out;
-               }
+       }
 
 out:
        return ret_val;
@@ -2336,7 +2723,7 @@ STATIC s32 e1000_validate_nvm_checksum_i350(struct e1000_hw *hw)
        for (j = 0; j < 4; j++) {
                nvm_offset = NVM_82580_LAN_FUNC_OFFSET(j);
                ret_val = e1000_validate_nvm_checksum_with_offset(hw,
-                                                               nvm_offset);
+                                                                 nvm_offset);
                if (ret_val != E1000_SUCCESS)
                        goto out;
        }
@@ -2373,42 +2760,880 @@ out:
 }
 
 /**
- *  e1000_set_eee_i350 - Enable/disable EEE support
+ *  __e1000_access_emi_reg - Read/write EMI register
  *  @hw: pointer to the HW structure
- *
- *  Enable/disable EEE based on setting in dev_spec structure.
- *
+ *  @addr: EMI address to program
+ *  @data: pointer to value to read/write from/to the EMI address
+ *  @read: boolean flag to indicate read or write
  **/
-s32 e1000_set_eee_i350(struct e1000_hw *hw)
+STATIC s32 __e1000_access_emi_reg(struct e1000_hw *hw, u16 address,
+                                 u16 *data, bool read)
 {
-       s32 ret_val = E1000_SUCCESS;
-       u32 ipcnfg, eeer, ctrl_ext;
+       s32 ret_val;
 
-       DEBUGFUNC("e1000_set_eee_i350");
+       DEBUGFUNC("__e1000_access_emi_reg");
 
-       ctrl_ext = E1000_READ_REG(hw, E1000_CTRL_EXT);
-       if ((hw->mac.type != e1000_i350) ||
-           (ctrl_ext & E1000_CTRL_EXT_LINK_MODE_MASK))
-               goto out;
+       ret_val = hw->phy.ops.write_reg(hw, E1000_EMIADD, address);
+       if (ret_val)
+               return ret_val;
+
+       if (read)
+               ret_val = hw->phy.ops.read_reg(hw, E1000_EMIDATA, data);
+       else
+               ret_val = hw->phy.ops.write_reg(hw, E1000_EMIDATA, *data);
+
+       return ret_val;
+}
+
+/**
+ *  e1000_read_emi_reg - Read Extended Management Interface register
+ *  @hw: pointer to the HW structure
+ *  @addr: EMI address to program
+ *  @data: value to be read from the EMI address
+ **/
+s32 e1000_read_emi_reg(struct e1000_hw *hw, u16 addr, u16 *data)
+{
+       DEBUGFUNC("e1000_read_emi_reg");
+
+       return __e1000_access_emi_reg(hw, addr, data, true);
+}
+
+/**
+ *  e1000_initialize_M88E1512_phy - Initialize M88E1512 PHY
+ *  @hw: pointer to the HW structure
+ *
+ *  Initialize Marverl 1512 to work correctly with Avoton.
+ **/
+s32 e1000_initialize_M88E1512_phy(struct e1000_hw *hw)
+{
+       struct e1000_phy_info *phy = &hw->phy;
+       s32 ret_val = E1000_SUCCESS;
+
+       DEBUGFUNC("e1000_initialize_M88E1512_phy");
+
+       /* Check if this is correct PHY. */
+       if (phy->id != M88E1512_E_PHY_ID)
+               goto out;
+
+       /* Switch to PHY page 0xFF. */
+       ret_val = phy->ops.write_reg(hw, E1000_M88E1543_PAGE_ADDR, 0x00FF);
+       if (ret_val)
+               goto out;
+
+       ret_val = phy->ops.write_reg(hw, E1000_M88E1512_CFG_REG_2, 0x214B);
+       if (ret_val)
+               goto out;
+
+       ret_val = phy->ops.write_reg(hw, E1000_M88E1512_CFG_REG_1, 0x2144);
+       if (ret_val)
+               goto out;
+
+       ret_val = phy->ops.write_reg(hw, E1000_M88E1512_CFG_REG_2, 0x0C28);
+       if (ret_val)
+               goto out;
+
+       ret_val = phy->ops.write_reg(hw, E1000_M88E1512_CFG_REG_1, 0x2146);
+       if (ret_val)
+               goto out;
+
+       ret_val = phy->ops.write_reg(hw, E1000_M88E1512_CFG_REG_2, 0xB233);
+       if (ret_val)
+               goto out;
+
+       ret_val = phy->ops.write_reg(hw, E1000_M88E1512_CFG_REG_1, 0x214D);
+       if (ret_val)
+               goto out;
+
+       ret_val = phy->ops.write_reg(hw, E1000_M88E1512_CFG_REG_2, 0xCC0C);
+       if (ret_val)
+               goto out;
+
+       ret_val = phy->ops.write_reg(hw, E1000_M88E1512_CFG_REG_1, 0x2159);
+       if (ret_val)
+               goto out;
+
+       /* Switch to PHY page 0xFB. */
+       ret_val = phy->ops.write_reg(hw, E1000_M88E1543_PAGE_ADDR, 0x00FB);
+       if (ret_val)
+               goto out;
+
+       ret_val = phy->ops.write_reg(hw, E1000_M88E1512_CFG_REG_3, 0x000D);
+       if (ret_val)
+               goto out;
+
+       /* Switch to PHY page 0x12. */
+       ret_val = phy->ops.write_reg(hw, E1000_M88E1543_PAGE_ADDR, 0x12);
+       if (ret_val)
+               goto out;
+
+       /* Change mode to SGMII-to-Copper */
+       ret_val = phy->ops.write_reg(hw, E1000_M88E1512_MODE, 0x8001);
+       if (ret_val)
+               goto out;
+
+       /* Return the PHY to page 0. */
+       ret_val = phy->ops.write_reg(hw, E1000_M88E1543_PAGE_ADDR, 0);
+       if (ret_val)
+               goto out;
+
+       ret_val = phy->ops.commit(hw);
+       if (ret_val) {
+               DEBUGOUT("Error committing the PHY changes\n");
+               return ret_val;
+       }
+
+       msec_delay(1000);
+out:
+       return ret_val;
+}
+
+/**
+ *  e1000_set_eee_i350 - Enable/disable EEE support
+ *  @hw: pointer to the HW structure
+ *
+ *  Enable/disable EEE based on setting in dev_spec structure.
+ *
+ **/
+s32 e1000_set_eee_i350(struct e1000_hw *hw)
+{
+       s32 ret_val = E1000_SUCCESS;
+       u32 ipcnfg, eeer;
+
+       DEBUGFUNC("e1000_set_eee_i350");
+
+       if ((hw->mac.type < e1000_i350) ||
+           (hw->phy.media_type != e1000_media_type_copper))
+               goto out;
        ipcnfg = E1000_READ_REG(hw, E1000_IPCNFG);
        eeer = E1000_READ_REG(hw, E1000_EEER);
 
        /* enable or disable per user setting */
        if (!(hw->dev_spec._82575.eee_disable)) {
+               u32 eee_su = E1000_READ_REG(hw, E1000_EEE_SU);
+
                ipcnfg |= (E1000_IPCNFG_EEE_1G_AN | E1000_IPCNFG_EEE_100M_AN);
                eeer |= (E1000_EEER_TX_LPI_EN | E1000_EEER_RX_LPI_EN |
-                        E1000_EEER_LPI_FC);
+                        E1000_EEER_LPI_FC);
 
+               /* This bit should not be set in normal operation. */
+               if (eee_su & E1000_EEE_SU_LPI_CLK_STP)
+                       DEBUGOUT("LPI Clock Stop Bit should not be set!\n");
        } else {
                ipcnfg &= ~(E1000_IPCNFG_EEE_1G_AN | E1000_IPCNFG_EEE_100M_AN);
                eeer &= ~(E1000_EEER_TX_LPI_EN | E1000_EEER_RX_LPI_EN |
-                         E1000_EEER_LPI_FC);
+                         E1000_EEER_LPI_FC);
        }
        E1000_WRITE_REG(hw, E1000_IPCNFG, ipcnfg);
        E1000_WRITE_REG(hw, E1000_EEER, eeer);
-                       E1000_READ_REG(hw, E1000_IPCNFG);
-                       E1000_READ_REG(hw, E1000_EEER);
+       E1000_READ_REG(hw, E1000_IPCNFG);
+       E1000_READ_REG(hw, E1000_EEER);
+out:
+
+       return ret_val;
+}
+
+/**
+ *  e1000_set_eee_i354 - Enable/disable EEE support
+ *  @hw: pointer to the HW structure
+ *
+ *  Enable/disable EEE legacy mode based on setting in dev_spec structure.
+ *
+ **/
+s32 e1000_set_eee_i354(struct e1000_hw *hw)
+{
+       struct e1000_phy_info *phy = &hw->phy;
+       s32 ret_val = E1000_SUCCESS;
+       u16 phy_data;
+
+       DEBUGFUNC("e1000_set_eee_i354");
+
+       if ((hw->phy.media_type != e1000_media_type_copper) ||
+           ((phy->id != M88E1543_E_PHY_ID) &&
+           (phy->id != M88E1512_E_PHY_ID)))
+               goto out;
+
+       if (!hw->dev_spec._82575.eee_disable) {
+               /* Switch to PHY page 18. */
+               ret_val = phy->ops.write_reg(hw, E1000_M88E1543_PAGE_ADDR, 18);
+               if (ret_val)
+                       goto out;
+
+               ret_val = phy->ops.read_reg(hw, E1000_M88E1543_EEE_CTRL_1,
+                                           &phy_data);
+               if (ret_val)
+                       goto out;
+
+               phy_data |= E1000_M88E1543_EEE_CTRL_1_MS;
+               ret_val = phy->ops.write_reg(hw, E1000_M88E1543_EEE_CTRL_1,
+                                            phy_data);
+               if (ret_val)
+                       goto out;
+
+               /* Return the PHY to page 0. */
+               ret_val = phy->ops.write_reg(hw, E1000_M88E1543_PAGE_ADDR, 0);
+               if (ret_val)
+                       goto out;
+
+               /* Turn on EEE advertisement. */
+               ret_val = e1000_read_xmdio_reg(hw, E1000_EEE_ADV_ADDR_I354,
+                                              E1000_EEE_ADV_DEV_I354,
+                                              &phy_data);
+               if (ret_val)
+                       goto out;
+
+               phy_data |= E1000_EEE_ADV_100_SUPPORTED |
+                           E1000_EEE_ADV_1000_SUPPORTED;
+               ret_val = e1000_write_xmdio_reg(hw, E1000_EEE_ADV_ADDR_I354,
+                                               E1000_EEE_ADV_DEV_I354,
+                                               phy_data);
+       } else {
+               /* Turn off EEE advertisement. */
+               ret_val = e1000_read_xmdio_reg(hw, E1000_EEE_ADV_ADDR_I354,
+                                              E1000_EEE_ADV_DEV_I354,
+                                              &phy_data);
+               if (ret_val)
+                       goto out;
+
+               phy_data &= ~(E1000_EEE_ADV_100_SUPPORTED |
+                             E1000_EEE_ADV_1000_SUPPORTED);
+               ret_val = e1000_write_xmdio_reg(hw, E1000_EEE_ADV_ADDR_I354,
+                                               E1000_EEE_ADV_DEV_I354,
+                                               phy_data);
+       }
+
 out:
+       return ret_val;
+}
+
+/**
+ *  e1000_get_eee_status_i354 - Get EEE status
+ *  @hw: pointer to the HW structure
+ *  @status: EEE status
+ *
+ *  Get EEE status by guessing based on whether Tx or Rx LPI indications have
+ *  been received.
+ **/
+s32 e1000_get_eee_status_i354(struct e1000_hw *hw, bool *status)
+{
+       struct e1000_phy_info *phy = &hw->phy;
+       s32 ret_val = E1000_SUCCESS;
+       u16 phy_data;
+
+       DEBUGFUNC("e1000_get_eee_status_i354");
+
+       /* Check if EEE is supported on this device. */
+       if ((hw->phy.media_type != e1000_media_type_copper) ||
+           ((phy->id != M88E1543_E_PHY_ID) &&
+           (phy->id != M88E1512_E_PHY_ID)))
+               goto out;
+
+       ret_val = e1000_read_xmdio_reg(hw, E1000_PCS_STATUS_ADDR_I354,
+                                      E1000_PCS_STATUS_DEV_I354,
+                                      &phy_data);
+       if (ret_val)
+               goto out;
+
+       *status = phy_data & (E1000_PCS_STATUS_TX_LPI_RCVD |
+                             E1000_PCS_STATUS_RX_LPI_RCVD) ? true : false;
+
+out:
+       return ret_val;
+}
+
+/* Due to a hw errata, if the host tries to  configure the VFTA register
+ * while performing queries from the BMC or DMA, then the VFTA in some
+ * cases won't be written.
+ */
+
+/**
+ *  e1000_clear_vfta_i350 - Clear VLAN filter table
+ *  @hw: pointer to the HW structure
+ *
+ *  Clears the register array which contains the VLAN filter table by
+ *  setting all the values to 0.
+ **/
+void e1000_clear_vfta_i350(struct e1000_hw *hw)
+{
+       u32 offset;
+       int i;
+
+       DEBUGFUNC("e1000_clear_vfta_350");
+
+       for (offset = 0; offset < E1000_VLAN_FILTER_TBL_SIZE; offset++) {
+               for (i = 0; i < 10; i++)
+                       E1000_WRITE_REG_ARRAY(hw, E1000_VFTA, offset, 0);
+
+               E1000_WRITE_FLUSH(hw);
+       }
+}
+
+/**
+ *  e1000_write_vfta_i350 - Write value to VLAN filter table
+ *  @hw: pointer to the HW structure
+ *  @offset: register offset in VLAN filter table
+ *  @value: register value written to VLAN filter table
+ *
+ *  Writes value at the given offset in the register array which stores
+ *  the VLAN filter table.
+ **/
+void e1000_write_vfta_i350(struct e1000_hw *hw, u32 offset, u32 value)
+{
+       int i;
+
+       DEBUGFUNC("e1000_write_vfta_350");
+
+       for (i = 0; i < 10; i++)
+               E1000_WRITE_REG_ARRAY(hw, E1000_VFTA, offset, value);
+
+       E1000_WRITE_FLUSH(hw);
+}
+
+
+/**
+ *  e1000_set_i2c_bb - Enable I2C bit-bang
+ *  @hw: pointer to the HW structure
+ *
+ *  Enable I2C bit-bang interface
+ *
+ **/
+s32 e1000_set_i2c_bb(struct e1000_hw *hw)
+{
+       s32 ret_val = E1000_SUCCESS;
+       u32 ctrl_ext, i2cparams;
+
+       DEBUGFUNC("e1000_set_i2c_bb");
+
+       ctrl_ext = E1000_READ_REG(hw, E1000_CTRL_EXT);
+       ctrl_ext |= E1000_CTRL_I2C_ENA;
+       E1000_WRITE_REG(hw, E1000_CTRL_EXT, ctrl_ext);
+       E1000_WRITE_FLUSH(hw);
+
+       i2cparams = E1000_READ_REG(hw, E1000_I2CPARAMS);
+       i2cparams |= E1000_I2CBB_EN;
+       i2cparams |= E1000_I2C_DATA_OE_N;
+       i2cparams |= E1000_I2C_CLK_OE_N;
+       E1000_WRITE_REG(hw, E1000_I2CPARAMS, i2cparams);
+       E1000_WRITE_FLUSH(hw);
 
        return ret_val;
 }
+
+/**
+ *  e1000_read_i2c_byte_generic - Reads 8 bit word over I2C
+ *  @hw: pointer to hardware structure
+ *  @byte_offset: byte offset to read
+ *  @dev_addr: device address
+ *  @data: value read
+ *
+ *  Performs byte read operation over I2C interface at
+ *  a specified device address.
+ **/
+s32 e1000_read_i2c_byte_generic(struct e1000_hw *hw, u8 byte_offset,
+                               u8 dev_addr, u8 *data)
+{
+       s32 status = E1000_SUCCESS;
+       u32 max_retry = 10;
+       u32 retry = 1;
+       u16 swfw_mask = 0;
+
+       bool nack = true;
+
+       DEBUGFUNC("e1000_read_i2c_byte_generic");
+
+       swfw_mask = E1000_SWFW_PHY0_SM;
+
+       do {
+               if (hw->mac.ops.acquire_swfw_sync(hw, swfw_mask)
+                   != E1000_SUCCESS) {
+                       status = E1000_ERR_SWFW_SYNC;
+                       goto read_byte_out;
+               }
+
+               e1000_i2c_start(hw);
+
+               /* Device Address and write indication */
+               status = e1000_clock_out_i2c_byte(hw, dev_addr);
+               if (status != E1000_SUCCESS)
+                       goto fail;
+
+               status = e1000_get_i2c_ack(hw);
+               if (status != E1000_SUCCESS)
+                       goto fail;
+
+               status = e1000_clock_out_i2c_byte(hw, byte_offset);
+               if (status != E1000_SUCCESS)
+                       goto fail;
+
+               status = e1000_get_i2c_ack(hw);
+               if (status != E1000_SUCCESS)
+                       goto fail;
+
+               e1000_i2c_start(hw);
+
+               /* Device Address and read indication */
+               status = e1000_clock_out_i2c_byte(hw, (dev_addr | 0x1));
+               if (status != E1000_SUCCESS)
+                       goto fail;
+
+               status = e1000_get_i2c_ack(hw);
+               if (status != E1000_SUCCESS)
+                       goto fail;
+
+               status = e1000_clock_in_i2c_byte(hw, data);
+               if (status != E1000_SUCCESS)
+                       goto fail;
+
+               status = e1000_clock_out_i2c_bit(hw, nack);
+               if (status != E1000_SUCCESS)
+                       goto fail;
+
+               e1000_i2c_stop(hw);
+               break;
+
+fail:
+               hw->mac.ops.release_swfw_sync(hw, swfw_mask);
+               msec_delay(100);
+               e1000_i2c_bus_clear(hw);
+               retry++;
+               if (retry < max_retry)
+                       DEBUGOUT("I2C byte read error - Retrying.\n");
+               else
+                       DEBUGOUT("I2C byte read error.\n");
+
+       } while (retry < max_retry);
+
+       hw->mac.ops.release_swfw_sync(hw, swfw_mask);
+
+read_byte_out:
+
+       return status;
+}
+
+/**
+ *  e1000_write_i2c_byte_generic - Writes 8 bit word over I2C
+ *  @hw: pointer to hardware structure
+ *  @byte_offset: byte offset to write
+ *  @dev_addr: device address
+ *  @data: value to write
+ *
+ *  Performs byte write operation over I2C interface at
+ *  a specified device address.
+ **/
+s32 e1000_write_i2c_byte_generic(struct e1000_hw *hw, u8 byte_offset,
+                                u8 dev_addr, u8 data)
+{
+       s32 status = E1000_SUCCESS;
+       u32 max_retry = 1;
+       u32 retry = 0;
+       u16 swfw_mask = 0;
+
+       DEBUGFUNC("e1000_write_i2c_byte_generic");
+
+       swfw_mask = E1000_SWFW_PHY0_SM;
+
+       if (hw->mac.ops.acquire_swfw_sync(hw, swfw_mask) != E1000_SUCCESS) {
+               status = E1000_ERR_SWFW_SYNC;
+               goto write_byte_out;
+       }
+
+       do {
+               e1000_i2c_start(hw);
+
+               status = e1000_clock_out_i2c_byte(hw, dev_addr);
+               if (status != E1000_SUCCESS)
+                       goto fail;
+
+               status = e1000_get_i2c_ack(hw);
+               if (status != E1000_SUCCESS)
+                       goto fail;
+
+               status = e1000_clock_out_i2c_byte(hw, byte_offset);
+               if (status != E1000_SUCCESS)
+                       goto fail;
+
+               status = e1000_get_i2c_ack(hw);
+               if (status != E1000_SUCCESS)
+                       goto fail;
+
+               status = e1000_clock_out_i2c_byte(hw, data);
+               if (status != E1000_SUCCESS)
+                       goto fail;
+
+               status = e1000_get_i2c_ack(hw);
+               if (status != E1000_SUCCESS)
+                       goto fail;
+
+               e1000_i2c_stop(hw);
+               break;
+
+fail:
+               e1000_i2c_bus_clear(hw);
+               retry++;
+               if (retry < max_retry)
+                       DEBUGOUT("I2C byte write error - Retrying.\n");
+               else
+                       DEBUGOUT("I2C byte write error.\n");
+       } while (retry < max_retry);
+
+       hw->mac.ops.release_swfw_sync(hw, swfw_mask);
+
+write_byte_out:
+
+       return status;
+}
+
+/**
+ *  e1000_i2c_start - Sets I2C start condition
+ *  @hw: pointer to hardware structure
+ *
+ *  Sets I2C start condition (High -> Low on SDA while SCL is High)
+ **/
+STATIC void e1000_i2c_start(struct e1000_hw *hw)
+{
+       u32 i2cctl = E1000_READ_REG(hw, E1000_I2CPARAMS);
+
+       DEBUGFUNC("e1000_i2c_start");
+
+       /* Start condition must begin with data and clock high */
+       e1000_set_i2c_data(hw, &i2cctl, 1);
+       e1000_raise_i2c_clk(hw, &i2cctl);
+
+       /* Setup time for start condition (4.7us) */
+       usec_delay(E1000_I2C_T_SU_STA);
+
+       e1000_set_i2c_data(hw, &i2cctl, 0);
+
+       /* Hold time for start condition (4us) */
+       usec_delay(E1000_I2C_T_HD_STA);
+
+       e1000_lower_i2c_clk(hw, &i2cctl);
+
+       /* Minimum low period of clock is 4.7 us */
+       usec_delay(E1000_I2C_T_LOW);
+
+}
+
+/**
+ *  e1000_i2c_stop - Sets I2C stop condition
+ *  @hw: pointer to hardware structure
+ *
+ *  Sets I2C stop condition (Low -> High on SDA while SCL is High)
+ **/
+STATIC void e1000_i2c_stop(struct e1000_hw *hw)
+{
+       u32 i2cctl = E1000_READ_REG(hw, E1000_I2CPARAMS);
+
+       DEBUGFUNC("e1000_i2c_stop");
+
+       /* Stop condition must begin with data low and clock high */
+       e1000_set_i2c_data(hw, &i2cctl, 0);
+       e1000_raise_i2c_clk(hw, &i2cctl);
+
+       /* Setup time for stop condition (4us) */
+       usec_delay(E1000_I2C_T_SU_STO);
+
+       e1000_set_i2c_data(hw, &i2cctl, 1);
+
+       /* bus free time between stop and start (4.7us)*/
+       usec_delay(E1000_I2C_T_BUF);
+}
+
+/**
+ *  e1000_clock_in_i2c_byte - Clocks in one byte via I2C
+ *  @hw: pointer to hardware structure
+ *  @data: data byte to clock in
+ *
+ *  Clocks in one byte data via I2C data/clock
+ **/
+STATIC s32 e1000_clock_in_i2c_byte(struct e1000_hw *hw, u8 *data)
+{
+       s32 i;
+       bool bit = 0;
+
+       DEBUGFUNC("e1000_clock_in_i2c_byte");
+
+       *data = 0;
+       for (i = 7; i >= 0; i--) {
+               e1000_clock_in_i2c_bit(hw, &bit);
+               *data |= bit << i;
+       }
+
+       return E1000_SUCCESS;
+}
+
+/**
+ *  e1000_clock_out_i2c_byte - Clocks out one byte via I2C
+ *  @hw: pointer to hardware structure
+ *  @data: data byte clocked out
+ *
+ *  Clocks out one byte data via I2C data/clock
+ **/
+STATIC s32 e1000_clock_out_i2c_byte(struct e1000_hw *hw, u8 data)
+{
+       s32 status = E1000_SUCCESS;
+       s32 i;
+       u32 i2cctl;
+       bool bit = 0;
+
+       DEBUGFUNC("e1000_clock_out_i2c_byte");
+
+       for (i = 7; i >= 0; i--) {
+               bit = (data >> i) & 0x1;
+               status = e1000_clock_out_i2c_bit(hw, bit);
+
+               if (status != E1000_SUCCESS)
+                       break;
+       }
+
+       /* Release SDA line (set high) */
+       i2cctl = E1000_READ_REG(hw, E1000_I2CPARAMS);
+
+       i2cctl |= E1000_I2C_DATA_OE_N;
+       E1000_WRITE_REG(hw, E1000_I2CPARAMS, i2cctl);
+       E1000_WRITE_FLUSH(hw);
+
+       return status;
+}
+
+/**
+ *  e1000_get_i2c_ack - Polls for I2C ACK
+ *  @hw: pointer to hardware structure
+ *
+ *  Clocks in/out one bit via I2C data/clock
+ **/
+STATIC s32 e1000_get_i2c_ack(struct e1000_hw *hw)
+{
+       s32 status = E1000_SUCCESS;
+       u32 i = 0;
+       u32 i2cctl = E1000_READ_REG(hw, E1000_I2CPARAMS);
+       u32 timeout = 10;
+       bool ack = true;
+
+       DEBUGFUNC("e1000_get_i2c_ack");
+
+       e1000_raise_i2c_clk(hw, &i2cctl);
+
+       /* Minimum high period of clock is 4us */
+       usec_delay(E1000_I2C_T_HIGH);
+
+       /* Wait until SCL returns high */
+       for (i = 0; i < timeout; i++) {
+               usec_delay(1);
+               i2cctl = E1000_READ_REG(hw, E1000_I2CPARAMS);
+               if (i2cctl & E1000_I2C_CLK_IN)
+                       break;
+       }
+       if (!(i2cctl & E1000_I2C_CLK_IN))
+               return E1000_ERR_I2C;
+
+       ack = e1000_get_i2c_data(&i2cctl);
+       if (ack) {
+               DEBUGOUT("I2C ack was not received.\n");
+               status = E1000_ERR_I2C;
+       }
+
+       e1000_lower_i2c_clk(hw, &i2cctl);
+
+       /* Minimum low period of clock is 4.7 us */
+       usec_delay(E1000_I2C_T_LOW);
+
+       return status;
+}
+
+/**
+ *  e1000_clock_in_i2c_bit - Clocks in one bit via I2C data/clock
+ *  @hw: pointer to hardware structure
+ *  @data: read data value
+ *
+ *  Clocks in one bit via I2C data/clock
+ **/
+STATIC s32 e1000_clock_in_i2c_bit(struct e1000_hw *hw, bool *data)
+{
+       u32 i2cctl = E1000_READ_REG(hw, E1000_I2CPARAMS);
+
+       DEBUGFUNC("e1000_clock_in_i2c_bit");
+
+       e1000_raise_i2c_clk(hw, &i2cctl);
+
+       /* Minimum high period of clock is 4us */
+       usec_delay(E1000_I2C_T_HIGH);
+
+       i2cctl = E1000_READ_REG(hw, E1000_I2CPARAMS);
+       *data = e1000_get_i2c_data(&i2cctl);
+
+       e1000_lower_i2c_clk(hw, &i2cctl);
+
+       /* Minimum low period of clock is 4.7 us */
+       usec_delay(E1000_I2C_T_LOW);
+
+       return E1000_SUCCESS;
+}
+
+/**
+ *  e1000_clock_out_i2c_bit - Clocks in/out one bit via I2C data/clock
+ *  @hw: pointer to hardware structure
+ *  @data: data value to write
+ *
+ *  Clocks out one bit via I2C data/clock
+ **/
+STATIC s32 e1000_clock_out_i2c_bit(struct e1000_hw *hw, bool data)
+{
+       s32 status;
+       u32 i2cctl = E1000_READ_REG(hw, E1000_I2CPARAMS);
+
+       DEBUGFUNC("e1000_clock_out_i2c_bit");
+
+       status = e1000_set_i2c_data(hw, &i2cctl, data);
+       if (status == E1000_SUCCESS) {
+               e1000_raise_i2c_clk(hw, &i2cctl);
+
+               /* Minimum high period of clock is 4us */
+               usec_delay(E1000_I2C_T_HIGH);
+
+               e1000_lower_i2c_clk(hw, &i2cctl);
+
+               /* Minimum low period of clock is 4.7 us.
+                * This also takes care of the data hold time.
+                */
+               usec_delay(E1000_I2C_T_LOW);
+       } else {
+               status = E1000_ERR_I2C;
+               DEBUGOUT1("I2C data was not set to %X\n", data);
+       }
+
+       return status;
+}
+/**
+ *  e1000_raise_i2c_clk - Raises the I2C SCL clock
+ *  @hw: pointer to hardware structure
+ *  @i2cctl: Current value of I2CCTL register
+ *
+ *  Raises the I2C clock line '0'->'1'
+ **/
+STATIC void e1000_raise_i2c_clk(struct e1000_hw *hw, u32 *i2cctl)
+{
+       DEBUGFUNC("e1000_raise_i2c_clk");
+
+       *i2cctl |= E1000_I2C_CLK_OUT;
+       *i2cctl &= ~E1000_I2C_CLK_OE_N;
+       E1000_WRITE_REG(hw, E1000_I2CPARAMS, *i2cctl);
+       E1000_WRITE_FLUSH(hw);
+
+       /* SCL rise time (1000ns) */
+       usec_delay(E1000_I2C_T_RISE);
+}
+
+/**
+ *  e1000_lower_i2c_clk - Lowers the I2C SCL clock
+ *  @hw: pointer to hardware structure
+ *  @i2cctl: Current value of I2CCTL register
+ *
+ *  Lowers the I2C clock line '1'->'0'
+ **/
+STATIC void e1000_lower_i2c_clk(struct e1000_hw *hw, u32 *i2cctl)
+{
+
+       DEBUGFUNC("e1000_lower_i2c_clk");
+
+       *i2cctl &= ~E1000_I2C_CLK_OUT;
+       *i2cctl &= ~E1000_I2C_CLK_OE_N;
+       E1000_WRITE_REG(hw, E1000_I2CPARAMS, *i2cctl);
+       E1000_WRITE_FLUSH(hw);
+
+       /* SCL fall time (300ns) */
+       usec_delay(E1000_I2C_T_FALL);
+}
+
+/**
+ *  e1000_set_i2c_data - Sets the I2C data bit
+ *  @hw: pointer to hardware structure
+ *  @i2cctl: Current value of I2CCTL register
+ *  @data: I2C data value (0 or 1) to set
+ *
+ *  Sets the I2C data bit
+ **/
+STATIC s32 e1000_set_i2c_data(struct e1000_hw *hw, u32 *i2cctl, bool data)
+{
+       s32 status = E1000_SUCCESS;
+
+       DEBUGFUNC("e1000_set_i2c_data");
+
+       if (data)
+               *i2cctl |= E1000_I2C_DATA_OUT;
+       else
+               *i2cctl &= ~E1000_I2C_DATA_OUT;
+
+       *i2cctl &= ~E1000_I2C_DATA_OE_N;
+       *i2cctl |= E1000_I2C_CLK_OE_N;
+       E1000_WRITE_REG(hw, E1000_I2CPARAMS, *i2cctl);
+       E1000_WRITE_FLUSH(hw);
+
+       /* Data rise/fall (1000ns/300ns) and set-up time (250ns) */
+       usec_delay(E1000_I2C_T_RISE + E1000_I2C_T_FALL + E1000_I2C_T_SU_DATA);
+
+       *i2cctl = E1000_READ_REG(hw, E1000_I2CPARAMS);
+       if (data != e1000_get_i2c_data(i2cctl)) {
+               status = E1000_ERR_I2C;
+               DEBUGOUT1("Error - I2C data was not set to %X.\n", data);
+       }
+
+       return status;
+}
+
+/**
+ *  e1000_get_i2c_data - Reads the I2C SDA data bit
+ *  @hw: pointer to hardware structure
+ *  @i2cctl: Current value of I2CCTL register
+ *
+ *  Returns the I2C data bit value
+ **/
+STATIC bool e1000_get_i2c_data(u32 *i2cctl)
+{
+       bool data;
+
+       DEBUGFUNC("e1000_get_i2c_data");
+
+       if (*i2cctl & E1000_I2C_DATA_IN)
+               data = 1;
+       else
+               data = 0;
+
+       return data;
+}
+
+/**
+ *  e1000_i2c_bus_clear - Clears the I2C bus
+ *  @hw: pointer to hardware structure
+ *
+ *  Clears the I2C bus by sending nine clock pulses.
+ *  Used when data line is stuck low.
+ **/
+void e1000_i2c_bus_clear(struct e1000_hw *hw)
+{
+       u32 i2cctl = E1000_READ_REG(hw, E1000_I2CPARAMS);
+       u32 i;
+
+       DEBUGFUNC("e1000_i2c_bus_clear");
+
+       e1000_i2c_start(hw);
+
+       e1000_set_i2c_data(hw, &i2cctl, 1);
+
+       for (i = 0; i < 9; i++) {
+               e1000_raise_i2c_clk(hw, &i2cctl);
+
+               /* Min high period of clock is 4us */
+               usec_delay(E1000_I2C_T_HIGH);
+
+               e1000_lower_i2c_clk(hw, &i2cctl);
+
+               /* Min low period of clock is 4.7us*/
+               usec_delay(E1000_I2C_T_LOW);
+       }
+
+       e1000_i2c_start(hw);
+
+       /* Put the i2c bus back to default state */
+       e1000_i2c_stop(hw);
+}
+