Commit | Line | Data |
---|---|---|
2b27bdcc | 1 | // SPDX-License-Identifier: GPL-2.0-only |
f8ff6028 RDC |
2 | /* |
3 | * File: pn_dev.c | |
4 | * | |
5 | * Phonet network device | |
6 | * | |
7 | * Copyright (C) 2008 Nokia Corporation. | |
8 | * | |
31fdc555 RDC |
9 | * Authors: Sakari Ailus <sakari.ailus@nokia.com> |
10 | * Rémi Denis-Courmont | |
f8ff6028 RDC |
11 | */ |
12 | ||
13 | #include <linux/kernel.h> | |
14 | #include <linux/net.h> | |
5a0e3ad6 | 15 | #include <linux/slab.h> |
f8ff6028 RDC |
16 | #include <linux/netdevice.h> |
17 | #include <linux/phonet.h> | |
421d20a3 | 18 | #include <linux/proc_fs.h> |
f5bb1c55 | 19 | #include <linux/if_arp.h> |
f8ff6028 | 20 | #include <net/sock.h> |
9a3b7a42 | 21 | #include <net/netns/generic.h> |
f8ff6028 RDC |
22 | #include <net/phonet/pn_dev.h> |
23 | ||
55748ac0 | 24 | struct phonet_routes { |
88880135 | 25 | struct mutex lock; |
79952bca | 26 | struct net_device __rcu *table[64]; |
55748ac0 RDC |
27 | }; |
28 | ||
9a3b7a42 | 29 | struct phonet_net { |
30 | struct phonet_device_list pndevs; | |
55748ac0 | 31 | struct phonet_routes routes; |
f8ff6028 RDC |
32 | }; |
33 | ||
c7d03a00 | 34 | static unsigned int phonet_net_id __read_mostly; |
9a3b7a42 | 35 | |
0db3f0f4 JP |
36 | static struct phonet_net *phonet_pernet(struct net *net) |
37 | { | |
38 | BUG_ON(!net); | |
39 | ||
40 | return net_generic(net, phonet_net_id); | |
41 | } | |
42 | ||
9a3b7a42 | 43 | struct phonet_device_list *phonet_device_list(struct net *net) |
44 | { | |
0db3f0f4 | 45 | struct phonet_net *pnn = phonet_pernet(net); |
9a3b7a42 | 46 | return &pnn->pndevs; |
47 | } | |
48 | ||
f8ff6028 RDC |
49 | /* Allocate new Phonet device. */ |
50 | static struct phonet_device *__phonet_device_alloc(struct net_device *dev) | |
51 | { | |
9a3b7a42 | 52 | struct phonet_device_list *pndevs = phonet_device_list(dev_net(dev)); |
f8ff6028 RDC |
53 | struct phonet_device *pnd = kmalloc(sizeof(*pnd), GFP_ATOMIC); |
54 | if (pnd == NULL) | |
55 | return NULL; | |
56 | pnd->netdev = dev; | |
57 | bitmap_zero(pnd->addrs, 64); | |
58 | ||
eeb74a9d RDC |
59 | BUG_ON(!mutex_is_locked(&pndevs->lock)); |
60 | list_add_rcu(&pnd->list, &pndevs->list); | |
f8ff6028 RDC |
61 | return pnd; |
62 | } | |
63 | ||
64 | static struct phonet_device *__phonet_get(struct net_device *dev) | |
65 | { | |
9a3b7a42 | 66 | struct phonet_device_list *pndevs = phonet_device_list(dev_net(dev)); |
f8ff6028 RDC |
67 | struct phonet_device *pnd; |
68 | ||
eeb74a9d | 69 | BUG_ON(!mutex_is_locked(&pndevs->lock)); |
9a3b7a42 | 70 | list_for_each_entry(pnd, &pndevs->list, list) { |
f8ff6028 RDC |
71 | if (pnd->netdev == dev) |
72 | return pnd; | |
73 | } | |
74 | return NULL; | |
75 | } | |
76 | ||
eeb74a9d RDC |
77 | static struct phonet_device *__phonet_get_rcu(struct net_device *dev) |
78 | { | |
79 | struct phonet_device_list *pndevs = phonet_device_list(dev_net(dev)); | |
80 | struct phonet_device *pnd; | |
81 | ||
82 | list_for_each_entry_rcu(pnd, &pndevs->list, list) { | |
83 | if (pnd->netdev == dev) | |
84 | return pnd; | |
85 | } | |
86 | return NULL; | |
87 | } | |
88 | ||
2be6fa4c | 89 | static void phonet_device_destroy(struct net_device *dev) |
f8ff6028 | 90 | { |
2be6fa4c RDC |
91 | struct phonet_device_list *pndevs = phonet_device_list(dev_net(dev)); |
92 | struct phonet_device *pnd; | |
93 | ||
94 | ASSERT_RTNL(); | |
95 | ||
eeb74a9d | 96 | mutex_lock(&pndevs->lock); |
2be6fa4c RDC |
97 | pnd = __phonet_get(dev); |
98 | if (pnd) | |
eeb74a9d RDC |
99 | list_del_rcu(&pnd->list); |
100 | mutex_unlock(&pndevs->lock); | |
2be6fa4c RDC |
101 | |
102 | if (pnd) { | |
103 | u8 addr; | |
104 | ||
a1ca14ac | 105 | for_each_set_bit(addr, pnd->addrs, 64) |
2be6fa4c RDC |
106 | phonet_address_notify(RTM_DELADDR, dev, addr); |
107 | kfree(pnd); | |
108 | } | |
f8ff6028 RDC |
109 | } |
110 | ||
111 | struct net_device *phonet_device_get(struct net *net) | |
112 | { | |
9a3b7a42 | 113 | struct phonet_device_list *pndevs = phonet_device_list(net); |
f8ff6028 | 114 | struct phonet_device *pnd; |
59e57f44 | 115 | struct net_device *dev = NULL; |
f8ff6028 | 116 | |
eeb74a9d RDC |
117 | rcu_read_lock(); |
118 | list_for_each_entry_rcu(pnd, &pndevs->list, list) { | |
f8ff6028 RDC |
119 | dev = pnd->netdev; |
120 | BUG_ON(!dev); | |
121 | ||
9a3b7a42 | 122 | if ((dev->reg_state == NETREG_REGISTERED) && |
f8ff6028 RDC |
123 | ((pnd->netdev->flags & IFF_UP)) == IFF_UP) |
124 | break; | |
125 | dev = NULL; | |
126 | } | |
127 | if (dev) | |
128 | dev_hold(dev); | |
eeb74a9d | 129 | rcu_read_unlock(); |
f8ff6028 RDC |
130 | return dev; |
131 | } | |
132 | ||
133 | int phonet_address_add(struct net_device *dev, u8 addr) | |
134 | { | |
9a3b7a42 | 135 | struct phonet_device_list *pndevs = phonet_device_list(dev_net(dev)); |
f8ff6028 RDC |
136 | struct phonet_device *pnd; |
137 | int err = 0; | |
138 | ||
eeb74a9d | 139 | mutex_lock(&pndevs->lock); |
f8ff6028 RDC |
140 | /* Find or create Phonet-specific device data */ |
141 | pnd = __phonet_get(dev); | |
142 | if (pnd == NULL) | |
143 | pnd = __phonet_device_alloc(dev); | |
144 | if (unlikely(pnd == NULL)) | |
145 | err = -ENOMEM; | |
146 | else if (test_and_set_bit(addr >> 2, pnd->addrs)) | |
147 | err = -EEXIST; | |
eeb74a9d | 148 | mutex_unlock(&pndevs->lock); |
f8ff6028 RDC |
149 | return err; |
150 | } | |
151 | ||
152 | int phonet_address_del(struct net_device *dev, u8 addr) | |
153 | { | |
9a3b7a42 | 154 | struct phonet_device_list *pndevs = phonet_device_list(dev_net(dev)); |
f8ff6028 RDC |
155 | struct phonet_device *pnd; |
156 | int err = 0; | |
157 | ||
eeb74a9d | 158 | mutex_lock(&pndevs->lock); |
f8ff6028 | 159 | pnd = __phonet_get(dev); |
eeb74a9d | 160 | if (!pnd || !test_and_clear_bit(addr >> 2, pnd->addrs)) { |
f8ff6028 | 161 | err = -EADDRNOTAVAIL; |
eeb74a9d RDC |
162 | pnd = NULL; |
163 | } else if (bitmap_empty(pnd->addrs, 64)) | |
164 | list_del_rcu(&pnd->list); | |
165 | else | |
166 | pnd = NULL; | |
167 | mutex_unlock(&pndevs->lock); | |
168 | ||
88e7594a | 169 | if (pnd) |
7e113a9c | 170 | kfree_rcu(pnd, rcu); |
88e7594a | 171 | |
f8ff6028 RDC |
172 | return err; |
173 | } | |
174 | ||
175 | /* Gets a source address toward a destination, through a interface. */ | |
55748ac0 | 176 | u8 phonet_address_get(struct net_device *dev, u8 daddr) |
f8ff6028 RDC |
177 | { |
178 | struct phonet_device *pnd; | |
55748ac0 | 179 | u8 saddr; |
f8ff6028 | 180 | |
eeb74a9d RDC |
181 | rcu_read_lock(); |
182 | pnd = __phonet_get_rcu(dev); | |
f8ff6028 RDC |
183 | if (pnd) { |
184 | BUG_ON(bitmap_empty(pnd->addrs, 64)); | |
185 | ||
186 | /* Use same source address as destination, if possible */ | |
55748ac0 RDC |
187 | if (test_bit(daddr >> 2, pnd->addrs)) |
188 | saddr = daddr; | |
189 | else | |
190 | saddr = find_first_bit(pnd->addrs, 64) << 2; | |
f8ff6028 | 191 | } else |
55748ac0 | 192 | saddr = PN_NO_ADDR; |
eeb74a9d | 193 | rcu_read_unlock(); |
55748ac0 RDC |
194 | |
195 | if (saddr == PN_NO_ADDR) { | |
196 | /* Fallback to another device */ | |
197 | struct net_device *def_dev; | |
198 | ||
199 | def_dev = phonet_device_get(dev_net(dev)); | |
200 | if (def_dev) { | |
201 | if (def_dev != dev) | |
202 | saddr = phonet_address_get(def_dev, daddr); | |
203 | dev_put(def_dev); | |
204 | } | |
205 | } | |
206 | return saddr; | |
f8ff6028 RDC |
207 | } |
208 | ||
52404881 | 209 | int phonet_address_lookup(struct net *net, u8 addr) |
f8ff6028 | 210 | { |
9a3b7a42 | 211 | struct phonet_device_list *pndevs = phonet_device_list(net); |
f8ff6028 | 212 | struct phonet_device *pnd; |
9a3b7a42 | 213 | int err = -EADDRNOTAVAIL; |
f8ff6028 | 214 | |
eeb74a9d RDC |
215 | rcu_read_lock(); |
216 | list_for_each_entry_rcu(pnd, &pndevs->list, list) { | |
f8ff6028 RDC |
217 | /* Don't allow unregistering devices! */ |
218 | if ((pnd->netdev->reg_state != NETREG_REGISTERED) || | |
219 | ((pnd->netdev->flags & IFF_UP)) != IFF_UP) | |
220 | continue; | |
221 | ||
222 | if (test_bit(addr >> 2, pnd->addrs)) { | |
9a3b7a42 | 223 | err = 0; |
224 | goto found; | |
f8ff6028 RDC |
225 | } |
226 | } | |
9a3b7a42 | 227 | found: |
eeb74a9d | 228 | rcu_read_unlock(); |
9a3b7a42 | 229 | return err; |
f8ff6028 RDC |
230 | } |
231 | ||
f5bb1c55 RDC |
232 | /* automatically configure a Phonet device, if supported */ |
233 | static int phonet_device_autoconf(struct net_device *dev) | |
234 | { | |
235 | struct if_phonet_req req; | |
236 | int ret; | |
237 | ||
238 | if (!dev->netdev_ops->ndo_do_ioctl) | |
239 | return -EOPNOTSUPP; | |
240 | ||
241 | ret = dev->netdev_ops->ndo_do_ioctl(dev, (struct ifreq *)&req, | |
242 | SIOCPNGAUTOCONF); | |
243 | if (ret < 0) | |
244 | return ret; | |
b11b5165 RDC |
245 | |
246 | ASSERT_RTNL(); | |
247 | ret = phonet_address_add(dev, req.ifr_phonet_autoconf.device); | |
248 | if (ret) | |
249 | return ret; | |
250 | phonet_address_notify(RTM_NEWADDR, dev, | |
251 | req.ifr_phonet_autoconf.device); | |
252 | return 0; | |
f5bb1c55 RDC |
253 | } |
254 | ||
f062f41d RDC |
255 | static void phonet_route_autodel(struct net_device *dev) |
256 | { | |
0db3f0f4 | 257 | struct phonet_net *pnn = phonet_pernet(dev_net(dev)); |
95c96174 | 258 | unsigned int i; |
f062f41d RDC |
259 | DECLARE_BITMAP(deleted, 64); |
260 | ||
261 | /* Remove left-over Phonet routes */ | |
262 | bitmap_zero(deleted, 64); | |
88880135 | 263 | mutex_lock(&pnn->routes.lock); |
f062f41d | 264 | for (i = 0; i < 64; i++) |
79952bca | 265 | if (rcu_access_pointer(pnn->routes.table[i]) == dev) { |
a9b3cd7f | 266 | RCU_INIT_POINTER(pnn->routes.table[i], NULL); |
f062f41d | 267 | set_bit(i, deleted); |
f062f41d | 268 | } |
88880135 RDC |
269 | mutex_unlock(&pnn->routes.lock); |
270 | ||
271 | if (bitmap_empty(deleted, 64)) | |
272 | return; /* short-circuit RCU */ | |
273 | synchronize_rcu(); | |
6a499b24 | 274 | for_each_set_bit(i, deleted, 64) { |
f062f41d | 275 | rtm_phonet_notify(RTM_DELROUTE, dev, i); |
88880135 RDC |
276 | dev_put(dev); |
277 | } | |
f062f41d RDC |
278 | } |
279 | ||
f8ff6028 RDC |
280 | /* notify Phonet of device events */ |
281 | static int phonet_device_notify(struct notifier_block *me, unsigned long what, | |
351638e7 | 282 | void *ptr) |
f8ff6028 | 283 | { |
351638e7 | 284 | struct net_device *dev = netdev_notifier_info_to_dev(ptr); |
f8ff6028 | 285 | |
f5bb1c55 RDC |
286 | switch (what) { |
287 | case NETDEV_REGISTER: | |
288 | if (dev->type == ARPHRD_PHONET) | |
289 | phonet_device_autoconf(dev); | |
290 | break; | |
291 | case NETDEV_UNREGISTER: | |
2be6fa4c | 292 | phonet_device_destroy(dev); |
f062f41d | 293 | phonet_route_autodel(dev); |
f5bb1c55 RDC |
294 | break; |
295 | } | |
f8ff6028 RDC |
296 | return 0; |
297 | ||
298 | } | |
299 | ||
300 | static struct notifier_block phonet_device_notifier = { | |
301 | .notifier_call = phonet_device_notify, | |
302 | .priority = 0, | |
303 | }; | |
304 | ||
9a3b7a42 | 305 | /* Per-namespace Phonet devices handling */ |
2c8c1e72 | 306 | static int __net_init phonet_init_net(struct net *net) |
9a3b7a42 | 307 | { |
0db3f0f4 | 308 | struct phonet_net *pnn = phonet_pernet(net); |
9a3b7a42 | 309 | |
c3506372 CH |
310 | if (!proc_create_net("phonet", 0, net->proc_net, &pn_sock_seq_ops, |
311 | sizeof(struct seq_net_private))) | |
c1dc13e9 | 312 | return -ENOMEM; |
c1dc13e9 | 313 | |
9a3b7a42 | 314 | INIT_LIST_HEAD(&pnn->pndevs.list); |
eeb74a9d | 315 | mutex_init(&pnn->pndevs.lock); |
88880135 | 316 | mutex_init(&pnn->routes.lock); |
9a3b7a42 | 317 | return 0; |
318 | } | |
319 | ||
2c8c1e72 | 320 | static void __net_exit phonet_exit_net(struct net *net) |
9a3b7a42 | 321 | { |
ae61e8cd VA |
322 | struct phonet_net *pnn = phonet_pernet(net); |
323 | ||
ece31ffd | 324 | remove_proc_entry("phonet", net->proc_net); |
ae61e8cd | 325 | WARN_ON_ONCE(!list_empty(&pnn->pndevs.list)); |
9a3b7a42 | 326 | } |
327 | ||
328 | static struct pernet_operations phonet_net_ops = { | |
329 | .init = phonet_init_net, | |
330 | .exit = phonet_exit_net, | |
d2b3eb63 EB |
331 | .id = &phonet_net_id, |
332 | .size = sizeof(struct phonet_net), | |
9a3b7a42 | 333 | }; |
334 | ||
f8ff6028 | 335 | /* Initialize Phonet devices list */ |
76e02cf6 | 336 | int __init phonet_device_init(void) |
f8ff6028 | 337 | { |
03478756 | 338 | int err = register_pernet_subsys(&phonet_net_ops); |
9a3b7a42 | 339 | if (err) |
340 | return err; | |
660f706d | 341 | |
c3506372 CH |
342 | proc_create_net("pnresource", 0, init_net.proc_net, &pn_res_seq_ops, |
343 | sizeof(struct seq_net_private)); | |
f8ff6028 | 344 | register_netdevice_notifier(&phonet_device_notifier); |
660f706d | 345 | err = phonet_netlink_register(); |
346 | if (err) | |
347 | phonet_device_exit(); | |
348 | return err; | |
f8ff6028 RDC |
349 | } |
350 | ||
351 | void phonet_device_exit(void) | |
352 | { | |
f8ff6028 | 353 | rtnl_unregister_all(PF_PHONET); |
6530e0fe | 354 | unregister_netdevice_notifier(&phonet_device_notifier); |
03478756 | 355 | unregister_pernet_subsys(&phonet_net_ops); |
ece31ffd | 356 | remove_proc_entry("pnresource", init_net.proc_net); |
f8ff6028 | 357 | } |
55748ac0 RDC |
358 | |
359 | int phonet_route_add(struct net_device *dev, u8 daddr) | |
360 | { | |
0db3f0f4 | 361 | struct phonet_net *pnn = phonet_pernet(dev_net(dev)); |
55748ac0 RDC |
362 | struct phonet_routes *routes = &pnn->routes; |
363 | int err = -EEXIST; | |
364 | ||
365 | daddr = daddr >> 2; | |
88880135 | 366 | mutex_lock(&routes->lock); |
55748ac0 | 367 | if (routes->table[daddr] == NULL) { |
cf778b00 | 368 | rcu_assign_pointer(routes->table[daddr], dev); |
55748ac0 RDC |
369 | dev_hold(dev); |
370 | err = 0; | |
371 | } | |
88880135 | 372 | mutex_unlock(&routes->lock); |
55748ac0 RDC |
373 | return err; |
374 | } | |
375 | ||
376 | int phonet_route_del(struct net_device *dev, u8 daddr) | |
377 | { | |
0db3f0f4 | 378 | struct phonet_net *pnn = phonet_pernet(dev_net(dev)); |
55748ac0 | 379 | struct phonet_routes *routes = &pnn->routes; |
55748ac0 RDC |
380 | |
381 | daddr = daddr >> 2; | |
88880135 | 382 | mutex_lock(&routes->lock); |
79952bca | 383 | if (rcu_access_pointer(routes->table[daddr]) == dev) |
a9b3cd7f | 384 | RCU_INIT_POINTER(routes->table[daddr], NULL); |
88880135 RDC |
385 | else |
386 | dev = NULL; | |
387 | mutex_unlock(&routes->lock); | |
388 | ||
389 | if (!dev) | |
390 | return -ENOENT; | |
391 | synchronize_rcu(); | |
392 | dev_put(dev); | |
393 | return 0; | |
55748ac0 RDC |
394 | } |
395 | ||
e67f88dd | 396 | struct net_device *phonet_route_get_rcu(struct net *net, u8 daddr) |
55748ac0 | 397 | { |
0db3f0f4 | 398 | struct phonet_net *pnn = phonet_pernet(net); |
55748ac0 RDC |
399 | struct phonet_routes *routes = &pnn->routes; |
400 | struct net_device *dev; | |
401 | ||
55748ac0 | 402 | daddr >>= 2; |
88880135 | 403 | dev = rcu_dereference(routes->table[daddr]); |
55748ac0 RDC |
404 | return dev; |
405 | } | |
406 | ||
407 | struct net_device *phonet_route_output(struct net *net, u8 daddr) | |
408 | { | |
0db3f0f4 | 409 | struct phonet_net *pnn = phonet_pernet(net); |
55748ac0 RDC |
410 | struct phonet_routes *routes = &pnn->routes; |
411 | struct net_device *dev; | |
412 | ||
88880135 RDC |
413 | daddr >>= 2; |
414 | rcu_read_lock(); | |
415 | dev = rcu_dereference(routes->table[daddr]); | |
55748ac0 RDC |
416 | if (dev) |
417 | dev_hold(dev); | |
88880135 | 418 | rcu_read_unlock(); |
55748ac0 RDC |
419 | |
420 | if (!dev) | |
421 | dev = phonet_device_get(net); /* Default route */ | |
422 | return dev; | |
423 | } |