]>
Commit | Line | Data |
---|---|---|
a2443fd1 | 1 | // SPDX-License-Identifier: GPL-2.0+ |
2f53e904 | 2 | /* Framework for finding and configuring PHYs. |
00db8189 AF |
3 | * Also contains generic PHY driver |
4 | * | |
5 | * Author: Andy Fleming | |
6 | * | |
7 | * Copyright (c) 2004 Freescale Semiconductor, Inc. | |
00db8189 | 8 | */ |
8d242488 JP |
9 | |
10 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt | |
11 | ||
e42bcd0f | 12 | #include <linux/bitmap.h> |
00db8189 | 13 | #include <linux/delay.h> |
e42bcd0f | 14 | #include <linux/errno.h> |
00db8189 | 15 | #include <linux/etherdevice.h> |
e42bcd0f BG |
16 | #include <linux/ethtool.h> |
17 | #include <linux/init.h> | |
18 | #include <linux/interrupt.h> | |
19 | #include <linux/io.h> | |
20 | #include <linux/kernel.h> | |
21 | #include <linux/mdio.h> | |
22 | #include <linux/mii.h> | |
00db8189 AF |
23 | #include <linux/mm.h> |
24 | #include <linux/module.h> | |
e42bcd0f | 25 | #include <linux/netdevice.h> |
00db8189 | 26 | #include <linux/phy.h> |
2e0bc452 | 27 | #include <linux/phy_led_triggers.h> |
e42bcd0f | 28 | #include <linux/property.h> |
298e54fa | 29 | #include <linux/sfp.h> |
e42bcd0f BG |
30 | #include <linux/skbuff.h> |
31 | #include <linux/slab.h> | |
32 | #include <linux/string.h> | |
2f53e904 | 33 | #include <linux/uaccess.h> |
e42bcd0f | 34 | #include <linux/unistd.h> |
00db8189 | 35 | |
afcceaa3 OH |
36 | MODULE_DESCRIPTION("PHY library"); |
37 | MODULE_AUTHOR("Andy Fleming"); | |
38 | MODULE_LICENSE("GPL"); | |
39 | ||
719655a1 AL |
40 | __ETHTOOL_DECLARE_LINK_MODE_MASK(phy_basic_features) __ro_after_init; |
41 | EXPORT_SYMBOL_GPL(phy_basic_features); | |
42 | ||
43 | __ETHTOOL_DECLARE_LINK_MODE_MASK(phy_basic_t1_features) __ro_after_init; | |
44 | EXPORT_SYMBOL_GPL(phy_basic_t1_features); | |
45 | ||
46 | __ETHTOOL_DECLARE_LINK_MODE_MASK(phy_gbit_features) __ro_after_init; | |
47 | EXPORT_SYMBOL_GPL(phy_gbit_features); | |
48 | ||
49 | __ETHTOOL_DECLARE_LINK_MODE_MASK(phy_gbit_fibre_features) __ro_after_init; | |
50 | EXPORT_SYMBOL_GPL(phy_gbit_fibre_features); | |
51 | ||
52 | __ETHTOOL_DECLARE_LINK_MODE_MASK(phy_gbit_all_ports_features) __ro_after_init; | |
53 | EXPORT_SYMBOL_GPL(phy_gbit_all_ports_features); | |
54 | ||
55 | __ETHTOOL_DECLARE_LINK_MODE_MASK(phy_10gbit_features) __ro_after_init; | |
56 | EXPORT_SYMBOL_GPL(phy_10gbit_features); | |
57 | ||
9e857a40 AL |
58 | __ETHTOOL_DECLARE_LINK_MODE_MASK(phy_10gbit_fec_features) __ro_after_init; |
59 | EXPORT_SYMBOL_GPL(phy_10gbit_fec_features); | |
60 | ||
54638c6e | 61 | const int phy_basic_ports_array[3] = { |
719655a1 AL |
62 | ETHTOOL_LINK_MODE_Autoneg_BIT, |
63 | ETHTOOL_LINK_MODE_TP_BIT, | |
64 | ETHTOOL_LINK_MODE_MII_BIT, | |
65 | }; | |
3c1bcc86 | 66 | EXPORT_SYMBOL_GPL(phy_basic_ports_array); |
719655a1 | 67 | |
54638c6e | 68 | const int phy_fibre_port_array[1] = { |
719655a1 AL |
69 | ETHTOOL_LINK_MODE_FIBRE_BIT, |
70 | }; | |
3c1bcc86 | 71 | EXPORT_SYMBOL_GPL(phy_fibre_port_array); |
719655a1 | 72 | |
54638c6e | 73 | const int phy_all_ports_features_array[7] = { |
719655a1 AL |
74 | ETHTOOL_LINK_MODE_Autoneg_BIT, |
75 | ETHTOOL_LINK_MODE_TP_BIT, | |
76 | ETHTOOL_LINK_MODE_MII_BIT, | |
77 | ETHTOOL_LINK_MODE_FIBRE_BIT, | |
78 | ETHTOOL_LINK_MODE_AUI_BIT, | |
79 | ETHTOOL_LINK_MODE_BNC_BIT, | |
80 | ETHTOOL_LINK_MODE_Backplane_BIT, | |
81 | }; | |
3c1bcc86 | 82 | EXPORT_SYMBOL_GPL(phy_all_ports_features_array); |
719655a1 | 83 | |
3c1bcc86 | 84 | const int phy_10_100_features_array[4] = { |
719655a1 AL |
85 | ETHTOOL_LINK_MODE_10baseT_Half_BIT, |
86 | ETHTOOL_LINK_MODE_10baseT_Full_BIT, | |
87 | ETHTOOL_LINK_MODE_100baseT_Half_BIT, | |
88 | ETHTOOL_LINK_MODE_100baseT_Full_BIT, | |
89 | }; | |
3c1bcc86 | 90 | EXPORT_SYMBOL_GPL(phy_10_100_features_array); |
719655a1 | 91 | |
3c1bcc86 | 92 | const int phy_basic_t1_features_array[2] = { |
719655a1 | 93 | ETHTOOL_LINK_MODE_TP_BIT, |
e5fb32c6 | 94 | ETHTOOL_LINK_MODE_100baseT1_Full_BIT, |
719655a1 | 95 | }; |
3c1bcc86 | 96 | EXPORT_SYMBOL_GPL(phy_basic_t1_features_array); |
719655a1 | 97 | |
3c1bcc86 | 98 | const int phy_gbit_features_array[2] = { |
719655a1 AL |
99 | ETHTOOL_LINK_MODE_1000baseT_Half_BIT, |
100 | ETHTOOL_LINK_MODE_1000baseT_Full_BIT, | |
101 | }; | |
3c1bcc86 | 102 | EXPORT_SYMBOL_GPL(phy_gbit_features_array); |
719655a1 | 103 | |
3c1bcc86 | 104 | const int phy_10gbit_features_array[1] = { |
719655a1 AL |
105 | ETHTOOL_LINK_MODE_10000baseT_Full_BIT, |
106 | }; | |
3c1bcc86 | 107 | EXPORT_SYMBOL_GPL(phy_10gbit_features_array); |
719655a1 | 108 | |
4f2b38e3 | 109 | static const int phy_10gbit_fec_features_array[1] = { |
9e857a40 AL |
110 | ETHTOOL_LINK_MODE_10000baseR_FEC_BIT, |
111 | }; | |
9e857a40 | 112 | |
719655a1 AL |
113 | __ETHTOOL_DECLARE_LINK_MODE_MASK(phy_10gbit_full_features) __ro_after_init; |
114 | EXPORT_SYMBOL_GPL(phy_10gbit_full_features); | |
115 | ||
116 | static const int phy_10gbit_full_features_array[] = { | |
117 | ETHTOOL_LINK_MODE_10baseT_Full_BIT, | |
118 | ETHTOOL_LINK_MODE_100baseT_Full_BIT, | |
119 | ETHTOOL_LINK_MODE_1000baseT_Full_BIT, | |
120 | ETHTOOL_LINK_MODE_10000baseT_Full_BIT, | |
121 | }; | |
122 | ||
123 | static void features_init(void) | |
124 | { | |
125 | /* 10/100 half/full*/ | |
126 | linkmode_set_bit_array(phy_basic_ports_array, | |
127 | ARRAY_SIZE(phy_basic_ports_array), | |
128 | phy_basic_features); | |
129 | linkmode_set_bit_array(phy_10_100_features_array, | |
130 | ARRAY_SIZE(phy_10_100_features_array), | |
131 | phy_basic_features); | |
132 | ||
133 | /* 100 full, TP */ | |
134 | linkmode_set_bit_array(phy_basic_t1_features_array, | |
135 | ARRAY_SIZE(phy_basic_t1_features_array), | |
136 | phy_basic_t1_features); | |
137 | ||
138 | /* 10/100 half/full + 1000 half/full */ | |
139 | linkmode_set_bit_array(phy_basic_ports_array, | |
140 | ARRAY_SIZE(phy_basic_ports_array), | |
141 | phy_gbit_features); | |
142 | linkmode_set_bit_array(phy_10_100_features_array, | |
143 | ARRAY_SIZE(phy_10_100_features_array), | |
144 | phy_gbit_features); | |
145 | linkmode_set_bit_array(phy_gbit_features_array, | |
146 | ARRAY_SIZE(phy_gbit_features_array), | |
147 | phy_gbit_features); | |
148 | ||
149 | /* 10/100 half/full + 1000 half/full + fibre*/ | |
150 | linkmode_set_bit_array(phy_basic_ports_array, | |
151 | ARRAY_SIZE(phy_basic_ports_array), | |
152 | phy_gbit_fibre_features); | |
153 | linkmode_set_bit_array(phy_10_100_features_array, | |
154 | ARRAY_SIZE(phy_10_100_features_array), | |
155 | phy_gbit_fibre_features); | |
156 | linkmode_set_bit_array(phy_gbit_features_array, | |
157 | ARRAY_SIZE(phy_gbit_features_array), | |
158 | phy_gbit_fibre_features); | |
159 | linkmode_set_bit_array(phy_fibre_port_array, | |
160 | ARRAY_SIZE(phy_fibre_port_array), | |
161 | phy_gbit_fibre_features); | |
162 | ||
163 | /* 10/100 half/full + 1000 half/full + TP/MII/FIBRE/AUI/BNC/Backplane*/ | |
164 | linkmode_set_bit_array(phy_all_ports_features_array, | |
165 | ARRAY_SIZE(phy_all_ports_features_array), | |
166 | phy_gbit_all_ports_features); | |
167 | linkmode_set_bit_array(phy_10_100_features_array, | |
168 | ARRAY_SIZE(phy_10_100_features_array), | |
169 | phy_gbit_all_ports_features); | |
170 | linkmode_set_bit_array(phy_gbit_features_array, | |
171 | ARRAY_SIZE(phy_gbit_features_array), | |
172 | phy_gbit_all_ports_features); | |
173 | ||
174 | /* 10/100 half/full + 1000 half/full + 10G full*/ | |
175 | linkmode_set_bit_array(phy_all_ports_features_array, | |
176 | ARRAY_SIZE(phy_all_ports_features_array), | |
177 | phy_10gbit_features); | |
178 | linkmode_set_bit_array(phy_10_100_features_array, | |
179 | ARRAY_SIZE(phy_10_100_features_array), | |
180 | phy_10gbit_features); | |
181 | linkmode_set_bit_array(phy_gbit_features_array, | |
182 | ARRAY_SIZE(phy_gbit_features_array), | |
183 | phy_10gbit_features); | |
184 | linkmode_set_bit_array(phy_10gbit_features_array, | |
185 | ARRAY_SIZE(phy_10gbit_features_array), | |
186 | phy_10gbit_features); | |
187 | ||
188 | /* 10/100/1000/10G full */ | |
189 | linkmode_set_bit_array(phy_all_ports_features_array, | |
190 | ARRAY_SIZE(phy_all_ports_features_array), | |
191 | phy_10gbit_full_features); | |
192 | linkmode_set_bit_array(phy_10gbit_full_features_array, | |
193 | ARRAY_SIZE(phy_10gbit_full_features_array), | |
194 | phy_10gbit_full_features); | |
9e857a40 AL |
195 | /* 10G FEC only */ |
196 | linkmode_set_bit_array(phy_10gbit_fec_features_array, | |
197 | ARRAY_SIZE(phy_10gbit_fec_features_array), | |
198 | phy_10gbit_fec_features); | |
719655a1 AL |
199 | } |
200 | ||
6f4a7f41 AV |
201 | void phy_device_free(struct phy_device *phydev) |
202 | { | |
e5a03bfd | 203 | put_device(&phydev->mdio.dev); |
6f4a7f41 | 204 | } |
4dea547f | 205 | EXPORT_SYMBOL(phy_device_free); |
6f4a7f41 | 206 | |
711fdba3 AL |
207 | static void phy_mdio_device_free(struct mdio_device *mdiodev) |
208 | { | |
209 | struct phy_device *phydev; | |
210 | ||
211 | phydev = container_of(mdiodev, struct phy_device, mdio); | |
212 | phy_device_free(phydev); | |
213 | } | |
214 | ||
6f4a7f41 AV |
215 | static void phy_device_release(struct device *dev) |
216 | { | |
b2a43191 | 217 | kfree(to_phy_device(dev)); |
6f4a7f41 AV |
218 | } |
219 | ||
711fdba3 AL |
220 | static void phy_mdio_device_remove(struct mdio_device *mdiodev) |
221 | { | |
222 | struct phy_device *phydev; | |
223 | ||
224 | phydev = container_of(mdiodev, struct phy_device, mdio); | |
225 | phy_device_remove(phydev); | |
226 | } | |
227 | ||
921690f2 | 228 | static struct phy_driver genphy_driver; |
4dea547f | 229 | |
f62220d3 AF |
230 | static LIST_HEAD(phy_fixup_list); |
231 | static DEFINE_MUTEX(phy_fixup_lock); | |
232 | ||
bc87922f AL |
233 | static bool mdio_bus_phy_may_suspend(struct phy_device *phydev) |
234 | { | |
235 | struct device_driver *drv = phydev->mdio.dev.driver; | |
236 | struct phy_driver *phydrv = to_phy_driver(drv); | |
237 | struct net_device *netdev = phydev->attached_dev; | |
238 | ||
239 | if (!drv || !phydrv->suspend) | |
240 | return false; | |
241 | ||
242 | /* PHY not attached? May suspend if the PHY has not already been | |
243 | * suspended as part of a prior call to phy_disconnect() -> | |
244 | * phy_detach() -> phy_suspend() because the parent netdev might be the | |
245 | * MDIO bus driver and clock gated at this point. | |
246 | */ | |
247 | if (!netdev) | |
503ba7c6 | 248 | goto out; |
bc87922f | 249 | |
93f41e67 HK |
250 | if (netdev->wol_enabled) |
251 | return false; | |
252 | ||
253 | /* As long as not all affected network drivers support the | |
254 | * wol_enabled flag, let's check for hints that WoL is enabled. | |
255 | * Don't suspend PHY if the attached netdev parent may wake up. | |
bc87922f AL |
256 | * The parent may point to a PCI device, as in tg3 driver. |
257 | */ | |
258 | if (netdev->dev.parent && device_may_wakeup(netdev->dev.parent)) | |
259 | return false; | |
260 | ||
261 | /* Also don't suspend PHY if the netdev itself may wakeup. This | |
262 | * is the case for devices w/o underlaying pwr. mgmt. aware bus, | |
263 | * e.g. SoC devices. | |
264 | */ | |
265 | if (device_may_wakeup(&netdev->dev)) | |
266 | return false; | |
267 | ||
503ba7c6 FF |
268 | out: |
269 | return !phydev->suspended; | |
bc87922f AL |
270 | } |
271 | ||
2ad9526f | 272 | static __maybe_unused int mdio_bus_phy_suspend(struct device *dev) |
bc87922f AL |
273 | { |
274 | struct phy_device *phydev = to_phy_device(dev); | |
275 | ||
276 | /* We must stop the state machine manually, otherwise it stops out of | |
277 | * control, possibly with the phydev->lock held. Upon resume, netdev | |
278 | * may call phy routines that try to grab the same lock, and that may | |
279 | * lead to a deadlock. | |
280 | */ | |
281 | if (phydev->attached_dev && phydev->adjust_link) | |
282 | phy_stop_machine(phydev); | |
283 | ||
284 | if (!mdio_bus_phy_may_suspend(phydev)) | |
285 | return 0; | |
286 | ||
611d779a HK |
287 | phydev->suspended_by_mdio_bus = 1; |
288 | ||
bc87922f AL |
289 | return phy_suspend(phydev); |
290 | } | |
291 | ||
2ad9526f | 292 | static __maybe_unused int mdio_bus_phy_resume(struct device *dev) |
bc87922f AL |
293 | { |
294 | struct phy_device *phydev = to_phy_device(dev); | |
295 | int ret; | |
296 | ||
611d779a | 297 | if (!phydev->suspended_by_mdio_bus) |
bc87922f AL |
298 | goto no_resume; |
299 | ||
611d779a HK |
300 | phydev->suspended_by_mdio_bus = 0; |
301 | ||
9839f047 | 302 | ret = phy_init_hw(phydev); |
bc87922f AL |
303 | if (ret < 0) |
304 | return ret; | |
305 | ||
9839f047 | 306 | ret = phy_resume(phydev); |
bc87922f AL |
307 | if (ret < 0) |
308 | return ret; | |
9839f047 | 309 | no_resume: |
8742beb5 KH |
310 | if (phydev->attached_dev && phydev->adjust_link) |
311 | phy_start_machine(phydev); | |
bc87922f AL |
312 | |
313 | return 0; | |
314 | } | |
315 | ||
9839f047 HK |
316 | static SIMPLE_DEV_PM_OPS(mdio_bus_phy_pm_ops, mdio_bus_phy_suspend, |
317 | mdio_bus_phy_resume); | |
bc87922f | 318 | |
2f53e904 SS |
319 | /** |
320 | * phy_register_fixup - creates a new phy_fixup and adds it to the list | |
e5a03bfd | 321 | * @bus_id: A string which matches phydev->mdio.dev.bus_id (or PHY_ANY_ID) |
f62220d3 | 322 | * @phy_uid: Used to match against phydev->phy_id (the UID of the PHY) |
2f53e904 | 323 | * It can also be PHY_ANY_UID |
f62220d3 | 324 | * @phy_uid_mask: Applied to phydev->phy_id and fixup->phy_uid before |
2f53e904 | 325 | * comparison |
f62220d3 AF |
326 | * @run: The actual code to be run when a matching PHY is found |
327 | */ | |
328 | int phy_register_fixup(const char *bus_id, u32 phy_uid, u32 phy_uid_mask, | |
2f53e904 | 329 | int (*run)(struct phy_device *)) |
f62220d3 | 330 | { |
553fe92b | 331 | struct phy_fixup *fixup = kzalloc(sizeof(*fixup), GFP_KERNEL); |
f62220d3 | 332 | |
f62220d3 AF |
333 | if (!fixup) |
334 | return -ENOMEM; | |
335 | ||
fb28ad35 | 336 | strlcpy(fixup->bus_id, bus_id, sizeof(fixup->bus_id)); |
f62220d3 AF |
337 | fixup->phy_uid = phy_uid; |
338 | fixup->phy_uid_mask = phy_uid_mask; | |
339 | fixup->run = run; | |
340 | ||
341 | mutex_lock(&phy_fixup_lock); | |
342 | list_add_tail(&fixup->list, &phy_fixup_list); | |
343 | mutex_unlock(&phy_fixup_lock); | |
344 | ||
345 | return 0; | |
346 | } | |
347 | EXPORT_SYMBOL(phy_register_fixup); | |
348 | ||
349 | /* Registers a fixup to be run on any PHY with the UID in phy_uid */ | |
350 | int phy_register_fixup_for_uid(u32 phy_uid, u32 phy_uid_mask, | |
2f53e904 | 351 | int (*run)(struct phy_device *)) |
f62220d3 AF |
352 | { |
353 | return phy_register_fixup(PHY_ANY_ID, phy_uid, phy_uid_mask, run); | |
354 | } | |
355 | EXPORT_SYMBOL(phy_register_fixup_for_uid); | |
356 | ||
357 | /* Registers a fixup to be run on the PHY with id string bus_id */ | |
358 | int phy_register_fixup_for_id(const char *bus_id, | |
2f53e904 | 359 | int (*run)(struct phy_device *)) |
f62220d3 AF |
360 | { |
361 | return phy_register_fixup(bus_id, PHY_ANY_UID, 0xffffffff, run); | |
362 | } | |
363 | EXPORT_SYMBOL(phy_register_fixup_for_id); | |
364 | ||
f38e7a32 WH |
365 | /** |
366 | * phy_unregister_fixup - remove a phy_fixup from the list | |
367 | * @bus_id: A string matches fixup->bus_id (or PHY_ANY_ID) in phy_fixup_list | |
368 | * @phy_uid: A phy id matches fixup->phy_id (or PHY_ANY_UID) in phy_fixup_list | |
369 | * @phy_uid_mask: Applied to phy_uid and fixup->phy_uid before comparison | |
370 | */ | |
371 | int phy_unregister_fixup(const char *bus_id, u32 phy_uid, u32 phy_uid_mask) | |
372 | { | |
373 | struct list_head *pos, *n; | |
374 | struct phy_fixup *fixup; | |
375 | int ret; | |
376 | ||
377 | ret = -ENODEV; | |
378 | ||
379 | mutex_lock(&phy_fixup_lock); | |
380 | list_for_each_safe(pos, n, &phy_fixup_list) { | |
381 | fixup = list_entry(pos, struct phy_fixup, list); | |
382 | ||
383 | if ((!strcmp(fixup->bus_id, bus_id)) && | |
384 | ((fixup->phy_uid & phy_uid_mask) == | |
385 | (phy_uid & phy_uid_mask))) { | |
386 | list_del(&fixup->list); | |
387 | kfree(fixup); | |
388 | ret = 0; | |
389 | break; | |
390 | } | |
391 | } | |
392 | mutex_unlock(&phy_fixup_lock); | |
393 | ||
394 | return ret; | |
395 | } | |
396 | EXPORT_SYMBOL(phy_unregister_fixup); | |
397 | ||
398 | /* Unregisters a fixup of any PHY with the UID in phy_uid */ | |
399 | int phy_unregister_fixup_for_uid(u32 phy_uid, u32 phy_uid_mask) | |
400 | { | |
401 | return phy_unregister_fixup(PHY_ANY_ID, phy_uid, phy_uid_mask); | |
402 | } | |
403 | EXPORT_SYMBOL(phy_unregister_fixup_for_uid); | |
404 | ||
405 | /* Unregisters a fixup of the PHY with id string bus_id */ | |
406 | int phy_unregister_fixup_for_id(const char *bus_id) | |
407 | { | |
408 | return phy_unregister_fixup(bus_id, PHY_ANY_UID, 0xffffffff); | |
409 | } | |
410 | EXPORT_SYMBOL(phy_unregister_fixup_for_id); | |
411 | ||
2f53e904 | 412 | /* Returns 1 if fixup matches phydev in bus_id and phy_uid. |
f62220d3 AF |
413 | * Fixups can be set to match any in one or more fields. |
414 | */ | |
415 | static int phy_needs_fixup(struct phy_device *phydev, struct phy_fixup *fixup) | |
416 | { | |
84eff6d1 | 417 | if (strcmp(fixup->bus_id, phydev_name(phydev)) != 0) |
f62220d3 AF |
418 | if (strcmp(fixup->bus_id, PHY_ANY_ID) != 0) |
419 | return 0; | |
420 | ||
421 | if ((fixup->phy_uid & fixup->phy_uid_mask) != | |
2f53e904 | 422 | (phydev->phy_id & fixup->phy_uid_mask)) |
f62220d3 AF |
423 | if (fixup->phy_uid != PHY_ANY_UID) |
424 | return 0; | |
425 | ||
426 | return 1; | |
427 | } | |
428 | ||
429 | /* Runs any matching fixups for this phydev */ | |
fbfcec63 | 430 | static int phy_scan_fixups(struct phy_device *phydev) |
f62220d3 AF |
431 | { |
432 | struct phy_fixup *fixup; | |
433 | ||
434 | mutex_lock(&phy_fixup_lock); | |
435 | list_for_each_entry(fixup, &phy_fixup_list, list) { | |
436 | if (phy_needs_fixup(phydev, fixup)) { | |
553fe92b | 437 | int err = fixup->run(phydev); |
f62220d3 | 438 | |
bc23283c JS |
439 | if (err < 0) { |
440 | mutex_unlock(&phy_fixup_lock); | |
f62220d3 | 441 | return err; |
bc23283c | 442 | } |
b0ae009f | 443 | phydev->has_fixups = true; |
f62220d3 AF |
444 | } |
445 | } | |
446 | mutex_unlock(&phy_fixup_lock); | |
447 | ||
448 | return 0; | |
449 | } | |
f62220d3 | 450 | |
e76a4957 AL |
451 | static int phy_bus_match(struct device *dev, struct device_driver *drv) |
452 | { | |
453 | struct phy_device *phydev = to_phy_device(dev); | |
454 | struct phy_driver *phydrv = to_phy_driver(drv); | |
455 | const int num_ids = ARRAY_SIZE(phydev->c45_ids.device_ids); | |
456 | int i; | |
457 | ||
a9049e0c AL |
458 | if (!(phydrv->mdiodrv.flags & MDIO_DEVICE_IS_PHY)) |
459 | return 0; | |
460 | ||
e76a4957 AL |
461 | if (phydrv->match_phy_device) |
462 | return phydrv->match_phy_device(phydev); | |
463 | ||
464 | if (phydev->is_c45) { | |
465 | for (i = 1; i < num_ids; i++) { | |
b95e86d8 | 466 | if (phydev->c45_ids.device_ids[i] == 0xffffffff) |
e76a4957 AL |
467 | continue; |
468 | ||
469 | if ((phydrv->phy_id & phydrv->phy_id_mask) == | |
470 | (phydev->c45_ids.device_ids[i] & | |
471 | phydrv->phy_id_mask)) | |
472 | return 1; | |
473 | } | |
474 | return 0; | |
475 | } else { | |
476 | return (phydrv->phy_id & phydrv->phy_id_mask) == | |
477 | (phydev->phy_id & phydrv->phy_id_mask); | |
478 | } | |
479 | } | |
480 | ||
7f4828ff HK |
481 | static ssize_t |
482 | phy_id_show(struct device *dev, struct device_attribute *attr, char *buf) | |
483 | { | |
484 | struct phy_device *phydev = to_phy_device(dev); | |
485 | ||
486 | return sprintf(buf, "0x%.8lx\n", (unsigned long)phydev->phy_id); | |
487 | } | |
488 | static DEVICE_ATTR_RO(phy_id); | |
489 | ||
490 | static ssize_t | |
491 | phy_interface_show(struct device *dev, struct device_attribute *attr, char *buf) | |
492 | { | |
493 | struct phy_device *phydev = to_phy_device(dev); | |
494 | const char *mode = NULL; | |
495 | ||
496 | if (phy_is_internal(phydev)) | |
497 | mode = "internal"; | |
498 | else | |
499 | mode = phy_modes(phydev->interface); | |
500 | ||
501 | return sprintf(buf, "%s\n", mode); | |
502 | } | |
503 | static DEVICE_ATTR_RO(phy_interface); | |
504 | ||
505 | static ssize_t | |
506 | phy_has_fixups_show(struct device *dev, struct device_attribute *attr, | |
507 | char *buf) | |
508 | { | |
509 | struct phy_device *phydev = to_phy_device(dev); | |
510 | ||
511 | return sprintf(buf, "%d\n", phydev->has_fixups); | |
512 | } | |
513 | static DEVICE_ATTR_RO(phy_has_fixups); | |
514 | ||
515 | static struct attribute *phy_dev_attrs[] = { | |
516 | &dev_attr_phy_id.attr, | |
517 | &dev_attr_phy_interface.attr, | |
518 | &dev_attr_phy_has_fixups.attr, | |
519 | NULL, | |
520 | }; | |
521 | ATTRIBUTE_GROUPS(phy_dev); | |
522 | ||
523 | static const struct device_type mdio_bus_phy_type = { | |
524 | .name = "PHY", | |
525 | .groups = phy_dev_groups, | |
526 | .release = phy_device_release, | |
9839f047 | 527 | .pm = pm_ptr(&mdio_bus_phy_pm_ops), |
7f4828ff HK |
528 | }; |
529 | ||
7d49a32a | 530 | static int phy_request_driver_module(struct phy_device *dev, u32 phy_id) |
13d0ab67 HK |
531 | { |
532 | int ret; | |
533 | ||
534 | ret = request_module(MDIO_MODULE_PREFIX MDIO_ID_FMT, | |
535 | MDIO_ID_ARGS(phy_id)); | |
21e19442 HK |
536 | /* We only check for failures in executing the usermode binary, |
537 | * not whether a PHY driver module exists for the PHY ID. | |
538 | * Accept -ENOENT because this may occur in case no initramfs exists, | |
539 | * then modprobe isn't available. | |
13d0ab67 | 540 | */ |
21e19442 | 541 | if (IS_ENABLED(CONFIG_MODULES) && ret < 0 && ret != -ENOENT) { |
7d49a32a RK |
542 | phydev_err(dev, "error %d loading PHY driver module for ID 0x%08lx\n", |
543 | ret, (unsigned long)phy_id); | |
13d0ab67 HK |
544 | return ret; |
545 | } | |
546 | ||
547 | return 0; | |
548 | } | |
549 | ||
7d49a32a | 550 | struct phy_device *phy_device_create(struct mii_bus *bus, int addr, u32 phy_id, |
2f53e904 SS |
551 | bool is_c45, |
552 | struct phy_c45_device_ids *c45_ids) | |
11b0bacd VB |
553 | { |
554 | struct phy_device *dev; | |
e5a03bfd | 555 | struct mdio_device *mdiodev; |
13d0ab67 | 556 | int ret = 0; |
8626d3b4 | 557 | |
2f53e904 | 558 | /* We allocate the device, and initialize the default values */ |
cd861280 | 559 | dev = kzalloc(sizeof(*dev), GFP_KERNEL); |
ef899c07 | 560 | if (!dev) |
d3765f08 | 561 | return ERR_PTR(-ENOMEM); |
11b0bacd | 562 | |
e5a03bfd | 563 | mdiodev = &dev->mdio; |
e5a03bfd AL |
564 | mdiodev->dev.parent = &bus->dev; |
565 | mdiodev->dev.bus = &mdio_bus_type; | |
7f4828ff | 566 | mdiodev->dev.type = &mdio_bus_phy_type; |
e5a03bfd | 567 | mdiodev->bus = bus; |
e76a4957 | 568 | mdiodev->bus_match = phy_bus_match; |
e5a03bfd | 569 | mdiodev->addr = addr; |
7f854420 | 570 | mdiodev->flags = MDIO_DEVICE_FLAG_PHY; |
711fdba3 AL |
571 | mdiodev->device_free = phy_mdio_device_free; |
572 | mdiodev->device_remove = phy_mdio_device_remove; | |
6f4a7f41 | 573 | |
a5d66f81 RK |
574 | dev->speed = SPEED_UNKNOWN; |
575 | dev->duplex = DUPLEX_UNKNOWN; | |
2f53e904 SS |
576 | dev->pause = 0; |
577 | dev->asym_pause = 0; | |
c69851e9 | 578 | dev->link = 0; |
947f74cb | 579 | dev->port = PORT_TP; |
e8a2b6a4 | 580 | dev->interface = PHY_INTERFACE_MODE_GMII; |
11b0bacd VB |
581 | |
582 | dev->autoneg = AUTONEG_ENABLE; | |
583 | ||
ac28b9f8 | 584 | dev->is_c45 = is_c45; |
11b0bacd | 585 | dev->phy_id = phy_id; |
ac28b9f8 DD |
586 | if (c45_ids) |
587 | dev->c45_ids = *c45_ids; | |
47b356e4 | 588 | dev->irq = bus->irq[addr]; |
d02cbc46 | 589 | |
e5a03bfd | 590 | dev_set_name(&mdiodev->dev, PHY_ID_FMT, bus->id, addr); |
d02cbc46 | 591 | device_initialize(&mdiodev->dev); |
11b0bacd VB |
592 | |
593 | dev->state = PHY_DOWN; | |
594 | ||
35b5f6b1 | 595 | mutex_init(&dev->lock); |
4f9c85a1 | 596 | INIT_DELAYED_WORK(&dev->state_queue, phy_state_machine); |
11b0bacd | 597 | |
8626d3b4 | 598 | /* Request the appropriate module unconditionally; don't |
2f53e904 SS |
599 | * bother trying to do so only if it isn't already loaded, |
600 | * because that gets complicated. A hotplug event would have | |
601 | * done an unconditional modprobe anyway. | |
602 | * We don't do normal hotplug because it won't work for MDIO | |
603 | * -- because it relies on the device staying around for long | |
604 | * enough for the driver to get loaded. With MDIO, the NIC | |
605 | * driver will get bored and give up as soon as it finds that | |
606 | * there's no driver _already_ loaded. | |
607 | */ | |
30fcd6a9 JA |
608 | if (is_c45 && c45_ids) { |
609 | const int num_ids = ARRAY_SIZE(c45_ids->device_ids); | |
610 | int i; | |
611 | ||
612 | for (i = 1; i < num_ids; i++) { | |
b95e86d8 | 613 | if (c45_ids->device_ids[i] == 0xffffffff) |
30fcd6a9 JA |
614 | continue; |
615 | ||
13d0ab67 HK |
616 | ret = phy_request_driver_module(dev, |
617 | c45_ids->device_ids[i]); | |
618 | if (ret) | |
619 | break; | |
30fcd6a9 JA |
620 | } |
621 | } else { | |
13d0ab67 | 622 | ret = phy_request_driver_module(dev, phy_id); |
30fcd6a9 | 623 | } |
8626d3b4 | 624 | |
d02cbc46 JH |
625 | if (ret) { |
626 | put_device(&mdiodev->dev); | |
13d0ab67 HK |
627 | dev = ERR_PTR(ret); |
628 | } | |
b2a43191 | 629 | |
11b0bacd VB |
630 | return dev; |
631 | } | |
ac28b9f8 DD |
632 | EXPORT_SYMBOL(phy_device_create); |
633 | ||
c746053d RK |
634 | /* phy_c45_probe_present - checks to see if a MMD is present in the package |
635 | * @bus: the target MII bus | |
636 | * @prtad: PHY package address on the MII bus | |
637 | * @devad: PHY device (MMD) address | |
638 | * | |
639 | * Read the MDIO_STAT2 register, and check whether a device is responding | |
640 | * at this address. | |
641 | * | |
642 | * Returns: negative error number on bus access error, zero if no device | |
643 | * is responding, or positive if a device is present. | |
644 | */ | |
645 | static int phy_c45_probe_present(struct mii_bus *bus, int prtad, int devad) | |
646 | { | |
647 | int stat2; | |
648 | ||
649 | stat2 = mdiobus_c45_read(bus, prtad, devad, MDIO_STAT2); | |
650 | if (stat2 < 0) | |
651 | return stat2; | |
652 | ||
653 | return (stat2 & MDIO_STAT2_DEVPRST) == MDIO_STAT2_DEVPRST_VAL; | |
654 | } | |
655 | ||
5f6c99e0 SX |
656 | /* get_phy_c45_devs_in_pkg - reads a MMD's devices in package registers. |
657 | * @bus: the target MII bus | |
658 | * @addr: PHY address on the MII bus | |
659 | * @dev_addr: MMD address in the PHY. | |
660 | * @devices_in_package: where to store the devices in package information. | |
661 | * | |
662 | * Description: reads devices in package registers of a MMD at @dev_addr | |
663 | * from PHY at @addr on @bus. | |
664 | * | |
665 | * Returns: 0 on success, -EIO on failure. | |
666 | */ | |
667 | static int get_phy_c45_devs_in_pkg(struct mii_bus *bus, int addr, int dev_addr, | |
668 | u32 *devices_in_package) | |
669 | { | |
90ce665c | 670 | int phy_reg; |
5f6c99e0 | 671 | |
90ce665c | 672 | phy_reg = mdiobus_c45_read(bus, addr, dev_addr, MDIO_DEVS2); |
5f6c99e0 SX |
673 | if (phy_reg < 0) |
674 | return -EIO; | |
50684da7 | 675 | *devices_in_package = phy_reg << 16; |
5f6c99e0 | 676 | |
90ce665c | 677 | phy_reg = mdiobus_c45_read(bus, addr, dev_addr, MDIO_DEVS1); |
5f6c99e0 SX |
678 | if (phy_reg < 0) |
679 | return -EIO; | |
50684da7 | 680 | *devices_in_package |= phy_reg; |
5f6c99e0 SX |
681 | |
682 | return 0; | |
683 | } | |
684 | ||
ac28b9f8 DD |
685 | /** |
686 | * get_phy_c45_ids - reads the specified addr for its 802.3-c45 IDs. | |
687 | * @bus: the target MII bus | |
688 | * @addr: PHY address on the MII bus | |
ac28b9f8 DD |
689 | * @c45_ids: where to store the c45 ID information. |
690 | * | |
48c54388 RK |
691 | * Read the PHY "devices in package". If this appears to be valid, read |
692 | * the PHY identifiers for each device. Return the "devices in package" | |
693 | * and identifiers in @c45_ids. | |
ac28b9f8 | 694 | * |
48c54388 RK |
695 | * Returns zero on success, %-EIO on bus access error, or %-ENODEV if |
696 | * the "devices in package" is invalid. | |
ac28b9f8 | 697 | */ |
48c54388 | 698 | static int get_phy_c45_ids(struct mii_bus *bus, int addr, |
90ce665c RK |
699 | struct phy_c45_device_ids *c45_ids) |
700 | { | |
ac28b9f8 | 701 | const int num_ids = ARRAY_SIZE(c45_ids->device_ids); |
5ba33cf4 | 702 | u32 devs_in_pkg = 0; |
c746053d | 703 | int i, ret, phy_reg; |
ac28b9f8 | 704 | |
5f6c99e0 SX |
705 | /* Find first non-zero Devices In package. Device zero is reserved |
706 | * for 802.3 c45 complied PHYs, so don't probe it at first. | |
ac28b9f8 | 707 | */ |
fb16d465 VO |
708 | for (i = 1; i < MDIO_MMD_NUM && (devs_in_pkg == 0 || |
709 | (devs_in_pkg & 0x1fffffff) == 0x1fffffff); i++) { | |
c746053d RK |
710 | if (i == MDIO_MMD_VEND1 || i == MDIO_MMD_VEND2) { |
711 | /* Check that there is a device present at this | |
712 | * address before reading the devices-in-package | |
713 | * register to avoid reading garbage from the PHY. | |
714 | * Some PHYs (88x3310) vendor space is not IEEE802.3 | |
715 | * compliant. | |
716 | */ | |
717 | ret = phy_c45_probe_present(bus, addr, i); | |
718 | if (ret < 0) | |
719 | return -EIO; | |
720 | ||
721 | if (!ret) | |
722 | continue; | |
723 | } | |
5ba33cf4 | 724 | phy_reg = get_phy_c45_devs_in_pkg(bus, addr, i, &devs_in_pkg); |
ac28b9f8 DD |
725 | if (phy_reg < 0) |
726 | return -EIO; | |
454a78d1 RK |
727 | } |
728 | ||
5ba33cf4 | 729 | if ((devs_in_pkg & 0x1fffffff) == 0x1fffffff) { |
454a78d1 RK |
730 | /* If mostly Fs, there is no device there, then let's probe |
731 | * MMD 0, as some 10G PHYs have zero Devices In package, | |
732 | * e.g. Cortina CS4315/CS4340 PHY. | |
733 | */ | |
5ba33cf4 | 734 | phy_reg = get_phy_c45_devs_in_pkg(bus, addr, 0, &devs_in_pkg); |
454a78d1 RK |
735 | if (phy_reg < 0) |
736 | return -EIO; | |
ac28b9f8 | 737 | |
454a78d1 | 738 | /* no device there, let's get out of here */ |
5ba33cf4 | 739 | if ((devs_in_pkg & 0x1fffffff) == 0x1fffffff) |
48c54388 | 740 | return -ENODEV; |
ac28b9f8 DD |
741 | } |
742 | ||
743 | /* Now probe Device Identifiers for each device present. */ | |
744 | for (i = 1; i < num_ids; i++) { | |
5ba33cf4 | 745 | if (!(devs_in_pkg & (1 << i))) |
ac28b9f8 DD |
746 | continue; |
747 | ||
389a3389 RK |
748 | if (i == MDIO_MMD_VEND1 || i == MDIO_MMD_VEND2) { |
749 | /* Probe the "Device Present" bits for the vendor MMDs | |
750 | * to ignore these if they do not contain IEEE 802.3 | |
751 | * registers. | |
752 | */ | |
753 | ret = phy_c45_probe_present(bus, addr, i); | |
754 | if (ret < 0) | |
755 | return ret; | |
756 | ||
757 | if (!ret) | |
758 | continue; | |
759 | } | |
760 | ||
90ce665c | 761 | phy_reg = mdiobus_c45_read(bus, addr, i, MII_PHYSID1); |
ac28b9f8 DD |
762 | if (phy_reg < 0) |
763 | return -EIO; | |
50684da7 | 764 | c45_ids->device_ids[i] = phy_reg << 16; |
ac28b9f8 | 765 | |
90ce665c | 766 | phy_reg = mdiobus_c45_read(bus, addr, i, MII_PHYSID2); |
ac28b9f8 DD |
767 | if (phy_reg < 0) |
768 | return -EIO; | |
50684da7 | 769 | c45_ids->device_ids[i] |= phy_reg; |
ac28b9f8 | 770 | } |
48c54388 | 771 | |
5ba33cf4 | 772 | c45_ids->devices_in_package = devs_in_pkg; |
320ed3bf RK |
773 | /* Bit 0 doesn't represent a device, it indicates c22 regs presence */ |
774 | c45_ids->mmds_present = devs_in_pkg & ~BIT(0); | |
5ba33cf4 | 775 | |
ac28b9f8 DD |
776 | return 0; |
777 | } | |
11b0bacd | 778 | |
b3df0da8 | 779 | /** |
e6306261 | 780 | * get_phy_c22_id - reads the specified addr for its clause 22 ID. |
b3df0da8 RD |
781 | * @bus: the target MII bus |
782 | * @addr: PHY address on the MII bus | |
cac1f3c8 | 783 | * @phy_id: where to store the ID retrieved. |
00db8189 | 784 | * |
ee951005 RK |
785 | * Read the 802.3 clause 22 PHY ID from the PHY at @addr on the @bus, |
786 | * placing it in @phy_id. Return zero on successful read and the ID is | |
787 | * valid, %-EIO on bus access error, or %-ENODEV if no device responds | |
788 | * or invalid ID. | |
00db8189 | 789 | */ |
e6306261 | 790 | static int get_phy_c22_id(struct mii_bus *bus, int addr, u32 *phy_id) |
00db8189 AF |
791 | { |
792 | int phy_reg; | |
00db8189 | 793 | |
2f53e904 | 794 | /* Grab the bits from PHYIR1, and put them in the upper half */ |
6fe32649 | 795 | phy_reg = mdiobus_read(bus, addr, MII_PHYSID1); |
02a6efca | 796 | if (phy_reg < 0) { |
d8cce3a1 HK |
797 | /* returning -ENODEV doesn't stop bus scanning */ |
798 | return (phy_reg == -EIO || phy_reg == -ENODEV) ? -ENODEV : -EIO; | |
02a6efca | 799 | } |
00db8189 | 800 | |
50684da7 | 801 | *phy_id = phy_reg << 16; |
00db8189 AF |
802 | |
803 | /* Grab the bits from PHYIR2, and put them in the lower half */ | |
6fe32649 | 804 | phy_reg = mdiobus_read(bus, addr, MII_PHYSID2); |
b2ffc75e FF |
805 | if (phy_reg < 0) { |
806 | /* returning -ENODEV doesn't stop bus scanning */ | |
807 | return (phy_reg == -EIO || phy_reg == -ENODEV) ? -ENODEV : -EIO; | |
808 | } | |
cac1f3c8 | 809 | |
50684da7 | 810 | *phy_id |= phy_reg; |
cac1f3c8 | 811 | |
ee951005 RK |
812 | /* If the phy_id is mostly Fs, there is no device there */ |
813 | if ((*phy_id & 0x1fffffff) == 0x1fffffff) | |
814 | return -ENODEV; | |
815 | ||
cac1f3c8 PG |
816 | return 0; |
817 | } | |
818 | ||
819 | /** | |
2f53e904 SS |
820 | * get_phy_device - reads the specified PHY device and returns its @phy_device |
821 | * struct | |
cac1f3c8 PG |
822 | * @bus: the target MII bus |
823 | * @addr: PHY address on the MII bus | |
ac28b9f8 | 824 | * @is_c45: If true the PHY uses the 802.3 clause 45 protocol |
cac1f3c8 | 825 | * |
439625a7 RK |
826 | * Probe for a PHY at @addr on @bus. |
827 | * | |
828 | * When probing for a clause 22 PHY, then read the ID registers. If we find | |
829 | * a valid ID, allocate and return a &struct phy_device. | |
830 | * | |
831 | * When probing for a clause 45 PHY, read the "devices in package" registers. | |
832 | * If the "devices in package" appears valid, read the ID registers for each | |
833 | * MMD, allocate and return a &struct phy_device. | |
834 | * | |
835 | * Returns an allocated &struct phy_device on success, %-ENODEV if there is | |
836 | * no PHY present, or %-EIO on bus access error. | |
cac1f3c8 | 837 | */ |
ac28b9f8 | 838 | struct phy_device *get_phy_device(struct mii_bus *bus, int addr, bool is_c45) |
cac1f3c8 | 839 | { |
b95e86d8 | 840 | struct phy_c45_device_ids c45_ids; |
160c85f0 | 841 | u32 phy_id = 0; |
cac1f3c8 | 842 | int r; |
00db8189 | 843 | |
b95e86d8 | 844 | c45_ids.devices_in_package = 0; |
320ed3bf | 845 | c45_ids.mmds_present = 0; |
b95e86d8 RK |
846 | memset(c45_ids.device_ids, 0xff, sizeof(c45_ids.device_ids)); |
847 | ||
e6306261 | 848 | if (is_c45) |
48c54388 | 849 | r = get_phy_c45_ids(bus, addr, &c45_ids); |
e6306261 RK |
850 | else |
851 | r = get_phy_c22_id(bus, addr, &phy_id); | |
852 | ||
cac1f3c8 PG |
853 | if (r) |
854 | return ERR_PTR(r); | |
00db8189 | 855 | |
e62a768f | 856 | return phy_device_create(bus, addr, phy_id, is_c45, &c45_ids); |
00db8189 | 857 | } |
4dea547f GL |
858 | EXPORT_SYMBOL(get_phy_device); |
859 | ||
860 | /** | |
861 | * phy_device_register - Register the phy device on the MDIO bus | |
1d4ac5d5 | 862 | * @phydev: phy_device structure to be added to the MDIO bus |
4dea547f GL |
863 | */ |
864 | int phy_device_register(struct phy_device *phydev) | |
865 | { | |
866 | int err; | |
867 | ||
7f854420 AL |
868 | err = mdiobus_register_device(&phydev->mdio); |
869 | if (err) | |
870 | return err; | |
4dea547f | 871 | |
bafbdd52 SS |
872 | /* Deassert the reset signal */ |
873 | phy_device_reset(phydev, 0); | |
874 | ||
4dea547f | 875 | /* Run all of the fixups for this PHY */ |
d92f5dec | 876 | err = phy_scan_fixups(phydev); |
87aa9f9c | 877 | if (err) { |
c3a6a174 | 878 | phydev_err(phydev, "failed to initialize\n"); |
87aa9f9c FF |
879 | goto out; |
880 | } | |
4dea547f | 881 | |
e5a03bfd | 882 | err = device_add(&phydev->mdio.dev); |
4dea547f | 883 | if (err) { |
c3a6a174 | 884 | phydev_err(phydev, "failed to add\n"); |
4dea547f GL |
885 | goto out; |
886 | } | |
887 | ||
888 | return 0; | |
889 | ||
890 | out: | |
bafbdd52 SS |
891 | /* Assert the reset signal */ |
892 | phy_device_reset(phydev, 1); | |
893 | ||
7f854420 | 894 | mdiobus_unregister_device(&phydev->mdio); |
4dea547f GL |
895 | return err; |
896 | } | |
897 | EXPORT_SYMBOL(phy_device_register); | |
00db8189 | 898 | |
38737e49 RK |
899 | /** |
900 | * phy_device_remove - Remove a previously registered phy device from the MDIO bus | |
901 | * @phydev: phy_device structure to remove | |
902 | * | |
903 | * This doesn't free the phy_device itself, it merely reverses the effects | |
904 | * of phy_device_register(). Use phy_device_free() to free the device | |
905 | * after calling this function. | |
906 | */ | |
907 | void phy_device_remove(struct phy_device *phydev) | |
908 | { | |
1dca22b1 RC |
909 | if (phydev->mii_ts) |
910 | unregister_mii_timestamper(phydev->mii_ts); | |
911 | ||
e5a03bfd | 912 | device_del(&phydev->mdio.dev); |
bafbdd52 SS |
913 | |
914 | /* Assert the reset signal */ | |
915 | phy_device_reset(phydev, 1); | |
916 | ||
7f854420 | 917 | mdiobus_unregister_device(&phydev->mdio); |
38737e49 RK |
918 | } |
919 | EXPORT_SYMBOL(phy_device_remove); | |
920 | ||
f8f76db1 JP |
921 | /** |
922 | * phy_find_first - finds the first PHY device on the bus | |
923 | * @bus: the target MII bus | |
924 | */ | |
925 | struct phy_device *phy_find_first(struct mii_bus *bus) | |
926 | { | |
7f854420 | 927 | struct phy_device *phydev; |
f8f76db1 JP |
928 | int addr; |
929 | ||
930 | for (addr = 0; addr < PHY_MAX_ADDR; addr++) { | |
7f854420 AL |
931 | phydev = mdiobus_get_phy(bus, addr); |
932 | if (phydev) | |
933 | return phydev; | |
f8f76db1 JP |
934 | } |
935 | return NULL; | |
936 | } | |
937 | EXPORT_SYMBOL(phy_find_first); | |
938 | ||
a307593a | 939 | static void phy_link_change(struct phy_device *phydev, bool up) |
a81497be RK |
940 | { |
941 | struct net_device *netdev = phydev->attached_dev; | |
942 | ||
a307593a DB |
943 | if (up) |
944 | netif_carrier_on(netdev); | |
945 | else | |
946 | netif_carrier_off(netdev); | |
a81497be | 947 | phydev->adjust_link(netdev); |
4715f65f RC |
948 | if (phydev->mii_ts && phydev->mii_ts->link_state) |
949 | phydev->mii_ts->link_state(phydev->mii_ts, phydev); | |
a81497be RK |
950 | } |
951 | ||
b3df0da8 RD |
952 | /** |
953 | * phy_prepare_link - prepares the PHY layer to monitor link status | |
954 | * @phydev: target phy_device struct | |
955 | * @handler: callback function for link status change notifications | |
00db8189 | 956 | * |
b3df0da8 | 957 | * Description: Tells the PHY infrastructure to handle the |
00db8189 AF |
958 | * gory details on monitoring link status (whether through |
959 | * polling or an interrupt), and to call back to the | |
960 | * connected device driver when the link status changes. | |
961 | * If you want to monitor your own link state, don't call | |
b3df0da8 RD |
962 | * this function. |
963 | */ | |
89ff05ec | 964 | static void phy_prepare_link(struct phy_device *phydev, |
2f53e904 | 965 | void (*handler)(struct net_device *)) |
00db8189 AF |
966 | { |
967 | phydev->adjust_link = handler; | |
968 | } | |
969 | ||
fa94f6d9 GL |
970 | /** |
971 | * phy_connect_direct - connect an ethernet device to a specific phy_device | |
972 | * @dev: the network device to connect | |
973 | * @phydev: the pointer to the phy device | |
974 | * @handler: callback function for state change notifications | |
fa94f6d9 GL |
975 | * @interface: PHY device's interface |
976 | */ | |
977 | int phy_connect_direct(struct net_device *dev, struct phy_device *phydev, | |
f9a8f83b | 978 | void (*handler)(struct net_device *), |
fa94f6d9 GL |
979 | phy_interface_t interface) |
980 | { | |
981 | int rc; | |
982 | ||
82c76aca IC |
983 | if (!dev) |
984 | return -EINVAL; | |
985 | ||
f9a8f83b | 986 | rc = phy_attach_direct(dev, phydev, phydev->dev_flags, interface); |
fa94f6d9 GL |
987 | if (rc) |
988 | return rc; | |
989 | ||
990 | phy_prepare_link(phydev, handler); | |
434a4315 HK |
991 | if (phy_interrupt_is_valid(phydev)) |
992 | phy_request_interrupt(phydev); | |
fa94f6d9 GL |
993 | |
994 | return 0; | |
995 | } | |
996 | EXPORT_SYMBOL(phy_connect_direct); | |
997 | ||
b3df0da8 RD |
998 | /** |
999 | * phy_connect - connect an ethernet device to a PHY device | |
1000 | * @dev: the network device to connect | |
5d12b132 | 1001 | * @bus_id: the id string of the PHY device to connect |
b3df0da8 | 1002 | * @handler: callback function for state change notifications |
b3df0da8 | 1003 | * @interface: PHY device's interface |
e1393456 | 1004 | * |
b3df0da8 | 1005 | * Description: Convenience function for connecting ethernet |
e1393456 AF |
1006 | * devices to PHY devices. The default behavior is for |
1007 | * the PHY infrastructure to handle everything, and only notify | |
1008 | * the connected driver when the link status changes. If you | |
1009 | * don't want, or can't use the provided functionality, you may | |
1010 | * choose to call only the subset of functions which provide | |
1011 | * the desired functionality. | |
1012 | */ | |
e109374f | 1013 | struct phy_device *phy_connect(struct net_device *dev, const char *bus_id, |
2f53e904 SS |
1014 | void (*handler)(struct net_device *), |
1015 | phy_interface_t interface) | |
e1393456 AF |
1016 | { |
1017 | struct phy_device *phydev; | |
fa94f6d9 GL |
1018 | struct device *d; |
1019 | int rc; | |
e1393456 | 1020 | |
fa94f6d9 | 1021 | /* Search the list of PHY devices on the mdio bus for the |
2f53e904 SS |
1022 | * PHY with the requested name |
1023 | */ | |
fa94f6d9 GL |
1024 | d = bus_find_device_by_name(&mdio_bus_type, NULL, bus_id); |
1025 | if (!d) { | |
1026 | pr_err("PHY %s not found\n", bus_id); | |
1027 | return ERR_PTR(-ENODEV); | |
1028 | } | |
1029 | phydev = to_phy_device(d); | |
e1393456 | 1030 | |
f9a8f83b | 1031 | rc = phy_connect_direct(dev, phydev, handler, interface); |
17ae1c65 | 1032 | put_device(d); |
fa94f6d9 GL |
1033 | if (rc) |
1034 | return ERR_PTR(rc); | |
e1393456 AF |
1035 | |
1036 | return phydev; | |
1037 | } | |
1038 | EXPORT_SYMBOL(phy_connect); | |
1039 | ||
b3df0da8 | 1040 | /** |
2f53e904 SS |
1041 | * phy_disconnect - disable interrupts, stop state machine, and detach a PHY |
1042 | * device | |
b3df0da8 RD |
1043 | * @phydev: target phy_device struct |
1044 | */ | |
e1393456 AF |
1045 | void phy_disconnect(struct phy_device *phydev) |
1046 | { | |
472115d9 HK |
1047 | if (phy_is_started(phydev)) |
1048 | phy_stop(phydev); | |
1049 | ||
bb658ab7 | 1050 | if (phy_interrupt_is_valid(phydev)) |
07b09289 | 1051 | phy_free_interrupt(phydev); |
e1393456 | 1052 | |
e1393456 AF |
1053 | phydev->adjust_link = NULL; |
1054 | ||
1055 | phy_detach(phydev); | |
1056 | } | |
1057 | EXPORT_SYMBOL(phy_disconnect); | |
1058 | ||
87aa9f9c FF |
1059 | /** |
1060 | * phy_poll_reset - Safely wait until a PHY reset has properly completed | |
1061 | * @phydev: The PHY device to poll | |
1062 | * | |
1063 | * Description: According to IEEE 802.3, Section 2, Subsection 22.2.4.1.1, as | |
1064 | * published in 2008, a PHY reset may take up to 0.5 seconds. The MII BMCR | |
1065 | * register must be polled until the BMCR_RESET bit clears. | |
1066 | * | |
1067 | * Furthermore, any attempts to write to PHY registers may have no effect | |
1068 | * or even generate MDIO bus errors until this is complete. | |
1069 | * | |
1070 | * Some PHYs (such as the Marvell 88E1111) don't entirely conform to the | |
1071 | * standard and do not fully reset after the BMCR_RESET bit is set, and may | |
1072 | * even *REQUIRE* a soft-reset to properly restart autonegotiation. In an | |
1073 | * effort to support such broken PHYs, this function is separate from the | |
1074 | * standard phy_init_hw() which will zero all the other bits in the BMCR | |
1075 | * and reapply all driver-specific and board-specific fixups. | |
1076 | */ | |
1077 | static int phy_poll_reset(struct phy_device *phydev) | |
1078 | { | |
1079 | /* Poll until the reset bit clears (50ms per retry == 0.6 sec) */ | |
745a237c | 1080 | int ret, val; |
87aa9f9c | 1081 | |
745a237c DZ |
1082 | ret = phy_read_poll_timeout(phydev, MII_BMCR, val, !(val & BMCR_RESET), |
1083 | 50000, 600000, true); | |
1084 | if (ret) | |
1085 | return ret; | |
2f53e904 | 1086 | /* Some chips (smsc911x) may still need up to another 1ms after the |
87aa9f9c FF |
1087 | * BMCR_RESET bit is cleared before they are usable. |
1088 | */ | |
1089 | msleep(1); | |
1090 | return 0; | |
1091 | } | |
1092 | ||
2f5cb434 AV |
1093 | int phy_init_hw(struct phy_device *phydev) |
1094 | { | |
9df81dd7 | 1095 | int ret = 0; |
2f5cb434 | 1096 | |
bafbdd52 SS |
1097 | /* Deassert the reset signal */ |
1098 | phy_device_reset(phydev, 0); | |
1099 | ||
a5996989 | 1100 | if (!phydev->drv) |
2f5cb434 AV |
1101 | return 0; |
1102 | ||
9576e9fa | 1103 | if (phydev->drv->soft_reset) { |
9df81dd7 | 1104 | ret = phydev->drv->soft_reset(phydev); |
9576e9fa HK |
1105 | /* see comment in genphy_soft_reset for an explanation */ |
1106 | if (!ret) | |
1107 | phydev->suspended = 0; | |
1108 | } | |
9df81dd7 | 1109 | |
87aa9f9c FF |
1110 | if (ret < 0) |
1111 | return ret; | |
1112 | ||
2f5cb434 AV |
1113 | ret = phy_scan_fixups(phydev); |
1114 | if (ret < 0) | |
1115 | return ret; | |
1116 | ||
9839f047 | 1117 | if (phydev->drv->config_init) { |
a5996989 | 1118 | ret = phydev->drv->config_init(phydev); |
9839f047 HK |
1119 | if (ret < 0) |
1120 | return ret; | |
1121 | } | |
a5996989 | 1122 | |
9839f047 HK |
1123 | if (phydev->drv->config_intr) { |
1124 | ret = phydev->drv->config_intr(phydev); | |
1125 | if (ret < 0) | |
1126 | return ret; | |
1127 | } | |
1128 | ||
1129 | return 0; | |
2f5cb434 | 1130 | } |
87aa9f9c | 1131 | EXPORT_SYMBOL(phy_init_hw); |
2f5cb434 | 1132 | |
2220943a AL |
1133 | void phy_attached_info(struct phy_device *phydev) |
1134 | { | |
1135 | phy_attached_print(phydev, NULL); | |
1136 | } | |
1137 | EXPORT_SYMBOL(phy_attached_info); | |
1138 | ||
a98cabdb | 1139 | #define ATTACHED_FMT "attached PHY driver %s(mii_bus:phy_addr=%s, irq=%s)" |
e27f1787 | 1140 | char *phy_attached_info_irq(struct phy_device *phydev) |
2220943a | 1141 | { |
5e369aef | 1142 | char *irq_str; |
059fbe8b | 1143 | char irq_num[8]; |
5e369aef RP |
1144 | |
1145 | switch(phydev->irq) { | |
1146 | case PHY_POLL: | |
1147 | irq_str = "POLL"; | |
1148 | break; | |
ed1f8bdc HK |
1149 | case PHY_MAC_INTERRUPT: |
1150 | irq_str = "MAC"; | |
5e369aef RP |
1151 | break; |
1152 | default: | |
1153 | snprintf(irq_num, sizeof(irq_num), "%d", phydev->irq); | |
1154 | irq_str = irq_num; | |
1155 | break; | |
1156 | } | |
1157 | ||
e27f1787 FF |
1158 | return kasprintf(GFP_KERNEL, "%s", irq_str); |
1159 | } | |
1160 | EXPORT_SYMBOL(phy_attached_info_irq); | |
1161 | ||
1162 | void phy_attached_print(struct phy_device *phydev, const char *fmt, ...) | |
1163 | { | |
a98cabdb | 1164 | const char *unbound = phydev->drv ? "" : "[unbound] "; |
e27f1787 | 1165 | char *irq_str = phy_attached_info_irq(phydev); |
fcd03e36 | 1166 | |
2220943a | 1167 | if (!fmt) { |
a98cabdb HK |
1168 | phydev_info(phydev, ATTACHED_FMT "\n", unbound, |
1169 | phydev_name(phydev), irq_str); | |
2220943a AL |
1170 | } else { |
1171 | va_list ap; | |
1172 | ||
a98cabdb HK |
1173 | phydev_info(phydev, ATTACHED_FMT, unbound, |
1174 | phydev_name(phydev), irq_str); | |
2220943a AL |
1175 | |
1176 | va_start(ap, fmt); | |
1177 | vprintk(fmt, ap); | |
1178 | va_end(ap); | |
1179 | } | |
e27f1787 | 1180 | kfree(irq_str); |
2220943a AL |
1181 | } |
1182 | EXPORT_SYMBOL(phy_attached_print); | |
1183 | ||
53cfca2d VO |
1184 | static void phy_sysfs_create_links(struct phy_device *phydev) |
1185 | { | |
1186 | struct net_device *dev = phydev->attached_dev; | |
1187 | int err; | |
1188 | ||
2db2d9d1 IC |
1189 | if (!dev) |
1190 | return; | |
1191 | ||
53cfca2d VO |
1192 | err = sysfs_create_link(&phydev->mdio.dev.kobj, &dev->dev.kobj, |
1193 | "attached_dev"); | |
1194 | if (err) | |
1195 | return; | |
1196 | ||
1197 | err = sysfs_create_link_nowarn(&dev->dev.kobj, | |
1198 | &phydev->mdio.dev.kobj, | |
1199 | "phydev"); | |
1200 | if (err) { | |
1201 | dev_err(&dev->dev, "could not add device link to %s err %d\n", | |
1202 | kobject_name(&phydev->mdio.dev.kobj), | |
1203 | err); | |
1204 | /* non-fatal - some net drivers can use one netdevice | |
1205 | * with more then one phy | |
1206 | */ | |
1207 | } | |
1208 | ||
1209 | phydev->sysfs_links = true; | |
1210 | } | |
1211 | ||
c920f745 IC |
1212 | static ssize_t |
1213 | phy_standalone_show(struct device *dev, struct device_attribute *attr, | |
1214 | char *buf) | |
1215 | { | |
1216 | struct phy_device *phydev = to_phy_device(dev); | |
1217 | ||
1218 | return sprintf(buf, "%d\n", !phydev->attached_dev); | |
1219 | } | |
1220 | static DEVICE_ATTR_RO(phy_standalone); | |
1221 | ||
298e54fa RK |
1222 | /** |
1223 | * phy_sfp_attach - attach the SFP bus to the PHY upstream network device | |
1224 | * @upstream: pointer to the phy device | |
1225 | * @bus: sfp bus representing cage being attached | |
1226 | * | |
1227 | * This is used to fill in the sfp_upstream_ops .attach member. | |
1228 | */ | |
1229 | void phy_sfp_attach(void *upstream, struct sfp_bus *bus) | |
1230 | { | |
1231 | struct phy_device *phydev = upstream; | |
1232 | ||
1233 | if (phydev->attached_dev) | |
1234 | phydev->attached_dev->sfp_bus = bus; | |
1235 | phydev->sfp_bus_attached = true; | |
1236 | } | |
1237 | EXPORT_SYMBOL(phy_sfp_attach); | |
1238 | ||
1239 | /** | |
1240 | * phy_sfp_detach - detach the SFP bus from the PHY upstream network device | |
1241 | * @upstream: pointer to the phy device | |
1242 | * @bus: sfp bus representing cage being attached | |
1243 | * | |
1244 | * This is used to fill in the sfp_upstream_ops .detach member. | |
1245 | */ | |
1246 | void phy_sfp_detach(void *upstream, struct sfp_bus *bus) | |
1247 | { | |
1248 | struct phy_device *phydev = upstream; | |
1249 | ||
1250 | if (phydev->attached_dev) | |
1251 | phydev->attached_dev->sfp_bus = NULL; | |
1252 | phydev->sfp_bus_attached = false; | |
1253 | } | |
1254 | EXPORT_SYMBOL(phy_sfp_detach); | |
1255 | ||
1256 | /** | |
1257 | * phy_sfp_probe - probe for a SFP cage attached to this PHY device | |
1258 | * @phydev: Pointer to phy_device | |
1259 | * @ops: SFP's upstream operations | |
1260 | */ | |
1261 | int phy_sfp_probe(struct phy_device *phydev, | |
1262 | const struct sfp_upstream_ops *ops) | |
1263 | { | |
1264 | struct sfp_bus *bus; | |
e3f2d557 | 1265 | int ret = 0; |
298e54fa RK |
1266 | |
1267 | if (phydev->mdio.dev.fwnode) { | |
1268 | bus = sfp_bus_find_fwnode(phydev->mdio.dev.fwnode); | |
1269 | if (IS_ERR(bus)) | |
1270 | return PTR_ERR(bus); | |
1271 | ||
1272 | phydev->sfp_bus = bus; | |
1273 | ||
1274 | ret = sfp_bus_add_upstream(bus, phydev, ops); | |
1275 | sfp_bus_put(bus); | |
1276 | } | |
e3f2d557 | 1277 | return ret; |
298e54fa RK |
1278 | } |
1279 | EXPORT_SYMBOL(phy_sfp_probe); | |
1280 | ||
b3df0da8 | 1281 | /** |
fa94f6d9 | 1282 | * phy_attach_direct - attach a network device to a given PHY device pointer |
b3df0da8 | 1283 | * @dev: network device to attach |
fa94f6d9 | 1284 | * @phydev: Pointer to phy_device to attach |
b3df0da8 RD |
1285 | * @flags: PHY device's dev_flags |
1286 | * @interface: PHY device's interface | |
e1393456 | 1287 | * |
b3df0da8 | 1288 | * Description: Called by drivers to attach to a particular PHY |
e1393456 | 1289 | * device. The phy_device is found, and properly hooked up |
257184d7 AF |
1290 | * to the phy_driver. If no driver is attached, then a |
1291 | * generic driver is used. The phy_device is given a ptr to | |
e1393456 | 1292 | * the attaching device, and given a callback for link status |
b3df0da8 | 1293 | * change. The phy_device is returned to the attaching driver. |
7322967b | 1294 | * This function takes a reference on the phy device. |
e1393456 | 1295 | */ |
257184d7 AF |
1296 | int phy_attach_direct(struct net_device *dev, struct phy_device *phydev, |
1297 | u32 flags, phy_interface_t interface) | |
e1393456 | 1298 | { |
e5a03bfd AL |
1299 | struct mii_bus *bus = phydev->mdio.bus; |
1300 | struct device *d = &phydev->mdio.dev; | |
2db2d9d1 | 1301 | struct module *ndev_owner = NULL; |
6d9f66ac | 1302 | bool using_genphy = false; |
d005a09e | 1303 | int err; |
e1393456 | 1304 | |
ec988ad7 FF |
1305 | /* For Ethernet device drivers that register their own MDIO bus, we |
1306 | * will have bus->owner match ndev_mod, so we do not want to increment | |
1307 | * our own module->refcnt here, otherwise we would not be able to | |
1308 | * unload later on. | |
1309 | */ | |
2db2d9d1 IC |
1310 | if (dev) |
1311 | ndev_owner = dev->dev.parent->driver->owner; | |
ec988ad7 | 1312 | if (ndev_owner != bus->owner && !try_module_get(bus->owner)) { |
2db2d9d1 | 1313 | phydev_err(phydev, "failed to get the bus module\n"); |
3e3aaf64 RK |
1314 | return -EIO; |
1315 | } | |
1316 | ||
7322967b RK |
1317 | get_device(d); |
1318 | ||
e1393456 | 1319 | /* Assume that if there is no driver, that it doesn't |
2f53e904 SS |
1320 | * exist, and we should use the genphy driver. |
1321 | */ | |
ef899c07 | 1322 | if (!d->driver) { |
257184d7 | 1323 | if (phydev->is_c45) |
22b56e82 | 1324 | d->driver = &genphy_c45_driver.mdiodrv.driver; |
257184d7 | 1325 | else |
921690f2 | 1326 | d->driver = &genphy_driver.mdiodrv.driver; |
e1393456 | 1327 | |
6d9f66ac FF |
1328 | using_genphy = true; |
1329 | } | |
1330 | ||
1331 | if (!try_module_get(d->driver->owner)) { | |
2db2d9d1 | 1332 | phydev_err(phydev, "failed to get the device driver module\n"); |
6d9f66ac FF |
1333 | err = -EIO; |
1334 | goto error_put_device; | |
1335 | } | |
1336 | ||
1337 | if (using_genphy) { | |
e1393456 | 1338 | err = d->driver->probe(d); |
b7a00ecd JG |
1339 | if (err >= 0) |
1340 | err = device_bind_driver(d); | |
e1393456 | 1341 | |
b7a00ecd | 1342 | if (err) |
6d9f66ac | 1343 | goto error_module_put; |
e1393456 AF |
1344 | } |
1345 | ||
1346 | if (phydev->attached_dev) { | |
fa94f6d9 | 1347 | dev_err(&dev->dev, "PHY already attached\n"); |
3e3aaf64 RK |
1348 | err = -EBUSY; |
1349 | goto error; | |
b3565f27 EG |
1350 | } |
1351 | ||
a81497be | 1352 | phydev->phy_link_change = phy_link_change; |
2db2d9d1 IC |
1353 | if (dev) { |
1354 | phydev->attached_dev = dev; | |
1355 | dev->phydev = phydev; | |
298e54fa RK |
1356 | |
1357 | if (phydev->sfp_bus_attached) | |
1358 | dev->sfp_bus = phydev->sfp_bus; | |
2db2d9d1 | 1359 | } |
a3995460 FF |
1360 | |
1361 | /* Some Ethernet drivers try to connect to a PHY device before | |
1362 | * calling register_netdevice() -> netdev_register_kobject() and | |
1363 | * does the dev->dev.kobj initialization. Here we only check for | |
1364 | * success which indicates that the network device kobject is | |
1365 | * ready. Once we do that we still need to keep track of whether | |
1366 | * links were successfully set up or not for phy_detach() to | |
1367 | * remove them accordingly. | |
1368 | */ | |
1369 | phydev->sysfs_links = false; | |
1370 | ||
53cfca2d | 1371 | phy_sysfs_create_links(phydev); |
e1393456 | 1372 | |
c920f745 IC |
1373 | if (!phydev->attached_dev) { |
1374 | err = sysfs_create_file(&phydev->mdio.dev.kobj, | |
1375 | &dev_attr_phy_standalone.attr); | |
1376 | if (err) | |
1377 | phydev_err(phydev, "error creating 'phy_standalone' sysfs entry\n"); | |
1378 | } | |
1379 | ||
e7312efb | 1380 | phydev->dev_flags |= flags; |
e1393456 | 1381 | |
e8a2b6a4 AF |
1382 | phydev->interface = interface; |
1383 | ||
ef24b16b AV |
1384 | phydev->state = PHY_READY; |
1385 | ||
947f74cb MW |
1386 | /* Port is set to PORT_TP by default and the actual PHY driver will set |
1387 | * it to different value depending on the PHY configuration. If we have | |
1388 | * the generic PHY driver we can't figure it out, thus set the old | |
1389 | * legacy PORT_MII value. | |
1390 | */ | |
1391 | if (using_genphy) | |
1392 | phydev->port = PORT_MII; | |
1393 | ||
113c74d8 SS |
1394 | /* Initial carrier state is off as the phy is about to be |
1395 | * (re)initialized. | |
1396 | */ | |
2db2d9d1 IC |
1397 | if (dev) |
1398 | netif_carrier_off(phydev->attached_dev); | |
113c74d8 | 1399 | |
e8a2b6a4 AF |
1400 | /* Do initial configuration here, now that |
1401 | * we have certain key parameters | |
2f53e904 SS |
1402 | * (dev_flags and interface) |
1403 | */ | |
d005a09e MKB |
1404 | err = phy_init_hw(phydev); |
1405 | if (err) | |
a7dac9f9 | 1406 | goto error; |
1211ce53 | 1407 | |
7d3ba936 YS |
1408 | err = phy_disable_interrupts(phydev); |
1409 | if (err) | |
1410 | return err; | |
1411 | ||
a7dac9f9 | 1412 | phy_resume(phydev); |
2e0bc452 ZB |
1413 | phy_led_triggers_register(phydev); |
1414 | ||
d005a09e | 1415 | return err; |
3e3aaf64 RK |
1416 | |
1417 | error: | |
6d9f66ac | 1418 | /* phy_detach() does all of the cleanup below */ |
a7dac9f9 | 1419 | phy_detach(phydev); |
6d9f66ac FF |
1420 | return err; |
1421 | ||
1422 | error_module_put: | |
cafe8df8 | 1423 | module_put(d->driver->owner); |
6d9f66ac FF |
1424 | error_put_device: |
1425 | put_device(d); | |
ec988ad7 FF |
1426 | if (ndev_owner != bus->owner) |
1427 | module_put(bus->owner); | |
3e3aaf64 | 1428 | return err; |
fa94f6d9 | 1429 | } |
257184d7 | 1430 | EXPORT_SYMBOL(phy_attach_direct); |
fa94f6d9 GL |
1431 | |
1432 | /** | |
1433 | * phy_attach - attach a network device to a particular PHY device | |
1434 | * @dev: network device to attach | |
1435 | * @bus_id: Bus ID of PHY device to attach | |
fa94f6d9 GL |
1436 | * @interface: PHY device's interface |
1437 | * | |
1438 | * Description: Same as phy_attach_direct() except that a PHY bus_id | |
1439 | * string is passed instead of a pointer to a struct phy_device. | |
1440 | */ | |
2f53e904 SS |
1441 | struct phy_device *phy_attach(struct net_device *dev, const char *bus_id, |
1442 | phy_interface_t interface) | |
fa94f6d9 GL |
1443 | { |
1444 | struct bus_type *bus = &mdio_bus_type; | |
1445 | struct phy_device *phydev; | |
1446 | struct device *d; | |
1447 | int rc; | |
1448 | ||
82c76aca IC |
1449 | if (!dev) |
1450 | return ERR_PTR(-EINVAL); | |
1451 | ||
fa94f6d9 | 1452 | /* Search the list of PHY devices on the mdio bus for the |
2f53e904 SS |
1453 | * PHY with the requested name |
1454 | */ | |
fa94f6d9 GL |
1455 | d = bus_find_device_by_name(bus, NULL, bus_id); |
1456 | if (!d) { | |
1457 | pr_err("PHY %s not found\n", bus_id); | |
1458 | return ERR_PTR(-ENODEV); | |
e8a2b6a4 | 1459 | } |
fa94f6d9 GL |
1460 | phydev = to_phy_device(d); |
1461 | ||
f9a8f83b | 1462 | rc = phy_attach_direct(dev, phydev, phydev->dev_flags, interface); |
17ae1c65 | 1463 | put_device(d); |
fa94f6d9 GL |
1464 | if (rc) |
1465 | return ERR_PTR(rc); | |
e8a2b6a4 | 1466 | |
e1393456 AF |
1467 | return phydev; |
1468 | } | |
1469 | EXPORT_SYMBOL(phy_attach); | |
1470 | ||
5db5ea99 FF |
1471 | static bool phy_driver_is_genphy_kind(struct phy_device *phydev, |
1472 | struct device_driver *driver) | |
1473 | { | |
1474 | struct device *d = &phydev->mdio.dev; | |
1475 | bool ret = false; | |
1476 | ||
1477 | if (!phydev->drv) | |
1478 | return ret; | |
1479 | ||
1480 | get_device(d); | |
1481 | ret = d->driver == driver; | |
1482 | put_device(d); | |
1483 | ||
1484 | return ret; | |
1485 | } | |
1486 | ||
1487 | bool phy_driver_is_genphy(struct phy_device *phydev) | |
1488 | { | |
1489 | return phy_driver_is_genphy_kind(phydev, | |
1490 | &genphy_driver.mdiodrv.driver); | |
1491 | } | |
1492 | EXPORT_SYMBOL_GPL(phy_driver_is_genphy); | |
1493 | ||
1494 | bool phy_driver_is_genphy_10g(struct phy_device *phydev) | |
1495 | { | |
1496 | return phy_driver_is_genphy_kind(phydev, | |
22b56e82 | 1497 | &genphy_c45_driver.mdiodrv.driver); |
5db5ea99 FF |
1498 | } |
1499 | EXPORT_SYMBOL_GPL(phy_driver_is_genphy_10g); | |
1500 | ||
63490847 MW |
1501 | /** |
1502 | * phy_package_join - join a common PHY group | |
1503 | * @phydev: target phy_device struct | |
1504 | * @addr: cookie and PHY address for global register access | |
1505 | * @priv_size: if non-zero allocate this amount of bytes for private data | |
1506 | * | |
1507 | * This joins a PHY group and provides a shared storage for all phydevs in | |
1508 | * this group. This is intended to be used for packages which contain | |
1509 | * more than one PHY, for example a quad PHY transceiver. | |
1510 | * | |
1511 | * The addr parameter serves as a cookie which has to have the same value | |
1512 | * for all members of one group and as a PHY address to access generic | |
1513 | * registers of a PHY package. Usually, one of the PHY addresses of the | |
1514 | * different PHYs in the package provides access to these global registers. | |
1515 | * The address which is given here, will be used in the phy_package_read() | |
1516 | * and phy_package_write() convenience functions. If your PHY doesn't have | |
1517 | * global registers you can just pick any of the PHY addresses. | |
1518 | * | |
1519 | * This will set the shared pointer of the phydev to the shared storage. | |
1520 | * If this is the first call for a this cookie the shared storage will be | |
1521 | * allocated. If priv_size is non-zero, the given amount of bytes are | |
1522 | * allocated for the priv member. | |
1523 | * | |
1524 | * Returns < 1 on error, 0 on success. Esp. calling phy_package_join() | |
1525 | * with the same cookie but a different priv_size is an error. | |
1526 | */ | |
1527 | int phy_package_join(struct phy_device *phydev, int addr, size_t priv_size) | |
1528 | { | |
1529 | struct mii_bus *bus = phydev->mdio.bus; | |
1530 | struct phy_package_shared *shared; | |
1531 | int ret; | |
1532 | ||
1533 | if (addr < 0 || addr >= PHY_MAX_ADDR) | |
1534 | return -EINVAL; | |
1535 | ||
1536 | mutex_lock(&bus->shared_lock); | |
1537 | shared = bus->shared[addr]; | |
1538 | if (!shared) { | |
1539 | ret = -ENOMEM; | |
1540 | shared = kzalloc(sizeof(*shared), GFP_KERNEL); | |
1541 | if (!shared) | |
1542 | goto err_unlock; | |
1543 | if (priv_size) { | |
1544 | shared->priv = kzalloc(priv_size, GFP_KERNEL); | |
1545 | if (!shared->priv) | |
1546 | goto err_free; | |
1547 | shared->priv_size = priv_size; | |
1548 | } | |
1549 | shared->addr = addr; | |
1550 | refcount_set(&shared->refcnt, 1); | |
1551 | bus->shared[addr] = shared; | |
1552 | } else { | |
1553 | ret = -EINVAL; | |
1554 | if (priv_size && priv_size != shared->priv_size) | |
1555 | goto err_unlock; | |
1556 | refcount_inc(&shared->refcnt); | |
1557 | } | |
1558 | mutex_unlock(&bus->shared_lock); | |
1559 | ||
1560 | phydev->shared = shared; | |
1561 | ||
1562 | return 0; | |
1563 | ||
1564 | err_free: | |
1565 | kfree(shared); | |
1566 | err_unlock: | |
1567 | mutex_unlock(&bus->shared_lock); | |
1568 | return ret; | |
1569 | } | |
1570 | EXPORT_SYMBOL_GPL(phy_package_join); | |
1571 | ||
1572 | /** | |
1573 | * phy_package_leave - leave a common PHY group | |
1574 | * @phydev: target phy_device struct | |
1575 | * | |
1576 | * This leaves a PHY group created by phy_package_join(). If this phydev | |
1577 | * was the last user of the shared data between the group, this data is | |
1578 | * freed. Resets the phydev->shared pointer to NULL. | |
1579 | */ | |
1580 | void phy_package_leave(struct phy_device *phydev) | |
1581 | { | |
1582 | struct phy_package_shared *shared = phydev->shared; | |
1583 | struct mii_bus *bus = phydev->mdio.bus; | |
1584 | ||
1585 | if (!shared) | |
1586 | return; | |
1587 | ||
1588 | if (refcount_dec_and_mutex_lock(&shared->refcnt, &bus->shared_lock)) { | |
1589 | bus->shared[shared->addr] = NULL; | |
1590 | mutex_unlock(&bus->shared_lock); | |
1591 | kfree(shared->priv); | |
1592 | kfree(shared); | |
1593 | } | |
1594 | ||
1595 | phydev->shared = NULL; | |
1596 | } | |
1597 | EXPORT_SYMBOL_GPL(phy_package_leave); | |
1598 | ||
1599 | static void devm_phy_package_leave(struct device *dev, void *res) | |
1600 | { | |
1601 | phy_package_leave(*(struct phy_device **)res); | |
1602 | } | |
1603 | ||
1604 | /** | |
1605 | * devm_phy_package_join - resource managed phy_package_join() | |
1606 | * @dev: device that is registering this PHY package | |
1607 | * @phydev: target phy_device struct | |
1608 | * @addr: cookie and PHY address for global register access | |
1609 | * @priv_size: if non-zero allocate this amount of bytes for private data | |
1610 | * | |
1611 | * Managed phy_package_join(). Shared storage fetched by this function, | |
1612 | * phy_package_leave() is automatically called on driver detach. See | |
1613 | * phy_package_join() for more information. | |
1614 | */ | |
1615 | int devm_phy_package_join(struct device *dev, struct phy_device *phydev, | |
1616 | int addr, size_t priv_size) | |
1617 | { | |
1618 | struct phy_device **ptr; | |
1619 | int ret; | |
1620 | ||
1621 | ptr = devres_alloc(devm_phy_package_leave, sizeof(*ptr), | |
1622 | GFP_KERNEL); | |
1623 | if (!ptr) | |
1624 | return -ENOMEM; | |
1625 | ||
1626 | ret = phy_package_join(phydev, addr, priv_size); | |
1627 | ||
1628 | if (!ret) { | |
1629 | *ptr = phydev; | |
1630 | devres_add(dev, ptr); | |
1631 | } else { | |
1632 | devres_free(ptr); | |
1633 | } | |
1634 | ||
1635 | return ret; | |
1636 | } | |
1637 | EXPORT_SYMBOL_GPL(devm_phy_package_join); | |
1638 | ||
b3df0da8 RD |
1639 | /** |
1640 | * phy_detach - detach a PHY device from its network device | |
1641 | * @phydev: target phy_device struct | |
7322967b RK |
1642 | * |
1643 | * This detaches the phy device from its network device and the phy | |
1644 | * driver, and drops the reference count taken in phy_attach_direct(). | |
b3df0da8 | 1645 | */ |
e1393456 AF |
1646 | void phy_detach(struct phy_device *phydev) |
1647 | { | |
ec988ad7 | 1648 | struct net_device *dev = phydev->attached_dev; |
2db2d9d1 | 1649 | struct module *ndev_owner = NULL; |
3e3aaf64 | 1650 | struct mii_bus *bus; |
b3565f27 | 1651 | |
a3995460 | 1652 | if (phydev->sysfs_links) { |
2db2d9d1 IC |
1653 | if (dev) |
1654 | sysfs_remove_link(&dev->dev.kobj, "phydev"); | |
a3995460 FF |
1655 | sysfs_remove_link(&phydev->mdio.dev.kobj, "attached_dev"); |
1656 | } | |
c920f745 IC |
1657 | |
1658 | if (!phydev->attached_dev) | |
1659 | sysfs_remove_file(&phydev->mdio.dev.kobj, | |
1660 | &dev_attr_phy_standalone.attr); | |
1661 | ||
93f41e67 | 1662 | phy_suspend(phydev); |
2db2d9d1 IC |
1663 | if (dev) { |
1664 | phydev->attached_dev->phydev = NULL; | |
1665 | phydev->attached_dev = NULL; | |
1666 | } | |
9525ae83 | 1667 | phydev->phylink = NULL; |
e1393456 | 1668 | |
0075bd69 GU |
1669 | phy_led_triggers_unregister(phydev); |
1670 | ||
c2b727df FF |
1671 | if (phydev->mdio.dev.driver) |
1672 | module_put(phydev->mdio.dev.driver->owner); | |
6d9f66ac | 1673 | |
e1393456 AF |
1674 | /* If the device had no specific driver before (i.e. - it |
1675 | * was using the generic driver), we unbind the device | |
1676 | * from the generic driver so that there's a chance a | |
2f53e904 SS |
1677 | * real driver could be loaded |
1678 | */ | |
5db5ea99 FF |
1679 | if (phy_driver_is_genphy(phydev) || |
1680 | phy_driver_is_genphy_10g(phydev)) | |
921690f2 | 1681 | device_release_driver(&phydev->mdio.dev); |
3e3aaf64 | 1682 | |
7322967b RK |
1683 | /* |
1684 | * The phydev might go away on the put_device() below, so avoid | |
1685 | * a use-after-free bug by reading the underlying bus first. | |
1686 | */ | |
e5a03bfd | 1687 | bus = phydev->mdio.bus; |
3e3aaf64 | 1688 | |
e5a03bfd | 1689 | put_device(&phydev->mdio.dev); |
2db2d9d1 IC |
1690 | if (dev) |
1691 | ndev_owner = dev->dev.parent->driver->owner; | |
ec988ad7 FF |
1692 | if (ndev_owner != bus->owner) |
1693 | module_put(bus->owner); | |
bafbdd52 SS |
1694 | |
1695 | /* Assert the reset signal */ | |
1696 | phy_device_reset(phydev, 1); | |
e1393456 AF |
1697 | } |
1698 | EXPORT_SYMBOL(phy_detach); | |
1699 | ||
481b5d93 SH |
1700 | int phy_suspend(struct phy_device *phydev) |
1701 | { | |
32fc3fd4 | 1702 | struct ethtool_wolinfo wol = { .cmd = ETHTOOL_GWOL }; |
8a8f8281 HK |
1703 | struct net_device *netdev = phydev->attached_dev; |
1704 | struct phy_driver *phydrv = phydev->drv; | |
1705 | int ret; | |
481b5d93 | 1706 | |
d70c47c8 HK |
1707 | if (phydev->suspended) |
1708 | return 0; | |
1709 | ||
481b5d93 | 1710 | /* If the device has WOL enabled, we cannot suspend the PHY */ |
481b5d93 | 1711 | phy_ethtool_get_wol(phydev, &wol); |
93f41e67 | 1712 | if (wol.wolopts || (netdev && netdev->wol_enabled)) |
481b5d93 SH |
1713 | return -EBUSY; |
1714 | ||
8a8f8281 HK |
1715 | if (!phydrv || !phydrv->suspend) |
1716 | return 0; | |
8a477a6f | 1717 | |
8a8f8281 HK |
1718 | ret = phydrv->suspend(phydev); |
1719 | if (!ret) | |
1720 | phydev->suspended = true; | |
8a477a6f FF |
1721 | |
1722 | return ret; | |
481b5d93 | 1723 | } |
ca127697 | 1724 | EXPORT_SYMBOL(phy_suspend); |
481b5d93 | 1725 | |
9c2c2e62 | 1726 | int __phy_resume(struct phy_device *phydev) |
481b5d93 | 1727 | { |
8a8f8281 HK |
1728 | struct phy_driver *phydrv = phydev->drv; |
1729 | int ret; | |
481b5d93 | 1730 | |
f5e64032 RK |
1731 | WARN_ON(!mutex_is_locked(&phydev->lock)); |
1732 | ||
8a8f8281 HK |
1733 | if (!phydrv || !phydrv->resume) |
1734 | return 0; | |
8a477a6f | 1735 | |
8a8f8281 HK |
1736 | ret = phydrv->resume(phydev); |
1737 | if (!ret) | |
1738 | phydev->suspended = false; | |
8a477a6f FF |
1739 | |
1740 | return ret; | |
481b5d93 | 1741 | } |
9c2c2e62 AL |
1742 | EXPORT_SYMBOL(__phy_resume); |
1743 | ||
1744 | int phy_resume(struct phy_device *phydev) | |
1745 | { | |
1746 | int ret; | |
1747 | ||
1748 | mutex_lock(&phydev->lock); | |
1749 | ret = __phy_resume(phydev); | |
1750 | mutex_unlock(&phydev->lock); | |
1751 | ||
1752 | return ret; | |
1753 | } | |
ca127697 | 1754 | EXPORT_SYMBOL(phy_resume); |
e1393456 | 1755 | |
f0f9b4ed LYS |
1756 | int phy_loopback(struct phy_device *phydev, bool enable) |
1757 | { | |
1758 | struct phy_driver *phydrv = to_phy_driver(phydev->mdio.dev.driver); | |
1759 | int ret = 0; | |
1760 | ||
1761 | mutex_lock(&phydev->lock); | |
1762 | ||
1763 | if (enable && phydev->loopback_enabled) { | |
1764 | ret = -EBUSY; | |
1765 | goto out; | |
1766 | } | |
1767 | ||
1768 | if (!enable && !phydev->loopback_enabled) { | |
1769 | ret = -EINVAL; | |
1770 | goto out; | |
1771 | } | |
1772 | ||
1773 | if (phydev->drv && phydrv->set_loopback) | |
1774 | ret = phydrv->set_loopback(phydev, enable); | |
1775 | else | |
1776 | ret = -EOPNOTSUPP; | |
1777 | ||
1778 | if (ret) | |
1779 | goto out; | |
1780 | ||
1781 | phydev->loopback_enabled = enable; | |
1782 | ||
1783 | out: | |
1784 | mutex_unlock(&phydev->lock); | |
1785 | return ret; | |
1786 | } | |
1787 | EXPORT_SYMBOL(phy_loopback); | |
1788 | ||
a9668491 RL |
1789 | /** |
1790 | * phy_reset_after_clk_enable - perform a PHY reset if needed | |
1791 | * @phydev: target phy_device struct | |
1792 | * | |
1793 | * Description: Some PHYs are known to need a reset after their refclk was | |
1794 | * enabled. This function evaluates the flags and perform the reset if it's | |
1795 | * needed. Returns < 0 on error, 0 if the phy wasn't reset and 1 if the phy | |
1796 | * was reset. | |
1797 | */ | |
1798 | int phy_reset_after_clk_enable(struct phy_device *phydev) | |
1799 | { | |
1800 | if (!phydev || !phydev->drv) | |
1801 | return -ENODEV; | |
1802 | ||
1803 | if (phydev->drv->flags & PHY_RST_AFTER_CLK_EN) { | |
1804 | phy_device_reset(phydev, 1); | |
1805 | phy_device_reset(phydev, 0); | |
1806 | return 1; | |
1807 | } | |
1808 | ||
1809 | return 0; | |
1810 | } | |
1811 | EXPORT_SYMBOL(phy_reset_after_clk_enable); | |
1812 | ||
00db8189 AF |
1813 | /* Generic PHY support and helper functions */ |
1814 | ||
b3df0da8 | 1815 | /** |
25985edc | 1816 | * genphy_config_advert - sanitize and advertise auto-negotiation parameters |
b3df0da8 | 1817 | * @phydev: target phy_device struct |
00db8189 | 1818 | * |
b3df0da8 | 1819 | * Description: Writes MII_ADVERTISE with the appropriate values, |
00db8189 | 1820 | * after sanitizing the values to make sure we only advertise |
51e2a384 TP |
1821 | * what is supported. Returns < 0 on error, 0 if the PHY's advertisement |
1822 | * hasn't changed, and > 0 if it has changed. | |
00db8189 | 1823 | */ |
89ff05ec | 1824 | static int genphy_config_advert(struct phy_device *phydev) |
00db8189 | 1825 | { |
3eef8689 HK |
1826 | int err, bmsr, changed = 0; |
1827 | u32 adv; | |
00db8189 | 1828 | |
2f53e904 | 1829 | /* Only allow advertising what this PHY supports */ |
3c1bcc86 AL |
1830 | linkmode_and(phydev->advertising, phydev->advertising, |
1831 | phydev->supported); | |
3eef8689 HK |
1832 | |
1833 | adv = linkmode_adv_to_mii_adv_t(phydev->advertising); | |
00db8189 AF |
1834 | |
1835 | /* Setup standard advertisement */ | |
4f9744ed HK |
1836 | err = phy_modify_changed(phydev, MII_ADVERTISE, |
1837 | ADVERTISE_ALL | ADVERTISE_100BASE4 | | |
1838 | ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM, | |
3eef8689 | 1839 | adv); |
4f9744ed HK |
1840 | if (err < 0) |
1841 | return err; | |
1842 | if (err > 0) | |
51e2a384 | 1843 | changed = 1; |
00db8189 | 1844 | |
5273e3a5 FF |
1845 | bmsr = phy_read(phydev, MII_BMSR); |
1846 | if (bmsr < 0) | |
1847 | return bmsr; | |
1848 | ||
1849 | /* Per 802.3-2008, Section 22.2.4.2.16 Extended status all | |
1850 | * 1000Mbits/sec capable PHYs shall have the BMSR_ESTATEN bit set to a | |
1851 | * logical 1. | |
1852 | */ | |
1853 | if (!(bmsr & BMSR_ESTATEN)) | |
1854 | return changed; | |
1855 | ||
3eef8689 | 1856 | adv = linkmode_adv_to_mii_ctrl1000_t(phydev->advertising); |
00db8189 | 1857 | |
4f9744ed HK |
1858 | err = phy_modify_changed(phydev, MII_CTRL1000, |
1859 | ADVERTISE_1000FULL | ADVERTISE_1000HALF, | |
1860 | adv); | |
5273e3a5 FF |
1861 | if (err < 0) |
1862 | return err; | |
4f9744ed HK |
1863 | if (err > 0) |
1864 | changed = 1; | |
5273e3a5 | 1865 | |
51e2a384 | 1866 | return changed; |
00db8189 | 1867 | } |
00db8189 | 1868 | |
fa6e98ce HK |
1869 | /** |
1870 | * genphy_c37_config_advert - sanitize and advertise auto-negotiation parameters | |
1871 | * @phydev: target phy_device struct | |
1872 | * | |
1873 | * Description: Writes MII_ADVERTISE with the appropriate values, | |
1874 | * after sanitizing the values to make sure we only advertise | |
1875 | * what is supported. Returns < 0 on error, 0 if the PHY's advertisement | |
1876 | * hasn't changed, and > 0 if it has changed. This function is intended | |
1877 | * for Clause 37 1000Base-X mode. | |
1878 | */ | |
1879 | static int genphy_c37_config_advert(struct phy_device *phydev) | |
1880 | { | |
1881 | u16 adv = 0; | |
1882 | ||
1883 | /* Only allow advertising what this PHY supports */ | |
1884 | linkmode_and(phydev->advertising, phydev->advertising, | |
1885 | phydev->supported); | |
1886 | ||
1887 | if (linkmode_test_bit(ETHTOOL_LINK_MODE_1000baseX_Full_BIT, | |
1888 | phydev->advertising)) | |
1889 | adv |= ADVERTISE_1000XFULL; | |
1890 | if (linkmode_test_bit(ETHTOOL_LINK_MODE_Pause_BIT, | |
1891 | phydev->advertising)) | |
1892 | adv |= ADVERTISE_1000XPAUSE; | |
1893 | if (linkmode_test_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, | |
1894 | phydev->advertising)) | |
1895 | adv |= ADVERTISE_1000XPSE_ASYM; | |
1896 | ||
1897 | return phy_modify_changed(phydev, MII_ADVERTISE, | |
1898 | ADVERTISE_1000XFULL | ADVERTISE_1000XPAUSE | | |
1899 | ADVERTISE_1000XHALF | ADVERTISE_1000XPSE_ASYM, | |
1900 | adv); | |
1901 | } | |
1902 | ||
d853d145 | 1903 | /** |
1904 | * genphy_config_eee_advert - disable unwanted eee mode advertisement | |
1905 | * @phydev: target phy_device struct | |
1906 | * | |
1907 | * Description: Writes MDIO_AN_EEE_ADV after disabling unsupported energy | |
1908 | * efficent ethernet modes. Returns 0 if the PHY's advertisement hasn't | |
1909 | * changed, and 1 if it has changed. | |
1910 | */ | |
cd34499c | 1911 | int genphy_config_eee_advert(struct phy_device *phydev) |
d853d145 | 1912 | { |
9f771f1f | 1913 | int err; |
d853d145 | 1914 | |
1915 | /* Nothing to disable */ | |
9f771f1f | 1916 | if (!phydev->eee_broken_modes) |
d853d145 | 1917 | return 0; |
1918 | ||
9f771f1f HK |
1919 | err = phy_modify_mmd_changed(phydev, MDIO_MMD_AN, MDIO_AN_EEE_ADV, |
1920 | phydev->eee_broken_modes, 0); | |
1921 | /* If the call failed, we assume that EEE is not supported */ | |
1922 | return err < 0 ? 0 : err; | |
d853d145 | 1923 | } |
cd34499c | 1924 | EXPORT_SYMBOL(genphy_config_eee_advert); |
d853d145 | 1925 | |
b3df0da8 RD |
1926 | /** |
1927 | * genphy_setup_forced - configures/forces speed/duplex from @phydev | |
1928 | * @phydev: target phy_device struct | |
00db8189 | 1929 | * |
b3df0da8 | 1930 | * Description: Configures MII_BMCR to force speed/duplex |
00db8189 | 1931 | * to the values in phydev. Assumes that the values are valid. |
b3df0da8 RD |
1932 | * Please see phy_sanitize_settings(). |
1933 | */ | |
3fb69bca | 1934 | int genphy_setup_forced(struct phy_device *phydev) |
00db8189 | 1935 | { |
fea23fb5 | 1936 | u16 ctl = 0; |
00db8189 | 1937 | |
2f53e904 SS |
1938 | phydev->pause = 0; |
1939 | phydev->asym_pause = 0; | |
00db8189 AF |
1940 | |
1941 | if (SPEED_1000 == phydev->speed) | |
1942 | ctl |= BMCR_SPEED1000; | |
1943 | else if (SPEED_100 == phydev->speed) | |
1944 | ctl |= BMCR_SPEED100; | |
1945 | ||
1946 | if (DUPLEX_FULL == phydev->duplex) | |
1947 | ctl |= BMCR_FULLDPLX; | |
e109374f | 1948 | |
fea23fb5 | 1949 | return phy_modify(phydev, MII_BMCR, |
18a5b052 | 1950 | ~(BMCR_LOOPBACK | BMCR_ISOLATE | BMCR_PDOWN), ctl); |
00db8189 | 1951 | } |
3fb69bca | 1952 | EXPORT_SYMBOL(genphy_setup_forced); |
00db8189 | 1953 | |
bdbdac76 OR |
1954 | static int genphy_setup_master_slave(struct phy_device *phydev) |
1955 | { | |
1956 | u16 ctl = 0; | |
1957 | ||
1958 | if (!phydev->is_gigabit_capable) | |
1959 | return 0; | |
1960 | ||
1961 | switch (phydev->master_slave_set) { | |
1962 | case MASTER_SLAVE_CFG_MASTER_PREFERRED: | |
1963 | ctl |= CTL1000_PREFER_MASTER; | |
1964 | break; | |
1965 | case MASTER_SLAVE_CFG_SLAVE_PREFERRED: | |
1966 | break; | |
1967 | case MASTER_SLAVE_CFG_MASTER_FORCE: | |
1968 | ctl |= CTL1000_AS_MASTER; | |
df561f66 | 1969 | fallthrough; |
bdbdac76 OR |
1970 | case MASTER_SLAVE_CFG_SLAVE_FORCE: |
1971 | ctl |= CTL1000_ENABLE_MASTER; | |
1972 | break; | |
1973 | case MASTER_SLAVE_CFG_UNKNOWN: | |
1974 | case MASTER_SLAVE_CFG_UNSUPPORTED: | |
1975 | return 0; | |
1976 | default: | |
1977 | phydev_warn(phydev, "Unsupported Master/Slave mode\n"); | |
1978 | return -EOPNOTSUPP; | |
1979 | } | |
1980 | ||
1981 | return phy_modify_changed(phydev, MII_CTRL1000, | |
1982 | (CTL1000_ENABLE_MASTER | CTL1000_AS_MASTER | | |
1983 | CTL1000_PREFER_MASTER), ctl); | |
1984 | } | |
1985 | ||
1986 | static int genphy_read_master_slave(struct phy_device *phydev) | |
1987 | { | |
1988 | int cfg, state; | |
3a13f98b | 1989 | int val; |
bdbdac76 OR |
1990 | |
1991 | if (!phydev->is_gigabit_capable) { | |
1992 | phydev->master_slave_get = MASTER_SLAVE_CFG_UNSUPPORTED; | |
1993 | phydev->master_slave_state = MASTER_SLAVE_STATE_UNSUPPORTED; | |
1994 | return 0; | |
1995 | } | |
1996 | ||
1997 | phydev->master_slave_get = MASTER_SLAVE_CFG_UNKNOWN; | |
1998 | phydev->master_slave_state = MASTER_SLAVE_STATE_UNKNOWN; | |
1999 | ||
2000 | val = phy_read(phydev, MII_CTRL1000); | |
2001 | if (val < 0) | |
2002 | return val; | |
2003 | ||
2004 | if (val & CTL1000_ENABLE_MASTER) { | |
2005 | if (val & CTL1000_AS_MASTER) | |
2006 | cfg = MASTER_SLAVE_CFG_MASTER_FORCE; | |
2007 | else | |
2008 | cfg = MASTER_SLAVE_CFG_SLAVE_FORCE; | |
2009 | } else { | |
2010 | if (val & CTL1000_PREFER_MASTER) | |
2011 | cfg = MASTER_SLAVE_CFG_MASTER_PREFERRED; | |
2012 | else | |
2013 | cfg = MASTER_SLAVE_CFG_SLAVE_PREFERRED; | |
2014 | } | |
2015 | ||
2016 | val = phy_read(phydev, MII_STAT1000); | |
2017 | if (val < 0) | |
2018 | return val; | |
2019 | ||
2020 | if (val & LPA_1000MSFAIL) { | |
2021 | state = MASTER_SLAVE_STATE_ERR; | |
2022 | } else if (phydev->link) { | |
2023 | /* this bits are valid only for active link */ | |
2024 | if (val & LPA_1000MSRES) | |
2025 | state = MASTER_SLAVE_STATE_MASTER; | |
2026 | else | |
2027 | state = MASTER_SLAVE_STATE_SLAVE; | |
2028 | } else { | |
2029 | state = MASTER_SLAVE_STATE_UNKNOWN; | |
2030 | } | |
2031 | ||
2032 | phydev->master_slave_get = cfg; | |
2033 | phydev->master_slave_state = state; | |
2034 | ||
2035 | return 0; | |
2036 | } | |
2037 | ||
b3df0da8 RD |
2038 | /** |
2039 | * genphy_restart_aneg - Enable and Restart Autonegotiation | |
2040 | * @phydev: target phy_device struct | |
2041 | */ | |
00db8189 AF |
2042 | int genphy_restart_aneg(struct phy_device *phydev) |
2043 | { | |
00db8189 | 2044 | /* Don't isolate the PHY if we're negotiating */ |
f102852f | 2045 | return phy_modify(phydev, MII_BMCR, BMCR_ISOLATE, |
fea23fb5 | 2046 | BMCR_ANENABLE | BMCR_ANRESTART); |
00db8189 | 2047 | } |
892871dc | 2048 | EXPORT_SYMBOL(genphy_restart_aneg); |
00db8189 | 2049 | |
2a10ab04 RK |
2050 | /** |
2051 | * genphy_check_and_restart_aneg - Enable and restart auto-negotiation | |
2052 | * @phydev: target phy_device struct | |
2053 | * @restart: whether aneg restart is requested | |
2054 | * | |
2055 | * Check, and restart auto-negotiation if needed. | |
2056 | */ | |
2057 | int genphy_check_and_restart_aneg(struct phy_device *phydev, bool restart) | |
2058 | { | |
4f31c532 | 2059 | int ret; |
2a10ab04 RK |
2060 | |
2061 | if (!restart) { | |
2062 | /* Advertisement hasn't changed, but maybe aneg was never on to | |
2063 | * begin with? Or maybe phy was isolated? | |
2064 | */ | |
2065 | ret = phy_read(phydev, MII_BMCR); | |
2066 | if (ret < 0) | |
2067 | return ret; | |
2068 | ||
2069 | if (!(ret & BMCR_ANENABLE) || (ret & BMCR_ISOLATE)) | |
2070 | restart = true; | |
2071 | } | |
2072 | ||
2073 | if (restart) | |
4f31c532 | 2074 | return genphy_restart_aneg(phydev); |
2a10ab04 | 2075 | |
4f31c532 | 2076 | return 0; |
2a10ab04 RK |
2077 | } |
2078 | EXPORT_SYMBOL(genphy_check_and_restart_aneg); | |
2079 | ||
b3df0da8 | 2080 | /** |
f4069cd7 | 2081 | * __genphy_config_aneg - restart auto-negotiation or write BMCR |
b3df0da8 | 2082 | * @phydev: target phy_device struct |
f4069cd7 | 2083 | * @changed: whether autoneg is requested |
00db8189 | 2084 | * |
b3df0da8 | 2085 | * Description: If auto-negotiation is enabled, we configure the |
00db8189 | 2086 | * advertising, and then restart auto-negotiation. If it is not |
b3df0da8 | 2087 | * enabled, then we write the BMCR. |
00db8189 | 2088 | */ |
f4069cd7 | 2089 | int __genphy_config_aneg(struct phy_device *phydev, bool changed) |
00db8189 | 2090 | { |
f4069cd7 | 2091 | int err; |
d853d145 | 2092 | |
f4069cd7 HK |
2093 | if (genphy_config_eee_advert(phydev)) |
2094 | changed = true; | |
00db8189 | 2095 | |
bdbdac76 OR |
2096 | err = genphy_setup_master_slave(phydev); |
2097 | if (err < 0) | |
2098 | return err; | |
2099 | else if (err) | |
2100 | changed = true; | |
2101 | ||
de339c2a TP |
2102 | if (AUTONEG_ENABLE != phydev->autoneg) |
2103 | return genphy_setup_forced(phydev); | |
00db8189 | 2104 | |
d853d145 | 2105 | err = genphy_config_advert(phydev); |
2106 | if (err < 0) /* error */ | |
2107 | return err; | |
f4069cd7 HK |
2108 | else if (err) |
2109 | changed = true; | |
d853d145 | 2110 | |
2a10ab04 | 2111 | return genphy_check_and_restart_aneg(phydev, changed); |
00db8189 | 2112 | } |
f4069cd7 | 2113 | EXPORT_SYMBOL(__genphy_config_aneg); |
00db8189 | 2114 | |
fa6e98ce HK |
2115 | /** |
2116 | * genphy_c37_config_aneg - restart auto-negotiation or write BMCR | |
2117 | * @phydev: target phy_device struct | |
2118 | * | |
2119 | * Description: If auto-negotiation is enabled, we configure the | |
2120 | * advertising, and then restart auto-negotiation. If it is not | |
2121 | * enabled, then we write the BMCR. This function is intended | |
2122 | * for use with Clause 37 1000Base-X mode. | |
2123 | */ | |
2124 | int genphy_c37_config_aneg(struct phy_device *phydev) | |
2125 | { | |
2126 | int err, changed; | |
2127 | ||
2128 | if (phydev->autoneg != AUTONEG_ENABLE) | |
2129 | return genphy_setup_forced(phydev); | |
2130 | ||
2131 | err = phy_modify(phydev, MII_BMCR, BMCR_SPEED1000 | BMCR_SPEED100, | |
2132 | BMCR_SPEED1000); | |
2133 | if (err) | |
2134 | return err; | |
2135 | ||
2136 | changed = genphy_c37_config_advert(phydev); | |
2137 | if (changed < 0) /* error */ | |
2138 | return changed; | |
2139 | ||
2140 | if (!changed) { | |
2141 | /* Advertisement hasn't changed, but maybe aneg was never on to | |
2142 | * begin with? Or maybe phy was isolated? | |
2143 | */ | |
2144 | int ctl = phy_read(phydev, MII_BMCR); | |
2145 | ||
2146 | if (ctl < 0) | |
2147 | return ctl; | |
2148 | ||
2149 | if (!(ctl & BMCR_ANENABLE) || (ctl & BMCR_ISOLATE)) | |
2150 | changed = 1; /* do restart aneg */ | |
2151 | } | |
2152 | ||
2153 | /* Only restart aneg if we are advertising something different | |
2154 | * than we were before. | |
2155 | */ | |
2156 | if (changed > 0) | |
2157 | return genphy_restart_aneg(phydev); | |
2158 | ||
2159 | return 0; | |
2160 | } | |
2161 | EXPORT_SYMBOL(genphy_c37_config_aneg); | |
2162 | ||
a9fa6e6a FF |
2163 | /** |
2164 | * genphy_aneg_done - return auto-negotiation status | |
2165 | * @phydev: target phy_device struct | |
2166 | * | |
2167 | * Description: Reads the status register and returns 0 either if | |
2168 | * auto-negotiation is incomplete, or if there was an error. | |
2169 | * Returns BMSR_ANEGCOMPLETE if auto-negotiation is done. | |
2170 | */ | |
2171 | int genphy_aneg_done(struct phy_device *phydev) | |
2172 | { | |
2173 | int retval = phy_read(phydev, MII_BMSR); | |
2174 | ||
2175 | return (retval < 0) ? retval : (retval & BMSR_ANEGCOMPLETE); | |
2176 | } | |
2177 | EXPORT_SYMBOL(genphy_aneg_done); | |
2178 | ||
b3df0da8 RD |
2179 | /** |
2180 | * genphy_update_link - update link status in @phydev | |
2181 | * @phydev: target phy_device struct | |
00db8189 | 2182 | * |
b3df0da8 | 2183 | * Description: Update the value in phydev->link to reflect the |
00db8189 | 2184 | * current link value. In order to do this, we need to read |
b3df0da8 | 2185 | * the status register twice, keeping the second value. |
00db8189 AF |
2186 | */ |
2187 | int genphy_update_link(struct phy_device *phydev) | |
2188 | { | |
c36757eb HK |
2189 | int status = 0, bmcr; |
2190 | ||
2191 | bmcr = phy_read(phydev, MII_BMCR); | |
2192 | if (bmcr < 0) | |
2193 | return bmcr; | |
2194 | ||
2195 | /* Autoneg is being started, therefore disregard BMSR value and | |
2196 | * report link as down. | |
2197 | */ | |
2198 | if (bmcr & BMCR_ANRESTART) | |
2199 | goto done; | |
00db8189 | 2200 | |
93c09704 HK |
2201 | /* The link state is latched low so that momentary link |
2202 | * drops can be detected. Do not double-read the status | |
e96bd2d3 PO |
2203 | * in polling mode to detect such short link drops except |
2204 | * the link was already down. | |
93c09704 | 2205 | */ |
e96bd2d3 | 2206 | if (!phy_polling_mode(phydev) || !phydev->link) { |
93c09704 | 2207 | status = phy_read(phydev, MII_BMSR); |
b7f29f8c | 2208 | if (status < 0) |
93c09704 | 2209 | return status; |
b7f29f8c HK |
2210 | else if (status & BMSR_LSTATUS) |
2211 | goto done; | |
93c09704 | 2212 | } |
00db8189 AF |
2213 | |
2214 | /* Read link and autonegotiation status */ | |
2215 | status = phy_read(phydev, MII_BMSR); | |
00db8189 AF |
2216 | if (status < 0) |
2217 | return status; | |
b7f29f8c | 2218 | done: |
4950c2ba HK |
2219 | phydev->link = status & BMSR_LSTATUS ? 1 : 0; |
2220 | phydev->autoneg_complete = status & BMSR_ANEGCOMPLETE ? 1 : 0; | |
00db8189 | 2221 | |
aa6b1956 HK |
2222 | /* Consider the case that autoneg was started and "aneg complete" |
2223 | * bit has been reset, but "link up" bit not yet. | |
2224 | */ | |
2225 | if (phydev->autoneg == AUTONEG_ENABLE && !phydev->autoneg_complete) | |
2226 | phydev->link = 0; | |
2227 | ||
00db8189 AF |
2228 | return 0; |
2229 | } | |
6b655529 | 2230 | EXPORT_SYMBOL(genphy_update_link); |
00db8189 | 2231 | |
8d3dc3ac | 2232 | int genphy_read_lpa(struct phy_device *phydev) |
00db8189 | 2233 | { |
8d3dc3ac | 2234 | int lpa, lpagb; |
b6163f19 | 2235 | |
3de5ae54 YL |
2236 | if (phydev->autoneg == AUTONEG_ENABLE) { |
2237 | if (!phydev->autoneg_complete) { | |
2238 | mii_stat1000_mod_linkmode_lpa_t(phydev->lp_advertising, | |
2239 | 0); | |
2240 | mii_lpa_mod_linkmode_lpa_t(phydev->lp_advertising, 0); | |
2241 | return 0; | |
2242 | } | |
2243 | ||
3b8b11f9 | 2244 | if (phydev->is_gigabit_capable) { |
00db8189 | 2245 | lpagb = phy_read(phydev, MII_STAT1000); |
00db8189 AF |
2246 | if (lpagb < 0) |
2247 | return lpagb; | |
2248 | ||
b8f8c8eb | 2249 | if (lpagb & LPA_1000MSFAIL) { |
916e571e HK |
2250 | int adv = phy_read(phydev, MII_CTRL1000); |
2251 | ||
2252 | if (adv < 0) | |
2253 | return adv; | |
2254 | ||
b8f8c8eb HK |
2255 | if (adv & CTL1000_ENABLE_MASTER) |
2256 | phydev_err(phydev, "Master/Slave resolution failed, maybe conflicting manual settings?\n"); | |
2257 | else | |
2258 | phydev_err(phydev, "Master/Slave resolution failed\n"); | |
2259 | return -ENOLINK; | |
2260 | } | |
2261 | ||
78a24df3 AL |
2262 | mii_stat1000_mod_linkmode_lpa_t(phydev->lp_advertising, |
2263 | lpagb); | |
00db8189 AF |
2264 | } |
2265 | ||
2266 | lpa = phy_read(phydev, MII_LPA); | |
00db8189 AF |
2267 | if (lpa < 0) |
2268 | return lpa; | |
2269 | ||
d3351931 | 2270 | mii_lpa_mod_linkmode_lpa_t(phydev->lp_advertising, lpa); |
3de5ae54 YL |
2271 | } else { |
2272 | linkmode_zero(phydev->lp_advertising); | |
8d3dc3ac RK |
2273 | } |
2274 | ||
2275 | return 0; | |
2276 | } | |
2277 | EXPORT_SYMBOL(genphy_read_lpa); | |
2278 | ||
0efc286a RK |
2279 | /** |
2280 | * genphy_read_status_fixed - read the link parameters for !aneg mode | |
2281 | * @phydev: target phy_device struct | |
2282 | * | |
2283 | * Read the current duplex and speed state for a PHY operating with | |
2284 | * autonegotiation disabled. | |
2285 | */ | |
2286 | int genphy_read_status_fixed(struct phy_device *phydev) | |
2287 | { | |
2288 | int bmcr = phy_read(phydev, MII_BMCR); | |
2289 | ||
2290 | if (bmcr < 0) | |
2291 | return bmcr; | |
2292 | ||
2293 | if (bmcr & BMCR_FULLDPLX) | |
2294 | phydev->duplex = DUPLEX_FULL; | |
2295 | else | |
2296 | phydev->duplex = DUPLEX_HALF; | |
2297 | ||
2298 | if (bmcr & BMCR_SPEED1000) | |
2299 | phydev->speed = SPEED_1000; | |
2300 | else if (bmcr & BMCR_SPEED100) | |
2301 | phydev->speed = SPEED_100; | |
2302 | else | |
2303 | phydev->speed = SPEED_10; | |
2304 | ||
2305 | return 0; | |
2306 | } | |
2307 | EXPORT_SYMBOL(genphy_read_status_fixed); | |
2308 | ||
8d3dc3ac RK |
2309 | /** |
2310 | * genphy_read_status - check the link status and update current link state | |
2311 | * @phydev: target phy_device struct | |
2312 | * | |
2313 | * Description: Check the link, then figure out the current state | |
2314 | * by comparing what we advertise with what the link partner | |
2315 | * advertises. Start by checking the gigabit possibilities, | |
2316 | * then move on to 10/100. | |
2317 | */ | |
2318 | int genphy_read_status(struct phy_device *phydev) | |
2319 | { | |
2320 | int err, old_link = phydev->link; | |
2321 | ||
2322 | /* Update the link, but return if there was an error */ | |
2323 | err = genphy_update_link(phydev); | |
2324 | if (err) | |
2325 | return err; | |
2326 | ||
2327 | /* why bother the PHY if nothing can have changed */ | |
2328 | if (phydev->autoneg == AUTONEG_ENABLE && old_link && phydev->link) | |
2329 | return 0; | |
2330 | ||
2331 | phydev->speed = SPEED_UNKNOWN; | |
2332 | phydev->duplex = DUPLEX_UNKNOWN; | |
2333 | phydev->pause = 0; | |
2334 | phydev->asym_pause = 0; | |
2335 | ||
bdbdac76 OR |
2336 | err = genphy_read_master_slave(phydev); |
2337 | if (err < 0) | |
2338 | return err; | |
2339 | ||
8d3dc3ac RK |
2340 | err = genphy_read_lpa(phydev); |
2341 | if (err < 0) | |
2342 | return err; | |
2343 | ||
2344 | if (phydev->autoneg == AUTONEG_ENABLE && phydev->autoneg_complete) { | |
5502b218 | 2345 | phy_resolve_aneg_linkmode(phydev); |
b6163f19 | 2346 | } else if (phydev->autoneg == AUTONEG_DISABLE) { |
0efc286a RK |
2347 | err = genphy_read_status_fixed(phydev); |
2348 | if (err < 0) | |
2349 | return err; | |
00db8189 AF |
2350 | } |
2351 | ||
2352 | return 0; | |
2353 | } | |
2354 | EXPORT_SYMBOL(genphy_read_status); | |
2355 | ||
fa6e98ce HK |
2356 | /** |
2357 | * genphy_c37_read_status - check the link status and update current link state | |
2358 | * @phydev: target phy_device struct | |
2359 | * | |
2360 | * Description: Check the link, then figure out the current state | |
2361 | * by comparing what we advertise with what the link partner | |
2362 | * advertises. This function is for Clause 37 1000Base-X mode. | |
2363 | */ | |
2364 | int genphy_c37_read_status(struct phy_device *phydev) | |
2365 | { | |
2366 | int lpa, err, old_link = phydev->link; | |
2367 | ||
2368 | /* Update the link, but return if there was an error */ | |
2369 | err = genphy_update_link(phydev); | |
2370 | if (err) | |
2371 | return err; | |
2372 | ||
2373 | /* why bother the PHY if nothing can have changed */ | |
2374 | if (phydev->autoneg == AUTONEG_ENABLE && old_link && phydev->link) | |
2375 | return 0; | |
2376 | ||
2377 | phydev->duplex = DUPLEX_UNKNOWN; | |
2378 | phydev->pause = 0; | |
2379 | phydev->asym_pause = 0; | |
2380 | ||
2381 | if (phydev->autoneg == AUTONEG_ENABLE && phydev->autoneg_complete) { | |
2382 | lpa = phy_read(phydev, MII_LPA); | |
2383 | if (lpa < 0) | |
2384 | return lpa; | |
2385 | ||
2386 | linkmode_mod_bit(ETHTOOL_LINK_MODE_Autoneg_BIT, | |
2387 | phydev->lp_advertising, lpa & LPA_LPACK); | |
2388 | linkmode_mod_bit(ETHTOOL_LINK_MODE_1000baseX_Full_BIT, | |
2389 | phydev->lp_advertising, lpa & LPA_1000XFULL); | |
2390 | linkmode_mod_bit(ETHTOOL_LINK_MODE_Pause_BIT, | |
2391 | phydev->lp_advertising, lpa & LPA_1000XPAUSE); | |
2392 | linkmode_mod_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, | |
2393 | phydev->lp_advertising, | |
2394 | lpa & LPA_1000XPAUSE_ASYM); | |
2395 | ||
2396 | phy_resolve_aneg_linkmode(phydev); | |
2397 | } else if (phydev->autoneg == AUTONEG_DISABLE) { | |
2398 | int bmcr = phy_read(phydev, MII_BMCR); | |
2399 | ||
2400 | if (bmcr < 0) | |
2401 | return bmcr; | |
2402 | ||
2403 | if (bmcr & BMCR_FULLDPLX) | |
2404 | phydev->duplex = DUPLEX_FULL; | |
2405 | else | |
2406 | phydev->duplex = DUPLEX_HALF; | |
2407 | } | |
2408 | ||
2409 | return 0; | |
2410 | } | |
2411 | EXPORT_SYMBOL(genphy_c37_read_status); | |
2412 | ||
797ac071 FF |
2413 | /** |
2414 | * genphy_soft_reset - software reset the PHY via BMCR_RESET bit | |
2415 | * @phydev: target phy_device struct | |
2416 | * | |
2417 | * Description: Perform a software PHY reset using the standard | |
2418 | * BMCR_RESET bit and poll for the reset bit to be cleared. | |
2419 | * | |
2420 | * Returns: 0 on success, < 0 on failure | |
2421 | */ | |
2422 | int genphy_soft_reset(struct phy_device *phydev) | |
2423 | { | |
8c90b795 | 2424 | u16 res = BMCR_RESET; |
797ac071 FF |
2425 | int ret; |
2426 | ||
8c90b795 HK |
2427 | if (phydev->autoneg == AUTONEG_ENABLE) |
2428 | res |= BMCR_ANRESTART; | |
2429 | ||
2430 | ret = phy_modify(phydev, MII_BMCR, BMCR_ISOLATE, res); | |
797ac071 FF |
2431 | if (ret < 0) |
2432 | return ret; | |
2433 | ||
9576e9fa HK |
2434 | /* Clause 22 states that setting bit BMCR_RESET sets control registers |
2435 | * to their default value. Therefore the POWER DOWN bit is supposed to | |
2436 | * be cleared after soft reset. | |
2437 | */ | |
2438 | phydev->suspended = 0; | |
2439 | ||
8c90b795 HK |
2440 | ret = phy_poll_reset(phydev); |
2441 | if (ret) | |
2442 | return ret; | |
2443 | ||
2444 | /* BMCR may be reset to defaults */ | |
2445 | if (phydev->autoneg == AUTONEG_DISABLE) | |
2446 | ret = genphy_setup_forced(phydev); | |
2447 | ||
2448 | return ret; | |
797ac071 FF |
2449 | } |
2450 | EXPORT_SYMBOL(genphy_soft_reset); | |
2451 | ||
87de1f05 IC |
2452 | irqreturn_t genphy_handle_interrupt_no_ack(struct phy_device *phydev) |
2453 | { | |
2454 | /* It seems there are cases where the interrupts are handled by another | |
2455 | * entity (ie an IRQ controller embedded inside the PHY) and do not | |
2456 | * need any other interraction from phylib. In this case, just trigger | |
2457 | * the state machine directly. | |
2458 | */ | |
2459 | phy_trigger_machine(phydev); | |
2460 | ||
2461 | return 0; | |
2462 | } | |
2463 | EXPORT_SYMBOL(genphy_handle_interrupt_no_ack); | |
2464 | ||
045925e3 HK |
2465 | /** |
2466 | * genphy_read_abilities - read PHY abilities from Clause 22 registers | |
2467 | * @phydev: target phy_device struct | |
2468 | * | |
2469 | * Description: Reads the PHY's abilities and populates | |
2470 | * phydev->supported accordingly. | |
2471 | * | |
2472 | * Returns: 0 on success, < 0 on failure | |
2473 | */ | |
2474 | int genphy_read_abilities(struct phy_device *phydev) | |
2475 | { | |
2476 | int val; | |
2477 | ||
2478 | linkmode_set_bit_array(phy_basic_ports_array, | |
2479 | ARRAY_SIZE(phy_basic_ports_array), | |
2480 | phydev->supported); | |
2481 | ||
2482 | val = phy_read(phydev, MII_BMSR); | |
2483 | if (val < 0) | |
2484 | return val; | |
2485 | ||
2486 | linkmode_mod_bit(ETHTOOL_LINK_MODE_Autoneg_BIT, phydev->supported, | |
2487 | val & BMSR_ANEGCAPABLE); | |
2488 | ||
2489 | linkmode_mod_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT, phydev->supported, | |
2490 | val & BMSR_100FULL); | |
2491 | linkmode_mod_bit(ETHTOOL_LINK_MODE_100baseT_Half_BIT, phydev->supported, | |
2492 | val & BMSR_100HALF); | |
2493 | linkmode_mod_bit(ETHTOOL_LINK_MODE_10baseT_Full_BIT, phydev->supported, | |
2494 | val & BMSR_10FULL); | |
2495 | linkmode_mod_bit(ETHTOOL_LINK_MODE_10baseT_Half_BIT, phydev->supported, | |
2496 | val & BMSR_10HALF); | |
2497 | ||
2498 | if (val & BMSR_ESTATEN) { | |
2499 | val = phy_read(phydev, MII_ESTATUS); | |
2500 | if (val < 0) | |
2501 | return val; | |
2502 | ||
2503 | linkmode_mod_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT, | |
2504 | phydev->supported, val & ESTATUS_1000_TFULL); | |
2505 | linkmode_mod_bit(ETHTOOL_LINK_MODE_1000baseT_Half_BIT, | |
2506 | phydev->supported, val & ESTATUS_1000_THALF); | |
f30e33bc RH |
2507 | linkmode_mod_bit(ETHTOOL_LINK_MODE_1000baseX_Full_BIT, |
2508 | phydev->supported, val & ESTATUS_1000_XFULL); | |
045925e3 HK |
2509 | } |
2510 | ||
2511 | return 0; | |
2512 | } | |
2513 | EXPORT_SYMBOL(genphy_read_abilities); | |
2514 | ||
5df7af85 KH |
2515 | /* This is used for the phy device which doesn't support the MMD extended |
2516 | * register access, but it does have side effect when we are trying to access | |
2517 | * the MMD register via indirect method. | |
2518 | */ | |
2519 | int genphy_read_mmd_unsupported(struct phy_device *phdev, int devad, u16 regnum) | |
2520 | { | |
2521 | return -EOPNOTSUPP; | |
2522 | } | |
2523 | EXPORT_SYMBOL(genphy_read_mmd_unsupported); | |
2524 | ||
2525 | int genphy_write_mmd_unsupported(struct phy_device *phdev, int devnum, | |
2526 | u16 regnum, u16 val) | |
2527 | { | |
2528 | return -EOPNOTSUPP; | |
2529 | } | |
2530 | EXPORT_SYMBOL(genphy_write_mmd_unsupported); | |
2531 | ||
0f0ca340 GC |
2532 | int genphy_suspend(struct phy_device *phydev) |
2533 | { | |
032f4700 | 2534 | return phy_set_bits(phydev, MII_BMCR, BMCR_PDOWN); |
0f0ca340 GC |
2535 | } |
2536 | EXPORT_SYMBOL(genphy_suspend); | |
00db8189 | 2537 | |
0f0ca340 GC |
2538 | int genphy_resume(struct phy_device *phydev) |
2539 | { | |
032f4700 | 2540 | return phy_clear_bits(phydev, MII_BMCR, BMCR_PDOWN); |
0f0ca340 GC |
2541 | } |
2542 | EXPORT_SYMBOL(genphy_resume); | |
00db8189 | 2543 | |
f0f9b4ed LYS |
2544 | int genphy_loopback(struct phy_device *phydev, bool enable) |
2545 | { | |
f102852f | 2546 | return phy_modify(phydev, MII_BMCR, BMCR_LOOPBACK, |
fea23fb5 | 2547 | enable ? BMCR_LOOPBACK : 0); |
f0f9b4ed LYS |
2548 | } |
2549 | EXPORT_SYMBOL(genphy_loopback); | |
2550 | ||
41124fa6 AL |
2551 | /** |
2552 | * phy_remove_link_mode - Remove a supported link mode | |
2553 | * @phydev: phy_device structure to remove link mode from | |
2554 | * @link_mode: Link mode to be removed | |
2555 | * | |
2556 | * Description: Some MACs don't support all link modes which the PHY | |
2557 | * does. e.g. a 1G MAC often does not support 1000Half. Add a helper | |
2558 | * to remove a link mode. | |
2559 | */ | |
2560 | void phy_remove_link_mode(struct phy_device *phydev, u32 link_mode) | |
2561 | { | |
3c1bcc86 | 2562 | linkmode_clear_bit(link_mode, phydev->supported); |
22c0ef6b | 2563 | phy_advertise_supported(phydev); |
41124fa6 AL |
2564 | } |
2565 | EXPORT_SYMBOL(phy_remove_link_mode); | |
2566 | ||
22c0ef6b HK |
2567 | static void phy_copy_pause_bits(unsigned long *dst, unsigned long *src) |
2568 | { | |
2569 | linkmode_mod_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, dst, | |
2570 | linkmode_test_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, src)); | |
2571 | linkmode_mod_bit(ETHTOOL_LINK_MODE_Pause_BIT, dst, | |
2572 | linkmode_test_bit(ETHTOOL_LINK_MODE_Pause_BIT, src)); | |
2573 | } | |
2574 | ||
2575 | /** | |
2576 | * phy_advertise_supported - Advertise all supported modes | |
2577 | * @phydev: target phy_device struct | |
2578 | * | |
2579 | * Description: Called to advertise all supported modes, doesn't touch | |
2580 | * pause mode advertising. | |
2581 | */ | |
2582 | void phy_advertise_supported(struct phy_device *phydev) | |
2583 | { | |
2584 | __ETHTOOL_DECLARE_LINK_MODE_MASK(new); | |
2585 | ||
2586 | linkmode_copy(new, phydev->supported); | |
2587 | phy_copy_pause_bits(new, phydev->advertising); | |
2588 | linkmode_copy(phydev->advertising, new); | |
2589 | } | |
2590 | EXPORT_SYMBOL(phy_advertise_supported); | |
2591 | ||
c306ad36 AL |
2592 | /** |
2593 | * phy_support_sym_pause - Enable support of symmetrical pause | |
2594 | * @phydev: target phy_device struct | |
2595 | * | |
2596 | * Description: Called by the MAC to indicate is supports symmetrical | |
2597 | * Pause, but not asym pause. | |
2598 | */ | |
2599 | void phy_support_sym_pause(struct phy_device *phydev) | |
2600 | { | |
3c1bcc86 | 2601 | linkmode_clear_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, phydev->supported); |
22c0ef6b | 2602 | phy_copy_pause_bits(phydev->advertising, phydev->supported); |
c306ad36 AL |
2603 | } |
2604 | EXPORT_SYMBOL(phy_support_sym_pause); | |
2605 | ||
af8d9bb2 AL |
2606 | /** |
2607 | * phy_support_asym_pause - Enable support of asym pause | |
2608 | * @phydev: target phy_device struct | |
2609 | * | |
2610 | * Description: Called by the MAC to indicate is supports Asym Pause. | |
2611 | */ | |
2612 | void phy_support_asym_pause(struct phy_device *phydev) | |
2613 | { | |
22c0ef6b | 2614 | phy_copy_pause_bits(phydev->advertising, phydev->supported); |
af8d9bb2 AL |
2615 | } |
2616 | EXPORT_SYMBOL(phy_support_asym_pause); | |
2617 | ||
0c122405 AL |
2618 | /** |
2619 | * phy_set_sym_pause - Configure symmetric Pause | |
2620 | * @phydev: target phy_device struct | |
2621 | * @rx: Receiver Pause is supported | |
2622 | * @tx: Transmit Pause is supported | |
2623 | * @autoneg: Auto neg should be used | |
2624 | * | |
2625 | * Description: Configure advertised Pause support depending on if | |
2626 | * receiver pause and pause auto neg is supported. Generally called | |
2627 | * from the set_pauseparam .ndo. | |
2628 | */ | |
2629 | void phy_set_sym_pause(struct phy_device *phydev, bool rx, bool tx, | |
2630 | bool autoneg) | |
2631 | { | |
3c1bcc86 | 2632 | linkmode_clear_bit(ETHTOOL_LINK_MODE_Pause_BIT, phydev->supported); |
0c122405 AL |
2633 | |
2634 | if (rx && tx && autoneg) | |
3c1bcc86 AL |
2635 | linkmode_set_bit(ETHTOOL_LINK_MODE_Pause_BIT, |
2636 | phydev->supported); | |
0c122405 | 2637 | |
3c1bcc86 | 2638 | linkmode_copy(phydev->advertising, phydev->supported); |
0c122405 AL |
2639 | } |
2640 | EXPORT_SYMBOL(phy_set_sym_pause); | |
2641 | ||
70814e81 AL |
2642 | /** |
2643 | * phy_set_asym_pause - Configure Pause and Asym Pause | |
2644 | * @phydev: target phy_device struct | |
2645 | * @rx: Receiver Pause is supported | |
2646 | * @tx: Transmit Pause is supported | |
2647 | * | |
2648 | * Description: Configure advertised Pause support depending on if | |
2649 | * transmit and receiver pause is supported. If there has been a | |
2650 | * change in adverting, trigger a new autoneg. Generally called from | |
2651 | * the set_pauseparam .ndo. | |
2652 | */ | |
2653 | void phy_set_asym_pause(struct phy_device *phydev, bool rx, bool tx) | |
2654 | { | |
3c1bcc86 | 2655 | __ETHTOOL_DECLARE_LINK_MODE_MASK(oldadv); |
70814e81 | 2656 | |
3c1bcc86 | 2657 | linkmode_copy(oldadv, phydev->advertising); |
45c767fa | 2658 | linkmode_set_pause(phydev->advertising, tx, rx); |
3c1bcc86 AL |
2659 | |
2660 | if (!linkmode_equal(oldadv, phydev->advertising) && | |
2661 | phydev->autoneg) | |
2662 | phy_start_aneg(phydev); | |
70814e81 AL |
2663 | } |
2664 | EXPORT_SYMBOL(phy_set_asym_pause); | |
2665 | ||
22b7d299 AL |
2666 | /** |
2667 | * phy_validate_pause - Test if the PHY/MAC support the pause configuration | |
2668 | * @phydev: phy_device struct | |
2669 | * @pp: requested pause configuration | |
2670 | * | |
2671 | * Description: Test if the PHY/MAC combination supports the Pause | |
2672 | * configuration the user is requesting. Returns True if it is | |
2673 | * supported, false otherwise. | |
2674 | */ | |
2675 | bool phy_validate_pause(struct phy_device *phydev, | |
2676 | struct ethtool_pauseparam *pp) | |
2677 | { | |
3c1bcc86 | 2678 | if (!linkmode_test_bit(ETHTOOL_LINK_MODE_Pause_BIT, |
b4010af9 | 2679 | phydev->supported) && pp->rx_pause) |
22b7d299 | 2680 | return false; |
b4010af9 HK |
2681 | |
2682 | if (!linkmode_test_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, | |
2683 | phydev->supported) && | |
2684 | pp->rx_pause != pp->tx_pause) | |
2685 | return false; | |
2686 | ||
22b7d299 AL |
2687 | return true; |
2688 | } | |
2689 | EXPORT_SYMBOL(phy_validate_pause); | |
2690 | ||
a87ae8a9 RK |
2691 | /** |
2692 | * phy_get_pause - resolve negotiated pause modes | |
2693 | * @phydev: phy_device struct | |
2694 | * @tx_pause: pointer to bool to indicate whether transmit pause should be | |
2695 | * enabled. | |
2696 | * @rx_pause: pointer to bool to indicate whether receive pause should be | |
2697 | * enabled. | |
2698 | * | |
2699 | * Resolve and return the flow control modes according to the negotiation | |
2700 | * result. This includes checking that we are operating in full duplex mode. | |
2701 | * See linkmode_resolve_pause() for further details. | |
2702 | */ | |
2703 | void phy_get_pause(struct phy_device *phydev, bool *tx_pause, bool *rx_pause) | |
2704 | { | |
2705 | if (phydev->duplex != DUPLEX_FULL) { | |
2706 | *tx_pause = false; | |
2707 | *rx_pause = false; | |
2708 | return; | |
2709 | } | |
2710 | ||
2711 | return linkmode_resolve_pause(phydev->advertising, | |
2712 | phydev->lp_advertising, | |
2713 | tx_pause, rx_pause); | |
2714 | } | |
2715 | EXPORT_SYMBOL(phy_get_pause); | |
2716 | ||
92252eec DM |
2717 | #if IS_ENABLED(CONFIG_OF_MDIO) |
2718 | static int phy_get_int_delay_property(struct device *dev, const char *name) | |
2719 | { | |
2720 | s32 int_delay; | |
2721 | int ret; | |
2722 | ||
2723 | ret = device_property_read_u32(dev, name, &int_delay); | |
2724 | if (ret) | |
2725 | return ret; | |
2726 | ||
2727 | return int_delay; | |
2728 | } | |
2729 | #else | |
2730 | static int phy_get_int_delay_property(struct device *dev, const char *name) | |
2731 | { | |
2732 | return -EINVAL; | |
2733 | } | |
2734 | #endif | |
2735 | ||
2736 | /** | |
69280228 | 2737 | * phy_get_internal_delay - returns the index of the internal delay |
92252eec DM |
2738 | * @phydev: phy_device struct |
2739 | * @dev: pointer to the devices device struct | |
2740 | * @delay_values: array of delays the PHY supports | |
2741 | * @size: the size of the delay array | |
2742 | * @is_rx: boolean to indicate to get the rx internal delay | |
2743 | * | |
2744 | * Returns the index within the array of internal delay passed in. | |
2745 | * If the device property is not present then the interface type is checked | |
2746 | * if the interface defines use of internal delay then a 1 is returned otherwise | |
2747 | * a 0 is returned. | |
2748 | * The array must be in ascending order. If PHY does not have an ascending order | |
2749 | * array then size = 0 and the value of the delay property is returned. | |
2750 | * Return -EINVAL if the delay is invalid or cannot be found. | |
2751 | */ | |
2752 | s32 phy_get_internal_delay(struct phy_device *phydev, struct device *dev, | |
2753 | const int *delay_values, int size, bool is_rx) | |
2754 | { | |
2755 | s32 delay; | |
2756 | int i; | |
2757 | ||
2758 | if (is_rx) { | |
2759 | delay = phy_get_int_delay_property(dev, "rx-internal-delay-ps"); | |
2760 | if (delay < 0 && size == 0) { | |
2761 | if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID || | |
2762 | phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) | |
2763 | return 1; | |
2764 | else | |
2765 | return 0; | |
2766 | } | |
2767 | ||
2768 | } else { | |
2769 | delay = phy_get_int_delay_property(dev, "tx-internal-delay-ps"); | |
2770 | if (delay < 0 && size == 0) { | |
2771 | if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID || | |
2772 | phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) | |
2773 | return 1; | |
2774 | else | |
2775 | return 0; | |
2776 | } | |
2777 | } | |
2778 | ||
2779 | if (delay < 0) | |
2780 | return delay; | |
2781 | ||
2782 | if (delay && size == 0) | |
2783 | return delay; | |
2784 | ||
2785 | if (delay < delay_values[0] || delay > delay_values[size - 1]) { | |
2786 | phydev_err(phydev, "Delay %d is out of range\n", delay); | |
2787 | return -EINVAL; | |
2788 | } | |
2789 | ||
2790 | if (delay == delay_values[0]) | |
2791 | return 0; | |
2792 | ||
2793 | for (i = 1; i < size; i++) { | |
2794 | if (delay == delay_values[i]) | |
2795 | return i; | |
2796 | ||
2797 | /* Find an approximate index by looking up the table */ | |
2798 | if (delay > delay_values[i - 1] && | |
2799 | delay < delay_values[i]) { | |
2800 | if (delay - delay_values[i - 1] < | |
2801 | delay_values[i] - delay) | |
2802 | return i - 1; | |
2803 | else | |
2804 | return i; | |
2805 | } | |
2806 | } | |
2807 | ||
2808 | phydev_err(phydev, "error finding internal delay index for %d\n", | |
2809 | delay); | |
2810 | ||
2811 | return -EINVAL; | |
2812 | } | |
2813 | EXPORT_SYMBOL(phy_get_internal_delay); | |
2814 | ||
0d2e778e HK |
2815 | static bool phy_drv_supports_irq(struct phy_driver *phydrv) |
2816 | { | |
6527b938 | 2817 | return phydrv->config_intr && phydrv->handle_interrupt; |
0d2e778e HK |
2818 | } |
2819 | ||
b3df0da8 RD |
2820 | /** |
2821 | * phy_probe - probe and init a PHY device | |
2822 | * @dev: device to probe and init | |
00db8189 | 2823 | * |
b3df0da8 | 2824 | * Description: Take care of setting up the phy_device structure, |
00db8189 AF |
2825 | * set the state to READY (the driver's init function should |
2826 | * set it to STARTING if needed). | |
2827 | */ | |
2828 | static int phy_probe(struct device *dev) | |
2829 | { | |
553fe92b | 2830 | struct phy_device *phydev = to_phy_device(dev); |
e5a03bfd | 2831 | struct device_driver *drv = phydev->mdio.dev.driver; |
553fe92b | 2832 | struct phy_driver *phydrv = to_phy_driver(drv); |
00db8189 AF |
2833 | int err = 0; |
2834 | ||
00db8189 AF |
2835 | phydev->drv = phydrv; |
2836 | ||
2c7b4921 FF |
2837 | /* Disable the interrupt if the PHY doesn't support it |
2838 | * but the interrupt is still a valid one | |
2839 | */ | |
0d2e778e | 2840 | if (!phy_drv_supports_irq(phydrv) && phy_interrupt_is_valid(phydev)) |
00db8189 AF |
2841 | phydev->irq = PHY_POLL; |
2842 | ||
4284b6a5 FF |
2843 | if (phydrv->flags & PHY_IS_INTERNAL) |
2844 | phydev->is_internal = true; | |
2845 | ||
35b5f6b1 | 2846 | mutex_lock(&phydev->lock); |
00db8189 | 2847 | |
1dba6995 BG |
2848 | /* Deassert the reset signal */ |
2849 | phy_device_reset(phydev, 0); | |
92ed2eb7 | 2850 | |
1dba6995 | 2851 | if (phydev->drv->probe) { |
92ed2eb7 | 2852 | err = phydev->drv->probe(phydev); |
1dba6995 | 2853 | if (err) |
92ed2eb7 | 2854 | goto out; |
92ed2eb7 AL |
2855 | } |
2856 | ||
00db8189 AF |
2857 | /* Start out supporting everything. Eventually, |
2858 | * a controller will attach, and may modify one | |
2f53e904 SS |
2859 | * or both of these values |
2860 | */ | |
efbdfdc2 AL |
2861 | if (phydrv->features) { |
2862 | linkmode_copy(phydev->supported, phydrv->features); | |
a1deab17 | 2863 | } else if (phydrv->get_features) { |
efbdfdc2 | 2864 | err = phydrv->get_features(phydev); |
a1deab17 HK |
2865 | } else if (phydev->is_c45) { |
2866 | err = genphy_c45_pma_read_abilities(phydev); | |
2867 | } else { | |
2868 | err = genphy_read_abilities(phydev); | |
efbdfdc2 AL |
2869 | } |
2870 | ||
a1deab17 HK |
2871 | if (err) |
2872 | goto out; | |
2873 | ||
5e42574b HK |
2874 | if (!linkmode_test_bit(ETHTOOL_LINK_MODE_Autoneg_BIT, |
2875 | phydev->supported)) | |
2876 | phydev->autoneg = 0; | |
2877 | ||
3b8b11f9 HK |
2878 | if (linkmode_test_bit(ETHTOOL_LINK_MODE_1000baseT_Half_BIT, |
2879 | phydev->supported)) | |
2880 | phydev->is_gigabit_capable = 1; | |
2881 | if (linkmode_test_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT, | |
2882 | phydev->supported)) | |
2883 | phydev->is_gigabit_capable = 1; | |
2884 | ||
de906af1 | 2885 | of_set_phy_supported(phydev); |
22c0ef6b | 2886 | phy_advertise_supported(phydev); |
00db8189 | 2887 | |
d853d145 | 2888 | /* Get the EEE modes we want to prohibit. We will ask |
2889 | * the PHY stop advertising these mode later on | |
2890 | */ | |
2891 | of_set_phy_eee_broken(phydev); | |
2892 | ||
529ed127 TT |
2893 | /* The Pause Frame bits indicate that the PHY can support passing |
2894 | * pause frames. During autonegotiation, the PHYs will determine if | |
2895 | * they should allow pause frames to pass. The MAC driver should then | |
2896 | * use that result to determine whether to enable flow control via | |
2897 | * pause frames. | |
2898 | * | |
2899 | * Normally, PHY drivers should not set the Pause bits, and instead | |
2900 | * allow phylib to do that. However, there may be some situations | |
2901 | * (e.g. hardware erratum) where the driver wants to set only one | |
2902 | * of these bits. | |
2903 | */ | |
efbdfdc2 AL |
2904 | if (!test_bit(ETHTOOL_LINK_MODE_Pause_BIT, phydev->supported) && |
2905 | !test_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, phydev->supported)) { | |
3c1bcc86 AL |
2906 | linkmode_set_bit(ETHTOOL_LINK_MODE_Pause_BIT, |
2907 | phydev->supported); | |
2908 | linkmode_set_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, | |
2909 | phydev->supported); | |
529ed127 TT |
2910 | } |
2911 | ||
00db8189 AF |
2912 | /* Set the state to READY by default */ |
2913 | phydev->state = PHY_READY; | |
2914 | ||
92ed2eb7 | 2915 | out: |
1dba6995 BG |
2916 | /* Assert the reset signal */ |
2917 | if (err) | |
2918 | phy_device_reset(phydev, 1); | |
2919 | ||
35b5f6b1 | 2920 | mutex_unlock(&phydev->lock); |
00db8189 | 2921 | |
00db8189 AF |
2922 | return err; |
2923 | } | |
2924 | ||
2925 | static int phy_remove(struct device *dev) | |
2926 | { | |
553fe92b | 2927 | struct phy_device *phydev = to_phy_device(dev); |
00db8189 | 2928 | |
7b9a88a3 FF |
2929 | cancel_delayed_work_sync(&phydev->state_queue); |
2930 | ||
35b5f6b1 | 2931 | mutex_lock(&phydev->lock); |
00db8189 | 2932 | phydev->state = PHY_DOWN; |
35b5f6b1 | 2933 | mutex_unlock(&phydev->lock); |
00db8189 | 2934 | |
298e54fa RK |
2935 | sfp_bus_del_upstream(phydev->sfp_bus); |
2936 | phydev->sfp_bus = NULL; | |
2937 | ||
1dba6995 | 2938 | if (phydev->drv && phydev->drv->remove) |
00db8189 | 2939 | phydev->drv->remove(phydev); |
bafbdd52 | 2940 | |
1dba6995 BG |
2941 | /* Assert the reset signal */ |
2942 | phy_device_reset(phydev, 1); | |
2943 | ||
00db8189 AF |
2944 | phydev->drv = NULL; |
2945 | ||
2946 | return 0; | |
2947 | } | |
2948 | ||
e2f016cf IC |
2949 | static void phy_shutdown(struct device *dev) |
2950 | { | |
2951 | struct phy_device *phydev = to_phy_device(dev); | |
2952 | ||
2953 | phy_disable_interrupts(phydev); | |
2954 | } | |
2955 | ||
b3df0da8 RD |
2956 | /** |
2957 | * phy_driver_register - register a phy_driver with the PHY layer | |
2958 | * @new_driver: new phy_driver to register | |
be01da72 | 2959 | * @owner: module owning this PHY |
b3df0da8 | 2960 | */ |
be01da72 | 2961 | int phy_driver_register(struct phy_driver *new_driver, struct module *owner) |
00db8189 AF |
2962 | { |
2963 | int retval; | |
2964 | ||
efbdfdc2 | 2965 | /* Either the features are hard coded, or dynamically |
a1deab17 | 2966 | * determined. It cannot be both. |
efbdfdc2 | 2967 | */ |
a1deab17 HK |
2968 | if (WARN_ON(new_driver->features && new_driver->get_features)) { |
2969 | pr_err("%s: features and get_features must not both be set\n", | |
2970 | new_driver->name); | |
3e64cf7a CG |
2971 | return -EINVAL; |
2972 | } | |
2973 | ||
a9049e0c AL |
2974 | new_driver->mdiodrv.flags |= MDIO_DEVICE_IS_PHY; |
2975 | new_driver->mdiodrv.driver.name = new_driver->name; | |
2976 | new_driver->mdiodrv.driver.bus = &mdio_bus_type; | |
2977 | new_driver->mdiodrv.driver.probe = phy_probe; | |
2978 | new_driver->mdiodrv.driver.remove = phy_remove; | |
e2f016cf | 2979 | new_driver->mdiodrv.driver.shutdown = phy_shutdown; |
a9049e0c | 2980 | new_driver->mdiodrv.driver.owner = owner; |
16983507 | 2981 | new_driver->mdiodrv.driver.probe_type = PROBE_FORCE_SYNCHRONOUS; |
00db8189 | 2982 | |
a9049e0c | 2983 | retval = driver_register(&new_driver->mdiodrv.driver); |
00db8189 | 2984 | if (retval) { |
8d242488 JP |
2985 | pr_err("%s: Error %d in registering driver\n", |
2986 | new_driver->name, retval); | |
00db8189 AF |
2987 | |
2988 | return retval; | |
2989 | } | |
2990 | ||
f2511f13 | 2991 | pr_debug("%s: Registered new driver\n", new_driver->name); |
00db8189 AF |
2992 | |
2993 | return 0; | |
2994 | } | |
2995 | EXPORT_SYMBOL(phy_driver_register); | |
2996 | ||
be01da72 AL |
2997 | int phy_drivers_register(struct phy_driver *new_driver, int n, |
2998 | struct module *owner) | |
d5bf9071 CH |
2999 | { |
3000 | int i, ret = 0; | |
3001 | ||
3002 | for (i = 0; i < n; i++) { | |
be01da72 | 3003 | ret = phy_driver_register(new_driver + i, owner); |
d5bf9071 CH |
3004 | if (ret) { |
3005 | while (i-- > 0) | |
3006 | phy_driver_unregister(new_driver + i); | |
3007 | break; | |
3008 | } | |
3009 | } | |
3010 | return ret; | |
3011 | } | |
3012 | EXPORT_SYMBOL(phy_drivers_register); | |
3013 | ||
00db8189 AF |
3014 | void phy_driver_unregister(struct phy_driver *drv) |
3015 | { | |
a9049e0c | 3016 | driver_unregister(&drv->mdiodrv.driver); |
00db8189 AF |
3017 | } |
3018 | EXPORT_SYMBOL(phy_driver_unregister); | |
3019 | ||
d5bf9071 CH |
3020 | void phy_drivers_unregister(struct phy_driver *drv, int n) |
3021 | { | |
3022 | int i; | |
2f53e904 SS |
3023 | |
3024 | for (i = 0; i < n; i++) | |
d5bf9071 | 3025 | phy_driver_unregister(drv + i); |
d5bf9071 CH |
3026 | } |
3027 | EXPORT_SYMBOL(phy_drivers_unregister); | |
3028 | ||
921690f2 | 3029 | static struct phy_driver genphy_driver = { |
e1393456 AF |
3030 | .phy_id = 0xffffffff, |
3031 | .phy_id_mask = 0xffffffff, | |
3032 | .name = "Generic PHY", | |
2a4d8674 | 3033 | .get_features = genphy_read_abilities, |
0f0ca340 GC |
3034 | .suspend = genphy_suspend, |
3035 | .resume = genphy_resume, | |
f0f9b4ed | 3036 | .set_loopback = genphy_loopback, |
921690f2 | 3037 | }; |
00db8189 | 3038 | |
55d8f053 | 3039 | static const struct ethtool_phy_ops phy_ethtool_phy_ops = { |
bd36ed1c FF |
3040 | .get_sset_count = phy_ethtool_get_sset_count, |
3041 | .get_strings = phy_ethtool_get_strings, | |
3042 | .get_stats = phy_ethtool_get_stats, | |
55d8f053 FF |
3043 | .start_cable_test = phy_start_cable_test, |
3044 | .start_cable_test_tdr = phy_start_cable_test_tdr, | |
3045 | }; | |
3046 | ||
67c4f3fa | 3047 | static int __init phy_init(void) |
00db8189 | 3048 | { |
67c4f3fa | 3049 | int rc; |
67c4f3fa JG |
3050 | |
3051 | rc = mdio_bus_init(); | |
3052 | if (rc) | |
e1393456 | 3053 | return rc; |
00db8189 | 3054 | |
55d8f053 | 3055 | ethtool_set_ethtool_phy_ops(&phy_ethtool_phy_ops); |
719655a1 AL |
3056 | features_init(); |
3057 | ||
22b56e82 | 3058 | rc = phy_driver_register(&genphy_c45_driver, THIS_MODULE); |
e1393456 | 3059 | if (rc) |
22b56e82 | 3060 | goto err_c45; |
921690f2 RK |
3061 | |
3062 | rc = phy_driver_register(&genphy_driver, THIS_MODULE); | |
3063 | if (rc) { | |
22b56e82 HK |
3064 | phy_driver_unregister(&genphy_c45_driver); |
3065 | err_c45: | |
e1393456 | 3066 | mdio_bus_exit(); |
921690f2 | 3067 | } |
67c4f3fa | 3068 | |
67c4f3fa | 3069 | return rc; |
00db8189 AF |
3070 | } |
3071 | ||
67c4f3fa | 3072 | static void __exit phy_exit(void) |
00db8189 | 3073 | { |
22b56e82 | 3074 | phy_driver_unregister(&genphy_c45_driver); |
921690f2 | 3075 | phy_driver_unregister(&genphy_driver); |
e1393456 | 3076 | mdio_bus_exit(); |
55d8f053 | 3077 | ethtool_set_ethtool_phy_ops(NULL); |
00db8189 AF |
3078 | } |
3079 | ||
e1393456 | 3080 | subsys_initcall(phy_init); |
67c4f3fa | 3081 | module_exit(phy_exit); |