275 lines
9.3 KiB
C
275 lines
9.3 KiB
C
/*
|
|
* 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);
|
|
|
|
}
|