root/drivers/net/ethernet/intel/e1000e/mac.c

/* [<][>][^][v][top][bottom][index][help] */

DEFINITIONS

This source file includes following definitions.
  1. e1000e_get_bus_info_pcie
  2. e1000_set_lan_id_multi_port_pcie
  3. e1000_set_lan_id_single_port
  4. e1000_clear_vfta_generic
  5. e1000_write_vfta_generic
  6. e1000e_init_rx_addrs
  7. e1000_check_alt_mac_addr_generic
  8. e1000e_rar_get_count_generic
  9. e1000e_rar_set_generic
  10. e1000_hash_mc_addr
  11. e1000e_update_mc_addr_list_generic
  12. e1000e_clear_hw_cntrs_base
  13. e1000e_check_for_copper_link
  14. e1000e_check_for_fiber_link
  15. e1000e_check_for_serdes_link
  16. e1000_set_default_fc_generic
  17. e1000e_setup_link_generic
  18. e1000_commit_fc_settings_generic
  19. e1000_poll_fiber_serdes_link_generic
  20. e1000e_setup_fiber_serdes_link
  21. e1000e_config_collision_dist_generic
  22. e1000e_set_fc_watermarks
  23. e1000e_force_mac_fc
  24. e1000e_config_fc_after_link_up
  25. e1000e_get_speed_and_duplex_copper
  26. e1000e_get_speed_and_duplex_fiber_serdes
  27. e1000e_get_hw_semaphore
  28. e1000e_put_hw_semaphore
  29. e1000e_get_auto_rd_done
  30. e1000e_valid_led_default
  31. e1000e_id_led_init_generic
  32. e1000e_setup_led_generic
  33. e1000e_cleanup_led_generic
  34. e1000e_blink_led_generic
  35. e1000e_led_on_generic
  36. e1000e_led_off_generic
  37. e1000e_set_pcie_no_snoop
  38. e1000e_disable_pcie_master
  39. e1000e_reset_adaptive
  40. e1000e_update_adaptive

   1 // SPDX-License-Identifier: GPL-2.0
   2 /* Copyright(c) 1999 - 2018 Intel Corporation. */
   3 
   4 #include "e1000.h"
   5 
   6 /**
   7  *  e1000e_get_bus_info_pcie - Get PCIe bus information
   8  *  @hw: pointer to the HW structure
   9  *
  10  *  Determines and stores the system bus information for a particular
  11  *  network interface.  The following bus information is determined and stored:
  12  *  bus speed, bus width, type (PCIe), and PCIe function.
  13  **/
  14 s32 e1000e_get_bus_info_pcie(struct e1000_hw *hw)
  15 {
  16         struct e1000_mac_info *mac = &hw->mac;
  17         struct e1000_bus_info *bus = &hw->bus;
  18         struct e1000_adapter *adapter = hw->adapter;
  19         u16 pcie_link_status, cap_offset;
  20 
  21         cap_offset = adapter->pdev->pcie_cap;
  22         if (!cap_offset) {
  23                 bus->width = e1000_bus_width_unknown;
  24         } else {
  25                 pci_read_config_word(adapter->pdev,
  26                                      cap_offset + PCIE_LINK_STATUS,
  27                                      &pcie_link_status);
  28                 bus->width = (enum e1000_bus_width)((pcie_link_status &
  29                                                      PCIE_LINK_WIDTH_MASK) >>
  30                                                     PCIE_LINK_WIDTH_SHIFT);
  31         }
  32 
  33         mac->ops.set_lan_id(hw);
  34 
  35         return 0;
  36 }
  37 
  38 /**
  39  *  e1000_set_lan_id_multi_port_pcie - Set LAN id for PCIe multiple port devices
  40  *
  41  *  @hw: pointer to the HW structure
  42  *
  43  *  Determines the LAN function id by reading memory-mapped registers
  44  *  and swaps the port value if requested.
  45  **/
  46 void e1000_set_lan_id_multi_port_pcie(struct e1000_hw *hw)
  47 {
  48         struct e1000_bus_info *bus = &hw->bus;
  49         u32 reg;
  50 
  51         /* The status register reports the correct function number
  52          * for the device regardless of function swap state.
  53          */
  54         reg = er32(STATUS);
  55         bus->func = (reg & E1000_STATUS_FUNC_MASK) >> E1000_STATUS_FUNC_SHIFT;
  56 }
  57 
  58 /**
  59  *  e1000_set_lan_id_single_port - Set LAN id for a single port device
  60  *  @hw: pointer to the HW structure
  61  *
  62  *  Sets the LAN function id to zero for a single port device.
  63  **/
  64 void e1000_set_lan_id_single_port(struct e1000_hw *hw)
  65 {
  66         struct e1000_bus_info *bus = &hw->bus;
  67 
  68         bus->func = 0;
  69 }
  70 
  71 /**
  72  *  e1000_clear_vfta_generic - Clear VLAN filter table
  73  *  @hw: pointer to the HW structure
  74  *
  75  *  Clears the register array which contains the VLAN filter table by
  76  *  setting all the values to 0.
  77  **/
  78 void e1000_clear_vfta_generic(struct e1000_hw *hw)
  79 {
  80         u32 offset;
  81 
  82         for (offset = 0; offset < E1000_VLAN_FILTER_TBL_SIZE; offset++) {
  83                 E1000_WRITE_REG_ARRAY(hw, E1000_VFTA, offset, 0);
  84                 e1e_flush();
  85         }
  86 }
  87 
  88 /**
  89  *  e1000_write_vfta_generic - Write value to VLAN filter table
  90  *  @hw: pointer to the HW structure
  91  *  @offset: register offset in VLAN filter table
  92  *  @value: register value written to VLAN filter table
  93  *
  94  *  Writes value at the given offset in the register array which stores
  95  *  the VLAN filter table.
  96  **/
  97 void e1000_write_vfta_generic(struct e1000_hw *hw, u32 offset, u32 value)
  98 {
  99         E1000_WRITE_REG_ARRAY(hw, E1000_VFTA, offset, value);
 100         e1e_flush();
 101 }
 102 
 103 /**
 104  *  e1000e_init_rx_addrs - Initialize receive address's
 105  *  @hw: pointer to the HW structure
 106  *  @rar_count: receive address registers
 107  *
 108  *  Setup the receive address registers by setting the base receive address
 109  *  register to the devices MAC address and clearing all the other receive
 110  *  address registers to 0.
 111  **/
 112 void e1000e_init_rx_addrs(struct e1000_hw *hw, u16 rar_count)
 113 {
 114         u32 i;
 115         u8 mac_addr[ETH_ALEN] = { 0 };
 116 
 117         /* Setup the receive address */
 118         e_dbg("Programming MAC Address into RAR[0]\n");
 119 
 120         hw->mac.ops.rar_set(hw, hw->mac.addr, 0);
 121 
 122         /* Zero out the other (rar_entry_count - 1) receive addresses */
 123         e_dbg("Clearing RAR[1-%u]\n", rar_count - 1);
 124         for (i = 1; i < rar_count; i++)
 125                 hw->mac.ops.rar_set(hw, mac_addr, i);
 126 }
 127 
 128 /**
 129  *  e1000_check_alt_mac_addr_generic - Check for alternate MAC addr
 130  *  @hw: pointer to the HW structure
 131  *
 132  *  Checks the nvm for an alternate MAC address.  An alternate MAC address
 133  *  can be setup by pre-boot software and must be treated like a permanent
 134  *  address and must override the actual permanent MAC address. If an
 135  *  alternate MAC address is found it is programmed into RAR0, replacing
 136  *  the permanent address that was installed into RAR0 by the Si on reset.
 137  *  This function will return SUCCESS unless it encounters an error while
 138  *  reading the EEPROM.
 139  **/
 140 s32 e1000_check_alt_mac_addr_generic(struct e1000_hw *hw)
 141 {
 142         u32 i;
 143         s32 ret_val;
 144         u16 offset, nvm_alt_mac_addr_offset, nvm_data;
 145         u8 alt_mac_addr[ETH_ALEN];
 146 
 147         ret_val = e1000_read_nvm(hw, NVM_COMPAT, 1, &nvm_data);
 148         if (ret_val)
 149                 return ret_val;
 150 
 151         /* not supported on 82573 */
 152         if (hw->mac.type == e1000_82573)
 153                 return 0;
 154 
 155         ret_val = e1000_read_nvm(hw, NVM_ALT_MAC_ADDR_PTR, 1,
 156                                  &nvm_alt_mac_addr_offset);
 157         if (ret_val) {
 158                 e_dbg("NVM Read Error\n");
 159                 return ret_val;
 160         }
 161 
 162         if ((nvm_alt_mac_addr_offset == 0xFFFF) ||
 163             (nvm_alt_mac_addr_offset == 0x0000))
 164                 /* There is no Alternate MAC Address */
 165                 return 0;
 166 
 167         if (hw->bus.func == E1000_FUNC_1)
 168                 nvm_alt_mac_addr_offset += E1000_ALT_MAC_ADDRESS_OFFSET_LAN1;
 169         for (i = 0; i < ETH_ALEN; i += 2) {
 170                 offset = nvm_alt_mac_addr_offset + (i >> 1);
 171                 ret_val = e1000_read_nvm(hw, offset, 1, &nvm_data);
 172                 if (ret_val) {
 173                         e_dbg("NVM Read Error\n");
 174                         return ret_val;
 175                 }
 176 
 177                 alt_mac_addr[i] = (u8)(nvm_data & 0xFF);
 178                 alt_mac_addr[i + 1] = (u8)(nvm_data >> 8);
 179         }
 180 
 181         /* if multicast bit is set, the alternate address will not be used */
 182         if (is_multicast_ether_addr(alt_mac_addr)) {
 183                 e_dbg("Ignoring Alternate Mac Address with MC bit set\n");
 184                 return 0;
 185         }
 186 
 187         /* We have a valid alternate MAC address, and we want to treat it the
 188          * same as the normal permanent MAC address stored by the HW into the
 189          * RAR. Do this by mapping this address into RAR0.
 190          */
 191         hw->mac.ops.rar_set(hw, alt_mac_addr, 0);
 192 
 193         return 0;
 194 }
 195 
 196 u32 e1000e_rar_get_count_generic(struct e1000_hw *hw)
 197 {
 198         return hw->mac.rar_entry_count;
 199 }
 200 
 201 /**
 202  *  e1000e_rar_set_generic - Set receive address register
 203  *  @hw: pointer to the HW structure
 204  *  @addr: pointer to the receive address
 205  *  @index: receive address array register
 206  *
 207  *  Sets the receive address array register at index to the address passed
 208  *  in by addr.
 209  **/
 210 int e1000e_rar_set_generic(struct e1000_hw *hw, u8 *addr, u32 index)
 211 {
 212         u32 rar_low, rar_high;
 213 
 214         /* HW expects these in little endian so we reverse the byte order
 215          * from network order (big endian) to little endian
 216          */
 217         rar_low = ((u32)addr[0] | ((u32)addr[1] << 8) |
 218                    ((u32)addr[2] << 16) | ((u32)addr[3] << 24));
 219 
 220         rar_high = ((u32)addr[4] | ((u32)addr[5] << 8));
 221 
 222         /* If MAC address zero, no need to set the AV bit */
 223         if (rar_low || rar_high)
 224                 rar_high |= E1000_RAH_AV;
 225 
 226         /* Some bridges will combine consecutive 32-bit writes into
 227          * a single burst write, which will malfunction on some parts.
 228          * The flushes avoid this.
 229          */
 230         ew32(RAL(index), rar_low);
 231         e1e_flush();
 232         ew32(RAH(index), rar_high);
 233         e1e_flush();
 234 
 235         return 0;
 236 }
 237 
 238 /**
 239  *  e1000_hash_mc_addr - Generate a multicast hash value
 240  *  @hw: pointer to the HW structure
 241  *  @mc_addr: pointer to a multicast address
 242  *
 243  *  Generates a multicast address hash value which is used to determine
 244  *  the multicast filter table array address and new table value.
 245  **/
 246 static u32 e1000_hash_mc_addr(struct e1000_hw *hw, u8 *mc_addr)
 247 {
 248         u32 hash_value, hash_mask;
 249         u8 bit_shift = 0;
 250 
 251         /* Register count multiplied by bits per register */
 252         hash_mask = (hw->mac.mta_reg_count * 32) - 1;
 253 
 254         /* For a mc_filter_type of 0, bit_shift is the number of left-shifts
 255          * where 0xFF would still fall within the hash mask.
 256          */
 257         while (hash_mask >> bit_shift != 0xFF)
 258                 bit_shift++;
 259 
 260         /* The portion of the address that is used for the hash table
 261          * is determined by the mc_filter_type setting.
 262          * The algorithm is such that there is a total of 8 bits of shifting.
 263          * The bit_shift for a mc_filter_type of 0 represents the number of
 264          * left-shifts where the MSB of mc_addr[5] would still fall within
 265          * the hash_mask.  Case 0 does this exactly.  Since there are a total
 266          * of 8 bits of shifting, then mc_addr[4] will shift right the
 267          * remaining number of bits. Thus 8 - bit_shift.  The rest of the
 268          * cases are a variation of this algorithm...essentially raising the
 269          * number of bits to shift mc_addr[5] left, while still keeping the
 270          * 8-bit shifting total.
 271          *
 272          * For example, given the following Destination MAC Address and an
 273          * mta register count of 128 (thus a 4096-bit vector and 0xFFF mask),
 274          * we can see that the bit_shift for case 0 is 4.  These are the hash
 275          * values resulting from each mc_filter_type...
 276          * [0] [1] [2] [3] [4] [5]
 277          * 01  AA  00  12  34  56
 278          * LSB           MSB
 279          *
 280          * case 0: hash_value = ((0x34 >> 4) | (0x56 << 4)) & 0xFFF = 0x563
 281          * case 1: hash_value = ((0x34 >> 3) | (0x56 << 5)) & 0xFFF = 0xAC6
 282          * case 2: hash_value = ((0x34 >> 2) | (0x56 << 6)) & 0xFFF = 0x163
 283          * case 3: hash_value = ((0x34 >> 0) | (0x56 << 8)) & 0xFFF = 0x634
 284          */
 285         switch (hw->mac.mc_filter_type) {
 286         default:
 287         case 0:
 288                 break;
 289         case 1:
 290                 bit_shift += 1;
 291                 break;
 292         case 2:
 293                 bit_shift += 2;
 294                 break;
 295         case 3:
 296                 bit_shift += 4;
 297                 break;
 298         }
 299 
 300         hash_value = hash_mask & (((mc_addr[4] >> (8 - bit_shift)) |
 301                                    (((u16)mc_addr[5]) << bit_shift)));
 302 
 303         return hash_value;
 304 }
 305 
 306 /**
 307  *  e1000e_update_mc_addr_list_generic - Update Multicast addresses
 308  *  @hw: pointer to the HW structure
 309  *  @mc_addr_list: array of multicast addresses to program
 310  *  @mc_addr_count: number of multicast addresses to program
 311  *
 312  *  Updates entire Multicast Table Array.
 313  *  The caller must have a packed mc_addr_list of multicast addresses.
 314  **/
 315 void e1000e_update_mc_addr_list_generic(struct e1000_hw *hw,
 316                                         u8 *mc_addr_list, u32 mc_addr_count)
 317 {
 318         u32 hash_value, hash_bit, hash_reg;
 319         int i;
 320 
 321         /* clear mta_shadow */
 322         memset(&hw->mac.mta_shadow, 0, sizeof(hw->mac.mta_shadow));
 323 
 324         /* update mta_shadow from mc_addr_list */
 325         for (i = 0; (u32)i < mc_addr_count; i++) {
 326                 hash_value = e1000_hash_mc_addr(hw, mc_addr_list);
 327 
 328                 hash_reg = (hash_value >> 5) & (hw->mac.mta_reg_count - 1);
 329                 hash_bit = hash_value & 0x1F;
 330 
 331                 hw->mac.mta_shadow[hash_reg] |= BIT(hash_bit);
 332                 mc_addr_list += (ETH_ALEN);
 333         }
 334 
 335         /* replace the entire MTA table */
 336         for (i = hw->mac.mta_reg_count - 1; i >= 0; i--)
 337                 E1000_WRITE_REG_ARRAY(hw, E1000_MTA, i, hw->mac.mta_shadow[i]);
 338         e1e_flush();
 339 }
 340 
 341 /**
 342  *  e1000e_clear_hw_cntrs_base - Clear base hardware counters
 343  *  @hw: pointer to the HW structure
 344  *
 345  *  Clears the base hardware counters by reading the counter registers.
 346  **/
 347 void e1000e_clear_hw_cntrs_base(struct e1000_hw *hw)
 348 {
 349         er32(CRCERRS);
 350         er32(SYMERRS);
 351         er32(MPC);
 352         er32(SCC);
 353         er32(ECOL);
 354         er32(MCC);
 355         er32(LATECOL);
 356         er32(COLC);
 357         er32(DC);
 358         er32(SEC);
 359         er32(RLEC);
 360         er32(XONRXC);
 361         er32(XONTXC);
 362         er32(XOFFRXC);
 363         er32(XOFFTXC);
 364         er32(FCRUC);
 365         er32(GPRC);
 366         er32(BPRC);
 367         er32(MPRC);
 368         er32(GPTC);
 369         er32(GORCL);
 370         er32(GORCH);
 371         er32(GOTCL);
 372         er32(GOTCH);
 373         er32(RNBC);
 374         er32(RUC);
 375         er32(RFC);
 376         er32(ROC);
 377         er32(RJC);
 378         er32(TORL);
 379         er32(TORH);
 380         er32(TOTL);
 381         er32(TOTH);
 382         er32(TPR);
 383         er32(TPT);
 384         er32(MPTC);
 385         er32(BPTC);
 386 }
 387 
 388 /**
 389  *  e1000e_check_for_copper_link - Check for link (Copper)
 390  *  @hw: pointer to the HW structure
 391  *
 392  *  Checks to see of the link status of the hardware has changed.  If a
 393  *  change in link status has been detected, then we read the PHY registers
 394  *  to get the current speed/duplex if link exists.
 395  **/
 396 s32 e1000e_check_for_copper_link(struct e1000_hw *hw)
 397 {
 398         struct e1000_mac_info *mac = &hw->mac;
 399         s32 ret_val;
 400         bool link;
 401 
 402         /* We only want to go out to the PHY registers to see if Auto-Neg
 403          * has completed and/or if our link status has changed.  The
 404          * get_link_status flag is set upon receiving a Link Status
 405          * Change or Rx Sequence Error interrupt.
 406          */
 407         if (!mac->get_link_status)
 408                 return 0;
 409         mac->get_link_status = false;
 410 
 411         /* First we want to see if the MII Status Register reports
 412          * link.  If so, then we want to get the current speed/duplex
 413          * of the PHY.
 414          */
 415         ret_val = e1000e_phy_has_link_generic(hw, 1, 0, &link);
 416         if (ret_val || !link)
 417                 goto out;
 418 
 419         /* Check if there was DownShift, must be checked
 420          * immediately after link-up
 421          */
 422         e1000e_check_downshift(hw);
 423 
 424         /* If we are forcing speed/duplex, then we simply return since
 425          * we have already determined whether we have link or not.
 426          */
 427         if (!mac->autoneg)
 428                 return -E1000_ERR_CONFIG;
 429 
 430         /* Auto-Neg is enabled.  Auto Speed Detection takes care
 431          * of MAC speed/duplex configuration.  So we only need to
 432          * configure Collision Distance in the MAC.
 433          */
 434         mac->ops.config_collision_dist(hw);
 435 
 436         /* Configure Flow Control now that Auto-Neg has completed.
 437          * First, we need to restore the desired flow control
 438          * settings because we may have had to re-autoneg with a
 439          * different link partner.
 440          */
 441         ret_val = e1000e_config_fc_after_link_up(hw);
 442         if (ret_val)
 443                 e_dbg("Error configuring flow control\n");
 444 
 445         return ret_val;
 446 
 447 out:
 448         mac->get_link_status = true;
 449         return ret_val;
 450 }
 451 
 452 /**
 453  *  e1000e_check_for_fiber_link - Check for link (Fiber)
 454  *  @hw: pointer to the HW structure
 455  *
 456  *  Checks for link up on the hardware.  If link is not up and we have
 457  *  a signal, then we need to force link up.
 458  **/
 459 s32 e1000e_check_for_fiber_link(struct e1000_hw *hw)
 460 {
 461         struct e1000_mac_info *mac = &hw->mac;
 462         u32 rxcw;
 463         u32 ctrl;
 464         u32 status;
 465         s32 ret_val;
 466 
 467         ctrl = er32(CTRL);
 468         status = er32(STATUS);
 469         rxcw = er32(RXCW);
 470 
 471         /* If we don't have link (auto-negotiation failed or link partner
 472          * cannot auto-negotiate), the cable is plugged in (we have signal),
 473          * and our link partner is not trying to auto-negotiate with us (we
 474          * are receiving idles or data), we need to force link up. We also
 475          * need to give auto-negotiation time to complete, in case the cable
 476          * was just plugged in. The autoneg_failed flag does this.
 477          */
 478         /* (ctrl & E1000_CTRL_SWDPIN1) == 1 == have signal */
 479         if ((ctrl & E1000_CTRL_SWDPIN1) && !(status & E1000_STATUS_LU) &&
 480             !(rxcw & E1000_RXCW_C)) {
 481                 if (!mac->autoneg_failed) {
 482                         mac->autoneg_failed = true;
 483                         return 0;
 484                 }
 485                 e_dbg("NOT Rx'ing /C/, disable AutoNeg and force link.\n");
 486 
 487                 /* Disable auto-negotiation in the TXCW register */
 488                 ew32(TXCW, (mac->txcw & ~E1000_TXCW_ANE));
 489 
 490                 /* Force link-up and also force full-duplex. */
 491                 ctrl = er32(CTRL);
 492                 ctrl |= (E1000_CTRL_SLU | E1000_CTRL_FD);
 493                 ew32(CTRL, ctrl);
 494 
 495                 /* Configure Flow Control after forcing link up. */
 496                 ret_val = e1000e_config_fc_after_link_up(hw);
 497                 if (ret_val) {
 498                         e_dbg("Error configuring flow control\n");
 499                         return ret_val;
 500                 }
 501         } else if ((ctrl & E1000_CTRL_SLU) && (rxcw & E1000_RXCW_C)) {
 502                 /* If we are forcing link and we are receiving /C/ ordered
 503                  * sets, re-enable auto-negotiation in the TXCW register
 504                  * and disable forced link in the Device Control register
 505                  * in an attempt to auto-negotiate with our link partner.
 506                  */
 507                 e_dbg("Rx'ing /C/, enable AutoNeg and stop forcing link.\n");
 508                 ew32(TXCW, mac->txcw);
 509                 ew32(CTRL, (ctrl & ~E1000_CTRL_SLU));
 510 
 511                 mac->serdes_has_link = true;
 512         }
 513 
 514         return 0;
 515 }
 516 
 517 /**
 518  *  e1000e_check_for_serdes_link - Check for link (Serdes)
 519  *  @hw: pointer to the HW structure
 520  *
 521  *  Checks for link up on the hardware.  If link is not up and we have
 522  *  a signal, then we need to force link up.
 523  **/
 524 s32 e1000e_check_for_serdes_link(struct e1000_hw *hw)
 525 {
 526         struct e1000_mac_info *mac = &hw->mac;
 527         u32 rxcw;
 528         u32 ctrl;
 529         u32 status;
 530         s32 ret_val;
 531 
 532         ctrl = er32(CTRL);
 533         status = er32(STATUS);
 534         rxcw = er32(RXCW);
 535 
 536         /* If we don't have link (auto-negotiation failed or link partner
 537          * cannot auto-negotiate), and our link partner is not trying to
 538          * auto-negotiate with us (we are receiving idles or data),
 539          * we need to force link up. We also need to give auto-negotiation
 540          * time to complete.
 541          */
 542         /* (ctrl & E1000_CTRL_SWDPIN1) == 1 == have signal */
 543         if (!(status & E1000_STATUS_LU) && !(rxcw & E1000_RXCW_C)) {
 544                 if (!mac->autoneg_failed) {
 545                         mac->autoneg_failed = true;
 546                         return 0;
 547                 }
 548                 e_dbg("NOT Rx'ing /C/, disable AutoNeg and force link.\n");
 549 
 550                 /* Disable auto-negotiation in the TXCW register */
 551                 ew32(TXCW, (mac->txcw & ~E1000_TXCW_ANE));
 552 
 553                 /* Force link-up and also force full-duplex. */
 554                 ctrl = er32(CTRL);
 555                 ctrl |= (E1000_CTRL_SLU | E1000_CTRL_FD);
 556                 ew32(CTRL, ctrl);
 557 
 558                 /* Configure Flow Control after forcing link up. */
 559                 ret_val = e1000e_config_fc_after_link_up(hw);
 560                 if (ret_val) {
 561                         e_dbg("Error configuring flow control\n");
 562                         return ret_val;
 563                 }
 564         } else if ((ctrl & E1000_CTRL_SLU) && (rxcw & E1000_RXCW_C)) {
 565                 /* If we are forcing link and we are receiving /C/ ordered
 566                  * sets, re-enable auto-negotiation in the TXCW register
 567                  * and disable forced link in the Device Control register
 568                  * in an attempt to auto-negotiate with our link partner.
 569                  */
 570                 e_dbg("Rx'ing /C/, enable AutoNeg and stop forcing link.\n");
 571                 ew32(TXCW, mac->txcw);
 572                 ew32(CTRL, (ctrl & ~E1000_CTRL_SLU));
 573 
 574                 mac->serdes_has_link = true;
 575         } else if (!(E1000_TXCW_ANE & er32(TXCW))) {
 576                 /* If we force link for non-auto-negotiation switch, check
 577                  * link status based on MAC synchronization for internal
 578                  * serdes media type.
 579                  */
 580                 /* SYNCH bit and IV bit are sticky. */
 581                 usleep_range(10, 20);
 582                 rxcw = er32(RXCW);
 583                 if (rxcw & E1000_RXCW_SYNCH) {
 584                         if (!(rxcw & E1000_RXCW_IV)) {
 585                                 mac->serdes_has_link = true;
 586                                 e_dbg("SERDES: Link up - forced.\n");
 587                         }
 588                 } else {
 589                         mac->serdes_has_link = false;
 590                         e_dbg("SERDES: Link down - force failed.\n");
 591                 }
 592         }
 593 
 594         if (E1000_TXCW_ANE & er32(TXCW)) {
 595                 status = er32(STATUS);
 596                 if (status & E1000_STATUS_LU) {
 597                         /* SYNCH bit and IV bit are sticky, so reread rxcw. */
 598                         usleep_range(10, 20);
 599                         rxcw = er32(RXCW);
 600                         if (rxcw & E1000_RXCW_SYNCH) {
 601                                 if (!(rxcw & E1000_RXCW_IV)) {
 602                                         mac->serdes_has_link = true;
 603                                         e_dbg("SERDES: Link up - autoneg completed successfully.\n");
 604                                 } else {
 605                                         mac->serdes_has_link = false;
 606                                         e_dbg("SERDES: Link down - invalid codewords detected in autoneg.\n");
 607                                 }
 608                         } else {
 609                                 mac->serdes_has_link = false;
 610                                 e_dbg("SERDES: Link down - no sync.\n");
 611                         }
 612                 } else {
 613                         mac->serdes_has_link = false;
 614                         e_dbg("SERDES: Link down - autoneg failed\n");
 615                 }
 616         }
 617 
 618         return 0;
 619 }
 620 
 621 /**
 622  *  e1000_set_default_fc_generic - Set flow control default values
 623  *  @hw: pointer to the HW structure
 624  *
 625  *  Read the EEPROM for the default values for flow control and store the
 626  *  values.
 627  **/
 628 static s32 e1000_set_default_fc_generic(struct e1000_hw *hw)
 629 {
 630         s32 ret_val;
 631         u16 nvm_data;
 632 
 633         /* Read and store word 0x0F of the EEPROM. This word contains bits
 634          * that determine the hardware's default PAUSE (flow control) mode,
 635          * a bit that determines whether the HW defaults to enabling or
 636          * disabling auto-negotiation, and the direction of the
 637          * SW defined pins. If there is no SW over-ride of the flow
 638          * control setting, then the variable hw->fc will
 639          * be initialized based on a value in the EEPROM.
 640          */
 641         ret_val = e1000_read_nvm(hw, NVM_INIT_CONTROL2_REG, 1, &nvm_data);
 642 
 643         if (ret_val) {
 644                 e_dbg("NVM Read Error\n");
 645                 return ret_val;
 646         }
 647 
 648         if (!(nvm_data & NVM_WORD0F_PAUSE_MASK))
 649                 hw->fc.requested_mode = e1000_fc_none;
 650         else if ((nvm_data & NVM_WORD0F_PAUSE_MASK) == NVM_WORD0F_ASM_DIR)
 651                 hw->fc.requested_mode = e1000_fc_tx_pause;
 652         else
 653                 hw->fc.requested_mode = e1000_fc_full;
 654 
 655         return 0;
 656 }
 657 
 658 /**
 659  *  e1000e_setup_link_generic - Setup flow control and link settings
 660  *  @hw: pointer to the HW structure
 661  *
 662  *  Determines which flow control settings to use, then configures flow
 663  *  control.  Calls the appropriate media-specific link configuration
 664  *  function.  Assuming the adapter has a valid link partner, a valid link
 665  *  should be established.  Assumes the hardware has previously been reset
 666  *  and the transmitter and receiver are not enabled.
 667  **/
 668 s32 e1000e_setup_link_generic(struct e1000_hw *hw)
 669 {
 670         s32 ret_val;
 671 
 672         /* In the case of the phy reset being blocked, we already have a link.
 673          * We do not need to set it up again.
 674          */
 675         if (hw->phy.ops.check_reset_block && hw->phy.ops.check_reset_block(hw))
 676                 return 0;
 677 
 678         /* If requested flow control is set to default, set flow control
 679          * based on the EEPROM flow control settings.
 680          */
 681         if (hw->fc.requested_mode == e1000_fc_default) {
 682                 ret_val = e1000_set_default_fc_generic(hw);
 683                 if (ret_val)
 684                         return ret_val;
 685         }
 686 
 687         /* Save off the requested flow control mode for use later.  Depending
 688          * on the link partner's capabilities, we may or may not use this mode.
 689          */
 690         hw->fc.current_mode = hw->fc.requested_mode;
 691 
 692         e_dbg("After fix-ups FlowControl is now = %x\n", hw->fc.current_mode);
 693 
 694         /* Call the necessary media_type subroutine to configure the link. */
 695         ret_val = hw->mac.ops.setup_physical_interface(hw);
 696         if (ret_val)
 697                 return ret_val;
 698 
 699         /* Initialize the flow control address, type, and PAUSE timer
 700          * registers to their default values.  This is done even if flow
 701          * control is disabled, because it does not hurt anything to
 702          * initialize these registers.
 703          */
 704         e_dbg("Initializing the Flow Control address, type and timer regs\n");
 705         ew32(FCT, FLOW_CONTROL_TYPE);
 706         ew32(FCAH, FLOW_CONTROL_ADDRESS_HIGH);
 707         ew32(FCAL, FLOW_CONTROL_ADDRESS_LOW);
 708 
 709         ew32(FCTTV, hw->fc.pause_time);
 710 
 711         return e1000e_set_fc_watermarks(hw);
 712 }
 713 
 714 /**
 715  *  e1000_commit_fc_settings_generic - Configure flow control
 716  *  @hw: pointer to the HW structure
 717  *
 718  *  Write the flow control settings to the Transmit Config Word Register (TXCW)
 719  *  base on the flow control settings in e1000_mac_info.
 720  **/
 721 static s32 e1000_commit_fc_settings_generic(struct e1000_hw *hw)
 722 {
 723         struct e1000_mac_info *mac = &hw->mac;
 724         u32 txcw;
 725 
 726         /* Check for a software override of the flow control settings, and
 727          * setup the device accordingly.  If auto-negotiation is enabled, then
 728          * software will have to set the "PAUSE" bits to the correct value in
 729          * the Transmit Config Word Register (TXCW) and re-start auto-
 730          * negotiation.  However, if auto-negotiation is disabled, then
 731          * software will have to manually configure the two flow control enable
 732          * bits in the CTRL register.
 733          *
 734          * The possible values of the "fc" parameter are:
 735          *      0:  Flow control is completely disabled
 736          *      1:  Rx flow control is enabled (we can receive pause frames,
 737          *          but not send pause frames).
 738          *      2:  Tx flow control is enabled (we can send pause frames but we
 739          *          do not support receiving pause frames).
 740          *      3:  Both Rx and Tx flow control (symmetric) are enabled.
 741          */
 742         switch (hw->fc.current_mode) {
 743         case e1000_fc_none:
 744                 /* Flow control completely disabled by a software over-ride. */
 745                 txcw = (E1000_TXCW_ANE | E1000_TXCW_FD);
 746                 break;
 747         case e1000_fc_rx_pause:
 748                 /* Rx Flow control is enabled and Tx Flow control is disabled
 749                  * by a software over-ride. Since there really isn't a way to
 750                  * advertise that we are capable of Rx Pause ONLY, we will
 751                  * advertise that we support both symmetric and asymmetric Rx
 752                  * PAUSE.  Later, we will disable the adapter's ability to send
 753                  * PAUSE frames.
 754                  */
 755                 txcw = (E1000_TXCW_ANE | E1000_TXCW_FD | E1000_TXCW_PAUSE_MASK);
 756                 break;
 757         case e1000_fc_tx_pause:
 758                 /* Tx Flow control is enabled, and Rx Flow control is disabled,
 759                  * by a software over-ride.
 760                  */
 761                 txcw = (E1000_TXCW_ANE | E1000_TXCW_FD | E1000_TXCW_ASM_DIR);
 762                 break;
 763         case e1000_fc_full:
 764                 /* Flow control (both Rx and Tx) is enabled by a software
 765                  * over-ride.
 766                  */
 767                 txcw = (E1000_TXCW_ANE | E1000_TXCW_FD | E1000_TXCW_PAUSE_MASK);
 768                 break;
 769         default:
 770                 e_dbg("Flow control param set incorrectly\n");
 771                 return -E1000_ERR_CONFIG;
 772         }
 773 
 774         ew32(TXCW, txcw);
 775         mac->txcw = txcw;
 776 
 777         return 0;
 778 }
 779 
 780 /**
 781  *  e1000_poll_fiber_serdes_link_generic - Poll for link up
 782  *  @hw: pointer to the HW structure
 783  *
 784  *  Polls for link up by reading the status register, if link fails to come
 785  *  up with auto-negotiation, then the link is forced if a signal is detected.
 786  **/
 787 static s32 e1000_poll_fiber_serdes_link_generic(struct e1000_hw *hw)
 788 {
 789         struct e1000_mac_info *mac = &hw->mac;
 790         u32 i, status;
 791         s32 ret_val;
 792 
 793         /* If we have a signal (the cable is plugged in, or assumed true for
 794          * serdes media) then poll for a "Link-Up" indication in the Device
 795          * Status Register.  Time-out if a link isn't seen in 500 milliseconds
 796          * seconds (Auto-negotiation should complete in less than 500
 797          * milliseconds even if the other end is doing it in SW).
 798          */
 799         for (i = 0; i < FIBER_LINK_UP_LIMIT; i++) {
 800                 usleep_range(10000, 11000);
 801                 status = er32(STATUS);
 802                 if (status & E1000_STATUS_LU)
 803                         break;
 804         }
 805         if (i == FIBER_LINK_UP_LIMIT) {
 806                 e_dbg("Never got a valid link from auto-neg!!!\n");
 807                 mac->autoneg_failed = true;
 808                 /* AutoNeg failed to achieve a link, so we'll call
 809                  * mac->check_for_link. This routine will force the
 810                  * link up if we detect a signal. This will allow us to
 811                  * communicate with non-autonegotiating link partners.
 812                  */
 813                 ret_val = mac->ops.check_for_link(hw);
 814                 if (ret_val) {
 815                         e_dbg("Error while checking for link\n");
 816                         return ret_val;
 817                 }
 818                 mac->autoneg_failed = false;
 819         } else {
 820                 mac->autoneg_failed = false;
 821                 e_dbg("Valid Link Found\n");
 822         }
 823 
 824         return 0;
 825 }
 826 
 827 /**
 828  *  e1000e_setup_fiber_serdes_link - Setup link for fiber/serdes
 829  *  @hw: pointer to the HW structure
 830  *
 831  *  Configures collision distance and flow control for fiber and serdes
 832  *  links.  Upon successful setup, poll for link.
 833  **/
 834 s32 e1000e_setup_fiber_serdes_link(struct e1000_hw *hw)
 835 {
 836         u32 ctrl;
 837         s32 ret_val;
 838 
 839         ctrl = er32(CTRL);
 840 
 841         /* Take the link out of reset */
 842         ctrl &= ~E1000_CTRL_LRST;
 843 
 844         hw->mac.ops.config_collision_dist(hw);
 845 
 846         ret_val = e1000_commit_fc_settings_generic(hw);
 847         if (ret_val)
 848                 return ret_val;
 849 
 850         /* Since auto-negotiation is enabled, take the link out of reset (the
 851          * link will be in reset, because we previously reset the chip). This
 852          * will restart auto-negotiation.  If auto-negotiation is successful
 853          * then the link-up status bit will be set and the flow control enable
 854          * bits (RFCE and TFCE) will be set according to their negotiated value.
 855          */
 856         e_dbg("Auto-negotiation enabled\n");
 857 
 858         ew32(CTRL, ctrl);
 859         e1e_flush();
 860         usleep_range(1000, 2000);
 861 
 862         /* For these adapters, the SW definable pin 1 is set when the optics
 863          * detect a signal.  If we have a signal, then poll for a "Link-Up"
 864          * indication.
 865          */
 866         if (hw->phy.media_type == e1000_media_type_internal_serdes ||
 867             (er32(CTRL) & E1000_CTRL_SWDPIN1)) {
 868                 ret_val = e1000_poll_fiber_serdes_link_generic(hw);
 869         } else {
 870                 e_dbg("No signal detected\n");
 871         }
 872 
 873         return ret_val;
 874 }
 875 
 876 /**
 877  *  e1000e_config_collision_dist_generic - Configure collision distance
 878  *  @hw: pointer to the HW structure
 879  *
 880  *  Configures the collision distance to the default value and is used
 881  *  during link setup.
 882  **/
 883 void e1000e_config_collision_dist_generic(struct e1000_hw *hw)
 884 {
 885         u32 tctl;
 886 
 887         tctl = er32(TCTL);
 888 
 889         tctl &= ~E1000_TCTL_COLD;
 890         tctl |= E1000_COLLISION_DISTANCE << E1000_COLD_SHIFT;
 891 
 892         ew32(TCTL, tctl);
 893         e1e_flush();
 894 }
 895 
 896 /**
 897  *  e1000e_set_fc_watermarks - Set flow control high/low watermarks
 898  *  @hw: pointer to the HW structure
 899  *
 900  *  Sets the flow control high/low threshold (watermark) registers.  If
 901  *  flow control XON frame transmission is enabled, then set XON frame
 902  *  transmission as well.
 903  **/
 904 s32 e1000e_set_fc_watermarks(struct e1000_hw *hw)
 905 {
 906         u32 fcrtl = 0, fcrth = 0;
 907 
 908         /* Set the flow control receive threshold registers.  Normally,
 909          * these registers will be set to a default threshold that may be
 910          * adjusted later by the driver's runtime code.  However, if the
 911          * ability to transmit pause frames is not enabled, then these
 912          * registers will be set to 0.
 913          */
 914         if (hw->fc.current_mode & e1000_fc_tx_pause) {
 915                 /* We need to set up the Receive Threshold high and low water
 916                  * marks as well as (optionally) enabling the transmission of
 917                  * XON frames.
 918                  */
 919                 fcrtl = hw->fc.low_water;
 920                 if (hw->fc.send_xon)
 921                         fcrtl |= E1000_FCRTL_XONE;
 922 
 923                 fcrth = hw->fc.high_water;
 924         }
 925         ew32(FCRTL, fcrtl);
 926         ew32(FCRTH, fcrth);
 927 
 928         return 0;
 929 }
 930 
 931 /**
 932  *  e1000e_force_mac_fc - Force the MAC's flow control settings
 933  *  @hw: pointer to the HW structure
 934  *
 935  *  Force the MAC's flow control settings.  Sets the TFCE and RFCE bits in the
 936  *  device control register to reflect the adapter settings.  TFCE and RFCE
 937  *  need to be explicitly set by software when a copper PHY is used because
 938  *  autonegotiation is managed by the PHY rather than the MAC.  Software must
 939  *  also configure these bits when link is forced on a fiber connection.
 940  **/
 941 s32 e1000e_force_mac_fc(struct e1000_hw *hw)
 942 {
 943         u32 ctrl;
 944 
 945         ctrl = er32(CTRL);
 946 
 947         /* Because we didn't get link via the internal auto-negotiation
 948          * mechanism (we either forced link or we got link via PHY
 949          * auto-neg), we have to manually enable/disable transmit an
 950          * receive flow control.
 951          *
 952          * The "Case" statement below enables/disable flow control
 953          * according to the "hw->fc.current_mode" parameter.
 954          *
 955          * The possible values of the "fc" parameter are:
 956          *      0:  Flow control is completely disabled
 957          *      1:  Rx flow control is enabled (we can receive pause
 958          *          frames but not send pause frames).
 959          *      2:  Tx flow control is enabled (we can send pause frames
 960          *          frames but we do not receive pause frames).
 961          *      3:  Both Rx and Tx flow control (symmetric) is enabled.
 962          *  other:  No other values should be possible at this point.
 963          */
 964         e_dbg("hw->fc.current_mode = %u\n", hw->fc.current_mode);
 965 
 966         switch (hw->fc.current_mode) {
 967         case e1000_fc_none:
 968                 ctrl &= (~(E1000_CTRL_TFCE | E1000_CTRL_RFCE));
 969                 break;
 970         case e1000_fc_rx_pause:
 971                 ctrl &= (~E1000_CTRL_TFCE);
 972                 ctrl |= E1000_CTRL_RFCE;
 973                 break;
 974         case e1000_fc_tx_pause:
 975                 ctrl &= (~E1000_CTRL_RFCE);
 976                 ctrl |= E1000_CTRL_TFCE;
 977                 break;
 978         case e1000_fc_full:
 979                 ctrl |= (E1000_CTRL_TFCE | E1000_CTRL_RFCE);
 980                 break;
 981         default:
 982                 e_dbg("Flow control param set incorrectly\n");
 983                 return -E1000_ERR_CONFIG;
 984         }
 985 
 986         ew32(CTRL, ctrl);
 987 
 988         return 0;
 989 }
 990 
 991 /**
 992  *  e1000e_config_fc_after_link_up - Configures flow control after link
 993  *  @hw: pointer to the HW structure
 994  *
 995  *  Checks the status of auto-negotiation after link up to ensure that the
 996  *  speed and duplex were not forced.  If the link needed to be forced, then
 997  *  flow control needs to be forced also.  If auto-negotiation is enabled
 998  *  and did not fail, then we configure flow control based on our link
 999  *  partner.
1000  **/
1001 s32 e1000e_config_fc_after_link_up(struct e1000_hw *hw)
1002 {
1003         struct e1000_mac_info *mac = &hw->mac;
1004         s32 ret_val = 0;
1005         u32 pcs_status_reg, pcs_adv_reg, pcs_lp_ability_reg, pcs_ctrl_reg;
1006         u16 mii_status_reg, mii_nway_adv_reg, mii_nway_lp_ability_reg;
1007         u16 speed, duplex;
1008 
1009         /* Check for the case where we have fiber media and auto-neg failed
1010          * so we had to force link.  In this case, we need to force the
1011          * configuration of the MAC to match the "fc" parameter.
1012          */
1013         if (mac->autoneg_failed) {
1014                 if (hw->phy.media_type == e1000_media_type_fiber ||
1015                     hw->phy.media_type == e1000_media_type_internal_serdes)
1016                         ret_val = e1000e_force_mac_fc(hw);
1017         } else {
1018                 if (hw->phy.media_type == e1000_media_type_copper)
1019                         ret_val = e1000e_force_mac_fc(hw);
1020         }
1021 
1022         if (ret_val) {
1023                 e_dbg("Error forcing flow control settings\n");
1024                 return ret_val;
1025         }
1026 
1027         /* Check for the case where we have copper media and auto-neg is
1028          * enabled.  In this case, we need to check and see if Auto-Neg
1029          * has completed, and if so, how the PHY and link partner has
1030          * flow control configured.
1031          */
1032         if ((hw->phy.media_type == e1000_media_type_copper) && mac->autoneg) {
1033                 /* Read the MII Status Register and check to see if AutoNeg
1034                  * has completed.  We read this twice because this reg has
1035                  * some "sticky" (latched) bits.
1036                  */
1037                 ret_val = e1e_rphy(hw, MII_BMSR, &mii_status_reg);
1038                 if (ret_val)
1039                         return ret_val;
1040                 ret_val = e1e_rphy(hw, MII_BMSR, &mii_status_reg);
1041                 if (ret_val)
1042                         return ret_val;
1043 
1044                 if (!(mii_status_reg & BMSR_ANEGCOMPLETE)) {
1045                         e_dbg("Copper PHY and Auto Neg has not completed.\n");
1046                         return ret_val;
1047                 }
1048 
1049                 /* The AutoNeg process has completed, so we now need to
1050                  * read both the Auto Negotiation Advertisement
1051                  * Register (Address 4) and the Auto_Negotiation Base
1052                  * Page Ability Register (Address 5) to determine how
1053                  * flow control was negotiated.
1054                  */
1055                 ret_val = e1e_rphy(hw, MII_ADVERTISE, &mii_nway_adv_reg);
1056                 if (ret_val)
1057                         return ret_val;
1058                 ret_val = e1e_rphy(hw, MII_LPA, &mii_nway_lp_ability_reg);
1059                 if (ret_val)
1060                         return ret_val;
1061 
1062                 /* Two bits in the Auto Negotiation Advertisement Register
1063                  * (Address 4) and two bits in the Auto Negotiation Base
1064                  * Page Ability Register (Address 5) determine flow control
1065                  * for both the PHY and the link partner.  The following
1066                  * table, taken out of the IEEE 802.3ab/D6.0 dated March 25,
1067                  * 1999, describes these PAUSE resolution bits and how flow
1068                  * control is determined based upon these settings.
1069                  * NOTE:  DC = Don't Care
1070                  *
1071                  *   LOCAL DEVICE  |   LINK PARTNER
1072                  * PAUSE | ASM_DIR | PAUSE | ASM_DIR | NIC Resolution
1073                  *-------|---------|-------|---------|--------------------
1074                  *   0   |    0    |  DC   |   DC    | e1000_fc_none
1075                  *   0   |    1    |   0   |   DC    | e1000_fc_none
1076                  *   0   |    1    |   1   |    0    | e1000_fc_none
1077                  *   0   |    1    |   1   |    1    | e1000_fc_tx_pause
1078                  *   1   |    0    |   0   |   DC    | e1000_fc_none
1079                  *   1   |   DC    |   1   |   DC    | e1000_fc_full
1080                  *   1   |    1    |   0   |    0    | e1000_fc_none
1081                  *   1   |    1    |   0   |    1    | e1000_fc_rx_pause
1082                  *
1083                  * Are both PAUSE bits set to 1?  If so, this implies
1084                  * Symmetric Flow Control is enabled at both ends.  The
1085                  * ASM_DIR bits are irrelevant per the spec.
1086                  *
1087                  * For Symmetric Flow Control:
1088                  *
1089                  *   LOCAL DEVICE  |   LINK PARTNER
1090                  * PAUSE | ASM_DIR | PAUSE | ASM_DIR | Result
1091                  *-------|---------|-------|---------|--------------------
1092                  *   1   |   DC    |   1   |   DC    | E1000_fc_full
1093                  *
1094                  */
1095                 if ((mii_nway_adv_reg & ADVERTISE_PAUSE_CAP) &&
1096                     (mii_nway_lp_ability_reg & LPA_PAUSE_CAP)) {
1097                         /* Now we need to check if the user selected Rx ONLY
1098                          * of pause frames.  In this case, we had to advertise
1099                          * FULL flow control because we could not advertise Rx
1100                          * ONLY. Hence, we must now check to see if we need to
1101                          * turn OFF the TRANSMISSION of PAUSE frames.
1102                          */
1103                         if (hw->fc.requested_mode == e1000_fc_full) {
1104                                 hw->fc.current_mode = e1000_fc_full;
1105                                 e_dbg("Flow Control = FULL.\n");
1106                         } else {
1107                                 hw->fc.current_mode = e1000_fc_rx_pause;
1108                                 e_dbg("Flow Control = Rx PAUSE frames only.\n");
1109                         }
1110                 }
1111                 /* For receiving PAUSE frames ONLY.
1112                  *
1113                  *   LOCAL DEVICE  |   LINK PARTNER
1114                  * PAUSE | ASM_DIR | PAUSE | ASM_DIR | Result
1115                  *-------|---------|-------|---------|--------------------
1116                  *   0   |    1    |   1   |    1    | e1000_fc_tx_pause
1117                  */
1118                 else if (!(mii_nway_adv_reg & ADVERTISE_PAUSE_CAP) &&
1119                          (mii_nway_adv_reg & ADVERTISE_PAUSE_ASYM) &&
1120                          (mii_nway_lp_ability_reg & LPA_PAUSE_CAP) &&
1121                          (mii_nway_lp_ability_reg & LPA_PAUSE_ASYM)) {
1122                         hw->fc.current_mode = e1000_fc_tx_pause;
1123                         e_dbg("Flow Control = Tx PAUSE frames only.\n");
1124                 }
1125                 /* For transmitting PAUSE frames ONLY.
1126                  *
1127                  *   LOCAL DEVICE  |   LINK PARTNER
1128                  * PAUSE | ASM_DIR | PAUSE | ASM_DIR | Result
1129                  *-------|---------|-------|---------|--------------------
1130                  *   1   |    1    |   0   |    1    | e1000_fc_rx_pause
1131                  */
1132                 else if ((mii_nway_adv_reg & ADVERTISE_PAUSE_CAP) &&
1133                          (mii_nway_adv_reg & ADVERTISE_PAUSE_ASYM) &&
1134                          !(mii_nway_lp_ability_reg & LPA_PAUSE_CAP) &&
1135                          (mii_nway_lp_ability_reg & LPA_PAUSE_ASYM)) {
1136                         hw->fc.current_mode = e1000_fc_rx_pause;
1137                         e_dbg("Flow Control = Rx PAUSE frames only.\n");
1138                 } else {
1139                         /* Per the IEEE spec, at this point flow control
1140                          * should be disabled.
1141                          */
1142                         hw->fc.current_mode = e1000_fc_none;
1143                         e_dbg("Flow Control = NONE.\n");
1144                 }
1145 
1146                 /* Now we need to do one last check...  If we auto-
1147                  * negotiated to HALF DUPLEX, flow control should not be
1148                  * enabled per IEEE 802.3 spec.
1149                  */
1150                 ret_val = mac->ops.get_link_up_info(hw, &speed, &duplex);
1151                 if (ret_val) {
1152                         e_dbg("Error getting link speed and duplex\n");
1153                         return ret_val;
1154                 }
1155 
1156                 if (duplex == HALF_DUPLEX)
1157                         hw->fc.current_mode = e1000_fc_none;
1158 
1159                 /* Now we call a subroutine to actually force the MAC
1160                  * controller to use the correct flow control settings.
1161                  */
1162                 ret_val = e1000e_force_mac_fc(hw);
1163                 if (ret_val) {
1164                         e_dbg("Error forcing flow control settings\n");
1165                         return ret_val;
1166                 }
1167         }
1168 
1169         /* Check for the case where we have SerDes media and auto-neg is
1170          * enabled.  In this case, we need to check and see if Auto-Neg
1171          * has completed, and if so, how the PHY and link partner has
1172          * flow control configured.
1173          */
1174         if ((hw->phy.media_type == e1000_media_type_internal_serdes) &&
1175             mac->autoneg) {
1176                 /* Read the PCS_LSTS and check to see if AutoNeg
1177                  * has completed.
1178                  */
1179                 pcs_status_reg = er32(PCS_LSTAT);
1180 
1181                 if (!(pcs_status_reg & E1000_PCS_LSTS_AN_COMPLETE)) {
1182                         e_dbg("PCS Auto Neg has not completed.\n");
1183                         return ret_val;
1184                 }
1185 
1186                 /* The AutoNeg process has completed, so we now need to
1187                  * read both the Auto Negotiation Advertisement
1188                  * Register (PCS_ANADV) and the Auto_Negotiation Base
1189                  * Page Ability Register (PCS_LPAB) to determine how
1190                  * flow control was negotiated.
1191                  */
1192                 pcs_adv_reg = er32(PCS_ANADV);
1193                 pcs_lp_ability_reg = er32(PCS_LPAB);
1194 
1195                 /* Two bits in the Auto Negotiation Advertisement Register
1196                  * (PCS_ANADV) and two bits in the Auto Negotiation Base
1197                  * Page Ability Register (PCS_LPAB) determine flow control
1198                  * for both the PHY and the link partner.  The following
1199                  * table, taken out of the IEEE 802.3ab/D6.0 dated March 25,
1200                  * 1999, describes these PAUSE resolution bits and how flow
1201                  * control is determined based upon these settings.
1202                  * NOTE:  DC = Don't Care
1203                  *
1204                  *   LOCAL DEVICE  |   LINK PARTNER
1205                  * PAUSE | ASM_DIR | PAUSE | ASM_DIR | NIC Resolution
1206                  *-------|---------|-------|---------|--------------------
1207                  *   0   |    0    |  DC   |   DC    | e1000_fc_none
1208                  *   0   |    1    |   0   |   DC    | e1000_fc_none
1209                  *   0   |    1    |   1   |    0    | e1000_fc_none
1210                  *   0   |    1    |   1   |    1    | e1000_fc_tx_pause
1211                  *   1   |    0    |   0   |   DC    | e1000_fc_none
1212                  *   1   |   DC    |   1   |   DC    | e1000_fc_full
1213                  *   1   |    1    |   0   |    0    | e1000_fc_none
1214                  *   1   |    1    |   0   |    1    | e1000_fc_rx_pause
1215                  *
1216                  * Are both PAUSE bits set to 1?  If so, this implies
1217                  * Symmetric Flow Control is enabled at both ends.  The
1218                  * ASM_DIR bits are irrelevant per the spec.
1219                  *
1220                  * For Symmetric Flow Control:
1221                  *
1222                  *   LOCAL DEVICE  |   LINK PARTNER
1223                  * PAUSE | ASM_DIR | PAUSE | ASM_DIR | Result
1224                  *-------|---------|-------|---------|--------------------
1225                  *   1   |   DC    |   1   |   DC    | e1000_fc_full
1226                  *
1227                  */
1228                 if ((pcs_adv_reg & E1000_TXCW_PAUSE) &&
1229                     (pcs_lp_ability_reg & E1000_TXCW_PAUSE)) {
1230                         /* Now we need to check if the user selected Rx ONLY
1231                          * of pause frames.  In this case, we had to advertise
1232                          * FULL flow control because we could not advertise Rx
1233                          * ONLY. Hence, we must now check to see if we need to
1234                          * turn OFF the TRANSMISSION of PAUSE frames.
1235                          */
1236                         if (hw->fc.requested_mode == e1000_fc_full) {
1237                                 hw->fc.current_mode = e1000_fc_full;
1238                                 e_dbg("Flow Control = FULL.\n");
1239                         } else {
1240                                 hw->fc.current_mode = e1000_fc_rx_pause;
1241                                 e_dbg("Flow Control = Rx PAUSE frames only.\n");
1242                         }
1243                 }
1244                 /* For receiving PAUSE frames ONLY.
1245                  *
1246                  *   LOCAL DEVICE  |   LINK PARTNER
1247                  * PAUSE | ASM_DIR | PAUSE | ASM_DIR | Result
1248                  *-------|---------|-------|---------|--------------------
1249                  *   0   |    1    |   1   |    1    | e1000_fc_tx_pause
1250                  */
1251                 else if (!(pcs_adv_reg & E1000_TXCW_PAUSE) &&
1252                          (pcs_adv_reg & E1000_TXCW_ASM_DIR) &&
1253                          (pcs_lp_ability_reg & E1000_TXCW_PAUSE) &&
1254                          (pcs_lp_ability_reg & E1000_TXCW_ASM_DIR)) {
1255                         hw->fc.current_mode = e1000_fc_tx_pause;
1256                         e_dbg("Flow Control = Tx PAUSE frames only.\n");
1257                 }
1258                 /* For transmitting PAUSE frames ONLY.
1259                  *
1260                  *   LOCAL DEVICE  |   LINK PARTNER
1261                  * PAUSE | ASM_DIR | PAUSE | ASM_DIR | Result
1262                  *-------|---------|-------|---------|--------------------
1263                  *   1   |    1    |   0   |    1    | e1000_fc_rx_pause
1264                  */
1265                 else if ((pcs_adv_reg & E1000_TXCW_PAUSE) &&
1266                          (pcs_adv_reg & E1000_TXCW_ASM_DIR) &&
1267                          !(pcs_lp_ability_reg & E1000_TXCW_PAUSE) &&
1268                          (pcs_lp_ability_reg & E1000_TXCW_ASM_DIR)) {
1269                         hw->fc.current_mode = e1000_fc_rx_pause;
1270                         e_dbg("Flow Control = Rx PAUSE frames only.\n");
1271                 } else {
1272                         /* Per the IEEE spec, at this point flow control
1273                          * should be disabled.
1274                          */
1275                         hw->fc.current_mode = e1000_fc_none;
1276                         e_dbg("Flow Control = NONE.\n");
1277                 }
1278 
1279                 /* Now we call a subroutine to actually force the MAC
1280                  * controller to use the correct flow control settings.
1281                  */
1282                 pcs_ctrl_reg = er32(PCS_LCTL);
1283                 pcs_ctrl_reg |= E1000_PCS_LCTL_FORCE_FCTRL;
1284                 ew32(PCS_LCTL, pcs_ctrl_reg);
1285 
1286                 ret_val = e1000e_force_mac_fc(hw);
1287                 if (ret_val) {
1288                         e_dbg("Error forcing flow control settings\n");
1289                         return ret_val;
1290                 }
1291         }
1292 
1293         return 0;
1294 }
1295 
1296 /**
1297  *  e1000e_get_speed_and_duplex_copper - Retrieve current speed/duplex
1298  *  @hw: pointer to the HW structure
1299  *  @speed: stores the current speed
1300  *  @duplex: stores the current duplex
1301  *
1302  *  Read the status register for the current speed/duplex and store the current
1303  *  speed and duplex for copper connections.
1304  **/
1305 s32 e1000e_get_speed_and_duplex_copper(struct e1000_hw *hw, u16 *speed,
1306                                        u16 *duplex)
1307 {
1308         u32 status;
1309 
1310         status = er32(STATUS);
1311         if (status & E1000_STATUS_SPEED_1000)
1312                 *speed = SPEED_1000;
1313         else if (status & E1000_STATUS_SPEED_100)
1314                 *speed = SPEED_100;
1315         else
1316                 *speed = SPEED_10;
1317 
1318         if (status & E1000_STATUS_FD)
1319                 *duplex = FULL_DUPLEX;
1320         else
1321                 *duplex = HALF_DUPLEX;
1322 
1323         e_dbg("%u Mbps, %s Duplex\n",
1324               *speed == SPEED_1000 ? 1000 : *speed == SPEED_100 ? 100 : 10,
1325               *duplex == FULL_DUPLEX ? "Full" : "Half");
1326 
1327         return 0;
1328 }
1329 
1330 /**
1331  *  e1000e_get_speed_and_duplex_fiber_serdes - Retrieve current speed/duplex
1332  *  @hw: pointer to the HW structure
1333  *  @speed: stores the current speed
1334  *  @duplex: stores the current duplex
1335  *
1336  *  Sets the speed and duplex to gigabit full duplex (the only possible option)
1337  *  for fiber/serdes links.
1338  **/
1339 s32 e1000e_get_speed_and_duplex_fiber_serdes(struct e1000_hw __always_unused
1340                                              *hw, u16 *speed, u16 *duplex)
1341 {
1342         *speed = SPEED_1000;
1343         *duplex = FULL_DUPLEX;
1344 
1345         return 0;
1346 }
1347 
1348 /**
1349  *  e1000e_get_hw_semaphore - Acquire hardware semaphore
1350  *  @hw: pointer to the HW structure
1351  *
1352  *  Acquire the HW semaphore to access the PHY or NVM
1353  **/
1354 s32 e1000e_get_hw_semaphore(struct e1000_hw *hw)
1355 {
1356         u32 swsm;
1357         s32 timeout = hw->nvm.word_size + 1;
1358         s32 i = 0;
1359 
1360         /* Get the SW semaphore */
1361         while (i < timeout) {
1362                 swsm = er32(SWSM);
1363                 if (!(swsm & E1000_SWSM_SMBI))
1364                         break;
1365 
1366                 usleep_range(50, 100);
1367                 i++;
1368         }
1369 
1370         if (i == timeout) {
1371                 e_dbg("Driver can't access device - SMBI bit is set.\n");
1372                 return -E1000_ERR_NVM;
1373         }
1374 
1375         /* Get the FW semaphore. */
1376         for (i = 0; i < timeout; i++) {
1377                 swsm = er32(SWSM);
1378                 ew32(SWSM, swsm | E1000_SWSM_SWESMBI);
1379 
1380                 /* Semaphore acquired if bit latched */
1381                 if (er32(SWSM) & E1000_SWSM_SWESMBI)
1382                         break;
1383 
1384                 usleep_range(50, 100);
1385         }
1386 
1387         if (i == timeout) {
1388                 /* Release semaphores */
1389                 e1000e_put_hw_semaphore(hw);
1390                 e_dbg("Driver can't access the NVM\n");
1391                 return -E1000_ERR_NVM;
1392         }
1393 
1394         return 0;
1395 }
1396 
1397 /**
1398  *  e1000e_put_hw_semaphore - Release hardware semaphore
1399  *  @hw: pointer to the HW structure
1400  *
1401  *  Release hardware semaphore used to access the PHY or NVM
1402  **/
1403 void e1000e_put_hw_semaphore(struct e1000_hw *hw)
1404 {
1405         u32 swsm;
1406 
1407         swsm = er32(SWSM);
1408         swsm &= ~(E1000_SWSM_SMBI | E1000_SWSM_SWESMBI);
1409         ew32(SWSM, swsm);
1410 }
1411 
1412 /**
1413  *  e1000e_get_auto_rd_done - Check for auto read completion
1414  *  @hw: pointer to the HW structure
1415  *
1416  *  Check EEPROM for Auto Read done bit.
1417  **/
1418 s32 e1000e_get_auto_rd_done(struct e1000_hw *hw)
1419 {
1420         s32 i = 0;
1421 
1422         while (i < AUTO_READ_DONE_TIMEOUT) {
1423                 if (er32(EECD) & E1000_EECD_AUTO_RD)
1424                         break;
1425                 usleep_range(1000, 2000);
1426                 i++;
1427         }
1428 
1429         if (i == AUTO_READ_DONE_TIMEOUT) {
1430                 e_dbg("Auto read by HW from NVM has not completed.\n");
1431                 return -E1000_ERR_RESET;
1432         }
1433 
1434         return 0;
1435 }
1436 
1437 /**
1438  *  e1000e_valid_led_default - Verify a valid default LED config
1439  *  @hw: pointer to the HW structure
1440  *  @data: pointer to the NVM (EEPROM)
1441  *
1442  *  Read the EEPROM for the current default LED configuration.  If the
1443  *  LED configuration is not valid, set to a valid LED configuration.
1444  **/
1445 s32 e1000e_valid_led_default(struct e1000_hw *hw, u16 *data)
1446 {
1447         s32 ret_val;
1448 
1449         ret_val = e1000_read_nvm(hw, NVM_ID_LED_SETTINGS, 1, data);
1450         if (ret_val) {
1451                 e_dbg("NVM Read Error\n");
1452                 return ret_val;
1453         }
1454 
1455         if (*data == ID_LED_RESERVED_0000 || *data == ID_LED_RESERVED_FFFF)
1456                 *data = ID_LED_DEFAULT;
1457 
1458         return 0;
1459 }
1460 
1461 /**
1462  *  e1000e_id_led_init_generic -
1463  *  @hw: pointer to the HW structure
1464  *
1465  **/
1466 s32 e1000e_id_led_init_generic(struct e1000_hw *hw)
1467 {
1468         struct e1000_mac_info *mac = &hw->mac;
1469         s32 ret_val;
1470         const u32 ledctl_mask = 0x000000FF;
1471         const u32 ledctl_on = E1000_LEDCTL_MODE_LED_ON;
1472         const u32 ledctl_off = E1000_LEDCTL_MODE_LED_OFF;
1473         u16 data, i, temp;
1474         const u16 led_mask = 0x0F;
1475 
1476         ret_val = hw->nvm.ops.valid_led_default(hw, &data);
1477         if (ret_val)
1478                 return ret_val;
1479 
1480         mac->ledctl_default = er32(LEDCTL);
1481         mac->ledctl_mode1 = mac->ledctl_default;
1482         mac->ledctl_mode2 = mac->ledctl_default;
1483 
1484         for (i = 0; i < 4; i++) {
1485                 temp = (data >> (i << 2)) & led_mask;
1486                 switch (temp) {
1487                 case ID_LED_ON1_DEF2:
1488                 case ID_LED_ON1_ON2:
1489                 case ID_LED_ON1_OFF2:
1490                         mac->ledctl_mode1 &= ~(ledctl_mask << (i << 3));
1491                         mac->ledctl_mode1 |= ledctl_on << (i << 3);
1492                         break;
1493                 case ID_LED_OFF1_DEF2:
1494                 case ID_LED_OFF1_ON2:
1495                 case ID_LED_OFF1_OFF2:
1496                         mac->ledctl_mode1 &= ~(ledctl_mask << (i << 3));
1497                         mac->ledctl_mode1 |= ledctl_off << (i << 3);
1498                         break;
1499                 default:
1500                         /* Do nothing */
1501                         break;
1502                 }
1503                 switch (temp) {
1504                 case ID_LED_DEF1_ON2:
1505                 case ID_LED_ON1_ON2:
1506                 case ID_LED_OFF1_ON2:
1507                         mac->ledctl_mode2 &= ~(ledctl_mask << (i << 3));
1508                         mac->ledctl_mode2 |= ledctl_on << (i << 3);
1509                         break;
1510                 case ID_LED_DEF1_OFF2:
1511                 case ID_LED_ON1_OFF2:
1512                 case ID_LED_OFF1_OFF2:
1513                         mac->ledctl_mode2 &= ~(ledctl_mask << (i << 3));
1514                         mac->ledctl_mode2 |= ledctl_off << (i << 3);
1515                         break;
1516                 default:
1517                         /* Do nothing */
1518                         break;
1519                 }
1520         }
1521 
1522         return 0;
1523 }
1524 
1525 /**
1526  *  e1000e_setup_led_generic - Configures SW controllable LED
1527  *  @hw: pointer to the HW structure
1528  *
1529  *  This prepares the SW controllable LED for use and saves the current state
1530  *  of the LED so it can be later restored.
1531  **/
1532 s32 e1000e_setup_led_generic(struct e1000_hw *hw)
1533 {
1534         u32 ledctl;
1535 
1536         if (hw->mac.ops.setup_led != e1000e_setup_led_generic)
1537                 return -E1000_ERR_CONFIG;
1538 
1539         if (hw->phy.media_type == e1000_media_type_fiber) {
1540                 ledctl = er32(LEDCTL);
1541                 hw->mac.ledctl_default = ledctl;
1542                 /* Turn off LED0 */
1543                 ledctl &= ~(E1000_LEDCTL_LED0_IVRT | E1000_LEDCTL_LED0_BLINK |
1544                             E1000_LEDCTL_LED0_MODE_MASK);
1545                 ledctl |= (E1000_LEDCTL_MODE_LED_OFF <<
1546                            E1000_LEDCTL_LED0_MODE_SHIFT);
1547                 ew32(LEDCTL, ledctl);
1548         } else if (hw->phy.media_type == e1000_media_type_copper) {
1549                 ew32(LEDCTL, hw->mac.ledctl_mode1);
1550         }
1551 
1552         return 0;
1553 }
1554 
1555 /**
1556  *  e1000e_cleanup_led_generic - Set LED config to default operation
1557  *  @hw: pointer to the HW structure
1558  *
1559  *  Remove the current LED configuration and set the LED configuration
1560  *  to the default value, saved from the EEPROM.
1561  **/
1562 s32 e1000e_cleanup_led_generic(struct e1000_hw *hw)
1563 {
1564         ew32(LEDCTL, hw->mac.ledctl_default);
1565         return 0;
1566 }
1567 
1568 /**
1569  *  e1000e_blink_led_generic - Blink LED
1570  *  @hw: pointer to the HW structure
1571  *
1572  *  Blink the LEDs which are set to be on.
1573  **/
1574 s32 e1000e_blink_led_generic(struct e1000_hw *hw)
1575 {
1576         u32 ledctl_blink = 0;
1577         u32 i;
1578 
1579         if (hw->phy.media_type == e1000_media_type_fiber) {
1580                 /* always blink LED0 for PCI-E fiber */
1581                 ledctl_blink = E1000_LEDCTL_LED0_BLINK |
1582                     (E1000_LEDCTL_MODE_LED_ON << E1000_LEDCTL_LED0_MODE_SHIFT);
1583         } else {
1584                 /* Set the blink bit for each LED that's "on" (0x0E)
1585                  * (or "off" if inverted) in ledctl_mode2.  The blink
1586                  * logic in hardware only works when mode is set to "on"
1587                  * so it must be changed accordingly when the mode is
1588                  * "off" and inverted.
1589                  */
1590                 ledctl_blink = hw->mac.ledctl_mode2;
1591                 for (i = 0; i < 32; i += 8) {
1592                         u32 mode = (hw->mac.ledctl_mode2 >> i) &
1593                             E1000_LEDCTL_LED0_MODE_MASK;
1594                         u32 led_default = hw->mac.ledctl_default >> i;
1595 
1596                         if ((!(led_default & E1000_LEDCTL_LED0_IVRT) &&
1597                              (mode == E1000_LEDCTL_MODE_LED_ON)) ||
1598                             ((led_default & E1000_LEDCTL_LED0_IVRT) &&
1599                              (mode == E1000_LEDCTL_MODE_LED_OFF))) {
1600                                 ledctl_blink &=
1601                                     ~(E1000_LEDCTL_LED0_MODE_MASK << i);
1602                                 ledctl_blink |= (E1000_LEDCTL_LED0_BLINK |
1603                                                  E1000_LEDCTL_MODE_LED_ON) << i;
1604                         }
1605                 }
1606         }
1607 
1608         ew32(LEDCTL, ledctl_blink);
1609 
1610         return 0;
1611 }
1612 
1613 /**
1614  *  e1000e_led_on_generic - Turn LED on
1615  *  @hw: pointer to the HW structure
1616  *
1617  *  Turn LED on.
1618  **/
1619 s32 e1000e_led_on_generic(struct e1000_hw *hw)
1620 {
1621         u32 ctrl;
1622 
1623         switch (hw->phy.media_type) {
1624         case e1000_media_type_fiber:
1625                 ctrl = er32(CTRL);
1626                 ctrl &= ~E1000_CTRL_SWDPIN0;
1627                 ctrl |= E1000_CTRL_SWDPIO0;
1628                 ew32(CTRL, ctrl);
1629                 break;
1630         case e1000_media_type_copper:
1631                 ew32(LEDCTL, hw->mac.ledctl_mode2);
1632                 break;
1633         default:
1634                 break;
1635         }
1636 
1637         return 0;
1638 }
1639 
1640 /**
1641  *  e1000e_led_off_generic - Turn LED off
1642  *  @hw: pointer to the HW structure
1643  *
1644  *  Turn LED off.
1645  **/
1646 s32 e1000e_led_off_generic(struct e1000_hw *hw)
1647 {
1648         u32 ctrl;
1649 
1650         switch (hw->phy.media_type) {
1651         case e1000_media_type_fiber:
1652                 ctrl = er32(CTRL);
1653                 ctrl |= E1000_CTRL_SWDPIN0;
1654                 ctrl |= E1000_CTRL_SWDPIO0;
1655                 ew32(CTRL, ctrl);
1656                 break;
1657         case e1000_media_type_copper:
1658                 ew32(LEDCTL, hw->mac.ledctl_mode1);
1659                 break;
1660         default:
1661                 break;
1662         }
1663 
1664         return 0;
1665 }
1666 
1667 /**
1668  *  e1000e_set_pcie_no_snoop - Set PCI-express capabilities
1669  *  @hw: pointer to the HW structure
1670  *  @no_snoop: bitmap of snoop events
1671  *
1672  *  Set the PCI-express register to snoop for events enabled in 'no_snoop'.
1673  **/
1674 void e1000e_set_pcie_no_snoop(struct e1000_hw *hw, u32 no_snoop)
1675 {
1676         u32 gcr;
1677 
1678         if (no_snoop) {
1679                 gcr = er32(GCR);
1680                 gcr &= ~(PCIE_NO_SNOOP_ALL);
1681                 gcr |= no_snoop;
1682                 ew32(GCR, gcr);
1683         }
1684 }
1685 
1686 /**
1687  *  e1000e_disable_pcie_master - Disables PCI-express master access
1688  *  @hw: pointer to the HW structure
1689  *
1690  *  Returns 0 if successful, else returns -10
1691  *  (-E1000_ERR_MASTER_REQUESTS_PENDING) if master disable bit has not caused
1692  *  the master requests to be disabled.
1693  *
1694  *  Disables PCI-Express master access and verifies there are no pending
1695  *  requests.
1696  **/
1697 s32 e1000e_disable_pcie_master(struct e1000_hw *hw)
1698 {
1699         u32 ctrl;
1700         s32 timeout = MASTER_DISABLE_TIMEOUT;
1701 
1702         ctrl = er32(CTRL);
1703         ctrl |= E1000_CTRL_GIO_MASTER_DISABLE;
1704         ew32(CTRL, ctrl);
1705 
1706         while (timeout) {
1707                 if (!(er32(STATUS) & E1000_STATUS_GIO_MASTER_ENABLE))
1708                         break;
1709                 usleep_range(100, 200);
1710                 timeout--;
1711         }
1712 
1713         if (!timeout) {
1714                 e_dbg("Master requests are pending.\n");
1715                 return -E1000_ERR_MASTER_REQUESTS_PENDING;
1716         }
1717 
1718         return 0;
1719 }
1720 
1721 /**
1722  *  e1000e_reset_adaptive - Reset Adaptive Interframe Spacing
1723  *  @hw: pointer to the HW structure
1724  *
1725  *  Reset the Adaptive Interframe Spacing throttle to default values.
1726  **/
1727 void e1000e_reset_adaptive(struct e1000_hw *hw)
1728 {
1729         struct e1000_mac_info *mac = &hw->mac;
1730 
1731         if (!mac->adaptive_ifs) {
1732                 e_dbg("Not in Adaptive IFS mode!\n");
1733                 return;
1734         }
1735 
1736         mac->current_ifs_val = 0;
1737         mac->ifs_min_val = IFS_MIN;
1738         mac->ifs_max_val = IFS_MAX;
1739         mac->ifs_step_size = IFS_STEP;
1740         mac->ifs_ratio = IFS_RATIO;
1741 
1742         mac->in_ifs_mode = false;
1743         ew32(AIT, 0);
1744 }
1745 
1746 /**
1747  *  e1000e_update_adaptive - Update Adaptive Interframe Spacing
1748  *  @hw: pointer to the HW structure
1749  *
1750  *  Update the Adaptive Interframe Spacing Throttle value based on the
1751  *  time between transmitted packets and time between collisions.
1752  **/
1753 void e1000e_update_adaptive(struct e1000_hw *hw)
1754 {
1755         struct e1000_mac_info *mac = &hw->mac;
1756 
1757         if (!mac->adaptive_ifs) {
1758                 e_dbg("Not in Adaptive IFS mode!\n");
1759                 return;
1760         }
1761 
1762         if ((mac->collision_delta * mac->ifs_ratio) > mac->tx_packet_delta) {
1763                 if (mac->tx_packet_delta > MIN_NUM_XMITS) {
1764                         mac->in_ifs_mode = true;
1765                         if (mac->current_ifs_val < mac->ifs_max_val) {
1766                                 if (!mac->current_ifs_val)
1767                                         mac->current_ifs_val = mac->ifs_min_val;
1768                                 else
1769                                         mac->current_ifs_val +=
1770                                             mac->ifs_step_size;
1771                                 ew32(AIT, mac->current_ifs_val);
1772                         }
1773                 }
1774         } else {
1775                 if (mac->in_ifs_mode &&
1776                     (mac->tx_packet_delta <= MIN_NUM_XMITS)) {
1777                         mac->current_ifs_val = 0;
1778                         mac->in_ifs_mode = false;
1779                         ew32(AIT, 0);
1780                 }
1781         }
1782 }

/* [<][>][^][v][top][bottom][index][help] */