kernel: make BCM54210E PHY code work with 4.4
[openwrt/openwrt.git] / target / linux / generic / patches-4.4 / 078-0004-net-phy-pick-Broadcom-drivers-updates-from-net-next-.patch
1 From: =?UTF-8?q?Rafa=C5=82=20Mi=C5=82ecki?= <rafal@milecki.pl>
2 Subject: [PATCH 2/2] net: phy: pick Broadcom drivers updates from net-next for
3 4.11
4 MIME-Version: 1.0
5 Content-Type: text/plain; charset=UTF-8
6 Content-Transfer-Encoding: 8bit
7
8 Signed-off-by: Rafał Miłecki <rafal@milecki.pl>
9 ---
10
11 --- a/drivers/net/phy/bcm7xxx.c
12 +++ b/drivers/net/phy/bcm7xxx.c
13 @@ -163,12 +163,43 @@ static int bcm7xxx_28nm_e0_plus_afe_conf
14 return 0;
15 }
16
17 +static int bcm7xxx_28nm_a0_patch_afe_config_init(struct phy_device *phydev)
18 +{
19 + /* +1 RC_CAL codes for RL centering for both LT and HT conditions */
20 + bcm_phy_write_misc(phydev, AFE_RXCONFIG_2, 0xd003);
21 +
22 + /* Cut master bias current by 2% to compensate for RC_CAL offset */
23 + bcm_phy_write_misc(phydev, DSP_TAP10, 0x791b);
24 +
25 + /* Improve hybrid leakage */
26 + bcm_phy_write_misc(phydev, AFE_HPF_TRIM_OTHERS, 0x10e3);
27 +
28 + /* Change rx_on_tune 8 to 0xf */
29 + bcm_phy_write_misc(phydev, 0x21, 0x2, 0x87f6);
30 +
31 + /* Change 100Tx EEE bandwidth */
32 + bcm_phy_write_misc(phydev, 0x22, 0x2, 0x017d);
33 +
34 + /* Enable ffe zero detection for Vitesse interoperability */
35 + bcm_phy_write_misc(phydev, 0x26, 0x2, 0x0015);
36 +
37 + r_rc_cal_reset(phydev);
38 +
39 + return 0;
40 +}
41 +
42 static int bcm7xxx_28nm_config_init(struct phy_device *phydev)
43 {
44 u8 rev = PHY_BRCM_7XXX_REV(phydev->dev_flags);
45 u8 patch = PHY_BRCM_7XXX_PATCH(phydev->dev_flags);
46 int ret = 0;
47
48 + /* Newer devices have moved the revision information back into a
49 + * standard location in MII_PHYS_ID[23]
50 + */
51 + if (rev == 0)
52 + rev = phydev->phy_id & ~phydev->drv->phy_id_mask;
53 +
54 pr_info_once("%s: %s PHY revision: 0x%02x, patch: %d\n",
55 dev_name(&phydev->dev), phydev->drv->name, rev, patch);
56
57 @@ -192,6 +223,9 @@ static int bcm7xxx_28nm_config_init(stru
58 case 0x10:
59 ret = bcm7xxx_28nm_e0_plus_afe_config_init(phydev);
60 break;
61 + case 0x01:
62 + ret = bcm7xxx_28nm_a0_patch_afe_config_init(phydev);
63 + break;
64 default:
65 break;
66 }
67 @@ -336,6 +370,7 @@ static int bcm7xxx_suspend(struct phy_de
68
69 static struct phy_driver bcm7xxx_driver[] = {
70 BCM7XXX_28NM_GPHY(PHY_ID_BCM7250, "Broadcom BCM7250"),
71 + BCM7XXX_28NM_GPHY(PHY_ID_BCM7278, "Broadcom BCM7278"),
72 BCM7XXX_28NM_GPHY(PHY_ID_BCM7364, "Broadcom BCM7364"),
73 BCM7XXX_28NM_GPHY(PHY_ID_BCM7366, "Broadcom BCM7366"),
74 BCM7XXX_28NM_GPHY(PHY_ID_BCM7439, "Broadcom BCM7439"),
75 @@ -350,6 +385,7 @@ static struct phy_driver bcm7xxx_driver[
76
77 static struct mdio_device_id __maybe_unused bcm7xxx_tbl[] = {
78 { PHY_ID_BCM7250, 0xfffffff0, },
79 + { PHY_ID_BCM7278, 0xfffffff0, },
80 { PHY_ID_BCM7364, 0xfffffff0, },
81 { PHY_ID_BCM7366, 0xfffffff0, },
82 { PHY_ID_BCM7346, 0xfffffff0, },
83 --- a/drivers/net/phy/broadcom.c
84 +++ b/drivers/net/phy/broadcom.c
85 @@ -30,6 +30,22 @@ MODULE_DESCRIPTION("Broadcom PHY driver"
86 MODULE_AUTHOR("Maciej W. Rozycki");
87 MODULE_LICENSE("GPL");
88
89 +static int bcm54210e_config_init(struct phy_device *phydev)
90 +{
91 + int val;
92 +
93 + val = bcm54xx_auxctl_read(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC);
94 + val &= ~MII_BCM54XX_AUXCTL_SHDWSEL_MISC_RGMII_SKEW_EN;
95 + val |= MII_BCM54XX_AUXCTL_MISC_WREN;
96 + bcm54xx_auxctl_write(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC, val);
97 +
98 + val = bcm_phy_read_shadow(phydev, BCM54810_SHD_CLK_CTL);
99 + val &= ~BCM54810_SHD_CLK_CTL_GTXCLK_EN;
100 + bcm_phy_write_shadow(phydev, BCM54810_SHD_CLK_CTL, val);
101 +
102 + return 0;
103 +}
104 +
105 static int bcm54810_config(struct phy_device *phydev)
106 {
107 int rc, val;
108 @@ -230,7 +246,11 @@ static int bcm54xx_config_init(struct ph
109 (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE))
110 bcm54xx_adjust_rxrefclk(phydev);
111
112 - if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54810) {
113 + if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54210E) {
114 + err = bcm54210e_config_init(phydev);
115 + if (err)
116 + return err;
117 + } else if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54810) {
118 err = bcm54810_config(phydev);
119 if (err)
120 return err;
121 @@ -395,12 +415,10 @@ static int bcm54612e_config_aneg(struct
122 (phydev->interface != PHY_INTERFACE_MODE_RGMII_RXID)) {
123 u16 reg;
124
125 - /* Errata: reads require filling in the write selector field */
126 - bcm54xx_auxctl_write(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC,
127 - MII_BCM54XX_AUXCTL_MISC_RDSEL_MISC);
128 - reg = phy_read(phydev, MII_BCM54XX_AUX_CTL);
129 + reg = bcm54xx_auxctl_read(phydev,
130 + MII_BCM54XX_AUXCTL_SHDWSEL_MISC);
131 /* Disable RXD to RXC delay (default set) */
132 - reg &= ~MII_BCM54XX_AUXCTL_MISC_RXD_RXC_SKEW;
133 + reg &= ~MII_BCM54XX_AUXCTL_SHDWSEL_MISC_RGMII_SKEW_EN;
134 /* Clear shadow selector field */
135 reg &= ~MII_BCM54XX_AUXCTL_SHDWSEL_MASK;
136 bcm54xx_auxctl_write(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC,
137 @@ -548,6 +566,19 @@ static struct phy_driver broadcom_driver
138 .config_intr = bcm_phy_config_intr,
139 .driver = { .owner = THIS_MODULE },
140 }, {
141 + .phy_id = PHY_ID_BCM54210E,
142 + .phy_id_mask = 0xfffffff0,
143 + .name = "Broadcom BCM54210E",
144 + .features = PHY_GBIT_FEATURES |
145 + SUPPORTED_Pause | SUPPORTED_Asym_Pause,
146 + .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
147 + .config_init = bcm54xx_config_init,
148 + .config_aneg = genphy_config_aneg,
149 + .read_status = genphy_read_status,
150 + .ack_interrupt = bcm_phy_ack_intr,
151 + .config_intr = bcm_phy_config_intr,
152 + .driver = { .owner = THIS_MODULE },
153 +}, {
154 .phy_id = PHY_ID_BCM5461,
155 .phy_id_mask = 0xfffffff0,
156 .name = "Broadcom BCM5461",
157 @@ -708,6 +739,7 @@ module_phy_driver(broadcom_drivers);
158 static struct mdio_device_id __maybe_unused broadcom_tbl[] = {
159 { PHY_ID_BCM5411, 0xfffffff0 },
160 { PHY_ID_BCM5421, 0xfffffff0 },
161 + { PHY_ID_BCM54210E, 0xfffffff0 },
162 { PHY_ID_BCM5461, 0xfffffff0 },
163 { PHY_ID_BCM54612E, 0xfffffff0 },
164 { PHY_ID_BCM54616S, 0xfffffff0 },
165 --- a/include/linux/brcmphy.h
166 +++ b/include/linux/brcmphy.h
167 @@ -17,6 +17,7 @@
168 #define PHY_ID_BCM5482 0x0143bcb0
169 #define PHY_ID_BCM5411 0x00206070
170 #define PHY_ID_BCM5421 0x002060e0
171 +#define PHY_ID_BCM54210E 0x600d84a0
172 #define PHY_ID_BCM5464 0x002060b0
173 #define PHY_ID_BCM5461 0x002060c0
174 #define PHY_ID_BCM54612E 0x03625e60
175 @@ -24,6 +25,7 @@
176 #define PHY_ID_BCM57780 0x03625d90
177
178 #define PHY_ID_BCM7250 0xae025280
179 +#define PHY_ID_BCM7278 0xae0251a0
180 #define PHY_ID_BCM7364 0xae025260
181 #define PHY_ID_BCM7366 0x600d8490
182 #define PHY_ID_BCM7346 0x600d8650
183 @@ -103,18 +105,17 @@
184 /*
185 * AUXILIARY CONTROL SHADOW ACCESS REGISTERS. (PHY REG 0x18)
186 */
187 -#define MII_BCM54XX_AUXCTL_SHDWSEL_AUXCTL 0x0000
188 +#define MII_BCM54XX_AUXCTL_SHDWSEL_AUXCTL 0x00
189 #define MII_BCM54XX_AUXCTL_ACTL_TX_6DB 0x0400
190 #define MII_BCM54XX_AUXCTL_ACTL_SMDSP_ENA 0x0800
191
192 -#define MII_BCM54XX_AUXCTL_MISC_WREN 0x8000
193 -#define MII_BCM54XX_AUXCTL_MISC_RXD_RXC_SKEW 0x0100
194 -#define MII_BCM54XX_AUXCTL_MISC_FORCE_AMDIX 0x0200
195 -#define MII_BCM54XX_AUXCTL_MISC_RDSEL_MISC 0x7000
196 -#define MII_BCM54XX_AUXCTL_SHDWSEL_MISC 0x0007
197 -#define MII_BCM54XX_AUXCTL_SHDWSEL_READ_SHIFT 12
198 -#define MII_BCM54XX_AUXCTL_SHDWSEL_MISC_RGMII_SKEW_EN (1 << 8)
199 +#define MII_BCM54XX_AUXCTL_SHDWSEL_MISC 0x07
200 +#define MII_BCM54XX_AUXCTL_SHDWSEL_MISC_WIRESPEED_EN 0x0010
201 +#define MII_BCM54XX_AUXCTL_SHDWSEL_MISC_RGMII_SKEW_EN 0x0100
202 +#define MII_BCM54XX_AUXCTL_MISC_FORCE_AMDIX 0x0200
203 +#define MII_BCM54XX_AUXCTL_MISC_WREN 0x8000
204
205 +#define MII_BCM54XX_AUXCTL_SHDWSEL_READ_SHIFT 12
206 #define MII_BCM54XX_AUXCTL_SHDWSEL_MASK 0x0007
207
208 /*