Quellcodebibliothek Statistik Leitseite products/Sources/formale Sprachen/C/Linux/drivers/net/ethernet/intel/e1000/   (Open Source Betriebssystem Version 6.17.9©)  Datei vom 24.10.2025 mit Größe 154 kB image not shown  

Quelle  e1000_hw.c   Sprache: C

 
// SPDX-License-Identifier: GPL-2.0
/* Copyright(c) 1999 - 2006 Intel Corporation. */

/* e1000_hw.c
 * Shared functions for accessing and configuring the MAC
 */


#include <linux/bitfield.h>
#include "e1000.h"

static s32 e1000_check_downshift(struct e1000_hw *hw);
static s32 e1000_check_polarity(struct e1000_hw *hw,
    e1000_rev_polarity *polarity);
static void e1000_clear_hw_cntrs(struct e1000_hw *hw);
static void e1000_clear_vfta(struct e1000_hw *hw);
static s32 e1000_config_dsp_after_link_change(struct e1000_hw *hw,
           bool link_up);
static s32 e1000_config_fc_after_link_up(struct e1000_hw *hw);
static s32 e1000_detect_gig_phy(struct e1000_hw *hw);
static s32 e1000_get_auto_rd_done(struct e1000_hw *hw);
static s32 e1000_get_cable_length(struct e1000_hw *hw, u16 *min_length,
      u16 *max_length);
static s32 e1000_get_phy_cfg_done(struct e1000_hw *hw);
static s32 e1000_id_led_init(struct e1000_hw *hw);
static void e1000_init_rx_addrs(struct e1000_hw *hw);
static s32 e1000_phy_igp_get_info(struct e1000_hw *hw,
      struct e1000_phy_info *phy_info);
static s32 e1000_phy_m88_get_info(struct e1000_hw *hw,
      struct e1000_phy_info *phy_info);
static s32 e1000_set_d3_lplu_state(struct e1000_hw *hw, bool active);
static s32 e1000_wait_autoneg(struct e1000_hw *hw);
static void e1000_write_reg_io(struct e1000_hw *hw, u32 offset, u32 value);
static s32 e1000_set_phy_type(struct e1000_hw *hw);
static void e1000_phy_init_script(struct e1000_hw *hw);
static s32 e1000_setup_copper_link(struct e1000_hw *hw);
static s32 e1000_setup_fiber_serdes_link(struct e1000_hw *hw);
static s32 e1000_adjust_serdes_amplitude(struct e1000_hw *hw);
static s32 e1000_phy_force_speed_duplex(struct e1000_hw *hw);
static s32 e1000_config_mac_to_phy(struct e1000_hw *hw);
static void e1000_raise_mdi_clk(struct e1000_hw *hw, u32 *ctrl);
static void e1000_lower_mdi_clk(struct e1000_hw *hw, u32 *ctrl);
static void e1000_shift_out_mdi_bits(struct e1000_hw *hw, u32 data, u16 count);
static u16 e1000_shift_in_mdi_bits(struct e1000_hw *hw);
static s32 e1000_phy_reset_dsp(struct e1000_hw *hw);
static s32 e1000_write_eeprom_spi(struct e1000_hw *hw, u16 offset,
      u16 words, u16 *data);
static s32 e1000_write_eeprom_microwire(struct e1000_hw *hw, u16 offset,
     u16 words, u16 *data);
static s32 e1000_spi_eeprom_ready(struct e1000_hw *hw);
static void e1000_raise_ee_clk(struct e1000_hw *hw, u32 *eecd);
static void e1000_lower_ee_clk(struct e1000_hw *hw, u32 *eecd);
static void e1000_shift_out_ee_bits(struct e1000_hw *hw, u16 data, u16 count);
static s32 e1000_write_phy_reg_ex(struct e1000_hw *hw, u32 reg_addr,
      u16 phy_data);
static s32 e1000_read_phy_reg_ex(struct e1000_hw *hw, u32 reg_addr,
     u16 *phy_data);
static u16 e1000_shift_in_ee_bits(struct e1000_hw *hw, u16 count);
static s32 e1000_acquire_eeprom(struct e1000_hw *hw);
static void e1000_release_eeprom(struct e1000_hw *hw);
static void e1000_standby_eeprom(struct e1000_hw *hw);
static s32 e1000_set_vco_speed(struct e1000_hw *hw);
static s32 e1000_polarity_reversal_workaround(struct e1000_hw *hw);
static s32 e1000_set_phy_mode(struct e1000_hw *hw);
static s32 e1000_do_read_eeprom(struct e1000_hw *hw, u16 offset, u16 words,
    u16 *data);
static s32 e1000_do_write_eeprom(struct e1000_hw *hw, u16 offset, u16 words,
     u16 *data);

/* IGP cable length table */
static const
u16 e1000_igp_cable_length_table[IGP01E1000_AGC_LENGTH_TABLE_SIZE] = {
 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5,
 5, 10, 10, 10, 10, 10, 10, 10, 20, 20, 20, 20, 20, 25, 25, 25,
 25, 25, 25, 25, 30, 30, 30, 30, 40, 40, 40, 40, 40, 40, 40, 40,
 40, 50, 50, 50, 50, 50, 50, 50, 60, 60, 60, 60, 60, 60, 60, 60,
 60, 70, 70, 70, 70, 70, 70, 80, 80, 80, 80, 80, 80, 90, 90, 90,
 90, 90, 90, 90, 90, 90, 100, 100, 100, 100, 100, 100, 100, 100, 100,
     100,
 100, 100, 100, 100, 110, 110, 110, 110, 110, 110, 110, 110, 110, 110,
     110, 110,
 110, 110, 110, 110, 110, 110, 120, 120, 120, 120, 120, 120, 120, 120,
     120, 120
};

static DEFINE_MUTEX(e1000_eeprom_lock);
static DEFINE_SPINLOCK(e1000_phy_lock);

/**
 * e1000_set_phy_type - Set the phy type member in the hw struct.
 * @hw: Struct containing variables accessed by shared code
 */

static s32 e1000_set_phy_type(struct e1000_hw *hw)
{
 if (hw->mac_type == e1000_undefined)
  return -E1000_ERR_PHY_TYPE;

 switch (hw->phy_id) {
 case M88E1000_E_PHY_ID:
 case M88E1000_I_PHY_ID:
 case M88E1011_I_PHY_ID:
 case M88E1111_I_PHY_ID:
 case M88E1118_E_PHY_ID:
  hw->phy_type = e1000_phy_m88;
  break;
 case IGP01E1000_I_PHY_ID:
  if (hw->mac_type == e1000_82541 ||
      hw->mac_type == e1000_82541_rev_2 ||
      hw->mac_type == e1000_82547 ||
      hw->mac_type == e1000_82547_rev_2)
   hw->phy_type = e1000_phy_igp;
  break;
 case RTL8211B_PHY_ID:
  hw->phy_type = e1000_phy_8211;
  break;
 case RTL8201N_PHY_ID:
  hw->phy_type = e1000_phy_8201;
  break;
 default:
  /* Should never have loaded on this device */
  hw->phy_type = e1000_phy_undefined;
  return -E1000_ERR_PHY_TYPE;
 }

 return E1000_SUCCESS;
}

/**
 * e1000_phy_init_script - IGP phy init script - initializes the GbE PHY
 * @hw: Struct containing variables accessed by shared code
 */

static void e1000_phy_init_script(struct e1000_hw *hw)
{
 u16 phy_saved_data;

 if (hw->phy_init_script) {
  msleep(20);

  /* Save off the current value of register 0x2F5B to be restored
 * at the end of this routine.
 */

  e1000_read_phy_reg(hw, 0x2F5B, &phy_saved_data);

  /* Disabled the PHY transmitter */
  e1000_write_phy_reg(hw, 0x2F5B, 0x0003);
  msleep(20);

  e1000_write_phy_reg(hw, 0x0000, 0x0140);
  msleep(5);

  switch (hw->mac_type) {
  case e1000_82541:
  case e1000_82547:
   e1000_write_phy_reg(hw, 0x1F95, 0x0001);
   e1000_write_phy_reg(hw, 0x1F71, 0xBD21);
   e1000_write_phy_reg(hw, 0x1F79, 0x0018);
   e1000_write_phy_reg(hw, 0x1F30, 0x1600);
   e1000_write_phy_reg(hw, 0x1F31, 0x0014);
   e1000_write_phy_reg(hw, 0x1F32, 0x161C);
   e1000_write_phy_reg(hw, 0x1F94, 0x0003);
   e1000_write_phy_reg(hw, 0x1F96, 0x003F);
   e1000_write_phy_reg(hw, 0x2010, 0x0008);
   break;

  case e1000_82541_rev_2:
  case e1000_82547_rev_2:
   e1000_write_phy_reg(hw, 0x1F73, 0x0099);
   break;
  default:
   break;
  }

  e1000_write_phy_reg(hw, 0x0000, 0x3300);
  msleep(20);

  /* Now enable the transmitter */
  e1000_write_phy_reg(hw, 0x2F5B, phy_saved_data);

  if (hw->mac_type == e1000_82547) {
   u16 fused, fine, coarse;

   /* Move to analog registers page */
   e1000_read_phy_reg(hw,
        IGP01E1000_ANALOG_SPARE_FUSE_STATUS,
        &fused);

   if (!(fused & IGP01E1000_ANALOG_SPARE_FUSE_ENABLED)) {
    e1000_read_phy_reg(hw,
         IGP01E1000_ANALOG_FUSE_STATUS,
         &fused);

    fine = fused & IGP01E1000_ANALOG_FUSE_FINE_MASK;
    coarse =
        fused & IGP01E1000_ANALOG_FUSE_COARSE_MASK;

    if (coarse >
        IGP01E1000_ANALOG_FUSE_COARSE_THRESH) {
     coarse -=
         IGP01E1000_ANALOG_FUSE_COARSE_10;
     fine -= IGP01E1000_ANALOG_FUSE_FINE_1;
    } else if (coarse ==
        IGP01E1000_ANALOG_FUSE_COARSE_THRESH)
     fine -= IGP01E1000_ANALOG_FUSE_FINE_10;

    fused =
        (fused & IGP01E1000_ANALOG_FUSE_POLY_MASK) |
        (fine & IGP01E1000_ANALOG_FUSE_FINE_MASK) |
        (coarse &
         IGP01E1000_ANALOG_FUSE_COARSE_MASK);

    e1000_write_phy_reg(hw,
          IGP01E1000_ANALOG_FUSE_CONTROL,
          fused);
    e1000_write_phy_reg(hw,
          IGP01E1000_ANALOG_FUSE_BYPASS,
          IGP01E1000_ANALOG_FUSE_ENABLE_SW_CONTROL);
   }
  }
 }
}

/**
 * e1000_set_mac_type - Set the mac type member in the hw struct.
 * @hw: Struct containing variables accessed by shared code
 */

s32 e1000_set_mac_type(struct e1000_hw *hw)
{
 switch (hw->device_id) {
 case E1000_DEV_ID_82542:
  switch (hw->revision_id) {
  case E1000_82542_2_0_REV_ID:
   hw->mac_type = e1000_82542_rev2_0;
   break;
  case E1000_82542_2_1_REV_ID:
   hw->mac_type = e1000_82542_rev2_1;
   break;
  default:
   /* Invalid 82542 revision ID */
   return -E1000_ERR_MAC_TYPE;
  }
  break;
 case E1000_DEV_ID_82543GC_FIBER:
 case E1000_DEV_ID_82543GC_COPPER:
  hw->mac_type = e1000_82543;
  break;
 case E1000_DEV_ID_82544EI_COPPER:
 case E1000_DEV_ID_82544EI_FIBER:
 case E1000_DEV_ID_82544GC_COPPER:
 case E1000_DEV_ID_82544GC_LOM:
  hw->mac_type = e1000_82544;
  break;
 case E1000_DEV_ID_82540EM:
 case E1000_DEV_ID_82540EM_LOM:
 case E1000_DEV_ID_82540EP:
 case E1000_DEV_ID_82540EP_LOM:
 case E1000_DEV_ID_82540EP_LP:
  hw->mac_type = e1000_82540;
  break;
 case E1000_DEV_ID_82545EM_COPPER:
 case E1000_DEV_ID_82545EM_FIBER:
  hw->mac_type = e1000_82545;
  break;
 case E1000_DEV_ID_82545GM_COPPER:
 case E1000_DEV_ID_82545GM_FIBER:
 case E1000_DEV_ID_82545GM_SERDES:
  hw->mac_type = e1000_82545_rev_3;
  break;
 case E1000_DEV_ID_82546EB_COPPER:
 case E1000_DEV_ID_82546EB_FIBER:
 case E1000_DEV_ID_82546EB_QUAD_COPPER:
  hw->mac_type = e1000_82546;
  break;
 case E1000_DEV_ID_82546GB_COPPER:
 case E1000_DEV_ID_82546GB_FIBER:
 case E1000_DEV_ID_82546GB_SERDES:
 case E1000_DEV_ID_82546GB_PCIE:
 case E1000_DEV_ID_82546GB_QUAD_COPPER:
 case E1000_DEV_ID_82546GB_QUAD_COPPER_KSP3:
  hw->mac_type = e1000_82546_rev_3;
  break;
 case E1000_DEV_ID_82541EI:
 case E1000_DEV_ID_82541EI_MOBILE:
 case E1000_DEV_ID_82541ER_LOM:
  hw->mac_type = e1000_82541;
  break;
 case E1000_DEV_ID_82541ER:
 case E1000_DEV_ID_82541GI:
 case E1000_DEV_ID_82541GI_LF:
 case E1000_DEV_ID_82541GI_MOBILE:
  hw->mac_type = e1000_82541_rev_2;
  break;
 case E1000_DEV_ID_82547EI:
 case E1000_DEV_ID_82547EI_MOBILE:
  hw->mac_type = e1000_82547;
  break;
 case E1000_DEV_ID_82547GI:
  hw->mac_type = e1000_82547_rev_2;
  break;
 case E1000_DEV_ID_INTEL_CE4100_GBE:
  hw->mac_type = e1000_ce4100;
  break;
 default:
  /* Should never have loaded on this device */
  return -E1000_ERR_MAC_TYPE;
 }

 switch (hw->mac_type) {
 case e1000_82541:
 case e1000_82547:
 case e1000_82541_rev_2:
 case e1000_82547_rev_2:
  hw->asf_firmware_present = true;
  break;
 default:
  break;
 }

 /* The 82543 chip does not count tx_carrier_errors properly in
 * FD mode
 */

 if (hw->mac_type == e1000_82543)
  hw->bad_tx_carr_stats_fd = true;

 if (hw->mac_type > e1000_82544)
  hw->has_smbus = true;

 return E1000_SUCCESS;
}

/**
 * e1000_set_media_type - Set media type and TBI compatibility.
 * @hw: Struct containing variables accessed by shared code
 */

void e1000_set_media_type(struct e1000_hw *hw)
{
 u32 status;

 if (hw->mac_type != e1000_82543) {
  /* tbi_compatibility is only valid on 82543 */
  hw->tbi_compatibility_en = false;
 }

 switch (hw->device_id) {
 case E1000_DEV_ID_82545GM_SERDES:
 case E1000_DEV_ID_82546GB_SERDES:
  hw->media_type = e1000_media_type_internal_serdes;
  break;
 default:
  switch (hw->mac_type) {
  case e1000_82542_rev2_0:
  case e1000_82542_rev2_1:
   hw->media_type = e1000_media_type_fiber;
   break;
  case e1000_ce4100:
   hw->media_type = e1000_media_type_copper;
   break;
  default:
   status = er32(STATUS);
   if (status & E1000_STATUS_TBIMODE) {
    hw->media_type = e1000_media_type_fiber;
    /* tbi_compatibility not valid on fiber */
    hw->tbi_compatibility_en = false;
   } else {
    hw->media_type = e1000_media_type_copper;
   }
   break;
  }
 }
}

/**
 * e1000_reset_hw - reset the hardware completely
 * @hw: Struct containing variables accessed by shared code
 *
 * Reset the transmit and receive units; mask and clear all interrupts.
 */

s32 e1000_reset_hw(struct e1000_hw *hw)
{
 u32 ctrl;
 u32 ctrl_ext;
 u32 manc;
 u32 led_ctrl;
 s32 ret_val;

 /* For 82542 (rev 2.0), disable MWI before issuing a device reset */
 if (hw->mac_type == e1000_82542_rev2_0) {
  e_dbg("Disabling MWI on 82542 rev 2.0\n");
  e1000_pci_clear_mwi(hw);
 }

 /* Clear interrupt mask to stop board from generating interrupts */
 e_dbg("Masking off all interrupts\n");
 ew32(IMC, 0xffffffff);

 /* Disable the Transmit and Receive units.  Then delay to allow
 * any pending transactions to complete before we hit the MAC with
 * the global reset.
 */

 ew32(RCTL, 0);
 ew32(TCTL, E1000_TCTL_PSP);
 E1000_WRITE_FLUSH();

 /* The tbi_compatibility_on Flag must be cleared when Rctl is cleared. */
 hw->tbi_compatibility_on = false;

 /* Delay to allow any outstanding PCI transactions to complete before
 * resetting the device
 */

 msleep(10);

 ctrl = er32(CTRL);

 /* Must reset the PHY before resetting the MAC */
 if ((hw->mac_type == e1000_82541) || (hw->mac_type == e1000_82547)) {
  ew32(CTRL, (ctrl | E1000_CTRL_PHY_RST));
  E1000_WRITE_FLUSH();
  msleep(5);
 }

 /* Issue a global reset to the MAC.  This will reset the chip's
 * transmit, receive, DMA, and link units.  It will not effect
 * the current PCI configuration.  The global reset bit is self-
 * clearing, and should clear within a microsecond.
 */

 e_dbg("Issuing a global reset to MAC\n");

 switch (hw->mac_type) {
 case e1000_82544:
 case e1000_82540:
 case e1000_82545:
 case e1000_82546:
 case e1000_82541:
 case e1000_82541_rev_2:
  /* These controllers can't ack the 64-bit write when issuing the
 * reset, so use IO-mapping as a workaround to issue the reset
 */

  E1000_WRITE_REG_IO(hw, CTRL, (ctrl | E1000_CTRL_RST));
  break;
 case e1000_82545_rev_3:
 case e1000_82546_rev_3:
  /* Reset is performed on a shadow of the control register */
  ew32(CTRL_DUP, (ctrl | E1000_CTRL_RST));
  break;
 case e1000_ce4100:
 default:
  ew32(CTRL, (ctrl | E1000_CTRL_RST));
  break;
 }

 /* After MAC reset, force reload of EEPROM to restore power-on settings
 * to device.  Later controllers reload the EEPROM automatically, so
 * just wait for reload to complete.
 */

 switch (hw->mac_type) {
 case e1000_82542_rev2_0:
 case e1000_82542_rev2_1:
 case e1000_82543:
 case e1000_82544:
  /* Wait for reset to complete */
  udelay(10);
  ctrl_ext = er32(CTRL_EXT);
  ctrl_ext |= E1000_CTRL_EXT_EE_RST;
  ew32(CTRL_EXT, ctrl_ext);
  E1000_WRITE_FLUSH();
  /* Wait for EEPROM reload */
  msleep(2);
  break;
 case e1000_82541:
 case e1000_82541_rev_2:
 case e1000_82547:
 case e1000_82547_rev_2:
  /* Wait for EEPROM reload */
  msleep(20);
  break;
 default:
  /* Auto read done will delay 5ms or poll based on mac type */
  ret_val = e1000_get_auto_rd_done(hw);
  if (ret_val)
   return ret_val;
  break;
 }

 /* Disable HW ARPs on ASF enabled adapters */
 if (hw->mac_type >= e1000_82540) {
  manc = er32(MANC);
  manc &= ~(E1000_MANC_ARP_EN);
  ew32(MANC, manc);
 }

 if ((hw->mac_type == e1000_82541) || (hw->mac_type == e1000_82547)) {
  e1000_phy_init_script(hw);

  /* Configure activity LED after PHY reset */
  led_ctrl = er32(LEDCTL);
  led_ctrl &= IGP_ACTIVITY_LED_MASK;
  led_ctrl |= (IGP_ACTIVITY_LED_ENABLE | IGP_LED3_MODE);
  ew32(LEDCTL, led_ctrl);
 }

 /* Clear interrupt mask to stop board from generating interrupts */
 e_dbg("Masking off all interrupts\n");
 ew32(IMC, 0xffffffff);

 /* Clear any pending interrupt events. */
 er32(ICR);

 /* If MWI was previously enabled, reenable it. */
 if (hw->mac_type == e1000_82542_rev2_0) {
  if (hw->pci_cmd_word & PCI_COMMAND_INVALIDATE)
   e1000_pci_set_mwi(hw);
 }

 return E1000_SUCCESS;
}

/**
 * e1000_init_hw - Performs basic configuration of the adapter.
 * @hw: Struct containing variables accessed by shared code
 *
 * Assumes that the controller has previously been reset and is in a
 * post-reset uninitialized state. Initializes the receive address registers,
 * multicast table, and VLAN filter table. Calls routines to setup link
 * configuration and flow control settings. Clears all on-chip counters. Leaves
 * the transmit and receive units disabled and uninitialized.
 */

s32 e1000_init_hw(struct e1000_hw *hw)
{
 u32 ctrl;
 u32 i;
 s32 ret_val;
 u32 mta_size;
 u32 ctrl_ext;

 /* Initialize Identification LED */
 ret_val = e1000_id_led_init(hw);
 if (ret_val) {
  e_dbg("Error Initializing Identification LED\n");
  return ret_val;
 }

 /* Set the media type and TBI compatibility */
 e1000_set_media_type(hw);

 /* Disabling VLAN filtering. */
 e_dbg("Initializing the IEEE VLAN\n");
 if (hw->mac_type < e1000_82545_rev_3)
  ew32(VET, 0);
 e1000_clear_vfta(hw);

 /* For 82542 (rev 2.0), disable MWI and put the receiver into reset */
 if (hw->mac_type == e1000_82542_rev2_0) {
  e_dbg("Disabling MWI on 82542 rev 2.0\n");
  e1000_pci_clear_mwi(hw);
  ew32(RCTL, E1000_RCTL_RST);
  E1000_WRITE_FLUSH();
  msleep(5);
 }

 /* Setup the receive address. This involves initializing all of the
 * Receive Address Registers (RARs 0 - 15).
 */

 e1000_init_rx_addrs(hw);

 /* For 82542 (rev 2.0), take the receiver out of reset and enable MWI */
 if (hw->mac_type == e1000_82542_rev2_0) {
  ew32(RCTL, 0);
  E1000_WRITE_FLUSH();
  msleep(1);
  if (hw->pci_cmd_word & PCI_COMMAND_INVALIDATE)
   e1000_pci_set_mwi(hw);
 }

 /* Zero out the Multicast HASH table */
 e_dbg("Zeroing the MTA\n");
 mta_size = E1000_MC_TBL_SIZE;
 for (i = 0; i < mta_size; i++) {
  E1000_WRITE_REG_ARRAY(hw, MTA, i, 0);
  /* use write flush to prevent Memory Write Block (MWB) from
 * occurring when accessing our register space
 */

  E1000_WRITE_FLUSH();
 }

 /* Set the PCI priority bit correctly in the CTRL register.  This
 * determines if the adapter gives priority to receives, or if it
 * gives equal priority to transmits and receives.  Valid only on
 * 82542 and 82543 silicon.
 */

 if (hw->dma_fairness && hw->mac_type <= e1000_82543) {
  ctrl = er32(CTRL);
  ew32(CTRL, ctrl | E1000_CTRL_PRIOR);
 }

 switch (hw->mac_type) {
 case e1000_82545_rev_3:
 case e1000_82546_rev_3:
  break;
 default:
  /* Workaround for PCI-X problem when BIOS sets MMRBC
 * incorrectly.
 */

  if (hw->bus_type == e1000_bus_type_pcix &&
      e1000_pcix_get_mmrbc(hw) > 2048)
   e1000_pcix_set_mmrbc(hw, 2048);
  break;
 }

 /* Call a subroutine to configure the link and setup flow control. */
 ret_val = e1000_setup_link(hw);

 /* Set the transmit descriptor write-back policy */
 if (hw->mac_type > e1000_82544) {
  ctrl = er32(TXDCTL);
  ctrl =
      (ctrl & ~E1000_TXDCTL_WTHRESH) |
      E1000_TXDCTL_FULL_TX_DESC_WB;
  ew32(TXDCTL, ctrl);
 }

 /* Clear all of the statistics registers (clear on read).  It is
 * important that we do this after we have tried to establish link
 * because the symbol error count will increment wildly if there
 * is no link.
 */

 e1000_clear_hw_cntrs(hw);

 if (hw->device_id == E1000_DEV_ID_82546GB_QUAD_COPPER ||
     hw->device_id == E1000_DEV_ID_82546GB_QUAD_COPPER_KSP3) {
  ctrl_ext = er32(CTRL_EXT);
  /* Relaxed ordering must be disabled to avoid a parity
 * error crash in a PCI slot.
 */

  ctrl_ext |= E1000_CTRL_EXT_RO_DIS;
  ew32(CTRL_EXT, ctrl_ext);
 }

 return ret_val;
}

/**
 * e1000_adjust_serdes_amplitude - Adjust SERDES output amplitude based on EEPROM setting.
 * @hw: Struct containing variables accessed by shared code.
 */

static s32 e1000_adjust_serdes_amplitude(struct e1000_hw *hw)
{
 u16 eeprom_data;
 s32 ret_val;

 if (hw->media_type != e1000_media_type_internal_serdes)
  return E1000_SUCCESS;

 switch (hw->mac_type) {
 case e1000_82545_rev_3:
 case e1000_82546_rev_3:
  break;
 default:
  return E1000_SUCCESS;
 }

 ret_val = e1000_read_eeprom(hw, EEPROM_SERDES_AMPLITUDE, 1,
        &eeprom_data);
 if (ret_val)
  return ret_val;

 if (eeprom_data != EEPROM_RESERVED_WORD) {
  /* Adjust SERDES output amplitude only. */
  eeprom_data &= EEPROM_SERDES_AMPLITUDE_MASK;
  ret_val =
      e1000_write_phy_reg(hw, M88E1000_PHY_EXT_CTRL, eeprom_data);
  if (ret_val)
   return ret_val;
 }

 return E1000_SUCCESS;
}

/**
 * e1000_setup_link - Configures flow control and link settings.
 * @hw: Struct containing variables accessed by shared code
 *
 * Determines which flow control settings to use. Calls the appropriate media-
 * specific link configuration function. Configures the flow control settings.
 * Assuming the adapter has a valid link partner, a valid link should be
 * established. Assumes the hardware has previously been reset and the
 * transmitter and receiver are not enabled.
 */

s32 e1000_setup_link(struct e1000_hw *hw)
{
 u32 ctrl_ext;
 s32 ret_val;
 u16 eeprom_data;

 /* Read and store word 0x0F of the EEPROM. This word contains bits
 * that determine the hardware's default PAUSE (flow control) mode,
 * a bit that determines whether the HW defaults to enabling or
 * disabling auto-negotiation, and the direction of the
 * SW defined pins. If there is no SW over-ride of the flow
 * control setting, then the variable hw->fc will
 * be initialized based on a value in the EEPROM.
 */

 if (hw->fc == E1000_FC_DEFAULT) {
  ret_val = e1000_read_eeprom(hw, EEPROM_INIT_CONTROL2_REG,
         1, &eeprom_data);
  if (ret_val) {
   e_dbg("EEPROM Read Error\n");
   return -E1000_ERR_EEPROM;
  }
  if ((eeprom_data & EEPROM_WORD0F_PAUSE_MASK) == 0)
   hw->fc = E1000_FC_NONE;
  else if ((eeprom_data & EEPROM_WORD0F_PAUSE_MASK) ==
    EEPROM_WORD0F_ASM_DIR)
   hw->fc = E1000_FC_TX_PAUSE;
  else
   hw->fc = E1000_FC_FULL;
 }

 /* We want to save off the original Flow Control configuration just
 * in case we get disconnected and then reconnected into a different
 * hub or switch with different Flow Control capabilities.
 */

 if (hw->mac_type == e1000_82542_rev2_0)
  hw->fc &= (~E1000_FC_TX_PAUSE);

 if ((hw->mac_type < e1000_82543) && (hw->report_tx_early == 1))
  hw->fc &= (~E1000_FC_RX_PAUSE);

 hw->original_fc = hw->fc;

 e_dbg("After fix-ups FlowControl is now = %x\n", hw->fc);

 /* Take the 4 bits from EEPROM word 0x0F that determine the initial
 * polarity value for the SW controlled pins, and setup the
 * Extended Device Control reg with that info.
 * This is needed because one of the SW controlled pins is used for
 * signal detection.  So this should be done before e1000_setup_pcs_link()
 * or e1000_phy_setup() is called.
 */

 if (hw->mac_type == e1000_82543) {
  ret_val = e1000_read_eeprom(hw, EEPROM_INIT_CONTROL2_REG,
         1, &eeprom_data);
  if (ret_val) {
   e_dbg("EEPROM Read Error\n");
   return -E1000_ERR_EEPROM;
  }
  ctrl_ext = ((eeprom_data & EEPROM_WORD0F_SWPDIO_EXT) <<
       SWDPIO__EXT_SHIFT);
  ew32(CTRL_EXT, ctrl_ext);
 }

 /* Call the necessary subroutine to configure the link. */
 ret_val = (hw->media_type == e1000_media_type_copper) ?
     e1000_setup_copper_link(hw) : e1000_setup_fiber_serdes_link(hw);

 /* Initialize the flow control address, type, and PAUSE timer
 * registers to their default values.  This is done even if flow
 * control is disabled, because it does not hurt anything to
 * initialize these registers.
 */

 e_dbg("Initializing the Flow Control address, type and timer regs\n");

 ew32(FCT, FLOW_CONTROL_TYPE);
 ew32(FCAH, FLOW_CONTROL_ADDRESS_HIGH);
 ew32(FCAL, FLOW_CONTROL_ADDRESS_LOW);

 ew32(FCTTV, hw->fc_pause_time);

 /* Set the flow control receive threshold registers.  Normally,
 * these registers will be set to a default threshold that may be
 * adjusted later by the driver's runtime code.  However, if the
 * ability to transmit pause frames in not enabled, then these
 * registers will be set to 0.
 */

 if (!(hw->fc & E1000_FC_TX_PAUSE)) {
  ew32(FCRTL, 0);
  ew32(FCRTH, 0);
 } else {
  /* We need to set up the Receive Threshold high and low water
 * marks as well as (optionally) enabling the transmission of
 * XON frames.
 */

  if (hw->fc_send_xon) {
   ew32(FCRTL, (hw->fc_low_water | E1000_FCRTL_XONE));
   ew32(FCRTH, hw->fc_high_water);
  } else {
   ew32(FCRTL, hw->fc_low_water);
   ew32(FCRTH, hw->fc_high_water);
  }
 }
 return ret_val;
}

/**
 * e1000_setup_fiber_serdes_link - prepare fiber or serdes link
 * @hw: Struct containing variables accessed by shared code
 *
 * Manipulates Physical Coding Sublayer functions in order to configure
 * link. Assumes the hardware has been previously reset and the transmitter
 * and receiver are not enabled.
 */

static s32 e1000_setup_fiber_serdes_link(struct e1000_hw *hw)
{
 u32 ctrl;
 u32 status;
 u32 txcw = 0;
 u32 i;
 u32 signal = 0;
 s32 ret_val;

 /* On adapters with a MAC newer than 82544, SWDP 1 will be
 * set when the optics detect a signal. On older adapters, it will be
 * cleared when there is a signal.  This applies to fiber media only.
 * If we're on serdes media, adjust the output amplitude to value
 * set in the EEPROM.
 */

 ctrl = er32(CTRL);
 if (hw->media_type == e1000_media_type_fiber)
  signal = (hw->mac_type > e1000_82544) ? E1000_CTRL_SWDPIN1 : 0;

 ret_val = e1000_adjust_serdes_amplitude(hw);
 if (ret_val)
  return ret_val;

 /* Take the link out of reset */
 ctrl &= ~(E1000_CTRL_LRST);

 /* Adjust VCO speed to improve BER performance */
 ret_val = e1000_set_vco_speed(hw);
 if (ret_val)
  return ret_val;

 e1000_config_collision_dist(hw);

 /* Check for a software override of the flow control settings, and setup
 * the device accordingly.  If auto-negotiation is enabled, then
 * software will have to set the "PAUSE" bits to the correct value in
 * the Tranmsit Config Word Register (TXCW) and re-start
 * auto-negotiation.  However, if auto-negotiation is disabled, then
 * software will have to manually configure the two flow control enable
 * bits in the CTRL register.
 *
 * The possible values of the "fc" parameter are:
 *  0:  Flow control is completely disabled
 *  1:  Rx flow control is enabled (we can receive pause frames, but
 *      not send pause frames).
 *  2:  Tx flow control is enabled (we can send pause frames but we do
 *      not support receiving pause frames).
 *  3:  Both Rx and TX flow control (symmetric) are enabled.
 */

 switch (hw->fc) {
 case E1000_FC_NONE:
  /* Flow ctrl is completely disabled by a software over-ride */
  txcw = (E1000_TXCW_ANE | E1000_TXCW_FD);
  break;
 case E1000_FC_RX_PAUSE:
  /* Rx Flow control is enabled and Tx Flow control is disabled by
 * a software over-ride. Since there really isn't a way to
 * advertise that we are capable of Rx Pause ONLY, we will
 * advertise that we support both symmetric and asymmetric Rx
 * PAUSE. Later, we will disable the adapter's ability to send
 * PAUSE frames.
 */

  txcw = (E1000_TXCW_ANE | E1000_TXCW_FD | E1000_TXCW_PAUSE_MASK);
  break;
 case E1000_FC_TX_PAUSE:
  /* Tx Flow control is enabled, and Rx Flow control is disabled,
 * by a software over-ride.
 */

  txcw = (E1000_TXCW_ANE | E1000_TXCW_FD | E1000_TXCW_ASM_DIR);
  break;
 case E1000_FC_FULL:
  /* Flow control (both Rx and Tx) is enabled by a software
 * over-ride.
 */

  txcw = (E1000_TXCW_ANE | E1000_TXCW_FD | E1000_TXCW_PAUSE_MASK);
  break;
 default:
  e_dbg("Flow control param set incorrectly\n");
  return -E1000_ERR_CONFIG;
 }

 /* Since auto-negotiation is enabled, take the link out of reset (the
 * link will be in reset, because we previously reset the chip). This
 * will restart auto-negotiation.  If auto-negotiation is successful
 * then the link-up status bit will be set and the flow control enable
 * bits (RFCE and TFCE) will be set according to their negotiated value.
 */

 e_dbg("Auto-negotiation enabled\n");

 ew32(TXCW, txcw);
 ew32(CTRL, ctrl);
 E1000_WRITE_FLUSH();

 hw->txcw = txcw;
 msleep(1);

 /* If we have a signal (the cable is plugged in) then poll for a
 * "Link-Up" indication in the Device Status Register.  Time-out if a
 * link isn't seen in 500 milliseconds seconds (Auto-negotiation should
 * complete in less than 500 milliseconds even if the other end is doing
 * it in SW). For internal serdes, we just assume a signal is present,
 * then poll.
 */

 if (hw->media_type == e1000_media_type_internal_serdes ||
     (er32(CTRL) & E1000_CTRL_SWDPIN1) == signal) {
  e_dbg("Looking for Link\n");
  for (i = 0; i < (LINK_UP_TIMEOUT / 10); i++) {
   msleep(10);
   status = er32(STATUS);
   if (status & E1000_STATUS_LU)
    break;
  }
  if (i == (LINK_UP_TIMEOUT / 10)) {
   e_dbg("Never got a valid link from auto-neg!!!\n");
   hw->autoneg_failed = 1;
   /* AutoNeg failed to achieve a link, so we'll call
 * e1000_check_for_link. This routine will force the
 * link up if we detect a signal. This will allow us to
 * communicate with non-autonegotiating link partners.
 */

   ret_val = e1000_check_for_link(hw);
   if (ret_val) {
    e_dbg("Error while checking for link\n");
    return ret_val;
   }
   hw->autoneg_failed = 0;
  } else {
   hw->autoneg_failed = 0;
   e_dbg("Valid Link Found\n");
  }
 } else {
  e_dbg("No Signal Detected\n");
 }
 return E1000_SUCCESS;
}

/**
 * e1000_copper_link_rtl_setup - Copper link setup for e1000_phy_rtl series.
 * @hw: Struct containing variables accessed by shared code
 *
 * Commits changes to PHY configuration by calling e1000_phy_reset().
 */

static s32 e1000_copper_link_rtl_setup(struct e1000_hw *hw)
{
 s32 ret_val;

 /* SW reset the PHY so all changes take effect */
 ret_val = e1000_phy_reset(hw);
 if (ret_val) {
  e_dbg("Error Resetting the PHY\n");
  return ret_val;
 }

 return E1000_SUCCESS;
}

static s32 gbe_dhg_phy_setup(struct e1000_hw *hw)
{
 s32 ret_val;
 u32 ctrl_aux;

 switch (hw->phy_type) {
 case e1000_phy_8211:
  ret_val = e1000_copper_link_rtl_setup(hw);
  if (ret_val) {
   e_dbg("e1000_copper_link_rtl_setup failed!\n");
   return ret_val;
  }
  break;
 case e1000_phy_8201:
  /* Set RMII mode */
  ctrl_aux = er32(CTL_AUX);
  ctrl_aux |= E1000_CTL_AUX_RMII;
  ew32(CTL_AUX, ctrl_aux);
  E1000_WRITE_FLUSH();

  /* Disable the J/K bits required for receive */
  ctrl_aux = er32(CTL_AUX);
  ctrl_aux |= 0x4;
  ctrl_aux &= ~0x2;
  ew32(CTL_AUX, ctrl_aux);
  E1000_WRITE_FLUSH();
  ret_val = e1000_copper_link_rtl_setup(hw);

  if (ret_val) {
   e_dbg("e1000_copper_link_rtl_setup failed!\n");
   return ret_val;
  }
  break;
 default:
  e_dbg("Error Resetting the PHY\n");
  return E1000_ERR_PHY_TYPE;
 }

 return E1000_SUCCESS;
}

/**
 * e1000_copper_link_preconfig - early configuration for copper
 * @hw: Struct containing variables accessed by shared code
 *
 * Make sure we have a valid PHY and change PHY mode before link setup.
 */

static s32 e1000_copper_link_preconfig(struct e1000_hw *hw)
{
 u32 ctrl;
 s32 ret_val;
 u16 phy_data;

 ctrl = er32(CTRL);
 /* With 82543, we need to force speed and duplex on the MAC equal to
 * what the PHY speed and duplex configuration is. In addition, we need
 * to perform a hardware reset on the PHY to take it out of reset.
 */

 if (hw->mac_type > e1000_82543) {
  ctrl |= E1000_CTRL_SLU;
  ctrl &= ~(E1000_CTRL_FRCSPD | E1000_CTRL_FRCDPX);
  ew32(CTRL, ctrl);
 } else {
  ctrl |=
      (E1000_CTRL_FRCSPD | E1000_CTRL_FRCDPX | E1000_CTRL_SLU);
  ew32(CTRL, ctrl);
  ret_val = e1000_phy_hw_reset(hw);
  if (ret_val)
   return ret_val;
 }

 /* Make sure we have a valid PHY */
 ret_val = e1000_detect_gig_phy(hw);
 if (ret_val) {
  e_dbg("Error, did not detect valid phy.\n");
  return ret_val;
 }
 e_dbg("Phy ID = %x\n", hw->phy_id);

 /* Set PHY to class A mode (if necessary) */
 ret_val = e1000_set_phy_mode(hw);
 if (ret_val)
  return ret_val;

 if ((hw->mac_type == e1000_82545_rev_3) ||
     (hw->mac_type == e1000_82546_rev_3)) {
  ret_val =
      e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);
  phy_data |= 0x00000008;
  ret_val =
      e1000_write_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, phy_data);
 }

 if (hw->mac_type <= e1000_82543 ||
     hw->mac_type == e1000_82541 || hw->mac_type == e1000_82547 ||
     hw->mac_type == e1000_82541_rev_2 ||
     hw->mac_type == e1000_82547_rev_2)
  hw->phy_reset_disable = false;

 return E1000_SUCCESS;
}

/**
 * e1000_copper_link_igp_setup - Copper link setup for e1000_phy_igp series.
 * @hw: Struct containing variables accessed by shared code
 */

static s32 e1000_copper_link_igp_setup(struct e1000_hw *hw)
{
 u32 led_ctrl;
 s32 ret_val;
 u16 phy_data;

 if (hw->phy_reset_disable)
  return E1000_SUCCESS;

 ret_val = e1000_phy_reset(hw);
 if (ret_val) {
  e_dbg("Error Resetting the PHY\n");
  return ret_val;
 }

 /* Wait 15ms for MAC to configure PHY from eeprom settings */
 msleep(15);
 /* Configure activity LED after PHY reset */
 led_ctrl = er32(LEDCTL);
 led_ctrl &= IGP_ACTIVITY_LED_MASK;
 led_ctrl |= (IGP_ACTIVITY_LED_ENABLE | IGP_LED3_MODE);
 ew32(LEDCTL, led_ctrl);

 /* The NVM settings will configure LPLU in D3 for IGP2 and IGP3 PHYs */
 if (hw->phy_type == e1000_phy_igp) {
  /* disable lplu d3 during driver init */
  ret_val = e1000_set_d3_lplu_state(hw, false);
  if (ret_val) {
   e_dbg("Error Disabling LPLU D3\n");
   return ret_val;
  }
 }

 /* Configure mdi-mdix settings */
 ret_val = e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_CTRL, &phy_data);
 if (ret_val)
  return ret_val;

 if ((hw->mac_type == e1000_82541) || (hw->mac_type == e1000_82547)) {
  hw->dsp_config_state = e1000_dsp_config_disabled;
  /* Force MDI for earlier revs of the IGP PHY */
  phy_data &=
      ~(IGP01E1000_PSCR_AUTO_MDIX |
        IGP01E1000_PSCR_FORCE_MDI_MDIX);
  hw->mdix = 1;

 } else {
  hw->dsp_config_state = e1000_dsp_config_enabled;
  phy_data &= ~IGP01E1000_PSCR_AUTO_MDIX;

  switch (hw->mdix) {
  case 1:
   phy_data &= ~IGP01E1000_PSCR_FORCE_MDI_MDIX;
   break;
  case 2:
   phy_data |= IGP01E1000_PSCR_FORCE_MDI_MDIX;
   break;
  case 0:
  default:
   phy_data |= IGP01E1000_PSCR_AUTO_MDIX;
   break;
  }
 }
 ret_val = e1000_write_phy_reg(hw, IGP01E1000_PHY_PORT_CTRL, phy_data);
 if (ret_val)
  return ret_val;

 /* set auto-master slave resolution settings */
 if (hw->autoneg) {
  e1000_ms_type phy_ms_setting = hw->master_slave;

  if (hw->ffe_config_state == e1000_ffe_config_active)
   hw->ffe_config_state = e1000_ffe_config_enabled;

  if (hw->dsp_config_state == e1000_dsp_config_activated)
   hw->dsp_config_state = e1000_dsp_config_enabled;

  /* when autonegotiation advertisement is only 1000Mbps then we
 * should disable SmartSpeed and enable Auto MasterSlave
 * resolution as hardware default.
 */

  if (hw->autoneg_advertised == ADVERTISE_1000_FULL) {
   /* Disable SmartSpeed */
   ret_val =
       e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
            &phy_data);
   if (ret_val)
    return ret_val;
   phy_data &= ~IGP01E1000_PSCFR_SMART_SPEED;
   ret_val =
       e1000_write_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
      phy_data);
   if (ret_val)
    return ret_val;
   /* Set auto Master/Slave resolution process */
   ret_val =
       e1000_read_phy_reg(hw, PHY_1000T_CTRL, &phy_data);
   if (ret_val)
    return ret_val;
   phy_data &= ~CR_1000T_MS_ENABLE;
   ret_val =
       e1000_write_phy_reg(hw, PHY_1000T_CTRL, phy_data);
   if (ret_val)
    return ret_val;
  }

  ret_val = e1000_read_phy_reg(hw, PHY_1000T_CTRL, &phy_data);
  if (ret_val)
   return ret_val;

  /* load defaults for future use */
  hw->original_master_slave = (phy_data & CR_1000T_MS_ENABLE) ?
      ((phy_data & CR_1000T_MS_VALUE) ?
       e1000_ms_force_master :
       e1000_ms_force_slave) : e1000_ms_auto;

  switch (phy_ms_setting) {
  case e1000_ms_force_master:
   phy_data |= (CR_1000T_MS_ENABLE | CR_1000T_MS_VALUE);
   break;
  case e1000_ms_force_slave:
   phy_data |= CR_1000T_MS_ENABLE;
   phy_data &= ~(CR_1000T_MS_VALUE);
   break;
  case e1000_ms_auto:
   phy_data &= ~CR_1000T_MS_ENABLE;
   break;
  default:
   break;
  }
  ret_val = e1000_write_phy_reg(hw, PHY_1000T_CTRL, phy_data);
  if (ret_val)
   return ret_val;
 }

 return E1000_SUCCESS;
}

/**
 * e1000_copper_link_mgp_setup - Copper link setup for e1000_phy_m88 series.
 * @hw: Struct containing variables accessed by shared code
 */

static s32 e1000_copper_link_mgp_setup(struct e1000_hw *hw)
{
 s32 ret_val;
 u16 phy_data;

 if (hw->phy_reset_disable)
  return E1000_SUCCESS;

 /* Enable CRS on TX. This must be set for half-duplex operation. */
 ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);
 if (ret_val)
  return ret_val;

 phy_data |= M88E1000_PSCR_ASSERT_CRS_ON_TX;

 /* Options:
 *   MDI/MDI-X = 0 (default)
 *   0 - Auto for all speeds
 *   1 - MDI mode
 *   2 - MDI-X mode
 *   3 - Auto for 1000Base-T only (MDI-X for 10/100Base-T modes)
 */

 phy_data &= ~M88E1000_PSCR_AUTO_X_MODE;

 switch (hw->mdix) {
 case 1:
  phy_data |= M88E1000_PSCR_MDI_MANUAL_MODE;
  break;
 case 2:
  phy_data |= M88E1000_PSCR_MDIX_MANUAL_MODE;
  break;
 case 3:
  phy_data |= M88E1000_PSCR_AUTO_X_1000T;
  break;
 case 0:
 default:
  phy_data |= M88E1000_PSCR_AUTO_X_MODE;
  break;
 }

 /* Options:
 *   disable_polarity_correction = 0 (default)
 *       Automatic Correction for Reversed Cable Polarity
 *   0 - Disabled
 *   1 - Enabled
 */

 phy_data &= ~M88E1000_PSCR_POLARITY_REVERSAL;
 if (hw->disable_polarity_correction == 1)
  phy_data |= M88E1000_PSCR_POLARITY_REVERSAL;
 ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, phy_data);
 if (ret_val)
  return ret_val;

 if (hw->phy_revision < M88E1011_I_REV_4) {
  /* Force TX_CLK in the Extended PHY Specific Control Register
 * to 25MHz clock.
 */

  ret_val =
      e1000_read_phy_reg(hw, M88E1000_EXT_PHY_SPEC_CTRL,
           &phy_data);
  if (ret_val)
   return ret_val;

  phy_data |= M88E1000_EPSCR_TX_CLK_25;

  if ((hw->phy_revision == E1000_REVISION_2) &&
      (hw->phy_id == M88E1111_I_PHY_ID)) {
   /* Vidalia Phy, set the downshift counter to 5x */
   phy_data &= ~(M88EC018_EPSCR_DOWNSHIFT_COUNTER_MASK);
   phy_data |= M88EC018_EPSCR_DOWNSHIFT_COUNTER_5X;
   ret_val = e1000_write_phy_reg(hw,
            M88E1000_EXT_PHY_SPEC_CTRL,
            phy_data);
   if (ret_val)
    return ret_val;
  } else {
   /* Configure Master and Slave downshift values */
   phy_data &= ~(M88E1000_EPSCR_MASTER_DOWNSHIFT_MASK |
          M88E1000_EPSCR_SLAVE_DOWNSHIFT_MASK);
   phy_data |= (M88E1000_EPSCR_MASTER_DOWNSHIFT_1X |
         M88E1000_EPSCR_SLAVE_DOWNSHIFT_1X);
   ret_val = e1000_write_phy_reg(hw,
            M88E1000_EXT_PHY_SPEC_CTRL,
            phy_data);
   if (ret_val)
    return ret_val;
  }
 }

 /* SW Reset the PHY so all changes take effect */
 ret_val = e1000_phy_reset(hw);
 if (ret_val) {
  e_dbg("Error Resetting the PHY\n");
  return ret_val;
 }

 return E1000_SUCCESS;
}

/**
 * e1000_copper_link_autoneg - setup auto-neg
 * @hw: Struct containing variables accessed by shared code
 *
 * Setup auto-negotiation and flow control advertisements,
 * and then perform auto-negotiation.
 */

static s32 e1000_copper_link_autoneg(struct e1000_hw *hw)
{
 s32 ret_val;
 u16 phy_data;

 /* Perform some bounds checking on the hw->autoneg_advertised
 * parameter.  If this variable is zero, then set it to the default.
 */

 hw->autoneg_advertised &= AUTONEG_ADVERTISE_SPEED_DEFAULT;

 /* If autoneg_advertised is zero, we assume it was not defaulted
 * by the calling code so we set to advertise full capability.
 */

 if (hw->autoneg_advertised == 0)
  hw->autoneg_advertised = AUTONEG_ADVERTISE_SPEED_DEFAULT;

 /* IFE/RTL8201N PHY only supports 10/100 */
 if (hw->phy_type == e1000_phy_8201)
  hw->autoneg_advertised &= AUTONEG_ADVERTISE_10_100_ALL;

 e_dbg("Reconfiguring auto-neg advertisement params\n");
 ret_val = e1000_phy_setup_autoneg(hw);
 if (ret_val) {
  e_dbg("Error Setting up Auto-Negotiation\n");
  return ret_val;
 }
 e_dbg("Restarting Auto-Neg\n");

 /* Restart auto-negotiation by setting the Auto Neg Enable bit and
 * the Auto Neg Restart bit in the PHY control register.
 */

 ret_val = e1000_read_phy_reg(hw, PHY_CTRL, &phy_data);
 if (ret_val)
  return ret_val;

 phy_data |= (MII_CR_AUTO_NEG_EN | MII_CR_RESTART_AUTO_NEG);
 ret_val = e1000_write_phy_reg(hw, PHY_CTRL, phy_data);
 if (ret_val)
  return ret_val;

 /* Does the user want to wait for Auto-Neg to complete here, or
 * check at a later time (for example, callback routine).
 */

 if (hw->wait_autoneg_complete) {
  ret_val = e1000_wait_autoneg(hw);
  if (ret_val) {
   e_dbg
       ("Error while waiting for autoneg to complete\n");
   return ret_val;
  }
 }

 hw->get_link_status = true;

 return E1000_SUCCESS;
}

/**
 * e1000_copper_link_postconfig - post link setup
 * @hw: Struct containing variables accessed by shared code
 *
 * Config the MAC and the PHY after link is up.
 *   1) Set up the MAC to the current PHY speed/duplex
 *      if we are on 82543.  If we
 *      are on newer silicon, we only need to configure
 *      collision distance in the Transmit Control Register.
 *   2) Set up flow control on the MAC to that established with
 *      the link partner.
 *   3) Config DSP to improve Gigabit link quality for some PHY revisions.
 */

static s32 e1000_copper_link_postconfig(struct e1000_hw *hw)
{
 s32 ret_val;

 if ((hw->mac_type >= e1000_82544) && (hw->mac_type != e1000_ce4100)) {
  e1000_config_collision_dist(hw);
 } else {
  ret_val = e1000_config_mac_to_phy(hw);
  if (ret_val) {
   e_dbg("Error configuring MAC to PHY settings\n");
   return ret_val;
  }
 }
 ret_val = e1000_config_fc_after_link_up(hw);
 if (ret_val) {
  e_dbg("Error Configuring Flow Control\n");
  return ret_val;
 }

 /* Config DSP to improve Giga link quality */
 if (hw->phy_type == e1000_phy_igp) {
  ret_val = e1000_config_dsp_after_link_change(hw, true);
  if (ret_val) {
   e_dbg("Error Configuring DSP after link up\n");
   return ret_val;
  }
 }

 return E1000_SUCCESS;
}

/**
 * e1000_setup_copper_link - phy/speed/duplex setting
 * @hw: Struct containing variables accessed by shared code
 *
 * Detects which PHY is present and sets up the speed and duplex
 */

static s32 e1000_setup_copper_link(struct e1000_hw *hw)
{
 s32 ret_val;
 u16 i;
 u16 phy_data;

 /* Check if it is a valid PHY and set PHY mode if necessary. */
 ret_val = e1000_copper_link_preconfig(hw);
 if (ret_val)
  return ret_val;

 if (hw->phy_type == e1000_phy_igp) {
  ret_val = e1000_copper_link_igp_setup(hw);
  if (ret_val)
   return ret_val;
 } else if (hw->phy_type == e1000_phy_m88) {
  ret_val = e1000_copper_link_mgp_setup(hw);
  if (ret_val)
   return ret_val;
 } else {
  ret_val = gbe_dhg_phy_setup(hw);
  if (ret_val) {
   e_dbg("gbe_dhg_phy_setup failed!\n");
   return ret_val;
  }
 }

 if (hw->autoneg) {
  /* Setup autoneg and flow control advertisement
 * and perform autonegotiation
 */

  ret_val = e1000_copper_link_autoneg(hw);
  if (ret_val)
   return ret_val;
 } else {
  /* PHY will be set to 10H, 10F, 100H,or 100F
 * depending on value from forced_speed_duplex.
 */

  e_dbg("Forcing speed and duplex\n");
  ret_val = e1000_phy_force_speed_duplex(hw);
  if (ret_val) {
   e_dbg("Error Forcing Speed and Duplex\n");
   return ret_val;
  }
 }

 /* Check link status. Wait up to 100 microseconds for link to become
 * valid.
 */

 for (i = 0; i < 10; i++) {
  ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &phy_data);
  if (ret_val)
   return ret_val;
  ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &phy_data);
  if (ret_val)
   return ret_val;

  if (phy_data & MII_SR_LINK_STATUS) {
   /* Config the MAC and PHY after link is up */
   ret_val = e1000_copper_link_postconfig(hw);
   if (ret_val)
    return ret_val;

   e_dbg("Valid link established!!!\n");
   return E1000_SUCCESS;
  }
  udelay(10);
 }

 e_dbg("Unable to establish link!!!\n");
 return E1000_SUCCESS;
}

/**
 * e1000_phy_setup_autoneg - phy settings
 * @hw: Struct containing variables accessed by shared code
 *
 * Configures PHY autoneg and flow control advertisement settings
 */

s32 e1000_phy_setup_autoneg(struct e1000_hw *hw)
{
 s32 ret_val;
 u16 mii_autoneg_adv_reg;
 u16 mii_1000t_ctrl_reg;

 /* Read the MII Auto-Neg Advertisement Register (Address 4). */
 ret_val = e1000_read_phy_reg(hw, PHY_AUTONEG_ADV, &mii_autoneg_adv_reg);
 if (ret_val)
  return ret_val;

 /* Read the MII 1000Base-T Control Register (Address 9). */
 ret_val = e1000_read_phy_reg(hw, PHY_1000T_CTRL, &mii_1000t_ctrl_reg);
 if (ret_val)
  return ret_val;
 else if (hw->phy_type == e1000_phy_8201)
  mii_1000t_ctrl_reg &= ~REG9_SPEED_MASK;

 /* Need to parse both autoneg_advertised and fc and set up
 * the appropriate PHY registers.  First we will parse for
 * autoneg_advertised software override.  Since we can advertise
 * a plethora of combinations, we need to check each bit
 * individually.
 */


 /* First we clear all the 10/100 mb speed bits in the Auto-Neg
 * Advertisement Register (Address 4) and the 1000 mb speed bits in
 * the  1000Base-T Control Register (Address 9).
 */

 mii_autoneg_adv_reg &= ~REG4_SPEED_MASK;
 mii_1000t_ctrl_reg &= ~REG9_SPEED_MASK;

 e_dbg("autoneg_advertised %x\n", hw->autoneg_advertised);

 /* Do we want to advertise 10 Mb Half Duplex? */
 if (hw->autoneg_advertised & ADVERTISE_10_HALF) {
  e_dbg("Advertise 10mb Half duplex\n");
  mii_autoneg_adv_reg |= NWAY_AR_10T_HD_CAPS;
 }

 /* Do we want to advertise 10 Mb Full Duplex? */
 if (hw->autoneg_advertised & ADVERTISE_10_FULL) {
  e_dbg("Advertise 10mb Full duplex\n");
  mii_autoneg_adv_reg |= NWAY_AR_10T_FD_CAPS;
 }

 /* Do we want to advertise 100 Mb Half Duplex? */
 if (hw->autoneg_advertised & ADVERTISE_100_HALF) {
  e_dbg("Advertise 100mb Half duplex\n");
  mii_autoneg_adv_reg |= NWAY_AR_100TX_HD_CAPS;
 }

 /* Do we want to advertise 100 Mb Full Duplex? */
 if (hw->autoneg_advertised & ADVERTISE_100_FULL) {
  e_dbg("Advertise 100mb Full duplex\n");
  mii_autoneg_adv_reg |= NWAY_AR_100TX_FD_CAPS;
 }

 /* We do not allow the Phy to advertise 1000 Mb Half Duplex */
 if (hw->autoneg_advertised & ADVERTISE_1000_HALF) {
  e_dbg
      ("Advertise 1000mb Half duplex requested, request denied!\n");
 }

 /* Do we want to advertise 1000 Mb Full Duplex? */
 if (hw->autoneg_advertised & ADVERTISE_1000_FULL) {
  e_dbg("Advertise 1000mb Full duplex\n");
  mii_1000t_ctrl_reg |= CR_1000T_FD_CAPS;
 }

 /* Check for a software override of the flow control settings, and
 * setup the PHY advertisement registers accordingly.  If
 * auto-negotiation is enabled, then software will have to set the
 * "PAUSE" bits to the correct value in the Auto-Negotiation
 * Advertisement Register (PHY_AUTONEG_ADV) and re-start
 * auto-negotiation.
 *
 * The possible values of the "fc" parameter are:
 *      0:  Flow control is completely disabled
 *      1:  Rx flow control is enabled (we can receive pause frames
 *          but not send pause frames).
 *      2:  Tx flow control is enabled (we can send pause frames
 *          but we do not support receiving pause frames).
 *      3:  Both Rx and TX flow control (symmetric) are enabled.
 *  other:  No software override.  The flow control configuration
 *          in the EEPROM is used.
 */

 switch (hw->fc) {
 case E1000_FC_NONE: /* 0 */
  /* Flow control (RX & TX) is completely disabled by a
 * software over-ride.
 */

  mii_autoneg_adv_reg &= ~(NWAY_AR_ASM_DIR | NWAY_AR_PAUSE);
  break;
 case E1000_FC_RX_PAUSE: /* 1 */
  /* RX Flow control is enabled, and TX Flow control is
 * disabled, by a software over-ride.
 */

  /* Since there really isn't a way to advertise that we are
 * capable of RX Pause ONLY, we will advertise that we
 * support both symmetric and asymmetric RX PAUSE.  Later
 * (in e1000_config_fc_after_link_up) we will disable the
 * hw's ability to send PAUSE frames.
 */

  mii_autoneg_adv_reg |= (NWAY_AR_ASM_DIR | NWAY_AR_PAUSE);
  break;
 case E1000_FC_TX_PAUSE: /* 2 */
  /* TX Flow control is enabled, and RX Flow control is
 * disabled, by a software over-ride.
 */

  mii_autoneg_adv_reg |= NWAY_AR_ASM_DIR;
  mii_autoneg_adv_reg &= ~NWAY_AR_PAUSE;
  break;
 case E1000_FC_FULL: /* 3 */
  /* Flow control (both RX and TX) is enabled by a software
 * over-ride.
 */

  mii_autoneg_adv_reg |= (NWAY_AR_ASM_DIR | NWAY_AR_PAUSE);
  break;
 default:
  e_dbg("Flow control param set incorrectly\n");
  return -E1000_ERR_CONFIG;
 }

 ret_val = e1000_write_phy_reg(hw, PHY_AUTONEG_ADV, mii_autoneg_adv_reg);
 if (ret_val)
  return ret_val;

 e_dbg("Auto-Neg Advertising %x\n", mii_autoneg_adv_reg);

 if (hw->phy_type == e1000_phy_8201) {
  mii_1000t_ctrl_reg = 0;
 } else {
  ret_val = e1000_write_phy_reg(hw, PHY_1000T_CTRL,
           mii_1000t_ctrl_reg);
  if (ret_val)
   return ret_val;
 }

 return E1000_SUCCESS;
}

/**
 * e1000_phy_force_speed_duplex - force link settings
 * @hw: Struct containing variables accessed by shared code
 *
 * Force PHY speed and duplex settings to hw->forced_speed_duplex
 */

static s32 e1000_phy_force_speed_duplex(struct e1000_hw *hw)
{
 u32 ctrl;
 s32 ret_val;
 u16 mii_ctrl_reg;
 u16 mii_status_reg;
 u16 phy_data;
 u16 i;

 /* Turn off Flow control if we are forcing speed and duplex. */
 hw->fc = E1000_FC_NONE;

 e_dbg("hw->fc = %d\n", hw->fc);

 /* Read the Device Control Register. */
 ctrl = er32(CTRL);

 /* Set the bits to Force Speed and Duplex in the Device Ctrl Reg. */
 ctrl |= (E1000_CTRL_FRCSPD | E1000_CTRL_FRCDPX);
 ctrl &= ~(DEVICE_SPEED_MASK);

 /* Clear the Auto Speed Detect Enable bit. */
 ctrl &= ~E1000_CTRL_ASDE;

 /* Read the MII Control Register. */
 ret_val = e1000_read_phy_reg(hw, PHY_CTRL, &mii_ctrl_reg);
 if (ret_val)
  return ret_val;

 /* We need to disable autoneg in order to force link and duplex. */

 mii_ctrl_reg &= ~MII_CR_AUTO_NEG_EN;

 /* Are we forcing Full or Half Duplex? */
 if (hw->forced_speed_duplex == e1000_100_full ||
     hw->forced_speed_duplex == e1000_10_full) {
  /* We want to force full duplex so we SET the full duplex bits
 * in the Device and MII Control Registers.
 */

  ctrl |= E1000_CTRL_FD;
  mii_ctrl_reg |= MII_CR_FULL_DUPLEX;
  e_dbg("Full Duplex\n");
 } else {
  /* We want to force half duplex so we CLEAR the full duplex bits
 * in the Device and MII Control Registers.
 */

  ctrl &= ~E1000_CTRL_FD;
  mii_ctrl_reg &= ~MII_CR_FULL_DUPLEX;
  e_dbg("Half Duplex\n");
 }

 /* Are we forcing 100Mbps??? */
 if (hw->forced_speed_duplex == e1000_100_full ||
     hw->forced_speed_duplex == e1000_100_half) {
  /* Set the 100Mb bit and turn off the 1000Mb and 10Mb bits. */
  ctrl |= E1000_CTRL_SPD_100;
  mii_ctrl_reg |= MII_CR_SPEED_100;
  mii_ctrl_reg &= ~(MII_CR_SPEED_1000 | MII_CR_SPEED_10);
  e_dbg("Forcing 100mb ");
 } else {
  /* Set the 10Mb bit and turn off the 1000Mb and 100Mb bits. */
  ctrl &= ~(E1000_CTRL_SPD_1000 | E1000_CTRL_SPD_100);
  mii_ctrl_reg |= MII_CR_SPEED_10;
  mii_ctrl_reg &= ~(MII_CR_SPEED_1000 | MII_CR_SPEED_100);
  e_dbg("Forcing 10mb ");
 }

 e1000_config_collision_dist(hw);

 /* Write the configured values back to the Device Control Reg. */
 ew32(CTRL, ctrl);

 if (hw->phy_type == e1000_phy_m88) {
  ret_val =
      e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);
  if (ret_val)
   return ret_val;

  /* Clear Auto-Crossover to force MDI manually. M88E1000 requires
 * MDI forced whenever speed are duplex are forced.
 */

  phy_data &= ~M88E1000_PSCR_AUTO_X_MODE;
  ret_val =
      e1000_write_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, phy_data);
  if (ret_val)
   return ret_val;

  e_dbg("M88E1000 PSCR: %x\n", phy_data);

  /* Need to reset the PHY or these changes will be ignored */
  mii_ctrl_reg |= MII_CR_RESET;

  /* Disable MDI-X support for 10/100 */
 } else {
  /* Clear Auto-Crossover to force MDI manually.  IGP requires MDI
 * forced whenever speed or duplex are forced.
 */

  ret_val =
      e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_CTRL, &phy_data);
  if (ret_val)
   return ret_val;

  phy_data &= ~IGP01E1000_PSCR_AUTO_MDIX;
  phy_data &= ~IGP01E1000_PSCR_FORCE_MDI_MDIX;

  ret_val =
      e1000_write_phy_reg(hw, IGP01E1000_PHY_PORT_CTRL, phy_data);
  if (ret_val)
   return ret_val;
 }

 /* Write back the modified PHY MII control register. */
 ret_val = e1000_write_phy_reg(hw, PHY_CTRL, mii_ctrl_reg);
 if (ret_val)
  return ret_val;

 udelay(1);

 /* The wait_autoneg_complete flag may be a little misleading here.
 * Since we are forcing speed and duplex, Auto-Neg is not enabled.
 * But we do want to delay for a period while forcing only so we
 * don't generate false No Link messages.  So we will wait here
 * only if the user has set wait_autoneg_complete to 1, which is
 * the default.
 */

 if (hw->wait_autoneg_complete) {
  /* We will wait for autoneg to complete. */
  e_dbg("Waiting for forced speed/duplex link.\n");
  mii_status_reg = 0;

  /* Wait for autoneg to complete or 4.5 seconds to expire */
  for (i = PHY_FORCE_TIME; i > 0; i--) {
   /* Read the MII Status Register and wait for Auto-Neg
 * Complete bit to be set.
 */

   ret_val =
       e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
   if (ret_val)
    return ret_val;

   ret_val =
       e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
   if (ret_val)
    return ret_val;

   if (mii_status_reg & MII_SR_LINK_STATUS)
    break;
   msleep(100);
  }
  if ((i == 0) && (hw->phy_type == e1000_phy_m88)) {
   /* We didn't get link.  Reset the DSP and wait again
 * for link.
 */

   ret_val = e1000_phy_reset_dsp(hw);
   if (ret_val) {
    e_dbg("Error Resetting PHY DSP\n");
    return ret_val;
   }
  }
  /* This loop will early-out if the link condition has been
 * met
 */

  for (i = PHY_FORCE_TIME; i > 0; i--) {
   if (mii_status_reg & MII_SR_LINK_STATUS)
    break;
   msleep(100);
   /* Read the MII Status Register and wait for Auto-Neg
 * Complete bit to be set.
 */

   ret_val =
       e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
   if (ret_val)
    return ret_val;

   ret_val =
       e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
   if (ret_val)
    return ret_val;
  }
 }

 if (hw->phy_type == e1000_phy_m88) {
  /* Because we reset the PHY above, we need to re-force TX_CLK in
 * the Extended PHY Specific Control Register to 25MHz clock.
 * This value defaults back to a 2.5MHz clock when the PHY is
 * reset.
 */

  ret_val =
      e1000_read_phy_reg(hw, M88E1000_EXT_PHY_SPEC_CTRL,
           &phy_data);
  if (ret_val)
   return ret_val;

  phy_data |= M88E1000_EPSCR_TX_CLK_25;
  ret_val =
      e1000_write_phy_reg(hw, M88E1000_EXT_PHY_SPEC_CTRL,
     phy_data);
  if (ret_val)
   return ret_val;

  /* In addition, because of the s/w reset above, we need to
 * enable CRS on Tx.  This must be set for both full and half
 * duplex operation.
 */

  ret_val =
      e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);
  if (ret_val)
   return ret_val;

  phy_data |= M88E1000_PSCR_ASSERT_CRS_ON_TX;
  ret_val =
      e1000_write_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, phy_data);
  if (ret_val)
   return ret_val;

  if ((hw->mac_type == e1000_82544 ||
       hw->mac_type == e1000_82543) &&
      (!hw->autoneg) &&
      (hw->forced_speed_duplex == e1000_10_full ||
       hw->forced_speed_duplex == e1000_10_half)) {
   ret_val = e1000_polarity_reversal_workaround(hw);
   if (ret_val)
    return ret_val;
  }
 }
 return E1000_SUCCESS;
}

/**
 * e1000_config_collision_dist - set collision distance register
 * @hw: Struct containing variables accessed by shared code
 *
 * Sets the collision distance in the Transmit Control register.
 * Link should have been established previously. Reads the speed and duplex
 * information from the Device Status register.
 */

void e1000_config_collision_dist(struct e1000_hw *hw)
{
 u32 tctl, coll_dist;

 if (hw->mac_type < e1000_82543)
  coll_dist = E1000_COLLISION_DISTANCE_82542;
 else
  coll_dist = E1000_COLLISION_DISTANCE;

 tctl = er32(TCTL);

 tctl &= ~E1000_TCTL_COLD;
 tctl |= coll_dist << E1000_COLD_SHIFT;

 ew32(TCTL, tctl);
 E1000_WRITE_FLUSH();
}

/**
 * e1000_config_mac_to_phy - sync phy and mac settings
 * @hw: Struct containing variables accessed by shared code
 *
 * Sets MAC speed and duplex settings to reflect the those in the PHY
 * The contents of the PHY register containing the needed information need to
 * be passed in.
 */

static s32 e1000_config_mac_to_phy(struct e1000_hw *hw)
{
 u32 ctrl;
 s32 ret_val;
 u16 phy_data;

 /* 82544 or newer MAC, Auto Speed Detection takes care of
 * MAC speed/duplex configuration.
 */

 if ((hw->mac_type >= e1000_82544) && (hw->mac_type != e1000_ce4100))
  return E1000_SUCCESS;

 /* Read the Device Control Register and set the bits to Force Speed
 * and Duplex.
 */

 ctrl = er32(CTRL);
 ctrl |= (E1000_CTRL_FRCSPD | E1000_CTRL_FRCDPX);
 ctrl &= ~(E1000_CTRL_SPD_SEL | E1000_CTRL_ILOS);

 switch (hw->phy_type) {
 case e1000_phy_8201:
  ret_val = e1000_read_phy_reg(hw, PHY_CTRL, &phy_data);
  if (ret_val)
   return ret_val;

  if (phy_data & RTL_PHY_CTRL_FD)
   ctrl |= E1000_CTRL_FD;
  else
   ctrl &= ~E1000_CTRL_FD;

  if (phy_data & RTL_PHY_CTRL_SPD_100)
   ctrl |= E1000_CTRL_SPD_100;
  else
   ctrl |= E1000_CTRL_SPD_10;

  e1000_config_collision_dist(hw);
  break;
 default:
  /* Set up duplex in the Device Control and Transmit Control
 * registers depending on negotiated values.
 */

  ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_STATUS,
          &phy_data);
  if (ret_val)
   return ret_val;

  if (phy_data & M88E1000_PSSR_DPLX)
   ctrl |= E1000_CTRL_FD;
  else
   ctrl &= ~E1000_CTRL_FD;

  e1000_config_collision_dist(hw);

  /* Set up speed in the Device Control register depending on
 * negotiated values.
 */

  if ((phy_data & M88E1000_PSSR_SPEED) == M88E1000_PSSR_1000MBS)
   ctrl |= E1000_CTRL_SPD_1000;
  else if ((phy_data & M88E1000_PSSR_SPEED) ==
    M88E1000_PSSR_100MBS)
   ctrl |= E1000_CTRL_SPD_100;
 }

 /* Write the configured values back to the Device Control Reg. */
 ew32(CTRL, ctrl);
 return E1000_SUCCESS;
}

/**
 * e1000_force_mac_fc - force flow control settings
 * @hw: Struct containing variables accessed by shared code
 *
 * Forces the MAC's flow control settings.
 * Sets the TFCE and RFCE bits in the device control register to reflect
 * the adapter settings. TFCE and RFCE need to be explicitly set by
 * software when a Copper PHY is used because autonegotiation is managed
 * by the PHY rather than the MAC. Software must also configure these
 * bits when link is forced on a fiber connection.
 */

s32 e1000_force_mac_fc(struct e1000_hw *hw)
{
 u32 ctrl;

 /* Get the current configuration of the Device Control Register */
 ctrl = er32(CTRL);

 /* Because we didn't get link via the internal auto-negotiation
 * mechanism (we either forced link or we got link via PHY
 * auto-neg), we have to manually enable/disable transmit an
 * receive flow control.
 *
 * The "Case" statement below enables/disable flow control
 * according to the "hw->fc" parameter.
 *
 * The possible values of the "fc" parameter are:
 *      0:  Flow control is completely disabled
 *      1:  Rx flow control is enabled (we can receive pause
 *          frames but not send pause frames).
 *      2:  Tx flow control is enabled (we can send pause frames
 *          but we do not receive pause frames).
 *      3:  Both Rx and TX flow control (symmetric) is enabled.
 *  other:  No other values should be possible at this point.
 */


 switch (hw->fc) {
 case E1000_FC_NONE:
  ctrl &= (~(E1000_CTRL_TFCE | E1000_CTRL_RFCE));
  break;
 case E1000_FC_RX_PAUSE:
  ctrl &= (~E1000_CTRL_TFCE);
  ctrl |= E1000_CTRL_RFCE;
  break;
 case E1000_FC_TX_PAUSE:
  ctrl &= (~E1000_CTRL_RFCE);
  ctrl |= E1000_CTRL_TFCE;
  break;
 case E1000_FC_FULL:
  ctrl |= (E1000_CTRL_TFCE | E1000_CTRL_RFCE);
  break;
 default:
  e_dbg("Flow control param set incorrectly\n");
  return -E1000_ERR_CONFIG;
 }

 /* Disable TX Flow Control for 82542 (rev 2.0) */
 if (hw->mac_type == e1000_82542_rev2_0)
  ctrl &= (~E1000_CTRL_TFCE);

 ew32(CTRL, ctrl);
 return E1000_SUCCESS;
}

/**
 * e1000_config_fc_after_link_up - configure flow control after autoneg
 * @hw: Struct containing variables accessed by shared code
 *
 * Configures flow control settings after link is established
 * Should be called immediately after a valid link has been established.
 * Forces MAC flow control settings if link was forced. When in MII/GMII mode
 * and autonegotiation is enabled, the MAC flow control settings will be set
 * based on the flow control negotiated by the PHY. In TBI mode, the TFCE
 * and RFCE bits will be automatically set to the negotiated flow control mode.
 */

static s32 e1000_config_fc_after_link_up(struct e1000_hw *hw)
{
 s32 ret_val;
 u16 mii_status_reg;
 u16 mii_nway_adv_reg;
 u16 mii_nway_lp_ability_reg;
 u16 speed;
 u16 duplex;

 /* Check for the case where we have fiber media and auto-neg failed
 * so we had to force link.  In this case, we need to force the
 * configuration of the MAC to match the "fc" parameter.
 */

 if (((hw->media_type == e1000_media_type_fiber) &&
      (hw->autoneg_failed)) ||
     ((hw->media_type == e1000_media_type_internal_serdes) &&
      (hw->autoneg_failed)) ||
     ((hw->media_type == e1000_media_type_copper) &&
      (!hw->autoneg))) {
  ret_val = e1000_force_mac_fc(hw);
  if (ret_val) {
   e_dbg("Error forcing flow control settings\n");
   return ret_val;
  }
 }

 /* Check for the case where we have copper media and auto-neg is
 * enabled.  In this case, we need to check and see if Auto-Neg
 * has completed, and if so, how the PHY and link partner has
 * flow control configured.
 */

 if ((hw->media_type == e1000_media_type_copper) && hw->autoneg) {
  /* Read the MII Status Register and check to see if AutoNeg
 * has completed.  We read this twice because this reg has
 * some "sticky" (latched) bits.
 */

  ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
  if (ret_val)
   return ret_val;
  ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
  if (ret_val)
   return ret_val;

  if (mii_status_reg & MII_SR_AUTONEG_COMPLETE) {
   /* The AutoNeg process has completed, so we now need to
 * read both the Auto Negotiation Advertisement Register
 * (Address 4) and the Auto_Negotiation Base Page
 * Ability Register (Address 5) to determine how flow
 * control was negotiated.
 */

   ret_val = e1000_read_phy_reg(hw, PHY_AUTONEG_ADV,
           &mii_nway_adv_reg);
   if (ret_val)
    return ret_val;
   ret_val = e1000_read_phy_reg(hw, PHY_LP_ABILITY,
           &mii_nway_lp_ability_reg);
   if (ret_val)
    return ret_val;

   /* Two bits in the Auto Negotiation Advertisement
 * Register (Address 4) and two bits in the Auto
 * Negotiation Base Page Ability Register (Address 5)
 * determine flow control for both the PHY and the link
 * partner.  The following table, taken out of the IEEE
 * 802.3ab/D6.0 dated March 25, 1999, describes these
 * PAUSE resolution bits and how flow control is
 * determined based upon these settings.
 * NOTE:  DC = Don't Care
 *
 *   LOCAL DEVICE  |   LINK PARTNER
 * PAUSE | ASM_DIR | PAUSE | ASM_DIR | NIC Resolution
 *-------|---------|-------|---------|------------------
 *   0   |    0    |  DC   |   DC    | E1000_FC_NONE
 *   0   |    1    |   0   |   DC    | E1000_FC_NONE
 *   0   |    1    |   1   |    0    | E1000_FC_NONE
 *   0   |    1    |   1   |    1    | E1000_FC_TX_PAUSE
 *   1   |    0    |   0   |   DC    | E1000_FC_NONE
 *   1   |   DC    |   1   |   DC    | E1000_FC_FULL
 *   1   |    1    |   0   |    0    | E1000_FC_NONE
 *   1   |    1    |   0   |    1    | E1000_FC_RX_PAUSE
 *
 */

   /* Are both PAUSE bits set to 1?  If so, this implies
 * Symmetric Flow Control is enabled at both ends.  The
 * ASM_DIR bits are irrelevant per the spec.
 *
 * For Symmetric Flow Control:
 *
 *   LOCAL DEVICE  |   LINK PARTNER
 * PAUSE | ASM_DIR | PAUSE | ASM_DIR | Result
 *-------|---------|-------|---------|------------------
 *   1   |   DC    |   1   |   DC    | E1000_FC_FULL
 *
 */

   if ((mii_nway_adv_reg & NWAY_AR_PAUSE) &&
       (mii_nway_lp_ability_reg & NWAY_LPAR_PAUSE)) {
    /* Now we need to check if the user selected Rx
 * ONLY of pause frames.  In this case, we had
 * to advertise FULL flow control because we
 * could not advertise Rx ONLY. Hence, we must
 * now check to see if we need to turn OFF the
 * TRANSMISSION of PAUSE frames.
 */

    if (hw->original_fc == E1000_FC_FULL) {
     hw->fc = E1000_FC_FULL;
     e_dbg("Flow Control = FULL.\n");
    } else {
     hw->fc = E1000_FC_RX_PAUSE;
     e_dbg
         ("Flow Control = RX PAUSE frames only.\n");
    }
   }
   /* For receiving PAUSE frames ONLY.
 *
 *   LOCAL DEVICE  |   LINK PARTNER
 * PAUSE | ASM_DIR | PAUSE | ASM_DIR | Result
 *-------|---------|-------|---------|------------------
 *   0   |    1    |   1   |    1    | E1000_FC_TX_PAUSE
 *
 */

   else if (!(mii_nway_adv_reg & NWAY_AR_PAUSE) &&
     (mii_nway_adv_reg & NWAY_AR_ASM_DIR) &&
     (mii_nway_lp_ability_reg & NWAY_LPAR_PAUSE) &&
     (mii_nway_lp_ability_reg & NWAY_LPAR_ASM_DIR)) {
    hw->fc = E1000_FC_TX_PAUSE;
    e_dbg
        ("Flow Control = TX PAUSE frames only.\n");
   }
   /* For transmitting PAUSE frames ONLY.
 *
 *   LOCAL DEVICE  |   LINK PARTNER
 * PAUSE | ASM_DIR | PAUSE | ASM_DIR | Result
 *-------|---------|-------|---------|------------------
 *   1   |    1    |   0   |    1    | E1000_FC_RX_PAUSE
 *
 */

   else if ((mii_nway_adv_reg & NWAY_AR_PAUSE) &&
     (mii_nway_adv_reg & NWAY_AR_ASM_DIR) &&
     !(mii_nway_lp_ability_reg & NWAY_LPAR_PAUSE) &&
     (mii_nway_lp_ability_reg & NWAY_LPAR_ASM_DIR)) {
    hw->fc = E1000_FC_RX_PAUSE;
    e_dbg
        ("Flow Control = RX PAUSE frames only.\n");
   }
   /* Per the IEEE spec, at this point flow control should
 * be disabled.  However, we want to consider that we
 * could be connected to a legacy switch that doesn't
 * advertise desired flow control, but can be forced on
 * the link partner.  So if we advertised no flow
 * control, that is what we will resolve to.  If we
 * advertised some kind of receive capability (Rx Pause
 * Only or Full Flow Control) and the link partner
 * advertised none, we will configure ourselves to
 * enable Rx Flow Control only.  We can do this safely
 * for two reasons:  If the link partner really
--> --------------------

--> maximum size reached

--> --------------------

Messung V0.5
C=90 H=98 G=94

¤ Dauer der Verarbeitung: 0.19 Sekunden  ¤

*© Formatika GbR, Deutschland






Wurzel

Suchen

Beweissystem der NASA

Beweissystem Isabelle

NIST Cobol Testsuite

Cephes Mathematical Library

Wiener Entwicklungsmethode

Haftungshinweis

Die Informationen auf dieser Webseite wurden nach bestem Wissen sorgfältig zusammengestellt. Es wird jedoch weder Vollständigkeit, noch Richtigkeit, noch Qualität der bereit gestellten Informationen zugesichert.

Bemerkung:

Die farbliche Syntaxdarstellung und die Messung sind noch experimentell.