Gitiles
Code Review Sign In
192.168.1.100 / T800 / d68f94909d2c944a2104291573a4826b8399604a / . / src / kernel / linux / v4.19 / net / ax25 / af_ax25.c
blob: 44ec492f3dc2f42e059939344cab4064ffbca547 [file] [log] [blame]
xjb04a4022021-11-25 15:01:52 +0800[diff] [blame]1/*
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 (C) Alan Cox GW4PTS (alan@lxorguk.ukuu.org.uk)
8 * Copyright (C) Jonathan Naylor G4KLX (g4klx@g4klx.demon.co.uk)
9 * Copyright (C) Darryl Miles G7LED (dlm@g7led.demon.co.uk)
10 * Copyright (C) Steven Whitehouse GW7RRM (stevew@acm.org)
11 * Copyright (C) Joerg Reuter DL1BKE (jreuter@yaina.de)
12 * Copyright (C) Hans-Joachim Hetscher DD8NE (dd8ne@bnv-bamberg.de)
13 * Copyright (C) Hans Alblas PE1AYX (hans@esrac.ele.tue.nl)
14 * Copyright (C) Frederic Rible F1OAT (frible@teaser.fr)
15 */
16#include <linux/capability.h>
17#include <linux/module.h>
18#include <linux/errno.h>
19#include <linux/types.h>
20#include <linux/socket.h>
21#include <linux/in.h>
22#include <linux/kernel.h>
23#include <linux/sched/signal.h>
24#include <linux/timer.h>
25#include <linux/string.h>
26#include <linux/sockios.h>
27#include <linux/net.h>
28#include <linux/slab.h>
29#include <net/ax25.h>
30#include <linux/inet.h>
31#include <linux/netdevice.h>
32#include <linux/if_arp.h>
33#include <linux/skbuff.h>
34#include <net/sock.h>
35#include <linux/uaccess.h>
36#include <linux/fcntl.h>
37#include <linux/termios.h> /* For TIOCINQ/OUTQ */
38#include <linux/mm.h>
39#include <linux/interrupt.h>
40#include <linux/notifier.h>
41#include <linux/proc_fs.h>
42#include <linux/stat.h>
43#include <linux/sysctl.h>
44#include <linux/init.h>
45#include <linux/spinlock.h>
46#include <net/net_namespace.h>
47#include <net/tcp_states.h>
48#include <net/ip.h>
49#include <net/arp.h>
50
51
52
53HLIST_HEAD(ax25_list);
54DEFINE_SPINLOCK(ax25_list_lock);
55
56static const struct proto_ops ax25_proto_ops;
57
58static void ax25_free_sock(struct sock *sk)
59{
60 ax25_cb_put(sk_to_ax25(sk));
61}
62
63/*
64 * Socket removal during an interrupt is now safe.
65 */
66static void ax25_cb_del(ax25_cb *ax25)
67{
68 if (!hlist_unhashed(&ax25->ax25_node)) {
69 spin_lock_bh(&ax25_list_lock);
70 hlist_del_init(&ax25->ax25_node);
71 spin_unlock_bh(&ax25_list_lock);
72 ax25_cb_put(ax25);
73 }
74}
75
76/*
77 * Kill all bound sockets on a dropped device.
78 */
79static void ax25_kill_by_device(struct net_device *dev)
80{
81 ax25_dev *ax25_dev;
82 ax25_cb *s;
83
84 if ((ax25_dev = ax25_dev_ax25dev(dev)) == NULL)
85 return;
86
87 spin_lock_bh(&ax25_list_lock);
88again:
89 ax25_for_each(s, &ax25_list) {
90 if (s->ax25_dev == ax25_dev) {
91 s->ax25_dev = NULL;
92 spin_unlock_bh(&ax25_list_lock);
93 ax25_disconnect(s, ENETUNREACH);
94 spin_lock_bh(&ax25_list_lock);
95
96 /* The entry could have been deleted from the
97 * list meanwhile and thus the next pointer is
98 * no longer valid. Play it safe and restart
99 * the scan. Forward progress is ensured
100 * because we set s->ax25_dev to NULL and we
101 * are never passed a NULL 'dev' argument.
102 */
103 goto again;
104 }
105 }
106 spin_unlock_bh(&ax25_list_lock);
107}
108
109/*
110 * Handle device status changes.
111 */
112static int ax25_device_event(struct notifier_block *this, unsigned long event,
113 void *ptr)
114{
115 struct net_device *dev = netdev_notifier_info_to_dev(ptr);
116
117 if (!net_eq(dev_net(dev), &init_net))
118 return NOTIFY_DONE;
119
120 /* Reject non AX.25 devices */
121 if (dev->type != ARPHRD_AX25)
122 return NOTIFY_DONE;
123
124 switch (event) {
125 case NETDEV_UP:
126 ax25_dev_device_up(dev);
127 break;
128 case NETDEV_DOWN:
129 ax25_kill_by_device(dev);
130 ax25_rt_device_down(dev);
131 ax25_dev_device_down(dev);
132 break;
133 default:
134 break;
135 }
136
137 return NOTIFY_DONE;
138}
139
140/*
141 * Add a socket to the bound sockets list.
142 */
143void ax25_cb_add(ax25_cb *ax25)
144{
145 spin_lock_bh(&ax25_list_lock);
146 ax25_cb_hold(ax25);
147 hlist_add_head(&ax25->ax25_node, &ax25_list);
148 spin_unlock_bh(&ax25_list_lock);
149}
150
151/*
152 * Find a socket that wants to accept the SABM we have just
153 * received.
154 */
155struct sock *ax25_find_listener(ax25_address *addr, int digi,
156 struct net_device *dev, int type)
157{
158 ax25_cb *s;
159
160 spin_lock(&ax25_list_lock);
161 ax25_for_each(s, &ax25_list) {
162 if ((s->iamdigi && !digi) || (!s->iamdigi && digi))
163 continue;
164 if (s->sk && !ax25cmp(&s->source_addr, addr) &&
165 s->sk->sk_type == type && s->sk->sk_state == TCP_LISTEN) {
166 /* If device is null we match any device */
167 if (s->ax25_dev == NULL || s->ax25_dev->dev == dev) {
168 sock_hold(s->sk);
169 spin_unlock(&ax25_list_lock);
170 return s->sk;
171 }
172 }
173 }
174 spin_unlock(&ax25_list_lock);
175
176 return NULL;
177}
178
179/*
180 * Find an AX.25 socket given both ends.
181 */
182struct sock *ax25_get_socket(ax25_address *my_addr, ax25_address *dest_addr,
183 int type)
184{
185 struct sock *sk = NULL;
186 ax25_cb *s;
187
188 spin_lock(&ax25_list_lock);
189 ax25_for_each(s, &ax25_list) {
190 if (s->sk && !ax25cmp(&s->source_addr, my_addr) &&
191 !ax25cmp(&s->dest_addr, dest_addr) &&
192 s->sk->sk_type == type) {
193 sk = s->sk;
194 sock_hold(sk);
195 break;
196 }
197 }
198
199 spin_unlock(&ax25_list_lock);
200
201 return sk;
202}
203
204/*
205 * Find an AX.25 control block given both ends. It will only pick up
206 * floating AX.25 control blocks or non Raw socket bound control blocks.
207 */
208ax25_cb *ax25_find_cb(ax25_address *src_addr, ax25_address *dest_addr,
209 ax25_digi *digi, struct net_device *dev)
210{
211 ax25_cb *s;
212
213 spin_lock_bh(&ax25_list_lock);
214 ax25_for_each(s, &ax25_list) {
215 if (s->sk && s->sk->sk_type != SOCK_SEQPACKET)
216 continue;
217 if (s->ax25_dev == NULL)
218 continue;
219 if (ax25cmp(&s->source_addr, src_addr) == 0 && ax25cmp(&s->dest_addr, dest_addr) == 0 && s->ax25_dev->dev == dev) {
220 if (digi != NULL && digi->ndigi != 0) {
221 if (s->digipeat == NULL)
222 continue;
223 if (ax25digicmp(s->digipeat, digi) != 0)
224 continue;
225 } else {
226 if (s->digipeat != NULL && s->digipeat->ndigi != 0)
227 continue;
228 }
229 ax25_cb_hold(s);
230 spin_unlock_bh(&ax25_list_lock);
231
232 return s;
233 }
234 }
235 spin_unlock_bh(&ax25_list_lock);
236
237 return NULL;
238}
239
240EXPORT_SYMBOL(ax25_find_cb);
241
242void ax25_send_to_raw(ax25_address *addr, struct sk_buff *skb, int proto)
243{
244 ax25_cb *s;
245 struct sk_buff *copy;
246
247 spin_lock(&ax25_list_lock);
248 ax25_for_each(s, &ax25_list) {
249 if (s->sk != NULL && ax25cmp(&s->source_addr, addr) == 0 &&
250 s->sk->sk_type == SOCK_RAW &&
251 s->sk->sk_protocol == proto &&
252 s->ax25_dev->dev == skb->dev &&
253 atomic_read(&s->sk->sk_rmem_alloc) <= s->sk->sk_rcvbuf) {
254 if ((copy = skb_clone(skb, GFP_ATOMIC)) == NULL)
255 continue;
256 if (sock_queue_rcv_skb(s->sk, copy) != 0)
257 kfree_skb(copy);
258 }
259 }
260 spin_unlock(&ax25_list_lock);
261}
262
263/*
264 * Deferred destroy.
265 */
266void ax25_destroy_socket(ax25_cb *);
267
268/*
269 * Handler for deferred kills.
270 */
271static void ax25_destroy_timer(struct timer_list *t)
272{
273 ax25_cb *ax25 = from_timer(ax25, t, dtimer);
274 struct sock *sk;
275
276 sk=ax25->sk;
277
278 bh_lock_sock(sk);
279 sock_hold(sk);
280 ax25_destroy_socket(ax25);
281 bh_unlock_sock(sk);
282 sock_put(sk);
283}
284
285/*
286 * This is called from user mode and the timers. Thus it protects itself
287 * against interrupt users but doesn't worry about being called during
288 * work. Once it is removed from the queue no interrupt or bottom half
289 * will touch it and we are (fairly 8-) ) safe.
290 */
291void ax25_destroy_socket(ax25_cb *ax25)
292{
293 struct sk_buff *skb;
294
295 ax25_cb_del(ax25);
296
297 ax25_stop_heartbeat(ax25);
298 ax25_stop_t1timer(ax25);
299 ax25_stop_t2timer(ax25);
300 ax25_stop_t3timer(ax25);
301 ax25_stop_idletimer(ax25);
302
303 ax25_clear_queues(ax25); /* Flush the queues */
304
305 if (ax25->sk != NULL) {
306 while ((skb = skb_dequeue(&ax25->sk->sk_receive_queue)) != NULL) {
307 if (skb->sk != ax25->sk) {
308 /* A pending connection */
309 ax25_cb *sax25 = sk_to_ax25(skb->sk);
310
311 /* Queue the unaccepted socket for death */
312 sock_orphan(skb->sk);
313
314 /* 9A4GL: hack to release unaccepted sockets */
315 skb->sk->sk_state = TCP_LISTEN;
316
317 ax25_start_heartbeat(sax25);
318 sax25->state = AX25_STATE_0;
319 }
320
321 kfree_skb(skb);
322 }
323 skb_queue_purge(&ax25->sk->sk_write_queue);
324 }
325
326 if (ax25->sk != NULL) {
327 if (sk_has_allocations(ax25->sk)) {
328 /* Defer: outstanding buffers */
329 timer_setup(&ax25->dtimer, ax25_destroy_timer, 0);
330 ax25->dtimer.expires = jiffies + 2 * HZ;
331 add_timer(&ax25->dtimer);
332 } else {
333 struct sock *sk=ax25->sk;
334 ax25->sk=NULL;
335 sock_put(sk);
336 }
337 } else {
338 ax25_cb_put(ax25);
339 }
340}
341
342/*
343 * dl1bke 960311: set parameters for existing AX.25 connections,
344 * includes a KILL command to abort any connection.
345 * VERY useful for debugging ;-)
346 */
347static int ax25_ctl_ioctl(const unsigned int cmd, void __user *arg)
348{
349 struct ax25_ctl_struct ax25_ctl;
350 ax25_digi digi;
351 ax25_dev *ax25_dev;
352 ax25_cb *ax25;
353 unsigned int k;
354 int ret = 0;
355
356 if (copy_from_user(&ax25_ctl, arg, sizeof(ax25_ctl)))
357 return -EFAULT;
358
359 if ((ax25_dev = ax25_addr_ax25dev(&ax25_ctl.port_addr)) == NULL)
360 return -ENODEV;
361
362 if (ax25_ctl.digi_count > AX25_MAX_DIGIS)
363 return -EINVAL;
364
365 if (ax25_ctl.arg > ULONG_MAX / HZ && ax25_ctl.cmd != AX25_KILL)
366 return -EINVAL;
367
368 digi.ndigi = ax25_ctl.digi_count;
369 for (k = 0; k < digi.ndigi; k++)
370 digi.calls[k] = ax25_ctl.digi_addr[k];
371
372 if ((ax25 = ax25_find_cb(&ax25_ctl.source_addr, &ax25_ctl.dest_addr, &digi, ax25_dev->dev)) == NULL)
373 return -ENOTCONN;
374
375 switch (ax25_ctl.cmd) {
376 case AX25_KILL:
377 ax25_send_control(ax25, AX25_DISC, AX25_POLLON, AX25_COMMAND);
378#ifdef CONFIG_AX25_DAMA_SLAVE
379 if (ax25_dev->dama.slave && ax25->ax25_dev->values[AX25_VALUES_PROTOCOL] == AX25_PROTO_DAMA_SLAVE)
380 ax25_dama_off(ax25);
381#endif
382 ax25_disconnect(ax25, ENETRESET);
383 break;
384
385 case AX25_WINDOW:
386 if (ax25->modulus == AX25_MODULUS) {
387 if (ax25_ctl.arg < 1 || ax25_ctl.arg > 7)
388 goto einval_put;
389 } else {
390 if (ax25_ctl.arg < 1 || ax25_ctl.arg > 63)
391 goto einval_put;
392 }
393 ax25->window = ax25_ctl.arg;
394 break;
395
396 case AX25_T1:
397 if (ax25_ctl.arg < 1 || ax25_ctl.arg > ULONG_MAX / HZ)
398 goto einval_put;
399 ax25->rtt = (ax25_ctl.arg * HZ) / 2;
400 ax25->t1 = ax25_ctl.arg * HZ;
401 break;
402
403 case AX25_T2:
404 if (ax25_ctl.arg < 1 || ax25_ctl.arg > ULONG_MAX / HZ)
405 goto einval_put;
406 ax25->t2 = ax25_ctl.arg * HZ;
407 break;
408
409 case AX25_N2:
410 if (ax25_ctl.arg < 1 || ax25_ctl.arg > 31)
411 goto einval_put;
412 ax25->n2count = 0;
413 ax25->n2 = ax25_ctl.arg;
414 break;
415
416 case AX25_T3:
417 if (ax25_ctl.arg > ULONG_MAX / HZ)
418 goto einval_put;
419 ax25->t3 = ax25_ctl.arg * HZ;
420 break;
421
422 case AX25_IDLE:
423 if (ax25_ctl.arg > ULONG_MAX / (60 * HZ))
424 goto einval_put;
425
426 ax25->idle = ax25_ctl.arg * 60 * HZ;
427 break;
428
429 case AX25_PACLEN:
430 if (ax25_ctl.arg < 16 || ax25_ctl.arg > 65535)
431 goto einval_put;
432 ax25->paclen = ax25_ctl.arg;
433 break;
434
435 default:
436 goto einval_put;
437 }
438
439out_put:
440 ax25_cb_put(ax25);
441 return ret;
442
443einval_put:
444 ret = -EINVAL;
445 goto out_put;
446}
447
448static void ax25_fillin_cb_from_dev(ax25_cb *ax25, ax25_dev *ax25_dev)
449{
450 ax25->rtt = msecs_to_jiffies(ax25_dev->values[AX25_VALUES_T1]) / 2;
451 ax25->t1 = msecs_to_jiffies(ax25_dev->values[AX25_VALUES_T1]);
452 ax25->t2 = msecs_to_jiffies(ax25_dev->values[AX25_VALUES_T2]);
453 ax25->t3 = msecs_to_jiffies(ax25_dev->values[AX25_VALUES_T3]);
454 ax25->n2 = ax25_dev->values[AX25_VALUES_N2];
455 ax25->paclen = ax25_dev->values[AX25_VALUES_PACLEN];
456 ax25->idle = msecs_to_jiffies(ax25_dev->values[AX25_VALUES_IDLE]);
457 ax25->backoff = ax25_dev->values[AX25_VALUES_BACKOFF];
458
459 if (ax25_dev->values[AX25_VALUES_AXDEFMODE]) {
460 ax25->modulus = AX25_EMODULUS;
461 ax25->window = ax25_dev->values[AX25_VALUES_EWINDOW];
462 } else {
463 ax25->modulus = AX25_MODULUS;
464 ax25->window = ax25_dev->values[AX25_VALUES_WINDOW];
465 }
466}
467
468/*
469 * Fill in a created AX.25 created control block with the default
470 * values for a particular device.
471 */
472void ax25_fillin_cb(ax25_cb *ax25, ax25_dev *ax25_dev)
473{
474 ax25->ax25_dev = ax25_dev;
475
476 if (ax25->ax25_dev != NULL) {
477 ax25_fillin_cb_from_dev(ax25, ax25_dev);
478 return;
479 }
480
481 /*
482 * No device, use kernel / AX.25 spec default values
483 */
484 ax25->rtt = msecs_to_jiffies(AX25_DEF_T1) / 2;
485 ax25->t1 = msecs_to_jiffies(AX25_DEF_T1);
486 ax25->t2 = msecs_to_jiffies(AX25_DEF_T2);
487 ax25->t3 = msecs_to_jiffies(AX25_DEF_T3);
488 ax25->n2 = AX25_DEF_N2;
489 ax25->paclen = AX25_DEF_PACLEN;
490 ax25->idle = msecs_to_jiffies(AX25_DEF_IDLE);
491 ax25->backoff = AX25_DEF_BACKOFF;
492
493 if (AX25_DEF_AXDEFMODE) {
494 ax25->modulus = AX25_EMODULUS;
495 ax25->window = AX25_DEF_EWINDOW;
496 } else {
497 ax25->modulus = AX25_MODULUS;
498 ax25->window = AX25_DEF_WINDOW;
499 }
500}
501
502/*
503 * Create an empty AX.25 control block.
504 */
505ax25_cb *ax25_create_cb(void)
506{
507 ax25_cb *ax25;
508
509 if ((ax25 = kzalloc(sizeof(*ax25), GFP_ATOMIC)) == NULL)
510 return NULL;
511
512 refcount_set(&ax25->refcount, 1);
513
514 skb_queue_head_init(&ax25->write_queue);
515 skb_queue_head_init(&ax25->frag_queue);
516 skb_queue_head_init(&ax25->ack_queue);
517 skb_queue_head_init(&ax25->reseq_queue);
518
519 ax25_setup_timers(ax25);
520
521 ax25_fillin_cb(ax25, NULL);
522
523 ax25->state = AX25_STATE_0;
524
525 return ax25;
526}
527
528/*
529 * Handling for system calls applied via the various interfaces to an
530 * AX25 socket object
531 */
532
533static int ax25_setsockopt(struct socket *sock, int level, int optname,
534 char __user *optval, unsigned int optlen)
535{
536 struct sock *sk = sock->sk;
537 ax25_cb *ax25;
538 struct net_device *dev;
539 char devname[IFNAMSIZ];
540 unsigned long opt;
541 int res = 0;
542
543 if (level != SOL_AX25)
544 return -ENOPROTOOPT;
545
546 if (optlen < sizeof(unsigned int))
547 return -EINVAL;
548
549 if (get_user(opt, (unsigned int __user *)optval))
550 return -EFAULT;
551
552 lock_sock(sk);
553 ax25 = sk_to_ax25(sk);
554
555 switch (optname) {
556 case AX25_WINDOW:
557 if (ax25->modulus == AX25_MODULUS) {
558 if (opt < 1 || opt > 7) {
559 res = -EINVAL;
560 break;
561 }
562 } else {
563 if (opt < 1 || opt > 63) {
564 res = -EINVAL;
565 break;
566 }
567 }
568 ax25->window = opt;
569 break;
570
571 case AX25_T1:
572 if (opt < 1 || opt > ULONG_MAX / HZ) {
573 res = -EINVAL;
574 break;
575 }
576 ax25->rtt = (opt * HZ) >> 1;
577 ax25->t1 = opt * HZ;
578 break;
579
580 case AX25_T2:
581 if (opt < 1 || opt > ULONG_MAX / HZ) {
582 res = -EINVAL;
583 break;
584 }
585 ax25->t2 = opt * HZ;
586 break;
587
588 case AX25_N2:
589 if (opt < 1 || opt > 31) {
590 res = -EINVAL;
591 break;
592 }
593 ax25->n2 = opt;
594 break;
595
596 case AX25_T3:
597 if (opt < 1 || opt > ULONG_MAX / HZ) {
598 res = -EINVAL;
599 break;
600 }
601 ax25->t3 = opt * HZ;
602 break;
603
604 case AX25_IDLE:
605 if (opt > ULONG_MAX / (60 * HZ)) {
606 res = -EINVAL;
607 break;
608 }
609 ax25->idle = opt * 60 * HZ;
610 break;
611
612 case AX25_BACKOFF:
613 if (opt > 2) {
614 res = -EINVAL;
615 break;
616 }
617 ax25->backoff = opt;
618 break;
619
620 case AX25_EXTSEQ:
621 ax25->modulus = opt ? AX25_EMODULUS : AX25_MODULUS;
622 break;
623
624 case AX25_PIDINCL:
625 ax25->pidincl = opt ? 1 : 0;
626 break;
627
628 case AX25_IAMDIGI:
629 ax25->iamdigi = opt ? 1 : 0;
630 break;
631
632 case AX25_PACLEN:
633 if (opt < 16 || opt > 65535) {
634 res = -EINVAL;
635 break;
636 }
637 ax25->paclen = opt;
638 break;
639
640 case SO_BINDTODEVICE:
641 if (optlen > IFNAMSIZ)
642 optlen = IFNAMSIZ;
643
644 if (copy_from_user(devname, optval, optlen)) {
645 res = -EFAULT;
646 break;
647 }
648
649 if (sk->sk_type == SOCK_SEQPACKET &&
650 (sock->state != SS_UNCONNECTED ||
651 sk->sk_state == TCP_LISTEN)) {
652 res = -EADDRNOTAVAIL;
653 break;
654 }
655
656 rtnl_lock();
657 dev = __dev_get_by_name(&init_net, devname);
658 if (!dev) {
659 rtnl_unlock();
660 res = -ENODEV;
661 break;
662 }
663
664 ax25->ax25_dev = ax25_dev_ax25dev(dev);
665 if (!ax25->ax25_dev) {
666 rtnl_unlock();
667 res = -ENODEV;
668 break;
669 }
670 ax25_fillin_cb(ax25, ax25->ax25_dev);
671 rtnl_unlock();
672 break;
673
674 default:
675 res = -ENOPROTOOPT;
676 }
677 release_sock(sk);
678
679 return res;
680}
681
682static int ax25_getsockopt(struct socket *sock, int level, int optname,
683 char __user *optval, int __user *optlen)
684{
685 struct sock *sk = sock->sk;
686 ax25_cb *ax25;
687 struct ax25_dev *ax25_dev;
688 char devname[IFNAMSIZ];
689 void *valptr;
690 int val = 0;
691 int maxlen, length;
692
693 if (level != SOL_AX25)
694 return -ENOPROTOOPT;
695
696 if (get_user(maxlen, optlen))
697 return -EFAULT;
698
699 if (maxlen < 1)
700 return -EFAULT;
701
702 valptr = (void *) &val;
703 length = min_t(unsigned int, maxlen, sizeof(int));
704
705 lock_sock(sk);
706 ax25 = sk_to_ax25(sk);
707
708 switch (optname) {
709 case AX25_WINDOW:
710 val = ax25->window;
711 break;
712
713 case AX25_T1:
714 val = ax25->t1 / HZ;
715 break;
716
717 case AX25_T2:
718 val = ax25->t2 / HZ;
719 break;
720
721 case AX25_N2:
722 val = ax25->n2;
723 break;
724
725 case AX25_T3:
726 val = ax25->t3 / HZ;
727 break;
728
729 case AX25_IDLE:
730 val = ax25->idle / (60 * HZ);
731 break;
732
733 case AX25_BACKOFF:
734 val = ax25->backoff;
735 break;
736
737 case AX25_EXTSEQ:
738 val = (ax25->modulus == AX25_EMODULUS);
739 break;
740
741 case AX25_PIDINCL:
742 val = ax25->pidincl;
743 break;
744
745 case AX25_IAMDIGI:
746 val = ax25->iamdigi;
747 break;
748
749 case AX25_PACLEN:
750 val = ax25->paclen;
751 break;
752
753 case SO_BINDTODEVICE:
754 ax25_dev = ax25->ax25_dev;
755
756 if (ax25_dev != NULL && ax25_dev->dev != NULL) {
757 strlcpy(devname, ax25_dev->dev->name, sizeof(devname));
758 length = strlen(devname) + 1;
759 } else {
760 *devname = '\0';
761 length = 1;
762 }
763
764 valptr = (void *) devname;
765 break;
766
767 default:
768 release_sock(sk);
769 return -ENOPROTOOPT;
770 }
771 release_sock(sk);
772
773 if (put_user(length, optlen))
774 return -EFAULT;
775
776 return copy_to_user(optval, valptr, length) ? -EFAULT : 0;
777}
778
779static int ax25_listen(struct socket *sock, int backlog)
780{
781 struct sock *sk = sock->sk;
782 int res = 0;
783
784 lock_sock(sk);
785 if (sk->sk_type == SOCK_SEQPACKET && sk->sk_state != TCP_LISTEN) {
786 sk->sk_max_ack_backlog = backlog;
787 sk->sk_state = TCP_LISTEN;
788 goto out;
789 }
790 res = -EOPNOTSUPP;
791
792out:
793 release_sock(sk);
794
795 return res;
796}
797
798/*
799 * XXX: when creating ax25_sock we should update the .obj_size setting
800 * below.
801 */
802static struct proto ax25_proto = {
803 .name = "AX25",
804 .owner = THIS_MODULE,
805 .obj_size = sizeof(struct ax25_sock),
806};
807
808static int ax25_create(struct net *net, struct socket *sock, int protocol,
809 int kern)
810{
811 struct sock *sk;
812 ax25_cb *ax25;
813
814 if (protocol < 0 || protocol > SK_PROTOCOL_MAX)
815 return -EINVAL;
816
817 if (!net_eq(net, &init_net))
818 return -EAFNOSUPPORT;
819
820 switch (sock->type) {
821 case SOCK_DGRAM:
822 if (protocol == 0 || protocol == PF_AX25)
823 protocol = AX25_P_TEXT;
824 break;
825
826 case SOCK_SEQPACKET:
827 switch (protocol) {
828 case 0:
829 case PF_AX25: /* For CLX */
830 protocol = AX25_P_TEXT;
831 break;
832 case AX25_P_SEGMENT:
833#ifdef CONFIG_INET
834 case AX25_P_ARP:
835 case AX25_P_IP:
836#endif
837#ifdef CONFIG_NETROM
838 case AX25_P_NETROM:
839#endif
840#ifdef CONFIG_ROSE
841 case AX25_P_ROSE:
842#endif
843 return -ESOCKTNOSUPPORT;
844#ifdef CONFIG_NETROM_MODULE
845 case AX25_P_NETROM:
846 if (ax25_protocol_is_registered(AX25_P_NETROM))
847 return -ESOCKTNOSUPPORT;
848 break;
849#endif
850#ifdef CONFIG_ROSE_MODULE
851 case AX25_P_ROSE:
852 if (ax25_protocol_is_registered(AX25_P_ROSE))
853 return -ESOCKTNOSUPPORT;
854#endif
855 default:
856 break;
857 }
858 break;
859
860 case SOCK_RAW:
861 if (!capable(CAP_NET_RAW))
862 return -EPERM;
863 break;
864 default:
865 return -ESOCKTNOSUPPORT;
866 }
867
868 sk = sk_alloc(net, PF_AX25, GFP_ATOMIC, &ax25_proto, kern);
869 if (sk == NULL)
870 return -ENOMEM;
871
872 ax25 = ax25_sk(sk)->cb = ax25_create_cb();
873 if (!ax25) {
874 sk_free(sk);
875 return -ENOMEM;
876 }
877
878 sock_init_data(sock, sk);
879
880 sk->sk_destruct = ax25_free_sock;
881 sock->ops = &ax25_proto_ops;
882 sk->sk_protocol = protocol;
883
884 ax25->sk = sk;
885
886 return 0;
887}
888
889struct sock *ax25_make_new(struct sock *osk, struct ax25_dev *ax25_dev)
890{
891 struct sock *sk;
892 ax25_cb *ax25, *oax25;
893
894 sk = sk_alloc(sock_net(osk), PF_AX25, GFP_ATOMIC, osk->sk_prot, 0);
895 if (sk == NULL)
896 return NULL;
897
898 if ((ax25 = ax25_create_cb()) == NULL) {
899 sk_free(sk);
900 return NULL;
901 }
902
903 switch (osk->sk_type) {
904 case SOCK_DGRAM:
905 break;
906 case SOCK_SEQPACKET:
907 break;
908 default:
909 sk_free(sk);
910 ax25_cb_put(ax25);
911 return NULL;
912 }
913
914 sock_init_data(NULL, sk);
915
916 sk->sk_type = osk->sk_type;
917 sk->sk_priority = osk->sk_priority;
918 sk->sk_protocol = osk->sk_protocol;
919 sk->sk_rcvbuf = osk->sk_rcvbuf;
920 sk->sk_sndbuf = osk->sk_sndbuf;
921 sk->sk_state = TCP_ESTABLISHED;
922 sock_copy_flags(sk, osk);
923
924 oax25 = sk_to_ax25(osk);
925
926 ax25->modulus = oax25->modulus;
927 ax25->backoff = oax25->backoff;
928 ax25->pidincl = oax25->pidincl;
929 ax25->iamdigi = oax25->iamdigi;
930 ax25->rtt = oax25->rtt;
931 ax25->t1 = oax25->t1;
932 ax25->t2 = oax25->t2;
933 ax25->t3 = oax25->t3;
934 ax25->n2 = oax25->n2;
935 ax25->idle = oax25->idle;
936 ax25->paclen = oax25->paclen;
937 ax25->window = oax25->window;
938
939 ax25->ax25_dev = ax25_dev;
940 ax25->source_addr = oax25->source_addr;
941
942 if (oax25->digipeat != NULL) {
943 ax25->digipeat = kmemdup(oax25->digipeat, sizeof(ax25_digi),
944 GFP_ATOMIC);
945 if (ax25->digipeat == NULL) {
946 sk_free(sk);
947 ax25_cb_put(ax25);
948 return NULL;
949 }
950 }
951
952 ax25_sk(sk)->cb = ax25;
953 sk->sk_destruct = ax25_free_sock;
954 ax25->sk = sk;
955
956 return sk;
957}
958
959static int ax25_release(struct socket *sock)
960{
961 struct sock *sk = sock->sk;
962 ax25_cb *ax25;
963
964 if (sk == NULL)
965 return 0;
966
967 sock_hold(sk);
968 sock_orphan(sk);
969 lock_sock(sk);
970 ax25 = sk_to_ax25(sk);
971
972 if (sk->sk_type == SOCK_SEQPACKET) {
973 switch (ax25->state) {
974 case AX25_STATE_0:
975 release_sock(sk);
976 ax25_disconnect(ax25, 0);
977 lock_sock(sk);
978 ax25_destroy_socket(ax25);
979 break;
980
981 case AX25_STATE_1:
982 case AX25_STATE_2:
983 ax25_send_control(ax25, AX25_DISC, AX25_POLLON, AX25_COMMAND);
984 release_sock(sk);
985 ax25_disconnect(ax25, 0);
986 lock_sock(sk);
987 if (!sock_flag(ax25->sk, SOCK_DESTROY))
988 ax25_destroy_socket(ax25);
989 break;
990
991 case AX25_STATE_3:
992 case AX25_STATE_4:
993 ax25_clear_queues(ax25);
994 ax25->n2count = 0;
995
996 switch (ax25->ax25_dev->values[AX25_VALUES_PROTOCOL]) {
997 case AX25_PROTO_STD_SIMPLEX:
998 case AX25_PROTO_STD_DUPLEX:
999 ax25_send_control(ax25,
1000 AX25_DISC,
1001 AX25_POLLON,
1002 AX25_COMMAND);
1003 ax25_stop_t2timer(ax25);
1004 ax25_stop_t3timer(ax25);
1005 ax25_stop_idletimer(ax25);
1006 break;
1007#ifdef CONFIG_AX25_DAMA_SLAVE
1008 case AX25_PROTO_DAMA_SLAVE:
1009 ax25_stop_t3timer(ax25);
1010 ax25_stop_idletimer(ax25);
1011 break;
1012#endif
1013 }
1014 ax25_calculate_t1(ax25);
1015 ax25_start_t1timer(ax25);
1016 ax25->state = AX25_STATE_2;
1017 sk->sk_state = TCP_CLOSE;
1018 sk->sk_shutdown |= SEND_SHUTDOWN;
1019 sk->sk_state_change(sk);
1020 sock_set_flag(sk, SOCK_DESTROY);
1021 break;
1022
1023 default:
1024 break;
1025 }
1026 } else {
1027 sk->sk_state = TCP_CLOSE;
1028 sk->sk_shutdown |= SEND_SHUTDOWN;
1029 sk->sk_state_change(sk);
1030 ax25_destroy_socket(ax25);
1031 }
1032
1033 sock->sk = NULL;
1034 release_sock(sk);
1035 sock_put(sk);
1036
1037 return 0;
1038}
1039
1040/*
1041 * We support a funny extension here so you can (as root) give any callsign
1042 * digipeated via a local address as source. This hack is obsolete now
1043 * that we've implemented support for SO_BINDTODEVICE. It is however small
1044 * and trivially backward compatible.
1045 */
1046static int ax25_bind(struct socket *sock, struct sockaddr *uaddr, int addr_len)
1047{
1048 struct sock *sk = sock->sk;
1049 struct full_sockaddr_ax25 *addr = (struct full_sockaddr_ax25 *)uaddr;
1050 ax25_dev *ax25_dev = NULL;
1051 ax25_uid_assoc *user;
1052 ax25_address call;
1053 ax25_cb *ax25;
1054 int err = 0;
1055
1056 if (addr_len != sizeof(struct sockaddr_ax25) &&
1057 addr_len != sizeof(struct full_sockaddr_ax25))
1058 /* support for old structure may go away some time
1059 * ax25_bind(): uses old (6 digipeater) socket structure.
1060 */
1061 if ((addr_len < sizeof(struct sockaddr_ax25) + sizeof(ax25_address) * 6) ||
1062 (addr_len > sizeof(struct full_sockaddr_ax25)))
1063 return -EINVAL;
1064
1065 if (addr->fsa_ax25.sax25_family != AF_AX25)
1066 return -EINVAL;
1067
1068 user = ax25_findbyuid(current_euid());
1069 if (user) {
1070 call = user->call;
1071 ax25_uid_put(user);
1072 } else {
1073 if (ax25_uid_policy && !capable(CAP_NET_ADMIN))
1074 return -EACCES;
1075
1076 call = addr->fsa_ax25.sax25_call;
1077 }
1078
1079 lock_sock(sk);
1080
1081 ax25 = sk_to_ax25(sk);
1082 if (!sock_flag(sk, SOCK_ZAPPED)) {
1083 err = -EINVAL;
1084 goto out;
1085 }
1086
1087 ax25->source_addr = call;
1088
1089 /*
1090 * User already set interface with SO_BINDTODEVICE
1091 */
1092 if (ax25->ax25_dev != NULL)
1093 goto done;
1094
1095 if (addr_len > sizeof(struct sockaddr_ax25) && addr->fsa_ax25.sax25_ndigis == 1) {
1096 if (ax25cmp(&addr->fsa_digipeater[0], &null_ax25_address) != 0 &&
1097 (ax25_dev = ax25_addr_ax25dev(&addr->fsa_digipeater[0])) == NULL) {
1098 err = -EADDRNOTAVAIL;
1099 goto out;
1100 }
1101 } else {
1102 if ((ax25_dev = ax25_addr_ax25dev(&addr->fsa_ax25.sax25_call)) == NULL) {
1103 err = -EADDRNOTAVAIL;
1104 goto out;
1105 }
1106 }
1107
1108 if (ax25_dev != NULL)
1109 ax25_fillin_cb(ax25, ax25_dev);
1110
1111done:
1112 ax25_cb_add(ax25);
1113 sock_reset_flag(sk, SOCK_ZAPPED);
1114
1115out:
1116 release_sock(sk);
1117
1118 return err;
1119}
1120
1121/*
1122 * FIXME: nonblock behaviour looks like it may have a bug.
1123 */
1124static int __must_check ax25_connect(struct socket *sock,
1125 struct sockaddr *uaddr, int addr_len, int flags)
1126{
1127 struct sock *sk = sock->sk;
1128 ax25_cb *ax25 = sk_to_ax25(sk), *ax25t;
1129 struct full_sockaddr_ax25 *fsa = (struct full_sockaddr_ax25 *)uaddr;
1130 ax25_digi *digi = NULL;
1131 int ct = 0, err = 0;
1132
1133 /*
1134 * some sanity checks. code further down depends on this
1135 */
1136
1137 if (addr_len == sizeof(struct sockaddr_ax25))
1138 /* support for this will go away in early 2.5.x
1139 * ax25_connect(): uses obsolete socket structure
1140 */
1141 ;
1142 else if (addr_len != sizeof(struct full_sockaddr_ax25))
1143 /* support for old structure may go away some time
1144 * ax25_connect(): uses old (6 digipeater) socket structure.
1145 */
1146 if ((addr_len < sizeof(struct sockaddr_ax25) + sizeof(ax25_address) * 6) ||
1147 (addr_len > sizeof(struct full_sockaddr_ax25)))
1148 return -EINVAL;
1149
1150
1151 if (fsa->fsa_ax25.sax25_family != AF_AX25)
1152 return -EINVAL;
1153
1154 lock_sock(sk);
1155
1156 /* deal with restarts */
1157 if (sock->state == SS_CONNECTING) {
1158 switch (sk->sk_state) {
1159 case TCP_SYN_SENT: /* still trying */
1160 err = -EINPROGRESS;
1161 goto out_release;
1162
1163 case TCP_ESTABLISHED: /* connection established */
1164 sock->state = SS_CONNECTED;
1165 goto out_release;
1166
1167 case TCP_CLOSE: /* connection refused */
1168 sock->state = SS_UNCONNECTED;
1169 err = -ECONNREFUSED;
1170 goto out_release;
1171 }
1172 }
1173
1174 if (sk->sk_state == TCP_ESTABLISHED && sk->sk_type == SOCK_SEQPACKET) {
1175 err = -EISCONN; /* No reconnect on a seqpacket socket */
1176 goto out_release;
1177 }
1178
1179 sk->sk_state = TCP_CLOSE;
1180 sock->state = SS_UNCONNECTED;
1181
1182 kfree(ax25->digipeat);
1183 ax25->digipeat = NULL;
1184
1185 /*
1186 * Handle digi-peaters to be used.
1187 */
1188 if (addr_len > sizeof(struct sockaddr_ax25) &&
1189 fsa->fsa_ax25.sax25_ndigis != 0) {
1190 /* Valid number of digipeaters ? */
1191 if (fsa->fsa_ax25.sax25_ndigis < 1 || fsa->fsa_ax25.sax25_ndigis > AX25_MAX_DIGIS) {
1192 err = -EINVAL;
1193 goto out_release;
1194 }
1195
1196 if ((digi = kmalloc(sizeof(ax25_digi), GFP_KERNEL)) == NULL) {
1197 err = -ENOBUFS;
1198 goto out_release;
1199 }
1200
1201 digi->ndigi = fsa->fsa_ax25.sax25_ndigis;
1202 digi->lastrepeat = -1;
1203
1204 while (ct < fsa->fsa_ax25.sax25_ndigis) {
1205 if ((fsa->fsa_digipeater[ct].ax25_call[6] &
1206 AX25_HBIT) && ax25->iamdigi) {
1207 digi->repeated[ct] = 1;
1208 digi->lastrepeat = ct;
1209 } else {
1210 digi->repeated[ct] = 0;
1211 }
1212 digi->calls[ct] = fsa->fsa_digipeater[ct];
1213 ct++;
1214 }
1215 }
1216
1217 /*
1218 * Must bind first - autobinding in this may or may not work. If
1219 * the socket is already bound, check to see if the device has
1220 * been filled in, error if it hasn't.
1221 */
1222 if (sock_flag(sk, SOCK_ZAPPED)) {
1223 /* check if we can remove this feature. It is broken. */
1224 printk(KERN_WARNING "ax25_connect(): %s uses autobind, please contact jreuter@yaina.de\n",
1225 current->comm);
1226 if ((err = ax25_rt_autobind(ax25, &fsa->fsa_ax25.sax25_call)) < 0) {
1227 kfree(digi);
1228 goto out_release;
1229 }
1230
1231 ax25_fillin_cb(ax25, ax25->ax25_dev);
1232 ax25_cb_add(ax25);
1233 } else {
1234 if (ax25->ax25_dev == NULL) {
1235 kfree(digi);
1236 err = -EHOSTUNREACH;
1237 goto out_release;
1238 }
1239 }
1240
1241 if (sk->sk_type == SOCK_SEQPACKET &&
1242 (ax25t=ax25_find_cb(&ax25->source_addr, &fsa->fsa_ax25.sax25_call, digi,
1243 ax25->ax25_dev->dev))) {
1244 kfree(digi);
1245 err = -EADDRINUSE; /* Already such a connection */
1246 ax25_cb_put(ax25t);
1247 goto out_release;
1248 }
1249
1250 ax25->dest_addr = fsa->fsa_ax25.sax25_call;
1251 ax25->digipeat = digi;
1252
1253 /* First the easy one */
1254 if (sk->sk_type != SOCK_SEQPACKET) {
1255 sock->state = SS_CONNECTED;
1256 sk->sk_state = TCP_ESTABLISHED;
1257 goto out_release;
1258 }
1259
1260 /* Move to connecting socket, ax.25 lapb WAIT_UA.. */
1261 sock->state = SS_CONNECTING;
1262 sk->sk_state = TCP_SYN_SENT;
1263
1264 switch (ax25->ax25_dev->values[AX25_VALUES_PROTOCOL]) {
1265 case AX25_PROTO_STD_SIMPLEX:
1266 case AX25_PROTO_STD_DUPLEX:
1267 ax25_std_establish_data_link(ax25);
1268 break;
1269
1270#ifdef CONFIG_AX25_DAMA_SLAVE
1271 case AX25_PROTO_DAMA_SLAVE:
1272 ax25->modulus = AX25_MODULUS;
1273 ax25->window = ax25->ax25_dev->values[AX25_VALUES_WINDOW];
1274 if (ax25->ax25_dev->dama.slave)
1275 ax25_ds_establish_data_link(ax25);
1276 else
1277 ax25_std_establish_data_link(ax25);
1278 break;
1279#endif
1280 }
1281
1282 ax25->state = AX25_STATE_1;
1283
1284 ax25_start_heartbeat(ax25);
1285
1286 /* Now the loop */
1287 if (sk->sk_state != TCP_ESTABLISHED && (flags & O_NONBLOCK)) {
1288 err = -EINPROGRESS;
1289 goto out_release;
1290 }
1291
1292 if (sk->sk_state == TCP_SYN_SENT) {
1293 DEFINE_WAIT(wait);
1294
1295 for (;;) {
1296 prepare_to_wait(sk_sleep(sk), &wait,
1297 TASK_INTERRUPTIBLE);
1298 if (sk->sk_state != TCP_SYN_SENT)
1299 break;
1300 if (!signal_pending(current)) {
1301 release_sock(sk);
1302 schedule();
1303 lock_sock(sk);
1304 continue;
1305 }
1306 err = -ERESTARTSYS;
1307 break;
1308 }
1309 finish_wait(sk_sleep(sk), &wait);
1310
1311 if (err)
1312 goto out_release;
1313 }
1314
1315 if (sk->sk_state != TCP_ESTABLISHED) {
1316 /* Not in ABM, not in WAIT_UA -> failed */
1317 sock->state = SS_UNCONNECTED;
1318 err = sock_error(sk); /* Always set at this point */
1319 goto out_release;
1320 }
1321
1322 sock->state = SS_CONNECTED;
1323
1324 err = 0;
1325out_release:
1326 release_sock(sk);
1327
1328 return err;
1329}
1330
1331static int ax25_accept(struct socket *sock, struct socket *newsock, int flags,
1332 bool kern)
1333{
1334 struct sk_buff *skb;
1335 struct sock *newsk;
1336 DEFINE_WAIT(wait);
1337 struct sock *sk;
1338 int err = 0;
1339
1340 if (sock->state != SS_UNCONNECTED)
1341 return -EINVAL;
1342
1343 if ((sk = sock->sk) == NULL)
1344 return -EINVAL;
1345
1346 lock_sock(sk);
1347 if (sk->sk_type != SOCK_SEQPACKET) {
1348 err = -EOPNOTSUPP;
1349 goto out;
1350 }
1351
1352 if (sk->sk_state != TCP_LISTEN) {
1353 err = -EINVAL;
1354 goto out;
1355 }
1356
1357 /*
1358 * The read queue this time is holding sockets ready to use
1359 * hooked into the SABM we saved
1360 */
1361 for (;;) {
1362 prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
1363 skb = skb_dequeue(&sk->sk_receive_queue);
1364 if (skb)
1365 break;
1366
1367 if (flags & O_NONBLOCK) {
1368 err = -EWOULDBLOCK;
1369 break;
1370 }
1371 if (!signal_pending(current)) {
1372 release_sock(sk);
1373 schedule();
1374 lock_sock(sk);
1375 continue;
1376 }
1377 err = -ERESTARTSYS;
1378 break;
1379 }
1380 finish_wait(sk_sleep(sk), &wait);
1381
1382 if (err)
1383 goto out;
1384
1385 newsk = skb->sk;
1386 sock_graft(newsk, newsock);
1387
1388 /* Now attach up the new socket */
1389 kfree_skb(skb);
1390 sk->sk_ack_backlog--;
1391 newsock->state = SS_CONNECTED;
1392
1393out:
1394 release_sock(sk);
1395
1396 return err;
1397}
1398
1399static int ax25_getname(struct socket *sock, struct sockaddr *uaddr,
1400 int peer)
1401{
1402 struct full_sockaddr_ax25 *fsa = (struct full_sockaddr_ax25 *)uaddr;
1403 struct sock *sk = sock->sk;
1404 unsigned char ndigi, i;
1405 ax25_cb *ax25;
1406 int err = 0;
1407
1408 memset(fsa, 0, sizeof(*fsa));
1409 lock_sock(sk);
1410 ax25 = sk_to_ax25(sk);
1411
1412 if (peer != 0) {
1413 if (sk->sk_state != TCP_ESTABLISHED) {
1414 err = -ENOTCONN;
1415 goto out;
1416 }
1417
1418 fsa->fsa_ax25.sax25_family = AF_AX25;
1419 fsa->fsa_ax25.sax25_call = ax25->dest_addr;
1420
1421 if (ax25->digipeat != NULL) {
1422 ndigi = ax25->digipeat->ndigi;
1423 fsa->fsa_ax25.sax25_ndigis = ndigi;
1424 for (i = 0; i < ndigi; i++)
1425 fsa->fsa_digipeater[i] =
1426 ax25->digipeat->calls[i];
1427 }
1428 } else {
1429 fsa->fsa_ax25.sax25_family = AF_AX25;
1430 fsa->fsa_ax25.sax25_call = ax25->source_addr;
1431 fsa->fsa_ax25.sax25_ndigis = 1;
1432 if (ax25->ax25_dev != NULL) {
1433 memcpy(&fsa->fsa_digipeater[0],
1434 ax25->ax25_dev->dev->dev_addr, AX25_ADDR_LEN);
1435 } else {
1436 fsa->fsa_digipeater[0] = null_ax25_address;
1437 }
1438 }
1439 err = sizeof (struct full_sockaddr_ax25);
1440
1441out:
1442 release_sock(sk);
1443
1444 return err;
1445}
1446
1447static int ax25_sendmsg(struct socket *sock, struct msghdr *msg, size_t len)
1448{
1449 DECLARE_SOCKADDR(struct sockaddr_ax25 *, usax, msg->msg_name);
1450 struct sock *sk = sock->sk;
1451 struct sockaddr_ax25 sax;
1452 struct sk_buff *skb;
1453 ax25_digi dtmp, *dp;
1454 ax25_cb *ax25;
1455 size_t size;
1456 int lv, err, addr_len = msg->msg_namelen;
1457
1458 if (msg->msg_flags & ~(MSG_DONTWAIT|MSG_EOR|MSG_CMSG_COMPAT))
1459 return -EINVAL;
1460
1461 lock_sock(sk);
1462 ax25 = sk_to_ax25(sk);
1463
1464 if (sock_flag(sk, SOCK_ZAPPED)) {
1465 err = -EADDRNOTAVAIL;
1466 goto out;
1467 }
1468
1469 if (sk->sk_shutdown & SEND_SHUTDOWN) {
1470 send_sig(SIGPIPE, current, 0);
1471 err = -EPIPE;
1472 goto out;
1473 }
1474
1475 if (ax25->ax25_dev == NULL) {
1476 err = -ENETUNREACH;
1477 goto out;
1478 }
1479
1480 if (len > ax25->ax25_dev->dev->mtu) {
1481 err = -EMSGSIZE;
1482 goto out;
1483 }
1484
1485 if (usax != NULL) {
1486 if (usax->sax25_family != AF_AX25) {
1487 err = -EINVAL;
1488 goto out;
1489 }
1490
1491 if (addr_len == sizeof(struct sockaddr_ax25))
1492 /* ax25_sendmsg(): uses obsolete socket structure */
1493 ;
1494 else if (addr_len != sizeof(struct full_sockaddr_ax25))
1495 /* support for old structure may go away some time
1496 * ax25_sendmsg(): uses old (6 digipeater)
1497 * socket structure.
1498 */
1499 if ((addr_len < sizeof(struct sockaddr_ax25) + sizeof(ax25_address) * 6) ||
1500 (addr_len > sizeof(struct full_sockaddr_ax25))) {
1501 err = -EINVAL;
1502 goto out;
1503 }
1504
1505
1506 if (addr_len > sizeof(struct sockaddr_ax25) && usax->sax25_ndigis != 0) {
1507 int ct = 0;
1508 struct full_sockaddr_ax25 *fsa = (struct full_sockaddr_ax25 *)usax;
1509
1510 /* Valid number of digipeaters ? */
1511 if (usax->sax25_ndigis < 1 || usax->sax25_ndigis > AX25_MAX_DIGIS) {
1512 err = -EINVAL;
1513 goto out;
1514 }
1515
1516 dtmp.ndigi = usax->sax25_ndigis;
1517
1518 while (ct < usax->sax25_ndigis) {
1519 dtmp.repeated[ct] = 0;
1520 dtmp.calls[ct] = fsa->fsa_digipeater[ct];
1521 ct++;
1522 }
1523
1524 dtmp.lastrepeat = 0;
1525 }
1526
1527 sax = *usax;
1528 if (sk->sk_type == SOCK_SEQPACKET &&
1529 ax25cmp(&ax25->dest_addr, &sax.sax25_call)) {
1530 err = -EISCONN;
1531 goto out;
1532 }
1533 if (usax->sax25_ndigis == 0)
1534 dp = NULL;
1535 else
1536 dp = &dtmp;
1537 } else {
1538 /*
1539 * FIXME: 1003.1g - if the socket is like this because
1540 * it has become closed (not started closed) and is VC
1541 * we ought to SIGPIPE, EPIPE
1542 */
1543 if (sk->sk_state != TCP_ESTABLISHED) {
1544 err = -ENOTCONN;
1545 goto out;
1546 }
1547 sax.sax25_family = AF_AX25;
1548 sax.sax25_call = ax25->dest_addr;
1549 dp = ax25->digipeat;
1550 }
1551
1552 /* Build a packet */
1553 /* Assume the worst case */
1554 size = len + ax25->ax25_dev->dev->hard_header_len;
1555
1556 skb = sock_alloc_send_skb(sk, size, msg->msg_flags&MSG_DONTWAIT, &err);
1557 if (skb == NULL)
1558 goto out;
1559
1560 skb_reserve(skb, size - len);
1561
1562 /* User data follows immediately after the AX.25 data */
1563 if (memcpy_from_msg(skb_put(skb, len), msg, len)) {
1564 err = -EFAULT;
1565 kfree_skb(skb);
1566 goto out;
1567 }
1568
1569 skb_reset_network_header(skb);
1570
1571 /* Add the PID if one is not supplied by the user in the skb */
1572 if (!ax25->pidincl)
1573 *(u8 *)skb_push(skb, 1) = sk->sk_protocol;
1574
1575 if (sk->sk_type == SOCK_SEQPACKET) {
1576 /* Connected mode sockets go via the LAPB machine */
1577 if (sk->sk_state != TCP_ESTABLISHED) {
1578 kfree_skb(skb);
1579 err = -ENOTCONN;
1580 goto out;
1581 }
1582
1583 /* Shove it onto the queue and kick */
1584 ax25_output(ax25, ax25->paclen, skb);
1585
1586 err = len;
1587 goto out;
1588 }
1589
1590 skb_push(skb, 1 + ax25_addr_size(dp));
1591
1592 /* Building AX.25 Header */
1593
1594 /* Build an AX.25 header */
1595 lv = ax25_addr_build(skb->data, &ax25->source_addr, &sax.sax25_call,
1596 dp, AX25_COMMAND, AX25_MODULUS);
1597
1598 skb_set_transport_header(skb, lv);
1599
1600 *skb_transport_header(skb) = AX25_UI;
1601
1602 /* Datagram frames go straight out of the door as UI */
1603 ax25_queue_xmit(skb, ax25->ax25_dev->dev);
1604
1605 err = len;
1606
1607out:
1608 release_sock(sk);
1609
1610 return err;
1611}
1612
1613static int ax25_recvmsg(struct socket *sock, struct msghdr *msg, size_t size,
1614 int flags)
1615{
1616 struct sock *sk = sock->sk;
1617 struct sk_buff *skb;
1618 int copied;
1619 int err = 0;
1620
1621 lock_sock(sk);
1622 /*
1623 * This works for seqpacket too. The receiver has ordered the
1624 * queue for us! We do one quick check first though
1625 */
1626 if (sk->sk_type == SOCK_SEQPACKET && sk->sk_state != TCP_ESTABLISHED) {
1627 err = -ENOTCONN;
1628 goto out;
1629 }
1630
1631 /* Now we can treat all alike */
1632 skb = skb_recv_datagram(sk, flags & ~MSG_DONTWAIT,
1633 flags & MSG_DONTWAIT, &err);
1634 if (skb == NULL)
1635 goto out;
1636
1637 if (!sk_to_ax25(sk)->pidincl)
1638 skb_pull(skb, 1); /* Remove PID */
1639
1640 skb_reset_transport_header(skb);
1641 copied = skb->len;
1642
1643 if (copied > size) {
1644 copied = size;
1645 msg->msg_flags |= MSG_TRUNC;
1646 }
1647
1648 skb_copy_datagram_msg(skb, 0, msg, copied);
1649
1650 if (msg->msg_name) {
1651 ax25_digi digi;
1652 ax25_address src;
1653 const unsigned char *mac = skb_mac_header(skb);
1654 DECLARE_SOCKADDR(struct sockaddr_ax25 *, sax, msg->msg_name);
1655
1656 memset(sax, 0, sizeof(struct full_sockaddr_ax25));
1657 ax25_addr_parse(mac + 1, skb->data - mac - 1, &src, NULL,
1658 &digi, NULL, NULL);
1659 sax->sax25_family = AF_AX25;
1660 /* We set this correctly, even though we may not let the
1661 application know the digi calls further down (because it
1662 did NOT ask to know them). This could get political... **/
1663 sax->sax25_ndigis = digi.ndigi;
1664 sax->sax25_call = src;
1665
1666 if (sax->sax25_ndigis != 0) {
1667 int ct;
1668 struct full_sockaddr_ax25 *fsa = (struct full_sockaddr_ax25 *)sax;
1669
1670 for (ct = 0; ct < digi.ndigi; ct++)
1671 fsa->fsa_digipeater[ct] = digi.calls[ct];
1672 }
1673 msg->msg_namelen = sizeof(struct full_sockaddr_ax25);
1674 }
1675
1676 skb_free_datagram(sk, skb);
1677 err = copied;
1678
1679out:
1680 release_sock(sk);
1681
1682 return err;
1683}
1684
1685static int ax25_shutdown(struct socket *sk, int how)
1686{
1687 /* FIXME - generate DM and RNR states */
1688 return -EOPNOTSUPP;
1689}
1690
1691static int ax25_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
1692{
1693 struct sock *sk = sock->sk;
1694 void __user *argp = (void __user *)arg;
1695 int res = 0;
1696
1697 lock_sock(sk);
1698 switch (cmd) {
1699 case TIOCOUTQ: {
1700 long amount;
1701
1702 amount = sk->sk_sndbuf - sk_wmem_alloc_get(sk);
1703 if (amount < 0)
1704 amount = 0;
1705 res = put_user(amount, (int __user *)argp);
1706 break;
1707 }
1708
1709 case TIOCINQ: {
1710 struct sk_buff *skb;
1711 long amount = 0L;
1712 /* These two are safe on a single CPU system as only user tasks fiddle here */
1713 if ((skb = skb_peek(&sk->sk_receive_queue)) != NULL)
1714 amount = skb->len;
1715 res = put_user(amount, (int __user *) argp);
1716 break;
1717 }
1718
1719 case SIOCGSTAMP:
1720 res = sock_get_timestamp(sk, argp);
1721 break;
1722
1723 case SIOCGSTAMPNS:
1724 res = sock_get_timestampns(sk, argp);
1725 break;
1726
1727 case SIOCAX25ADDUID: /* Add a uid to the uid/call map table */
1728 case SIOCAX25DELUID: /* Delete a uid from the uid/call map table */
1729 case SIOCAX25GETUID: {
1730 struct sockaddr_ax25 sax25;
1731 if (copy_from_user(&sax25, argp, sizeof(sax25))) {
1732 res = -EFAULT;
1733 break;
1734 }
1735 res = ax25_uid_ioctl(cmd, &sax25);
1736 break;
1737 }
1738
1739 case SIOCAX25NOUID: { /* Set the default policy (default/bar) */
1740 long amount;
1741 if (!capable(CAP_NET_ADMIN)) {
1742 res = -EPERM;
1743 break;
1744 }
1745 if (get_user(amount, (long __user *)argp)) {
1746 res = -EFAULT;
1747 break;
1748 }
1749 if (amount < 0 || amount > AX25_NOUID_BLOCK) {
1750 res = -EINVAL;
1751 break;
1752 }
1753 ax25_uid_policy = amount;
1754 res = 0;
1755 break;
1756 }
1757
1758 case SIOCADDRT:
1759 case SIOCDELRT:
1760 case SIOCAX25OPTRT:
1761 if (!capable(CAP_NET_ADMIN)) {
1762 res = -EPERM;
1763 break;
1764 }
1765 res = ax25_rt_ioctl(cmd, argp);
1766 break;
1767
1768 case SIOCAX25CTLCON:
1769 if (!capable(CAP_NET_ADMIN)) {
1770 res = -EPERM;
1771 break;
1772 }
1773 res = ax25_ctl_ioctl(cmd, argp);
1774 break;
1775
1776 case SIOCAX25GETINFO:
1777 case SIOCAX25GETINFOOLD: {
1778 ax25_cb *ax25 = sk_to_ax25(sk);
1779 struct ax25_info_struct ax25_info;
1780
1781 ax25_info.t1 = ax25->t1 / HZ;
1782 ax25_info.t2 = ax25->t2 / HZ;
1783 ax25_info.t3 = ax25->t3 / HZ;
1784 ax25_info.idle = ax25->idle / (60 * HZ);
1785 ax25_info.n2 = ax25->n2;
1786 ax25_info.t1timer = ax25_display_timer(&ax25->t1timer) / HZ;
1787 ax25_info.t2timer = ax25_display_timer(&ax25->t2timer) / HZ;
1788 ax25_info.t3timer = ax25_display_timer(&ax25->t3timer) / HZ;
1789 ax25_info.idletimer = ax25_display_timer(&ax25->idletimer) / (60 * HZ);
1790 ax25_info.n2count = ax25->n2count;
1791 ax25_info.state = ax25->state;
1792 ax25_info.rcv_q = sk_rmem_alloc_get(sk);
1793 ax25_info.snd_q = sk_wmem_alloc_get(sk);
1794 ax25_info.vs = ax25->vs;
1795 ax25_info.vr = ax25->vr;
1796 ax25_info.va = ax25->va;
1797 ax25_info.vs_max = ax25->vs; /* reserved */
1798 ax25_info.paclen = ax25->paclen;
1799 ax25_info.window = ax25->window;
1800
1801 /* old structure? */
1802 if (cmd == SIOCAX25GETINFOOLD) {
1803 static int warned = 0;
1804 if (!warned) {
1805 printk(KERN_INFO "%s uses old SIOCAX25GETINFO\n",
1806 current->comm);
1807 warned=1;
1808 }
1809
1810 if (copy_to_user(argp, &ax25_info, sizeof(struct ax25_info_struct_deprecated))) {
1811 res = -EFAULT;
1812 break;
1813 }
1814 } else {
1815 if (copy_to_user(argp, &ax25_info, sizeof(struct ax25_info_struct))) {
1816 res = -EINVAL;
1817 break;
1818 }
1819 }
1820 res = 0;
1821 break;
1822 }
1823
1824 case SIOCAX25ADDFWD:
1825 case SIOCAX25DELFWD: {
1826 struct ax25_fwd_struct ax25_fwd;
1827 if (!capable(CAP_NET_ADMIN)) {
1828 res = -EPERM;
1829 break;
1830 }
1831 if (copy_from_user(&ax25_fwd, argp, sizeof(ax25_fwd))) {
1832 res = -EFAULT;
1833 break;
1834 }
1835 res = ax25_fwd_ioctl(cmd, &ax25_fwd);
1836 break;
1837 }
1838
1839 case SIOCGIFADDR:
1840 case SIOCSIFADDR:
1841 case SIOCGIFDSTADDR:
1842 case SIOCSIFDSTADDR:
1843 case SIOCGIFBRDADDR:
1844 case SIOCSIFBRDADDR:
1845 case SIOCGIFNETMASK:
1846 case SIOCSIFNETMASK:
1847 case SIOCGIFMETRIC:
1848 case SIOCSIFMETRIC:
1849 res = -EINVAL;
1850 break;
1851
1852 default:
1853 res = -ENOIOCTLCMD;
1854 break;
1855 }
1856 release_sock(sk);
1857
1858 return res;
1859}
1860
1861#ifdef CONFIG_PROC_FS
1862
1863static void *ax25_info_start(struct seq_file *seq, loff_t *pos)
1864 __acquires(ax25_list_lock)
1865{
1866 spin_lock_bh(&ax25_list_lock);
1867 return seq_hlist_start(&ax25_list, *pos);
1868}
1869
1870static void *ax25_info_next(struct seq_file *seq, void *v, loff_t *pos)
1871{
1872 return seq_hlist_next(v, &ax25_list, pos);
1873}
1874
1875static void ax25_info_stop(struct seq_file *seq, void *v)
1876 __releases(ax25_list_lock)
1877{
1878 spin_unlock_bh(&ax25_list_lock);
1879}
1880
1881static int ax25_info_show(struct seq_file *seq, void *v)
1882{
1883 ax25_cb *ax25 = hlist_entry(v, struct ax25_cb, ax25_node);
1884 char buf[11];
1885 int k;
1886
1887
1888 /*
1889 * New format:
1890 * magic dev src_addr dest_addr,digi1,digi2,.. st vs vr va t1 t1 t2 t2 t3 t3 idle idle n2 n2 rtt window paclen Snd-Q Rcv-Q inode
1891 */
1892
1893 seq_printf(seq, "%8.8lx %s %s%s ",
1894 (long) ax25,
1895 ax25->ax25_dev == NULL? "???" : ax25->ax25_dev->dev->name,
1896 ax2asc(buf, &ax25->source_addr),
1897 ax25->iamdigi? "*":"");
1898 seq_printf(seq, "%s", ax2asc(buf, &ax25->dest_addr));
1899
1900 for (k=0; (ax25->digipeat != NULL) && (k < ax25->digipeat->ndigi); k++) {
1901 seq_printf(seq, ",%s%s",
1902 ax2asc(buf, &ax25->digipeat->calls[k]),
1903 ax25->digipeat->repeated[k]? "*":"");
1904 }
1905
1906 seq_printf(seq, " %d %d %d %d %lu %lu %lu %lu %lu %lu %lu %lu %d %d %lu %d %d",
1907 ax25->state,
1908 ax25->vs, ax25->vr, ax25->va,
1909 ax25_display_timer(&ax25->t1timer) / HZ, ax25->t1 / HZ,
1910 ax25_display_timer(&ax25->t2timer) / HZ, ax25->t2 / HZ,
1911 ax25_display_timer(&ax25->t3timer) / HZ, ax25->t3 / HZ,
1912 ax25_display_timer(&ax25->idletimer) / (60 * HZ),
1913 ax25->idle / (60 * HZ),
1914 ax25->n2count, ax25->n2,
1915 ax25->rtt / HZ,
1916 ax25->window,
1917 ax25->paclen);
1918
1919 if (ax25->sk != NULL) {
1920 seq_printf(seq, " %d %d %lu\n",
1921 sk_wmem_alloc_get(ax25->sk),
1922 sk_rmem_alloc_get(ax25->sk),
1923 sock_i_ino(ax25->sk));
1924 } else {
1925 seq_puts(seq, " * * *\n");
1926 }
1927 return 0;
1928}
1929
1930static const struct seq_operations ax25_info_seqops = {
1931 .start = ax25_info_start,
1932 .next = ax25_info_next,
1933 .stop = ax25_info_stop,
1934 .show = ax25_info_show,
1935};
1936#endif
1937
1938static const struct net_proto_family ax25_family_ops = {
1939 .family = PF_AX25,
1940 .create = ax25_create,
1941 .owner = THIS_MODULE,
1942};
1943
1944static const struct proto_ops ax25_proto_ops = {
1945 .family = PF_AX25,
1946 .owner = THIS_MODULE,
1947 .release = ax25_release,
1948 .bind = ax25_bind,
1949 .connect = ax25_connect,
1950 .socketpair = sock_no_socketpair,
1951 .accept = ax25_accept,
1952 .getname = ax25_getname,
1953 .poll = datagram_poll,
1954 .ioctl = ax25_ioctl,
1955 .listen = ax25_listen,
1956 .shutdown = ax25_shutdown,
1957 .setsockopt = ax25_setsockopt,
1958 .getsockopt = ax25_getsockopt,
1959 .sendmsg = ax25_sendmsg,
1960 .recvmsg = ax25_recvmsg,
1961 .mmap = sock_no_mmap,
1962 .sendpage = sock_no_sendpage,
1963};
1964
1965/*
1966 * Called by socket.c on kernel start up
1967 */
1968static struct packet_type ax25_packet_type __read_mostly = {
1969 .type = cpu_to_be16(ETH_P_AX25),
1970 .func = ax25_kiss_rcv,
1971};
1972
1973static struct notifier_block ax25_dev_notifier = {
1974 .notifier_call = ax25_device_event,
1975};
1976
1977static int __init ax25_init(void)
1978{
1979 int rc = proto_register(&ax25_proto, 0);
1980
1981 if (rc != 0)
1982 goto out;
1983
1984 sock_register(&ax25_family_ops);
1985 dev_add_pack(&ax25_packet_type);
1986 register_netdevice_notifier(&ax25_dev_notifier);
1987
1988 proc_create_seq("ax25_route", 0444, init_net.proc_net, &ax25_rt_seqops);
1989 proc_create_seq("ax25", 0444, init_net.proc_net, &ax25_info_seqops);
1990 proc_create_seq("ax25_calls", 0444, init_net.proc_net,
1991 &ax25_uid_seqops);
1992out:
1993 return rc;
1994}
1995module_init(ax25_init);
1996
1997
1998MODULE_AUTHOR("Jonathan Naylor G4KLX <g4klx@g4klx.demon.co.uk>");
1999MODULE_DESCRIPTION("The amateur radio AX.25 link layer protocol");
2000MODULE_LICENSE("GPL");
2001MODULE_ALIAS_NETPROTO(PF_AX25);
2002
2003static void __exit ax25_exit(void)
2004{
2005 remove_proc_entry("ax25_route", init_net.proc_net);
2006 remove_proc_entry("ax25", init_net.proc_net);
2007 remove_proc_entry("ax25_calls", init_net.proc_net);
2008
2009 unregister_netdevice_notifier(&ax25_dev_notifier);
2010
2011 dev_remove_pack(&ax25_packet_type);
2012
2013 sock_unregister(PF_AX25);
2014 proto_unregister(&ax25_proto);
2015
2016 ax25_rt_free();
2017 ax25_uid_free();
2018 ax25_dev_free();
2019}
2020module_exit(ax25_exit);