1
2
3
4
5
6#include <linux/kernel.h>
7#include <linux/slab.h>
8#include <linux/export.h>
9#include <linux/mutex.h>
10#include <linux/list.h>
11
12#include "mdio-boardinfo.h"
13
14static LIST_HEAD(mdio_board_list);
15static DEFINE_MUTEX(mdio_board_lock);
16
17
18
19
20
21
22
23
24void mdiobus_setup_mdiodev_from_board_info(struct mii_bus *bus,
25 int (*cb)
26 (struct mii_bus *bus,
27 struct mdio_board_info *bi))
28{
29 struct mdio_board_entry *be;
30 struct mdio_board_entry *tmp;
31 struct mdio_board_info *bi;
32 int ret;
33
34 mutex_lock(&mdio_board_lock);
35 list_for_each_entry_safe(be, tmp, &mdio_board_list, list) {
36 bi = &be->board_info;
37
38 if (strcmp(bus->id, bi->bus_id))
39 continue;
40
41 mutex_unlock(&mdio_board_lock);
42 ret = cb(bus, bi);
43 mutex_lock(&mdio_board_lock);
44 if (ret)
45 continue;
46
47 }
48 mutex_unlock(&mdio_board_lock);
49}
50EXPORT_SYMBOL(mdiobus_setup_mdiodev_from_board_info);
51
52
53
54
55
56
57
58
59
60
61int mdiobus_register_board_info(const struct mdio_board_info *info,
62 unsigned int n)
63{
64 struct mdio_board_entry *be;
65 unsigned int i;
66
67 be = kcalloc(n, sizeof(*be), GFP_KERNEL);
68 if (!be)
69 return -ENOMEM;
70
71 for (i = 0; i < n; i++, be++, info++) {
72 memcpy(&be->board_info, info, sizeof(*info));
73 mutex_lock(&mdio_board_lock);
74 list_add_tail(&be->list, &mdio_board_list);
75 mutex_unlock(&mdio_board_lock);
76 }
77
78 return 0;
79}
80EXPORT_SYMBOL(mdiobus_register_board_info);
81