|
|
|
|
@ -9,9 +9,14 @@ |
|
|
|
|
*/ |
|
|
|
|
#include <config.h> |
|
|
|
|
#include <common.h> |
|
|
|
|
#include <dm.h> |
|
|
|
|
#include <errno.h> |
|
|
|
|
#include <fdtdec.h> |
|
|
|
|
#include <micrel.h> |
|
|
|
|
#include <phy.h> |
|
|
|
|
|
|
|
|
|
DECLARE_GLOBAL_DATA_PTR; |
|
|
|
|
|
|
|
|
|
static struct phy_driver KSZ804_driver = { |
|
|
|
|
.name = "Micrel KSZ804", |
|
|
|
|
.uid = 0x221510, |
|
|
|
|
@ -174,6 +179,73 @@ static int ksz90xx_startup(struct phy_device *phydev) |
|
|
|
|
return 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/* Common OF config bits for KSZ9021 and KSZ9031 */ |
|
|
|
|
#if defined(CONFIG_PHY_MICREL_KSZ9021) || defined(CONFIG_PHY_MICREL_KSZ9031) |
|
|
|
|
#ifdef CONFIG_DM_ETH |
|
|
|
|
struct ksz90x1_reg_field { |
|
|
|
|
const char *name; |
|
|
|
|
const u8 size; /* Size of the bitfield, in bits */ |
|
|
|
|
const u8 off; /* Offset from bit 0 */ |
|
|
|
|
const u8 dflt; /* Default value */ |
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|
struct ksz90x1_ofcfg { |
|
|
|
|
const u16 reg; |
|
|
|
|
const u16 devad; |
|
|
|
|
const struct ksz90x1_reg_field *grp; |
|
|
|
|
const u16 grpsz; |
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|
static const struct ksz90x1_reg_field ksz90x1_rxd_grp[] = { |
|
|
|
|
{ "rxd0-skew-ps", 4, 0, 0x7 }, { "rxd1-skew-ps", 4, 4, 0x7 }, |
|
|
|
|
{ "rxd2-skew-ps", 4, 8, 0x7 }, { "rxd3-skew-ps", 4, 12, 0x7 } |
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|
static const struct ksz90x1_reg_field ksz90x1_txd_grp[] = { |
|
|
|
|
{ "txd0-skew-ps", 4, 0, 0x7 }, { "txd1-skew-ps", 4, 4, 0x7 }, |
|
|
|
|
{ "txd2-skew-ps", 4, 8, 0x7 }, { "txd3-skew-ps", 4, 12, 0x7 }, |
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|
static int ksz90x1_of_config_group(struct phy_device *phydev, |
|
|
|
|
struct ksz90x1_ofcfg *ofcfg) |
|
|
|
|
{ |
|
|
|
|
struct udevice *dev = phydev->dev; |
|
|
|
|
struct phy_driver *drv = phydev->drv; |
|
|
|
|
const int ps_to_regval = 200; |
|
|
|
|
int val[4]; |
|
|
|
|
int i, changed = 0, offset, max; |
|
|
|
|
u16 regval = 0; |
|
|
|
|
|
|
|
|
|
if (!drv || !drv->writeext) |
|
|
|
|
return -EOPNOTSUPP; |
|
|
|
|
|
|
|
|
|
for (i = 0; i < ofcfg->grpsz; i++) { |
|
|
|
|
val[i] = fdtdec_get_uint(gd->fdt_blob, dev->of_offset, |
|
|
|
|
ofcfg->grp[i].name, -1); |
|
|
|
|
offset = ofcfg->grp[i].off; |
|
|
|
|
if (val[i] == -1) { |
|
|
|
|
/* Default register value for KSZ9021 */ |
|
|
|
|
regval |= ofcfg->grp[i].dflt << offset; |
|
|
|
|
} else { |
|
|
|
|
changed = 1; /* Value was changed in OF */ |
|
|
|
|
/* Calculate the register value and fix corner cases */ |
|
|
|
|
if (val[i] > ps_to_regval * 0xf) { |
|
|
|
|
max = (1 << ofcfg->grp[i].size) - 1; |
|
|
|
|
regval |= max << offset; |
|
|
|
|
} else { |
|
|
|
|
regval |= (val[i] / ps_to_regval) << offset; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (!changed) |
|
|
|
|
return 0; |
|
|
|
|
|
|
|
|
|
return drv->writeext(phydev, 0, ofcfg->devad, ofcfg->reg, regval); |
|
|
|
|
} |
|
|
|
|
#endif |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
#ifdef CONFIG_PHY_MICREL_KSZ9021 |
|
|
|
|
/*
|
|
|
|
|
* KSZ9021 |
|
|
|
|
@ -188,6 +260,35 @@ static int ksz90xx_startup(struct phy_device *phydev) |
|
|
|
|
#define CTRL1000_CONFIG_MASTER (1 << 11) |
|
|
|
|
#define CTRL1000_MANUAL_CONFIG (1 << 12) |
|
|
|
|
|
|
|
|
|
#ifdef CONFIG_DM_ETH |
|
|
|
|
static const struct ksz90x1_reg_field ksz9021_clk_grp[] = { |
|
|
|
|
{ "txen-skew-ps", 4, 0, 0x7 }, { "txc-skew-ps", 4, 4, 0x7 }, |
|
|
|
|
{ "rxdv-skew-ps", 4, 8, 0x7 }, { "rxc-skew-ps", 4, 12, 0x7 }, |
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|
static int ksz9021_of_config(struct phy_device *phydev) |
|
|
|
|
{ |
|
|
|
|
struct ksz90x1_ofcfg ofcfg[] = { |
|
|
|
|
{ MII_KSZ9021_EXT_RGMII_RX_DATA_SKEW, 0, ksz90x1_rxd_grp, 4 }, |
|
|
|
|
{ MII_KSZ9021_EXT_RGMII_TX_DATA_SKEW, 0, ksz90x1_txd_grp, 4 }, |
|
|
|
|
{ MII_KSZ9021_EXT_RGMII_CLOCK_SKEW, 0, ksz9021_clk_grp, 4 }, |
|
|
|
|
}; |
|
|
|
|
int i, ret = 0; |
|
|
|
|
|
|
|
|
|
for (i = 0; i < ARRAY_SIZE(ofcfg); i++) |
|
|
|
|
ret = ksz90x1_of_config_group(phydev, &(ofcfg[i])); |
|
|
|
|
if (ret) |
|
|
|
|
return ret; |
|
|
|
|
|
|
|
|
|
return 0; |
|
|
|
|
} |
|
|
|
|
#else |
|
|
|
|
static int ksz9021_of_config(struct phy_device *phydev) |
|
|
|
|
{ |
|
|
|
|
return 0; |
|
|
|
|
} |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
int ksz9021_phy_extended_write(struct phy_device *phydev, int regnum, u16 val) |
|
|
|
|
{ |
|
|
|
|
/* extended registers */ |
|
|
|
|
@ -224,6 +325,11 @@ static int ksz9021_config(struct phy_device *phydev) |
|
|
|
|
const unsigned master = CTRL1000_PREFER_MASTER | |
|
|
|
|
CTRL1000_CONFIG_MASTER | CTRL1000_MANUAL_CONFIG; |
|
|
|
|
unsigned features = phydev->drv->features; |
|
|
|
|
int ret; |
|
|
|
|
|
|
|
|
|
ret = ksz9021_of_config(phydev); |
|
|
|
|
if (ret) |
|
|
|
|
return ret; |
|
|
|
|
|
|
|
|
|
if (getenv("disable_giga")) |
|
|
|
|
features &= ~(SUPPORTED_1000baseT_Half | |
|
|
|
|
@ -260,6 +366,36 @@ static struct phy_driver ksz9021_driver = { |
|
|
|
|
#define MII_KSZ9031_MMD_ACCES_CTRL 0x0d |
|
|
|
|
#define MII_KSZ9031_MMD_REG_DATA 0x0e |
|
|
|
|
|
|
|
|
|
#ifdef CONFIG_DM_ETH |
|
|
|
|
static const struct ksz90x1_reg_field ksz9031_ctl_grp[] = |
|
|
|
|
{ { "txen-skew-ps", 4, 0, 0x7 }, { "rxdv-skew-ps", 4, 4, 0x7 } }; |
|
|
|
|
static const struct ksz90x1_reg_field ksz9031_clk_grp[] = |
|
|
|
|
{ { "rxc-skew-ps", 5, 0, 0xf }, { "txc-skew-ps", 5, 5, 0xf } }; |
|
|
|
|
|
|
|
|
|
static int ksz9031_of_config(struct phy_device *phydev) |
|
|
|
|
{ |
|
|
|
|
struct ksz90x1_ofcfg ofcfg[] = { |
|
|
|
|
{ MII_KSZ9031_EXT_RGMII_CTRL_SIG_SKEW, 2, ksz9031_ctl_grp, 2 }, |
|
|
|
|
{ MII_KSZ9031_EXT_RGMII_RX_DATA_SKEW, 2, ksz90x1_rxd_grp, 4 }, |
|
|
|
|
{ MII_KSZ9031_EXT_RGMII_TX_DATA_SKEW, 2, ksz90x1_txd_grp, 4 }, |
|
|
|
|
{ MII_KSZ9031_EXT_RGMII_CLOCK_SKEW, 2, ksz9031_clk_grp, 2 }, |
|
|
|
|
}; |
|
|
|
|
int i, ret = 0; |
|
|
|
|
|
|
|
|
|
for (i = 0; i < ARRAY_SIZE(ofcfg); i++) |
|
|
|
|
ret = ksz90x1_of_config_group(phydev, &(ofcfg[i])); |
|
|
|
|
if (ret) |
|
|
|
|
return ret; |
|
|
|
|
|
|
|
|
|
return 0; |
|
|
|
|
} |
|
|
|
|
#else |
|
|
|
|
static int ksz9031_of_config(struct phy_device *phydev) |
|
|
|
|
{ |
|
|
|
|
return 0; |
|
|
|
|
} |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
/* Accessors to extended registers*/ |
|
|
|
|
int ksz9031_phy_extended_write(struct phy_device *phydev, |
|
|
|
|
int devaddr, int regnum, u16 mode, u16 val) |
|
|
|
|
@ -304,13 +440,21 @@ static int ksz9031_phy_extwrite(struct phy_device *phydev, int addr, |
|
|
|
|
MII_KSZ9031_MOD_DATA_POST_INC_RW, val); |
|
|
|
|
}; |
|
|
|
|
|
|
|
|
|
static int ksz9031_config(struct phy_device *phydev) |
|
|
|
|
{ |
|
|
|
|
int ret; |
|
|
|
|
ret = ksz9031_of_config(phydev); |
|
|
|
|
if (ret) |
|
|
|
|
return ret; |
|
|
|
|
return genphy_config(phydev); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static struct phy_driver ksz9031_driver = { |
|
|
|
|
.name = "Micrel ksz9031", |
|
|
|
|
.uid = 0x221620, |
|
|
|
|
.mask = 0xfffff0, |
|
|
|
|
.features = PHY_GBIT_FEATURES, |
|
|
|
|
.config = &genphy_config, |
|
|
|
|
.config = &ksz9031_config, |
|
|
|
|
.startup = &ksz90xx_startup, |
|
|
|
|
.shutdown = &genphy_shutdown, |
|
|
|
|
.writeext = &ksz9031_phy_extwrite, |
|
|
|
|
|
Tom Rini
9 years ago