mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-07-06 11:16:15 +09:00
83d290c56f
When U-Boot started using SPDX tags we were among the early adopters and there weren't a lot of other examples to borrow from. So we picked the area of the file that usually had a full license text and replaced it with an appropriate SPDX-License-Identifier: entry. Since then, the Linux Kernel has adopted SPDX tags and they place it as the very first line in a file (except where shebangs are used, then it's second line) and with slightly different comment styles than us. In part due to community overlap, in part due to better tag visibility and in part for other minor reasons, switch over to that style. This commit changes all instances where we have a single declared license in the tag as both the before and after are identical in tag contents. There's also a few places where I found we did not have a tag and have introduced one. Signed-off-by: Tom Rini <trini@konsulko.com>
509 lines
15 KiB
C
509 lines
15 KiB
C
// SPDX-License-Identifier: MIT
|
|
/*
|
|
* Microsemi PHY drivers
|
|
*
|
|
*
|
|
* Copyright (c) 2016 Microsemi Corporation
|
|
*
|
|
* Author: John Haechten
|
|
*
|
|
*/
|
|
|
|
#include <miiphy.h>
|
|
#include <bitfield.h>
|
|
|
|
/* Microsemi PHY ID's */
|
|
#define PHY_ID_VSC8530 0x00070560
|
|
#define PHY_ID_VSC8531 0x00070570
|
|
#define PHY_ID_VSC8540 0x00070760
|
|
#define PHY_ID_VSC8541 0x00070770
|
|
|
|
/* Microsemi VSC85xx PHY Register Pages */
|
|
#define MSCC_EXT_PAGE_ACCESS 31 /* Page Access Register */
|
|
#define MSCC_PHY_PAGE_STD 0x0000 /* Standard registers */
|
|
#define MSCC_PHY_PAGE_EXT1 0x0001 /* Extended registers - page 1 */
|
|
#define MSCC_PHY_PAGE_EXT2 0x0002 /* Extended registers - page 2 */
|
|
#define MSCC_PHY_PAGE_EXT3 0x0003 /* Extended registers - page 3 */
|
|
#define MSCC_PHY_PAGE_EXT4 0x0004 /* Extended registers - page 4 */
|
|
#define MSCC_PHY_PAGE_GPIO 0x0010 /* GPIO registers */
|
|
#define MSCC_PHY_PAGE_TEST 0x2A30 /* TEST Page registers */
|
|
#define MSCC_PHY_PAGE_TR 0x52B5 /* Token Ring Page registers */
|
|
|
|
/* Std Page Register 28 - PHY AUX Control/Status */
|
|
#define MIIM_AUX_CNTRL_STAT_REG 28
|
|
#define MIIM_AUX_CNTRL_STAT_ACTIPHY_TO (0x0004)
|
|
#define MIIM_AUX_CNTRL_STAT_F_DUPLEX (0x0020)
|
|
#define MIIM_AUX_CNTRL_STAT_SPEED_MASK (0x0018)
|
|
#define MIIM_AUX_CNTRL_STAT_SPEED_POS (3)
|
|
#define MIIM_AUX_CNTRL_STAT_SPEED_10M (0x0)
|
|
#define MIIM_AUX_CNTRL_STAT_SPEED_100M (0x1)
|
|
#define MIIM_AUX_CNTRL_STAT_SPEED_1000M (0x2)
|
|
|
|
/* Std Page Register 23 - Extended PHY CTRL_1 */
|
|
#define MSCC_PHY_EXT_PHY_CNTL_1_REG 23
|
|
#define MAC_IF_SELECTION_MASK (0x1800)
|
|
#define MAC_IF_SELECTION_GMII (0)
|
|
#define MAC_IF_SELECTION_RMII (1)
|
|
#define MAC_IF_SELECTION_RGMII (2)
|
|
#define MAC_IF_SELECTION_POS (11)
|
|
#define MAC_IF_SELECTION_WIDTH (2)
|
|
|
|
/* Extended Page 2 Register 20E2 */
|
|
#define MSCC_PHY_RGMII_CNTL_REG 20
|
|
#define VSC_FAST_LINK_FAIL2_ENA_MASK (0x8000)
|
|
#define RX_CLK_OUT_MASK (0x0800)
|
|
#define RX_CLK_OUT_POS (11)
|
|
#define RX_CLK_OUT_WIDTH (1)
|
|
#define RX_CLK_OUT_NORMAL (0)
|
|
#define RX_CLK_OUT_DISABLE (1)
|
|
#define RGMII_RX_CLK_DELAY_POS (4)
|
|
#define RGMII_RX_CLK_DELAY_WIDTH (3)
|
|
#define RGMII_RX_CLK_DELAY_MASK (0x0070)
|
|
#define RGMII_TX_CLK_DELAY_POS (0)
|
|
#define RGMII_TX_CLK_DELAY_WIDTH (3)
|
|
#define RGMII_TX_CLK_DELAY_MASK (0x0007)
|
|
|
|
/* Extended Page 2 Register 27E2 */
|
|
#define MSCC_PHY_WOL_MAC_CONTROL 27
|
|
#define EDGE_RATE_CNTL_POS (5)
|
|
#define EDGE_RATE_CNTL_WIDTH (3)
|
|
#define EDGE_RATE_CNTL_MASK (0x00E0)
|
|
#define RMII_CLK_OUT_ENABLE_POS (4)
|
|
#define RMII_CLK_OUT_ENABLE_WIDTH (1)
|
|
#define RMII_CLK_OUT_ENABLE_MASK (0x10)
|
|
|
|
/* Token Ring Page 0x52B5 Registers */
|
|
#define MSCC_PHY_REG_TR_ADDR_16 16
|
|
#define MSCC_PHY_REG_TR_DATA_17 17
|
|
#define MSCC_PHY_REG_TR_DATA_18 18
|
|
|
|
/* Token Ring - Read Value in */
|
|
#define MSCC_PHY_TR_16_READ (0xA000)
|
|
/* Token Ring - Write Value out */
|
|
#define MSCC_PHY_TR_16_WRITE (0x8000)
|
|
|
|
/* Token Ring Registers */
|
|
#define MSCC_PHY_TR_LINKDETCTRL_POS (3)
|
|
#define MSCC_PHY_TR_LINKDETCTRL_WIDTH (2)
|
|
#define MSCC_PHY_TR_LINKDETCTRL_VAL (3)
|
|
#define MSCC_PHY_TR_LINKDETCTRL_MASK (0x0018)
|
|
#define MSCC_PHY_TR_LINKDETCTRL_ADDR (0x07F8)
|
|
|
|
#define MSCC_PHY_TR_VGATHRESH100_POS (0)
|
|
#define MSCC_PHY_TR_VGATHRESH100_WIDTH (7)
|
|
#define MSCC_PHY_TR_VGATHRESH100_VAL (0x0018)
|
|
#define MSCC_PHY_TR_VGATHRESH100_MASK (0x007f)
|
|
#define MSCC_PHY_TR_VGATHRESH100_ADDR (0x0FA4)
|
|
|
|
#define MSCC_PHY_TR_VGAGAIN10_U_POS (0)
|
|
#define MSCC_PHY_TR_VGAGAIN10_U_WIDTH (1)
|
|
#define MSCC_PHY_TR_VGAGAIN10_U_MASK (0x0001)
|
|
#define MSCC_PHY_TR_VGAGAIN10_U_VAL (0)
|
|
|
|
#define MSCC_PHY_TR_VGAGAIN10_L_POS (12)
|
|
#define MSCC_PHY_TR_VGAGAIN10_L_WIDTH (4)
|
|
#define MSCC_PHY_TR_VGAGAIN10_L_MASK (0xf000)
|
|
#define MSCC_PHY_TR_VGAGAIN10_L_VAL (0x0001)
|
|
#define MSCC_PHY_TR_VGAGAIN10_ADDR (0x0F92)
|
|
|
|
/* General Timeout Values */
|
|
#define MSCC_PHY_RESET_TIMEOUT (100)
|
|
#define MSCC_PHY_MICRO_TIMEOUT (500)
|
|
|
|
/* RGMII/GMII Clock Delay (Skew) Options */ enum vsc_phy_rgmii_skew {
|
|
VSC_PHY_RGMII_DELAY_200_PS,
|
|
VSC_PHY_RGMII_DELAY_800_PS,
|
|
VSC_PHY_RGMII_DELAY_1100_PS,
|
|
VSC_PHY_RGMII_DELAY_1700_PS,
|
|
VSC_PHY_RGMII_DELAY_2000_PS,
|
|
VSC_PHY_RGMII_DELAY_2300_PS,
|
|
VSC_PHY_RGMII_DELAY_2600_PS,
|
|
VSC_PHY_RGMII_DELAY_3400_PS,
|
|
};
|
|
|
|
/* MAC i/f Clock Edge Rage Control (Slew), See Reg27E2 */ enum
|
|
vsc_phy_clk_slew {
|
|
VSC_PHY_CLK_SLEW_RATE_0,
|
|
VSC_PHY_CLK_SLEW_RATE_1,
|
|
VSC_PHY_CLK_SLEW_RATE_2,
|
|
VSC_PHY_CLK_SLEW_RATE_3,
|
|
VSC_PHY_CLK_SLEW_RATE_4,
|
|
VSC_PHY_CLK_SLEW_RATE_5,
|
|
VSC_PHY_CLK_SLEW_RATE_6,
|
|
VSC_PHY_CLK_SLEW_RATE_7,
|
|
};
|
|
|
|
|
|
static int mscc_vsc8531_vsc8541_init_scripts(struct phy_device *phydev)
|
|
{
|
|
u16 reg_val;
|
|
|
|
/* Set to Access Token Ring Registers */
|
|
phy_write(phydev, MDIO_DEVAD_NONE,
|
|
MSCC_EXT_PAGE_ACCESS, MSCC_PHY_PAGE_TR);
|
|
|
|
/* Update LinkDetectCtrl default to optimized values */
|
|
/* Determined during Silicon Validation Testing */
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_PHY_REG_TR_ADDR_16,
|
|
(MSCC_PHY_TR_LINKDETCTRL_ADDR | MSCC_PHY_TR_16_READ));
|
|
reg_val = phy_read(phydev, MDIO_DEVAD_NONE, MSCC_PHY_REG_TR_DATA_17);
|
|
reg_val = bitfield_replace(reg_val, MSCC_PHY_TR_LINKDETCTRL_POS,
|
|
MSCC_PHY_TR_LINKDETCTRL_WIDTH,
|
|
MSCC_PHY_TR_LINKDETCTRL_VAL);
|
|
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_PHY_REG_TR_DATA_17, reg_val);
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_PHY_REG_TR_ADDR_16,
|
|
(MSCC_PHY_TR_LINKDETCTRL_ADDR | MSCC_PHY_TR_16_WRITE));
|
|
|
|
/* Update VgaThresh100 defaults to optimized values */
|
|
/* Determined during Silicon Validation Testing */
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_PHY_REG_TR_ADDR_16,
|
|
(MSCC_PHY_TR_VGATHRESH100_ADDR | MSCC_PHY_TR_16_READ));
|
|
|
|
reg_val = phy_read(phydev, MDIO_DEVAD_NONE, MSCC_PHY_REG_TR_DATA_18);
|
|
reg_val = bitfield_replace(reg_val, MSCC_PHY_TR_VGATHRESH100_POS,
|
|
MSCC_PHY_TR_VGATHRESH100_WIDTH,
|
|
MSCC_PHY_TR_VGATHRESH100_VAL);
|
|
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_PHY_REG_TR_DATA_18, reg_val);
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_PHY_REG_TR_ADDR_16,
|
|
(MSCC_PHY_TR_VGATHRESH100_ADDR | MSCC_PHY_TR_16_WRITE));
|
|
|
|
/* Update VgaGain10 defaults to optimized values */
|
|
/* Determined during Silicon Validation Testing */
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_PHY_REG_TR_ADDR_16,
|
|
(MSCC_PHY_TR_VGAGAIN10_ADDR | MSCC_PHY_TR_16_READ));
|
|
|
|
reg_val = phy_read(phydev, MDIO_DEVAD_NONE, MSCC_PHY_REG_TR_DATA_18);
|
|
reg_val = bitfield_replace(reg_val, MSCC_PHY_TR_VGAGAIN10_U_POS,
|
|
MSCC_PHY_TR_VGAGAIN10_U_WIDTH,
|
|
MSCC_PHY_TR_VGAGAIN10_U_VAL);
|
|
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_PHY_REG_TR_DATA_18, reg_val);
|
|
reg_val = phy_read(phydev, MDIO_DEVAD_NONE, MSCC_PHY_REG_TR_DATA_17);
|
|
reg_val = bitfield_replace(reg_val, MSCC_PHY_TR_VGAGAIN10_L_POS,
|
|
MSCC_PHY_TR_VGAGAIN10_L_WIDTH,
|
|
MSCC_PHY_TR_VGAGAIN10_L_VAL);
|
|
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_PHY_REG_TR_DATA_17, reg_val);
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_PHY_REG_TR_ADDR_16,
|
|
(MSCC_PHY_TR_VGAGAIN10_ADDR | MSCC_PHY_TR_16_WRITE));
|
|
|
|
/* Set back to Access Standard Page Registers */
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_EXT_PAGE_ACCESS,
|
|
MSCC_PHY_PAGE_STD);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int mscc_parse_status(struct phy_device *phydev)
|
|
{
|
|
u16 speed;
|
|
u16 mii_reg;
|
|
|
|
mii_reg = phy_read(phydev, MDIO_DEVAD_NONE, MIIM_AUX_CNTRL_STAT_REG);
|
|
|
|
if (mii_reg & MIIM_AUX_CNTRL_STAT_F_DUPLEX)
|
|
phydev->duplex = DUPLEX_FULL;
|
|
else
|
|
phydev->duplex = DUPLEX_HALF;
|
|
|
|
speed = mii_reg & MIIM_AUX_CNTRL_STAT_SPEED_MASK;
|
|
speed = speed >> MIIM_AUX_CNTRL_STAT_SPEED_POS;
|
|
|
|
switch (speed) {
|
|
case MIIM_AUX_CNTRL_STAT_SPEED_1000M:
|
|
phydev->speed = SPEED_1000;
|
|
break;
|
|
case MIIM_AUX_CNTRL_STAT_SPEED_100M:
|
|
phydev->speed = SPEED_100;
|
|
break;
|
|
case MIIM_AUX_CNTRL_STAT_SPEED_10M:
|
|
phydev->speed = SPEED_10;
|
|
break;
|
|
default:
|
|
phydev->speed = SPEED_10;
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int mscc_startup(struct phy_device *phydev)
|
|
{
|
|
int retval;
|
|
|
|
retval = genphy_update_link(phydev);
|
|
|
|
if (retval)
|
|
return retval;
|
|
|
|
return mscc_parse_status(phydev);
|
|
}
|
|
|
|
static int mscc_phy_soft_reset(struct phy_device *phydev)
|
|
{
|
|
int retval = 0;
|
|
u16 timeout = MSCC_PHY_RESET_TIMEOUT;
|
|
u16 reg_val = 0;
|
|
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_EXT_PAGE_ACCESS,
|
|
MSCC_PHY_PAGE_STD);
|
|
|
|
reg_val = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMCR);
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MII_BMCR, (reg_val | BMCR_RESET));
|
|
|
|
reg_val = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMCR);
|
|
|
|
while ((reg_val & BMCR_RESET) && (timeout > 0)) {
|
|
reg_val = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMCR);
|
|
timeout--;
|
|
udelay(1000); /* 1 ms */
|
|
}
|
|
|
|
if (timeout == 0) {
|
|
printf("MSCC PHY Soft_Reset Error: mac i/f = 0x%x\n",
|
|
phydev->interface);
|
|
retval = -ETIME;
|
|
}
|
|
|
|
return retval;
|
|
}
|
|
|
|
static int vsc8531_vsc8541_mac_config(struct phy_device *phydev)
|
|
{
|
|
u16 reg_val = 0;
|
|
u16 mac_if = 0;
|
|
u16 rx_clk_out = 0;
|
|
|
|
/* For VSC8530/31 the only MAC modes are RMII/RGMII. */
|
|
/* For VSC8540/41 the only MAC modes are (G)MII and RMII/RGMII. */
|
|
/* Setup MAC Configuration */
|
|
switch (phydev->interface) {
|
|
case PHY_INTERFACE_MODE_MII:
|
|
case PHY_INTERFACE_MODE_GMII:
|
|
/* Set Reg23.12:11=0 */
|
|
mac_if = MAC_IF_SELECTION_GMII;
|
|
/* Set Reg20E2.11=1 */
|
|
rx_clk_out = RX_CLK_OUT_DISABLE;
|
|
break;
|
|
|
|
case PHY_INTERFACE_MODE_RMII:
|
|
/* Set Reg23.12:11=1 */
|
|
mac_if = MAC_IF_SELECTION_RMII;
|
|
/* Set Reg20E2.11=0 */
|
|
rx_clk_out = RX_CLK_OUT_NORMAL;
|
|
break;
|
|
|
|
case PHY_INTERFACE_MODE_RGMII:
|
|
/* Set Reg23.12:11=2 */
|
|
mac_if = MAC_IF_SELECTION_RGMII;
|
|
/* Set Reg20E2.11=0 */
|
|
rx_clk_out = RX_CLK_OUT_NORMAL;
|
|
break;
|
|
|
|
default:
|
|
printf("MSCC PHY - INVALID MAC i/f Config: mac i/f = 0x%x\n",
|
|
phydev->interface);
|
|
return -EINVAL;
|
|
}
|
|
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_EXT_PAGE_ACCESS,
|
|
MSCC_PHY_PAGE_STD);
|
|
|
|
reg_val = phy_read(phydev, MDIO_DEVAD_NONE,
|
|
MSCC_PHY_EXT_PHY_CNTL_1_REG);
|
|
/* Set MAC i/f bits Reg23.12:11 */
|
|
reg_val = bitfield_replace(reg_val, MAC_IF_SELECTION_POS,
|
|
MAC_IF_SELECTION_WIDTH, mac_if);
|
|
/* Update Reg23.12:11 */
|
|
phy_write(phydev, MDIO_DEVAD_NONE,
|
|
MSCC_PHY_EXT_PHY_CNTL_1_REG, reg_val);
|
|
/* Setup ExtPg_2 Register Access */
|
|
phy_write(phydev, MDIO_DEVAD_NONE,
|
|
MSCC_EXT_PAGE_ACCESS, MSCC_PHY_PAGE_EXT2);
|
|
/* Read Reg20E2 */
|
|
reg_val = phy_read(phydev, MDIO_DEVAD_NONE,
|
|
MSCC_PHY_RGMII_CNTL_REG);
|
|
reg_val = bitfield_replace(reg_val, RX_CLK_OUT_POS,
|
|
RX_CLK_OUT_WIDTH, rx_clk_out);
|
|
/* Update Reg20E2.11 */
|
|
phy_write(phydev, MDIO_DEVAD_NONE,
|
|
MSCC_PHY_RGMII_CNTL_REG, reg_val);
|
|
/* Before leaving - Change back to Std Page Register Access */
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_EXT_PAGE_ACCESS,
|
|
MSCC_PHY_PAGE_STD);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int vsc8531_config(struct phy_device *phydev)
|
|
{
|
|
int retval = -EINVAL;
|
|
u16 reg_val;
|
|
u16 rmii_clk_out;
|
|
enum vsc_phy_rgmii_skew rx_clk_skew = VSC_PHY_RGMII_DELAY_1700_PS;
|
|
enum vsc_phy_rgmii_skew tx_clk_skew = VSC_PHY_RGMII_DELAY_800_PS;
|
|
enum vsc_phy_clk_slew edge_rate = VSC_PHY_CLK_SLEW_RATE_4;
|
|
|
|
/* For VSC8530/31 and VSC8540/41 the init scripts are the same */
|
|
mscc_vsc8531_vsc8541_init_scripts(phydev);
|
|
|
|
/* For VSC8530/31 the only MAC modes are RMII/RGMII. */
|
|
switch (phydev->interface) {
|
|
case PHY_INTERFACE_MODE_RMII:
|
|
case PHY_INTERFACE_MODE_RGMII:
|
|
retval = vsc8531_vsc8541_mac_config(phydev);
|
|
if (retval != 0)
|
|
return retval;
|
|
|
|
retval = mscc_phy_soft_reset(phydev);
|
|
if (retval != 0)
|
|
return retval;
|
|
break;
|
|
default:
|
|
printf("PHY 8530/31 MAC i/f Config Error: mac i/f = 0x%x\n",
|
|
phydev->interface);
|
|
return -EINVAL;
|
|
}
|
|
/* Default RMII Clk Output to 0=OFF/1=ON */
|
|
rmii_clk_out = 0;
|
|
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_EXT_PAGE_ACCESS,
|
|
MSCC_PHY_PAGE_EXT2);
|
|
reg_val = phy_read(phydev, MDIO_DEVAD_NONE, MSCC_PHY_RGMII_CNTL_REG);
|
|
|
|
/* Reg20E2 - Update RGMII RX_Clk Skews. */
|
|
reg_val = bitfield_replace(reg_val, RGMII_RX_CLK_DELAY_POS,
|
|
RGMII_RX_CLK_DELAY_WIDTH, rx_clk_skew);
|
|
/* Reg20E2 - Update RGMII TX_Clk Skews. */
|
|
reg_val = bitfield_replace(reg_val, RGMII_TX_CLK_DELAY_POS,
|
|
RGMII_TX_CLK_DELAY_WIDTH, tx_clk_skew);
|
|
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_PHY_RGMII_CNTL_REG, reg_val);
|
|
|
|
reg_val = phy_read(phydev, MDIO_DEVAD_NONE, MSCC_PHY_WOL_MAC_CONTROL);
|
|
/* Reg27E2 - Update Clk Slew Rate. */
|
|
reg_val = bitfield_replace(reg_val, EDGE_RATE_CNTL_POS,
|
|
EDGE_RATE_CNTL_WIDTH, edge_rate);
|
|
/* Reg27E2 - Update RMII Clk Out. */
|
|
reg_val = bitfield_replace(reg_val, RMII_CLK_OUT_ENABLE_POS,
|
|
RMII_CLK_OUT_ENABLE_WIDTH, rmii_clk_out);
|
|
/* Update Reg27E2 */
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_PHY_WOL_MAC_CONTROL, reg_val);
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_EXT_PAGE_ACCESS,
|
|
MSCC_PHY_PAGE_STD);
|
|
|
|
return genphy_config_aneg(phydev);
|
|
}
|
|
|
|
static int vsc8541_config(struct phy_device *phydev)
|
|
{
|
|
int retval = -EINVAL;
|
|
u16 reg_val;
|
|
u16 rmii_clk_out;
|
|
enum vsc_phy_rgmii_skew rx_clk_skew = VSC_PHY_RGMII_DELAY_1700_PS;
|
|
enum vsc_phy_rgmii_skew tx_clk_skew = VSC_PHY_RGMII_DELAY_800_PS;
|
|
enum vsc_phy_clk_slew edge_rate = VSC_PHY_CLK_SLEW_RATE_4;
|
|
|
|
/* For VSC8530/31 and VSC8540/41 the init scripts are the same */
|
|
mscc_vsc8531_vsc8541_init_scripts(phydev);
|
|
|
|
/* For VSC8540/41 the only MAC modes are (G)MII and RMII/RGMII. */
|
|
switch (phydev->interface) {
|
|
case PHY_INTERFACE_MODE_MII:
|
|
case PHY_INTERFACE_MODE_GMII:
|
|
case PHY_INTERFACE_MODE_RMII:
|
|
case PHY_INTERFACE_MODE_RGMII:
|
|
retval = vsc8531_vsc8541_mac_config(phydev);
|
|
if (retval != 0)
|
|
return retval;
|
|
|
|
retval = mscc_phy_soft_reset(phydev);
|
|
if (retval != 0)
|
|
return retval;
|
|
break;
|
|
default:
|
|
printf("PHY 8541 MAC i/f config Error: mac i/f = 0x%x\n",
|
|
phydev->interface);
|
|
return -EINVAL;
|
|
}
|
|
/* Default RMII Clk Output to 0=OFF/1=ON */
|
|
rmii_clk_out = 0;
|
|
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_EXT_PAGE_ACCESS,
|
|
MSCC_PHY_PAGE_EXT2);
|
|
reg_val = phy_read(phydev, MDIO_DEVAD_NONE, MSCC_PHY_RGMII_CNTL_REG);
|
|
/* Reg20E2 - Update RGMII RX_Clk Skews. */
|
|
reg_val = bitfield_replace(reg_val, RGMII_RX_CLK_DELAY_POS,
|
|
RGMII_RX_CLK_DELAY_WIDTH, rx_clk_skew);
|
|
/* Reg20E2 - Update RGMII TX_Clk Skews. */
|
|
reg_val = bitfield_replace(reg_val, RGMII_TX_CLK_DELAY_POS,
|
|
RGMII_TX_CLK_DELAY_WIDTH, tx_clk_skew);
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_PHY_RGMII_CNTL_REG, reg_val);
|
|
|
|
reg_val = phy_read(phydev, MDIO_DEVAD_NONE, MSCC_PHY_WOL_MAC_CONTROL);
|
|
/* Reg27E2 - Update Clk Slew Rate. */
|
|
reg_val = bitfield_replace(reg_val, EDGE_RATE_CNTL_POS,
|
|
EDGE_RATE_CNTL_WIDTH, edge_rate);
|
|
/* Reg27E2 - Update RMII Clk Out. */
|
|
reg_val = bitfield_replace(reg_val, RMII_CLK_OUT_ENABLE_POS,
|
|
RMII_CLK_OUT_ENABLE_WIDTH, rmii_clk_out);
|
|
/* Update Reg27E2 */
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_PHY_WOL_MAC_CONTROL, reg_val);
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MSCC_EXT_PAGE_ACCESS,
|
|
MSCC_PHY_PAGE_STD);
|
|
|
|
return genphy_config_aneg(phydev);
|
|
}
|
|
|
|
static struct phy_driver VSC8530_driver = {
|
|
.name = "Microsemi VSC8530",
|
|
.uid = PHY_ID_VSC8530,
|
|
.mask = 0x000ffff0,
|
|
.features = PHY_BASIC_FEATURES,
|
|
.config = &vsc8531_config,
|
|
.startup = &mscc_startup,
|
|
.shutdown = &genphy_shutdown,
|
|
};
|
|
|
|
static struct phy_driver VSC8531_driver = {
|
|
.name = "Microsemi VSC8531",
|
|
.uid = PHY_ID_VSC8531,
|
|
.mask = 0x000ffff0,
|
|
.features = PHY_GBIT_FEATURES,
|
|
.config = &vsc8531_config,
|
|
.startup = &mscc_startup,
|
|
.shutdown = &genphy_shutdown,
|
|
};
|
|
|
|
static struct phy_driver VSC8540_driver = {
|
|
.name = "Microsemi VSC8540",
|
|
.uid = PHY_ID_VSC8540,
|
|
.mask = 0x000ffff0,
|
|
.features = PHY_BASIC_FEATURES,
|
|
.config = &vsc8541_config,
|
|
.startup = &mscc_startup,
|
|
.shutdown = &genphy_shutdown,
|
|
};
|
|
|
|
static struct phy_driver VSC8541_driver = {
|
|
.name = "Microsemi VSC8541",
|
|
.uid = PHY_ID_VSC8541,
|
|
.mask = 0x000ffff0,
|
|
.features = PHY_GBIT_FEATURES,
|
|
.config = &vsc8541_config,
|
|
.startup = &mscc_startup,
|
|
.shutdown = &genphy_shutdown,
|
|
};
|
|
|
|
int phy_mscc_init(void)
|
|
{
|
|
phy_register(&VSC8530_driver);
|
|
phy_register(&VSC8531_driver);
|
|
phy_register(&VSC8540_driver);
|
|
phy_register(&VSC8541_driver);
|
|
|
|
return 0;
|
|
}
|