forked from mirror/openwrt
realtek: rtl931x: rename SerDes read/write helpers
During SerDes rework the helper functions were temporarily renamed to ..._new(). Fix the leftovers by - giving the functions a new rtsds_ prefix nad - dropping the _new appendix. Signed-off-by: Markus Stockhausen <markus.stockhausen@gmx.de> Link: https://github.com/openwrt/openwrt/pull/20034 Signed-off-by: Robert Marko <robimarko@gmail.com>
This commit is contained in:
Markus Stockhausen
Robert Marko
parent
2503e5bc37
commit
d4893b816c
2 changed files with 140 additions and 134 deletions
|
|
@ -92,8 +92,11 @@
|
|||
int rtmdio_930x_read_sds_phy(int sds, int page, int regnum);
|
||||
int rtmdio_930x_write_sds_phy(int sds, int page, int regnum, u16 val);
|
||||
|
||||
int rtmdio_931x_read_sds_phy_new(int sds, int page, int regnum);
|
||||
int rtmdio_931x_write_sds_phy_new(int sds, int page, int regnum, u16 val);
|
||||
int rtsds_931x_read(int sds, int page, int regnum);
|
||||
int rtsds_931x_read_field(int sds, int page, int regnum, int end_bit, int start_bit);
|
||||
|
||||
int rtsds_931x_write(int sds, int page, int regnum, u16 val);
|
||||
int rtsds_931x_write_field(int sds, int page, int regnum, int end_bit, int start_bit, u16 val);
|
||||
|
||||
/*
|
||||
* On all Realtek switch platforms the hardware periodically reads the link status of all
|
||||
|
|
@ -827,7 +830,7 @@ static int rtmdio_930x_read_mmd_phy(u32 port, u32 devnum, u32 regnum, u32 *val)
|
|||
* page 0x200-0x23f (digi 2): page 0x000-0x03f back SDS+1 page 0x000-0x03f back SDS+2
|
||||
*/
|
||||
|
||||
static int rtmdio_931x_get_backing_sds(u32 sds, u32 page)
|
||||
static int rtsds_931x_get_backing_sds(int sds, int page)
|
||||
{
|
||||
int map[] = {0, 1, 2, 3, 6, 7, 10, 11, 14, 15, 18, 19, 22, 23};
|
||||
int back = map[sds];
|
||||
|
|
@ -845,7 +848,7 @@ static int rtmdio_931x_get_backing_sds(u32 sds, u32 page)
|
|||
return back;
|
||||
}
|
||||
|
||||
int rtmdio_931x_read_sds_phy_new(int sds, int page, int regnum)
|
||||
int rtsds_931x_read(int sds, int page, int regnum)
|
||||
{
|
||||
int backsds, i, cmd, ret = -EIO;
|
||||
int backpage = page & 0x3f;
|
||||
|
|
@ -853,7 +856,7 @@ int rtmdio_931x_read_sds_phy_new(int sds, int page, int regnum)
|
|||
if (sds < 0 || sds > 13 || page < 0 || page > 575 || regnum < 0 || regnum > 31)
|
||||
return -EIO;
|
||||
|
||||
backsds = rtmdio_931x_get_backing_sds(sds, page);
|
||||
backsds = rtsds_931x_get_backing_sds(sds, page);
|
||||
if (backsds == -EINVAL)
|
||||
return 0;
|
||||
|
||||
|
|
@ -875,7 +878,7 @@ int rtmdio_931x_read_sds_phy_new(int sds, int page, int regnum)
|
|||
return ret;
|
||||
}
|
||||
|
||||
int rtmdio_931x_write_sds_phy_new(int sds, int page, int regnum, u16 val)
|
||||
int rtsds_931x_write(int sds, int page, int regnum, u16 val)
|
||||
{
|
||||
int backsds, i, cmd, ret = -EIO;
|
||||
int backpage = page & 0x3f;
|
||||
|
|
@ -883,7 +886,7 @@ int rtmdio_931x_write_sds_phy_new(int sds, int page, int regnum, u16 val)
|
|||
if (sds < 0 || sds > 13 || page < 0 || page > 575 || regnum < 0 || regnum > 31)
|
||||
return -EIO;
|
||||
|
||||
backsds = rtmdio_931x_get_backing_sds(sds, page);
|
||||
backsds = rtsds_931x_get_backing_sds(sds, page);
|
||||
if (backsds == -EINVAL)
|
||||
return 0;
|
||||
|
||||
|
|
@ -906,6 +909,33 @@ int rtmdio_931x_write_sds_phy_new(int sds, int page, int regnum, u16 val)
|
|||
return ret;
|
||||
}
|
||||
|
||||
int rtsds_931x_write_field(int sds, int page, int reg, int end_bit, int start_bit, u16 val)
|
||||
{
|
||||
int l = end_bit - start_bit + 1;
|
||||
u32 data = val;
|
||||
|
||||
if (l < 32) {
|
||||
u32 mask = BIT(l) - 1;
|
||||
|
||||
data = rtsds_931x_read(sds, page, reg);
|
||||
data &= ~(mask << start_bit);
|
||||
data |= (val & mask) << start_bit;
|
||||
}
|
||||
|
||||
return rtsds_931x_write(sds, page, reg, data);
|
||||
}
|
||||
|
||||
int rtsds_931x_read_field(int sds, int page, int reg, int end_bit, int start_bit)
|
||||
{
|
||||
int l = end_bit - start_bit + 1;
|
||||
u32 v = rtsds_931x_read(sds, page, reg);
|
||||
|
||||
if (l >= 32)
|
||||
return v;
|
||||
|
||||
return (v >> start_bit) & (BIT(l) - 1);
|
||||
}
|
||||
|
||||
/* RTL931x specific MDIO functions */
|
||||
|
||||
static int rtmdio_931x_write_phy(u32 port, u32 page, u32 reg, u32 val)
|
||||
|
|
@ -1471,8 +1501,8 @@ static int rtmdio_probe(struct platform_device *pdev)
|
|||
bus->read = rtmdio_read;
|
||||
bus->write = rtmdio_write;
|
||||
bus->reset = rtmdio_931x_reset;
|
||||
priv->read_sds_phy = rtmdio_931x_read_sds_phy_new;
|
||||
priv->write_sds_phy = rtmdio_931x_write_sds_phy_new;
|
||||
priv->read_sds_phy = rtsds_931x_read;
|
||||
priv->write_sds_phy = rtsds_931x_write;
|
||||
priv->read_mmd_phy = rtmdio_931x_read_mmd_phy;
|
||||
priv->write_mmd_phy = rtmdio_931x_write_mmd_phy;
|
||||
priv->read_phy = rtmdio_931x_read_phy;
|
||||
|
|
|
|||
|
|
@ -23,8 +23,11 @@ extern struct rtl83xx_soc_info soc_info;
|
|||
extern int rtmdio_930x_read_sds_phy(int sds, int page, int regnum);
|
||||
extern int rtmdio_930x_write_sds_phy(int sds, int page, int regnum, u16 val);
|
||||
|
||||
extern int rtmdio_931x_read_sds_phy_new(int sds, int page, int regnum);
|
||||
extern int rtmdio_931x_write_sds_phy_new(int sds, int page, int regnum, u16 val);
|
||||
extern int rtsds_931x_read(int sds, int page, int regnum);
|
||||
extern int rtsds_931x_read_field(int sds, int page, int regnum, int end_bit, int start_bit);
|
||||
|
||||
extern int rtsds_931x_write(int sds, int page, int regnum, u16 val);
|
||||
extern int rtsds_931x_write_field(int sds, int page, int regnum, int end_bit, int start_bit, u16 val);
|
||||
|
||||
#define PHY_PAGE_2 2
|
||||
#define PHY_PAGE_4 4
|
||||
|
|
@ -2634,33 +2637,6 @@ int rtl9300_sds_cmu_band_get(int sds)
|
|||
return cmu_band;
|
||||
}
|
||||
|
||||
static void rtl9310_sds_field_w_new(int sds, u32 page, u32 reg, int end_bit, int start_bit, u32 v)
|
||||
{
|
||||
int l = end_bit - start_bit + 1;
|
||||
u32 data = v;
|
||||
|
||||
if (l < 32) {
|
||||
u32 mask = BIT(l) - 1;
|
||||
|
||||
data = rtmdio_931x_read_sds_phy_new(sds, page, reg);
|
||||
data &= ~(mask << start_bit);
|
||||
data |= (v & mask) << start_bit;
|
||||
}
|
||||
|
||||
rtmdio_931x_write_sds_phy_new(sds, page, reg, data);
|
||||
}
|
||||
|
||||
static u32 rtl9310_sds_field_r_new(int sds, u32 page, u32 reg, int end_bit, int start_bit)
|
||||
{
|
||||
int l = end_bit - start_bit + 1;
|
||||
u32 v = rtmdio_931x_read_sds_phy_new(sds, page, reg);
|
||||
|
||||
if (l >= 32)
|
||||
return v;
|
||||
|
||||
return (v >> start_bit) & (BIT(l) - 1);
|
||||
}
|
||||
|
||||
static void rtl931x_sds_rst(u32 sds)
|
||||
{
|
||||
u32 o, v, o_mode;
|
||||
|
|
@ -2688,21 +2664,21 @@ static void rtl931x_symerr_clear(u32 sds, phy_interface_t mode)
|
|||
break;
|
||||
case PHY_INTERFACE_MODE_XGMII:
|
||||
for (int i = 0; i < 4; ++i) {
|
||||
rtl9310_sds_field_w_new(sds, 0x101, 24, 2, 0, i);
|
||||
rtl9310_sds_field_w_new(sds, 0x101, 3, 15, 8, 0x0);
|
||||
rtl9310_sds_field_w_new(sds, 0x101, 2, 15, 0, 0x0);
|
||||
rtsds_931x_write_field(sds, 0x101, 24, 2, 0, i);
|
||||
rtsds_931x_write_field(sds, 0x101, 3, 15, 8, 0x0);
|
||||
rtsds_931x_write_field(sds, 0x101, 2, 15, 0, 0x0);
|
||||
}
|
||||
|
||||
for (int i = 0; i < 4; ++i) {
|
||||
rtl9310_sds_field_w_new(sds, 0x201, 24, 2, 0, i);
|
||||
rtl9310_sds_field_w_new(sds, 0x201, 3, 15, 8, 0x0);
|
||||
rtl9310_sds_field_w_new(sds, 0x201, 2, 15, 0, 0x0);
|
||||
rtsds_931x_write_field(sds, 0x201, 24, 2, 0, i);
|
||||
rtsds_931x_write_field(sds, 0x201, 3, 15, 8, 0x0);
|
||||
rtsds_931x_write_field(sds, 0x201, 2, 15, 0, 0x0);
|
||||
}
|
||||
|
||||
rtl9310_sds_field_w_new(sds, 0x101, 0, 15, 0, 0x0);
|
||||
rtl9310_sds_field_w_new(sds, 0x101, 1, 15, 8, 0x0);
|
||||
rtl9310_sds_field_w_new(sds, 0x201, 0, 15, 0, 0x0);
|
||||
rtl9310_sds_field_w_new(sds, 0x201, 1, 15, 8, 0x0);
|
||||
rtsds_931x_write_field(sds, 0x101, 0, 15, 0, 0x0);
|
||||
rtsds_931x_write_field(sds, 0x101, 1, 15, 8, 0x0);
|
||||
rtsds_931x_write_field(sds, 0x201, 0, 15, 0, 0x0);
|
||||
rtsds_931x_write_field(sds, 0x201, 1, 15, 8, 0x0);
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
|
|
@ -2715,7 +2691,7 @@ void rtl931x_sds_fiber_disable(u32 sds)
|
|||
{
|
||||
u32 v = 0x3F;
|
||||
|
||||
rtl9310_sds_field_w_new(sds, 0x1F, 0x9, 11, 6, v);
|
||||
rtsds_931x_write_field(sds, 0x1F, 0x9, 11, 6, v);
|
||||
}
|
||||
|
||||
static void rtl931x_sds_fiber_mode_set(u32 sds, phy_interface_t mode)
|
||||
|
|
@ -2755,7 +2731,7 @@ static void rtl931x_sds_fiber_mode_set(u32 sds, phy_interface_t mode)
|
|||
}
|
||||
|
||||
pr_info("%s writing analog SerDes Mode value %02x\n", __func__, val);
|
||||
rtl9310_sds_field_w_new(sds, 0x1F, 0x9, 11, 6, val);
|
||||
rtsds_931x_write_field(sds, 0x1F, 0x9, 11, 6, val);
|
||||
|
||||
return;
|
||||
}
|
||||
|
|
@ -2803,7 +2779,7 @@ static void rtl931x_cmu_type_set(u32 sds, phy_interface_t mode, int chiptype)
|
|||
|
||||
/* case MII_10GR1000BX_AUTO:
|
||||
if (chiptype)
|
||||
rtl9310_sds_field_w_new(sds, 0x24, 0xd, 14, 14, 0);
|
||||
rtsds_931x_write_field(sds, 0x24, 0xd, 14, 14, 0);
|
||||
return; */
|
||||
|
||||
case PHY_INTERFACE_MODE_QSGMII:
|
||||
|
|
@ -2855,21 +2831,21 @@ static void rtl931x_cmu_type_set(u32 sds, phy_interface_t mode, int chiptype)
|
|||
__func__, cmu_type, cmu_page, frc_cmu_spd, lane, sds);
|
||||
|
||||
if (cmu_type == 1) {
|
||||
pr_info("%s A CMU page 0x28 0x7 %08x\n", __func__, rtmdio_931x_read_sds_phy_new(sds, 0x28, 0x7));
|
||||
rtl9310_sds_field_w_new(sds, cmu_page, 0x7, 15, 15, 0);
|
||||
pr_info("%s B CMU page 0x28 0x7 %08x\n", __func__, rtmdio_931x_read_sds_phy_new(sds, 0x28, 0x7));
|
||||
pr_info("%s A CMU page 0x28 0x7 %08x\n", __func__, rtsds_931x_read(sds, 0x28, 0x7));
|
||||
rtsds_931x_write_field(sds, cmu_page, 0x7, 15, 15, 0);
|
||||
pr_info("%s B CMU page 0x28 0x7 %08x\n", __func__, rtsds_931x_read(sds, 0x28, 0x7));
|
||||
if (chiptype) {
|
||||
rtl9310_sds_field_w_new(sds, cmu_page, 0xd, 14, 14, 0);
|
||||
rtsds_931x_write_field(sds, cmu_page, 0xd, 14, 14, 0);
|
||||
}
|
||||
|
||||
rtl9310_sds_field_w_new(evenSds, 0x20, 0x12, 3, 2, 0x3);
|
||||
rtl9310_sds_field_w_new(evenSds, 0x20, 0x12, frc_lc_mode_bitnum, frc_lc_mode_bitnum, 1);
|
||||
rtl9310_sds_field_w_new(evenSds, 0x20, 0x12, frc_lc_mode_val_bitnum, frc_lc_mode_val_bitnum, 0);
|
||||
rtl9310_sds_field_w_new(evenSds, 0x20, 0x12, 12, 12, 1);
|
||||
rtl9310_sds_field_w_new(evenSds, 0x20, 0x12, 15, 13, frc_cmu_spd);
|
||||
rtsds_931x_write_field(evenSds, 0x20, 0x12, 3, 2, 0x3);
|
||||
rtsds_931x_write_field(evenSds, 0x20, 0x12, frc_lc_mode_bitnum, frc_lc_mode_bitnum, 1);
|
||||
rtsds_931x_write_field(evenSds, 0x20, 0x12, frc_lc_mode_val_bitnum, frc_lc_mode_val_bitnum, 0);
|
||||
rtsds_931x_write_field(evenSds, 0x20, 0x12, 12, 12, 1);
|
||||
rtsds_931x_write_field(evenSds, 0x20, 0x12, 15, 13, frc_cmu_spd);
|
||||
}
|
||||
|
||||
pr_info("%s CMU page 0x28 0x7 %08x\n", __func__, rtmdio_931x_read_sds_phy_new(sds, 0x28, 0x7));
|
||||
pr_info("%s CMU page 0x28 0x7 %08x\n", __func__, rtsds_931x_read(sds, 0x28, 0x7));
|
||||
return;
|
||||
}
|
||||
|
||||
|
|
@ -2878,15 +2854,15 @@ static void rtl931x_sds_rx_rst(u32 sds)
|
|||
if (sds < 2)
|
||||
return;
|
||||
|
||||
rtmdio_931x_write_sds_phy_new(sds, 0x2e, 0x12, 0x2740);
|
||||
rtmdio_931x_write_sds_phy_new(sds, 0x2f, 0x0, 0x0);
|
||||
rtmdio_931x_write_sds_phy_new(sds, 0x2f, 0x2, 0x2010);
|
||||
rtmdio_931x_write_sds_phy_new(sds, 0x20, 0x0, 0xc10);
|
||||
rtsds_931x_write(sds, 0x2e, 0x12, 0x2740);
|
||||
rtsds_931x_write(sds, 0x2f, 0x0, 0x0);
|
||||
rtsds_931x_write(sds, 0x2f, 0x2, 0x2010);
|
||||
rtsds_931x_write(sds, 0x20, 0x0, 0xc10);
|
||||
|
||||
rtmdio_931x_write_sds_phy_new(sds, 0x2e, 0x12, 0x27c0);
|
||||
rtmdio_931x_write_sds_phy_new(sds, 0x2f, 0x0, 0xc000);
|
||||
rtmdio_931x_write_sds_phy_new(sds, 0x2f, 0x2, 0x6010);
|
||||
rtmdio_931x_write_sds_phy_new(sds, 0x20, 0x0, 0xc30);
|
||||
rtsds_931x_write(sds, 0x2e, 0x12, 0x27c0);
|
||||
rtsds_931x_write(sds, 0x2f, 0x0, 0xc000);
|
||||
rtsds_931x_write(sds, 0x2f, 0x2, 0x6010);
|
||||
rtsds_931x_write(sds, 0x20, 0x0, 0xc30);
|
||||
|
||||
mdelay(50);
|
||||
}
|
||||
|
|
@ -2972,20 +2948,20 @@ void rtl931x_sds_init(u32 sds, phy_interface_t mode)
|
|||
return;
|
||||
|
||||
pr_info("%s: set sds %d to mode %d\n", __func__, sds, mode);
|
||||
val = rtl9310_sds_field_r_new(sds, 0x1F, 0x9, 11, 6);
|
||||
val = rtsds_931x_read_field(sds, 0x1F, 0x9, 11, 6);
|
||||
|
||||
pr_info("%s: fibermode %08X stored mode 0x%x", __func__,
|
||||
rtmdio_931x_read_sds_phy_new(sds, 0x1f, 0x9), val);
|
||||
rtsds_931x_read(sds, 0x1f, 0x9), val);
|
||||
pr_info("%s: SGMII mode %08X in 0x24 0x9", __func__,
|
||||
rtmdio_931x_read_sds_phy_new(sds, 0x24, 0x9));
|
||||
rtsds_931x_read(sds, 0x24, 0x9));
|
||||
pr_info("%s: CMU mode %08X stored even SDS %d", __func__,
|
||||
rtmdio_931x_read_sds_phy_new(sds & ~1, 0x20, 0x12), sds & ~1);
|
||||
rtsds_931x_read(sds & ~1, 0x20, 0x12), sds & ~1);
|
||||
pr_info("%s: serdes_mode_ctrl %08X", __func__, RTL931X_SERDES_MODE_CTRL + 4 * (sds >> 2));
|
||||
pr_info("%s CMU page 0x24 0x7 %08x\n", __func__, rtmdio_931x_read_sds_phy_new(sds, 0x24, 0x7));
|
||||
pr_info("%s CMU page 0x26 0x7 %08x\n", __func__, rtmdio_931x_read_sds_phy_new(sds, 0x26, 0x7));
|
||||
pr_info("%s CMU page 0x28 0x7 %08x\n", __func__, rtmdio_931x_read_sds_phy_new(sds, 0x28, 0x7));
|
||||
pr_info("%s XSG page 0x0 0xe %08x\n", __func__, rtmdio_931x_read_sds_phy_new(sds, 0x100, 0xe));
|
||||
pr_info("%s XSG2 page 0x0 0xe %08x\n", __func__, rtmdio_931x_read_sds_phy_new(sds, 0x200, 0xe));
|
||||
pr_info("%s CMU page 0x24 0x7 %08x\n", __func__, rtsds_931x_read(sds, 0x24, 0x7));
|
||||
pr_info("%s CMU page 0x26 0x7 %08x\n", __func__, rtsds_931x_read(sds, 0x26, 0x7));
|
||||
pr_info("%s CMU page 0x28 0x7 %08x\n", __func__, rtsds_931x_read(sds, 0x28, 0x7));
|
||||
pr_info("%s XSG page 0x0 0xe %08x\n", __func__, rtsds_931x_read(sds, 0x100, 0xe));
|
||||
pr_info("%s XSG2 page 0x0 0xe %08x\n", __func__, rtsds_931x_read(sds, 0x200, 0xe));
|
||||
|
||||
model_info = sw_r32(RTL93XX_MODEL_NAME_INFO);
|
||||
if ((model_info >> 4) & 0x1) {
|
||||
|
|
@ -2996,7 +2972,7 @@ void rtl931x_sds_init(u32 sds, phy_interface_t mode)
|
|||
}
|
||||
|
||||
pr_info("%s: 2.5gbit %08X", __func__,
|
||||
rtmdio_931x_read_sds_phy_new(sds, 0x101, 0x14));
|
||||
rtsds_931x_read(sds, 0x101, 0x14));
|
||||
|
||||
pr_info("%s: RTL931X_PS_SERDES_OFF_MODE_CTRL_ADDR 0x%08X\n", __func__, sw_r32(RTL931X_PS_SERDES_OFF_MODE_CTRL_ADDR));
|
||||
ori = sw_r32(RTL931X_PS_SERDES_OFF_MODE_CTRL_ADDR);
|
||||
|
|
@ -3011,16 +2987,16 @@ void rtl931x_sds_init(u32 sds, phy_interface_t mode)
|
|||
|
||||
if (chiptype) {
|
||||
/* fifo inv clk */
|
||||
rtl9310_sds_field_w_new(sds, 0x101, 0x1, 7, 4, 0xf);
|
||||
rtl9310_sds_field_w_new(sds, 0x101, 0x1, 3, 0, 0xf);
|
||||
rtsds_931x_write_field(sds, 0x101, 0x1, 7, 4, 0xf);
|
||||
rtsds_931x_write_field(sds, 0x101, 0x1, 3, 0, 0xf);
|
||||
|
||||
rtl9310_sds_field_w_new(sds, 0x201, 0x1, 7, 4, 0xf);
|
||||
rtl9310_sds_field_w_new(sds, 0x201, 0x1, 3, 0, 0xf);
|
||||
rtsds_931x_write_field(sds, 0x201, 0x1, 7, 4, 0xf);
|
||||
rtsds_931x_write_field(sds, 0x201, 0x1, 3, 0, 0xf);
|
||||
|
||||
}
|
||||
|
||||
rtl9310_sds_field_w_new(sds, 0x100, 0xE, 12, 12, 1);
|
||||
rtl9310_sds_field_w_new(sds, 0x200, 0xE, 12, 12, 1);
|
||||
rtsds_931x_write_field(sds, 0x100, 0xE, 12, 12, 1);
|
||||
rtsds_931x_write_field(sds, 0x200, 0xE, 12, 12, 1);
|
||||
break;
|
||||
|
||||
case PHY_INTERFACE_MODE_USXGMII: /* MII_USXGMII_10GSXGMII/10GDXGMII/10GQXGMII: */
|
||||
|
|
@ -3028,73 +3004,73 @@ void rtl931x_sds_init(u32 sds, phy_interface_t mode)
|
|||
u32 evenSds;
|
||||
|
||||
if (chiptype) {
|
||||
rtl9310_sds_field_w_new(sds, 0x6, 0x2, 12, 12, 1);
|
||||
rtsds_931x_write_field(sds, 0x6, 0x2, 12, 12, 1);
|
||||
|
||||
for (int i = 0; i < sizeof(sds_config_10p3125g_type1) / sizeof(sds_config); ++i) {
|
||||
rtmdio_931x_write_sds_phy_new(sds, sds_config_10p3125g_type1[i].page - 0x4, sds_config_10p3125g_type1[i].reg, sds_config_10p3125g_type1[i].data);
|
||||
rtsds_931x_write(sds, sds_config_10p3125g_type1[i].page - 0x4, sds_config_10p3125g_type1[i].reg, sds_config_10p3125g_type1[i].data);
|
||||
}
|
||||
|
||||
evenSds = sds & ~1;
|
||||
|
||||
for (int i = 0; i < sizeof(sds_config_10p3125g_cmu_type1) / sizeof(sds_config); ++i) {
|
||||
rtmdio_931x_write_sds_phy_new(evenSds,
|
||||
rtsds_931x_write(evenSds,
|
||||
sds_config_10p3125g_cmu_type1[i].page - 0x4, sds_config_10p3125g_cmu_type1[i].reg, sds_config_10p3125g_cmu_type1[i].data);
|
||||
}
|
||||
|
||||
rtl9310_sds_field_w_new(sds, 0x6, 0x2, 12, 12, 0);
|
||||
rtsds_931x_write_field(sds, 0x6, 0x2, 12, 12, 0);
|
||||
} else {
|
||||
|
||||
rtl9310_sds_field_w_new(sds, 0x2e, 0xd, 6, 0, 0x0);
|
||||
rtl9310_sds_field_w_new(sds, 0x2e, 0xd, 7, 7, 0x1);
|
||||
rtsds_931x_write_field(sds, 0x2e, 0xd, 6, 0, 0x0);
|
||||
rtsds_931x_write_field(sds, 0x2e, 0xd, 7, 7, 0x1);
|
||||
|
||||
rtl9310_sds_field_w_new(sds, 0x2e, 0x1c, 5, 0, 0x1E);
|
||||
rtl9310_sds_field_w_new(sds, 0x2e, 0x1d, 11, 0, 0x00);
|
||||
rtl9310_sds_field_w_new(sds, 0x2e, 0x1f, 11, 0, 0x00);
|
||||
rtl9310_sds_field_w_new(sds, 0x2f, 0x0, 11, 0, 0x00);
|
||||
rtl9310_sds_field_w_new(sds, 0x2f, 0x1, 11, 0, 0x00);
|
||||
rtsds_931x_write_field(sds, 0x2e, 0x1c, 5, 0, 0x1E);
|
||||
rtsds_931x_write_field(sds, 0x2e, 0x1d, 11, 0, 0x00);
|
||||
rtsds_931x_write_field(sds, 0x2e, 0x1f, 11, 0, 0x00);
|
||||
rtsds_931x_write_field(sds, 0x2f, 0x0, 11, 0, 0x00);
|
||||
rtsds_931x_write_field(sds, 0x2f, 0x1, 11, 0, 0x00);
|
||||
|
||||
rtl9310_sds_field_w_new(sds, 0x2e, 0xf, 12, 6, 0x7F);
|
||||
rtmdio_931x_write_sds_phy_new(sds, 0x2f, 0x12, 0xaaa);
|
||||
rtsds_931x_write_field(sds, 0x2e, 0xf, 12, 6, 0x7F);
|
||||
rtsds_931x_write(sds, 0x2f, 0x12, 0xaaa);
|
||||
|
||||
rtl931x_sds_rx_rst(sds);
|
||||
|
||||
rtmdio_931x_write_sds_phy_new(sds, 0x7, 0x10, op_code);
|
||||
rtmdio_931x_write_sds_phy_new(sds, 0x6, 0x1d, 0x0480);
|
||||
rtmdio_931x_write_sds_phy_new(sds, 0x6, 0xe, 0x0400);
|
||||
rtsds_931x_write(sds, 0x7, 0x10, op_code);
|
||||
rtsds_931x_write(sds, 0x6, 0x1d, 0x0480);
|
||||
rtsds_931x_write(sds, 0x6, 0xe, 0x0400);
|
||||
}
|
||||
break;
|
||||
|
||||
case PHY_INTERFACE_MODE_10GBASER: /* MII_10GR / MII_10GR1000BX_AUTO: */
|
||||
/* configure 10GR fiber mode=1 */
|
||||
rtl9310_sds_field_w_new(sds, 0x1f, 0xb, 1, 1, 1);
|
||||
rtsds_931x_write_field(sds, 0x1f, 0xb, 1, 1, 1);
|
||||
|
||||
/* init fiber_1g */
|
||||
rtl9310_sds_field_w_new(sds, 0x103, 0x13, 15, 14, 0);
|
||||
rtsds_931x_write_field(sds, 0x103, 0x13, 15, 14, 0);
|
||||
|
||||
rtl9310_sds_field_w_new(sds, 0x102, 0x0, 12, 12, 1);
|
||||
rtl9310_sds_field_w_new(sds, 0x102, 0x0, 6, 6, 1);
|
||||
rtl9310_sds_field_w_new(sds, 0x102, 0x0, 13, 13, 0);
|
||||
rtsds_931x_write_field(sds, 0x102, 0x0, 12, 12, 1);
|
||||
rtsds_931x_write_field(sds, 0x102, 0x0, 6, 6, 1);
|
||||
rtsds_931x_write_field(sds, 0x102, 0x0, 13, 13, 0);
|
||||
|
||||
/* init auto */
|
||||
rtl9310_sds_field_w_new(sds, 0x1f, 13, 15, 0, 0x109e);
|
||||
rtl9310_sds_field_w_new(sds, 0x1f, 0x6, 14, 10, 0x8);
|
||||
rtl9310_sds_field_w_new(sds, 0x1f, 0x7, 10, 4, 0x7f);
|
||||
rtsds_931x_write_field(sds, 0x1f, 13, 15, 0, 0x109e);
|
||||
rtsds_931x_write_field(sds, 0x1f, 0x6, 14, 10, 0x8);
|
||||
rtsds_931x_write_field(sds, 0x1f, 0x7, 10, 4, 0x7f);
|
||||
break;
|
||||
|
||||
case PHY_INTERFACE_MODE_1000BASEX: /* MII_1000BX_FIBER */
|
||||
rtl9310_sds_field_w_new(sds, 0x103, 0x13, 15, 14, 0);
|
||||
rtsds_931x_write_field(sds, 0x103, 0x13, 15, 14, 0);
|
||||
|
||||
rtl9310_sds_field_w_new(sds, 0x102, 0x0, 12, 12, 1);
|
||||
rtl9310_sds_field_w_new(sds, 0x102, 0x0, 6, 6, 1);
|
||||
rtl9310_sds_field_w_new(sds, 0x102, 0x0, 13, 13, 0);
|
||||
rtsds_931x_write_field(sds, 0x102, 0x0, 12, 12, 1);
|
||||
rtsds_931x_write_field(sds, 0x102, 0x0, 6, 6, 1);
|
||||
rtsds_931x_write_field(sds, 0x102, 0x0, 13, 13, 0);
|
||||
break;
|
||||
|
||||
case PHY_INTERFACE_MODE_SGMII:
|
||||
rtl9310_sds_field_w_new(sds, 0x24, 0x9, 15, 15, 0);
|
||||
rtsds_931x_write_field(sds, 0x24, 0x9, 15, 15, 0);
|
||||
break;
|
||||
|
||||
case PHY_INTERFACE_MODE_2500BASEX:
|
||||
rtl9310_sds_field_w_new(sds, 0x101, 0x14, 8, 8, 1);
|
||||
rtsds_931x_write_field(sds, 0x101, 0x14, 8, 8, 1);
|
||||
break;
|
||||
|
||||
case PHY_INTERFACE_MODE_QSGMII:
|
||||
|
|
@ -3108,16 +3084,16 @@ void rtl931x_sds_init(u32 sds, phy_interface_t mode)
|
|||
|
||||
if (sds >= 2 && sds <= 13) {
|
||||
if (chiptype)
|
||||
rtmdio_931x_write_sds_phy_new(sds, 0x2E, 0x1, board_sds_tx_type1[sds - 2]);
|
||||
rtsds_931x_write(sds, 0x2E, 0x1, board_sds_tx_type1[sds - 2]);
|
||||
else {
|
||||
val = 0xa0000;
|
||||
sw_w32(val, RTL93XX_CHIP_INFO);
|
||||
val = sw_r32(RTL93XX_CHIP_INFO);
|
||||
if (val & BIT(28)) /* consider 9311 etc. RTL9313_CHIP_ID == HWP_CHIP_ID(unit)) */
|
||||
{
|
||||
rtmdio_931x_write_sds_phy_new(sds, 0x2E, 0x1, board_sds_tx2[sds - 2]);
|
||||
rtsds_931x_write(sds, 0x2E, 0x1, board_sds_tx2[sds - 2]);
|
||||
} else {
|
||||
rtmdio_931x_write_sds_phy_new(sds, 0x2E, 0x1, board_sds_tx[sds - 2]);
|
||||
rtsds_931x_write(sds, 0x2E, 0x1, board_sds_tx[sds - 2]);
|
||||
}
|
||||
val = 0;
|
||||
sw_w32(val, RTL93XX_CHIP_INFO);
|
||||
|
|
@ -3148,14 +3124,14 @@ int rtl931x_sds_cmu_band_set(int sds, bool enable, u32 band, phy_interface_t mod
|
|||
page += 1;
|
||||
|
||||
if (enable) {
|
||||
rtl9310_sds_field_w_new(sds, page, 0x7, 13, 13, 0);
|
||||
rtl9310_sds_field_w_new(sds, page, 0x7, 11, 11, 0);
|
||||
rtsds_931x_write_field(sds, page, 0x7, 13, 13, 0);
|
||||
rtsds_931x_write_field(sds, page, 0x7, 11, 11, 0);
|
||||
} else {
|
||||
rtl9310_sds_field_w_new(sds, page, 0x7, 13, 13, 0);
|
||||
rtl9310_sds_field_w_new(sds, page, 0x7, 11, 11, 0);
|
||||
rtsds_931x_write_field(sds, page, 0x7, 13, 13, 0);
|
||||
rtsds_931x_write_field(sds, page, 0x7, 11, 11, 0);
|
||||
}
|
||||
|
||||
rtl9310_sds_field_w_new(sds, page, 0x7, 4, 0, band);
|
||||
rtsds_931x_write_field(sds, page, 0x7, 4, 0, band);
|
||||
|
||||
rtl931x_sds_rst(sds);
|
||||
|
||||
|
|
@ -3169,10 +3145,10 @@ int rtl931x_sds_cmu_band_get(int sds, phy_interface_t mode)
|
|||
|
||||
sds -= (sds % 2);
|
||||
page += 1;
|
||||
rtmdio_931x_write_sds_phy_new(sds, 0x1f, 0x02, 73);
|
||||
rtsds_931x_write(sds, 0x1f, 0x02, 73);
|
||||
|
||||
rtl9310_sds_field_w_new(sds, page, 0x5, 15, 15, 1);
|
||||
band = rtl9310_sds_field_r_new(sds, 0x1f, 0x15, 8, 3);
|
||||
rtsds_931x_write_field(sds, page, 0x5, 15, 15, 1);
|
||||
band = rtsds_931x_read_field(sds, 0x1f, 0x15, 8, 3);
|
||||
pr_info("%s band is: %d\n", __func__, band);
|
||||
|
||||
return band;
|
||||
|
|
@ -3183,15 +3159,15 @@ int rtl931x_link_sts_get(u32 sds)
|
|||
{
|
||||
u32 sts, sts1, latch_sts, latch_sts1;
|
||||
if (0){
|
||||
sts = rtl9310_sds_field_r_new(sds, 0x101, 29, 8, 0);
|
||||
sts1 = rtl9310_sds_field_r_new(sds, 0x201, 29, 8, 0);
|
||||
latch_sts = rtl9310_sds_field_r_new(sds, 0x101, 30, 8, 0);
|
||||
latch_sts1 = rtl9310_sds_field_r_new(sds, 0x201, 30, 8, 0);
|
||||
sts = rtsds_931x_read_field(sds, 0x101, 29, 8, 0);
|
||||
sts1 = rtsds_931x_read_field(sds, 0x201, 29, 8, 0);
|
||||
latch_sts = rtsds_931x_read_field(sds, 0x101, 30, 8, 0);
|
||||
latch_sts1 = rtsds_931x_read_field(sds, 0x201, 30, 8, 0);
|
||||
} else {
|
||||
sts = rtl9310_sds_field_r_new(sds, 0x5, 0, 12, 12);
|
||||
latch_sts = rtl9310_sds_field_r_new(sds, 0x4, 1, 2, 2);
|
||||
latch_sts1 = rtl9310_sds_field_r_new(sds, 0x102, 1, 2, 2);
|
||||
sts1 = rtl9310_sds_field_r_new(sds, 0x102, 1, 2, 2);
|
||||
sts = rtsds_931x_read_field(sds, 0x5, 0, 12, 12);
|
||||
latch_sts = rtsds_931x_read_field(sds, 0x4, 1, 2, 2);
|
||||
latch_sts1 = rtsds_931x_read_field(sds, 0x102, 1, 2, 2);
|
||||
sts1 = rtsds_931x_read_field(sds, 0x102, 1, 2, 2);
|
||||
}
|
||||
|
||||
pr_info("%s: serdes %d sts %d, sts1 %d, latch_sts %d, latch_sts1 %d\n", __func__,
|
||||
|
|
|
|||
Loading…
Add table
Reference in a new issue