1
2
3
4
5
6
7#include <linux/etherdevice.h>
8#include <linux/kernel.h>
9#include <linux/of_net.h>
10#include <linux/of_platform.h>
11#include <linux/phy.h>
12#include <linux/export.h>
13#include <linux/device.h>
14#include <linux/nvmem-consumer.h>
15
16
17
18
19
20
21
22
23
24
25
26int of_get_phy_mode(struct device_node *np, phy_interface_t *interface)
27{
28 const char *pm;
29 int err, i;
30
31 *interface = PHY_INTERFACE_MODE_NA;
32
33 err = of_property_read_string(np, "phy-mode", &pm);
34 if (err < 0)
35 err = of_property_read_string(np, "phy-connection-type", &pm);
36 if (err < 0)
37 return err;
38
39 for (i = 0; i < PHY_INTERFACE_MODE_MAX; i++)
40 if (!strcasecmp(pm, phy_modes(i))) {
41 *interface = i;
42 return 0;
43 }
44
45 return -ENODEV;
46}
47EXPORT_SYMBOL_GPL(of_get_phy_mode);
48
49static int of_get_mac_addr(struct device_node *np, const char *name, u8 *addr)
50{
51 struct property *pp = of_find_property(np, name, NULL);
52
53 if (pp && pp->length == ETH_ALEN && is_valid_ether_addr(pp->value)) {
54 memcpy(addr, pp->value, ETH_ALEN);
55 return 0;
56 }
57 return -ENODEV;
58}
59
60static int of_get_mac_addr_nvmem(struct device_node *np, u8 *addr)
61{
62 struct platform_device *pdev = of_find_device_by_node(np);
63 struct nvmem_cell *cell;
64 const void *mac;
65 size_t len;
66 int ret;
67
68
69
70
71 if (pdev) {
72 ret = nvmem_get_mac_address(&pdev->dev, addr);
73 put_device(&pdev->dev);
74 return ret;
75 }
76
77 cell = of_nvmem_cell_get(np, "mac-address");
78 if (IS_ERR(cell))
79 return PTR_ERR(cell);
80
81 mac = nvmem_cell_read(cell, &len);
82 nvmem_cell_put(cell);
83
84 if (IS_ERR(mac))
85 return PTR_ERR(mac);
86
87 if (len != ETH_ALEN || !is_valid_ether_addr(mac)) {
88 kfree(mac);
89 return -EINVAL;
90 }
91
92 memcpy(addr, mac, ETH_ALEN);
93 kfree(mac);
94
95 return 0;
96}
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124int of_get_mac_address(struct device_node *np, u8 *addr)
125{
126 int ret;
127
128 if (!np)
129 return -ENODEV;
130
131 ret = of_get_mac_addr(np, "mac-address", addr);
132 if (!ret)
133 return 0;
134
135 ret = of_get_mac_addr(np, "local-mac-address", addr);
136 if (!ret)
137 return 0;
138
139 ret = of_get_mac_addr(np, "address", addr);
140 if (!ret)
141 return 0;
142
143 return of_get_mac_addr_nvmem(np, addr);
144}
145EXPORT_SYMBOL(of_get_mac_address);
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160int of_get_ethdev_address(struct device_node *np, struct net_device *dev)
161{
162 u8 addr[ETH_ALEN];
163 int ret;
164
165 ret = of_get_mac_address(np, addr);
166 if (!ret)
167 eth_hw_addr_set(dev, addr);
168 return ret;
169}
170EXPORT_SYMBOL(of_get_ethdev_address);
171