blob: 6485f593e2f09bc3f215e2ad2c638154de738487 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * This program is free software; you can redistribute it and/or modify
3 * it under the terms of the GNU General Public License as published by
4 * the Free Software Foundation; either version 2 of the License, or
5 * (at your option) any later version.
6 *
7 * Copyright Jonathan Naylor G4KLX (g4klx@g4klx.demon.co.uk)
8 * Copyright Alan Cox GW4PTS (alan@lxorguk.ukuu.org.uk)
9 * Copyright Tomi Manninen OH2BNS (oh2bns@sral.fi)
10 */
11#include <linux/errno.h>
12#include <linux/types.h>
13#include <linux/socket.h>
14#include <linux/in.h>
15#include <linux/kernel.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070016#include <linux/timer.h>
17#include <linux/string.h>
18#include <linux/sockios.h>
19#include <linux/net.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090020#include <linux/slab.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070021#include <net/ax25.h>
22#include <linux/inet.h>
23#include <linux/netdevice.h>
24#include <net/arp.h>
25#include <linux/if_arp.h>
26#include <linux/skbuff.h>
27#include <net/sock.h>
Fabian Frederickdc8e5412014-10-17 22:00:22 +020028#include <linux/uaccess.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070029#include <linux/fcntl.h>
30#include <linux/termios.h> /* For TIOCINQ/OUTQ */
31#include <linux/mm.h>
32#include <linux/interrupt.h>
33#include <linux/notifier.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070034#include <linux/init.h>
35#include <linux/spinlock.h>
36#include <net/netrom.h>
37#include <linux/seq_file.h>
Paul Gortmakerbc3b2d72011-07-15 11:47:34 -040038#include <linux/export.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070039
40static unsigned int nr_neigh_no = 1;
41
42static HLIST_HEAD(nr_node_list);
43static DEFINE_SPINLOCK(nr_node_list_lock);
44static HLIST_HEAD(nr_neigh_list);
45static DEFINE_SPINLOCK(nr_neigh_list_lock);
46
47static struct nr_node *nr_node_get(ax25_address *callsign)
48{
49 struct nr_node *found = NULL;
50 struct nr_node *nr_node;
Linus Torvalds1da177e2005-04-16 15:20:36 -070051
52 spin_lock_bh(&nr_node_list_lock);
Sasha Levinb67bfe02013-02-27 17:06:00 -080053 nr_node_for_each(nr_node, &nr_node_list)
Linus Torvalds1da177e2005-04-16 15:20:36 -070054 if (ax25cmp(callsign, &nr_node->callsign) == 0) {
55 nr_node_hold(nr_node);
56 found = nr_node;
57 break;
58 }
59 spin_unlock_bh(&nr_node_list_lock);
60 return found;
61}
62
63static struct nr_neigh *nr_neigh_get_dev(ax25_address *callsign,
64 struct net_device *dev)
65{
66 struct nr_neigh *found = NULL;
67 struct nr_neigh *nr_neigh;
Linus Torvalds1da177e2005-04-16 15:20:36 -070068
69 spin_lock_bh(&nr_neigh_list_lock);
Sasha Levinb67bfe02013-02-27 17:06:00 -080070 nr_neigh_for_each(nr_neigh, &nr_neigh_list)
Linus Torvalds1da177e2005-04-16 15:20:36 -070071 if (ax25cmp(callsign, &nr_neigh->callsign) == 0 &&
72 nr_neigh->dev == dev) {
73 nr_neigh_hold(nr_neigh);
74 found = nr_neigh;
75 break;
76 }
77 spin_unlock_bh(&nr_neigh_list_lock);
78 return found;
79}
80
81static void nr_remove_neigh(struct nr_neigh *);
82
Gustavo A. R. Silva4c316062017-10-27 00:51:04 -050083/* re-sort the routes in quality order. */
84static void re_sort_routes(struct nr_node *nr_node, int x, int y)
85{
86 if (nr_node->routes[y].quality > nr_node->routes[x].quality) {
87 if (nr_node->which == x)
88 nr_node->which = y;
89 else if (nr_node->which == y)
90 nr_node->which = x;
91
92 swap(nr_node->routes[x], nr_node->routes[y]);
93 }
94}
95
Linus Torvalds1da177e2005-04-16 15:20:36 -070096/*
97 * Add a new route to a node, and in the process add the node and the
98 * neighbour if it is new.
99 */
Ralf Baechlec9266b92006-12-14 15:49:28 -0800100static int __must_check nr_add_node(ax25_address *nr, const char *mnemonic,
101 ax25_address *ax25, ax25_digi *ax25_digi, struct net_device *dev,
102 int quality, int obs_count)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700103{
104 struct nr_node *nr_node;
105 struct nr_neigh *nr_neigh;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700106 int i, found;
107 struct net_device *odev;
108
109 if ((odev=nr_dev_get(nr)) != NULL) { /* Can't add routes to ourself */
110 dev_put(odev);
111 return -EINVAL;
112 }
113
114 nr_node = nr_node_get(nr);
115
116 nr_neigh = nr_neigh_get_dev(ax25, dev);
117
118 /*
119 * The L2 link to a neighbour has failed in the past
120 * and now a frame comes from this neighbour. We assume
121 * it was a temporary trouble with the link and reset the
122 * routes now (and not wait for a node broadcast).
123 */
124 if (nr_neigh != NULL && nr_neigh->failed != 0 && quality == 0) {
125 struct nr_node *nr_nodet;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700126
127 spin_lock_bh(&nr_node_list_lock);
Sasha Levinb67bfe02013-02-27 17:06:00 -0800128 nr_node_for_each(nr_nodet, &nr_node_list) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700129 nr_node_lock(nr_nodet);
130 for (i = 0; i < nr_nodet->count; i++)
131 if (nr_nodet->routes[i].neighbour == nr_neigh)
132 if (i < nr_nodet->which)
133 nr_nodet->which = i;
134 nr_node_unlock(nr_nodet);
135 }
136 spin_unlock_bh(&nr_node_list_lock);
137 }
138
139 if (nr_neigh != NULL)
140 nr_neigh->failed = 0;
141
142 if (quality == 0 && nr_neigh != NULL && nr_node != NULL) {
143 nr_neigh_put(nr_neigh);
144 nr_node_put(nr_node);
145 return 0;
146 }
147
148 if (nr_neigh == NULL) {
149 if ((nr_neigh = kmalloc(sizeof(*nr_neigh), GFP_ATOMIC)) == NULL) {
150 if (nr_node)
151 nr_node_put(nr_node);
152 return -ENOMEM;
153 }
154
155 nr_neigh->callsign = *ax25;
156 nr_neigh->digipeat = NULL;
157 nr_neigh->ax25 = NULL;
158 nr_neigh->dev = dev;
159 nr_neigh->quality = sysctl_netrom_default_path_quality;
160 nr_neigh->locked = 0;
161 nr_neigh->count = 0;
162 nr_neigh->number = nr_neigh_no++;
163 nr_neigh->failed = 0;
Reshetova, Elenaaf420742017-07-04 15:53:11 +0300164 refcount_set(&nr_neigh->refcount, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700165
166 if (ax25_digi != NULL && ax25_digi->ndigi > 0) {
Arnaldo Carvalho de Meloeafff862006-11-17 13:05:04 -0200167 nr_neigh->digipeat = kmemdup(ax25_digi,
168 sizeof(*ax25_digi),
169 GFP_KERNEL);
170 if (nr_neigh->digipeat == NULL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700171 kfree(nr_neigh);
172 if (nr_node)
173 nr_node_put(nr_node);
174 return -ENOMEM;
175 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700176 }
177
178 spin_lock_bh(&nr_neigh_list_lock);
179 hlist_add_head(&nr_neigh->neigh_node, &nr_neigh_list);
180 nr_neigh_hold(nr_neigh);
181 spin_unlock_bh(&nr_neigh_list_lock);
182 }
183
184 if (quality != 0 && ax25cmp(nr, ax25) == 0 && !nr_neigh->locked)
185 nr_neigh->quality = quality;
186
187 if (nr_node == NULL) {
188 if ((nr_node = kmalloc(sizeof(*nr_node), GFP_ATOMIC)) == NULL) {
189 if (nr_neigh)
190 nr_neigh_put(nr_neigh);
191 return -ENOMEM;
192 }
193
194 nr_node->callsign = *nr;
195 strcpy(nr_node->mnemonic, mnemonic);
196
197 nr_node->which = 0;
198 nr_node->count = 1;
Reshetova, Elena156be7e2017-07-04 15:53:12 +0300199 refcount_set(&nr_node->refcount, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700200 spin_lock_init(&nr_node->node_lock);
201
202 nr_node->routes[0].quality = quality;
203 nr_node->routes[0].obs_count = obs_count;
204 nr_node->routes[0].neighbour = nr_neigh;
205
206 nr_neigh_hold(nr_neigh);
207 nr_neigh->count++;
208
209 spin_lock_bh(&nr_node_list_lock);
210 hlist_add_head(&nr_node->node_node, &nr_node_list);
211 /* refcount initialized at 1 */
212 spin_unlock_bh(&nr_node_list_lock);
213
214 return 0;
215 }
216 nr_node_lock(nr_node);
217
218 if (quality != 0)
219 strcpy(nr_node->mnemonic, mnemonic);
220
221 for (found = 0, i = 0; i < nr_node->count; i++) {
222 if (nr_node->routes[i].neighbour == nr_neigh) {
223 nr_node->routes[i].quality = quality;
224 nr_node->routes[i].obs_count = obs_count;
225 found = 1;
226 break;
227 }
228 }
229
230 if (!found) {
231 /* We have space at the bottom, slot it in */
232 if (nr_node->count < 3) {
233 nr_node->routes[2] = nr_node->routes[1];
234 nr_node->routes[1] = nr_node->routes[0];
235
236 nr_node->routes[0].quality = quality;
237 nr_node->routes[0].obs_count = obs_count;
238 nr_node->routes[0].neighbour = nr_neigh;
239
240 nr_node->which++;
241 nr_node->count++;
242 nr_neigh_hold(nr_neigh);
243 nr_neigh->count++;
244 } else {
245 /* It must be better than the worst */
246 if (quality > nr_node->routes[2].quality) {
247 nr_node->routes[2].neighbour->count--;
248 nr_neigh_put(nr_node->routes[2].neighbour);
249
250 if (nr_node->routes[2].neighbour->count == 0 && !nr_node->routes[2].neighbour->locked)
251 nr_remove_neigh(nr_node->routes[2].neighbour);
252
253 nr_node->routes[2].quality = quality;
254 nr_node->routes[2].obs_count = obs_count;
255 nr_node->routes[2].neighbour = nr_neigh;
256
257 nr_neigh_hold(nr_neigh);
258 nr_neigh->count++;
259 }
260 }
261 }
262
263 /* Now re-sort the routes in quality order */
264 switch (nr_node->count) {
265 case 3:
Gustavo A. R. Silva4c316062017-10-27 00:51:04 -0500266 re_sort_routes(nr_node, 0, 1);
267 re_sort_routes(nr_node, 1, 2);
Gustavo A. R. Silva31f74f02017-10-27 00:51:08 -0500268 /* fall through */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700269 case 2:
Gustavo A. R. Silva4c316062017-10-27 00:51:04 -0500270 re_sort_routes(nr_node, 0, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700271 case 1:
272 break;
273 }
274
275 for (i = 0; i < nr_node->count; i++) {
276 if (nr_node->routes[i].neighbour == nr_neigh) {
277 if (i < nr_node->which)
278 nr_node->which = i;
279 break;
280 }
281 }
282
283 nr_neigh_put(nr_neigh);
284 nr_node_unlock(nr_node);
285 nr_node_put(nr_node);
286 return 0;
287}
288
289static inline void __nr_remove_node(struct nr_node *nr_node)
290{
291 hlist_del_init(&nr_node->node_node);
292 nr_node_put(nr_node);
293}
294
295#define nr_remove_node_locked(__node) \
296 __nr_remove_node(__node)
297
298static void nr_remove_node(struct nr_node *nr_node)
299{
300 spin_lock_bh(&nr_node_list_lock);
301 __nr_remove_node(nr_node);
302 spin_unlock_bh(&nr_node_list_lock);
303}
304
305static inline void __nr_remove_neigh(struct nr_neigh *nr_neigh)
306{
307 hlist_del_init(&nr_neigh->neigh_node);
308 nr_neigh_put(nr_neigh);
309}
310
311#define nr_remove_neigh_locked(__neigh) \
312 __nr_remove_neigh(__neigh)
313
314static void nr_remove_neigh(struct nr_neigh *nr_neigh)
315{
316 spin_lock_bh(&nr_neigh_list_lock);
317 __nr_remove_neigh(nr_neigh);
318 spin_unlock_bh(&nr_neigh_list_lock);
319}
320
321/*
322 * "Delete" a node. Strictly speaking remove a route to a node. The node
323 * is only deleted if no routes are left to it.
324 */
325static int nr_del_node(ax25_address *callsign, ax25_address *neighbour, struct net_device *dev)
326{
327 struct nr_node *nr_node;
328 struct nr_neigh *nr_neigh;
329 int i;
330
331 nr_node = nr_node_get(callsign);
332
333 if (nr_node == NULL)
334 return -EINVAL;
335
336 nr_neigh = nr_neigh_get_dev(neighbour, dev);
337
338 if (nr_neigh == NULL) {
339 nr_node_put(nr_node);
340 return -EINVAL;
341 }
342
343 nr_node_lock(nr_node);
344 for (i = 0; i < nr_node->count; i++) {
345 if (nr_node->routes[i].neighbour == nr_neigh) {
346 nr_neigh->count--;
347 nr_neigh_put(nr_neigh);
348
349 if (nr_neigh->count == 0 && !nr_neigh->locked)
350 nr_remove_neigh(nr_neigh);
351 nr_neigh_put(nr_neigh);
352
353 nr_node->count--;
354
355 if (nr_node->count == 0) {
356 nr_remove_node(nr_node);
357 } else {
358 switch (i) {
359 case 0:
360 nr_node->routes[0] = nr_node->routes[1];
Gustavo A. R. Silva31f74f02017-10-27 00:51:08 -0500361 /* fall through */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700362 case 1:
363 nr_node->routes[1] = nr_node->routes[2];
364 case 2:
365 break;
366 }
367 nr_node_put(nr_node);
368 }
369 nr_node_unlock(nr_node);
370
371 return 0;
372 }
373 }
374 nr_neigh_put(nr_neigh);
375 nr_node_unlock(nr_node);
376 nr_node_put(nr_node);
377
378 return -EINVAL;
379}
380
381/*
382 * Lock a neighbour with a quality.
383 */
Ralf Baechlec9266b92006-12-14 15:49:28 -0800384static int __must_check nr_add_neigh(ax25_address *callsign,
385 ax25_digi *ax25_digi, struct net_device *dev, unsigned int quality)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700386{
387 struct nr_neigh *nr_neigh;
388
389 nr_neigh = nr_neigh_get_dev(callsign, dev);
390 if (nr_neigh) {
391 nr_neigh->quality = quality;
392 nr_neigh->locked = 1;
393 nr_neigh_put(nr_neigh);
394 return 0;
395 }
396
397 if ((nr_neigh = kmalloc(sizeof(*nr_neigh), GFP_ATOMIC)) == NULL)
398 return -ENOMEM;
399
400 nr_neigh->callsign = *callsign;
401 nr_neigh->digipeat = NULL;
402 nr_neigh->ax25 = NULL;
403 nr_neigh->dev = dev;
404 nr_neigh->quality = quality;
405 nr_neigh->locked = 1;
406 nr_neigh->count = 0;
407 nr_neigh->number = nr_neigh_no++;
408 nr_neigh->failed = 0;
Reshetova, Elenaaf420742017-07-04 15:53:11 +0300409 refcount_set(&nr_neigh->refcount, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700410
411 if (ax25_digi != NULL && ax25_digi->ndigi > 0) {
Arnaldo Carvalho de Meloeafff862006-11-17 13:05:04 -0200412 nr_neigh->digipeat = kmemdup(ax25_digi, sizeof(*ax25_digi),
413 GFP_KERNEL);
414 if (nr_neigh->digipeat == NULL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700415 kfree(nr_neigh);
416 return -ENOMEM;
417 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700418 }
419
420 spin_lock_bh(&nr_neigh_list_lock);
421 hlist_add_head(&nr_neigh->neigh_node, &nr_neigh_list);
422 /* refcount is initialized at 1 */
423 spin_unlock_bh(&nr_neigh_list_lock);
424
425 return 0;
426}
427
428/*
429 * "Delete" a neighbour. The neighbour is only removed if the number
430 * of nodes that may use it is zero.
431 */
432static int nr_del_neigh(ax25_address *callsign, struct net_device *dev, unsigned int quality)
433{
434 struct nr_neigh *nr_neigh;
435
436 nr_neigh = nr_neigh_get_dev(callsign, dev);
437
438 if (nr_neigh == NULL) return -EINVAL;
439
440 nr_neigh->quality = quality;
441 nr_neigh->locked = 0;
442
443 if (nr_neigh->count == 0)
444 nr_remove_neigh(nr_neigh);
445 nr_neigh_put(nr_neigh);
446
447 return 0;
448}
449
450/*
451 * Decrement the obsolescence count by one. If a route is reduced to a
452 * count of zero, remove it. Also remove any unlocked neighbours with
453 * zero nodes routing via it.
454 */
455static int nr_dec_obs(void)
456{
457 struct nr_neigh *nr_neigh;
458 struct nr_node *s;
Sasha Levinb67bfe02013-02-27 17:06:00 -0800459 struct hlist_node *nodet;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700460 int i;
461
462 spin_lock_bh(&nr_node_list_lock);
Sasha Levinb67bfe02013-02-27 17:06:00 -0800463 nr_node_for_each_safe(s, nodet, &nr_node_list) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700464 nr_node_lock(s);
465 for (i = 0; i < s->count; i++) {
466 switch (s->routes[i].obs_count) {
467 case 0: /* A locked entry */
468 break;
469
470 case 1: /* From 1 -> 0 */
471 nr_neigh = s->routes[i].neighbour;
472
473 nr_neigh->count--;
474 nr_neigh_put(nr_neigh);
475
476 if (nr_neigh->count == 0 && !nr_neigh->locked)
477 nr_remove_neigh(nr_neigh);
478
479 s->count--;
480
481 switch (i) {
Joe Perchesc4855382011-07-01 09:43:10 +0000482 case 0:
483 s->routes[0] = s->routes[1];
484 /* Fallthrough */
485 case 1:
486 s->routes[1] = s->routes[2];
487 case 2:
488 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700489 }
490 break;
491
492 default:
493 s->routes[i].obs_count--;
494 break;
495
496 }
497 }
498
499 if (s->count <= 0)
500 nr_remove_node_locked(s);
501 nr_node_unlock(s);
502 }
503 spin_unlock_bh(&nr_node_list_lock);
504
505 return 0;
506}
507
508/*
509 * A device has been removed. Remove its routes and neighbours.
510 */
511void nr_rt_device_down(struct net_device *dev)
512{
513 struct nr_neigh *s;
Sasha Levinb67bfe02013-02-27 17:06:00 -0800514 struct hlist_node *nodet, *node2t;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700515 struct nr_node *t;
516 int i;
517
518 spin_lock_bh(&nr_neigh_list_lock);
Sasha Levinb67bfe02013-02-27 17:06:00 -0800519 nr_neigh_for_each_safe(s, nodet, &nr_neigh_list) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700520 if (s->dev == dev) {
521 spin_lock_bh(&nr_node_list_lock);
Sasha Levinb67bfe02013-02-27 17:06:00 -0800522 nr_node_for_each_safe(t, node2t, &nr_node_list) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700523 nr_node_lock(t);
524 for (i = 0; i < t->count; i++) {
525 if (t->routes[i].neighbour == s) {
526 t->count--;
527
528 switch (i) {
529 case 0:
530 t->routes[0] = t->routes[1];
Gustavo A. R. Silva31f74f02017-10-27 00:51:08 -0500531 /* fall through */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700532 case 1:
533 t->routes[1] = t->routes[2];
534 case 2:
535 break;
536 }
537 }
538 }
539
540 if (t->count <= 0)
541 nr_remove_node_locked(t);
542 nr_node_unlock(t);
543 }
544 spin_unlock_bh(&nr_node_list_lock);
545
546 nr_remove_neigh_locked(s);
547 }
548 }
549 spin_unlock_bh(&nr_neigh_list_lock);
550}
551
552/*
553 * Check that the device given is a valid AX.25 interface that is "up".
554 * Or a valid ethernet interface with an AX.25 callsign binding.
555 */
556static struct net_device *nr_ax25_dev_get(char *devname)
557{
558 struct net_device *dev;
559
Eric W. Biederman881d9662007-09-17 11:56:21 -0700560 if ((dev = dev_get_by_name(&init_net, devname)) == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700561 return NULL;
562
563 if ((dev->flags & IFF_UP) && dev->type == ARPHRD_AX25)
564 return dev;
565
566 dev_put(dev);
567 return NULL;
568}
569
570/*
571 * Find the first active NET/ROM device, usually "nr0".
572 */
573struct net_device *nr_dev_first(void)
574{
575 struct net_device *dev, *first = NULL;
576
Eric Dumazetc6d14c82009-11-04 05:43:23 -0800577 rcu_read_lock();
578 for_each_netdev_rcu(&init_net, dev) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700579 if ((dev->flags & IFF_UP) && dev->type == ARPHRD_NETROM)
580 if (first == NULL || strncmp(dev->name, first->name, 3) < 0)
581 first = dev;
582 }
583 if (first)
584 dev_hold(first);
Eric Dumazetc6d14c82009-11-04 05:43:23 -0800585 rcu_read_unlock();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700586
587 return first;
588}
589
590/*
591 * Find the NET/ROM device for the given callsign.
592 */
593struct net_device *nr_dev_get(ax25_address *addr)
594{
595 struct net_device *dev;
596
Eric Dumazetc6d14c82009-11-04 05:43:23 -0800597 rcu_read_lock();
598 for_each_netdev_rcu(&init_net, dev) {
599 if ((dev->flags & IFF_UP) && dev->type == ARPHRD_NETROM &&
600 ax25cmp(addr, (ax25_address *)dev->dev_addr) == 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700601 dev_hold(dev);
602 goto out;
603 }
604 }
Pavel Emelianov7562f872007-05-03 15:13:45 -0700605 dev = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700606out:
Eric Dumazetc6d14c82009-11-04 05:43:23 -0800607 rcu_read_unlock();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700608 return dev;
609}
610
Ralf Baechlec6ba9732009-08-17 18:05:32 -0700611static ax25_digi *nr_call_to_digi(ax25_digi *digi, int ndigis,
612 ax25_address *digipeaters)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700613{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700614 int i;
615
616 if (ndigis == 0)
617 return NULL;
618
619 for (i = 0; i < ndigis; i++) {
Ralf Baechlec6ba9732009-08-17 18:05:32 -0700620 digi->calls[i] = digipeaters[i];
621 digi->repeated[i] = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700622 }
623
Ralf Baechlec6ba9732009-08-17 18:05:32 -0700624 digi->ndigi = ndigis;
625 digi->lastrepeat = -1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700626
Ralf Baechlec6ba9732009-08-17 18:05:32 -0700627 return digi;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700628}
629
630/*
631 * Handle the ioctls that control the routing functions.
632 */
633int nr_rt_ioctl(unsigned int cmd, void __user *arg)
634{
635 struct nr_route_struct nr_route;
636 struct net_device *dev;
Ralf Baechlec6ba9732009-08-17 18:05:32 -0700637 ax25_digi digi;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700638 int ret;
639
640 switch (cmd) {
641 case SIOCADDRT:
642 if (copy_from_user(&nr_route, arg, sizeof(struct nr_route_struct)))
643 return -EFAULT;
Ralf Baechle10cae1c2011-11-24 23:09:00 +0000644 if (nr_route.ndigis > AX25_MAX_DIGIS)
645 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700646 if ((dev = nr_ax25_dev_get(nr_route.device)) == NULL)
647 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700648 switch (nr_route.type) {
649 case NETROM_NODE:
Ralf Baechleac1a1de2011-11-24 23:08:49 +0000650 if (strnlen(nr_route.mnemonic, 7) == 7) {
651 ret = -EINVAL;
652 break;
653 }
654
Linus Torvalds1da177e2005-04-16 15:20:36 -0700655 ret = nr_add_node(&nr_route.callsign,
656 nr_route.mnemonic,
657 &nr_route.neighbour,
Ralf Baechlec6ba9732009-08-17 18:05:32 -0700658 nr_call_to_digi(&digi, nr_route.ndigis,
659 nr_route.digipeaters),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700660 dev, nr_route.quality,
661 nr_route.obs_count);
662 break;
663 case NETROM_NEIGH:
664 ret = nr_add_neigh(&nr_route.callsign,
Ralf Baechlec6ba9732009-08-17 18:05:32 -0700665 nr_call_to_digi(&digi, nr_route.ndigis,
666 nr_route.digipeaters),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700667 dev, nr_route.quality);
668 break;
669 default:
670 ret = -EINVAL;
671 }
672 dev_put(dev);
673 return ret;
674
675 case SIOCDELRT:
676 if (copy_from_user(&nr_route, arg, sizeof(struct nr_route_struct)))
677 return -EFAULT;
678 if ((dev = nr_ax25_dev_get(nr_route.device)) == NULL)
679 return -EINVAL;
680 switch (nr_route.type) {
681 case NETROM_NODE:
682 ret = nr_del_node(&nr_route.callsign,
683 &nr_route.neighbour, dev);
684 break;
685 case NETROM_NEIGH:
686 ret = nr_del_neigh(&nr_route.callsign,
687 dev, nr_route.quality);
688 break;
689 default:
690 ret = -EINVAL;
691 }
692 dev_put(dev);
693 return ret;
694
695 case SIOCNRDECOBS:
696 return nr_dec_obs();
697
698 default:
699 return -EINVAL;
700 }
701
702 return 0;
703}
704
705/*
706 * A level 2 link has timed out, therefore it appears to be a poor link,
707 * then don't use that neighbour until it is reset.
708 */
709void nr_link_failed(ax25_cb *ax25, int reason)
710{
711 struct nr_neigh *s, *nr_neigh = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700712 struct nr_node *nr_node = NULL;
713
714 spin_lock_bh(&nr_neigh_list_lock);
Sasha Levinb67bfe02013-02-27 17:06:00 -0800715 nr_neigh_for_each(s, &nr_neigh_list) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700716 if (s->ax25 == ax25) {
717 nr_neigh_hold(s);
718 nr_neigh = s;
719 break;
720 }
Ralf Baechle52383672006-06-26 00:05:23 -0700721 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700722 spin_unlock_bh(&nr_neigh_list_lock);
723
Ralf Baechle52383672006-06-26 00:05:23 -0700724 if (nr_neigh == NULL)
725 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700726
727 nr_neigh->ax25 = NULL;
728 ax25_cb_put(ax25);
729
730 if (++nr_neigh->failed < sysctl_netrom_link_fails_count) {
731 nr_neigh_put(nr_neigh);
732 return;
733 }
734 spin_lock_bh(&nr_node_list_lock);
Sasha Levinb67bfe02013-02-27 17:06:00 -0800735 nr_node_for_each(nr_node, &nr_node_list) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700736 nr_node_lock(nr_node);
Ralf Baechle52383672006-06-26 00:05:23 -0700737 if (nr_node->which < nr_node->count &&
738 nr_node->routes[nr_node->which].neighbour == nr_neigh)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700739 nr_node->which++;
740 nr_node_unlock(nr_node);
Ralf Baechle52383672006-06-26 00:05:23 -0700741 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700742 spin_unlock_bh(&nr_node_list_lock);
743 nr_neigh_put(nr_neigh);
744}
745
746/*
747 * Route a frame to an appropriate AX.25 connection. A NULL ax25_cb
748 * indicates an internally generated frame.
749 */
750int nr_route_frame(struct sk_buff *skb, ax25_cb *ax25)
751{
752 ax25_address *nr_src, *nr_dest;
753 struct nr_neigh *nr_neigh;
754 struct nr_node *nr_node;
755 struct net_device *dev;
756 unsigned char *dptr;
757 ax25_cb *ax25s;
758 int ret;
759 struct sk_buff *skbn;
760
761
762 nr_src = (ax25_address *)(skb->data + 0);
763 nr_dest = (ax25_address *)(skb->data + 7);
764
Ralf Baechle58bc5742006-12-14 15:50:58 -0800765 if (ax25 != NULL) {
766 ret = nr_add_node(nr_src, "", &ax25->dest_addr, ax25->digipeat,
YOSHIFUJI Hideaki5f8f59d2007-02-09 23:25:09 +0900767 ax25->ax25_dev->dev, 0,
768 sysctl_netrom_obsolescence_count_initialiser);
Ralf Baechle58bc5742006-12-14 15:50:58 -0800769 if (ret)
770 return ret;
771 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700772
773 if ((dev = nr_dev_get(nr_dest)) != NULL) { /* Its for me */
774 if (ax25 == NULL) /* Its from me */
775 ret = nr_loopback_queue(skb);
776 else
777 ret = nr_rx_frame(skb, dev);
778 dev_put(dev);
779 return ret;
780 }
781
782 if (!sysctl_netrom_routing_control && ax25 != NULL)
783 return 0;
784
785 /* Its Time-To-Live has expired */
786 if (skb->data[14] == 1) {
787 return 0;
788 }
789
790 nr_node = nr_node_get(nr_dest);
791 if (nr_node == NULL)
792 return 0;
793 nr_node_lock(nr_node);
794
795 if (nr_node->which >= nr_node->count) {
796 nr_node_unlock(nr_node);
797 nr_node_put(nr_node);
798 return 0;
799 }
800
801 nr_neigh = nr_node->routes[nr_node->which].neighbour;
802
803 if ((dev = nr_dev_first()) == NULL) {
804 nr_node_unlock(nr_node);
805 nr_node_put(nr_node);
806 return 0;
807 }
808
809 /* We are going to change the netrom headers so we should get our
810 own skb, we also did not know until now how much header space
811 we had to reserve... - RXQ */
812 if ((skbn=skb_copy_expand(skb, dev->hard_header_len, 0, GFP_ATOMIC)) == NULL) {
813 nr_node_unlock(nr_node);
814 nr_node_put(nr_node);
815 dev_put(dev);
816 return 0;
817 }
818 kfree_skb(skb);
819 skb=skbn;
820 skb->data[14]--;
821
822 dptr = skb_push(skb, 1);
823 *dptr = AX25_P_NETROM;
824
Jarek Poplawskid00c3622010-01-16 01:04:04 -0800825 ax25s = nr_neigh->ax25;
826 nr_neigh->ax25 = ax25_send_frame(skb, 256,
827 (ax25_address *)dev->dev_addr,
828 &nr_neigh->callsign,
829 nr_neigh->digipeat, nr_neigh->dev);
830 if (ax25s)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700831 ax25_cb_put(ax25s);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700832
833 dev_put(dev);
834 ret = (nr_neigh->ax25 != NULL);
835 nr_node_unlock(nr_node);
836 nr_node_put(nr_node);
Ralf Baechle58bc5742006-12-14 15:50:58 -0800837
Linus Torvalds1da177e2005-04-16 15:20:36 -0700838 return ret;
839}
840
841#ifdef CONFIG_PROC_FS
842
843static void *nr_node_start(struct seq_file *seq, loff_t *pos)
844{
YOSHIFUJI Hideaki5f8f59d2007-02-09 23:25:09 +0900845 spin_lock_bh(&nr_node_list_lock);
Li Zefan90dd7f52010-02-08 23:19:42 +0000846 return seq_hlist_start_head(&nr_node_list, *pos);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700847}
848
849static void *nr_node_next(struct seq_file *seq, void *v, loff_t *pos)
850{
Li Zefan90dd7f52010-02-08 23:19:42 +0000851 return seq_hlist_next(v, &nr_node_list, pos);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700852}
853
854static void nr_node_stop(struct seq_file *seq, void *v)
855{
856 spin_unlock_bh(&nr_node_list_lock);
857}
858
859static int nr_node_show(struct seq_file *seq, void *v)
860{
Ralf Baechlef75268c2005-09-06 15:49:39 -0700861 char buf[11];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700862 int i;
863
864 if (v == SEQ_START_TOKEN)
865 seq_puts(seq,
866 "callsign mnemonic w n qual obs neigh qual obs neigh qual obs neigh\n");
867 else {
Li Zefan90dd7f52010-02-08 23:19:42 +0000868 struct nr_node *nr_node = hlist_entry(v, struct nr_node,
869 node_node);
870
Linus Torvalds1da177e2005-04-16 15:20:36 -0700871 nr_node_lock(nr_node);
872 seq_printf(seq, "%-9s %-7s %d %d",
Ralf Baechlef75268c2005-09-06 15:49:39 -0700873 ax2asc(buf, &nr_node->callsign),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700874 (nr_node->mnemonic[0] == '\0') ? "*" : nr_node->mnemonic,
875 nr_node->which + 1,
876 nr_node->count);
877
878 for (i = 0; i < nr_node->count; i++) {
879 seq_printf(seq, " %3d %d %05d",
880 nr_node->routes[i].quality,
881 nr_node->routes[i].obs_count,
882 nr_node->routes[i].neighbour->number);
883 }
884 nr_node_unlock(nr_node);
885
886 seq_puts(seq, "\n");
887 }
888 return 0;
889}
890
Christoph Hellwigfddda2b2018-04-13 19:44:18 +0200891const struct seq_operations nr_node_seqops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700892 .start = nr_node_start,
893 .next = nr_node_next,
894 .stop = nr_node_stop,
895 .show = nr_node_show,
896};
897
Linus Torvalds1da177e2005-04-16 15:20:36 -0700898static void *nr_neigh_start(struct seq_file *seq, loff_t *pos)
899{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700900 spin_lock_bh(&nr_neigh_list_lock);
Li Zefan90dd7f52010-02-08 23:19:42 +0000901 return seq_hlist_start_head(&nr_neigh_list, *pos);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700902}
903
904static void *nr_neigh_next(struct seq_file *seq, void *v, loff_t *pos)
905{
Li Zefan90dd7f52010-02-08 23:19:42 +0000906 return seq_hlist_next(v, &nr_neigh_list, pos);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700907}
908
909static void nr_neigh_stop(struct seq_file *seq, void *v)
910{
911 spin_unlock_bh(&nr_neigh_list_lock);
912}
913
914static int nr_neigh_show(struct seq_file *seq, void *v)
915{
Ralf Baechlef75268c2005-09-06 15:49:39 -0700916 char buf[11];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700917 int i;
918
919 if (v == SEQ_START_TOKEN)
920 seq_puts(seq, "addr callsign dev qual lock count failed digipeaters\n");
921 else {
Li Zefan90dd7f52010-02-08 23:19:42 +0000922 struct nr_neigh *nr_neigh;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700923
Li Zefan90dd7f52010-02-08 23:19:42 +0000924 nr_neigh = hlist_entry(v, struct nr_neigh, neigh_node);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700925 seq_printf(seq, "%05d %-9s %-4s %3d %d %3d %3d",
926 nr_neigh->number,
Ralf Baechlef75268c2005-09-06 15:49:39 -0700927 ax2asc(buf, &nr_neigh->callsign),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700928 nr_neigh->dev ? nr_neigh->dev->name : "???",
929 nr_neigh->quality,
930 nr_neigh->locked,
931 nr_neigh->count,
932 nr_neigh->failed);
933
934 if (nr_neigh->digipeat != NULL) {
935 for (i = 0; i < nr_neigh->digipeat->ndigi; i++)
YOSHIFUJI Hideaki5f8f59d2007-02-09 23:25:09 +0900936 seq_printf(seq, " %s",
Ralf Baechlef75268c2005-09-06 15:49:39 -0700937 ax2asc(buf, &nr_neigh->digipeat->calls[i]));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700938 }
939
940 seq_puts(seq, "\n");
941 }
942 return 0;
943}
944
Christoph Hellwigfddda2b2018-04-13 19:44:18 +0200945const struct seq_operations nr_neigh_seqops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700946 .start = nr_neigh_start,
947 .next = nr_neigh_next,
948 .stop = nr_neigh_stop,
949 .show = nr_neigh_show,
950};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700951#endif
952
953/*
954 * Free all memory associated with the nodes and routes lists.
955 */
956void __exit nr_rt_free(void)
957{
958 struct nr_neigh *s = NULL;
959 struct nr_node *t = NULL;
Sasha Levinb67bfe02013-02-27 17:06:00 -0800960 struct hlist_node *nodet;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700961
962 spin_lock_bh(&nr_neigh_list_lock);
963 spin_lock_bh(&nr_node_list_lock);
Sasha Levinb67bfe02013-02-27 17:06:00 -0800964 nr_node_for_each_safe(t, nodet, &nr_node_list) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700965 nr_node_lock(t);
966 nr_remove_node_locked(t);
967 nr_node_unlock(t);
968 }
Sasha Levinb67bfe02013-02-27 17:06:00 -0800969 nr_neigh_for_each_safe(s, nodet, &nr_neigh_list) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700970 while(s->count) {
971 s->count--;
972 nr_neigh_put(s);
973 }
974 nr_remove_neigh_locked(s);
975 }
976 spin_unlock_bh(&nr_node_list_lock);
977 spin_unlock_bh(&nr_neigh_list_lock);
978}