1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * mdio-boardinfo - Collect pre-declarations for MDIO devices
4 */
5
6 #include <linux/export.h>
7 #include <linux/kernel.h>
8 #include <linux/list.h>
9 #include <linux/mutex.h>
10 #include <linux/phy.h>
11 #include <linux/slab.h>
12
13 #include "mdio-boardinfo.h"
14
15 static LIST_HEAD(mdio_board_list);
16 static DEFINE_MUTEX(mdio_board_lock);
17
18 struct mdio_board_entry {
19 struct list_head list;
20 struct mdio_board_info board_info;
21 };
22
23 /**
24 * mdiobus_setup_mdiodev_from_board_info - create and setup MDIO devices
25 * from pre-collected board specific MDIO information
26 * @bus: Bus the board_info belongs to
27 * @cb: Callback to create device on bus
28 * Context: can sleep
29 */
mdiobus_setup_mdiodev_from_board_info(struct mii_bus * bus,int (* cb)(struct mii_bus * bus,struct mdio_board_info * bi))30 void mdiobus_setup_mdiodev_from_board_info(struct mii_bus *bus,
31 int (*cb)
32 (struct mii_bus *bus,
33 struct mdio_board_info *bi))
34 {
35 struct mdio_board_entry *be, *tmp;
36
37 mutex_lock(&mdio_board_lock);
38 list_for_each_entry_safe(be, tmp, &mdio_board_list, list) {
39 struct mdio_board_info *bi = &be->board_info;
40
41 if (strcmp(bus->id, bi->bus_id))
42 continue;
43
44 mutex_unlock(&mdio_board_lock);
45 cb(bus, bi);
46 mutex_lock(&mdio_board_lock);
47 }
48 mutex_unlock(&mdio_board_lock);
49 }
50 EXPORT_SYMBOL(mdiobus_setup_mdiodev_from_board_info);
51
52 /**
53 * mdiobus_register_board_info - register MDIO devices for a given board
54 * @info: array of devices descriptors
55 * @n: number of descriptors provided
56 * Context: can sleep
57 *
58 * The board info passed can be marked with __initdata but be pointers
59 * such as platform_data etc. are copied as-is
60 */
mdiobus_register_board_info(const struct mdio_board_info * info,unsigned int n)61 int mdiobus_register_board_info(const struct mdio_board_info *info,
62 unsigned int n)
63 {
64 struct mdio_board_entry *be;
65
66 be = kcalloc(n, sizeof(*be), GFP_KERNEL);
67 if (!be)
68 return -ENOMEM;
69
70 for (int i = 0; i < n; i++, be++) {
71 be->board_info = info[i];
72 mutex_lock(&mdio_board_lock);
73 list_add_tail(&be->list, &mdio_board_list);
74 mutex_unlock(&mdio_board_lock);
75 }
76
77 return 0;
78 }
79 EXPORT_SYMBOL(mdiobus_register_board_info);
80