| /* |
| * Copyright (C) 1999 - 2010 Intel Corporation. |
| * Copyright (C) 2010 OKI SEMICONDUCTOR Co., LTD. |
| * |
| * This code was derived from the Intel e1000e Linux driver. |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; version 2 of the License. |
| * |
| * This program is distributed in the hope that 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA. |
| */ |
| |
| #include "pch_gbe.h" |
| #include "pch_gbe_phy.h" |
| |
| #define PHY_MAX_REG_ADDRESS 0x1F /* 5 bit address bus (0-0x1F) */ |
| |
| /* PHY 1000 MII Register/Bit Definitions */ |
| /* PHY Registers defined by IEEE */ |
| #define PHY_CONTROL 0x00 /* Control Register */ |
| #define PHY_STATUS 0x01 /* Status Regiser */ |
| #define PHY_ID1 0x02 /* Phy Id Register (word 1) */ |
| #define PHY_ID2 0x03 /* Phy Id Register (word 2) */ |
| #define PHY_AUTONEG_ADV 0x04 /* Autoneg Advertisement */ |
| #define PHY_LP_ABILITY 0x05 /* Link Partner Ability (Base Page) */ |
| #define PHY_AUTONEG_EXP 0x06 /* Autoneg Expansion Register */ |
| #define PHY_NEXT_PAGE_TX 0x07 /* Next Page TX */ |
| #define PHY_LP_NEXT_PAGE 0x08 /* Link Partner Next Page */ |
| #define PHY_1000T_CTRL 0x09 /* 1000Base-T Control Register */ |
| #define PHY_1000T_STATUS 0x0A /* 1000Base-T Status Register */ |
| #define PHY_EXT_STATUS 0x0F /* Extended Status Register */ |
| #define PHY_PHYSP_CONTROL 0x10 /* PHY Specific Control Register */ |
| #define PHY_EXT_PHYSP_CONTROL 0x14 /* Extended PHY Specific Control Register */ |
| #define PHY_LED_CONTROL 0x18 /* LED Control Register */ |
| #define PHY_EXT_PHYSP_STATUS 0x1B /* Extended PHY Specific Status Register */ |
| |
| /* PHY Control Register */ |
| #define MII_CR_SPEED_SELECT_MSB 0x0040 /* bits 6,13: 10=1000, 01=100, 00=10 */ |
| #define MII_CR_COLL_TEST_ENABLE 0x0080 /* Collision test enable */ |
| #define MII_CR_FULL_DUPLEX 0x0100 /* FDX =1, half duplex =0 */ |
| #define MII_CR_RESTART_AUTO_NEG 0x0200 /* Restart auto negotiation */ |
| #define MII_CR_ISOLATE 0x0400 /* Isolate PHY from MII */ |
| #define MII_CR_POWER_DOWN 0x0800 /* Power down */ |
| #define MII_CR_AUTO_NEG_EN 0x1000 /* Auto Neg Enable */ |
| #define MII_CR_SPEED_SELECT_LSB 0x2000 /* bits 6,13: 10=1000, 01=100, 00=10 */ |
| #define MII_CR_LOOPBACK 0x4000 /* 0 = normal, 1 = loopback */ |
| #define MII_CR_RESET 0x8000 /* 0 = normal, 1 = PHY reset */ |
| #define MII_CR_SPEED_1000 0x0040 |
| #define MII_CR_SPEED_100 0x2000 |
| #define MII_CR_SPEED_10 0x0000 |
| |
| /* PHY Status Register */ |
| #define MII_SR_EXTENDED_CAPS 0x0001 /* Extended register capabilities */ |
| #define MII_SR_JABBER_DETECT 0x0002 /* Jabber Detected */ |
| #define MII_SR_LINK_STATUS 0x0004 /* Link Status 1 = link */ |
| #define MII_SR_AUTONEG_CAPS 0x0008 /* Auto Neg Capable */ |
| #define MII_SR_REMOTE_FAULT 0x0010 /* Remote Fault Detect */ |
| #define MII_SR_AUTONEG_COMPLETE 0x0020 /* Auto Neg Complete */ |
| #define MII_SR_PREAMBLE_SUPPRESS 0x0040 /* Preamble may be suppressed */ |
| #define MII_SR_EXTENDED_STATUS 0x0100 /* Ext. status info in Reg 0x0F */ |
| #define MII_SR_100T2_HD_CAPS 0x0200 /* 100T2 Half Duplex Capable */ |
| #define MII_SR_100T2_FD_CAPS 0x0400 /* 100T2 Full Duplex Capable */ |
| #define MII_SR_10T_HD_CAPS 0x0800 /* 10T Half Duplex Capable */ |
| #define MII_SR_10T_FD_CAPS 0x1000 /* 10T Full Duplex Capable */ |
| #define MII_SR_100X_HD_CAPS 0x2000 /* 100X Half Duplex Capable */ |
| #define MII_SR_100X_FD_CAPS 0x4000 /* 100X Full Duplex Capable */ |
| #define MII_SR_100T4_CAPS 0x8000 /* 100T4 Capable */ |
| |
| /* Phy Id Register (word 2) */ |
| #define PHY_REVISION_MASK 0x000F |
| |
| /* PHY Specific Control Register */ |
| #define PHYSP_CTRL_ASSERT_CRS_TX 0x0800 |
| |
| |
| /* Default value of PHY register */ |
| #define PHY_CONTROL_DEFAULT 0x1140 /* Control Register */ |
| #define PHY_AUTONEG_ADV_DEFAULT 0x01e0 /* Autoneg Advertisement */ |
| #define PHY_NEXT_PAGE_TX_DEFAULT 0x2001 /* Next Page TX */ |
| #define PHY_1000T_CTRL_DEFAULT 0x0300 /* 1000Base-T Control Register */ |
| #define PHY_PHYSP_CONTROL_DEFAULT 0x01EE /* PHY Specific Control Register */ |
| |
| /** |
| * pch_gbe_phy_get_id - Retrieve the PHY ID and revision |
| * @hw: Pointer to the HW structure |
| * Returns |
| * 0: Successful. |
| * Negative value: Failed. |
| */ |
| s32 pch_gbe_phy_get_id(struct pch_gbe_hw *hw) |
| { |
| struct pch_gbe_phy_info *phy = &hw->phy; |
| s32 ret; |
| u16 phy_id1; |
| u16 phy_id2; |
| |
| ret = pch_gbe_phy_read_reg_miic(hw, PHY_ID1, &phy_id1); |
| if (ret) |
| return ret; |
| ret = pch_gbe_phy_read_reg_miic(hw, PHY_ID2, &phy_id2); |
| if (ret) |
| return ret; |
| /* |
| * PHY_ID1: [bit15-0:ID(21-6)] |
| * PHY_ID2: [bit15-10:ID(5-0)][bit9-4:Model][bit3-0:revision] |
| */ |
| phy->id = (u32)phy_id1; |
| phy->id = ((phy->id << 6) | ((phy_id2 & 0xFC00) >> 10)); |
| phy->revision = (u32) (phy_id2 & 0x000F); |
| pr_debug("phy->id : 0x%08x phy->revision : 0x%08x\n", |
| phy->id, phy->revision); |
| return 0; |
| } |
| |
| /** |
| * pch_gbe_phy_read_reg_miic - Read MII control register |
| * @hw: Pointer to the HW structure |
| * @offset: Register offset to be read |
| * @data: Pointer to the read data |
| * Returns |
| * 0: Successful. |
| * -EINVAL: Invalid argument. |
| */ |
| s32 pch_gbe_phy_read_reg_miic(struct pch_gbe_hw *hw, u32 offset, u16 *data) |
| { |
| struct pch_gbe_phy_info *phy = &hw->phy; |
| |
| if (offset > PHY_MAX_REG_ADDRESS) { |
| pr_err("PHY Address %d is out of range\n", offset); |
| return -EINVAL; |
| } |
| *data = pch_gbe_mac_ctrl_miim(hw, phy->addr, PCH_GBE_HAL_MIIM_READ, |
| offset, (u16)0); |
| return 0; |
| } |
| |
| /** |
| * pch_gbe_phy_write_reg_miic - Write MII control register |
| * @hw: Pointer to the HW structure |
| * @offset: Register offset to be read |
| * @data: data to write to register at offset |
| * Returns |
| * 0: Successful. |
| * -EINVAL: Invalid argument. |
| */ |
| s32 pch_gbe_phy_write_reg_miic(struct pch_gbe_hw *hw, u32 offset, u16 data) |
| { |
| struct pch_gbe_phy_info *phy = &hw->phy; |
| |
| if (offset > PHY_MAX_REG_ADDRESS) { |
| pr_err("PHY Address %d is out of range\n", offset); |
| return -EINVAL; |
| } |
| pch_gbe_mac_ctrl_miim(hw, phy->addr, PCH_GBE_HAL_MIIM_WRITE, |
| offset, data); |
| return 0; |
| } |
| |
| /** |
| * pch_gbe_phy_sw_reset - PHY software reset |
| * @hw: Pointer to the HW structure |
| */ |
| void pch_gbe_phy_sw_reset(struct pch_gbe_hw *hw) |
| { |
| u16 phy_ctrl; |
| |
| pch_gbe_phy_read_reg_miic(hw, PHY_CONTROL, &phy_ctrl); |
| phy_ctrl |= MII_CR_RESET; |
| pch_gbe_phy_write_reg_miic(hw, PHY_CONTROL, phy_ctrl); |
| udelay(1); |
| } |
| |
| /** |
| * pch_gbe_phy_hw_reset - PHY hardware reset |
| * @hw: Pointer to the HW structure |
| */ |
| void pch_gbe_phy_hw_reset(struct pch_gbe_hw *hw) |
| { |
| pch_gbe_phy_write_reg_miic(hw, PHY_CONTROL, PHY_CONTROL_DEFAULT); |
| pch_gbe_phy_write_reg_miic(hw, PHY_AUTONEG_ADV, |
| PHY_AUTONEG_ADV_DEFAULT); |
| pch_gbe_phy_write_reg_miic(hw, PHY_NEXT_PAGE_TX, |
| PHY_NEXT_PAGE_TX_DEFAULT); |
| pch_gbe_phy_write_reg_miic(hw, PHY_1000T_CTRL, PHY_1000T_CTRL_DEFAULT); |
| pch_gbe_phy_write_reg_miic(hw, PHY_PHYSP_CONTROL, |
| PHY_PHYSP_CONTROL_DEFAULT); |
| } |
| |
| /** |
| * pch_gbe_phy_power_up - restore link in case the phy was powered down |
| * @hw: Pointer to the HW structure |
| */ |
| void pch_gbe_phy_power_up(struct pch_gbe_hw *hw) |
| { |
| u16 mii_reg; |
| |
| mii_reg = 0; |
| /* Just clear the power down bit to wake the phy back up */ |
| /* according to the manual, the phy will retain its |
| * settings across a power-down/up cycle */ |
| pch_gbe_phy_read_reg_miic(hw, PHY_CONTROL, &mii_reg); |
| mii_reg &= ~MII_CR_POWER_DOWN; |
| pch_gbe_phy_write_reg_miic(hw, PHY_CONTROL, mii_reg); |
| } |
| |
| /** |
| * pch_gbe_phy_power_down - Power down PHY |
| * @hw: Pointer to the HW structure |
| */ |
| void pch_gbe_phy_power_down(struct pch_gbe_hw *hw) |
| { |
| u16 mii_reg; |
| |
| mii_reg = 0; |
| /* Power down the PHY so no link is implied when interface is down * |
| * The PHY cannot be powered down if any of the following is TRUE * |
| * (a) WoL is enabled |
| * (b) AMT is active |
| */ |
| pch_gbe_phy_read_reg_miic(hw, PHY_CONTROL, &mii_reg); |
| mii_reg |= MII_CR_POWER_DOWN; |
| pch_gbe_phy_write_reg_miic(hw, PHY_CONTROL, mii_reg); |
| mdelay(1); |
| } |
| |
| /** |
| * pch_gbe_phy_set_rgmii - RGMII interface setting |
| * @hw: Pointer to the HW structure |
| */ |
| inline void pch_gbe_phy_set_rgmii(struct pch_gbe_hw *hw) |
| { |
| pch_gbe_phy_sw_reset(hw); |
| } |
| |
| /** |
| * pch_gbe_phy_init_setting - PHY initial setting |
| * @hw: Pointer to the HW structure |
| */ |
| void pch_gbe_phy_init_setting(struct pch_gbe_hw *hw) |
| { |
| struct pch_gbe_adapter *adapter; |
| struct ethtool_cmd cmd = { .cmd = ETHTOOL_GSET }; |
| int ret; |
| u16 mii_reg; |
| |
| adapter = container_of(hw, struct pch_gbe_adapter, hw); |
| ret = mii_ethtool_gset(&adapter->mii, &cmd); |
| if (ret) |
| pr_err("Error: mii_ethtool_gset\n"); |
| |
| ethtool_cmd_speed_set(&cmd, hw->mac.link_speed); |
| cmd.duplex = hw->mac.link_duplex; |
| cmd.advertising = hw->phy.autoneg_advertised; |
| cmd.autoneg = hw->mac.autoneg; |
| pch_gbe_phy_write_reg_miic(hw, MII_BMCR, BMCR_RESET); |
| ret = mii_ethtool_sset(&adapter->mii, &cmd); |
| if (ret) |
| pr_err("Error: mii_ethtool_sset\n"); |
| |
| pch_gbe_phy_sw_reset(hw); |
| |
| pch_gbe_phy_read_reg_miic(hw, PHY_PHYSP_CONTROL, &mii_reg); |
| mii_reg |= PHYSP_CTRL_ASSERT_CRS_TX; |
| pch_gbe_phy_write_reg_miic(hw, PHY_PHYSP_CONTROL, mii_reg); |
| |
| } |