armbian/linux-rockchip
0
0
Fork 0
mirror of https://github.com/armbian/linux-rockchip.git synced 2026-01-06 11:08:10 -08:00
Code Issues Packages Projects Releases Wiki Activity

mekotronics: stmmac: hack LED_FIX

Browse Source
This commit is contained in:
Ricardo Pardini
2023-03-31 23:49:38 +02:00
committed by Jianfeng Liu
parent 61c7552c44
commit cdf2cb3e20
1 changed files with 130 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

130
drivers/net/ethernet/stmicro/stmmac/stmmac_main.c
View File

@@ -146,6 +146,14 @@ static void stmmac_exit_fs(struct net_device *dev);
#define STMMAC_COAL_TIMER(x) (ns_to_ktime((x) * NSEC_PER_USEC))
#define LED_FIX 1
#ifdef LED_FIX
#define RTL_8201F_PHY_ID 0x001cc816
#define RTL_8211E_PHY_ID 0x001cc915
#define RTL_8211F_PHY_ID 0x001cc916
#define DP_83848_PHY_ID 0x20005c90
#endif
int stmmac_bus_clks_config(struct stmmac_priv *priv, bool enabled)
{
int ret = 0;
@@ -7080,6 +7088,112 @@ void stmmac_fpe_handshake(struct stmmac_priv *priv, bool enable)
}
}
#ifdef LED_FIX
static int phy_dp83848_led_fixup(struct phy_device *phydev)
{
int value;
if (phydev->phy_id != DP_83848_PHY_ID)
return 0;
printk("%s in\n", __func__);
value = phy_read(phydev, 0x18);
value &= ~(1<<2);
phy_write(phydev, 0x18, value);
value = phy_read(phydev, 0x19);
value &= ~(1<<5);
phy_write(phydev, 0x19, value);
return 0;
}
static int phy_rtl8201f_led_fixup(struct phy_device *phydev)
{
int value;
printk("%s in\n", __func__);
/* switch to page 7 */
value = phy_read(phydev, 31);
value &= 0xff00;
value |= 0x0007;
value = phy_write(phydev, 31, value);
/* set customized led enable */
value = phy_read(phydev, 19);
value |= (0x1<<3);
phy_write(phydev, 19, value);
value &= 0x0000;
value |= (0x1<<1);
value |= (0x1<<7);
phy_write(phydev, 17, value);
/* back to page 0 */
value = phy_read(phydev, 31);
value &= 0x0000;
value = phy_write(phydev, 31, value);
return 0;
}
static int phy_rtl8211e_led_fixup(struct phy_device *phydev)
{
int val;
printk("%s in\n", __func__);
val = phy_read(phydev, 3);
printk("%s in val=0x%04x\n", __func__, val);
/*switch to extension page44*/
phy_write(phydev, 31, 0x07);
phy_write(phydev, 30, 0x2c);
/*set led1(yellow) act*/
val = phy_read(phydev, 26);
val &= (~(1<<4));// bit4=0
val |= (1<<5);// bit5=1
val &= (~(1<<6));// bit6=0
phy_write(phydev, 26, val);
/*set led0(green) link*/
val = phy_read(phydev, 28);
val |= (7<<0);// bit0,1,2=1
val &= (~(7<<4));// bit4,5,6=0
val &= (~(7<<8));// bit8,9,10=0
phy_write(phydev, 28, val);
/*switch back to page0*/
phy_write(phydev,31,0x00);
return 0;
}
static int phy_rtl8211f_led_fixup(struct phy_device *phydev)
{
int val;
printk("%s in\n", __func__);
val = phy_read(phydev, 31);
printk("%s in val=0x%04x\n", __func__, val);
/*switch to extension page31*/
phy_write(phydev, 31, 0xd04);
//phy_write(phydev, 0x10, 0x6d60); /*led1-green led2-yellow */
phy_write(phydev, 0x10, 0xc160); /*led1-green led2-yellow */
phy_write(phydev, 0x11, 0x8);
/*switch back to page0*/
phy_write(phydev,31,0x0);
return 0;
}
#endif
/**
* stmmac_dvr_probe
* @device: device pointer
@@ -7352,6 +7466,22 @@ int stmmac_dvr_probe(struct device *device,
goto error_netdev_register;
}
#ifdef LED_FIX
/* register the PHY board fixup */
ret = phy_register_fixup_for_uid(RTL_8211E_PHY_ID, 0xffffffff, phy_rtl8211e_led_fixup);
if (ret)
pr_warn("Cannot register PHY board fixup.\n");
ret = phy_register_fixup_for_uid(RTL_8211F_PHY_ID, 0xffffffff, phy_rtl8211f_led_fixup);
if (ret)
pr_warn("Cannot register PHY board fixup.\n");
ret = phy_register_fixup_for_uid(RTL_8201F_PHY_ID, 0xffffffff, phy_rtl8201f_led_fixup);
if (ret)
pr_warn("Cannot register PHY board fixup.\n");
ret = phy_register_fixup_for_uid(DP_83848_PHY_ID, 0xffffffff, phy_dp83848_led_fixup);
if (ret)
pr_warn("Cannot register PHY board fixup.\n");
#endif
#ifdef CONFIG_DEBUG_FS
stmmac_init_fs(ndev);
#endif