4 * This code REQUIRES 2.1.15 or higher/ NET3.038
7 * This module is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License
9 * as published by the Free Software Foundation; either version
10 * 2 of the License, or (at your option) any later version.
13 * NET/ROM 001 Jonathan(G4KLX) First attempt.
14 * NET/ROM 003 Jonathan(G4KLX) Use SIOCADDRT/SIOCDELRT ioctl values
16 * Use '*' for a blank mnemonic in /proc/net/nr_nodes.
17 * Change default quality for new neighbour when same
19 * Alan Cox(GW4PTS) Added the firewall hooks.
20 * NET/ROM 006 Jonathan(G4KLX) Added the setting of digipeated neighbours.
21 * Tomi(OH2BNS) Routing quality and link failure changes.
24 #include <linux/config.h>
25 #if defined(CONFIG_NETROM) || defined(CONFIG_NETROM_MODULE)
26 #include <linux/errno.h>
27 #include <linux/types.h>
28 #include <linux/socket.h>
30 #include <linux/kernel.h>
31 #include <linux/sched.h>
32 #include <linux/timer.h>
33 #include <linux/string.h>
34 #include <linux/sockios.h>
35 #include <linux/net.h>
37 #include <linux/inet.h>
38 #include <linux/netdevice.h>
40 #include <linux/if_arp.h>
41 #include <linux/skbuff.h>
43 #include <asm/uaccess.h>
44 #include <asm/system.h>
45 #include <linux/fcntl.h>
46 #include <linux/termios.h> /* For TIOCINQ/OUTQ */
48 #include <linux/interrupt.h>
49 #include <linux/notifier.h>
50 #include <linux/firewall.h>
51 #include <net/netrom.h>
53 static unsigned int nr_neigh_no
= 1;
55 static struct nr_node
*nr_node_list
= NULL
;
56 static struct nr_neigh
*nr_neigh_list
= NULL
;
58 static void nr_remove_neigh(struct nr_neigh
*);
61 * Add a new route to a node, and in the process add the node and the
62 * neighbour if it is new.
64 static int nr_add_node(ax25_address
*nr
, const char *mnemonic
, ax25_address
*ax25
,
65 ax25_digi
*ax25_digi
, struct device
*dev
, int quality
, int obs_count
)
67 struct nr_node
*nr_node
;
68 struct nr_neigh
*nr_neigh
;
69 struct nr_route nr_route
;
73 if (nr_dev_get(nr
) != NULL
) /* Can't add routes to ourself */
76 for (nr_node
= nr_node_list
; nr_node
!= NULL
; nr_node
= nr_node
->next
)
77 if (ax25cmp(nr
, &nr_node
->callsign
) == 0)
80 for (nr_neigh
= nr_neigh_list
; nr_neigh
!= NULL
; nr_neigh
= nr_neigh
->next
)
81 if (ax25cmp(ax25
, &nr_neigh
->callsign
) == 0 && nr_neigh
->dev
== dev
)
87 if (quality
== 0 && nr_neigh
!= NULL
&& nr_node
!= NULL
)
90 if (nr_neigh
== NULL
) {
91 if ((nr_neigh
= kmalloc(sizeof(*nr_neigh
), GFP_ATOMIC
)) == NULL
)
94 nr_neigh
->callsign
= *ax25
;
95 nr_neigh
->digipeat
= NULL
;
97 nr_neigh
->quality
= sysctl_netrom_default_path_quality
;
100 nr_neigh
->number
= nr_neigh_no
++;
101 nr_neigh
->failed
= 0;
103 if (ax25_digi
!= NULL
&& ax25_digi
->ndigi
> 0) {
104 if ((nr_neigh
->digipeat
= kmalloc(sizeof(*ax25_digi
), GFP_KERNEL
)) == NULL
) {
108 *nr_neigh
->digipeat
= *ax25_digi
;
114 nr_neigh
->next
= nr_neigh_list
;
115 nr_neigh_list
= nr_neigh
;
117 restore_flags(flags
);
120 if (quality
!= 0 && ax25cmp(nr
, ax25
) == 0 && !nr_neigh
->locked
)
121 nr_neigh
->quality
= quality
;
123 if (nr_node
== NULL
) {
124 if ((nr_node
= kmalloc(sizeof(*nr_node
), GFP_ATOMIC
)) == NULL
)
127 nr_node
->callsign
= *nr
;
128 strcpy(nr_node
->mnemonic
, mnemonic
);
133 nr_node
->routes
[0].quality
= quality
;
134 nr_node
->routes
[0].obs_count
= obs_count
;
135 nr_node
->routes
[0].neighbour
= nr_neigh
;
140 nr_node
->next
= nr_node_list
;
141 nr_node_list
= nr_node
;
143 restore_flags(flags
);
151 strcpy(nr_node
->mnemonic
, mnemonic
);
153 for (found
= 0, i
= 0; i
< nr_node
->count
; i
++) {
154 if (nr_node
->routes
[i
].neighbour
== nr_neigh
) {
155 nr_node
->routes
[i
].quality
= quality
;
156 nr_node
->routes
[i
].obs_count
= obs_count
;
163 /* We have space at the bottom, slot it in */
164 if (nr_node
->count
< 3) {
165 nr_node
->routes
[2] = nr_node
->routes
[1];
166 nr_node
->routes
[1] = nr_node
->routes
[0];
168 nr_node
->routes
[0].quality
= quality
;
169 nr_node
->routes
[0].obs_count
= obs_count
;
170 nr_node
->routes
[0].neighbour
= nr_neigh
;
176 /* It must be better than the worst */
177 if (quality
> nr_node
->routes
[2].quality
) {
178 nr_node
->routes
[2].neighbour
->count
--;
180 if (nr_node
->routes
[2].neighbour
->count
== 0 && !nr_node
->routes
[2].neighbour
->locked
)
181 nr_remove_neigh(nr_node
->routes
[2].neighbour
);
183 nr_node
->routes
[2].quality
= quality
;
184 nr_node
->routes
[2].obs_count
= obs_count
;
185 nr_node
->routes
[2].neighbour
= nr_neigh
;
192 /* Now re-sort the routes in quality order */
193 switch (nr_node
->count
) {
195 if (nr_node
->routes
[1].quality
> nr_node
->routes
[0].quality
) {
196 switch (nr_node
->which
) {
197 case 0: nr_node
->which
= 1; break;
198 case 1: nr_node
->which
= 0; break;
201 nr_route
= nr_node
->routes
[0];
202 nr_node
->routes
[0] = nr_node
->routes
[1];
203 nr_node
->routes
[1] = nr_route
;
205 if (nr_node
->routes
[2].quality
> nr_node
->routes
[1].quality
) {
206 switch (nr_node
->which
) {
207 case 1: nr_node
->which
= 2; break;
208 case 2: nr_node
->which
= 1; break;
211 nr_route
= nr_node
->routes
[1];
212 nr_node
->routes
[1] = nr_node
->routes
[2];
213 nr_node
->routes
[2] = nr_route
;
216 if (nr_node
->routes
[1].quality
> nr_node
->routes
[0].quality
) {
217 switch (nr_node
->which
) {
218 case 0: nr_node
->which
= 1; break;
219 case 1: nr_node
->which
= 0; break;
222 nr_route
= nr_node
->routes
[0];
223 nr_node
->routes
[0] = nr_node
->routes
[1];
224 nr_node
->routes
[1] = nr_route
;
230 for (i
= 0; i
< nr_node
->count
; i
++) {
231 if (nr_node
->routes
[i
].neighbour
== nr_neigh
) {
232 if (i
< nr_node
->which
)
241 static void nr_remove_node(struct nr_node
*nr_node
)
249 if ((s
= nr_node_list
) == nr_node
) {
250 nr_node_list
= nr_node
->next
;
251 restore_flags(flags
);
256 while (s
!= NULL
&& s
->next
!= NULL
) {
257 if (s
->next
== nr_node
) {
258 s
->next
= nr_node
->next
;
259 restore_flags(flags
);
267 restore_flags(flags
);
270 static void nr_remove_neigh(struct nr_neigh
*nr_neigh
)
278 if ((s
= nr_neigh_list
) == nr_neigh
) {
279 nr_neigh_list
= nr_neigh
->next
;
280 restore_flags(flags
);
281 if (nr_neigh
->digipeat
!= NULL
)
282 kfree(nr_neigh
->digipeat
);
287 while (s
!= NULL
&& s
->next
!= NULL
) {
288 if (s
->next
== nr_neigh
) {
289 s
->next
= nr_neigh
->next
;
290 restore_flags(flags
);
291 if (nr_neigh
->digipeat
!= NULL
)
292 kfree(nr_neigh
->digipeat
);
300 restore_flags(flags
);
304 * "Delete" a node. Strictly speaking remove a route to a node. The node
305 * is only deleted if no routes are left to it.
307 static int nr_del_node(ax25_address
*callsign
, ax25_address
*neighbour
, struct device
*dev
)
309 struct nr_node
*nr_node
;
310 struct nr_neigh
*nr_neigh
;
313 for (nr_node
= nr_node_list
; nr_node
!= NULL
; nr_node
= nr_node
->next
)
314 if (ax25cmp(callsign
, &nr_node
->callsign
) == 0)
317 if (nr_node
== NULL
) return -EINVAL
;
319 for (nr_neigh
= nr_neigh_list
; nr_neigh
!= NULL
; nr_neigh
= nr_neigh
->next
)
320 if (ax25cmp(neighbour
, &nr_neigh
->callsign
) == 0 && nr_neigh
->dev
== dev
)
323 if (nr_neigh
== NULL
) return -EINVAL
;
325 for (i
= 0; i
< nr_node
->count
; i
++) {
326 if (nr_node
->routes
[i
].neighbour
== nr_neigh
) {
329 if (nr_neigh
->count
== 0 && !nr_neigh
->locked
)
330 nr_remove_neigh(nr_neigh
);
334 if (nr_node
->count
== 0) {
335 nr_remove_node(nr_node
);
339 nr_node
->routes
[0] = nr_node
->routes
[1];
341 nr_node
->routes
[1] = nr_node
->routes
[2];
355 * Lock a neighbour with a quality.
357 static int nr_add_neigh(ax25_address
*callsign
, ax25_digi
*ax25_digi
, struct device
*dev
, unsigned int quality
)
359 struct nr_neigh
*nr_neigh
;
362 for (nr_neigh
= nr_neigh_list
; nr_neigh
!= NULL
; nr_neigh
= nr_neigh
->next
) {
363 if (ax25cmp(callsign
, &nr_neigh
->callsign
) == 0 && nr_neigh
->dev
== dev
) {
364 nr_neigh
->quality
= quality
;
365 nr_neigh
->locked
= 1;
370 if ((nr_neigh
= kmalloc(sizeof(*nr_neigh
), GFP_ATOMIC
)) == NULL
)
373 nr_neigh
->callsign
= *callsign
;
374 nr_neigh
->digipeat
= NULL
;
376 nr_neigh
->quality
= quality
;
377 nr_neigh
->locked
= 1;
379 nr_neigh
->number
= nr_neigh_no
++;
380 nr_neigh
->failed
= 0;
382 if (ax25_digi
!= NULL
&& ax25_digi
->ndigi
> 0) {
383 if ((nr_neigh
->digipeat
= kmalloc(sizeof(*ax25_digi
), GFP_KERNEL
)) == NULL
) {
387 *nr_neigh
->digipeat
= *ax25_digi
;
393 nr_neigh
->next
= nr_neigh_list
;
394 nr_neigh_list
= nr_neigh
;
396 restore_flags(flags
);
402 * "Delete" a neighbour. The neighbour is only removed if the number
403 * of nodes that may use it is zero.
405 static int nr_del_neigh(ax25_address
*callsign
, struct device
*dev
, unsigned int quality
)
407 struct nr_neigh
*nr_neigh
;
409 for (nr_neigh
= nr_neigh_list
; nr_neigh
!= NULL
; nr_neigh
= nr_neigh
->next
)
410 if (ax25cmp(callsign
, &nr_neigh
->callsign
) == 0 && nr_neigh
->dev
== dev
)
413 if (nr_neigh
== NULL
) return -EINVAL
;
415 nr_neigh
->quality
= quality
;
416 nr_neigh
->locked
= 0;
418 if (nr_neigh
->count
== 0)
419 nr_remove_neigh(nr_neigh
);
425 * Decrement the obsolescence count by one. If a route is reduced to a
426 * count of zero, remove it. Also remove any unlocked neighbours with
427 * zero nodes routing via it.
429 static int nr_dec_obs(void)
431 struct nr_neigh
*nr_neigh
;
432 struct nr_node
*s
, *nr_node
;
435 nr_node
= nr_node_list
;
437 while (nr_node
!= NULL
) {
439 nr_node
= nr_node
->next
;
441 for (i
= 0; i
< s
->count
; i
++) {
442 switch (s
->routes
[i
].obs_count
) {
444 case 0: /* A locked entry */
447 case 1: /* From 1 -> 0 */
448 nr_neigh
= s
->routes
[i
].neighbour
;
452 if (nr_neigh
->count
== 0 && !nr_neigh
->locked
)
453 nr_remove_neigh(nr_neigh
);
459 s
->routes
[0] = s
->routes
[1];
461 s
->routes
[1] = s
->routes
[2];
468 s
->routes
[i
].obs_count
--;
482 * A device has been removed. Remove its routes and neighbours.
484 void nr_rt_device_down(struct device
*dev
)
486 struct nr_neigh
*s
, *nr_neigh
= nr_neigh_list
;
487 struct nr_node
*t
, *nr_node
;
490 while (nr_neigh
!= NULL
) {
492 nr_neigh
= nr_neigh
->next
;
495 nr_node
= nr_node_list
;
497 while (nr_node
!= NULL
) {
499 nr_node
= nr_node
->next
;
501 for (i
= 0; i
< t
->count
; i
++) {
502 if (t
->routes
[i
].neighbour
== s
) {
507 t
->routes
[0] = t
->routes
[1];
509 t
->routes
[1] = t
->routes
[2];
526 * Check that the device given is a valid AX.25 interface that is "up".
527 * Or a valid ethernet interface with an AX.25 callsign binding.
529 static struct device
*nr_ax25_dev_get(char *devname
)
533 if ((dev
= dev_get(devname
)) == NULL
)
536 if ((dev
->flags
& IFF_UP
) && dev
->type
== ARPHRD_AX25
)
543 * Find the first active NET/ROM device, usually "nr0".
545 struct device
*nr_dev_first(void)
547 struct device
*dev
, *first
= NULL
;
549 for (dev
= dev_base
; dev
!= NULL
; dev
= dev
->next
)
550 if ((dev
->flags
& IFF_UP
) && dev
->type
== ARPHRD_NETROM
)
551 if (first
== NULL
|| strncmp(dev
->name
, first
->name
, 3) < 0)
558 * Find the NET/ROM device for the given callsign.
560 struct device
*nr_dev_get(ax25_address
*addr
)
564 for (dev
= dev_base
; dev
!= NULL
; dev
= dev
->next
)
565 if ((dev
->flags
& IFF_UP
) && dev
->type
== ARPHRD_NETROM
&& ax25cmp(addr
, (ax25_address
*)dev
->dev_addr
) == 0)
571 static ax25_digi
*nr_call_to_digi(int ndigis
, ax25_address
*digipeaters
)
573 static ax25_digi ax25_digi
;
579 for (i
= 0; i
< ndigis
; i
++) {
580 ax25_digi
.calls
[i
] = digipeaters
[i
];
581 ax25_digi
.repeated
[i
] = 0;
584 ax25_digi
.ndigi
= ndigis
;
585 ax25_digi
.lastrepeat
= 0;
591 * Handle the ioctls that control the routing functions.
593 int nr_rt_ioctl(unsigned int cmd
, void *arg
)
595 struct nr_route_struct nr_route
;
602 if ((err
= verify_area(VERIFY_READ
, arg
, sizeof(struct nr_route_struct
))) != 0)
604 copy_from_user(&nr_route
, arg
, sizeof(struct nr_route_struct
));
605 if ((dev
= nr_ax25_dev_get(nr_route
.device
)) == NULL
)
607 if (nr_route
.ndigis
< 0 || nr_route
.ndigis
> AX25_MAX_DIGIS
)
609 switch (nr_route
.type
) {
611 return nr_add_node(&nr_route
.callsign
,
614 nr_call_to_digi(nr_route
.ndigis
, nr_route
.digipeaters
),
615 dev
, nr_route
.quality
,
618 return nr_add_neigh(&nr_route
.callsign
,
619 nr_call_to_digi(nr_route
.ndigis
, nr_route
.digipeaters
),
620 dev
, nr_route
.quality
);
626 if ((err
= verify_area(VERIFY_READ
, arg
, sizeof(struct nr_route_struct
))) != 0)
628 copy_from_user(&nr_route
, arg
, sizeof(struct nr_route_struct
));
629 if ((dev
= nr_ax25_dev_get(nr_route
.device
)) == NULL
)
631 switch (nr_route
.type
) {
633 return nr_del_node(&nr_route
.callsign
,
634 &nr_route
.neighbour
, dev
);
636 return nr_del_neigh(&nr_route
.callsign
,
637 dev
, nr_route
.quality
);
653 * A level 2 link has timed out, therefore it appears to be a poor link,
654 * then don't use that neighbour until it is reset.
656 void nr_link_failed(ax25_address
*callsign
, struct device
*dev
)
658 struct nr_neigh
*nr_neigh
;
659 struct nr_node
*nr_node
;
661 for (nr_neigh
= nr_neigh_list
; nr_neigh
!= NULL
; nr_neigh
= nr_neigh
->next
)
662 if (ax25cmp(&nr_neigh
->callsign
, callsign
) == 0 && nr_neigh
->dev
== dev
)
665 if (nr_neigh
== NULL
) return;
667 if (++nr_neigh
->failed
< sysctl_netrom_link_fails_count
) return;
669 for (nr_node
= nr_node_list
; nr_node
!= NULL
; nr_node
= nr_node
->next
)
670 if (nr_node
->which
< nr_node
->count
&& nr_node
->routes
[nr_node
->which
].neighbour
== nr_neigh
)
675 * Route a frame to an appropriate AX.25 connection. A NULL ax25_cb
676 * indicates an internally generated frame.
678 int nr_route_frame(struct sk_buff
*skb
, ax25_cb
*ax25
)
680 ax25_address
*nr_src
, *nr_dest
;
681 struct nr_neigh
*nr_neigh
;
682 struct nr_node
*nr_node
;
686 if (ax25
!= NULL
&& call_in_firewall(PF_NETROM
, skb
->dev
, skb
->data
, NULL
, &skb
) != FW_ACCEPT
)
689 if (ax25
== NULL
&& call_out_firewall(PF_NETROM
, skb
->dev
, skb
->data
, NULL
, &skb
) != FW_ACCEPT
)
692 nr_src
= (ax25_address
*)(skb
->data
+ 0);
693 nr_dest
= (ax25_address
*)(skb
->data
+ 7);
696 nr_add_node(nr_src
, "", &ax25
->dest_addr
, ax25
->digipeat
,
697 ax25
->ax25_dev
->dev
, 0, sysctl_netrom_obsolescence_count_initialiser
);
699 if ((dev
= nr_dev_get(nr_dest
)) != NULL
) /* Its for me */
700 return nr_rx_frame(skb
, dev
);
702 if (!sysctl_netrom_routing_control
&& ax25
!= NULL
)
705 /* Its Time-To-Live has expired */
706 if (--skb
->data
[14] == 0)
709 for (nr_node
= nr_node_list
; nr_node
!= NULL
; nr_node
= nr_node
->next
)
710 if (ax25cmp(nr_dest
, &nr_node
->callsign
) == 0)
713 if (nr_node
== NULL
|| nr_node
->which
>= nr_node
->count
)
716 nr_neigh
= nr_node
->routes
[nr_node
->which
].neighbour
;
718 if ((dev
= nr_dev_first()) == NULL
)
721 if (ax25
!= NULL
&& call_fw_firewall(PF_NETROM
, skb
->dev
, skb
->data
, NULL
, &skb
) != FW_ACCEPT
)
724 dptr
= skb_push(skb
, 1);
725 *dptr
= AX25_P_NETROM
;
727 return ax25_send_frame(skb
, 256, (ax25_address
*)dev
->dev_addr
, &nr_neigh
->callsign
, nr_neigh
->digipeat
, nr_neigh
->dev
);
730 int nr_nodes_get_info(char *buffer
, char **start
, off_t offset
,
731 int length
, int dummy
)
733 struct nr_node
*nr_node
;
741 len
+= sprintf(buffer
, "callsign mnemonic w n qual obs neigh qual obs neigh qual obs neigh\n");
743 for (nr_node
= nr_node_list
; nr_node
!= NULL
; nr_node
= nr_node
->next
) {
744 len
+= sprintf(buffer
+ len
, "%-9s %-7s %d %d",
745 ax2asc(&nr_node
->callsign
),
746 (nr_node
->mnemonic
[0] == '\0') ? "*" : nr_node
->mnemonic
,
750 for (i
= 0; i
< nr_node
->count
; i
++) {
751 len
+= sprintf(buffer
+ len
, " %3d %d %05d",
752 nr_node
->routes
[i
].quality
,
753 nr_node
->routes
[i
].obs_count
,
754 nr_node
->routes
[i
].neighbour
->number
);
757 len
+= sprintf(buffer
+ len
, "\n");
766 if (pos
> offset
+ length
)
772 *start
= buffer
+ (offset
- begin
);
773 len
-= (offset
- begin
);
775 if (len
> length
) len
= length
;
780 int nr_neigh_get_info(char *buffer
, char **start
, off_t offset
,
781 int length
, int dummy
)
783 struct nr_neigh
*nr_neigh
;
791 len
+= sprintf(buffer
, "addr callsign dev qual lock count failed digipeaters\n");
793 for (nr_neigh
= nr_neigh_list
; nr_neigh
!= NULL
; nr_neigh
= nr_neigh
->next
) {
794 len
+= sprintf(buffer
+ len
, "%05d %-9s %-4s %3d %d %3d %3d",
796 ax2asc(&nr_neigh
->callsign
),
797 nr_neigh
->dev
? nr_neigh
->dev
->name
: "???",
803 if (nr_neigh
->digipeat
!= NULL
) {
804 for (i
= 0; i
< nr_neigh
->digipeat
->ndigi
; i
++)
805 len
+= sprintf(buffer
+ len
, " %s", ax2asc(&nr_neigh
->digipeat
->calls
[i
]));
808 len
+= sprintf(buffer
+ len
, "\n");
817 if (pos
> offset
+ length
)
823 *start
= buffer
+ (offset
- begin
);
824 len
-= (offset
- begin
);
826 if (len
> length
) len
= length
;
834 * Free all memory associated with the nodes and routes lists.
836 void nr_rt_free(void)
838 struct nr_neigh
*s
, *nr_neigh
= nr_neigh_list
;
839 struct nr_node
*t
, *nr_node
= nr_node_list
;
841 while (nr_node
!= NULL
) {
843 nr_node
= nr_node
->next
;
848 while (nr_neigh
!= NULL
) {
850 nr_neigh
= nr_neigh
->next
;