| /******************************************************************************* |
| |
| Intel 10 Gigabit PCI Express Linux driver |
| Copyright(c) 1999 - 2009 Intel Corporation. |
| |
| This program is free software; you can redistribute it and/or modify it |
| under the terms and conditions of the GNU General Public License, |
| version 2, as published by the Free Software Foundation. |
| |
| This program is distributed in the hope it will be useful, but WITHOUT |
| ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or |
| FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for |
| more details. |
| |
| You should have received a copy of the GNU General Public License along with |
| this program; if not, write to the Free Software Foundation, Inc., |
| 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA. |
| |
| The full GNU General Public License is included in this distribution in |
| the file called "COPYING". |
| |
| Contact Information: |
| e1000-devel Mailing List <e1000-devel@lists.sourceforge.net> |
| Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 |
| |
| *******************************************************************************/ |
| |
| #include <linux/pci.h> |
| #include <linux/delay.h> |
| #include <linux/sched.h> |
| |
| #include "ixgbe.h" |
| #include "ixgbe_phy.h" |
| |
| #define IXGBE_82599_MAX_TX_QUEUES 128 |
| #define IXGBE_82599_MAX_RX_QUEUES 128 |
| #define IXGBE_82599_RAR_ENTRIES 128 |
| #define IXGBE_82599_MC_TBL_SIZE 128 |
| #define IXGBE_82599_VFT_TBL_SIZE 128 |
| |
| s32 ixgbe_setup_mac_link_multispeed_fiber(struct ixgbe_hw *hw, |
| ixgbe_link_speed speed, |
| bool autoneg, |
| bool autoneg_wait_to_complete); |
| static s32 ixgbe_setup_mac_link_smartspeed(struct ixgbe_hw *hw, |
| ixgbe_link_speed speed, |
| bool autoneg, |
| bool autoneg_wait_to_complete); |
| s32 ixgbe_start_mac_link_82599(struct ixgbe_hw *hw, |
| bool autoneg_wait_to_complete); |
| s32 ixgbe_setup_mac_link_82599(struct ixgbe_hw *hw, |
| ixgbe_link_speed speed, |
| bool autoneg, |
| bool autoneg_wait_to_complete); |
| static s32 ixgbe_get_copper_link_capabilities_82599(struct ixgbe_hw *hw, |
| ixgbe_link_speed *speed, |
| bool *autoneg); |
| static s32 ixgbe_setup_copper_link_82599(struct ixgbe_hw *hw, |
| ixgbe_link_speed speed, |
| bool autoneg, |
| bool autoneg_wait_to_complete); |
| static s32 ixgbe_verify_fw_version_82599(struct ixgbe_hw *hw); |
| |
| static void ixgbe_init_mac_link_ops_82599(struct ixgbe_hw *hw) |
| { |
| struct ixgbe_mac_info *mac = &hw->mac; |
| if (hw->phy.multispeed_fiber) { |
| /* Set up dual speed SFP+ support */ |
| mac->ops.setup_link = &ixgbe_setup_mac_link_multispeed_fiber; |
| } else { |
| if ((mac->ops.get_media_type(hw) == |
| ixgbe_media_type_backplane) && |
| (hw->phy.smart_speed == ixgbe_smart_speed_auto || |
| hw->phy.smart_speed == ixgbe_smart_speed_on)) |
| mac->ops.setup_link = &ixgbe_setup_mac_link_smartspeed; |
| else |
| mac->ops.setup_link = &ixgbe_setup_mac_link_82599; |
| } |
| } |
| |
| static s32 ixgbe_setup_sfp_modules_82599(struct ixgbe_hw *hw) |
| { |
| s32 ret_val = 0; |
| u16 list_offset, data_offset, data_value; |
| |
| if (hw->phy.sfp_type != ixgbe_sfp_type_unknown) { |
| ixgbe_init_mac_link_ops_82599(hw); |
| |
| hw->phy.ops.reset = NULL; |
| |
| ret_val = ixgbe_get_sfp_init_sequence_offsets(hw, &list_offset, |
| &data_offset); |
| |
| if (ret_val != 0) |
| goto setup_sfp_out; |
| |
| /* PHY config will finish before releasing the semaphore */ |
| ret_val = ixgbe_acquire_swfw_sync(hw, IXGBE_GSSR_MAC_CSR_SM); |
| if (ret_val != 0) { |
| ret_val = IXGBE_ERR_SWFW_SYNC; |
| goto setup_sfp_out; |
| } |
| |
| hw->eeprom.ops.read(hw, ++data_offset, &data_value); |
| while (data_value != 0xffff) { |
| IXGBE_WRITE_REG(hw, IXGBE_CORECTL, data_value); |
| IXGBE_WRITE_FLUSH(hw); |
| hw->eeprom.ops.read(hw, ++data_offset, &data_value); |
| } |
| /* Now restart DSP by setting Restart_AN */ |
| IXGBE_WRITE_REG(hw, IXGBE_AUTOC, |
| (IXGBE_READ_REG(hw, IXGBE_AUTOC) | IXGBE_AUTOC_AN_RESTART)); |
| |
| /* Release the semaphore */ |
| ixgbe_release_swfw_sync(hw, IXGBE_GSSR_MAC_CSR_SM); |
| /* Delay obtaining semaphore again to allow FW access */ |
| msleep(hw->eeprom.semaphore_delay); |
| } |
| |
| setup_sfp_out: |
| return ret_val; |
| } |
| |
| /** |
| * ixgbe_get_pcie_msix_count_82599 - Gets MSI-X vector count |
| * @hw: pointer to hardware structure |
| * |
| * Read PCIe configuration space, and get the MSI-X vector count from |
| * the capabilities table. |
| **/ |
| static u32 ixgbe_get_pcie_msix_count_82599(struct ixgbe_hw *hw) |
| { |
| struct ixgbe_adapter *adapter = hw->back; |
| u16 msix_count; |
| pci_read_config_word(adapter->pdev, IXGBE_PCIE_MSIX_82599_CAPS, |
| &msix_count); |
| msix_count &= IXGBE_PCIE_MSIX_TBL_SZ_MASK; |
| |
| /* MSI-X count is zero-based in HW, so increment to give proper value */ |
| msix_count++; |
| |
| return msix_count; |
| } |
| |
| static s32 ixgbe_get_invariants_82599(struct ixgbe_hw *hw) |
| { |
| struct ixgbe_mac_info *mac = &hw->mac; |
| |
| ixgbe_init_mac_link_ops_82599(hw); |
| |
| mac->mcft_size = IXGBE_82599_MC_TBL_SIZE; |
| mac->vft_size = IXGBE_82599_VFT_TBL_SIZE; |
| mac->num_rar_entries = IXGBE_82599_RAR_ENTRIES; |
| mac->max_rx_queues = IXGBE_82599_MAX_RX_QUEUES; |
| mac->max_tx_queues = IXGBE_82599_MAX_TX_QUEUES; |
| mac->max_msix_vectors = ixgbe_get_pcie_msix_count_82599(hw); |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_init_phy_ops_82599 - PHY/SFP specific init |
| * @hw: pointer to hardware structure |
| * |
| * Initialize any function pointers that were not able to be |
| * set during get_invariants because the PHY/SFP type was |
| * not known. Perform the SFP init if necessary. |
| * |
| **/ |
| static s32 ixgbe_init_phy_ops_82599(struct ixgbe_hw *hw) |
| { |
| struct ixgbe_mac_info *mac = &hw->mac; |
| struct ixgbe_phy_info *phy = &hw->phy; |
| s32 ret_val = 0; |
| |
| /* Identify the PHY or SFP module */ |
| ret_val = phy->ops.identify(hw); |
| |
| /* Setup function pointers based on detected SFP module and speeds */ |
| ixgbe_init_mac_link_ops_82599(hw); |
| |
| /* If copper media, overwrite with copper function pointers */ |
| if (mac->ops.get_media_type(hw) == ixgbe_media_type_copper) { |
| mac->ops.setup_link = &ixgbe_setup_copper_link_82599; |
| mac->ops.get_link_capabilities = |
| &ixgbe_get_copper_link_capabilities_82599; |
| } |
| |
| /* Set necessary function pointers based on phy type */ |
| switch (hw->phy.type) { |
| case ixgbe_phy_tn: |
| phy->ops.check_link = &ixgbe_check_phy_link_tnx; |
| phy->ops.get_firmware_version = |
| &ixgbe_get_phy_firmware_version_tnx; |
| break; |
| default: |
| break; |
| } |
| |
| return ret_val; |
| } |
| |
| /** |
| * ixgbe_get_link_capabilities_82599 - Determines link capabilities |
| * @hw: pointer to hardware structure |
| * @speed: pointer to link speed |
| * @negotiation: true when autoneg or autotry is enabled |
| * |
| * Determines the link capabilities by reading the AUTOC register. |
| **/ |
| static s32 ixgbe_get_link_capabilities_82599(struct ixgbe_hw *hw, |
| ixgbe_link_speed *speed, |
| bool *negotiation) |
| { |
| s32 status = 0; |
| u32 autoc = 0; |
| |
| /* |
| * Determine link capabilities based on the stored value of AUTOC, |
| * which represents EEPROM defaults. If AUTOC value has not been |
| * stored, use the current register value. |
| */ |
| if (hw->mac.orig_link_settings_stored) |
| autoc = hw->mac.orig_autoc; |
| else |
| autoc = IXGBE_READ_REG(hw, IXGBE_AUTOC); |
| |
| switch (autoc & IXGBE_AUTOC_LMS_MASK) { |
| case IXGBE_AUTOC_LMS_1G_LINK_NO_AN: |
| *speed = IXGBE_LINK_SPEED_1GB_FULL; |
| *negotiation = false; |
| break; |
| |
| case IXGBE_AUTOC_LMS_10G_LINK_NO_AN: |
| *speed = IXGBE_LINK_SPEED_10GB_FULL; |
| *negotiation = false; |
| break; |
| |
| case IXGBE_AUTOC_LMS_1G_AN: |
| *speed = IXGBE_LINK_SPEED_1GB_FULL; |
| *negotiation = true; |
| break; |
| |
| case IXGBE_AUTOC_LMS_10G_SERIAL: |
| *speed = IXGBE_LINK_SPEED_10GB_FULL; |
| *negotiation = false; |
| break; |
| |
| case IXGBE_AUTOC_LMS_KX4_KX_KR: |
| case IXGBE_AUTOC_LMS_KX4_KX_KR_1G_AN: |
| *speed = IXGBE_LINK_SPEED_UNKNOWN; |
| if (autoc & IXGBE_AUTOC_KR_SUPP) |
| *speed |= IXGBE_LINK_SPEED_10GB_FULL; |
| if (autoc & IXGBE_AUTOC_KX4_SUPP) |
| *speed |= IXGBE_LINK_SPEED_10GB_FULL; |
| if (autoc & IXGBE_AUTOC_KX_SUPP) |
| *speed |= IXGBE_LINK_SPEED_1GB_FULL; |
| *negotiation = true; |
| break; |
| |
| case IXGBE_AUTOC_LMS_KX4_KX_KR_SGMII: |
| *speed = IXGBE_LINK_SPEED_100_FULL; |
| if (autoc & IXGBE_AUTOC_KR_SUPP) |
| *speed |= IXGBE_LINK_SPEED_10GB_FULL; |
| if (autoc & IXGBE_AUTOC_KX4_SUPP) |
| *speed |= IXGBE_LINK_SPEED_10GB_FULL; |
| if (autoc & IXGBE_AUTOC_KX_SUPP) |
| *speed |= IXGBE_LINK_SPEED_1GB_FULL; |
| *negotiation = true; |
| break; |
| |
| case IXGBE_AUTOC_LMS_SGMII_1G_100M: |
| *speed = IXGBE_LINK_SPEED_1GB_FULL | IXGBE_LINK_SPEED_100_FULL; |
| *negotiation = false; |
| break; |
| |
| default: |
| status = IXGBE_ERR_LINK_SETUP; |
| goto out; |
| break; |
| } |
| |
| if (hw->phy.multispeed_fiber) { |
| *speed |= IXGBE_LINK_SPEED_10GB_FULL | |
| IXGBE_LINK_SPEED_1GB_FULL; |
| *negotiation = true; |
| } |
| |
| out: |
| return status; |
| } |
| |
| /** |
| * ixgbe_get_copper_link_capabilities_82599 - Determines link capabilities |
| * @hw: pointer to hardware structure |
| * @speed: pointer to link speed |
| * @autoneg: boolean auto-negotiation value |
| * |
| * Determines the link capabilities by reading the AUTOC register. |
| **/ |
| static s32 ixgbe_get_copper_link_capabilities_82599(struct ixgbe_hw *hw, |
| ixgbe_link_speed *speed, |
| bool *autoneg) |
| { |
| s32 status = IXGBE_ERR_LINK_SETUP; |
| u16 speed_ability; |
| |
| *speed = 0; |
| *autoneg = true; |
| |
| status = hw->phy.ops.read_reg(hw, MDIO_SPEED, MDIO_MMD_PMAPMD, |
| &speed_ability); |
| |
| if (status == 0) { |
| if (speed_ability & MDIO_SPEED_10G) |
| *speed |= IXGBE_LINK_SPEED_10GB_FULL; |
| if (speed_ability & MDIO_PMA_SPEED_1000) |
| *speed |= IXGBE_LINK_SPEED_1GB_FULL; |
| } |
| |
| return status; |
| } |
| |
| /** |
| * ixgbe_get_media_type_82599 - Get media type |
| * @hw: pointer to hardware structure |
| * |
| * Returns the media type (fiber, copper, backplane) |
| **/ |
| static enum ixgbe_media_type ixgbe_get_media_type_82599(struct ixgbe_hw *hw) |
| { |
| enum ixgbe_media_type media_type; |
| |
| /* Detect if there is a copper PHY attached. */ |
| if (hw->phy.type == ixgbe_phy_cu_unknown || |
| hw->phy.type == ixgbe_phy_tn) { |
| media_type = ixgbe_media_type_copper; |
| goto out; |
| } |
| |
| switch (hw->device_id) { |
| case IXGBE_DEV_ID_82599_KX4: |
| case IXGBE_DEV_ID_82599_KX4_MEZZ: |
| case IXGBE_DEV_ID_82599_COMBO_BACKPLANE: |
| case IXGBE_DEV_ID_82599_XAUI_LOM: |
| /* Default device ID is mezzanine card KX/KX4 */ |
| media_type = ixgbe_media_type_backplane; |
| break; |
| case IXGBE_DEV_ID_82599_SFP: |
| case IXGBE_DEV_ID_82599_SFP_EM: |
| media_type = ixgbe_media_type_fiber; |
| break; |
| case IXGBE_DEV_ID_82599_CX4: |
| media_type = ixgbe_media_type_cx4; |
| break; |
| default: |
| media_type = ixgbe_media_type_unknown; |
| break; |
| } |
| out: |
| return media_type; |
| } |
| |
| /** |
| * ixgbe_start_mac_link_82599 - Setup MAC link settings |
| * @hw: pointer to hardware structure |
| * @autoneg_wait_to_complete: true when waiting for completion is needed |
| * |
| * Configures link settings based on values in the ixgbe_hw struct. |
| * Restarts the link. Performs autonegotiation if needed. |
| **/ |
| s32 ixgbe_start_mac_link_82599(struct ixgbe_hw *hw, |
| bool autoneg_wait_to_complete) |
| { |
| u32 autoc_reg; |
| u32 links_reg; |
| u32 i; |
| s32 status = 0; |
| |
| /* Restart link */ |
| autoc_reg = IXGBE_READ_REG(hw, IXGBE_AUTOC); |
| autoc_reg |= IXGBE_AUTOC_AN_RESTART; |
| IXGBE_WRITE_REG(hw, IXGBE_AUTOC, autoc_reg); |
| |
| /* Only poll for autoneg to complete if specified to do so */ |
| if (autoneg_wait_to_complete) { |
| if ((autoc_reg & IXGBE_AUTOC_LMS_MASK) == |
| IXGBE_AUTOC_LMS_KX4_KX_KR || |
| (autoc_reg & IXGBE_AUTOC_LMS_MASK) == |
| IXGBE_AUTOC_LMS_KX4_KX_KR_1G_AN || |
| (autoc_reg & IXGBE_AUTOC_LMS_MASK) == |
| IXGBE_AUTOC_LMS_KX4_KX_KR_SGMII) { |
| links_reg = 0; /* Just in case Autoneg time = 0 */ |
| for (i = 0; i < IXGBE_AUTO_NEG_TIME; i++) { |
| links_reg = IXGBE_READ_REG(hw, IXGBE_LINKS); |
| if (links_reg & IXGBE_LINKS_KX_AN_COMP) |
| break; |
| msleep(100); |
| } |
| if (!(links_reg & IXGBE_LINKS_KX_AN_COMP)) { |
| status = IXGBE_ERR_AUTONEG_NOT_COMPLETE; |
| hw_dbg(hw, "Autoneg did not complete.\n"); |
| } |
| } |
| } |
| |
| /* Add delay to filter out noises during initial link setup */ |
| msleep(50); |
| |
| return status; |
| } |
| |
| /** |
| * ixgbe_setup_mac_link_multispeed_fiber - Set MAC link speed |
| * @hw: pointer to hardware structure |
| * @speed: new link speed |
| * @autoneg: true if autonegotiation enabled |
| * @autoneg_wait_to_complete: true when waiting for completion is needed |
| * |
| * Set the link speed in the AUTOC register and restarts link. |
| **/ |
| s32 ixgbe_setup_mac_link_multispeed_fiber(struct ixgbe_hw *hw, |
| ixgbe_link_speed speed, |
| bool autoneg, |
| bool autoneg_wait_to_complete) |
| { |
| s32 status = 0; |
| ixgbe_link_speed phy_link_speed; |
| ixgbe_link_speed highest_link_speed = IXGBE_LINK_SPEED_UNKNOWN; |
| u32 speedcnt = 0; |
| u32 esdp_reg = IXGBE_READ_REG(hw, IXGBE_ESDP); |
| bool link_up = false; |
| bool negotiation; |
| int i; |
| |
| /* Mask off requested but non-supported speeds */ |
| hw->mac.ops.get_link_capabilities(hw, &phy_link_speed, &negotiation); |
| speed &= phy_link_speed; |
| |
| /* |
| * When the driver changes the link speeds that it can support, |
| * it sets autotry_restart to true to indicate that we need to |
| * initiate a new autotry session with the link partner. To do |
| * so, we set the speed then disable and re-enable the tx laser, to |
| * alert the link partner that it also needs to restart autotry on its |
| * end. This is consistent with true clause 37 autoneg, which also |
| * involves a loss of signal. |
| */ |
| |
| /* |
| * Try each speed one by one, highest priority first. We do this in |
| * software because 10gb fiber doesn't support speed autonegotiation. |
| */ |
| if (speed & IXGBE_LINK_SPEED_10GB_FULL) { |
| speedcnt++; |
| highest_link_speed = IXGBE_LINK_SPEED_10GB_FULL; |
| |
| /* If we already have link at this speed, just jump out */ |
| hw->mac.ops.check_link(hw, &phy_link_speed, &link_up, false); |
| |
| if ((phy_link_speed == IXGBE_LINK_SPEED_10GB_FULL) && link_up) |
| goto out; |
| |
| /* Set the module link speed */ |
| esdp_reg |= (IXGBE_ESDP_SDP5_DIR | IXGBE_ESDP_SDP5); |
| IXGBE_WRITE_REG(hw, IXGBE_ESDP, esdp_reg); |
| |
| /* Allow module to change analog characteristics (1G->10G) */ |
| msleep(40); |
| |
| status = ixgbe_setup_mac_link_82599(hw, |
| IXGBE_LINK_SPEED_10GB_FULL, |
| autoneg, |
| autoneg_wait_to_complete); |
| if (status != 0) |
| return status; |
| |
| /* Flap the tx laser if it has not already been done */ |
| if (hw->mac.autotry_restart) { |
| /* Disable tx laser; allow 100us to go dark per spec */ |
| esdp_reg |= IXGBE_ESDP_SDP3; |
| IXGBE_WRITE_REG(hw, IXGBE_ESDP, esdp_reg); |
| udelay(100); |
| |
| /* Enable tx laser; allow 2ms to light up per spec */ |
| esdp_reg &= ~IXGBE_ESDP_SDP3; |
| IXGBE_WRITE_REG(hw, IXGBE_ESDP, esdp_reg); |
| msleep(2); |
| |
| hw->mac.autotry_restart = false; |
| } |
| |
| /* |
| * Wait for the controller to acquire link. Per IEEE 802.3ap, |
| * Section 73.10.2, we may have to wait up to 500ms if KR is |
| * attempted. 82599 uses the same timing for 10g SFI. |
| */ |
| |
| for (i = 0; i < 5; i++) { |
| /* Wait for the link partner to also set speed */ |
| msleep(100); |
| |
| /* If we have link, just jump out */ |
| hw->mac.ops.check_link(hw, &phy_link_speed, |
| &link_up, false); |
| if (link_up) |
| goto out; |
| } |
| } |
| |
| if (speed & IXGBE_LINK_SPEED_1GB_FULL) { |
| speedcnt++; |
| if (highest_link_speed == IXGBE_LINK_SPEED_UNKNOWN) |
| highest_link_speed = IXGBE_LINK_SPEED_1GB_FULL; |
| |
| /* If we already have link at this speed, just jump out */ |
| hw->mac.ops.check_link(hw, &phy_link_speed, &link_up, false); |
| |
| if ((phy_link_speed == IXGBE_LINK_SPEED_1GB_FULL) && link_up) |
| goto out; |
| |
| /* Set the module link speed */ |
| esdp_reg &= ~IXGBE_ESDP_SDP5; |
| esdp_reg |= IXGBE_ESDP_SDP5_DIR; |
| IXGBE_WRITE_REG(hw, IXGBE_ESDP, esdp_reg); |
| |
| /* Allow module to change analog characteristics (10G->1G) */ |
| msleep(40); |
| |
| status = ixgbe_setup_mac_link_82599(hw, |
| IXGBE_LINK_SPEED_1GB_FULL, |
| autoneg, |
| autoneg_wait_to_complete); |
| if (status != 0) |
| return status; |
| |
| /* Flap the tx laser if it has not already been done */ |
| if (hw->mac.autotry_restart) { |
| /* Disable tx laser; allow 100us to go dark per spec */ |
| esdp_reg |= IXGBE_ESDP_SDP3; |
| IXGBE_WRITE_REG(hw, IXGBE_ESDP, esdp_reg); |
| udelay(100); |
| |
| /* Enable tx laser; allow 2ms to light up per spec */ |
| esdp_reg &= ~IXGBE_ESDP_SDP3; |
| IXGBE_WRITE_REG(hw, IXGBE_ESDP, esdp_reg); |
| msleep(2); |
| |
| hw->mac.autotry_restart = false; |
| } |
| |
| /* Wait for the link partner to also set speed */ |
| msleep(100); |
| |
| /* If we have link, just jump out */ |
| hw->mac.ops.check_link(hw, &phy_link_speed, &link_up, false); |
| if (link_up) |
| goto out; |
| } |
| |
| /* |
| * We didn't get link. Configure back to the highest speed we tried, |
| * (if there was more than one). We call ourselves back with just the |
| * single highest speed that the user requested. |
| */ |
| if (speedcnt > 1) |
| status = ixgbe_setup_mac_link_multispeed_fiber(hw, |
| highest_link_speed, |
| autoneg, |
| autoneg_wait_to_complete); |
| |
| out: |
| /* Set autoneg_advertised value based on input link speed */ |
| hw->phy.autoneg_advertised = 0; |
| |
| if (speed & IXGBE_LINK_SPEED_10GB_FULL) |
| hw->phy.autoneg_advertised |= IXGBE_LINK_SPEED_10GB_FULL; |
| |
| if (speed & IXGBE_LINK_SPEED_1GB_FULL) |
| hw->phy.autoneg_advertised |= IXGBE_LINK_SPEED_1GB_FULL; |
| |
| return status; |
| } |
| |
| /** |
| * ixgbe_setup_mac_link_smartspeed - Set MAC link speed using SmartSpeed |
| * @hw: pointer to hardware structure |
| * @speed: new link speed |
| * @autoneg: true if autonegotiation enabled |
| * @autoneg_wait_to_complete: true when waiting for completion is needed |
| * |
| * Implements the Intel SmartSpeed algorithm. |
| **/ |
| static s32 ixgbe_setup_mac_link_smartspeed(struct ixgbe_hw *hw, |
| ixgbe_link_speed speed, bool autoneg, |
| bool autoneg_wait_to_complete) |
| { |
| s32 status = 0; |
| ixgbe_link_speed link_speed; |
| s32 i, j; |
| bool link_up = false; |
| u32 autoc_reg = IXGBE_READ_REG(hw, IXGBE_AUTOC); |
| |
| hw_dbg(hw, "ixgbe_setup_mac_link_smartspeed.\n"); |
| |
| /* Set autoneg_advertised value based on input link speed */ |
| hw->phy.autoneg_advertised = 0; |
| |
| if (speed & IXGBE_LINK_SPEED_10GB_FULL) |
| hw->phy.autoneg_advertised |= IXGBE_LINK_SPEED_10GB_FULL; |
| |
| if (speed & IXGBE_LINK_SPEED_1GB_FULL) |
| hw->phy.autoneg_advertised |= IXGBE_LINK_SPEED_1GB_FULL; |
| |
| if (speed & IXGBE_LINK_SPEED_100_FULL) |
| hw->phy.autoneg_advertised |= IXGBE_LINK_SPEED_100_FULL; |
| |
| /* |
| * Implement Intel SmartSpeed algorithm. SmartSpeed will reduce the |
| * autoneg advertisement if link is unable to be established at the |
| * highest negotiated rate. This can sometimes happen due to integrity |
| * issues with the physical media connection. |
| */ |
| |
| /* First, try to get link with full advertisement */ |
| hw->phy.smart_speed_active = false; |
| for (j = 0; j < IXGBE_SMARTSPEED_MAX_RETRIES; j++) { |
| status = ixgbe_setup_mac_link_82599(hw, speed, autoneg, |
| autoneg_wait_to_complete); |
| if (status) |
| goto out; |
| |
| /* |
| * Wait for the controller to acquire link. Per IEEE 802.3ap, |
| * Section 73.10.2, we may have to wait up to 500ms if KR is |
| * attempted, or 200ms if KX/KX4/BX/BX4 is attempted, per |
| * Table 9 in the AN MAS. |
| */ |
| for (i = 0; i < 5; i++) { |
| mdelay(100); |
| |
| /* If we have link, just jump out */ |
| hw->mac.ops.check_link(hw, &link_speed, |
| &link_up, false); |
| if (link_up) |
| goto out; |
| } |
| } |
| |
| /* |
| * We didn't get link. If we advertised KR plus one of KX4/KX |
| * (or BX4/BX), then disable KR and try again. |
| */ |
| if (((autoc_reg & IXGBE_AUTOC_KR_SUPP) == 0) || |
| ((autoc_reg & IXGBE_AUTOC_KX4_KX_SUPP_MASK) == 0)) |
| goto out; |
| |
| /* Turn SmartSpeed on to disable KR support */ |
| hw->phy.smart_speed_active = true; |
| status = ixgbe_setup_mac_link_82599(hw, speed, autoneg, |
| autoneg_wait_to_complete); |
| if (status) |
| goto out; |
| |
| /* |
| * Wait for the controller to acquire link. 600ms will allow for |
| * the AN link_fail_inhibit_timer as well for multiple cycles of |
| * parallel detect, both 10g and 1g. This allows for the maximum |
| * connect attempts as defined in the AN MAS table 73-7. |
| */ |
| for (i = 0; i < 6; i++) { |
| mdelay(100); |
| |
| /* If we have link, just jump out */ |
| hw->mac.ops.check_link(hw, &link_speed, |
| &link_up, false); |
| if (link_up) |
| goto out; |
| } |
| |
| /* We didn't get link. Turn SmartSpeed back off. */ |
| hw->phy.smart_speed_active = false; |
| status = ixgbe_setup_mac_link_82599(hw, speed, autoneg, |
| autoneg_wait_to_complete); |
| |
| out: |
| return status; |
| } |
| |
| /** |
| * ixgbe_check_mac_link_82599 - Determine link and speed status |
| * @hw: pointer to hardware structure |
| * @speed: pointer to link speed |
| * @link_up: true when link is up |
| * @link_up_wait_to_complete: bool used to wait for link up or not |
| * |
| * Reads the links register to determine if link is up and the current speed |
| **/ |
| static s32 ixgbe_check_mac_link_82599(struct ixgbe_hw *hw, |
| ixgbe_link_speed *speed, |
| bool *link_up, |
| bool link_up_wait_to_complete) |
| { |
| u32 links_reg; |
| u32 i; |
| |
| links_reg = IXGBE_READ_REG(hw, IXGBE_LINKS); |
| if (link_up_wait_to_complete) { |
| for (i = 0; i < IXGBE_LINK_UP_TIME; i++) { |
| if (links_reg & IXGBE_LINKS_UP) { |
| *link_up = true; |
| break; |
| } else { |
| *link_up = false; |
| } |
| msleep(100); |
| links_reg = IXGBE_READ_REG(hw, IXGBE_LINKS); |
| } |
| } else { |
| if (links_reg & IXGBE_LINKS_UP) |
| *link_up = true; |
| else |
| *link_up = false; |
| } |
| |
| if ((links_reg & IXGBE_LINKS_SPEED_82599) == |
| IXGBE_LINKS_SPEED_10G_82599) |
| *speed = IXGBE_LINK_SPEED_10GB_FULL; |
| else if ((links_reg & IXGBE_LINKS_SPEED_82599) == |
| IXGBE_LINKS_SPEED_1G_82599) |
| *speed = IXGBE_LINK_SPEED_1GB_FULL; |
| else |
| *speed = IXGBE_LINK_SPEED_100_FULL; |
| |
| /* if link is down, zero out the current_mode */ |
| if (*link_up == false) { |
| hw->fc.current_mode = ixgbe_fc_none; |
| hw->fc.fc_was_autonegged = false; |
| } |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_setup_mac_link_82599 - Set MAC link speed |
| * @hw: pointer to hardware structure |
| * @speed: new link speed |
| * @autoneg: true if autonegotiation enabled |
| * @autoneg_wait_to_complete: true when waiting for completion is needed |
| * |
| * Set the link speed in the AUTOC register and restarts link. |
| **/ |
| s32 ixgbe_setup_mac_link_82599(struct ixgbe_hw *hw, |
| ixgbe_link_speed speed, bool autoneg, |
| bool autoneg_wait_to_complete) |
| { |
| s32 status = 0; |
| u32 autoc = IXGBE_READ_REG(hw, IXGBE_AUTOC); |
| u32 autoc2 = IXGBE_READ_REG(hw, IXGBE_AUTOC2); |
| u32 start_autoc = autoc; |
| u32 orig_autoc = 0; |
| u32 link_mode = autoc & IXGBE_AUTOC_LMS_MASK; |
| u32 pma_pmd_1g = autoc & IXGBE_AUTOC_1G_PMA_PMD_MASK; |
| u32 pma_pmd_10g_serial = autoc2 & IXGBE_AUTOC2_10G_SERIAL_PMA_PMD_MASK; |
| u32 links_reg; |
| u32 i; |
| ixgbe_link_speed link_capabilities = IXGBE_LINK_SPEED_UNKNOWN; |
| |
| /* Check to see if speed passed in is supported. */ |
| hw->mac.ops.get_link_capabilities(hw, &link_capabilities, &autoneg); |
| speed &= link_capabilities; |
| |
| if (speed == IXGBE_LINK_SPEED_UNKNOWN) { |
| status = IXGBE_ERR_LINK_SETUP; |
| goto out; |
| } |
| |
| /* Use stored value (EEPROM defaults) of AUTOC to find KR/KX4 support*/ |
| if (hw->mac.orig_link_settings_stored) |
| orig_autoc = hw->mac.orig_autoc; |
| else |
| orig_autoc = autoc; |
| |
| |
| if (link_mode == IXGBE_AUTOC_LMS_KX4_KX_KR || |
| link_mode == IXGBE_AUTOC_LMS_KX4_KX_KR_1G_AN || |
| link_mode == IXGBE_AUTOC_LMS_KX4_KX_KR_SGMII) { |
| /* Set KX4/KX/KR support according to speed requested */ |
| autoc &= ~(IXGBE_AUTOC_KX4_KX_SUPP_MASK | IXGBE_AUTOC_KR_SUPP); |
| if (speed & IXGBE_LINK_SPEED_10GB_FULL) |
| if (orig_autoc & IXGBE_AUTOC_KX4_SUPP) |
| autoc |= IXGBE_AUTOC_KX4_SUPP; |
| if ((orig_autoc & IXGBE_AUTOC_KR_SUPP) && |
| (hw->phy.smart_speed_active == false)) |
| autoc |= IXGBE_AUTOC_KR_SUPP; |
| if (speed & IXGBE_LINK_SPEED_1GB_FULL) |
| autoc |= IXGBE_AUTOC_KX_SUPP; |
| } else if ((pma_pmd_1g == IXGBE_AUTOC_1G_SFI) && |
| (link_mode == IXGBE_AUTOC_LMS_1G_LINK_NO_AN || |
| link_mode == IXGBE_AUTOC_LMS_1G_AN)) { |
| /* Switch from 1G SFI to 10G SFI if requested */ |
| if ((speed == IXGBE_LINK_SPEED_10GB_FULL) && |
| (pma_pmd_10g_serial == IXGBE_AUTOC2_10G_SFI)) { |
| autoc &= ~IXGBE_AUTOC_LMS_MASK; |
| autoc |= IXGBE_AUTOC_LMS_10G_SERIAL; |
| } |
| } else if ((pma_pmd_10g_serial == IXGBE_AUTOC2_10G_SFI) && |
| (link_mode == IXGBE_AUTOC_LMS_10G_SERIAL)) { |
| /* Switch from 10G SFI to 1G SFI if requested */ |
| if ((speed == IXGBE_LINK_SPEED_1GB_FULL) && |
| (pma_pmd_1g == IXGBE_AUTOC_1G_SFI)) { |
| autoc &= ~IXGBE_AUTOC_LMS_MASK; |
| if (autoneg) |
| autoc |= IXGBE_AUTOC_LMS_1G_AN; |
| else |
| autoc |= IXGBE_AUTOC_LMS_1G_LINK_NO_AN; |
| } |
| } |
| |
| if (autoc != start_autoc) { |
| /* Restart link */ |
| autoc |= IXGBE_AUTOC_AN_RESTART; |
| IXGBE_WRITE_REG(hw, IXGBE_AUTOC, autoc); |
| |
| /* Only poll for autoneg to complete if specified to do so */ |
| if (autoneg_wait_to_complete) { |
| if (link_mode == IXGBE_AUTOC_LMS_KX4_KX_KR || |
| link_mode == IXGBE_AUTOC_LMS_KX4_KX_KR_1G_AN || |
| link_mode == IXGBE_AUTOC_LMS_KX4_KX_KR_SGMII) { |
| links_reg = 0; /*Just in case Autoneg time=0*/ |
| for (i = 0; i < IXGBE_AUTO_NEG_TIME; i++) { |
| links_reg = |
| IXGBE_READ_REG(hw, IXGBE_LINKS); |
| if (links_reg & IXGBE_LINKS_KX_AN_COMP) |
| break; |
| msleep(100); |
| } |
| if (!(links_reg & IXGBE_LINKS_KX_AN_COMP)) { |
| status = |
| IXGBE_ERR_AUTONEG_NOT_COMPLETE; |
| hw_dbg(hw, "Autoneg did not " |
| "complete.\n"); |
| } |
| } |
| } |
| |
| /* Add delay to filter out noises during initial link setup */ |
| msleep(50); |
| } |
| |
| out: |
| return status; |
| } |
| |
| /** |
| * ixgbe_setup_copper_link_82599 - Set the PHY autoneg advertised field |
| * @hw: pointer to hardware structure |
| * @speed: new link speed |
| * @autoneg: true if autonegotiation enabled |
| * @autoneg_wait_to_complete: true if waiting is needed to complete |
| * |
| * Restarts link on PHY and MAC based on settings passed in. |
| **/ |
| static s32 ixgbe_setup_copper_link_82599(struct ixgbe_hw *hw, |
| ixgbe_link_speed speed, |
| bool autoneg, |
| bool autoneg_wait_to_complete) |
| { |
| s32 status; |
| |
| /* Setup the PHY according to input speed */ |
| status = hw->phy.ops.setup_link_speed(hw, speed, autoneg, |
| autoneg_wait_to_complete); |
| /* Set up MAC */ |
| ixgbe_start_mac_link_82599(hw, autoneg_wait_to_complete); |
| |
| return status; |
| } |
| |
| /** |
| * ixgbe_reset_hw_82599 - Perform hardware reset |
| * @hw: pointer to hardware structure |
| * |
| * Resets the hardware by resetting the transmit and receive units, masks |
| * and clears all interrupts, perform a PHY reset, and perform a link (MAC) |
| * reset. |
| **/ |
| static s32 ixgbe_reset_hw_82599(struct ixgbe_hw *hw) |
| { |
| s32 status = 0; |
| u32 ctrl, ctrl_ext; |
| u32 i; |
| u32 autoc; |
| u32 autoc2; |
| |
| /* Call adapter stop to disable tx/rx and clear interrupts */ |
| hw->mac.ops.stop_adapter(hw); |
| |
| /* PHY ops must be identified and initialized prior to reset */ |
| |
| /* Init PHY and function pointers, perform SFP setup */ |
| status = hw->phy.ops.init(hw); |
| |
| if (status == IXGBE_ERR_SFP_NOT_SUPPORTED) |
| goto reset_hw_out; |
| |
| /* Setup SFP module if there is one present. */ |
| if (hw->phy.sfp_setup_needed) { |
| status = hw->mac.ops.setup_sfp(hw); |
| hw->phy.sfp_setup_needed = false; |
| } |
| |
| /* Reset PHY */ |
| if (hw->phy.reset_disable == false && hw->phy.ops.reset != NULL) |
| hw->phy.ops.reset(hw); |
| |
| /* |
| * Prevent the PCI-E bus from from hanging by disabling PCI-E master |
| * access and verify no pending requests before reset |
| */ |
| status = ixgbe_disable_pcie_master(hw); |
| if (status != 0) { |
| status = IXGBE_ERR_MASTER_REQUESTS_PENDING; |
| hw_dbg(hw, "PCI-E Master disable polling has failed.\n"); |
| } |
| |
| /* |
| * Issue global reset to the MAC. This needs to be a SW reset. |
| * If link reset is used, it might reset the MAC when mng is using it |
| */ |
| ctrl = IXGBE_READ_REG(hw, IXGBE_CTRL); |
| IXGBE_WRITE_REG(hw, IXGBE_CTRL, (ctrl | IXGBE_CTRL_RST)); |
| IXGBE_WRITE_FLUSH(hw); |
| |
| /* Poll for reset bit to self-clear indicating reset is complete */ |
| for (i = 0; i < 10; i++) { |
| udelay(1); |
| ctrl = IXGBE_READ_REG(hw, IXGBE_CTRL); |
| if (!(ctrl & IXGBE_CTRL_RST)) |
| break; |
| } |
| if (ctrl & IXGBE_CTRL_RST) { |
| status = IXGBE_ERR_RESET_FAILED; |
| hw_dbg(hw, "Reset polling failed to complete.\n"); |
| } |
| /* Clear PF Reset Done bit so PF/VF Mail Ops can work */ |
| ctrl_ext = IXGBE_READ_REG(hw, IXGBE_CTRL_EXT); |
| ctrl_ext |= IXGBE_CTRL_EXT_PFRSTD; |
| IXGBE_WRITE_REG(hw, IXGBE_CTRL_EXT, ctrl_ext); |
| |
| msleep(50); |
| |
| |
| |
| /* |
| * Store the original AUTOC/AUTOC2 values if they have not been |
| * stored off yet. Otherwise restore the stored original |
| * values since the reset operation sets back to defaults. |
| */ |
| autoc = IXGBE_READ_REG(hw, IXGBE_AUTOC); |
| autoc2 = IXGBE_READ_REG(hw, IXGBE_AUTOC2); |
| if (hw->mac.orig_link_settings_stored == false) { |
| hw->mac.orig_autoc = autoc; |
| hw->mac.orig_autoc2 = autoc2; |
| hw->mac.orig_link_settings_stored = true; |
| } else { |
| if (autoc != hw->mac.orig_autoc) |
| IXGBE_WRITE_REG(hw, IXGBE_AUTOC, (hw->mac.orig_autoc | |
| IXGBE_AUTOC_AN_RESTART)); |
| |
| if ((autoc2 & IXGBE_AUTOC2_UPPER_MASK) != |
| (hw->mac.orig_autoc2 & IXGBE_AUTOC2_UPPER_MASK)) { |
| autoc2 &= ~IXGBE_AUTOC2_UPPER_MASK; |
| autoc2 |= (hw->mac.orig_autoc2 & |
| IXGBE_AUTOC2_UPPER_MASK); |
| IXGBE_WRITE_REG(hw, IXGBE_AUTOC2, autoc2); |
| } |
| } |
| |
| /* |
| * Store MAC address from RAR0, clear receive address registers, and |
| * clear the multicast table. Also reset num_rar_entries to 128, |
| * since we modify this value when programming the SAN MAC address. |
| */ |
| hw->mac.num_rar_entries = 128; |
| hw->mac.ops.init_rx_addrs(hw); |
| |
| /* Store the permanent mac address */ |
| hw->mac.ops.get_mac_addr(hw, hw->mac.perm_addr); |
| |
| /* Store the permanent SAN mac address */ |
| hw->mac.ops.get_san_mac_addr(hw, hw->mac.san_addr); |
| |
| /* Add the SAN MAC address to the RAR only if it's a valid address */ |
| if (ixgbe_validate_mac_addr(hw->mac.san_addr) == 0) { |
| hw->mac.ops.set_rar(hw, hw->mac.num_rar_entries - 1, |
| hw->mac.san_addr, 0, IXGBE_RAH_AV); |
| |
| /* Reserve the last RAR for the SAN MAC address */ |
| hw->mac.num_rar_entries--; |
| } |
| |
| reset_hw_out: |
| return status; |
| } |
| |
| /** |
| * ixgbe_clear_vmdq_82599 - Disassociate a VMDq pool index from a rx address |
| * @hw: pointer to hardware struct |
| * @rar: receive address register index to disassociate |
| * @vmdq: VMDq pool index to remove from the rar |
| **/ |
| static s32 ixgbe_clear_vmdq_82599(struct ixgbe_hw *hw, u32 rar, u32 vmdq) |
| { |
| u32 mpsar_lo, mpsar_hi; |
| u32 rar_entries = hw->mac.num_rar_entries; |
| |
| if (rar < rar_entries) { |
| mpsar_lo = IXGBE_READ_REG(hw, IXGBE_MPSAR_LO(rar)); |
| mpsar_hi = IXGBE_READ_REG(hw, IXGBE_MPSAR_HI(rar)); |
| |
| if (!mpsar_lo && !mpsar_hi) |
| goto done; |
| |
| if (vmdq == IXGBE_CLEAR_VMDQ_ALL) { |
| if (mpsar_lo) { |
| IXGBE_WRITE_REG(hw, IXGBE_MPSAR_LO(rar), 0); |
| mpsar_lo = 0; |
| } |
| if (mpsar_hi) { |
| IXGBE_WRITE_REG(hw, IXGBE_MPSAR_HI(rar), 0); |
| mpsar_hi = 0; |
| } |
| } else if (vmdq < 32) { |
| mpsar_lo &= ~(1 << vmdq); |
| IXGBE_WRITE_REG(hw, IXGBE_MPSAR_LO(rar), mpsar_lo); |
| } else { |
| mpsar_hi &= ~(1 << (vmdq - 32)); |
| IXGBE_WRITE_REG(hw, IXGBE_MPSAR_HI(rar), mpsar_hi); |
| } |
| |
| /* was that the last pool using this rar? */ |
| if (mpsar_lo == 0 && mpsar_hi == 0 && rar != 0) |
| hw->mac.ops.clear_rar(hw, rar); |
| } else { |
| hw_dbg(hw, "RAR index %d is out of range.\n", rar); |
| } |
| |
| done: |
| return 0; |
| } |
| |
| /** |
| * ixgbe_set_vmdq_82599 - Associate a VMDq pool index with a rx address |
| * @hw: pointer to hardware struct |
| * @rar: receive address register index to associate with a VMDq index |
| * @vmdq: VMDq pool index |
| **/ |
| static s32 ixgbe_set_vmdq_82599(struct ixgbe_hw *hw, u32 rar, u32 vmdq) |
| { |
| u32 mpsar; |
| u32 rar_entries = hw->mac.num_rar_entries; |
| |
| if (rar < rar_entries) { |
| if (vmdq < 32) { |
| mpsar = IXGBE_READ_REG(hw, IXGBE_MPSAR_LO(rar)); |
| mpsar |= 1 << vmdq; |
| IXGBE_WRITE_REG(hw, IXGBE_MPSAR_LO(rar), mpsar); |
| } else { |
| mpsar = IXGBE_READ_REG(hw, IXGBE_MPSAR_HI(rar)); |
| mpsar |= 1 << (vmdq - 32); |
| IXGBE_WRITE_REG(hw, IXGBE_MPSAR_HI(rar), mpsar); |
| } |
| } else { |
| hw_dbg(hw, "RAR index %d is out of range.\n", rar); |
| } |
| return 0; |
| } |
| |
| /** |
| * ixgbe_set_vfta_82599 - Set VLAN filter table |
| * @hw: pointer to hardware structure |
| * @vlan: VLAN id to write to VLAN filter |
| * @vind: VMDq output index that maps queue to VLAN id in VFVFB |
| * @vlan_on: boolean flag to turn on/off VLAN in VFVF |
| * |
| * Turn on/off specified VLAN in the VLAN filter table. |
| **/ |
| static s32 ixgbe_set_vfta_82599(struct ixgbe_hw *hw, u32 vlan, u32 vind, |
| bool vlan_on) |
| { |
| u32 regindex; |
| u32 bitindex; |
| u32 bits; |
| u32 first_empty_slot; |
| |
| if (vlan > 4095) |
| return IXGBE_ERR_PARAM; |
| |
| /* |
| * this is a 2 part operation - first the VFTA, then the |
| * VLVF and VLVFB if vind is set |
| */ |
| |
| /* Part 1 |
| * The VFTA is a bitstring made up of 128 32-bit registers |
| * that enable the particular VLAN id, much like the MTA: |
| * bits[11-5]: which register |
| * bits[4-0]: which bit in the register |
| */ |
| regindex = (vlan >> 5) & 0x7F; |
| bitindex = vlan & 0x1F; |
| bits = IXGBE_READ_REG(hw, IXGBE_VFTA(regindex)); |
| if (vlan_on) |
| bits |= (1 << bitindex); |
| else |
| bits &= ~(1 << bitindex); |
| IXGBE_WRITE_REG(hw, IXGBE_VFTA(regindex), bits); |
| |
| |
| /* Part 2 |
| * If the vind is set |
| * Either vlan_on |
| * make sure the vlan is in VLVF |
| * set the vind bit in the matching VLVFB |
| * Or !vlan_on |
| * clear the pool bit and possibly the vind |
| */ |
| if (vind) { |
| /* find the vlanid or the first empty slot */ |
| first_empty_slot = 0; |
| |
| for (regindex = 1; regindex < IXGBE_VLVF_ENTRIES; regindex++) { |
| bits = IXGBE_READ_REG(hw, IXGBE_VLVF(regindex)); |
| if (!bits && !first_empty_slot) |
| first_empty_slot = regindex; |
| else if ((bits & 0x0FFF) == vlan) |
| break; |
| } |
| |
| if (regindex >= IXGBE_VLVF_ENTRIES) { |
| if (first_empty_slot) |
| regindex = first_empty_slot; |
| else { |
| hw_dbg(hw, "No space in VLVF.\n"); |
| goto out; |
| } |
| } |
| |
| if (vlan_on) { |
| /* set the pool bit */ |
| if (vind < 32) { |
| bits = IXGBE_READ_REG(hw, |
| IXGBE_VLVFB(regindex * 2)); |
| bits |= (1 << vind); |
| IXGBE_WRITE_REG(hw, |
| IXGBE_VLVFB(regindex * 2), bits); |
| } else { |
| bits = IXGBE_READ_REG(hw, |
| IXGBE_VLVFB((regindex * 2) + 1)); |
| bits |= (1 << vind); |
| IXGBE_WRITE_REG(hw, |
| IXGBE_VLVFB((regindex * 2) + 1), bits); |
| } |
| } else { |
| /* clear the pool bit */ |
| if (vind < 32) { |
| bits = IXGBE_READ_REG(hw, |
| IXGBE_VLVFB(regindex * 2)); |
| bits &= ~(1 << vind); |
| IXGBE_WRITE_REG(hw, |
| IXGBE_VLVFB(regindex * 2), bits); |
| bits |= IXGBE_READ_REG(hw, |
| IXGBE_VLVFB((regindex * 2) + 1)); |
| } else { |
| bits = IXGBE_READ_REG(hw, |
| IXGBE_VLVFB((regindex * 2) + 1)); |
| bits &= ~(1 << vind); |
| IXGBE_WRITE_REG(hw, |
| IXGBE_VLVFB((regindex * 2) + 1), bits); |
| bits |= IXGBE_READ_REG(hw, |
| IXGBE_VLVFB(regindex * 2)); |
| } |
| } |
| |
| if (bits) |
| IXGBE_WRITE_REG(hw, IXGBE_VLVF(regindex), |
| (IXGBE_VLVF_VIEN | vlan)); |
| else |
| IXGBE_WRITE_REG(hw, IXGBE_VLVF(regindex), 0); |
| } |
| |
| out: |
| return 0; |
| } |
| |
| /** |
| * ixgbe_clear_vfta_82599 - Clear VLAN filter table |
| * @hw: pointer to hardware structure |
| * |
| * Clears the VLAN filer table, and the VMDq index associated with the filter |
| **/ |
| static s32 ixgbe_clear_vfta_82599(struct ixgbe_hw *hw) |
| { |
| u32 offset; |
| |
| for (offset = 0; offset < hw->mac.vft_size; offset++) |
| IXGBE_WRITE_REG(hw, IXGBE_VFTA(offset), 0); |
| |
| for (offset = 0; offset < IXGBE_VLVF_ENTRIES; offset++) { |
| IXGBE_WRITE_REG(hw, IXGBE_VLVF(offset), 0); |
| IXGBE_WRITE_REG(hw, IXGBE_VLVFB(offset * 2), 0); |
| IXGBE_WRITE_REG(hw, IXGBE_VLVFB((offset * 2) + 1), 0); |
| } |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_init_uta_tables_82599 - Initialize the Unicast Table Array |
| * @hw: pointer to hardware structure |
| **/ |
| static s32 ixgbe_init_uta_tables_82599(struct ixgbe_hw *hw) |
| { |
| int i; |
| hw_dbg(hw, " Clearing UTA\n"); |
| |
| for (i = 0; i < 128; i++) |
| IXGBE_WRITE_REG(hw, IXGBE_UTA(i), 0); |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_reinit_fdir_tables_82599 - Reinitialize Flow Director tables. |
| * @hw: pointer to hardware structure |
| **/ |
| s32 ixgbe_reinit_fdir_tables_82599(struct ixgbe_hw *hw) |
| { |
| int i; |
| u32 fdirctrl = IXGBE_READ_REG(hw, IXGBE_FDIRCTRL); |
| fdirctrl &= ~IXGBE_FDIRCTRL_INIT_DONE; |
| |
| /* |
| * Before starting reinitialization process, |
| * FDIRCMD.CMD must be zero. |
| */ |
| for (i = 0; i < IXGBE_FDIRCMD_CMD_POLL; i++) { |
| if (!(IXGBE_READ_REG(hw, IXGBE_FDIRCMD) & |
| IXGBE_FDIRCMD_CMD_MASK)) |
| break; |
| udelay(10); |
| } |
| if (i >= IXGBE_FDIRCMD_CMD_POLL) { |
| hw_dbg(hw ,"Flow Director previous command isn't complete, " |
| "aborting table re-initialization. \n"); |
| return IXGBE_ERR_FDIR_REINIT_FAILED; |
| } |
| |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRFREE, 0); |
| IXGBE_WRITE_FLUSH(hw); |
| /* |
| * 82599 adapters flow director init flow cannot be restarted, |
| * Workaround 82599 silicon errata by performing the following steps |
| * before re-writing the FDIRCTRL control register with the same value. |
| * - write 1 to bit 8 of FDIRCMD register & |
| * - write 0 to bit 8 of FDIRCMD register |
| */ |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRCMD, |
| (IXGBE_READ_REG(hw, IXGBE_FDIRCMD) | |
| IXGBE_FDIRCMD_CLEARHT)); |
| IXGBE_WRITE_FLUSH(hw); |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRCMD, |
| (IXGBE_READ_REG(hw, IXGBE_FDIRCMD) & |
| ~IXGBE_FDIRCMD_CLEARHT)); |
| IXGBE_WRITE_FLUSH(hw); |
| /* |
| * Clear FDIR Hash register to clear any leftover hashes |
| * waiting to be programmed. |
| */ |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRHASH, 0x00); |
| IXGBE_WRITE_FLUSH(hw); |
| |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRCTRL, fdirctrl); |
| IXGBE_WRITE_FLUSH(hw); |
| |
| /* Poll init-done after we write FDIRCTRL register */ |
| for (i = 0; i < IXGBE_FDIR_INIT_DONE_POLL; i++) { |
| if (IXGBE_READ_REG(hw, IXGBE_FDIRCTRL) & |
| IXGBE_FDIRCTRL_INIT_DONE) |
| break; |
| udelay(10); |
| } |
| if (i >= IXGBE_FDIR_INIT_DONE_POLL) { |
| hw_dbg(hw, "Flow Director Signature poll time exceeded!\n"); |
| return IXGBE_ERR_FDIR_REINIT_FAILED; |
| } |
| |
| /* Clear FDIR statistics registers (read to clear) */ |
| IXGBE_READ_REG(hw, IXGBE_FDIRUSTAT); |
| IXGBE_READ_REG(hw, IXGBE_FDIRFSTAT); |
| IXGBE_READ_REG(hw, IXGBE_FDIRMATCH); |
| IXGBE_READ_REG(hw, IXGBE_FDIRMISS); |
| IXGBE_READ_REG(hw, IXGBE_FDIRLEN); |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_init_fdir_signature_82599 - Initialize Flow Director signature filters |
| * @hw: pointer to hardware structure |
| * @pballoc: which mode to allocate filters with |
| **/ |
| s32 ixgbe_init_fdir_signature_82599(struct ixgbe_hw *hw, u32 pballoc) |
| { |
| u32 fdirctrl = 0; |
| u32 pbsize; |
| int i; |
| |
| /* |
| * Before enabling Flow Director, the Rx Packet Buffer size |
| * must be reduced. The new value is the current size minus |
| * flow director memory usage size. |
| */ |
| pbsize = (1 << (IXGBE_FDIR_PBALLOC_SIZE_SHIFT + pballoc)); |
| IXGBE_WRITE_REG(hw, IXGBE_RXPBSIZE(0), |
| (IXGBE_READ_REG(hw, IXGBE_RXPBSIZE(0)) - pbsize)); |
| |
| /* |
| * The defaults in the HW for RX PB 1-7 are not zero and so should be |
| * intialized to zero for non DCB mode otherwise actual total RX PB |
| * would be bigger than programmed and filter space would run into |
| * the PB 0 region. |
| */ |
| for (i = 1; i < 8; i++) |
| IXGBE_WRITE_REG(hw, IXGBE_RXPBSIZE(i), 0); |
| |
| /* Send interrupt when 64 filters are left */ |
| fdirctrl |= 4 << IXGBE_FDIRCTRL_FULL_THRESH_SHIFT; |
| |
| /* Set the maximum length per hash bucket to 0xA filters */ |
| fdirctrl |= 0xA << IXGBE_FDIRCTRL_MAX_LENGTH_SHIFT; |
| |
| switch (pballoc) { |
| case IXGBE_FDIR_PBALLOC_64K: |
| /* 8k - 1 signature filters */ |
| fdirctrl |= IXGBE_FDIRCTRL_PBALLOC_64K; |
| break; |
| case IXGBE_FDIR_PBALLOC_128K: |
| /* 16k - 1 signature filters */ |
| fdirctrl |= IXGBE_FDIRCTRL_PBALLOC_128K; |
| break; |
| case IXGBE_FDIR_PBALLOC_256K: |
| /* 32k - 1 signature filters */ |
| fdirctrl |= IXGBE_FDIRCTRL_PBALLOC_256K; |
| break; |
| default: |
| /* bad value */ |
| return IXGBE_ERR_CONFIG; |
| }; |
| |
| /* Move the flexible bytes to use the ethertype - shift 6 words */ |
| fdirctrl |= (0x6 << IXGBE_FDIRCTRL_FLEX_SHIFT); |
| |
| fdirctrl |= IXGBE_FDIRCTRL_REPORT_STATUS; |
| |
| /* Prime the keys for hashing */ |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRHKEY, |
| htonl(IXGBE_ATR_BUCKET_HASH_KEY)); |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRSKEY, |
| htonl(IXGBE_ATR_SIGNATURE_HASH_KEY)); |
| |
| /* |
| * Poll init-done after we write the register. Estimated times: |
| * 10G: PBALLOC = 11b, timing is 60us |
| * 1G: PBALLOC = 11b, timing is 600us |
| * 100M: PBALLOC = 11b, timing is 6ms |
| * |
| * Multiple these timings by 4 if under full Rx load |
| * |
| * So we'll poll for IXGBE_FDIR_INIT_DONE_POLL times, sleeping for |
| * 1 msec per poll time. If we're at line rate and drop to 100M, then |
| * this might not finish in our poll time, but we can live with that |
| * for now. |
| */ |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRCTRL, fdirctrl); |
| IXGBE_WRITE_FLUSH(hw); |
| for (i = 0; i < IXGBE_FDIR_INIT_DONE_POLL; i++) { |
| if (IXGBE_READ_REG(hw, IXGBE_FDIRCTRL) & |
| IXGBE_FDIRCTRL_INIT_DONE) |
| break; |
| msleep(1); |
| } |
| if (i >= IXGBE_FDIR_INIT_DONE_POLL) |
| hw_dbg(hw, "Flow Director Signature poll time exceeded!\n"); |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_init_fdir_perfect_82599 - Initialize Flow Director perfect filters |
| * @hw: pointer to hardware structure |
| * @pballoc: which mode to allocate filters with |
| **/ |
| s32 ixgbe_init_fdir_perfect_82599(struct ixgbe_hw *hw, u32 pballoc) |
| { |
| u32 fdirctrl = 0; |
| u32 pbsize; |
| int i; |
| |
| /* |
| * Before enabling Flow Director, the Rx Packet Buffer size |
| * must be reduced. The new value is the current size minus |
| * flow director memory usage size. |
| */ |
| pbsize = (1 << (IXGBE_FDIR_PBALLOC_SIZE_SHIFT + pballoc)); |
| IXGBE_WRITE_REG(hw, IXGBE_RXPBSIZE(0), |
| (IXGBE_READ_REG(hw, IXGBE_RXPBSIZE(0)) - pbsize)); |
| |
| /* |
| * The defaults in the HW for RX PB 1-7 are not zero and so should be |
| * intialized to zero for non DCB mode otherwise actual total RX PB |
| * would be bigger than programmed and filter space would run into |
| * the PB 0 region. |
| */ |
| for (i = 1; i < 8; i++) |
| IXGBE_WRITE_REG(hw, IXGBE_RXPBSIZE(i), 0); |
| |
| /* Send interrupt when 64 filters are left */ |
| fdirctrl |= 4 << IXGBE_FDIRCTRL_FULL_THRESH_SHIFT; |
| |
| switch (pballoc) { |
| case IXGBE_FDIR_PBALLOC_64K: |
| /* 2k - 1 perfect filters */ |
| fdirctrl |= IXGBE_FDIRCTRL_PBALLOC_64K; |
| break; |
| case IXGBE_FDIR_PBALLOC_128K: |
| /* 4k - 1 perfect filters */ |
| fdirctrl |= IXGBE_FDIRCTRL_PBALLOC_128K; |
| break; |
| case IXGBE_FDIR_PBALLOC_256K: |
| /* 8k - 1 perfect filters */ |
| fdirctrl |= IXGBE_FDIRCTRL_PBALLOC_256K; |
| break; |
| default: |
| /* bad value */ |
| return IXGBE_ERR_CONFIG; |
| }; |
| |
| /* Turn perfect match filtering on */ |
| fdirctrl |= IXGBE_FDIRCTRL_PERFECT_MATCH; |
| fdirctrl |= IXGBE_FDIRCTRL_REPORT_STATUS; |
| |
| /* Move the flexible bytes to use the ethertype - shift 6 words */ |
| fdirctrl |= (0x6 << IXGBE_FDIRCTRL_FLEX_SHIFT); |
| |
| /* Prime the keys for hashing */ |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRHKEY, |
| htonl(IXGBE_ATR_BUCKET_HASH_KEY)); |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRSKEY, |
| htonl(IXGBE_ATR_SIGNATURE_HASH_KEY)); |
| |
| /* |
| * Poll init-done after we write the register. Estimated times: |
| * 10G: PBALLOC = 11b, timing is 60us |
| * 1G: PBALLOC = 11b, timing is 600us |
| * 100M: PBALLOC = 11b, timing is 6ms |
| * |
| * Multiple these timings by 4 if under full Rx load |
| * |
| * So we'll poll for IXGBE_FDIR_INIT_DONE_POLL times, sleeping for |
| * 1 msec per poll time. If we're at line rate and drop to 100M, then |
| * this might not finish in our poll time, but we can live with that |
| * for now. |
| */ |
| |
| /* Set the maximum length per hash bucket to 0xA filters */ |
| fdirctrl |= (0xA << IXGBE_FDIRCTRL_MAX_LENGTH_SHIFT); |
| |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRCTRL, fdirctrl); |
| IXGBE_WRITE_FLUSH(hw); |
| for (i = 0; i < IXGBE_FDIR_INIT_DONE_POLL; i++) { |
| if (IXGBE_READ_REG(hw, IXGBE_FDIRCTRL) & |
| IXGBE_FDIRCTRL_INIT_DONE) |
| break; |
| msleep(1); |
| } |
| if (i >= IXGBE_FDIR_INIT_DONE_POLL) |
| hw_dbg(hw, "Flow Director Perfect poll time exceeded!\n"); |
| |
| return 0; |
| } |
| |
| |
| /** |
| * ixgbe_atr_compute_hash_82599 - Compute the hashes for SW ATR |
| * @stream: input bitstream to compute the hash on |
| * @key: 32-bit hash key |
| **/ |
| static u16 ixgbe_atr_compute_hash_82599(struct ixgbe_atr_input *atr_input, |
| u32 key) |
| { |
| /* |
| * The algorithm is as follows: |
| * Hash[15:0] = Sum { S[n] x K[n+16] }, n = 0...350 |
| * where Sum {A[n]}, n = 0...n is bitwise XOR of A[0], A[1]...A[n] |
| * and A[n] x B[n] is bitwise AND between same length strings |
| * |
| * K[n] is 16 bits, defined as: |
| * for n modulo 32 >= 15, K[n] = K[n % 32 : (n % 32) - 15] |
| * for n modulo 32 < 15, K[n] = |
| * K[(n % 32:0) | (31:31 - (14 - (n % 32)))] |
| * |
| * S[n] is 16 bits, defined as: |
| * for n >= 15, S[n] = S[n:n - 15] |
| * for n < 15, S[n] = S[(n:0) | (350:350 - (14 - n))] |
| * |
| * To simplify for programming, the algorithm is implemented |
| * in software this way: |
| * |
| * Key[31:0], Stream[335:0] |
| * |
| * tmp_key[11 * 32 - 1:0] = 11{Key[31:0] = key concatenated 11 times |
| * int_key[350:0] = tmp_key[351:1] |
| * int_stream[365:0] = Stream[14:0] | Stream[335:0] | Stream[335:321] |
| * |
| * hash[15:0] = 0; |
| * for (i = 0; i < 351; i++) { |
| * if (int_key[i]) |
| * hash ^= int_stream[(i + 15):i]; |
| * } |
| */ |
| |
| union { |
| u64 fill[6]; |
| u32 key[11]; |
| u8 key_stream[44]; |
| } tmp_key; |
| |
| u8 *stream = (u8 *)atr_input; |
| u8 int_key[44]; /* upper-most bit unused */ |
| u8 hash_str[46]; /* upper-most 2 bits unused */ |
| u16 hash_result = 0; |
| int i, j, k, h; |
| |
| /* |
| * Initialize the fill member to prevent warnings |
| * on some compilers |
| */ |
| tmp_key.fill[0] = 0; |
| |
| /* First load the temporary key stream */ |
| for (i = 0; i < 6; i++) { |
| u64 fillkey = ((u64)key << 32) | key; |
| tmp_key.fill[i] = fillkey; |
| } |
| |
| /* |
| * Set the interim key for the hashing. Bit 352 is unused, so we must |
| * shift and compensate when building the key. |
| */ |
| |
| int_key[0] = tmp_key.key_stream[0] >> 1; |
| for (i = 1, j = 0; i < 44; i++) { |
| unsigned int this_key = tmp_key.key_stream[j] << 7; |
| j++; |
| int_key[i] = (u8)(this_key | (tmp_key.key_stream[j] >> 1)); |
| } |
| |
| /* |
| * Set the interim bit string for the hashing. Bits 368 and 367 are |
| * unused, so shift and compensate when building the string. |
| */ |
| hash_str[0] = (stream[40] & 0x7f) >> 1; |
| for (i = 1, j = 40; i < 46; i++) { |
| unsigned int this_str = stream[j] << 7; |
| j++; |
| if (j > 41) |
| j = 0; |
| hash_str[i] = (u8)(this_str | (stream[j] >> 1)); |
| } |
| |
| /* |
| * Now compute the hash. i is the index into hash_str, j is into our |
| * key stream, k is counting the number of bits, and h interates within |
| * each byte. |
| */ |
| for (i = 45, j = 43, k = 0; k < 351 && i >= 2 && j >= 0; i--, j--) { |
| for (h = 0; h < 8 && k < 351; h++, k++) { |
| if (int_key[j] & (1 << h)) { |
| /* |
| * Key bit is set, XOR in the current 16-bit |
| * string. Example of processing: |
| * h = 0, |
| * tmp = (hash_str[i - 2] & 0 << 16) | |
| * (hash_str[i - 1] & 0xff << 8) | |
| * (hash_str[i] & 0xff >> 0) |
| * So tmp = hash_str[15 + k:k], since the |
| * i + 2 clause rolls off the 16-bit value |
| * h = 7, |
| * tmp = (hash_str[i - 2] & 0x7f << 9) | |
| * (hash_str[i - 1] & 0xff << 1) | |
| * (hash_str[i] & 0x80 >> 7) |
| */ |
| int tmp = (hash_str[i] >> h); |
| tmp |= (hash_str[i - 1] << (8 - h)); |
| tmp |= (int)(hash_str[i - 2] & ((1 << h) - 1)) |
| << (16 - h); |
| hash_result ^= (u16)tmp; |
| } |
| } |
| } |
| |
| return hash_result; |
| } |
| |
| /** |
| * ixgbe_atr_set_vlan_id_82599 - Sets the VLAN id in the ATR input stream |
| * @input: input stream to modify |
| * @vlan: the VLAN id to load |
| **/ |
| s32 ixgbe_atr_set_vlan_id_82599(struct ixgbe_atr_input *input, u16 vlan) |
| { |
| input->byte_stream[IXGBE_ATR_VLAN_OFFSET + 1] = vlan >> 8; |
| input->byte_stream[IXGBE_ATR_VLAN_OFFSET] = vlan & 0xff; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_atr_set_src_ipv4_82599 - Sets the source IPv4 address |
| * @input: input stream to modify |
| * @src_addr: the IP address to load |
| **/ |
| s32 ixgbe_atr_set_src_ipv4_82599(struct ixgbe_atr_input *input, u32 src_addr) |
| { |
| input->byte_stream[IXGBE_ATR_SRC_IPV4_OFFSET + 3] = src_addr >> 24; |
| input->byte_stream[IXGBE_ATR_SRC_IPV4_OFFSET + 2] = |
| (src_addr >> 16) & 0xff; |
| input->byte_stream[IXGBE_ATR_SRC_IPV4_OFFSET + 1] = |
| (src_addr >> 8) & 0xff; |
| input->byte_stream[IXGBE_ATR_SRC_IPV4_OFFSET] = src_addr & 0xff; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_atr_set_dst_ipv4_82599 - Sets the destination IPv4 address |
| * @input: input stream to modify |
| * @dst_addr: the IP address to load |
| **/ |
| s32 ixgbe_atr_set_dst_ipv4_82599(struct ixgbe_atr_input *input, u32 dst_addr) |
| { |
| input->byte_stream[IXGBE_ATR_DST_IPV4_OFFSET + 3] = dst_addr >> 24; |
| input->byte_stream[IXGBE_ATR_DST_IPV4_OFFSET + 2] = |
| (dst_addr >> 16) & 0xff; |
| input->byte_stream[IXGBE_ATR_DST_IPV4_OFFSET + 1] = |
| (dst_addr >> 8) & 0xff; |
| input->byte_stream[IXGBE_ATR_DST_IPV4_OFFSET] = dst_addr & 0xff; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_atr_set_src_ipv6_82599 - Sets the source IPv6 address |
| * @input: input stream to modify |
| * @src_addr_1: the first 4 bytes of the IP address to load |
| * @src_addr_2: the second 4 bytes of the IP address to load |
| * @src_addr_3: the third 4 bytes of the IP address to load |
| * @src_addr_4: the fourth 4 bytes of the IP address to load |
| **/ |
| s32 ixgbe_atr_set_src_ipv6_82599(struct ixgbe_atr_input *input, |
| u32 src_addr_1, u32 src_addr_2, |
| u32 src_addr_3, u32 src_addr_4) |
| { |
| input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET] = src_addr_4 & 0xff; |
| input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 1] = |
| (src_addr_4 >> 8) & 0xff; |
| input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 2] = |
| (src_addr_4 >> 16) & 0xff; |
| input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 3] = src_addr_4 >> 24; |
| |
| input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 4] = src_addr_3 & 0xff; |
| input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 5] = |
| (src_addr_3 >> 8) & 0xff; |
| input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 6] = |
| (src_addr_3 >> 16) & 0xff; |
| input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 7] = src_addr_3 >> 24; |
| |
| input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 8] = src_addr_2 & 0xff; |
| input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 9] = |
| (src_addr_2 >> 8) & 0xff; |
| input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 10] = |
| (src_addr_2 >> 16) & 0xff; |
| input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 11] = src_addr_2 >> 24; |
| |
| input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 12] = src_addr_1 & 0xff; |
| input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 13] = |
| (src_addr_1 >> 8) & 0xff; |
| input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 14] = |
| (src_addr_1 >> 16) & 0xff; |
| input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 15] = src_addr_1 >> 24; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_atr_set_dst_ipv6_82599 - Sets the destination IPv6 address |
| * @input: input stream to modify |
| * @dst_addr_1: the first 4 bytes of the IP address to load |
| * @dst_addr_2: the second 4 bytes of the IP address to load |
| * @dst_addr_3: the third 4 bytes of the IP address to load |
| * @dst_addr_4: the fourth 4 bytes of the IP address to load |
| **/ |
| s32 ixgbe_atr_set_dst_ipv6_82599(struct ixgbe_atr_input *input, |
| u32 dst_addr_1, u32 dst_addr_2, |
| u32 dst_addr_3, u32 dst_addr_4) |
| { |
| input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET] = dst_addr_4 & 0xff; |
| input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 1] = |
| (dst_addr_4 >> 8) & 0xff; |
| input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 2] = |
| (dst_addr_4 >> 16) & 0xff; |
| input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 3] = dst_addr_4 >> 24; |
| |
| input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 4] = dst_addr_3 & 0xff; |
| input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 5] = |
| (dst_addr_3 >> 8) & 0xff; |
| input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 6] = |
| (dst_addr_3 >> 16) & 0xff; |
| input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 7] = dst_addr_3 >> 24; |
| |
| input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 8] = dst_addr_2 & 0xff; |
| input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 9] = |
| (dst_addr_2 >> 8) & 0xff; |
| input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 10] = |
| (dst_addr_2 >> 16) & 0xff; |
| input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 11] = dst_addr_2 >> 24; |
| |
| input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 12] = dst_addr_1 & 0xff; |
| input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 13] = |
| (dst_addr_1 >> 8) & 0xff; |
| input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 14] = |
| (dst_addr_1 >> 16) & 0xff; |
| input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 15] = dst_addr_1 >> 24; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_atr_set_src_port_82599 - Sets the source port |
| * @input: input stream to modify |
| * @src_port: the source port to load |
| **/ |
| s32 ixgbe_atr_set_src_port_82599(struct ixgbe_atr_input *input, u16 src_port) |
| { |
| input->byte_stream[IXGBE_ATR_SRC_PORT_OFFSET + 1] = src_port >> 8; |
| input->byte_stream[IXGBE_ATR_SRC_PORT_OFFSET] = src_port & 0xff; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_atr_set_dst_port_82599 - Sets the destination port |
| * @input: input stream to modify |
| * @dst_port: the destination port to load |
| **/ |
| s32 ixgbe_atr_set_dst_port_82599(struct ixgbe_atr_input *input, u16 dst_port) |
| { |
| input->byte_stream[IXGBE_ATR_DST_PORT_OFFSET + 1] = dst_port >> 8; |
| input->byte_stream[IXGBE_ATR_DST_PORT_OFFSET] = dst_port & 0xff; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_atr_set_flex_byte_82599 - Sets the flexible bytes |
| * @input: input stream to modify |
| * @flex_bytes: the flexible bytes to load |
| **/ |
| s32 ixgbe_atr_set_flex_byte_82599(struct ixgbe_atr_input *input, u16 flex_byte) |
| { |
| input->byte_stream[IXGBE_ATR_FLEX_BYTE_OFFSET + 1] = flex_byte >> 8; |
| input->byte_stream[IXGBE_ATR_FLEX_BYTE_OFFSET] = flex_byte & 0xff; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_atr_set_vm_pool_82599 - Sets the Virtual Machine pool |
| * @input: input stream to modify |
| * @vm_pool: the Virtual Machine pool to load |
| **/ |
| s32 ixgbe_atr_set_vm_pool_82599(struct ixgbe_atr_input *input, |
| u8 vm_pool) |
| { |
| input->byte_stream[IXGBE_ATR_VM_POOL_OFFSET] = vm_pool; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_atr_set_l4type_82599 - Sets the layer 4 packet type |
| * @input: input stream to modify |
| * @l4type: the layer 4 type value to load |
| **/ |
| s32 ixgbe_atr_set_l4type_82599(struct ixgbe_atr_input *input, u8 l4type) |
| { |
| input->byte_stream[IXGBE_ATR_L4TYPE_OFFSET] = l4type; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_atr_get_vlan_id_82599 - Gets the VLAN id from the ATR input stream |
| * @input: input stream to search |
| * @vlan: the VLAN id to load |
| **/ |
| static s32 ixgbe_atr_get_vlan_id_82599(struct ixgbe_atr_input *input, |
| u16 *vlan) |
| { |
| *vlan = input->byte_stream[IXGBE_ATR_VLAN_OFFSET]; |
| *vlan |= input->byte_stream[IXGBE_ATR_VLAN_OFFSET + 1] << 8; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_atr_get_src_ipv4_82599 - Gets the source IPv4 address |
| * @input: input stream to search |
| * @src_addr: the IP address to load |
| **/ |
| static s32 ixgbe_atr_get_src_ipv4_82599(struct ixgbe_atr_input *input, |
| u32 *src_addr) |
| { |
| *src_addr = input->byte_stream[IXGBE_ATR_SRC_IPV4_OFFSET]; |
| *src_addr |= input->byte_stream[IXGBE_ATR_SRC_IPV4_OFFSET + 1] << 8; |
| *src_addr |= input->byte_stream[IXGBE_ATR_SRC_IPV4_OFFSET + 2] << 16; |
| *src_addr |= input->byte_stream[IXGBE_ATR_SRC_IPV4_OFFSET + 3] << 24; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_atr_get_dst_ipv4_82599 - Gets the destination IPv4 address |
| * @input: input stream to search |
| * @dst_addr: the IP address to load |
| **/ |
| static s32 ixgbe_atr_get_dst_ipv4_82599(struct ixgbe_atr_input *input, |
| u32 *dst_addr) |
| { |
| *dst_addr = input->byte_stream[IXGBE_ATR_DST_IPV4_OFFSET]; |
| *dst_addr |= input->byte_stream[IXGBE_ATR_DST_IPV4_OFFSET + 1] << 8; |
| *dst_addr |= input->byte_stream[IXGBE_ATR_DST_IPV4_OFFSET + 2] << 16; |
| *dst_addr |= input->byte_stream[IXGBE_ATR_DST_IPV4_OFFSET + 3] << 24; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_atr_get_src_ipv6_82599 - Gets the source IPv6 address |
| * @input: input stream to search |
| * @src_addr_1: the first 4 bytes of the IP address to load |
| * @src_addr_2: the second 4 bytes of the IP address to load |
| * @src_addr_3: the third 4 bytes of the IP address to load |
| * @src_addr_4: the fourth 4 bytes of the IP address to load |
| **/ |
| static s32 ixgbe_atr_get_src_ipv6_82599(struct ixgbe_atr_input *input, |
| u32 *src_addr_1, u32 *src_addr_2, |
| u32 *src_addr_3, u32 *src_addr_4) |
| { |
| *src_addr_1 = input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 12]; |
| *src_addr_1 = input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 13] << 8; |
| *src_addr_1 = input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 14] << 16; |
| *src_addr_1 = input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 15] << 24; |
| |
| *src_addr_2 = input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 8]; |
| *src_addr_2 = input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 9] << 8; |
| *src_addr_2 = input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 10] << 16; |
| *src_addr_2 = input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 11] << 24; |
| |
| *src_addr_3 = input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 4]; |
| *src_addr_3 = input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 5] << 8; |
| *src_addr_3 = input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 6] << 16; |
| *src_addr_3 = input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 7] << 24; |
| |
| *src_addr_4 = input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET]; |
| *src_addr_4 = input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 1] << 8; |
| *src_addr_4 = input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 2] << 16; |
| *src_addr_4 = input->byte_stream[IXGBE_ATR_SRC_IPV6_OFFSET + 3] << 24; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_atr_get_dst_ipv6_82599 - Gets the destination IPv6 address |
| * @input: input stream to search |
| * @dst_addr_1: the first 4 bytes of the IP address to load |
| * @dst_addr_2: the second 4 bytes of the IP address to load |
| * @dst_addr_3: the third 4 bytes of the IP address to load |
| * @dst_addr_4: the fourth 4 bytes of the IP address to load |
| **/ |
| s32 ixgbe_atr_get_dst_ipv6_82599(struct ixgbe_atr_input *input, |
| u32 *dst_addr_1, u32 *dst_addr_2, |
| u32 *dst_addr_3, u32 *dst_addr_4) |
| { |
| *dst_addr_1 = input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 12]; |
| *dst_addr_1 = input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 13] << 8; |
| *dst_addr_1 = input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 14] << 16; |
| *dst_addr_1 = input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 15] << 24; |
| |
| *dst_addr_2 = input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 8]; |
| *dst_addr_2 = input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 9] << 8; |
| *dst_addr_2 = input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 10] << 16; |
| *dst_addr_2 = input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 11] << 24; |
| |
| *dst_addr_3 = input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 4]; |
| *dst_addr_3 = input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 5] << 8; |
| *dst_addr_3 = input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 6] << 16; |
| *dst_addr_3 = input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 7] << 24; |
| |
| *dst_addr_4 = input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET]; |
| *dst_addr_4 = input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 1] << 8; |
| *dst_addr_4 = input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 2] << 16; |
| *dst_addr_4 = input->byte_stream[IXGBE_ATR_DST_IPV6_OFFSET + 3] << 24; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_atr_get_src_port_82599 - Gets the source port |
| * @input: input stream to modify |
| * @src_port: the source port to load |
| * |
| * Even though the input is given in big-endian, the FDIRPORT registers |
| * expect the ports to be programmed in little-endian. Hence the need to swap |
| * endianness when retrieving the data. This can be confusing since the |
| * internal hash engine expects it to be big-endian. |
| **/ |
| static s32 ixgbe_atr_get_src_port_82599(struct ixgbe_atr_input *input, |
| u16 *src_port) |
| { |
| *src_port = input->byte_stream[IXGBE_ATR_SRC_PORT_OFFSET] << 8; |
| *src_port |= input->byte_stream[IXGBE_ATR_SRC_PORT_OFFSET + 1]; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_atr_get_dst_port_82599 - Gets the destination port |
| * @input: input stream to modify |
| * @dst_port: the destination port to load |
| * |
| * Even though the input is given in big-endian, the FDIRPORT registers |
| * expect the ports to be programmed in little-endian. Hence the need to swap |
| * endianness when retrieving the data. This can be confusing since the |
| * internal hash engine expects it to be big-endian. |
| **/ |
| static s32 ixgbe_atr_get_dst_port_82599(struct ixgbe_atr_input *input, |
| u16 *dst_port) |
| { |
| *dst_port = input->byte_stream[IXGBE_ATR_DST_PORT_OFFSET] << 8; |
| *dst_port |= input->byte_stream[IXGBE_ATR_DST_PORT_OFFSET + 1]; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_atr_get_flex_byte_82599 - Gets the flexible bytes |
| * @input: input stream to modify |
| * @flex_bytes: the flexible bytes to load |
| **/ |
| static s32 ixgbe_atr_get_flex_byte_82599(struct ixgbe_atr_input *input, |
| u16 *flex_byte) |
| { |
| *flex_byte = input->byte_stream[IXGBE_ATR_FLEX_BYTE_OFFSET]; |
| *flex_byte |= input->byte_stream[IXGBE_ATR_FLEX_BYTE_OFFSET + 1] << 8; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_atr_get_vm_pool_82599 - Gets the Virtual Machine pool |
| * @input: input stream to modify |
| * @vm_pool: the Virtual Machine pool to load |
| **/ |
| s32 ixgbe_atr_get_vm_pool_82599(struct ixgbe_atr_input *input, |
| u8 *vm_pool) |
| { |
| *vm_pool = input->byte_stream[IXGBE_ATR_VM_POOL_OFFSET]; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_atr_get_l4type_82599 - Gets the layer 4 packet type |
| * @input: input stream to modify |
| * @l4type: the layer 4 type value to load |
| **/ |
| static s32 ixgbe_atr_get_l4type_82599(struct ixgbe_atr_input *input, |
| u8 *l4type) |
| { |
| *l4type = input->byte_stream[IXGBE_ATR_L4TYPE_OFFSET]; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_atr_add_signature_filter_82599 - Adds a signature hash filter |
| * @hw: pointer to hardware structure |
| * @stream: input bitstream |
| * @queue: queue index to direct traffic to |
| **/ |
| s32 ixgbe_fdir_add_signature_filter_82599(struct ixgbe_hw *hw, |
| struct ixgbe_atr_input *input, |
| u8 queue) |
| { |
| u64 fdirhashcmd; |
| u64 fdircmd; |
| u32 fdirhash; |
| u16 bucket_hash, sig_hash; |
| u8 l4type; |
| |
| bucket_hash = ixgbe_atr_compute_hash_82599(input, |
| IXGBE_ATR_BUCKET_HASH_KEY); |
| |
| /* bucket_hash is only 15 bits */ |
| bucket_hash &= IXGBE_ATR_HASH_MASK; |
| |
| sig_hash = ixgbe_atr_compute_hash_82599(input, |
| IXGBE_ATR_SIGNATURE_HASH_KEY); |
| |
| /* Get the l4type in order to program FDIRCMD properly */ |
| /* lowest 2 bits are FDIRCMD.L4TYPE, third lowest bit is FDIRCMD.IPV6 */ |
| ixgbe_atr_get_l4type_82599(input, &l4type); |
| |
| /* |
| * The lower 32-bits of fdirhashcmd is for FDIRHASH, the upper 32-bits |
| * is for FDIRCMD. Then do a 64-bit register write from FDIRHASH. |
| */ |
| fdirhash = sig_hash << IXGBE_FDIRHASH_SIG_SW_INDEX_SHIFT | bucket_hash; |
| |
| fdircmd = (IXGBE_FDIRCMD_CMD_ADD_FLOW | IXGBE_FDIRCMD_FILTER_UPDATE | |
| IXGBE_FDIRCMD_LAST | IXGBE_FDIRCMD_QUEUE_EN); |
| |
| switch (l4type & IXGBE_ATR_L4TYPE_MASK) { |
| case IXGBE_ATR_L4TYPE_TCP: |
| fdircmd |= IXGBE_FDIRCMD_L4TYPE_TCP; |
| break; |
| case IXGBE_ATR_L4TYPE_UDP: |
| fdircmd |= IXGBE_FDIRCMD_L4TYPE_UDP; |
| break; |
| case IXGBE_ATR_L4TYPE_SCTP: |
| fdircmd |= IXGBE_FDIRCMD_L4TYPE_SCTP; |
| break; |
| default: |
| hw_dbg(hw, "Error on l4type input\n"); |
| return IXGBE_ERR_CONFIG; |
| } |
| |
| if (l4type & IXGBE_ATR_L4TYPE_IPV6_MASK) |
| fdircmd |= IXGBE_FDIRCMD_IPV6; |
| |
| fdircmd |= ((u64)queue << IXGBE_FDIRCMD_RX_QUEUE_SHIFT); |
| fdirhashcmd = ((fdircmd << 32) | fdirhash); |
| |
| IXGBE_WRITE_REG64(hw, IXGBE_FDIRHASH, fdirhashcmd); |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_fdir_add_perfect_filter_82599 - Adds a perfect filter |
| * @hw: pointer to hardware structure |
| * @input: input bitstream |
| * @queue: queue index to direct traffic to |
| * |
| * Note that the caller to this function must lock before calling, since the |
| * hardware writes must be protected from one another. |
| **/ |
| s32 ixgbe_fdir_add_perfect_filter_82599(struct ixgbe_hw *hw, |
| struct ixgbe_atr_input *input, |
| u16 soft_id, |
| u8 queue) |
| { |
| u32 fdircmd = 0; |
| u32 fdirhash; |
| u32 src_ipv4, dst_ipv4; |
| u32 src_ipv6_1, src_ipv6_2, src_ipv6_3, src_ipv6_4; |
| u16 src_port, dst_port, vlan_id, flex_bytes; |
| u16 bucket_hash; |
| u8 l4type; |
| |
| /* Get our input values */ |
| ixgbe_atr_get_l4type_82599(input, &l4type); |
| |
| /* |
| * Check l4type formatting, and bail out before we touch the hardware |
| * if there's a configuration issue |
| */ |
| switch (l4type & IXGBE_ATR_L4TYPE_MASK) { |
| case IXGBE_ATR_L4TYPE_TCP: |
| fdircmd |= IXGBE_FDIRCMD_L4TYPE_TCP; |
| break; |
| case IXGBE_ATR_L4TYPE_UDP: |
| fdircmd |= IXGBE_FDIRCMD_L4TYPE_UDP; |
| break; |
| case IXGBE_ATR_L4TYPE_SCTP: |
| fdircmd |= IXGBE_FDIRCMD_L4TYPE_SCTP; |
| break; |
| default: |
| hw_dbg(hw, "Error on l4type input\n"); |
| return IXGBE_ERR_CONFIG; |
| } |
| |
| bucket_hash = ixgbe_atr_compute_hash_82599(input, |
| IXGBE_ATR_BUCKET_HASH_KEY); |
| |
| /* bucket_hash is only 15 bits */ |
| bucket_hash &= IXGBE_ATR_HASH_MASK; |
| |
| ixgbe_atr_get_vlan_id_82599(input, &vlan_id); |
| ixgbe_atr_get_src_port_82599(input, &src_port); |
| ixgbe_atr_get_dst_port_82599(input, &dst_port); |
| ixgbe_atr_get_flex_byte_82599(input, &flex_bytes); |
| |
| fdirhash = soft_id << IXGBE_FDIRHASH_SIG_SW_INDEX_SHIFT | bucket_hash; |
| |
| /* Now figure out if we're IPv4 or IPv6 */ |
| if (l4type & IXGBE_ATR_L4TYPE_IPV6_MASK) { |
| /* IPv6 */ |
| ixgbe_atr_get_src_ipv6_82599(input, &src_ipv6_1, &src_ipv6_2, |
| &src_ipv6_3, &src_ipv6_4); |
| |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRSIPv6(0), src_ipv6_1); |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRSIPv6(1), src_ipv6_2); |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRSIPv6(2), src_ipv6_3); |
| /* The last 4 bytes is the same register as IPv4 */ |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRIPSA, src_ipv6_4); |
| |
| fdircmd |= IXGBE_FDIRCMD_IPV6; |
| fdircmd |= IXGBE_FDIRCMD_IPv6DMATCH; |
| } else { |
| /* IPv4 */ |
| ixgbe_atr_get_src_ipv4_82599(input, &src_ipv4); |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRIPSA, src_ipv4); |
| |
| } |
| |
| ixgbe_atr_get_dst_ipv4_82599(input, &dst_ipv4); |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRIPDA, dst_ipv4); |
| |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRVLAN, (vlan_id | |
| (flex_bytes << IXGBE_FDIRVLAN_FLEX_SHIFT))); |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRPORT, (src_port | |
| (dst_port << IXGBE_FDIRPORT_DESTINATION_SHIFT))); |
| |
| fdircmd |= IXGBE_FDIRCMD_CMD_ADD_FLOW; |
| fdircmd |= IXGBE_FDIRCMD_FILTER_UPDATE; |
| fdircmd |= IXGBE_FDIRCMD_LAST; |
| fdircmd |= IXGBE_FDIRCMD_QUEUE_EN; |
| fdircmd |= queue << IXGBE_FDIRCMD_RX_QUEUE_SHIFT; |
| |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRHASH, fdirhash); |
| IXGBE_WRITE_REG(hw, IXGBE_FDIRCMD, fdircmd); |
| |
| return 0; |
| } |
| /** |
| * ixgbe_read_analog_reg8_82599 - Reads 8 bit Omer analog register |
| * @hw: pointer to hardware structure |
| * @reg: analog register to read |
| * @val: read value |
| * |
| * Performs read operation to Omer analog register specified. |
| **/ |
| static s32 ixgbe_read_analog_reg8_82599(struct ixgbe_hw *hw, u32 reg, u8 *val) |
| { |
| u32 core_ctl; |
| |
| IXGBE_WRITE_REG(hw, IXGBE_CORECTL, IXGBE_CORECTL_WRITE_CMD | |
| (reg << 8)); |
| IXGBE_WRITE_FLUSH(hw); |
| udelay(10); |
| core_ctl = IXGBE_READ_REG(hw, IXGBE_CORECTL); |
| *val = (u8)core_ctl; |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_write_analog_reg8_82599 - Writes 8 bit Omer analog register |
| * @hw: pointer to hardware structure |
| * @reg: atlas register to write |
| * @val: value to write |
| * |
| * Performs write operation to Omer analog register specified. |
| **/ |
| static s32 ixgbe_write_analog_reg8_82599(struct ixgbe_hw *hw, u32 reg, u8 val) |
| { |
| u32 core_ctl; |
| |
| core_ctl = (reg << 8) | val; |
| IXGBE_WRITE_REG(hw, IXGBE_CORECTL, core_ctl); |
| IXGBE_WRITE_FLUSH(hw); |
| udelay(10); |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_start_hw_82599 - Prepare hardware for Tx/Rx |
| * @hw: pointer to hardware structure |
| * |
| * Starts the hardware using the generic start_hw function. |
| * Then performs device-specific: |
| * Clears the rate limiter registers. |
| **/ |
| static s32 ixgbe_start_hw_82599(struct ixgbe_hw *hw) |
| { |
| u32 q_num; |
| s32 ret_val; |
| |
| ret_val = ixgbe_start_hw_generic(hw); |
| |
| /* Clear the rate limiters */ |
| for (q_num = 0; q_num < hw->mac.max_tx_queues; q_num++) { |
| IXGBE_WRITE_REG(hw, IXGBE_RTTDQSEL, q_num); |
| IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRC, 0); |
| } |
| IXGBE_WRITE_FLUSH(hw); |
| |
| /* We need to run link autotry after the driver loads */ |
| hw->mac.autotry_restart = true; |
| |
| if (ret_val == 0) |
| ret_val = ixgbe_verify_fw_version_82599(hw); |
| |
| return ret_val; |
| } |
| |
| /** |
| * ixgbe_identify_phy_82599 - Get physical layer module |
| * @hw: pointer to hardware structure |
| * |
| * Determines the physical layer module found on the current adapter. |
| **/ |
| static s32 ixgbe_identify_phy_82599(struct ixgbe_hw *hw) |
| { |
| s32 status = IXGBE_ERR_PHY_ADDR_INVALID; |
| status = ixgbe_identify_phy_generic(hw); |
| if (status != 0) |
| status = ixgbe_identify_sfp_module_generic(hw); |
| return status; |
| } |
| |
| /** |
| * ixgbe_get_supported_physical_layer_82599 - Returns physical layer type |
| * @hw: pointer to hardware structure |
| * |
| * Determines physical layer capabilities of the current configuration. |
| **/ |
| static u32 ixgbe_get_supported_physical_layer_82599(struct ixgbe_hw *hw) |
| { |
| u32 physical_layer = IXGBE_PHYSICAL_LAYER_UNKNOWN; |
| u32 autoc = IXGBE_READ_REG(hw, IXGBE_AUTOC); |
| u32 autoc2 = IXGBE_READ_REG(hw, IXGBE_AUTOC2); |
| u32 pma_pmd_10g_serial = autoc2 & IXGBE_AUTOC2_10G_SERIAL_PMA_PMD_MASK; |
| u32 pma_pmd_10g_parallel = autoc & IXGBE_AUTOC_10G_PMA_PMD_MASK; |
| u32 pma_pmd_1g = autoc & IXGBE_AUTOC_1G_PMA_PMD_MASK; |
| u16 ext_ability = 0; |
| u8 comp_codes_10g = 0; |
| |
| hw->phy.ops.identify(hw); |
| |
| if (hw->phy.type == ixgbe_phy_tn || |
| hw->phy.type == ixgbe_phy_cu_unknown) { |
| hw->phy.ops.read_reg(hw, MDIO_PMA_EXTABLE, MDIO_MMD_PMAPMD, |
| &ext_ability); |
| if (ext_ability & MDIO_PMA_EXTABLE_10GBT) |
| physical_layer |= IXGBE_PHYSICAL_LAYER_10GBASE_T; |
| if (ext_ability & MDIO_PMA_EXTABLE_1000BT) |
| physical_layer |= IXGBE_PHYSICAL_LAYER_1000BASE_T; |
| if (ext_ability & MDIO_PMA_EXTABLE_100BTX) |
| physical_layer |= IXGBE_PHYSICAL_LAYER_100BASE_TX; |
| goto out; |
| } |
| |
| switch (autoc & IXGBE_AUTOC_LMS_MASK) { |
| case IXGBE_AUTOC_LMS_1G_AN: |
| case IXGBE_AUTOC_LMS_1G_LINK_NO_AN: |
| if (pma_pmd_1g == IXGBE_AUTOC_1G_KX_BX) { |
| physical_layer = IXGBE_PHYSICAL_LAYER_1000BASE_KX | |
| IXGBE_PHYSICAL_LAYER_1000BASE_BX; |
| goto out; |
| } else |
| /* SFI mode so read SFP module */ |
| goto sfp_check; |
| break; |
| case IXGBE_AUTOC_LMS_10G_LINK_NO_AN: |
| if (pma_pmd_10g_parallel == IXGBE_AUTOC_10G_CX4) |
| physical_layer = IXGBE_PHYSICAL_LAYER_10GBASE_CX4; |
| else if (pma_pmd_10g_parallel == IXGBE_AUTOC_10G_KX4) |
| physical_layer = IXGBE_PHYSICAL_LAYER_10GBASE_KX4; |
| else if (pma_pmd_10g_parallel == IXGBE_AUTOC_10G_XAUI) |
| physical_layer = IXGBE_PHYSICAL_LAYER_10GBASE_XAUI; |
| goto out; |
| break; |
| case IXGBE_AUTOC_LMS_10G_SERIAL: |
| if (pma_pmd_10g_serial == IXGBE_AUTOC2_10G_KR) { |
| physical_layer = IXGBE_PHYSICAL_LAYER_10GBASE_KR; |
| goto out; |
| } else if (pma_pmd_10g_serial == IXGBE_AUTOC2_10G_SFI) |
| goto sfp_check; |
| break; |
| case IXGBE_AUTOC_LMS_KX4_KX_KR: |
| case IXGBE_AUTOC_LMS_KX4_KX_KR_1G_AN: |
| if (autoc & IXGBE_AUTOC_KX_SUPP) |
| physical_layer |= IXGBE_PHYSICAL_LAYER_1000BASE_KX; |
| if (autoc & IXGBE_AUTOC_KX4_SUPP) |
| physical_layer |= IXGBE_PHYSICAL_LAYER_10GBASE_KX4; |
| if (autoc & IXGBE_AUTOC_KR_SUPP) |
| physical_layer |= IXGBE_PHYSICAL_LAYER_10GBASE_KR; |
| goto out; |
| break; |
| default: |
| goto out; |
| break; |
| } |
| |
| sfp_check: |
| /* SFP check must be done last since DA modules are sometimes used to |
| * test KR mode - we need to id KR mode correctly before SFP module. |
| * Call identify_sfp because the pluggable module may have changed */ |
| hw->phy.ops.identify_sfp(hw); |
| if (hw->phy.sfp_type == ixgbe_sfp_type_not_present) |
| goto out; |
| |
| switch (hw->phy.type) { |
| case ixgbe_phy_tw_tyco: |
| case ixgbe_phy_tw_unknown: |
| physical_layer = IXGBE_PHYSICAL_LAYER_SFP_PLUS_CU; |
| break; |
| case ixgbe_phy_sfp_avago: |
| case ixgbe_phy_sfp_ftl: |
| case ixgbe_phy_sfp_intel: |
| case ixgbe_phy_sfp_unknown: |
| hw->phy.ops.read_i2c_eeprom(hw, |
| IXGBE_SFF_10GBE_COMP_CODES, &comp_codes_10g); |
| if (comp_codes_10g & IXGBE_SFF_10GBASESR_CAPABLE) |
| physical_layer = IXGBE_PHYSICAL_LAYER_10GBASE_SR; |
| else if (comp_codes_10g & IXGBE_SFF_10GBASELR_CAPABLE) |
| physical_layer = IXGBE_PHYSICAL_LAYER_10GBASE_LR; |
| break; |
| default: |
| break; |
| } |
| |
| out: |
| return physical_layer; |
| } |
| |
| /** |
| * ixgbe_enable_rx_dma_82599 - Enable the Rx DMA unit on 82599 |
| * @hw: pointer to hardware structure |
| * @regval: register value to write to RXCTRL |
| * |
| * Enables the Rx DMA unit for 82599 |
| **/ |
| static s32 ixgbe_enable_rx_dma_82599(struct ixgbe_hw *hw, u32 regval) |
| { |
| #define IXGBE_MAX_SECRX_POLL 30 |
| int i; |
| int secrxreg; |
| |
| /* |
| * Workaround for 82599 silicon errata when enabling the Rx datapath. |
| * If traffic is incoming before we enable the Rx unit, it could hang |
| * the Rx DMA unit. Therefore, make sure the security engine is |
| * completely disabled prior to enabling the Rx unit. |
| */ |
| secrxreg = IXGBE_READ_REG(hw, IXGBE_SECRXCTRL); |
| secrxreg |= IXGBE_SECRXCTRL_RX_DIS; |
| IXGBE_WRITE_REG(hw, IXGBE_SECRXCTRL, secrxreg); |
| for (i = 0; i < IXGBE_MAX_SECRX_POLL; i++) { |
| secrxreg = IXGBE_READ_REG(hw, IXGBE_SECRXSTAT); |
| if (secrxreg & IXGBE_SECRXSTAT_SECRX_RDY) |
| break; |
| else |
| udelay(10); |
| } |
| |
| /* For informational purposes only */ |
| if (i >= IXGBE_MAX_SECRX_POLL) |
| hw_dbg(hw, "Rx unit being enabled before security " |
| "path fully disabled. Continuing with init.\n"); |
| |
| IXGBE_WRITE_REG(hw, IXGBE_RXCTRL, regval); |
| secrxreg = IXGBE_READ_REG(hw, IXGBE_SECRXCTRL); |
| secrxreg &= ~IXGBE_SECRXCTRL_RX_DIS; |
| IXGBE_WRITE_REG(hw, IXGBE_SECRXCTRL, secrxreg); |
| IXGBE_WRITE_FLUSH(hw); |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_get_device_caps_82599 - Get additional device capabilities |
| * @hw: pointer to hardware structure |
| * @device_caps: the EEPROM word with the extra device capabilities |
| * |
| * This function will read the EEPROM location for the device capabilities, |
| * and return the word through device_caps. |
| **/ |
| static s32 ixgbe_get_device_caps_82599(struct ixgbe_hw *hw, u16 *device_caps) |
| { |
| hw->eeprom.ops.read(hw, IXGBE_DEVICE_CAPS, device_caps); |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_get_san_mac_addr_offset_82599 - SAN MAC address offset for 82599 |
| * @hw: pointer to hardware structure |
| * @san_mac_offset: SAN MAC address offset |
| * |
| * This function will read the EEPROM location for the SAN MAC address |
| * pointer, and returns the value at that location. This is used in both |
| * get and set mac_addr routines. |
| **/ |
| static s32 ixgbe_get_san_mac_addr_offset_82599(struct ixgbe_hw *hw, |
| u16 *san_mac_offset) |
| { |
| /* |
| * First read the EEPROM pointer to see if the MAC addresses are |
| * available. |
| */ |
| hw->eeprom.ops.read(hw, IXGBE_SAN_MAC_ADDR_PTR, san_mac_offset); |
| |
| return 0; |
| } |
| |
| /** |
| * ixgbe_get_san_mac_addr_82599 - SAN MAC address retrieval for 82599 |
| * @hw: pointer to hardware structure |
| * @san_mac_addr: SAN MAC address |
| * |
| * Reads the SAN MAC address from the EEPROM, if it's available. This is |
| * per-port, so set_lan_id() must be called before reading the addresses. |
| * set_lan_id() is called by identify_sfp(), but this cannot be relied |
| * upon for non-SFP connections, so we must call it here. |
| **/ |
| static s32 ixgbe_get_san_mac_addr_82599(struct ixgbe_hw *hw, u8 *san_mac_addr) |
| { |
| u16 san_mac_data, san_mac_offset; |
| u8 i; |
| |
| /* |
| * First read the EEPROM pointer to see if the MAC addresses are |
| * available. If they're not, no point in calling set_lan_id() here. |
| */ |
| ixgbe_get_san_mac_addr_offset_82599(hw, &san_mac_offset); |
| |
| if ((san_mac_offset == 0) || (san_mac_offset == 0xFFFF)) { |
| /* |
| * No addresses available in this EEPROM. It's not an |
| * error though, so just wipe the local address and return. |
| */ |
| for (i = 0; i < 6; i++) |
| san_mac_addr[i] = 0xFF; |
| |
| goto san_mac_addr_out; |
| } |
| |
| /* make sure we know which port we need to program */ |
| hw->mac.ops.set_lan_id(hw); |
| /* apply the port offset to the address offset */ |
| (hw->bus.func) ? (san_mac_offset += IXGBE_SAN_MAC_ADDR_PORT1_OFFSET) : |
| (san_mac_offset += IXGBE_SAN_MAC_ADDR_PORT0_OFFSET); |
| for (i = 0; i < 3; i++) { |
| hw->eeprom.ops.read(hw, san_mac_offset, &san_mac_data); |
| san_mac_addr[i * 2] = (u8)(san_mac_data); |
| san_mac_addr[i * 2 + 1] = (u8)(san_mac_data >> 8); |
| san_mac_offset++; |
| } |
| |
| san_mac_addr_out: |
| return 0; |
| } |
| |
| /** |
| * ixgbe_verify_fw_version_82599 - verify fw version for 82599 |
| * @hw: pointer to hardware structure |
| * |
| * Verifies that installed the firmware version is 0.6 or higher |
| * for SFI devices. All 82599 SFI devices should have version 0.6 or higher. |
| * |
| * Returns IXGBE_ERR_EEPROM_VERSION if the FW is not present or |
| * if the FW version is not supported. |
| **/ |
| static s32 ixgbe_verify_fw_version_82599(struct ixgbe_hw *hw) |
| { |
| s32 status = IXGBE_ERR_EEPROM_VERSION; |
| u16 fw_offset, fw_ptp_cfg_offset; |
| u16 fw_version = 0; |
| |
| /* firmware check is only necessary for SFI devices */ |
| if (hw->phy.media_type != ixgbe_media_type_fiber) { |
| status = 0; |
| goto fw_version_out; |
| } |
| |
| /* get the offset to the Firmware Module block */ |
| hw->eeprom.ops.read(hw, IXGBE_FW_PTR, &fw_offset); |
| |
| if ((fw_offset == 0) || (fw_offset == 0xFFFF)) |
| goto fw_version_out; |
| |
| /* get the offset to the Pass Through Patch Configuration block */ |
| hw->eeprom.ops.read(hw, (fw_offset + |
| IXGBE_FW_PASSTHROUGH_PATCH_CONFIG_PTR), |
| &fw_ptp_cfg_offset); |
| |
| if ((fw_ptp_cfg_offset == 0) || (fw_ptp_cfg_offset == 0xFFFF)) |
| goto fw_version_out; |
| |
| /* get the firmware version */ |
| hw->eeprom.ops.read(hw, (fw_ptp_cfg_offset + |
| IXGBE_FW_PATCH_VERSION_4), |
| &fw_version); |
| |
| if (fw_version > 0x5) |
| status = 0; |
| |
| fw_version_out: |
| return status; |
| } |
| |
| static struct ixgbe_mac_operations mac_ops_82599 = { |
| .init_hw = &ixgbe_init_hw_generic, |
| .reset_hw = &ixgbe_reset_hw_82599, |
| .start_hw = &ixgbe_start_hw_82599, |
| .clear_hw_cntrs = &ixgbe_clear_hw_cntrs_generic, |
| .get_media_type = &ixgbe_get_media_type_82599, |
| .get_supported_physical_layer = &ixgbe_get_supported_physical_layer_82599, |
| .enable_rx_dma = &ixgbe_enable_rx_dma_82599, |
| .get_mac_addr = &ixgbe_get_mac_addr_generic, |
| .get_san_mac_addr = &ixgbe_get_san_mac_addr_82599, |
| .get_device_caps = &ixgbe_get_device_caps_82599, |
| .stop_adapter = &ixgbe_stop_adapter_generic, |
| .get_bus_info = &ixgbe_get_bus_info_generic, |
| .set_lan_id = &ixgbe_set_lan_id_multi_port_pcie, |
| .read_analog_reg8 = &ixgbe_read_analog_reg8_82599, |
| .write_analog_reg8 = &ixgbe_write_analog_reg8_82599, |
| .setup_link = &ixgbe_setup_mac_link_82599, |
| .check_link = &ixgbe_check_mac_link_82599, |
| .get_link_capabilities = &ixgbe_get_link_capabilities_82599, |
| .led_on = &ixgbe_led_on_generic, |
| .led_off = &ixgbe_led_off_generic, |
| .blink_led_start = &ixgbe_blink_led_start_generic, |
| .blink_led_stop = &ixgbe_blink_led_stop_generic, |
| .set_rar = &ixgbe_set_rar_generic, |
| .clear_rar = &ixgbe_clear_rar_generic, |
| .set_vmdq = &ixgbe_set_vmdq_82599, |
| .clear_vmdq = &ixgbe_clear_vmdq_82599, |
| .init_rx_addrs = &ixgbe_init_rx_addrs_generic, |
| .update_uc_addr_list = &ixgbe_update_uc_addr_list_generic, |
| .update_mc_addr_list = &ixgbe_update_mc_addr_list_generic, |
| .enable_mc = &ixgbe_enable_mc_generic, |
| .disable_mc = &ixgbe_disable_mc_generic, |
| .clear_vfta = &ixgbe_clear_vfta_82599, |
| .set_vfta = &ixgbe_set_vfta_82599, |
| .fc_enable = &ixgbe_fc_enable_generic, |
| .init_uta_tables = &ixgbe_init_uta_tables_82599, |
| .setup_sfp = &ixgbe_setup_sfp_modules_82599, |
| }; |
| |
| static struct ixgbe_eeprom_operations eeprom_ops_82599 = { |
| .init_params = &ixgbe_init_eeprom_params_generic, |
| .read = &ixgbe_read_eeprom_generic, |
| .write = &ixgbe_write_eeprom_generic, |
| .validate_checksum = &ixgbe_validate_eeprom_checksum_generic, |
| .update_checksum = &ixgbe_update_eeprom_checksum_generic, |
| }; |
| |
| static struct ixgbe_phy_operations phy_ops_82599 = { |
| .identify = &ixgbe_identify_phy_82599, |
| .identify_sfp = &ixgbe_identify_sfp_module_generic, |
| .init = &ixgbe_init_phy_ops_82599, |
| .reset = &ixgbe_reset_phy_generic, |
| .read_reg = &ixgbe_read_phy_reg_generic, |
| .write_reg = &ixgbe_write_phy_reg_generic, |
| .setup_link = &ixgbe_setup_phy_link_generic, |
| .setup_link_speed = &ixgbe_setup_phy_link_speed_generic, |
| .read_i2c_byte = &ixgbe_read_i2c_byte_generic, |
| .write_i2c_byte = &ixgbe_write_i2c_byte_generic, |
| .read_i2c_eeprom = &ixgbe_read_i2c_eeprom_generic, |
| .write_i2c_eeprom = &ixgbe_write_i2c_eeprom_generic, |
| }; |
| |
| struct ixgbe_info ixgbe_82599_info = { |
| .mac = ixgbe_mac_82599EB, |
| .get_invariants = &ixgbe_get_invariants_82599, |
| .mac_ops = &mac_ops_82599, |
| .eeprom_ops = &eeprom_ops_82599, |
| .phy_ops = &phy_ops_82599, |
| }; |