aio-3399b/ImmortalWrt
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

realtek: 5.15: Improve rtl838x dsa driver error handling

Browse Source 
Make sure functions calling rtl838x_smi_wait_op() return its return
value in target/linux/realtek/files-5.15/drivers/net/dsa/rtl83xx/rtl838x.c.
This brings the code style in line with the rtl839x implementation.

Suggested-by: Sander Vanheule <sander@svanheule.net>
Signed-off-by: Pascal Ernster <git@hardfalcon.net>
This commit is contained in:
Pascal Ernster 2023-01-05 06:35:35 +01:00 committed by Sander Vanheule
parent de2dc3feae
commit a188536ef6
1 changed files with 32 additions and 24 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

56
target/linux/realtek/files-5.15/drivers/net/dsa/rtl83xx/rtl838x.c
View File

@ -1798,7 +1798,7 @@ int rtl838x_smi_wait_op(int timeout)
/* Reads a register in a page from the PHY */
int rtl838x_read_phy(u32 port, u32 page, u32 reg, u32 *val)
{
int err = -ETIMEDOUT;
int err;
u32 v;
u32 park_page;
@ -1812,8 +1812,9 @@ int rtl838x_read_phy(u32 port, u32 page, u32 reg, u32 *val)
mutex_lock(&smi_lock);
if (rtl838x_smi_wait_op(100000))
goto timeout;
err = rtl838x_smi_wait_op(100000);
if (err)
goto errout;
sw_w32_mask(0xffff0000, port << 16, RTL838X_SMI_ACCESS_PHY_CTRL_2);
@ -1822,14 +1823,15 @@ int rtl838x_read_phy(u32 port, u32 page, u32 reg, u32 *val)
sw_w32(v | park_page, RTL838X_SMI_ACCESS_PHY_CTRL_1);
sw_w32_mask(0, 1, RTL838X_SMI_ACCESS_PHY_CTRL_1);
if (rtl838x_smi_wait_op(100000))
goto timeout;
err = rtl838x_smi_wait_op(100000);
if (err)
goto errout;
*val = sw_r32(RTL838X_SMI_ACCESS_PHY_CTRL_2) & 0xffff;
err = 0;
timeout:
errout:
mutex_unlock(&smi_lock);
return err;
@ -1838,7 +1840,7 @@ timeout:
/* Write to a register in a page of the PHY */
int rtl838x_write_phy(u32 port, u32 page, u32 reg, u32 val)
{
int err = -ETIMEDOUT;
int err;
u32 v;
u32 park_page;
@ -1847,8 +1849,9 @@ int rtl838x_write_phy(u32 port, u32 page, u32 reg, u32 val)
return -ENOTSUPP;
mutex_lock(&smi_lock);
if (rtl838x_smi_wait_op(100000))
goto timeout;
err = rtl838x_smi_wait_op(100000);
if (err)
goto errout;
sw_w32(BIT(port), RTL838X_SMI_ACCESS_PHY_CTRL_0);
mdelay(10);
@ -1860,12 +1863,13 @@ int rtl838x_write_phy(u32 port, u32 page, u32 reg, u32 val)
sw_w32(v | park_page, RTL838X_SMI_ACCESS_PHY_CTRL_1);
sw_w32_mask(0, 1, RTL838X_SMI_ACCESS_PHY_CTRL_1);
if (rtl838x_smi_wait_op(100000))
goto timeout;
err = rtl838x_smi_wait_op(100000);
if (err)
goto errout;
err = 0;
timeout:
errout:
mutex_unlock(&smi_lock);
return err;
@ -1874,13 +1878,14 @@ timeout:
/* Read an mmd register of a PHY */
int rtl838x_read_mmd_phy(u32 port, u32 addr, u32 reg, u32 *val)
{
int err = -ETIMEDOUT;
int err;
u32 v;
mutex_lock(&smi_lock);
if (rtl838x_smi_wait_op(100000))
goto timeout;
err = rtl838x_smi_wait_op(100000);
if (err)
goto errout;
sw_w32(1 << port, RTL838X_SMI_ACCESS_PHY_CTRL_0);
mdelay(10);
@ -1894,14 +1899,15 @@ int rtl838x_read_mmd_phy(u32 port, u32 addr, u32 reg, u32 *val)
v = 1 << 1 | 0 << 2 | 1;
sw_w32(v, RTL838X_SMI_ACCESS_PHY_CTRL_1);
if (rtl838x_smi_wait_op(100000))
goto timeout;
err = rtl838x_smi_wait_op(100000);
if (err)
goto errout;
*val = sw_r32(RTL838X_SMI_ACCESS_PHY_CTRL_2) & 0xffff;
err = 0;
timeout:
errout:
mutex_unlock(&smi_lock);
return err;
@ -1910,15 +1916,16 @@ timeout:
/* Write to an mmd register of a PHY */
int rtl838x_write_mmd_phy(u32 port, u32 addr, u32 reg, u32 val)
{
int err = -ETIMEDOUT;
int err;
u32 v;
pr_debug("MMD write: port %d, dev %d, reg %d, val %x\n", port, addr, reg, val);
val &= 0xffff;
mutex_lock(&smi_lock);
if (rtl838x_smi_wait_op(100000))
goto timeout;
err = rtl838x_smi_wait_op(100000);
if (err)
goto errout;
sw_w32(1 << port, RTL838X_SMI_ACCESS_PHY_CTRL_0);
mdelay(10);
@ -1931,12 +1938,13 @@ int rtl838x_write_mmd_phy(u32 port, u32 addr, u32 reg, u32 val)
v = 1 << 1 | 1 << 2 | 1;
sw_w32(v, RTL838X_SMI_ACCESS_PHY_CTRL_1);
if (rtl838x_smi_wait_op(100000))
goto timeout;
err = rtl838x_smi_wait_op(100000);
if (err)
goto errout;
err = 0;
timeout:
errout:
mutex_unlock(&smi_lock);
return err;
}