This source file includes following definitions.
- tja11xx_check
- phy_modify_check
- tja11xx_enable_reg_write
- tja11xx_enable_link_control
- tja11xx_wakeup
- tja11xx_soft_reset
- tja11xx_config_init
- tja11xx_read_status
- tja11xx_get_sset_count
- tja11xx_get_strings
- tja11xx_get_stats
- tja11xx_hwmon_read
- tja11xx_hwmon_is_visible
- tja11xx_probe
1
2
3
4
5
6 #include <linux/delay.h>
7 #include <linux/ethtool.h>
8 #include <linux/kernel.h>
9 #include <linux/mii.h>
10 #include <linux/module.h>
11 #include <linux/phy.h>
12 #include <linux/hwmon.h>
13 #include <linux/bitfield.h>
14
15 #define PHY_ID_MASK 0xfffffff0
16 #define PHY_ID_TJA1100 0x0180dc40
17 #define PHY_ID_TJA1101 0x0180dd00
18
19 #define MII_ECTRL 17
20 #define MII_ECTRL_LINK_CONTROL BIT(15)
21 #define MII_ECTRL_POWER_MODE_MASK GENMASK(14, 11)
22 #define MII_ECTRL_POWER_MODE_NO_CHANGE (0x0 << 11)
23 #define MII_ECTRL_POWER_MODE_NORMAL (0x3 << 11)
24 #define MII_ECTRL_POWER_MODE_STANDBY (0xc << 11)
25 #define MII_ECTRL_CONFIG_EN BIT(2)
26 #define MII_ECTRL_WAKE_REQUEST BIT(0)
27
28 #define MII_CFG1 18
29 #define MII_CFG1_AUTO_OP BIT(14)
30 #define MII_CFG1_SLEEP_CONFIRM BIT(6)
31 #define MII_CFG1_LED_MODE_MASK GENMASK(5, 4)
32 #define MII_CFG1_LED_MODE_LINKUP 0
33 #define MII_CFG1_LED_ENABLE BIT(3)
34
35 #define MII_CFG2 19
36 #define MII_CFG2_SLEEP_REQUEST_TO GENMASK(1, 0)
37 #define MII_CFG2_SLEEP_REQUEST_TO_16MS 0x3
38
39 #define MII_INTSRC 21
40 #define MII_INTSRC_TEMP_ERR BIT(1)
41 #define MII_INTSRC_UV_ERR BIT(3)
42
43 #define MII_COMMSTAT 23
44 #define MII_COMMSTAT_LINK_UP BIT(15)
45
46 #define MII_GENSTAT 24
47 #define MII_GENSTAT_PLL_LOCKED BIT(14)
48
49 #define MII_COMMCFG 27
50 #define MII_COMMCFG_AUTO_OP BIT(15)
51
52 struct tja11xx_priv {
53 char *hwmon_name;
54 struct device *hwmon_dev;
55 };
56
57 struct tja11xx_phy_stats {
58 const char *string;
59 u8 reg;
60 u8 off;
61 u16 mask;
62 };
63
64 static struct tja11xx_phy_stats tja11xx_hw_stats[] = {
65 { "phy_symbol_error_count", 20, 0, GENMASK(15, 0) },
66 { "phy_polarity_detect", 25, 6, BIT(6) },
67 { "phy_open_detect", 25, 7, BIT(7) },
68 { "phy_short_detect", 25, 8, BIT(8) },
69 { "phy_rem_rcvr_count", 26, 0, GENMASK(7, 0) },
70 { "phy_loc_rcvr_count", 26, 8, GENMASK(15, 8) },
71 };
72
73 static int tja11xx_check(struct phy_device *phydev, u8 reg, u16 mask, u16 set)
74 {
75 int i, ret;
76
77 for (i = 0; i < 200; i++) {
78 ret = phy_read(phydev, reg);
79 if (ret < 0)
80 return ret;
81
82 if ((ret & mask) == set)
83 return 0;
84
85 usleep_range(100, 150);
86 }
87
88 return -ETIMEDOUT;
89 }
90
91 static int phy_modify_check(struct phy_device *phydev, u8 reg,
92 u16 mask, u16 set)
93 {
94 int ret;
95
96 ret = phy_modify(phydev, reg, mask, set);
97 if (ret)
98 return ret;
99
100 return tja11xx_check(phydev, reg, mask, set);
101 }
102
103 static int tja11xx_enable_reg_write(struct phy_device *phydev)
104 {
105 return phy_set_bits(phydev, MII_ECTRL, MII_ECTRL_CONFIG_EN);
106 }
107
108 static int tja11xx_enable_link_control(struct phy_device *phydev)
109 {
110 return phy_set_bits(phydev, MII_ECTRL, MII_ECTRL_LINK_CONTROL);
111 }
112
113 static int tja11xx_wakeup(struct phy_device *phydev)
114 {
115 int ret;
116
117 ret = phy_read(phydev, MII_ECTRL);
118 if (ret < 0)
119 return ret;
120
121 switch (ret & MII_ECTRL_POWER_MODE_MASK) {
122 case MII_ECTRL_POWER_MODE_NO_CHANGE:
123 break;
124 case MII_ECTRL_POWER_MODE_NORMAL:
125 ret = phy_set_bits(phydev, MII_ECTRL, MII_ECTRL_WAKE_REQUEST);
126 if (ret)
127 return ret;
128
129 ret = phy_clear_bits(phydev, MII_ECTRL, MII_ECTRL_WAKE_REQUEST);
130 if (ret)
131 return ret;
132 break;
133 case MII_ECTRL_POWER_MODE_STANDBY:
134 ret = phy_modify_check(phydev, MII_ECTRL,
135 MII_ECTRL_POWER_MODE_MASK,
136 MII_ECTRL_POWER_MODE_STANDBY);
137 if (ret)
138 return ret;
139
140 ret = phy_modify(phydev, MII_ECTRL, MII_ECTRL_POWER_MODE_MASK,
141 MII_ECTRL_POWER_MODE_NORMAL);
142 if (ret)
143 return ret;
144
145 ret = phy_modify_check(phydev, MII_GENSTAT,
146 MII_GENSTAT_PLL_LOCKED,
147 MII_GENSTAT_PLL_LOCKED);
148 if (ret)
149 return ret;
150
151 return tja11xx_enable_link_control(phydev);
152 default:
153 break;
154 }
155
156 return 0;
157 }
158
159 static int tja11xx_soft_reset(struct phy_device *phydev)
160 {
161 int ret;
162
163 ret = tja11xx_enable_reg_write(phydev);
164 if (ret)
165 return ret;
166
167 return genphy_soft_reset(phydev);
168 }
169
170 static int tja11xx_config_init(struct phy_device *phydev)
171 {
172 int ret;
173
174 ret = tja11xx_enable_reg_write(phydev);
175 if (ret)
176 return ret;
177
178 phydev->autoneg = AUTONEG_DISABLE;
179 phydev->speed = SPEED_100;
180 phydev->duplex = DUPLEX_FULL;
181
182 switch (phydev->phy_id & PHY_ID_MASK) {
183 case PHY_ID_TJA1100:
184 ret = phy_modify(phydev, MII_CFG1,
185 MII_CFG1_AUTO_OP | MII_CFG1_LED_MODE_MASK |
186 MII_CFG1_LED_ENABLE,
187 MII_CFG1_AUTO_OP | MII_CFG1_LED_MODE_LINKUP |
188 MII_CFG1_LED_ENABLE);
189 if (ret)
190 return ret;
191 break;
192 case PHY_ID_TJA1101:
193 ret = phy_set_bits(phydev, MII_COMMCFG, MII_COMMCFG_AUTO_OP);
194 if (ret)
195 return ret;
196 break;
197 default:
198 return -EINVAL;
199 }
200
201 ret = phy_clear_bits(phydev, MII_CFG1, MII_CFG1_SLEEP_CONFIRM);
202 if (ret)
203 return ret;
204
205 ret = phy_modify(phydev, MII_CFG2, MII_CFG2_SLEEP_REQUEST_TO,
206 MII_CFG2_SLEEP_REQUEST_TO_16MS);
207 if (ret)
208 return ret;
209
210 ret = tja11xx_wakeup(phydev);
211 if (ret < 0)
212 return ret;
213
214
215 ret = phy_read(phydev, MII_INTSRC);
216 if (ret < 0)
217 return ret;
218
219 return 0;
220 }
221
222 static int tja11xx_read_status(struct phy_device *phydev)
223 {
224 int ret;
225
226 ret = genphy_update_link(phydev);
227 if (ret)
228 return ret;
229
230 if (phydev->link) {
231 ret = phy_read(phydev, MII_COMMSTAT);
232 if (ret < 0)
233 return ret;
234
235 if (!(ret & MII_COMMSTAT_LINK_UP))
236 phydev->link = 0;
237 }
238
239 return 0;
240 }
241
242 static int tja11xx_get_sset_count(struct phy_device *phydev)
243 {
244 return ARRAY_SIZE(tja11xx_hw_stats);
245 }
246
247 static void tja11xx_get_strings(struct phy_device *phydev, u8 *data)
248 {
249 int i;
250
251 for (i = 0; i < ARRAY_SIZE(tja11xx_hw_stats); i++) {
252 strncpy(data + i * ETH_GSTRING_LEN,
253 tja11xx_hw_stats[i].string, ETH_GSTRING_LEN);
254 }
255 }
256
257 static void tja11xx_get_stats(struct phy_device *phydev,
258 struct ethtool_stats *stats, u64 *data)
259 {
260 int i, ret;
261
262 for (i = 0; i < ARRAY_SIZE(tja11xx_hw_stats); i++) {
263 ret = phy_read(phydev, tja11xx_hw_stats[i].reg);
264 if (ret < 0)
265 data[i] = U64_MAX;
266 else {
267 data[i] = ret & tja11xx_hw_stats[i].mask;
268 data[i] >>= tja11xx_hw_stats[i].off;
269 }
270 }
271 }
272
273 static int tja11xx_hwmon_read(struct device *dev,
274 enum hwmon_sensor_types type,
275 u32 attr, int channel, long *value)
276 {
277 struct phy_device *phydev = dev_get_drvdata(dev);
278 int ret;
279
280 if (type == hwmon_in && attr == hwmon_in_lcrit_alarm) {
281 ret = phy_read(phydev, MII_INTSRC);
282 if (ret < 0)
283 return ret;
284
285 *value = !!(ret & MII_INTSRC_TEMP_ERR);
286 return 0;
287 }
288
289 if (type == hwmon_temp && attr == hwmon_temp_crit_alarm) {
290 ret = phy_read(phydev, MII_INTSRC);
291 if (ret < 0)
292 return ret;
293
294 *value = !!(ret & MII_INTSRC_UV_ERR);
295 return 0;
296 }
297
298 return -EOPNOTSUPP;
299 }
300
301 static umode_t tja11xx_hwmon_is_visible(const void *data,
302 enum hwmon_sensor_types type,
303 u32 attr, int channel)
304 {
305 if (type == hwmon_in && attr == hwmon_in_lcrit_alarm)
306 return 0444;
307
308 if (type == hwmon_temp && attr == hwmon_temp_crit_alarm)
309 return 0444;
310
311 return 0;
312 }
313
314 static const struct hwmon_channel_info *tja11xx_hwmon_info[] = {
315 HWMON_CHANNEL_INFO(in, HWMON_I_LCRIT_ALARM),
316 HWMON_CHANNEL_INFO(temp, HWMON_T_CRIT_ALARM),
317 NULL
318 };
319
320 static const struct hwmon_ops tja11xx_hwmon_hwmon_ops = {
321 .is_visible = tja11xx_hwmon_is_visible,
322 .read = tja11xx_hwmon_read,
323 };
324
325 static const struct hwmon_chip_info tja11xx_hwmon_chip_info = {
326 .ops = &tja11xx_hwmon_hwmon_ops,
327 .info = tja11xx_hwmon_info,
328 };
329
330 static int tja11xx_probe(struct phy_device *phydev)
331 {
332 struct device *dev = &phydev->mdio.dev;
333 struct tja11xx_priv *priv;
334 int i;
335
336 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
337 if (!priv)
338 return -ENOMEM;
339
340 priv->hwmon_name = devm_kstrdup(dev, dev_name(dev), GFP_KERNEL);
341 if (!priv->hwmon_name)
342 return -ENOMEM;
343
344 for (i = 0; priv->hwmon_name[i]; i++)
345 if (hwmon_is_bad_char(priv->hwmon_name[i]))
346 priv->hwmon_name[i] = '_';
347
348 priv->hwmon_dev =
349 devm_hwmon_device_register_with_info(dev, priv->hwmon_name,
350 phydev,
351 &tja11xx_hwmon_chip_info,
352 NULL);
353
354 return PTR_ERR_OR_ZERO(priv->hwmon_dev);
355 }
356
357 static struct phy_driver tja11xx_driver[] = {
358 {
359 PHY_ID_MATCH_MODEL(PHY_ID_TJA1100),
360 .name = "NXP TJA1100",
361 .features = PHY_BASIC_T1_FEATURES,
362 .probe = tja11xx_probe,
363 .soft_reset = tja11xx_soft_reset,
364 .config_init = tja11xx_config_init,
365 .read_status = tja11xx_read_status,
366 .suspend = genphy_suspend,
367 .resume = genphy_resume,
368 .set_loopback = genphy_loopback,
369
370 .get_sset_count = tja11xx_get_sset_count,
371 .get_strings = tja11xx_get_strings,
372 .get_stats = tja11xx_get_stats,
373 }, {
374 PHY_ID_MATCH_MODEL(PHY_ID_TJA1101),
375 .name = "NXP TJA1101",
376 .features = PHY_BASIC_T1_FEATURES,
377 .probe = tja11xx_probe,
378 .soft_reset = tja11xx_soft_reset,
379 .config_init = tja11xx_config_init,
380 .read_status = tja11xx_read_status,
381 .suspend = genphy_suspend,
382 .resume = genphy_resume,
383 .set_loopback = genphy_loopback,
384
385 .get_sset_count = tja11xx_get_sset_count,
386 .get_strings = tja11xx_get_strings,
387 .get_stats = tja11xx_get_stats,
388 }
389 };
390
391 module_phy_driver(tja11xx_driver);
392
393 static struct mdio_device_id __maybe_unused tja11xx_tbl[] = {
394 { PHY_ID_MATCH_MODEL(PHY_ID_TJA1100) },
395 { PHY_ID_MATCH_MODEL(PHY_ID_TJA1101) },
396 { }
397 };
398
399 MODULE_DEVICE_TABLE(mdio, tja11xx_tbl);
400
401 MODULE_AUTHOR("Marek Vasut <marex@denx.de>");
402 MODULE_DESCRIPTION("NXP TJA11xx BoardR-Reach PHY driver");
403 MODULE_LICENSE("GPL");