net: phy: micrel: add Microchip KSZ9131 initial driver
Add support for Microchip Technology KSZ9131 10/100/1000 Ethernet PHY Signed-off-by: Yuiko Oshino <yuiko.oshino@microchip.com> Signed-off-by: David S. Miller <davem@davemloft.net>hifive-unleashed-5.1
Yuiko Oshino
David S. Miller
parent
c9fbd71f73
commit
bff5b4b373
|
|
@ -14,7 +14,7 @@
|
|||
* option) any later version.
|
||||
*
|
||||
* Support : Micrel Phys:
|
||||
* Giga phys: ksz9021, ksz9031
|
||||
* Giga phys: ksz9021, ksz9031, ksz9131
|
||||
* 100/10 Phys : ksz8001, ksz8721, ksz8737, ksz8041
|
||||
* ksz8021, ksz8031, ksz8051,
|
||||
* ksz8081, ksz8091,
|
||||
|
|
@ -609,6 +609,116 @@ err_force_master:
|
|||
return result;
|
||||
}
|
||||
|
||||
#define KSZ9131_SKEW_5BIT_MAX 2400
|
||||
#define KSZ9131_SKEW_4BIT_MAX 800
|
||||
#define KSZ9131_OFFSET 700
|
||||
#define KSZ9131_STEP 100
|
||||
|
||||
static int ksz9131_of_load_skew_values(struct phy_device *phydev,
|
||||
struct device_node *of_node,
|
||||
u16 reg, size_t field_sz,
|
||||
char *field[], u8 numfields)
|
||||
{
|
||||
int val[4] = {-(1 + KSZ9131_OFFSET), -(2 + KSZ9131_OFFSET),
|
||||
-(3 + KSZ9131_OFFSET), -(4 + KSZ9131_OFFSET)};
|
||||
int skewval, skewmax = 0;
|
||||
int matches = 0;
|
||||
u16 maxval;
|
||||
u16 newval;
|
||||
u16 mask;
|
||||
int i;
|
||||
|
||||
/* psec properties in dts should mean x pico seconds */
|
||||
if (field_sz == 5)
|
||||
skewmax = KSZ9131_SKEW_5BIT_MAX;
|
||||
else
|
||||
skewmax = KSZ9131_SKEW_4BIT_MAX;
|
||||
|
||||
for (i = 0; i < numfields; i++)
|
||||
if (!of_property_read_s32(of_node, field[i], &skewval)) {
|
||||
if (skewval < -KSZ9131_OFFSET)
|
||||
skewval = -KSZ9131_OFFSET;
|
||||
else if (skewval > skewmax)
|
||||
skewval = skewmax;
|
||||
|
||||
val[i] = skewval + KSZ9131_OFFSET;
|
||||
matches++;
|
||||
}
|
||||
|
||||
if (!matches)
|
||||
return 0;
|
||||
|
||||
if (matches < numfields)
|
||||
newval = ksz9031_extended_read(phydev, OP_DATA, 2, reg);
|
||||
else
|
||||
newval = 0;
|
||||
|
||||
maxval = (field_sz == 4) ? 0xf : 0x1f;
|
||||
for (i = 0; i < numfields; i++)
|
||||
if (val[i] != -(i + 1 + KSZ9131_OFFSET)) {
|
||||
mask = 0xffff;
|
||||
mask ^= maxval << (field_sz * i);
|
||||
newval = (newval & mask) |
|
||||
(((val[i] / KSZ9131_STEP) & maxval)
|
||||
<< (field_sz * i));
|
||||
}
|
||||
|
||||
return ksz9031_extended_write(phydev, OP_DATA, 2, reg, newval);
|
||||
}
|
||||
|
||||
static int ksz9131_config_init(struct phy_device *phydev)
|
||||
{
|
||||
const struct device *dev = &phydev->mdio.dev;
|
||||
struct device_node *of_node = dev->of_node;
|
||||
char *clk_skews[2] = {"rxc-skew-psec", "txc-skew-psec"};
|
||||
char *rx_data_skews[4] = {
|
||||
"rxd0-skew-psec", "rxd1-skew-psec",
|
||||
"rxd2-skew-psec", "rxd3-skew-psec"
|
||||
};
|
||||
char *tx_data_skews[4] = {
|
||||
"txd0-skew-psec", "txd1-skew-psec",
|
||||
"txd2-skew-psec", "txd3-skew-psec"
|
||||
};
|
||||
char *control_skews[2] = {"txen-skew-psec", "rxdv-skew-psec"};
|
||||
const struct device *dev_walker;
|
||||
int ret;
|
||||
|
||||
dev_walker = &phydev->mdio.dev;
|
||||
do {
|
||||
of_node = dev_walker->of_node;
|
||||
dev_walker = dev_walker->parent;
|
||||
} while (!of_node && dev_walker);
|
||||
|
||||
if (!of_node)
|
||||
return 0;
|
||||
|
||||
ret = ksz9131_of_load_skew_values(phydev, of_node,
|
||||
MII_KSZ9031RN_CLK_PAD_SKEW, 5,
|
||||
clk_skews, 2);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = ksz9131_of_load_skew_values(phydev, of_node,
|
||||
MII_KSZ9031RN_CONTROL_PAD_SKEW, 4,
|
||||
control_skews, 2);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = ksz9131_of_load_skew_values(phydev, of_node,
|
||||
MII_KSZ9031RN_RX_DATA_PAD_SKEW, 4,
|
||||
rx_data_skews, 4);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = ksz9131_of_load_skew_values(phydev, of_node,
|
||||
MII_KSZ9031RN_TX_DATA_PAD_SKEW, 4,
|
||||
tx_data_skews, 4);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
#define KSZ8873MLL_GLOBAL_CONTROL_4 0x06
|
||||
#define KSZ8873MLL_GLOBAL_CONTROL_4_DUPLEX BIT(6)
|
||||
#define KSZ8873MLL_GLOBAL_CONTROL_4_SPEED BIT(4)
|
||||
|
|
@ -974,6 +1084,23 @@ static struct phy_driver ksphy_driver[] = {
|
|||
.get_stats = kszphy_get_stats,
|
||||
.suspend = genphy_suspend,
|
||||
.resume = kszphy_resume,
|
||||
}, {
|
||||
.phy_id = PHY_ID_KSZ9131,
|
||||
.phy_id_mask = MICREL_PHY_ID_MASK,
|
||||
.name = "Microchip KSZ9131 Gigabit PHY",
|
||||
.features = PHY_GBIT_FEATURES,
|
||||
.flags = PHY_HAS_INTERRUPT,
|
||||
.driver_data = &ksz9021_type,
|
||||
.probe = kszphy_probe,
|
||||
.config_init = ksz9131_config_init,
|
||||
.read_status = ksz9031_read_status,
|
||||
.ack_interrupt = kszphy_ack_interrupt,
|
||||
.config_intr = kszphy_config_intr,
|
||||
.get_sset_count = kszphy_get_sset_count,
|
||||
.get_strings = kszphy_get_strings,
|
||||
.get_stats = kszphy_get_stats,
|
||||
.suspend = genphy_suspend,
|
||||
.resume = kszphy_resume,
|
||||
}, {
|
||||
.phy_id = PHY_ID_KSZ8873MLL,
|
||||
.phy_id_mask = MICREL_PHY_ID_MASK,
|
||||
|
|
@ -1022,6 +1149,7 @@ MODULE_LICENSE("GPL");
|
|||
static struct mdio_device_id __maybe_unused micrel_tbl[] = {
|
||||
{ PHY_ID_KSZ9021, 0x000ffffe },
|
||||
{ PHY_ID_KSZ9031, MICREL_PHY_ID_MASK },
|
||||
{ PHY_ID_KSZ9131, MICREL_PHY_ID_MASK },
|
||||
{ PHY_ID_KSZ8001, 0x00fffffc },
|
||||
{ PHY_ID_KS8737, MICREL_PHY_ID_MASK },
|
||||
{ PHY_ID_KSZ8021, 0x00ffffff },
|
||||
|
|
|
|||
|
|
@ -31,6 +31,7 @@
|
|||
#define PHY_ID_KSZ8081 0x00221560
|
||||
#define PHY_ID_KSZ8061 0x00221570
|
||||
#define PHY_ID_KSZ9031 0x00221620
|
||||
#define PHY_ID_KSZ9131 0x00221640
|
||||
|
||||
#define PHY_ID_KSZ886X 0x00221430
|
||||
#define PHY_ID_KSZ8863 0x00221435
|
||||
|
|
|
|||
Loading…
Reference in New Issue