xref: /openbmc/linux/net/netrom/af_netrom.c (revision 6a87e0f0)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  *
4  * Copyright Jonathan Naylor G4KLX (g4klx@g4klx.demon.co.uk)
5  * Copyright Alan Cox GW4PTS (alan@lxorguk.ukuu.org.uk)
6  * Copyright Darryl Miles G7LED (dlm@g7led.demon.co.uk)
7  */
8 #include <linux/module.h>
9 #include <linux/moduleparam.h>
10 #include <linux/capability.h>
11 #include <linux/errno.h>
12 #include <linux/types.h>
13 #include <linux/socket.h>
14 #include <linux/in.h>
15 #include <linux/slab.h>
16 #include <linux/kernel.h>
17 #include <linux/sched/signal.h>
18 #include <linux/timer.h>
19 #include <linux/string.h>
20 #include <linux/sockios.h>
21 #include <linux/net.h>
22 #include <linux/stat.h>
23 #include <net/ax25.h>
24 #include <linux/inet.h>
25 #include <linux/netdevice.h>
26 #include <linux/if_arp.h>
27 #include <linux/skbuff.h>
28 #include <net/net_namespace.h>
29 #include <net/sock.h>
30 #include <linux/uaccess.h>
31 #include <linux/fcntl.h>
32 #include <linux/termios.h>	/* For TIOCINQ/OUTQ */
33 #include <linux/mm.h>
34 #include <linux/interrupt.h>
35 #include <linux/notifier.h>
36 #include <net/netrom.h>
37 #include <linux/proc_fs.h>
38 #include <linux/seq_file.h>
39 #include <net/ip.h>
40 #include <net/tcp_states.h>
41 #include <net/arp.h>
42 #include <linux/init.h>
43 
44 static int nr_ndevs = 4;
45 
46 int sysctl_netrom_default_path_quality            = NR_DEFAULT_QUAL;
47 int sysctl_netrom_obsolescence_count_initialiser  = NR_DEFAULT_OBS;
48 int sysctl_netrom_network_ttl_initialiser         = NR_DEFAULT_TTL;
49 int sysctl_netrom_transport_timeout               = NR_DEFAULT_T1;
50 int sysctl_netrom_transport_maximum_tries         = NR_DEFAULT_N2;
51 int sysctl_netrom_transport_acknowledge_delay     = NR_DEFAULT_T2;
52 int sysctl_netrom_transport_busy_delay            = NR_DEFAULT_T4;
53 int sysctl_netrom_transport_requested_window_size = NR_DEFAULT_WINDOW;
54 int sysctl_netrom_transport_no_activity_timeout   = NR_DEFAULT_IDLE;
55 int sysctl_netrom_routing_control                 = NR_DEFAULT_ROUTING;
56 int sysctl_netrom_link_fails_count                = NR_DEFAULT_FAILS;
57 int sysctl_netrom_reset_circuit                   = NR_DEFAULT_RESET;
58 
59 static unsigned short circuit = 0x101;
60 
61 static HLIST_HEAD(nr_list);
62 static DEFINE_SPINLOCK(nr_list_lock);
63 
64 static const struct proto_ops nr_proto_ops;
65 
66 /*
67  * NETROM network devices are virtual network devices encapsulating NETROM
68  * frames into AX.25 which will be sent through an AX.25 device, so form a
69  * special "super class" of normal net devices; split their locks off into a
70  * separate class since they always nest.
71  */
72 static struct lock_class_key nr_netdev_xmit_lock_key;
73 static struct lock_class_key nr_netdev_addr_lock_key;
74 
75 static void nr_set_lockdep_one(struct net_device *dev,
76 			       struct netdev_queue *txq,
77 			       void *_unused)
78 {
79 	lockdep_set_class(&txq->_xmit_lock, &nr_netdev_xmit_lock_key);
80 }
81 
82 static void nr_set_lockdep_key(struct net_device *dev)
83 {
84 	lockdep_set_class(&dev->addr_list_lock, &nr_netdev_addr_lock_key);
85 	netdev_for_each_tx_queue(dev, nr_set_lockdep_one, NULL);
86 }
87 
88 /*
89  *	Socket removal during an interrupt is now safe.
90  */
91 static void nr_remove_socket(struct sock *sk)
92 {
93 	spin_lock_bh(&nr_list_lock);
94 	sk_del_node_init(sk);
95 	spin_unlock_bh(&nr_list_lock);
96 }
97 
98 /*
99  *	Kill all bound sockets on a dropped device.
100  */
101 static void nr_kill_by_device(struct net_device *dev)
102 {
103 	struct sock *s;
104 
105 	spin_lock_bh(&nr_list_lock);
106 	sk_for_each(s, &nr_list)
107 		if (nr_sk(s)->device == dev)
108 			nr_disconnect(s, ENETUNREACH);
109 	spin_unlock_bh(&nr_list_lock);
110 }
111 
112 /*
113  *	Handle device status changes.
114  */
115 static int nr_device_event(struct notifier_block *this, unsigned long event, void *ptr)
116 {
117 	struct net_device *dev = netdev_notifier_info_to_dev(ptr);
118 
119 	if (!net_eq(dev_net(dev), &init_net))
120 		return NOTIFY_DONE;
121 
122 	if (event != NETDEV_DOWN)
123 		return NOTIFY_DONE;
124 
125 	nr_kill_by_device(dev);
126 	nr_rt_device_down(dev);
127 
128 	return NOTIFY_DONE;
129 }
130 
131 /*
132  *	Add a socket to the bound sockets list.
133  */
134 static void nr_insert_socket(struct sock *sk)
135 {
136 	spin_lock_bh(&nr_list_lock);
137 	sk_add_node(sk, &nr_list);
138 	spin_unlock_bh(&nr_list_lock);
139 }
140 
141 /*
142  *	Find a socket that wants to accept the Connect Request we just
143  *	received.
144  */
145 static struct sock *nr_find_listener(ax25_address *addr)
146 {
147 	struct sock *s;
148 
149 	spin_lock_bh(&nr_list_lock);
150 	sk_for_each(s, &nr_list)
151 		if (!ax25cmp(&nr_sk(s)->source_addr, addr) &&
152 		    s->sk_state == TCP_LISTEN) {
153 			sock_hold(s);
154 			goto found;
155 		}
156 	s = NULL;
157 found:
158 	spin_unlock_bh(&nr_list_lock);
159 	return s;
160 }
161 
162 /*
163  *	Find a connected NET/ROM socket given my circuit IDs.
164  */
165 static struct sock *nr_find_socket(unsigned char index, unsigned char id)
166 {
167 	struct sock *s;
168 
169 	spin_lock_bh(&nr_list_lock);
170 	sk_for_each(s, &nr_list) {
171 		struct nr_sock *nr = nr_sk(s);
172 
173 		if (nr->my_index == index && nr->my_id == id) {
174 			sock_hold(s);
175 			goto found;
176 		}
177 	}
178 	s = NULL;
179 found:
180 	spin_unlock_bh(&nr_list_lock);
181 	return s;
182 }
183 
184 /*
185  *	Find a connected NET/ROM socket given their circuit IDs.
186  */
187 static struct sock *nr_find_peer(unsigned char index, unsigned char id,
188 	ax25_address *dest)
189 {
190 	struct sock *s;
191 
192 	spin_lock_bh(&nr_list_lock);
193 	sk_for_each(s, &nr_list) {
194 		struct nr_sock *nr = nr_sk(s);
195 
196 		if (nr->your_index == index && nr->your_id == id &&
197 		    !ax25cmp(&nr->dest_addr, dest)) {
198 			sock_hold(s);
199 			goto found;
200 		}
201 	}
202 	s = NULL;
203 found:
204 	spin_unlock_bh(&nr_list_lock);
205 	return s;
206 }
207 
208 /*
209  *	Find next free circuit ID.
210  */
211 static unsigned short nr_find_next_circuit(void)
212 {
213 	unsigned short id = circuit;
214 	unsigned char i, j;
215 	struct sock *sk;
216 
217 	for (;;) {
218 		i = id / 256;
219 		j = id % 256;
220 
221 		if (i != 0 && j != 0) {
222 			if ((sk=nr_find_socket(i, j)) == NULL)
223 				break;
224 			sock_put(sk);
225 		}
226 
227 		id++;
228 	}
229 
230 	return id;
231 }
232 
233 /*
234  *	Deferred destroy.
235  */
236 void nr_destroy_socket(struct sock *);
237 
238 /*
239  *	Handler for deferred kills.
240  */
241 static void nr_destroy_timer(struct timer_list *t)
242 {
243 	struct sock *sk = from_timer(sk, t, sk_timer);
244 	bh_lock_sock(sk);
245 	sock_hold(sk);
246 	nr_destroy_socket(sk);
247 	bh_unlock_sock(sk);
248 	sock_put(sk);
249 }
250 
251 /*
252  *	This is called from user mode and the timers. Thus it protects itself
253  *	against interrupt users but doesn't worry about being called during
254  *	work. Once it is removed from the queue no interrupt or bottom half
255  *	will touch it and we are (fairly 8-) ) safe.
256  */
257 void nr_destroy_socket(struct sock *sk)
258 {
259 	struct sk_buff *skb;
260 
261 	nr_remove_socket(sk);
262 
263 	nr_stop_heartbeat(sk);
264 	nr_stop_t1timer(sk);
265 	nr_stop_t2timer(sk);
266 	nr_stop_t4timer(sk);
267 	nr_stop_idletimer(sk);
268 
269 	nr_clear_queues(sk);		/* Flush the queues */
270 
271 	while ((skb = skb_dequeue(&sk->sk_receive_queue)) != NULL) {
272 		if (skb->sk != sk) { /* A pending connection */
273 			/* Queue the unaccepted socket for death */
274 			sock_set_flag(skb->sk, SOCK_DEAD);
275 			nr_start_heartbeat(skb->sk);
276 			nr_sk(skb->sk)->state = NR_STATE_0;
277 		}
278 
279 		kfree_skb(skb);
280 	}
281 
282 	if (sk_has_allocations(sk)) {
283 		/* Defer: outstanding buffers */
284 		sk->sk_timer.function = nr_destroy_timer;
285 		sk->sk_timer.expires  = jiffies + 2 * HZ;
286 		add_timer(&sk->sk_timer);
287 	} else
288 		sock_put(sk);
289 }
290 
291 /*
292  *	Handling for system calls applied via the various interfaces to a
293  *	NET/ROM socket object.
294  */
295 
296 static int nr_setsockopt(struct socket *sock, int level, int optname,
297 		sockptr_t optval, unsigned int optlen)
298 {
299 	struct sock *sk = sock->sk;
300 	struct nr_sock *nr = nr_sk(sk);
301 	unsigned int opt;
302 
303 	if (level != SOL_NETROM)
304 		return -ENOPROTOOPT;
305 
306 	if (optlen < sizeof(unsigned int))
307 		return -EINVAL;
308 
309 	if (copy_from_sockptr(&opt, optval, sizeof(opt)))
310 		return -EFAULT;
311 
312 	switch (optname) {
313 	case NETROM_T1:
314 		if (opt < 1 || opt > UINT_MAX / HZ)
315 			return -EINVAL;
316 		nr->t1 = opt * HZ;
317 		return 0;
318 
319 	case NETROM_T2:
320 		if (opt < 1 || opt > UINT_MAX / HZ)
321 			return -EINVAL;
322 		nr->t2 = opt * HZ;
323 		return 0;
324 
325 	case NETROM_N2:
326 		if (opt < 1 || opt > 31)
327 			return -EINVAL;
328 		nr->n2 = opt;
329 		return 0;
330 
331 	case NETROM_T4:
332 		if (opt < 1 || opt > UINT_MAX / HZ)
333 			return -EINVAL;
334 		nr->t4 = opt * HZ;
335 		return 0;
336 
337 	case NETROM_IDLE:
338 		if (opt > UINT_MAX / (60 * HZ))
339 			return -EINVAL;
340 		nr->idle = opt * 60 * HZ;
341 		return 0;
342 
343 	default:
344 		return -ENOPROTOOPT;
345 	}
346 }
347 
348 static int nr_getsockopt(struct socket *sock, int level, int optname,
349 	char __user *optval, int __user *optlen)
350 {
351 	struct sock *sk = sock->sk;
352 	struct nr_sock *nr = nr_sk(sk);
353 	int val = 0;
354 	int len;
355 
356 	if (level != SOL_NETROM)
357 		return -ENOPROTOOPT;
358 
359 	if (get_user(len, optlen))
360 		return -EFAULT;
361 
362 	if (len < 0)
363 		return -EINVAL;
364 
365 	switch (optname) {
366 	case NETROM_T1:
367 		val = nr->t1 / HZ;
368 		break;
369 
370 	case NETROM_T2:
371 		val = nr->t2 / HZ;
372 		break;
373 
374 	case NETROM_N2:
375 		val = nr->n2;
376 		break;
377 
378 	case NETROM_T4:
379 		val = nr->t4 / HZ;
380 		break;
381 
382 	case NETROM_IDLE:
383 		val = nr->idle / (60 * HZ);
384 		break;
385 
386 	default:
387 		return -ENOPROTOOPT;
388 	}
389 
390 	len = min_t(unsigned int, len, sizeof(int));
391 
392 	if (put_user(len, optlen))
393 		return -EFAULT;
394 
395 	return copy_to_user(optval, &val, len) ? -EFAULT : 0;
396 }
397 
398 static int nr_listen(struct socket *sock, int backlog)
399 {
400 	struct sock *sk = sock->sk;
401 
402 	lock_sock(sk);
403 	if (sock->state != SS_UNCONNECTED) {
404 		release_sock(sk);
405 		return -EINVAL;
406 	}
407 
408 	if (sk->sk_state != TCP_LISTEN) {
409 		memset(&nr_sk(sk)->user_addr, 0, AX25_ADDR_LEN);
410 		sk->sk_max_ack_backlog = backlog;
411 		sk->sk_state           = TCP_LISTEN;
412 		release_sock(sk);
413 		return 0;
414 	}
415 	release_sock(sk);
416 
417 	return -EOPNOTSUPP;
418 }
419 
420 static struct proto nr_proto = {
421 	.name	  = "NETROM",
422 	.owner	  = THIS_MODULE,
423 	.obj_size = sizeof(struct nr_sock),
424 };
425 
426 static int nr_create(struct net *net, struct socket *sock, int protocol,
427 		     int kern)
428 {
429 	struct sock *sk;
430 	struct nr_sock *nr;
431 
432 	if (!net_eq(net, &init_net))
433 		return -EAFNOSUPPORT;
434 
435 	if (sock->type != SOCK_SEQPACKET || protocol != 0)
436 		return -ESOCKTNOSUPPORT;
437 
438 	sk = sk_alloc(net, PF_NETROM, GFP_ATOMIC, &nr_proto, kern);
439 	if (sk  == NULL)
440 		return -ENOMEM;
441 
442 	nr = nr_sk(sk);
443 
444 	sock_init_data(sock, sk);
445 
446 	sock->ops    = &nr_proto_ops;
447 	sk->sk_protocol = protocol;
448 
449 	skb_queue_head_init(&nr->ack_queue);
450 	skb_queue_head_init(&nr->reseq_queue);
451 	skb_queue_head_init(&nr->frag_queue);
452 
453 	nr_init_timers(sk);
454 
455 	nr->t1     =
456 		msecs_to_jiffies(sysctl_netrom_transport_timeout);
457 	nr->t2     =
458 		msecs_to_jiffies(sysctl_netrom_transport_acknowledge_delay);
459 	nr->n2     =
460 		msecs_to_jiffies(sysctl_netrom_transport_maximum_tries);
461 	nr->t4     =
462 		msecs_to_jiffies(sysctl_netrom_transport_busy_delay);
463 	nr->idle   =
464 		msecs_to_jiffies(sysctl_netrom_transport_no_activity_timeout);
465 	nr->window = sysctl_netrom_transport_requested_window_size;
466 
467 	nr->bpqext = 1;
468 	nr->state  = NR_STATE_0;
469 
470 	return 0;
471 }
472 
473 static struct sock *nr_make_new(struct sock *osk)
474 {
475 	struct sock *sk;
476 	struct nr_sock *nr, *onr;
477 
478 	if (osk->sk_type != SOCK_SEQPACKET)
479 		return NULL;
480 
481 	sk = sk_alloc(sock_net(osk), PF_NETROM, GFP_ATOMIC, osk->sk_prot, 0);
482 	if (sk == NULL)
483 		return NULL;
484 
485 	nr = nr_sk(sk);
486 
487 	sock_init_data(NULL, sk);
488 
489 	sk->sk_type     = osk->sk_type;
490 	sk->sk_priority = osk->sk_priority;
491 	sk->sk_protocol = osk->sk_protocol;
492 	sk->sk_rcvbuf   = osk->sk_rcvbuf;
493 	sk->sk_sndbuf   = osk->sk_sndbuf;
494 	sk->sk_state    = TCP_ESTABLISHED;
495 	sock_copy_flags(sk, osk);
496 
497 	skb_queue_head_init(&nr->ack_queue);
498 	skb_queue_head_init(&nr->reseq_queue);
499 	skb_queue_head_init(&nr->frag_queue);
500 
501 	nr_init_timers(sk);
502 
503 	onr = nr_sk(osk);
504 
505 	nr->t1      = onr->t1;
506 	nr->t2      = onr->t2;
507 	nr->n2      = onr->n2;
508 	nr->t4      = onr->t4;
509 	nr->idle    = onr->idle;
510 	nr->window  = onr->window;
511 
512 	nr->device  = onr->device;
513 	nr->bpqext  = onr->bpqext;
514 
515 	return sk;
516 }
517 
518 static int nr_release(struct socket *sock)
519 {
520 	struct sock *sk = sock->sk;
521 	struct nr_sock *nr;
522 
523 	if (sk == NULL) return 0;
524 
525 	sock_hold(sk);
526 	sock_orphan(sk);
527 	lock_sock(sk);
528 	nr = nr_sk(sk);
529 
530 	switch (nr->state) {
531 	case NR_STATE_0:
532 	case NR_STATE_1:
533 	case NR_STATE_2:
534 		nr_disconnect(sk, 0);
535 		nr_destroy_socket(sk);
536 		break;
537 
538 	case NR_STATE_3:
539 		nr_clear_queues(sk);
540 		nr->n2count = 0;
541 		nr_write_internal(sk, NR_DISCREQ);
542 		nr_start_t1timer(sk);
543 		nr_stop_t2timer(sk);
544 		nr_stop_t4timer(sk);
545 		nr_stop_idletimer(sk);
546 		nr->state    = NR_STATE_2;
547 		sk->sk_state    = TCP_CLOSE;
548 		sk->sk_shutdown |= SEND_SHUTDOWN;
549 		sk->sk_state_change(sk);
550 		sock_set_flag(sk, SOCK_DESTROY);
551 		break;
552 
553 	default:
554 		break;
555 	}
556 
557 	sock->sk   = NULL;
558 	release_sock(sk);
559 	sock_put(sk);
560 
561 	return 0;
562 }
563 
564 static int nr_bind(struct socket *sock, struct sockaddr *uaddr, int addr_len)
565 {
566 	struct sock *sk = sock->sk;
567 	struct nr_sock *nr = nr_sk(sk);
568 	struct full_sockaddr_ax25 *addr = (struct full_sockaddr_ax25 *)uaddr;
569 	struct net_device *dev;
570 	ax25_uid_assoc *user;
571 	ax25_address *source;
572 
573 	lock_sock(sk);
574 	if (!sock_flag(sk, SOCK_ZAPPED)) {
575 		release_sock(sk);
576 		return -EINVAL;
577 	}
578 	if (addr_len < sizeof(struct sockaddr_ax25) || addr_len > sizeof(struct full_sockaddr_ax25)) {
579 		release_sock(sk);
580 		return -EINVAL;
581 	}
582 	if (addr_len < (addr->fsa_ax25.sax25_ndigis * sizeof(ax25_address) + sizeof(struct sockaddr_ax25))) {
583 		release_sock(sk);
584 		return -EINVAL;
585 	}
586 	if (addr->fsa_ax25.sax25_family != AF_NETROM) {
587 		release_sock(sk);
588 		return -EINVAL;
589 	}
590 	if ((dev = nr_dev_get(&addr->fsa_ax25.sax25_call)) == NULL) {
591 		release_sock(sk);
592 		return -EADDRNOTAVAIL;
593 	}
594 
595 	/*
596 	 * Only the super user can set an arbitrary user callsign.
597 	 */
598 	if (addr->fsa_ax25.sax25_ndigis == 1) {
599 		if (!capable(CAP_NET_BIND_SERVICE)) {
600 			dev_put(dev);
601 			release_sock(sk);
602 			return -EPERM;
603 		}
604 		nr->user_addr   = addr->fsa_digipeater[0];
605 		nr->source_addr = addr->fsa_ax25.sax25_call;
606 	} else {
607 		source = &addr->fsa_ax25.sax25_call;
608 
609 		user = ax25_findbyuid(current_euid());
610 		if (user) {
611 			nr->user_addr   = user->call;
612 			ax25_uid_put(user);
613 		} else {
614 			if (ax25_uid_policy && !capable(CAP_NET_BIND_SERVICE)) {
615 				release_sock(sk);
616 				dev_put(dev);
617 				return -EPERM;
618 			}
619 			nr->user_addr   = *source;
620 		}
621 
622 		nr->source_addr = *source;
623 	}
624 
625 	nr->device = dev;
626 	nr_insert_socket(sk);
627 
628 	sock_reset_flag(sk, SOCK_ZAPPED);
629 	dev_put(dev);
630 	release_sock(sk);
631 
632 	return 0;
633 }
634 
635 static int nr_connect(struct socket *sock, struct sockaddr *uaddr,
636 	int addr_len, int flags)
637 {
638 	struct sock *sk = sock->sk;
639 	struct nr_sock *nr = nr_sk(sk);
640 	struct sockaddr_ax25 *addr = (struct sockaddr_ax25 *)uaddr;
641 	const ax25_address *source = NULL;
642 	ax25_uid_assoc *user;
643 	struct net_device *dev;
644 	int err = 0;
645 
646 	lock_sock(sk);
647 	if (sk->sk_state == TCP_ESTABLISHED && sock->state == SS_CONNECTING) {
648 		sock->state = SS_CONNECTED;
649 		goto out_release;	/* Connect completed during a ERESTARTSYS event */
650 	}
651 
652 	if (sk->sk_state == TCP_CLOSE && sock->state == SS_CONNECTING) {
653 		sock->state = SS_UNCONNECTED;
654 		err = -ECONNREFUSED;
655 		goto out_release;
656 	}
657 
658 	if (sk->sk_state == TCP_ESTABLISHED) {
659 		err = -EISCONN;	/* No reconnect on a seqpacket socket */
660 		goto out_release;
661 	}
662 
663 	sk->sk_state   = TCP_CLOSE;
664 	sock->state = SS_UNCONNECTED;
665 
666 	if (addr_len != sizeof(struct sockaddr_ax25) && addr_len != sizeof(struct full_sockaddr_ax25)) {
667 		err = -EINVAL;
668 		goto out_release;
669 	}
670 	if (addr->sax25_family != AF_NETROM) {
671 		err = -EINVAL;
672 		goto out_release;
673 	}
674 	if (sock_flag(sk, SOCK_ZAPPED)) {	/* Must bind first - autobinding in this may or may not work */
675 		sock_reset_flag(sk, SOCK_ZAPPED);
676 
677 		if ((dev = nr_dev_first()) == NULL) {
678 			err = -ENETUNREACH;
679 			goto out_release;
680 		}
681 		source = (const ax25_address *)dev->dev_addr;
682 
683 		user = ax25_findbyuid(current_euid());
684 		if (user) {
685 			nr->user_addr   = user->call;
686 			ax25_uid_put(user);
687 		} else {
688 			if (ax25_uid_policy && !capable(CAP_NET_ADMIN)) {
689 				dev_put(dev);
690 				err = -EPERM;
691 				goto out_release;
692 			}
693 			nr->user_addr   = *source;
694 		}
695 
696 		nr->source_addr = *source;
697 		nr->device      = dev;
698 
699 		dev_put(dev);
700 		nr_insert_socket(sk);		/* Finish the bind */
701 	}
702 
703 	nr->dest_addr = addr->sax25_call;
704 
705 	release_sock(sk);
706 	circuit = nr_find_next_circuit();
707 	lock_sock(sk);
708 
709 	nr->my_index = circuit / 256;
710 	nr->my_id    = circuit % 256;
711 
712 	circuit++;
713 
714 	/* Move to connecting socket, start sending Connect Requests */
715 	sock->state  = SS_CONNECTING;
716 	sk->sk_state = TCP_SYN_SENT;
717 
718 	nr_establish_data_link(sk);
719 
720 	nr->state = NR_STATE_1;
721 
722 	nr_start_heartbeat(sk);
723 
724 	/* Now the loop */
725 	if (sk->sk_state != TCP_ESTABLISHED && (flags & O_NONBLOCK)) {
726 		err = -EINPROGRESS;
727 		goto out_release;
728 	}
729 
730 	/*
731 	 * A Connect Ack with Choke or timeout or failed routing will go to
732 	 * closed.
733 	 */
734 	if (sk->sk_state == TCP_SYN_SENT) {
735 		DEFINE_WAIT(wait);
736 
737 		for (;;) {
738 			prepare_to_wait(sk_sleep(sk), &wait,
739 					TASK_INTERRUPTIBLE);
740 			if (sk->sk_state != TCP_SYN_SENT)
741 				break;
742 			if (!signal_pending(current)) {
743 				release_sock(sk);
744 				schedule();
745 				lock_sock(sk);
746 				continue;
747 			}
748 			err = -ERESTARTSYS;
749 			break;
750 		}
751 		finish_wait(sk_sleep(sk), &wait);
752 		if (err)
753 			goto out_release;
754 	}
755 
756 	if (sk->sk_state != TCP_ESTABLISHED) {
757 		sock->state = SS_UNCONNECTED;
758 		err = sock_error(sk);	/* Always set at this point */
759 		goto out_release;
760 	}
761 
762 	sock->state = SS_CONNECTED;
763 
764 out_release:
765 	release_sock(sk);
766 
767 	return err;
768 }
769 
770 static int nr_accept(struct socket *sock, struct socket *newsock, int flags,
771 		     bool kern)
772 {
773 	struct sk_buff *skb;
774 	struct sock *newsk;
775 	DEFINE_WAIT(wait);
776 	struct sock *sk;
777 	int err = 0;
778 
779 	if ((sk = sock->sk) == NULL)
780 		return -EINVAL;
781 
782 	lock_sock(sk);
783 	if (sk->sk_type != SOCK_SEQPACKET) {
784 		err = -EOPNOTSUPP;
785 		goto out_release;
786 	}
787 
788 	if (sk->sk_state != TCP_LISTEN) {
789 		err = -EINVAL;
790 		goto out_release;
791 	}
792 
793 	/*
794 	 *	The write queue this time is holding sockets ready to use
795 	 *	hooked into the SABM we saved
796 	 */
797 	for (;;) {
798 		prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
799 		skb = skb_dequeue(&sk->sk_receive_queue);
800 		if (skb)
801 			break;
802 
803 		if (flags & O_NONBLOCK) {
804 			err = -EWOULDBLOCK;
805 			break;
806 		}
807 		if (!signal_pending(current)) {
808 			release_sock(sk);
809 			schedule();
810 			lock_sock(sk);
811 			continue;
812 		}
813 		err = -ERESTARTSYS;
814 		break;
815 	}
816 	finish_wait(sk_sleep(sk), &wait);
817 	if (err)
818 		goto out_release;
819 
820 	newsk = skb->sk;
821 	sock_graft(newsk, newsock);
822 
823 	/* Now attach up the new socket */
824 	kfree_skb(skb);
825 	sk_acceptq_removed(sk);
826 
827 out_release:
828 	release_sock(sk);
829 
830 	return err;
831 }
832 
833 static int nr_getname(struct socket *sock, struct sockaddr *uaddr,
834 	int peer)
835 {
836 	struct full_sockaddr_ax25 *sax = (struct full_sockaddr_ax25 *)uaddr;
837 	struct sock *sk = sock->sk;
838 	struct nr_sock *nr = nr_sk(sk);
839 	int uaddr_len;
840 
841 	memset(&sax->fsa_ax25, 0, sizeof(struct sockaddr_ax25));
842 
843 	lock_sock(sk);
844 	if (peer != 0) {
845 		if (sk->sk_state != TCP_ESTABLISHED) {
846 			release_sock(sk);
847 			return -ENOTCONN;
848 		}
849 		sax->fsa_ax25.sax25_family = AF_NETROM;
850 		sax->fsa_ax25.sax25_ndigis = 1;
851 		sax->fsa_ax25.sax25_call   = nr->user_addr;
852 		memset(sax->fsa_digipeater, 0, sizeof(sax->fsa_digipeater));
853 		sax->fsa_digipeater[0]     = nr->dest_addr;
854 		uaddr_len = sizeof(struct full_sockaddr_ax25);
855 	} else {
856 		sax->fsa_ax25.sax25_family = AF_NETROM;
857 		sax->fsa_ax25.sax25_ndigis = 0;
858 		sax->fsa_ax25.sax25_call   = nr->source_addr;
859 		uaddr_len = sizeof(struct sockaddr_ax25);
860 	}
861 	release_sock(sk);
862 
863 	return uaddr_len;
864 }
865 
866 int nr_rx_frame(struct sk_buff *skb, struct net_device *dev)
867 {
868 	struct sock *sk;
869 	struct sock *make;
870 	struct nr_sock *nr_make;
871 	ax25_address *src, *dest, *user;
872 	unsigned short circuit_index, circuit_id;
873 	unsigned short peer_circuit_index, peer_circuit_id;
874 	unsigned short frametype, flags, window, timeout;
875 	int ret;
876 
877 	skb_orphan(skb);
878 
879 	/*
880 	 *	skb->data points to the netrom frame start
881 	 */
882 
883 	src  = (ax25_address *)(skb->data + 0);
884 	dest = (ax25_address *)(skb->data + 7);
885 
886 	circuit_index      = skb->data[15];
887 	circuit_id         = skb->data[16];
888 	peer_circuit_index = skb->data[17];
889 	peer_circuit_id    = skb->data[18];
890 	frametype          = skb->data[19] & 0x0F;
891 	flags              = skb->data[19] & 0xF0;
892 
893 	/*
894 	 * Check for an incoming IP over NET/ROM frame.
895 	 */
896 	if (frametype == NR_PROTOEXT &&
897 	    circuit_index == NR_PROTO_IP && circuit_id == NR_PROTO_IP) {
898 		skb_pull(skb, NR_NETWORK_LEN + NR_TRANSPORT_LEN);
899 		skb_reset_transport_header(skb);
900 
901 		return nr_rx_ip(skb, dev);
902 	}
903 
904 	/*
905 	 * Find an existing socket connection, based on circuit ID, if it's
906 	 * a Connect Request base it on their circuit ID.
907 	 *
908 	 * Circuit ID 0/0 is not valid but it could still be a "reset" for a
909 	 * circuit that no longer exists at the other end ...
910 	 */
911 
912 	sk = NULL;
913 
914 	if (circuit_index == 0 && circuit_id == 0) {
915 		if (frametype == NR_CONNACK && flags == NR_CHOKE_FLAG)
916 			sk = nr_find_peer(peer_circuit_index, peer_circuit_id, src);
917 	} else {
918 		if (frametype == NR_CONNREQ)
919 			sk = nr_find_peer(circuit_index, circuit_id, src);
920 		else
921 			sk = nr_find_socket(circuit_index, circuit_id);
922 	}
923 
924 	if (sk != NULL) {
925 		bh_lock_sock(sk);
926 		skb_reset_transport_header(skb);
927 
928 		if (frametype == NR_CONNACK && skb->len == 22)
929 			nr_sk(sk)->bpqext = 1;
930 		else
931 			nr_sk(sk)->bpqext = 0;
932 
933 		ret = nr_process_rx_frame(sk, skb);
934 		bh_unlock_sock(sk);
935 		sock_put(sk);
936 		return ret;
937 	}
938 
939 	/*
940 	 * Now it should be a CONNREQ.
941 	 */
942 	if (frametype != NR_CONNREQ) {
943 		/*
944 		 * Here it would be nice to be able to send a reset but
945 		 * NET/ROM doesn't have one.  We've tried to extend the protocol
946 		 * by sending NR_CONNACK | NR_CHOKE_FLAGS replies but that
947 		 * apparently kills BPQ boxes... :-(
948 		 * So now we try to follow the established behaviour of
949 		 * G8PZT's Xrouter which is sending packets with command type 7
950 		 * as an extension of the protocol.
951 		 */
952 		if (sysctl_netrom_reset_circuit &&
953 		    (frametype != NR_RESET || flags != 0))
954 			nr_transmit_reset(skb, 1);
955 
956 		return 0;
957 	}
958 
959 	sk = nr_find_listener(dest);
960 
961 	user = (ax25_address *)(skb->data + 21);
962 
963 	if (sk == NULL || sk_acceptq_is_full(sk) ||
964 	    (make = nr_make_new(sk)) == NULL) {
965 		nr_transmit_refusal(skb, 0);
966 		if (sk)
967 			sock_put(sk);
968 		return 0;
969 	}
970 
971 	bh_lock_sock(sk);
972 
973 	window = skb->data[20];
974 
975 	sock_hold(make);
976 	skb->sk             = make;
977 	skb->destructor     = sock_efree;
978 	make->sk_state	    = TCP_ESTABLISHED;
979 
980 	/* Fill in his circuit details */
981 	nr_make = nr_sk(make);
982 	nr_make->source_addr = *dest;
983 	nr_make->dest_addr   = *src;
984 	nr_make->user_addr   = *user;
985 
986 	nr_make->your_index  = circuit_index;
987 	nr_make->your_id     = circuit_id;
988 
989 	bh_unlock_sock(sk);
990 	circuit = nr_find_next_circuit();
991 	bh_lock_sock(sk);
992 
993 	nr_make->my_index    = circuit / 256;
994 	nr_make->my_id       = circuit % 256;
995 
996 	circuit++;
997 
998 	/* Window negotiation */
999 	if (window < nr_make->window)
1000 		nr_make->window = window;
1001 
1002 	/* L4 timeout negotiation */
1003 	if (skb->len == 37) {
1004 		timeout = skb->data[36] * 256 + skb->data[35];
1005 		if (timeout * HZ < nr_make->t1)
1006 			nr_make->t1 = timeout * HZ;
1007 		nr_make->bpqext = 1;
1008 	} else {
1009 		nr_make->bpqext = 0;
1010 	}
1011 
1012 	nr_write_internal(make, NR_CONNACK);
1013 
1014 	nr_make->condition = 0x00;
1015 	nr_make->vs        = 0;
1016 	nr_make->va        = 0;
1017 	nr_make->vr        = 0;
1018 	nr_make->vl        = 0;
1019 	nr_make->state     = NR_STATE_3;
1020 	sk_acceptq_added(sk);
1021 	skb_queue_head(&sk->sk_receive_queue, skb);
1022 
1023 	if (!sock_flag(sk, SOCK_DEAD))
1024 		sk->sk_data_ready(sk);
1025 
1026 	bh_unlock_sock(sk);
1027 	sock_put(sk);
1028 
1029 	nr_insert_socket(make);
1030 
1031 	nr_start_heartbeat(make);
1032 	nr_start_idletimer(make);
1033 
1034 	return 1;
1035 }
1036 
1037 static int nr_sendmsg(struct socket *sock, struct msghdr *msg, size_t len)
1038 {
1039 	struct sock *sk = sock->sk;
1040 	struct nr_sock *nr = nr_sk(sk);
1041 	DECLARE_SOCKADDR(struct sockaddr_ax25 *, usax, msg->msg_name);
1042 	int err;
1043 	struct sockaddr_ax25 sax;
1044 	struct sk_buff *skb;
1045 	unsigned char *asmptr;
1046 	int size;
1047 
1048 	if (msg->msg_flags & ~(MSG_DONTWAIT|MSG_EOR|MSG_CMSG_COMPAT))
1049 		return -EINVAL;
1050 
1051 	lock_sock(sk);
1052 	if (sock_flag(sk, SOCK_ZAPPED)) {
1053 		err = -EADDRNOTAVAIL;
1054 		goto out;
1055 	}
1056 
1057 	if (sk->sk_shutdown & SEND_SHUTDOWN) {
1058 		send_sig(SIGPIPE, current, 0);
1059 		err = -EPIPE;
1060 		goto out;
1061 	}
1062 
1063 	if (nr->device == NULL) {
1064 		err = -ENETUNREACH;
1065 		goto out;
1066 	}
1067 
1068 	if (usax) {
1069 		if (msg->msg_namelen < sizeof(sax)) {
1070 			err = -EINVAL;
1071 			goto out;
1072 		}
1073 		sax = *usax;
1074 		if (ax25cmp(&nr->dest_addr, &sax.sax25_call) != 0) {
1075 			err = -EISCONN;
1076 			goto out;
1077 		}
1078 		if (sax.sax25_family != AF_NETROM) {
1079 			err = -EINVAL;
1080 			goto out;
1081 		}
1082 	} else {
1083 		if (sk->sk_state != TCP_ESTABLISHED) {
1084 			err = -ENOTCONN;
1085 			goto out;
1086 		}
1087 		sax.sax25_family = AF_NETROM;
1088 		sax.sax25_call   = nr->dest_addr;
1089 	}
1090 
1091 	/* Build a packet - the conventional user limit is 236 bytes. We can
1092 	   do ludicrously large NetROM frames but must not overflow */
1093 	if (len > 65536) {
1094 		err = -EMSGSIZE;
1095 		goto out;
1096 	}
1097 
1098 	size = len + NR_NETWORK_LEN + NR_TRANSPORT_LEN;
1099 
1100 	if ((skb = sock_alloc_send_skb(sk, size, msg->msg_flags & MSG_DONTWAIT, &err)) == NULL)
1101 		goto out;
1102 
1103 	skb_reserve(skb, size - len);
1104 	skb_reset_transport_header(skb);
1105 
1106 	/*
1107 	 *	Push down the NET/ROM header
1108 	 */
1109 
1110 	asmptr = skb_push(skb, NR_TRANSPORT_LEN);
1111 
1112 	/* Build a NET/ROM Transport header */
1113 
1114 	*asmptr++ = nr->your_index;
1115 	*asmptr++ = nr->your_id;
1116 	*asmptr++ = 0;		/* To be filled in later */
1117 	*asmptr++ = 0;		/*      Ditto            */
1118 	*asmptr++ = NR_INFO;
1119 
1120 	/*
1121 	 *	Put the data on the end
1122 	 */
1123 	skb_put(skb, len);
1124 
1125 	/* User data follows immediately after the NET/ROM transport header */
1126 	if (memcpy_from_msg(skb_transport_header(skb), msg, len)) {
1127 		kfree_skb(skb);
1128 		err = -EFAULT;
1129 		goto out;
1130 	}
1131 
1132 	if (sk->sk_state != TCP_ESTABLISHED) {
1133 		kfree_skb(skb);
1134 		err = -ENOTCONN;
1135 		goto out;
1136 	}
1137 
1138 	nr_output(sk, skb);	/* Shove it onto the queue */
1139 
1140 	err = len;
1141 out:
1142 	release_sock(sk);
1143 	return err;
1144 }
1145 
1146 static int nr_recvmsg(struct socket *sock, struct msghdr *msg, size_t size,
1147 		      int flags)
1148 {
1149 	struct sock *sk = sock->sk;
1150 	DECLARE_SOCKADDR(struct sockaddr_ax25 *, sax, msg->msg_name);
1151 	size_t copied;
1152 	struct sk_buff *skb;
1153 	int er;
1154 
1155 	/*
1156 	 * This works for seqpacket too. The receiver has ordered the queue for
1157 	 * us! We do one quick check first though
1158 	 */
1159 
1160 	lock_sock(sk);
1161 	if (sk->sk_state != TCP_ESTABLISHED) {
1162 		release_sock(sk);
1163 		return -ENOTCONN;
1164 	}
1165 
1166 	/* Now we can treat all alike */
1167 	skb = skb_recv_datagram(sk, flags, &er);
1168 	if (!skb) {
1169 		release_sock(sk);
1170 		return er;
1171 	}
1172 
1173 	skb_reset_transport_header(skb);
1174 	copied     = skb->len;
1175 
1176 	if (copied > size) {
1177 		copied = size;
1178 		msg->msg_flags |= MSG_TRUNC;
1179 	}
1180 
1181 	er = skb_copy_datagram_msg(skb, 0, msg, copied);
1182 	if (er < 0) {
1183 		skb_free_datagram(sk, skb);
1184 		release_sock(sk);
1185 		return er;
1186 	}
1187 
1188 	if (sax != NULL) {
1189 		memset(sax, 0, sizeof(*sax));
1190 		sax->sax25_family = AF_NETROM;
1191 		skb_copy_from_linear_data_offset(skb, 7, sax->sax25_call.ax25_call,
1192 			      AX25_ADDR_LEN);
1193 		msg->msg_namelen = sizeof(*sax);
1194 	}
1195 
1196 	skb_free_datagram(sk, skb);
1197 
1198 	release_sock(sk);
1199 	return copied;
1200 }
1201 
1202 
1203 static int nr_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
1204 {
1205 	struct sock *sk = sock->sk;
1206 	void __user *argp = (void __user *)arg;
1207 
1208 	switch (cmd) {
1209 	case TIOCOUTQ: {
1210 		long amount;
1211 
1212 		lock_sock(sk);
1213 		amount = sk->sk_sndbuf - sk_wmem_alloc_get(sk);
1214 		if (amount < 0)
1215 			amount = 0;
1216 		release_sock(sk);
1217 		return put_user(amount, (int __user *)argp);
1218 	}
1219 
1220 	case TIOCINQ: {
1221 		struct sk_buff *skb;
1222 		long amount = 0L;
1223 
1224 		lock_sock(sk);
1225 		/* These two are safe on a single CPU system as only user tasks fiddle here */
1226 		if ((skb = skb_peek(&sk->sk_receive_queue)) != NULL)
1227 			amount = skb->len;
1228 		release_sock(sk);
1229 		return put_user(amount, (int __user *)argp);
1230 	}
1231 
1232 	case SIOCGIFADDR:
1233 	case SIOCSIFADDR:
1234 	case SIOCGIFDSTADDR:
1235 	case SIOCSIFDSTADDR:
1236 	case SIOCGIFBRDADDR:
1237 	case SIOCSIFBRDADDR:
1238 	case SIOCGIFNETMASK:
1239 	case SIOCSIFNETMASK:
1240 	case SIOCGIFMETRIC:
1241 	case SIOCSIFMETRIC:
1242 		return -EINVAL;
1243 
1244 	case SIOCADDRT:
1245 	case SIOCDELRT:
1246 	case SIOCNRDECOBS:
1247 		if (!capable(CAP_NET_ADMIN))
1248 			return -EPERM;
1249 		return nr_rt_ioctl(cmd, argp);
1250 
1251 	default:
1252 		return -ENOIOCTLCMD;
1253 	}
1254 
1255 	return 0;
1256 }
1257 
1258 #ifdef CONFIG_PROC_FS
1259 
1260 static void *nr_info_start(struct seq_file *seq, loff_t *pos)
1261 	__acquires(&nr_list_lock)
1262 {
1263 	spin_lock_bh(&nr_list_lock);
1264 	return seq_hlist_start_head(&nr_list, *pos);
1265 }
1266 
1267 static void *nr_info_next(struct seq_file *seq, void *v, loff_t *pos)
1268 {
1269 	return seq_hlist_next(v, &nr_list, pos);
1270 }
1271 
1272 static void nr_info_stop(struct seq_file *seq, void *v)
1273 	__releases(&nr_list_lock)
1274 {
1275 	spin_unlock_bh(&nr_list_lock);
1276 }
1277 
1278 static int nr_info_show(struct seq_file *seq, void *v)
1279 {
1280 	struct sock *s = sk_entry(v);
1281 	struct net_device *dev;
1282 	struct nr_sock *nr;
1283 	const char *devname;
1284 	char buf[11];
1285 
1286 	if (v == SEQ_START_TOKEN)
1287 		seq_puts(seq,
1288 "user_addr dest_node src_node  dev    my  your  st  vs  vr  va    t1     t2     t4      idle   n2  wnd Snd-Q Rcv-Q inode\n");
1289 
1290 	else {
1291 
1292 		bh_lock_sock(s);
1293 		nr = nr_sk(s);
1294 
1295 		if ((dev = nr->device) == NULL)
1296 			devname = "???";
1297 		else
1298 			devname = dev->name;
1299 
1300 		seq_printf(seq, "%-9s ", ax2asc(buf, &nr->user_addr));
1301 		seq_printf(seq, "%-9s ", ax2asc(buf, &nr->dest_addr));
1302 		seq_printf(seq,
1303 "%-9s %-3s  %02X/%02X %02X/%02X %2d %3d %3d %3d %3lu/%03lu %2lu/%02lu %3lu/%03lu %3lu/%03lu %2d/%02d %3d %5d %5d %ld\n",
1304 			ax2asc(buf, &nr->source_addr),
1305 			devname,
1306 			nr->my_index,
1307 			nr->my_id,
1308 			nr->your_index,
1309 			nr->your_id,
1310 			nr->state,
1311 			nr->vs,
1312 			nr->vr,
1313 			nr->va,
1314 			ax25_display_timer(&nr->t1timer) / HZ,
1315 			nr->t1 / HZ,
1316 			ax25_display_timer(&nr->t2timer) / HZ,
1317 			nr->t2 / HZ,
1318 			ax25_display_timer(&nr->t4timer) / HZ,
1319 			nr->t4 / HZ,
1320 			ax25_display_timer(&nr->idletimer) / (60 * HZ),
1321 			nr->idle / (60 * HZ),
1322 			nr->n2count,
1323 			nr->n2,
1324 			nr->window,
1325 			sk_wmem_alloc_get(s),
1326 			sk_rmem_alloc_get(s),
1327 			s->sk_socket ? SOCK_INODE(s->sk_socket)->i_ino : 0L);
1328 
1329 		bh_unlock_sock(s);
1330 	}
1331 	return 0;
1332 }
1333 
1334 static const struct seq_operations nr_info_seqops = {
1335 	.start = nr_info_start,
1336 	.next = nr_info_next,
1337 	.stop = nr_info_stop,
1338 	.show = nr_info_show,
1339 };
1340 #endif	/* CONFIG_PROC_FS */
1341 
1342 static const struct net_proto_family nr_family_ops = {
1343 	.family		=	PF_NETROM,
1344 	.create		=	nr_create,
1345 	.owner		=	THIS_MODULE,
1346 };
1347 
1348 static const struct proto_ops nr_proto_ops = {
1349 	.family		=	PF_NETROM,
1350 	.owner		=	THIS_MODULE,
1351 	.release	=	nr_release,
1352 	.bind		=	nr_bind,
1353 	.connect	=	nr_connect,
1354 	.socketpair	=	sock_no_socketpair,
1355 	.accept		=	nr_accept,
1356 	.getname	=	nr_getname,
1357 	.poll		=	datagram_poll,
1358 	.ioctl		=	nr_ioctl,
1359 	.gettstamp	=	sock_gettstamp,
1360 	.listen		=	nr_listen,
1361 	.shutdown	=	sock_no_shutdown,
1362 	.setsockopt	=	nr_setsockopt,
1363 	.getsockopt	=	nr_getsockopt,
1364 	.sendmsg	=	nr_sendmsg,
1365 	.recvmsg	=	nr_recvmsg,
1366 	.mmap		=	sock_no_mmap,
1367 };
1368 
1369 static struct notifier_block nr_dev_notifier = {
1370 	.notifier_call	=	nr_device_event,
1371 };
1372 
1373 static struct net_device **dev_nr;
1374 
1375 static struct ax25_protocol nr_pid = {
1376 	.pid	= AX25_P_NETROM,
1377 	.func	= nr_route_frame
1378 };
1379 
1380 static struct ax25_linkfail nr_linkfail_notifier = {
1381 	.func	= nr_link_failed,
1382 };
1383 
1384 static int __init nr_proto_init(void)
1385 {
1386 	int i;
1387 	int rc = proto_register(&nr_proto, 0);
1388 
1389 	if (rc)
1390 		return rc;
1391 
1392 	if (nr_ndevs > 0x7fffffff/sizeof(struct net_device *)) {
1393 		pr_err("NET/ROM: %s - nr_ndevs parameter too large\n",
1394 		       __func__);
1395 		rc = -EINVAL;
1396 		goto unregister_proto;
1397 	}
1398 
1399 	dev_nr = kcalloc(nr_ndevs, sizeof(struct net_device *), GFP_KERNEL);
1400 	if (!dev_nr) {
1401 		pr_err("NET/ROM: %s - unable to allocate device array\n",
1402 		       __func__);
1403 		rc = -ENOMEM;
1404 		goto unregister_proto;
1405 	}
1406 
1407 	for (i = 0; i < nr_ndevs; i++) {
1408 		char name[IFNAMSIZ];
1409 		struct net_device *dev;
1410 
1411 		sprintf(name, "nr%d", i);
1412 		dev = alloc_netdev(0, name, NET_NAME_UNKNOWN, nr_setup);
1413 		if (!dev) {
1414 			rc = -ENOMEM;
1415 			goto fail;
1416 		}
1417 
1418 		dev->base_addr = i;
1419 		rc = register_netdev(dev);
1420 		if (rc) {
1421 			free_netdev(dev);
1422 			goto fail;
1423 		}
1424 		nr_set_lockdep_key(dev);
1425 		dev_nr[i] = dev;
1426 	}
1427 
1428 	rc = sock_register(&nr_family_ops);
1429 	if (rc)
1430 		goto fail;
1431 
1432 	rc = register_netdevice_notifier(&nr_dev_notifier);
1433 	if (rc)
1434 		goto out_sock;
1435 
1436 	ax25_register_pid(&nr_pid);
1437 	ax25_linkfail_register(&nr_linkfail_notifier);
1438 
1439 #ifdef CONFIG_SYSCTL
1440 	rc = nr_register_sysctl();
1441 	if (rc)
1442 		goto out_sysctl;
1443 #endif
1444 
1445 	nr_loopback_init();
1446 
1447 	rc = -ENOMEM;
1448 	if (!proc_create_seq("nr", 0444, init_net.proc_net, &nr_info_seqops))
1449 		goto proc_remove1;
1450 	if (!proc_create_seq("nr_neigh", 0444, init_net.proc_net,
1451 			     &nr_neigh_seqops))
1452 		goto proc_remove2;
1453 	if (!proc_create_seq("nr_nodes", 0444, init_net.proc_net,
1454 			     &nr_node_seqops))
1455 		goto proc_remove3;
1456 
1457 	return 0;
1458 
1459 proc_remove3:
1460 	remove_proc_entry("nr_neigh", init_net.proc_net);
1461 proc_remove2:
1462 	remove_proc_entry("nr", init_net.proc_net);
1463 proc_remove1:
1464 
1465 	nr_loopback_clear();
1466 	nr_rt_free();
1467 
1468 #ifdef CONFIG_SYSCTL
1469 	nr_unregister_sysctl();
1470 out_sysctl:
1471 #endif
1472 	ax25_linkfail_release(&nr_linkfail_notifier);
1473 	ax25_protocol_release(AX25_P_NETROM);
1474 	unregister_netdevice_notifier(&nr_dev_notifier);
1475 out_sock:
1476 	sock_unregister(PF_NETROM);
1477 fail:
1478 	while (--i >= 0) {
1479 		unregister_netdev(dev_nr[i]);
1480 		free_netdev(dev_nr[i]);
1481 	}
1482 	kfree(dev_nr);
1483 unregister_proto:
1484 	proto_unregister(&nr_proto);
1485 	return rc;
1486 }
1487 
1488 module_init(nr_proto_init);
1489 
1490 module_param(nr_ndevs, int, 0);
1491 MODULE_PARM_DESC(nr_ndevs, "number of NET/ROM devices");
1492 
1493 MODULE_AUTHOR("Jonathan Naylor G4KLX <g4klx@g4klx.demon.co.uk>");
1494 MODULE_DESCRIPTION("The amateur radio NET/ROM network and transport layer protocol");
1495 MODULE_LICENSE("GPL");
1496 MODULE_ALIAS_NETPROTO(PF_NETROM);
1497 
1498 static void __exit nr_exit(void)
1499 {
1500 	int i;
1501 
1502 	remove_proc_entry("nr", init_net.proc_net);
1503 	remove_proc_entry("nr_neigh", init_net.proc_net);
1504 	remove_proc_entry("nr_nodes", init_net.proc_net);
1505 	nr_loopback_clear();
1506 
1507 	nr_rt_free();
1508 
1509 #ifdef CONFIG_SYSCTL
1510 	nr_unregister_sysctl();
1511 #endif
1512 
1513 	ax25_linkfail_release(&nr_linkfail_notifier);
1514 	ax25_protocol_release(AX25_P_NETROM);
1515 
1516 	unregister_netdevice_notifier(&nr_dev_notifier);
1517 
1518 	sock_unregister(PF_NETROM);
1519 
1520 	for (i = 0; i < nr_ndevs; i++) {
1521 		struct net_device *dev = dev_nr[i];
1522 		if (dev) {
1523 			unregister_netdev(dev);
1524 			free_netdev(dev);
1525 		}
1526 	}
1527 
1528 	kfree(dev_nr);
1529 	proto_unregister(&nr_proto);
1530 }
1531 module_exit(nr_exit);
1532