|
1 | 1 | // SPDX-License-Identifier: GPL-2.0-or-later
|
2 | 2 |
|
| 3 | +#include <linux/device.h> |
3 | 4 | #include <linux/phy.h>
|
| 5 | +#include <linux/stddef.h> |
| 6 | + |
| 7 | +struct mdiobus_devres { |
| 8 | + struct mii_bus *mii; |
| 9 | +}; |
| 10 | + |
| 11 | +static void devm_mdiobus_free(struct device *dev, void *this) |
| 12 | +{ |
| 13 | + struct mdiobus_devres *dr = this; |
| 14 | + |
| 15 | + mdiobus_free(dr->mii); |
| 16 | +} |
| 17 | + |
| 18 | +/** |
| 19 | + * devm_mdiobus_alloc_size - Resource-managed mdiobus_alloc_size() |
| 20 | + * @dev: Device to allocate mii_bus for |
| 21 | + * @sizeof_priv: Space to allocate for private structure |
| 22 | + * |
| 23 | + * Managed mdiobus_alloc_size. mii_bus allocated with this function is |
| 24 | + * automatically freed on driver detach. |
| 25 | + * |
| 26 | + * RETURNS: |
| 27 | + * Pointer to allocated mii_bus on success, NULL on out-of-memory error. |
| 28 | + */ |
| 29 | +struct mii_bus *devm_mdiobus_alloc_size(struct device *dev, int sizeof_priv) |
| 30 | +{ |
| 31 | + struct mdiobus_devres *dr; |
| 32 | + |
| 33 | + dr = devres_alloc(devm_mdiobus_free, sizeof(*dr), GFP_KERNEL); |
| 34 | + if (!dr) |
| 35 | + return NULL; |
| 36 | + |
| 37 | + dr->mii = mdiobus_alloc_size(sizeof_priv); |
| 38 | + if (!dr->mii) { |
| 39 | + devres_free(dr); |
| 40 | + return NULL; |
| 41 | + } |
| 42 | + |
| 43 | + devres_add(dev, dr); |
| 44 | + return dr->mii; |
| 45 | +} |
| 46 | +EXPORT_SYMBOL(devm_mdiobus_alloc_size); |
| 47 | + |
| 48 | +static void devm_mdiobus_unregister(struct device *dev, void *this) |
| 49 | +{ |
| 50 | + struct mdiobus_devres *dr = this; |
| 51 | + |
| 52 | + mdiobus_unregister(dr->mii); |
| 53 | +} |
| 54 | + |
| 55 | +static int mdiobus_devres_match(struct device *dev, |
| 56 | + void *this, void *match_data) |
| 57 | +{ |
| 58 | + struct mdiobus_devres *res = this; |
| 59 | + struct mii_bus *mii = match_data; |
| 60 | + |
| 61 | + return mii == res->mii; |
| 62 | +} |
4 | 63 |
|
5 | 64 | /**
|
6 | 65 | * __devm_mdiobus_register - Resource-managed variant of mdiobus_register()
|
| 66 | + * @dev: Device to register mii_bus for |
7 | 67 | * @bus: MII bus structure to register
|
8 | 68 | * @owner: Owning module
|
9 | 69 | *
|
10 | 70 | * Returns 0 on success, negative error number on failure.
|
11 | 71 | */
|
12 |
| -int __devm_mdiobus_register(struct mii_bus *bus, struct module *owner) |
| 72 | +int __devm_mdiobus_register(struct device *dev, struct mii_bus *bus, |
| 73 | + struct module *owner) |
13 | 74 | {
|
| 75 | + struct mdiobus_devres *dr; |
14 | 76 | int ret;
|
15 | 77 |
|
16 |
| - if (!bus->is_managed) |
17 |
| - return -EPERM; |
| 78 | + if (WARN_ON(!devres_find(dev, devm_mdiobus_free, |
| 79 | + mdiobus_devres_match, bus))) |
| 80 | + return -EINVAL; |
| 81 | + |
| 82 | + dr = devres_alloc(devm_mdiobus_unregister, sizeof(*dr), GFP_KERNEL); |
| 83 | + if (!dr) |
| 84 | + return -ENOMEM; |
18 | 85 |
|
19 | 86 | ret = __mdiobus_register(bus, owner);
|
20 |
| - if (!ret) |
21 |
| - bus->is_managed_registered = 1; |
| 87 | + if (ret) { |
| 88 | + devres_free(dr); |
| 89 | + return ret; |
| 90 | + } |
22 | 91 |
|
23 |
| - return ret; |
| 92 | + dr->mii = bus; |
| 93 | + devres_add(dev, dr); |
| 94 | + return 0; |
24 | 95 | }
|
25 | 96 | EXPORT_SYMBOL(__devm_mdiobus_register);
|
0 commit comments