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 53 HLIST_HEAD(ax25_list); 54 DEFINE_SPINLOCK(ax25_list_lock); 55 56 static const struct proto_ops ax25_proto_ops; 57 58 static 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 */ 66 static 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 */ 79 static 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); 88 again: 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 */ 112 static 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 */ 143 void 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 */ 155 struct 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 */ 182 struct 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 */ 208 ax25_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 240 EXPORT_SYMBOL(ax25_find_cb); 241 242 void 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 */ 266 void ax25_destroy_socket(ax25_cb *); 267 268 /* 269 * Handler for deferred kills. 270 */ 271 static 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 */ 291 void 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 */ 347 static 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 439 out_put: 440 ax25_cb_put(ax25); 441 return ret; 442 443 einval_put: 444 ret = -EINVAL; 445 goto out_put; 446 } 447 448 static 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 */ 472 void 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 */ 505 ax25_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 533 static 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 682 static 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 779 static 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 792 out: 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 */ 802 static struct proto ax25_proto = { 803 .name = "AX25", 804 .owner = THIS_MODULE, 805 .obj_size = sizeof(struct ax25_sock), 806 }; 807 808 static 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 break; 862 default: 863 return -ESOCKTNOSUPPORT; 864 } 865 866 sk = sk_alloc(net, PF_AX25, GFP_ATOMIC, &ax25_proto, kern); 867 if (sk == NULL) 868 return -ENOMEM; 869 870 ax25 = ax25_sk(sk)->cb = ax25_create_cb(); 871 if (!ax25) { 872 sk_free(sk); 873 return -ENOMEM; 874 } 875 876 sock_init_data(sock, sk); 877 878 sk->sk_destruct = ax25_free_sock; 879 sock->ops = &ax25_proto_ops; 880 sk->sk_protocol = protocol; 881 882 ax25->sk = sk; 883 884 return 0; 885 } 886 887 struct sock *ax25_make_new(struct sock *osk, struct ax25_dev *ax25_dev) 888 { 889 struct sock *sk; 890 ax25_cb *ax25, *oax25; 891 892 sk = sk_alloc(sock_net(osk), PF_AX25, GFP_ATOMIC, osk->sk_prot, 0); 893 if (sk == NULL) 894 return NULL; 895 896 if ((ax25 = ax25_create_cb()) == NULL) { 897 sk_free(sk); 898 return NULL; 899 } 900 901 switch (osk->sk_type) { 902 case SOCK_DGRAM: 903 break; 904 case SOCK_SEQPACKET: 905 break; 906 default: 907 sk_free(sk); 908 ax25_cb_put(ax25); 909 return NULL; 910 } 911 912 sock_init_data(NULL, sk); 913 914 sk->sk_type = osk->sk_type; 915 sk->sk_priority = osk->sk_priority; 916 sk->sk_protocol = osk->sk_protocol; 917 sk->sk_rcvbuf = osk->sk_rcvbuf; 918 sk->sk_sndbuf = osk->sk_sndbuf; 919 sk->sk_state = TCP_ESTABLISHED; 920 sock_copy_flags(sk, osk); 921 922 oax25 = sk_to_ax25(osk); 923 924 ax25->modulus = oax25->modulus; 925 ax25->backoff = oax25->backoff; 926 ax25->pidincl = oax25->pidincl; 927 ax25->iamdigi = oax25->iamdigi; 928 ax25->rtt = oax25->rtt; 929 ax25->t1 = oax25->t1; 930 ax25->t2 = oax25->t2; 931 ax25->t3 = oax25->t3; 932 ax25->n2 = oax25->n2; 933 ax25->idle = oax25->idle; 934 ax25->paclen = oax25->paclen; 935 ax25->window = oax25->window; 936 937 ax25->ax25_dev = ax25_dev; 938 ax25->source_addr = oax25->source_addr; 939 940 if (oax25->digipeat != NULL) { 941 ax25->digipeat = kmemdup(oax25->digipeat, sizeof(ax25_digi), 942 GFP_ATOMIC); 943 if (ax25->digipeat == NULL) { 944 sk_free(sk); 945 ax25_cb_put(ax25); 946 return NULL; 947 } 948 } 949 950 ax25_sk(sk)->cb = ax25; 951 sk->sk_destruct = ax25_free_sock; 952 ax25->sk = sk; 953 954 return sk; 955 } 956 957 static int ax25_release(struct socket *sock) 958 { 959 struct sock *sk = sock->sk; 960 ax25_cb *ax25; 961 962 if (sk == NULL) 963 return 0; 964 965 sock_hold(sk); 966 sock_orphan(sk); 967 lock_sock(sk); 968 ax25 = sk_to_ax25(sk); 969 970 if (sk->sk_type == SOCK_SEQPACKET) { 971 switch (ax25->state) { 972 case AX25_STATE_0: 973 release_sock(sk); 974 ax25_disconnect(ax25, 0); 975 lock_sock(sk); 976 ax25_destroy_socket(ax25); 977 break; 978 979 case AX25_STATE_1: 980 case AX25_STATE_2: 981 ax25_send_control(ax25, AX25_DISC, AX25_POLLON, AX25_COMMAND); 982 release_sock(sk); 983 ax25_disconnect(ax25, 0); 984 lock_sock(sk); 985 if (!sock_flag(ax25->sk, SOCK_DESTROY)) 986 ax25_destroy_socket(ax25); 987 break; 988 989 case AX25_STATE_3: 990 case AX25_STATE_4: 991 ax25_clear_queues(ax25); 992 ax25->n2count = 0; 993 994 switch (ax25->ax25_dev->values[AX25_VALUES_PROTOCOL]) { 995 case AX25_PROTO_STD_SIMPLEX: 996 case AX25_PROTO_STD_DUPLEX: 997 ax25_send_control(ax25, 998 AX25_DISC, 999 AX25_POLLON, 1000 AX25_COMMAND); 1001 ax25_stop_t2timer(ax25); 1002 ax25_stop_t3timer(ax25); 1003 ax25_stop_idletimer(ax25); 1004 break; 1005 #ifdef CONFIG_AX25_DAMA_SLAVE 1006 case AX25_PROTO_DAMA_SLAVE: 1007 ax25_stop_t3timer(ax25); 1008 ax25_stop_idletimer(ax25); 1009 break; 1010 #endif 1011 } 1012 ax25_calculate_t1(ax25); 1013 ax25_start_t1timer(ax25); 1014 ax25->state = AX25_STATE_2; 1015 sk->sk_state = TCP_CLOSE; 1016 sk->sk_shutdown |= SEND_SHUTDOWN; 1017 sk->sk_state_change(sk); 1018 sock_set_flag(sk, SOCK_DESTROY); 1019 break; 1020 1021 default: 1022 break; 1023 } 1024 } else { 1025 sk->sk_state = TCP_CLOSE; 1026 sk->sk_shutdown |= SEND_SHUTDOWN; 1027 sk->sk_state_change(sk); 1028 ax25_destroy_socket(ax25); 1029 } 1030 1031 sock->sk = NULL; 1032 release_sock(sk); 1033 sock_put(sk); 1034 1035 return 0; 1036 } 1037 1038 /* 1039 * We support a funny extension here so you can (as root) give any callsign 1040 * digipeated via a local address as source. This hack is obsolete now 1041 * that we've implemented support for SO_BINDTODEVICE. It is however small 1042 * and trivially backward compatible. 1043 */ 1044 static int ax25_bind(struct socket *sock, struct sockaddr *uaddr, int addr_len) 1045 { 1046 struct sock *sk = sock->sk; 1047 struct full_sockaddr_ax25 *addr = (struct full_sockaddr_ax25 *)uaddr; 1048 ax25_dev *ax25_dev = NULL; 1049 ax25_uid_assoc *user; 1050 ax25_address call; 1051 ax25_cb *ax25; 1052 int err = 0; 1053 1054 if (addr_len != sizeof(struct sockaddr_ax25) && 1055 addr_len != sizeof(struct full_sockaddr_ax25)) 1056 /* support for old structure may go away some time 1057 * ax25_bind(): uses old (6 digipeater) socket structure. 1058 */ 1059 if ((addr_len < sizeof(struct sockaddr_ax25) + sizeof(ax25_address) * 6) || 1060 (addr_len > sizeof(struct full_sockaddr_ax25))) 1061 return -EINVAL; 1062 1063 if (addr->fsa_ax25.sax25_family != AF_AX25) 1064 return -EINVAL; 1065 1066 user = ax25_findbyuid(current_euid()); 1067 if (user) { 1068 call = user->call; 1069 ax25_uid_put(user); 1070 } else { 1071 if (ax25_uid_policy && !capable(CAP_NET_ADMIN)) 1072 return -EACCES; 1073 1074 call = addr->fsa_ax25.sax25_call; 1075 } 1076 1077 lock_sock(sk); 1078 1079 ax25 = sk_to_ax25(sk); 1080 if (!sock_flag(sk, SOCK_ZAPPED)) { 1081 err = -EINVAL; 1082 goto out; 1083 } 1084 1085 ax25->source_addr = call; 1086 1087 /* 1088 * User already set interface with SO_BINDTODEVICE 1089 */ 1090 if (ax25->ax25_dev != NULL) 1091 goto done; 1092 1093 if (addr_len > sizeof(struct sockaddr_ax25) && addr->fsa_ax25.sax25_ndigis == 1) { 1094 if (ax25cmp(&addr->fsa_digipeater[0], &null_ax25_address) != 0 && 1095 (ax25_dev = ax25_addr_ax25dev(&addr->fsa_digipeater[0])) == NULL) { 1096 err = -EADDRNOTAVAIL; 1097 goto out; 1098 } 1099 } else { 1100 if ((ax25_dev = ax25_addr_ax25dev(&addr->fsa_ax25.sax25_call)) == NULL) { 1101 err = -EADDRNOTAVAIL; 1102 goto out; 1103 } 1104 } 1105 1106 if (ax25_dev != NULL) 1107 ax25_fillin_cb(ax25, ax25_dev); 1108 1109 done: 1110 ax25_cb_add(ax25); 1111 sock_reset_flag(sk, SOCK_ZAPPED); 1112 1113 out: 1114 release_sock(sk); 1115 1116 return err; 1117 } 1118 1119 /* 1120 * FIXME: nonblock behaviour looks like it may have a bug. 1121 */ 1122 static int __must_check ax25_connect(struct socket *sock, 1123 struct sockaddr *uaddr, int addr_len, int flags) 1124 { 1125 struct sock *sk = sock->sk; 1126 ax25_cb *ax25 = sk_to_ax25(sk), *ax25t; 1127 struct full_sockaddr_ax25 *fsa = (struct full_sockaddr_ax25 *)uaddr; 1128 ax25_digi *digi = NULL; 1129 int ct = 0, err = 0; 1130 1131 /* 1132 * some sanity checks. code further down depends on this 1133 */ 1134 1135 if (addr_len == sizeof(struct sockaddr_ax25)) 1136 /* support for this will go away in early 2.5.x 1137 * ax25_connect(): uses obsolete socket structure 1138 */ 1139 ; 1140 else if (addr_len != sizeof(struct full_sockaddr_ax25)) 1141 /* support for old structure may go away some time 1142 * ax25_connect(): uses old (6 digipeater) socket structure. 1143 */ 1144 if ((addr_len < sizeof(struct sockaddr_ax25) + sizeof(ax25_address) * 6) || 1145 (addr_len > sizeof(struct full_sockaddr_ax25))) 1146 return -EINVAL; 1147 1148 1149 if (fsa->fsa_ax25.sax25_family != AF_AX25) 1150 return -EINVAL; 1151 1152 lock_sock(sk); 1153 1154 /* deal with restarts */ 1155 if (sock->state == SS_CONNECTING) { 1156 switch (sk->sk_state) { 1157 case TCP_SYN_SENT: /* still trying */ 1158 err = -EINPROGRESS; 1159 goto out_release; 1160 1161 case TCP_ESTABLISHED: /* connection established */ 1162 sock->state = SS_CONNECTED; 1163 goto out_release; 1164 1165 case TCP_CLOSE: /* connection refused */ 1166 sock->state = SS_UNCONNECTED; 1167 err = -ECONNREFUSED; 1168 goto out_release; 1169 } 1170 } 1171 1172 if (sk->sk_state == TCP_ESTABLISHED && sk->sk_type == SOCK_SEQPACKET) { 1173 err = -EISCONN; /* No reconnect on a seqpacket socket */ 1174 goto out_release; 1175 } 1176 1177 sk->sk_state = TCP_CLOSE; 1178 sock->state = SS_UNCONNECTED; 1179 1180 kfree(ax25->digipeat); 1181 ax25->digipeat = NULL; 1182 1183 /* 1184 * Handle digi-peaters to be used. 1185 */ 1186 if (addr_len > sizeof(struct sockaddr_ax25) && 1187 fsa->fsa_ax25.sax25_ndigis != 0) { 1188 /* Valid number of digipeaters ? */ 1189 if (fsa->fsa_ax25.sax25_ndigis < 1 || fsa->fsa_ax25.sax25_ndigis > AX25_MAX_DIGIS) { 1190 err = -EINVAL; 1191 goto out_release; 1192 } 1193 1194 if ((digi = kmalloc(sizeof(ax25_digi), GFP_KERNEL)) == NULL) { 1195 err = -ENOBUFS; 1196 goto out_release; 1197 } 1198 1199 digi->ndigi = fsa->fsa_ax25.sax25_ndigis; 1200 digi->lastrepeat = -1; 1201 1202 while (ct < fsa->fsa_ax25.sax25_ndigis) { 1203 if ((fsa->fsa_digipeater[ct].ax25_call[6] & 1204 AX25_HBIT) && ax25->iamdigi) { 1205 digi->repeated[ct] = 1; 1206 digi->lastrepeat = ct; 1207 } else { 1208 digi->repeated[ct] = 0; 1209 } 1210 digi->calls[ct] = fsa->fsa_digipeater[ct]; 1211 ct++; 1212 } 1213 } 1214 1215 /* 1216 * Must bind first - autobinding in this may or may not work. If 1217 * the socket is already bound, check to see if the device has 1218 * been filled in, error if it hasn't. 1219 */ 1220 if (sock_flag(sk, SOCK_ZAPPED)) { 1221 /* check if we can remove this feature. It is broken. */ 1222 printk(KERN_WARNING "ax25_connect(): %s uses autobind, please contact jreuter@yaina.de\n", 1223 current->comm); 1224 if ((err = ax25_rt_autobind(ax25, &fsa->fsa_ax25.sax25_call)) < 0) { 1225 kfree(digi); 1226 goto out_release; 1227 } 1228 1229 ax25_fillin_cb(ax25, ax25->ax25_dev); 1230 ax25_cb_add(ax25); 1231 } else { 1232 if (ax25->ax25_dev == NULL) { 1233 kfree(digi); 1234 err = -EHOSTUNREACH; 1235 goto out_release; 1236 } 1237 } 1238 1239 if (sk->sk_type == SOCK_SEQPACKET && 1240 (ax25t=ax25_find_cb(&ax25->source_addr, &fsa->fsa_ax25.sax25_call, digi, 1241 ax25->ax25_dev->dev))) { 1242 kfree(digi); 1243 err = -EADDRINUSE; /* Already such a connection */ 1244 ax25_cb_put(ax25t); 1245 goto out_release; 1246 } 1247 1248 ax25->dest_addr = fsa->fsa_ax25.sax25_call; 1249 ax25->digipeat = digi; 1250 1251 /* First the easy one */ 1252 if (sk->sk_type != SOCK_SEQPACKET) { 1253 sock->state = SS_CONNECTED; 1254 sk->sk_state = TCP_ESTABLISHED; 1255 goto out_release; 1256 } 1257 1258 /* Move to connecting socket, ax.25 lapb WAIT_UA.. */ 1259 sock->state = SS_CONNECTING; 1260 sk->sk_state = TCP_SYN_SENT; 1261 1262 switch (ax25->ax25_dev->values[AX25_VALUES_PROTOCOL]) { 1263 case AX25_PROTO_STD_SIMPLEX: 1264 case AX25_PROTO_STD_DUPLEX: 1265 ax25_std_establish_data_link(ax25); 1266 break; 1267 1268 #ifdef CONFIG_AX25_DAMA_SLAVE 1269 case AX25_PROTO_DAMA_SLAVE: 1270 ax25->modulus = AX25_MODULUS; 1271 ax25->window = ax25->ax25_dev->values[AX25_VALUES_WINDOW]; 1272 if (ax25->ax25_dev->dama.slave) 1273 ax25_ds_establish_data_link(ax25); 1274 else 1275 ax25_std_establish_data_link(ax25); 1276 break; 1277 #endif 1278 } 1279 1280 ax25->state = AX25_STATE_1; 1281 1282 ax25_start_heartbeat(ax25); 1283 1284 /* Now the loop */ 1285 if (sk->sk_state != TCP_ESTABLISHED && (flags & O_NONBLOCK)) { 1286 err = -EINPROGRESS; 1287 goto out_release; 1288 } 1289 1290 if (sk->sk_state == TCP_SYN_SENT) { 1291 DEFINE_WAIT(wait); 1292 1293 for (;;) { 1294 prepare_to_wait(sk_sleep(sk), &wait, 1295 TASK_INTERRUPTIBLE); 1296 if (sk->sk_state != TCP_SYN_SENT) 1297 break; 1298 if (!signal_pending(current)) { 1299 release_sock(sk); 1300 schedule(); 1301 lock_sock(sk); 1302 continue; 1303 } 1304 err = -ERESTARTSYS; 1305 break; 1306 } 1307 finish_wait(sk_sleep(sk), &wait); 1308 1309 if (err) 1310 goto out_release; 1311 } 1312 1313 if (sk->sk_state != TCP_ESTABLISHED) { 1314 /* Not in ABM, not in WAIT_UA -> failed */ 1315 sock->state = SS_UNCONNECTED; 1316 err = sock_error(sk); /* Always set at this point */ 1317 goto out_release; 1318 } 1319 1320 sock->state = SS_CONNECTED; 1321 1322 err = 0; 1323 out_release: 1324 release_sock(sk); 1325 1326 return err; 1327 } 1328 1329 static int ax25_accept(struct socket *sock, struct socket *newsock, int flags, 1330 bool kern) 1331 { 1332 struct sk_buff *skb; 1333 struct sock *newsk; 1334 DEFINE_WAIT(wait); 1335 struct sock *sk; 1336 int err = 0; 1337 1338 if (sock->state != SS_UNCONNECTED) 1339 return -EINVAL; 1340 1341 if ((sk = sock->sk) == NULL) 1342 return -EINVAL; 1343 1344 lock_sock(sk); 1345 if (sk->sk_type != SOCK_SEQPACKET) { 1346 err = -EOPNOTSUPP; 1347 goto out; 1348 } 1349 1350 if (sk->sk_state != TCP_LISTEN) { 1351 err = -EINVAL; 1352 goto out; 1353 } 1354 1355 /* 1356 * The read queue this time is holding sockets ready to use 1357 * hooked into the SABM we saved 1358 */ 1359 for (;;) { 1360 prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE); 1361 skb = skb_dequeue(&sk->sk_receive_queue); 1362 if (skb) 1363 break; 1364 1365 if (flags & O_NONBLOCK) { 1366 err = -EWOULDBLOCK; 1367 break; 1368 } 1369 if (!signal_pending(current)) { 1370 release_sock(sk); 1371 schedule(); 1372 lock_sock(sk); 1373 continue; 1374 } 1375 err = -ERESTARTSYS; 1376 break; 1377 } 1378 finish_wait(sk_sleep(sk), &wait); 1379 1380 if (err) 1381 goto out; 1382 1383 newsk = skb->sk; 1384 sock_graft(newsk, newsock); 1385 1386 /* Now attach up the new socket */ 1387 kfree_skb(skb); 1388 sk->sk_ack_backlog--; 1389 newsock->state = SS_CONNECTED; 1390 1391 out: 1392 release_sock(sk); 1393 1394 return err; 1395 } 1396 1397 static int ax25_getname(struct socket *sock, struct sockaddr *uaddr, 1398 int peer) 1399 { 1400 struct full_sockaddr_ax25 *fsa = (struct full_sockaddr_ax25 *)uaddr; 1401 struct sock *sk = sock->sk; 1402 unsigned char ndigi, i; 1403 ax25_cb *ax25; 1404 int err = 0; 1405 1406 memset(fsa, 0, sizeof(*fsa)); 1407 lock_sock(sk); 1408 ax25 = sk_to_ax25(sk); 1409 1410 if (peer != 0) { 1411 if (sk->sk_state != TCP_ESTABLISHED) { 1412 err = -ENOTCONN; 1413 goto out; 1414 } 1415 1416 fsa->fsa_ax25.sax25_family = AF_AX25; 1417 fsa->fsa_ax25.sax25_call = ax25->dest_addr; 1418 1419 if (ax25->digipeat != NULL) { 1420 ndigi = ax25->digipeat->ndigi; 1421 fsa->fsa_ax25.sax25_ndigis = ndigi; 1422 for (i = 0; i < ndigi; i++) 1423 fsa->fsa_digipeater[i] = 1424 ax25->digipeat->calls[i]; 1425 } 1426 } else { 1427 fsa->fsa_ax25.sax25_family = AF_AX25; 1428 fsa->fsa_ax25.sax25_call = ax25->source_addr; 1429 fsa->fsa_ax25.sax25_ndigis = 1; 1430 if (ax25->ax25_dev != NULL) { 1431 memcpy(&fsa->fsa_digipeater[0], 1432 ax25->ax25_dev->dev->dev_addr, AX25_ADDR_LEN); 1433 } else { 1434 fsa->fsa_digipeater[0] = null_ax25_address; 1435 } 1436 } 1437 err = sizeof (struct full_sockaddr_ax25); 1438 1439 out: 1440 release_sock(sk); 1441 1442 return err; 1443 } 1444 1445 static int ax25_sendmsg(struct socket *sock, struct msghdr *msg, size_t len) 1446 { 1447 DECLARE_SOCKADDR(struct sockaddr_ax25 *, usax, msg->msg_name); 1448 struct sock *sk = sock->sk; 1449 struct sockaddr_ax25 sax; 1450 struct sk_buff *skb; 1451 ax25_digi dtmp, *dp; 1452 ax25_cb *ax25; 1453 size_t size; 1454 int lv, err, addr_len = msg->msg_namelen; 1455 1456 if (msg->msg_flags & ~(MSG_DONTWAIT|MSG_EOR|MSG_CMSG_COMPAT)) 1457 return -EINVAL; 1458 1459 lock_sock(sk); 1460 ax25 = sk_to_ax25(sk); 1461 1462 if (sock_flag(sk, SOCK_ZAPPED)) { 1463 err = -EADDRNOTAVAIL; 1464 goto out; 1465 } 1466 1467 if (sk->sk_shutdown & SEND_SHUTDOWN) { 1468 send_sig(SIGPIPE, current, 0); 1469 err = -EPIPE; 1470 goto out; 1471 } 1472 1473 if (ax25->ax25_dev == NULL) { 1474 err = -ENETUNREACH; 1475 goto out; 1476 } 1477 1478 if (len > ax25->ax25_dev->dev->mtu) { 1479 err = -EMSGSIZE; 1480 goto out; 1481 } 1482 1483 if (usax != NULL) { 1484 if (usax->sax25_family != AF_AX25) { 1485 err = -EINVAL; 1486 goto out; 1487 } 1488 1489 if (addr_len == sizeof(struct sockaddr_ax25)) 1490 /* ax25_sendmsg(): uses obsolete socket structure */ 1491 ; 1492 else if (addr_len != sizeof(struct full_sockaddr_ax25)) 1493 /* support for old structure may go away some time 1494 * ax25_sendmsg(): uses old (6 digipeater) 1495 * socket structure. 1496 */ 1497 if ((addr_len < sizeof(struct sockaddr_ax25) + sizeof(ax25_address) * 6) || 1498 (addr_len > sizeof(struct full_sockaddr_ax25))) { 1499 err = -EINVAL; 1500 goto out; 1501 } 1502 1503 1504 if (addr_len > sizeof(struct sockaddr_ax25) && usax->sax25_ndigis != 0) { 1505 int ct = 0; 1506 struct full_sockaddr_ax25 *fsa = (struct full_sockaddr_ax25 *)usax; 1507 1508 /* Valid number of digipeaters ? */ 1509 if (usax->sax25_ndigis < 1 || usax->sax25_ndigis > AX25_MAX_DIGIS) { 1510 err = -EINVAL; 1511 goto out; 1512 } 1513 1514 dtmp.ndigi = usax->sax25_ndigis; 1515 1516 while (ct < usax->sax25_ndigis) { 1517 dtmp.repeated[ct] = 0; 1518 dtmp.calls[ct] = fsa->fsa_digipeater[ct]; 1519 ct++; 1520 } 1521 1522 dtmp.lastrepeat = 0; 1523 } 1524 1525 sax = *usax; 1526 if (sk->sk_type == SOCK_SEQPACKET && 1527 ax25cmp(&ax25->dest_addr, &sax.sax25_call)) { 1528 err = -EISCONN; 1529 goto out; 1530 } 1531 if (usax->sax25_ndigis == 0) 1532 dp = NULL; 1533 else 1534 dp = &dtmp; 1535 } else { 1536 /* 1537 * FIXME: 1003.1g - if the socket is like this because 1538 * it has become closed (not started closed) and is VC 1539 * we ought to SIGPIPE, EPIPE 1540 */ 1541 if (sk->sk_state != TCP_ESTABLISHED) { 1542 err = -ENOTCONN; 1543 goto out; 1544 } 1545 sax.sax25_family = AF_AX25; 1546 sax.sax25_call = ax25->dest_addr; 1547 dp = ax25->digipeat; 1548 } 1549 1550 /* Build a packet */ 1551 /* Assume the worst case */ 1552 size = len + ax25->ax25_dev->dev->hard_header_len; 1553 1554 skb = sock_alloc_send_skb(sk, size, msg->msg_flags&MSG_DONTWAIT, &err); 1555 if (skb == NULL) 1556 goto out; 1557 1558 skb_reserve(skb, size - len); 1559 1560 /* User data follows immediately after the AX.25 data */ 1561 if (memcpy_from_msg(skb_put(skb, len), msg, len)) { 1562 err = -EFAULT; 1563 kfree_skb(skb); 1564 goto out; 1565 } 1566 1567 skb_reset_network_header(skb); 1568 1569 /* Add the PID if one is not supplied by the user in the skb */ 1570 if (!ax25->pidincl) 1571 *(u8 *)skb_push(skb, 1) = sk->sk_protocol; 1572 1573 if (sk->sk_type == SOCK_SEQPACKET) { 1574 /* Connected mode sockets go via the LAPB machine */ 1575 if (sk->sk_state != TCP_ESTABLISHED) { 1576 kfree_skb(skb); 1577 err = -ENOTCONN; 1578 goto out; 1579 } 1580 1581 /* Shove it onto the queue and kick */ 1582 ax25_output(ax25, ax25->paclen, skb); 1583 1584 err = len; 1585 goto out; 1586 } 1587 1588 skb_push(skb, 1 + ax25_addr_size(dp)); 1589 1590 /* Building AX.25 Header */ 1591 1592 /* Build an AX.25 header */ 1593 lv = ax25_addr_build(skb->data, &ax25->source_addr, &sax.sax25_call, 1594 dp, AX25_COMMAND, AX25_MODULUS); 1595 1596 skb_set_transport_header(skb, lv); 1597 1598 *skb_transport_header(skb) = AX25_UI; 1599 1600 /* Datagram frames go straight out of the door as UI */ 1601 ax25_queue_xmit(skb, ax25->ax25_dev->dev); 1602 1603 err = len; 1604 1605 out: 1606 release_sock(sk); 1607 1608 return err; 1609 } 1610 1611 static int ax25_recvmsg(struct socket *sock, struct msghdr *msg, size_t size, 1612 int flags) 1613 { 1614 struct sock *sk = sock->sk; 1615 struct sk_buff *skb; 1616 int copied; 1617 int err = 0; 1618 1619 lock_sock(sk); 1620 /* 1621 * This works for seqpacket too. The receiver has ordered the 1622 * queue for us! We do one quick check first though 1623 */ 1624 if (sk->sk_type == SOCK_SEQPACKET && sk->sk_state != TCP_ESTABLISHED) { 1625 err = -ENOTCONN; 1626 goto out; 1627 } 1628 1629 /* Now we can treat all alike */ 1630 skb = skb_recv_datagram(sk, flags & ~MSG_DONTWAIT, 1631 flags & MSG_DONTWAIT, &err); 1632 if (skb == NULL) 1633 goto out; 1634 1635 if (!sk_to_ax25(sk)->pidincl) 1636 skb_pull(skb, 1); /* Remove PID */ 1637 1638 skb_reset_transport_header(skb); 1639 copied = skb->len; 1640 1641 if (copied > size) { 1642 copied = size; 1643 msg->msg_flags |= MSG_TRUNC; 1644 } 1645 1646 skb_copy_datagram_msg(skb, 0, msg, copied); 1647 1648 if (msg->msg_name) { 1649 ax25_digi digi; 1650 ax25_address src; 1651 const unsigned char *mac = skb_mac_header(skb); 1652 DECLARE_SOCKADDR(struct sockaddr_ax25 *, sax, msg->msg_name); 1653 1654 memset(sax, 0, sizeof(struct full_sockaddr_ax25)); 1655 ax25_addr_parse(mac + 1, skb->data - mac - 1, &src, NULL, 1656 &digi, NULL, NULL); 1657 sax->sax25_family = AF_AX25; 1658 /* We set this correctly, even though we may not let the 1659 application know the digi calls further down (because it 1660 did NOT ask to know them). This could get political... **/ 1661 sax->sax25_ndigis = digi.ndigi; 1662 sax->sax25_call = src; 1663 1664 if (sax->sax25_ndigis != 0) { 1665 int ct; 1666 struct full_sockaddr_ax25 *fsa = (struct full_sockaddr_ax25 *)sax; 1667 1668 for (ct = 0; ct < digi.ndigi; ct++) 1669 fsa->fsa_digipeater[ct] = digi.calls[ct]; 1670 } 1671 msg->msg_namelen = sizeof(struct full_sockaddr_ax25); 1672 } 1673 1674 skb_free_datagram(sk, skb); 1675 err = copied; 1676 1677 out: 1678 release_sock(sk); 1679 1680 return err; 1681 } 1682 1683 static int ax25_shutdown(struct socket *sk, int how) 1684 { 1685 /* FIXME - generate DM and RNR states */ 1686 return -EOPNOTSUPP; 1687 } 1688 1689 static int ax25_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg) 1690 { 1691 struct sock *sk = sock->sk; 1692 void __user *argp = (void __user *)arg; 1693 int res = 0; 1694 1695 lock_sock(sk); 1696 switch (cmd) { 1697 case TIOCOUTQ: { 1698 long amount; 1699 1700 amount = sk->sk_sndbuf - sk_wmem_alloc_get(sk); 1701 if (amount < 0) 1702 amount = 0; 1703 res = put_user(amount, (int __user *)argp); 1704 break; 1705 } 1706 1707 case TIOCINQ: { 1708 struct sk_buff *skb; 1709 long amount = 0L; 1710 /* These two are safe on a single CPU system as only user tasks fiddle here */ 1711 if ((skb = skb_peek(&sk->sk_receive_queue)) != NULL) 1712 amount = skb->len; 1713 res = put_user(amount, (int __user *) argp); 1714 break; 1715 } 1716 1717 case SIOCGSTAMP: 1718 res = sock_get_timestamp(sk, argp); 1719 break; 1720 1721 case SIOCGSTAMPNS: 1722 res = sock_get_timestampns(sk, argp); 1723 break; 1724 1725 case SIOCAX25ADDUID: /* Add a uid to the uid/call map table */ 1726 case SIOCAX25DELUID: /* Delete a uid from the uid/call map table */ 1727 case SIOCAX25GETUID: { 1728 struct sockaddr_ax25 sax25; 1729 if (copy_from_user(&sax25, argp, sizeof(sax25))) { 1730 res = -EFAULT; 1731 break; 1732 } 1733 res = ax25_uid_ioctl(cmd, &sax25); 1734 break; 1735 } 1736 1737 case SIOCAX25NOUID: { /* Set the default policy (default/bar) */ 1738 long amount; 1739 if (!capable(CAP_NET_ADMIN)) { 1740 res = -EPERM; 1741 break; 1742 } 1743 if (get_user(amount, (long __user *)argp)) { 1744 res = -EFAULT; 1745 break; 1746 } 1747 if (amount < 0 || amount > AX25_NOUID_BLOCK) { 1748 res = -EINVAL; 1749 break; 1750 } 1751 ax25_uid_policy = amount; 1752 res = 0; 1753 break; 1754 } 1755 1756 case SIOCADDRT: 1757 case SIOCDELRT: 1758 case SIOCAX25OPTRT: 1759 if (!capable(CAP_NET_ADMIN)) { 1760 res = -EPERM; 1761 break; 1762 } 1763 res = ax25_rt_ioctl(cmd, argp); 1764 break; 1765 1766 case SIOCAX25CTLCON: 1767 if (!capable(CAP_NET_ADMIN)) { 1768 res = -EPERM; 1769 break; 1770 } 1771 res = ax25_ctl_ioctl(cmd, argp); 1772 break; 1773 1774 case SIOCAX25GETINFO: 1775 case SIOCAX25GETINFOOLD: { 1776 ax25_cb *ax25 = sk_to_ax25(sk); 1777 struct ax25_info_struct ax25_info; 1778 1779 ax25_info.t1 = ax25->t1 / HZ; 1780 ax25_info.t2 = ax25->t2 / HZ; 1781 ax25_info.t3 = ax25->t3 / HZ; 1782 ax25_info.idle = ax25->idle / (60 * HZ); 1783 ax25_info.n2 = ax25->n2; 1784 ax25_info.t1timer = ax25_display_timer(&ax25->t1timer) / HZ; 1785 ax25_info.t2timer = ax25_display_timer(&ax25->t2timer) / HZ; 1786 ax25_info.t3timer = ax25_display_timer(&ax25->t3timer) / HZ; 1787 ax25_info.idletimer = ax25_display_timer(&ax25->idletimer) / (60 * HZ); 1788 ax25_info.n2count = ax25->n2count; 1789 ax25_info.state = ax25->state; 1790 ax25_info.rcv_q = sk_rmem_alloc_get(sk); 1791 ax25_info.snd_q = sk_wmem_alloc_get(sk); 1792 ax25_info.vs = ax25->vs; 1793 ax25_info.vr = ax25->vr; 1794 ax25_info.va = ax25->va; 1795 ax25_info.vs_max = ax25->vs; /* reserved */ 1796 ax25_info.paclen = ax25->paclen; 1797 ax25_info.window = ax25->window; 1798 1799 /* old structure? */ 1800 if (cmd == SIOCAX25GETINFOOLD) { 1801 static int warned = 0; 1802 if (!warned) { 1803 printk(KERN_INFO "%s uses old SIOCAX25GETINFO\n", 1804 current->comm); 1805 warned=1; 1806 } 1807 1808 if (copy_to_user(argp, &ax25_info, sizeof(struct ax25_info_struct_deprecated))) { 1809 res = -EFAULT; 1810 break; 1811 } 1812 } else { 1813 if (copy_to_user(argp, &ax25_info, sizeof(struct ax25_info_struct))) { 1814 res = -EINVAL; 1815 break; 1816 } 1817 } 1818 res = 0; 1819 break; 1820 } 1821 1822 case SIOCAX25ADDFWD: 1823 case SIOCAX25DELFWD: { 1824 struct ax25_fwd_struct ax25_fwd; 1825 if (!capable(CAP_NET_ADMIN)) { 1826 res = -EPERM; 1827 break; 1828 } 1829 if (copy_from_user(&ax25_fwd, argp, sizeof(ax25_fwd))) { 1830 res = -EFAULT; 1831 break; 1832 } 1833 res = ax25_fwd_ioctl(cmd, &ax25_fwd); 1834 break; 1835 } 1836 1837 case SIOCGIFADDR: 1838 case SIOCSIFADDR: 1839 case SIOCGIFDSTADDR: 1840 case SIOCSIFDSTADDR: 1841 case SIOCGIFBRDADDR: 1842 case SIOCSIFBRDADDR: 1843 case SIOCGIFNETMASK: 1844 case SIOCSIFNETMASK: 1845 case SIOCGIFMETRIC: 1846 case SIOCSIFMETRIC: 1847 res = -EINVAL; 1848 break; 1849 1850 default: 1851 res = -ENOIOCTLCMD; 1852 break; 1853 } 1854 release_sock(sk); 1855 1856 return res; 1857 } 1858 1859 #ifdef CONFIG_PROC_FS 1860 1861 static void *ax25_info_start(struct seq_file *seq, loff_t *pos) 1862 __acquires(ax25_list_lock) 1863 { 1864 spin_lock_bh(&ax25_list_lock); 1865 return seq_hlist_start(&ax25_list, *pos); 1866 } 1867 1868 static void *ax25_info_next(struct seq_file *seq, void *v, loff_t *pos) 1869 { 1870 return seq_hlist_next(v, &ax25_list, pos); 1871 } 1872 1873 static void ax25_info_stop(struct seq_file *seq, void *v) 1874 __releases(ax25_list_lock) 1875 { 1876 spin_unlock_bh(&ax25_list_lock); 1877 } 1878 1879 static int ax25_info_show(struct seq_file *seq, void *v) 1880 { 1881 ax25_cb *ax25 = hlist_entry(v, struct ax25_cb, ax25_node); 1882 char buf[11]; 1883 int k; 1884 1885 1886 /* 1887 * New format: 1888 * 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 1889 */ 1890 1891 seq_printf(seq, "%8.8lx %s %s%s ", 1892 (long) ax25, 1893 ax25->ax25_dev == NULL? "???" : ax25->ax25_dev->dev->name, 1894 ax2asc(buf, &ax25->source_addr), 1895 ax25->iamdigi? "*":""); 1896 seq_printf(seq, "%s", ax2asc(buf, &ax25->dest_addr)); 1897 1898 for (k=0; (ax25->digipeat != NULL) && (k < ax25->digipeat->ndigi); k++) { 1899 seq_printf(seq, ",%s%s", 1900 ax2asc(buf, &ax25->digipeat->calls[k]), 1901 ax25->digipeat->repeated[k]? "*":""); 1902 } 1903 1904 seq_printf(seq, " %d %d %d %d %lu %lu %lu %lu %lu %lu %lu %lu %d %d %lu %d %d", 1905 ax25->state, 1906 ax25->vs, ax25->vr, ax25->va, 1907 ax25_display_timer(&ax25->t1timer) / HZ, ax25->t1 / HZ, 1908 ax25_display_timer(&ax25->t2timer) / HZ, ax25->t2 / HZ, 1909 ax25_display_timer(&ax25->t3timer) / HZ, ax25->t3 / HZ, 1910 ax25_display_timer(&ax25->idletimer) / (60 * HZ), 1911 ax25->idle / (60 * HZ), 1912 ax25->n2count, ax25->n2, 1913 ax25->rtt / HZ, 1914 ax25->window, 1915 ax25->paclen); 1916 1917 if (ax25->sk != NULL) { 1918 seq_printf(seq, " %d %d %lu\n", 1919 sk_wmem_alloc_get(ax25->sk), 1920 sk_rmem_alloc_get(ax25->sk), 1921 sock_i_ino(ax25->sk)); 1922 } else { 1923 seq_puts(seq, " * * *\n"); 1924 } 1925 return 0; 1926 } 1927 1928 static const struct seq_operations ax25_info_seqops = { 1929 .start = ax25_info_start, 1930 .next = ax25_info_next, 1931 .stop = ax25_info_stop, 1932 .show = ax25_info_show, 1933 }; 1934 #endif 1935 1936 static const struct net_proto_family ax25_family_ops = { 1937 .family = PF_AX25, 1938 .create = ax25_create, 1939 .owner = THIS_MODULE, 1940 }; 1941 1942 static const struct proto_ops ax25_proto_ops = { 1943 .family = PF_AX25, 1944 .owner = THIS_MODULE, 1945 .release = ax25_release, 1946 .bind = ax25_bind, 1947 .connect = ax25_connect, 1948 .socketpair = sock_no_socketpair, 1949 .accept = ax25_accept, 1950 .getname = ax25_getname, 1951 .poll = datagram_poll, 1952 .ioctl = ax25_ioctl, 1953 .listen = ax25_listen, 1954 .shutdown = ax25_shutdown, 1955 .setsockopt = ax25_setsockopt, 1956 .getsockopt = ax25_getsockopt, 1957 .sendmsg = ax25_sendmsg, 1958 .recvmsg = ax25_recvmsg, 1959 .mmap = sock_no_mmap, 1960 .sendpage = sock_no_sendpage, 1961 }; 1962 1963 /* 1964 * Called by socket.c on kernel start up 1965 */ 1966 static struct packet_type ax25_packet_type __read_mostly = { 1967 .type = cpu_to_be16(ETH_P_AX25), 1968 .func = ax25_kiss_rcv, 1969 }; 1970 1971 static struct notifier_block ax25_dev_notifier = { 1972 .notifier_call = ax25_device_event, 1973 }; 1974 1975 static int __init ax25_init(void) 1976 { 1977 int rc = proto_register(&ax25_proto, 0); 1978 1979 if (rc != 0) 1980 goto out; 1981 1982 sock_register(&ax25_family_ops); 1983 dev_add_pack(&ax25_packet_type); 1984 register_netdevice_notifier(&ax25_dev_notifier); 1985 1986 proc_create_seq("ax25_route", 0444, init_net.proc_net, &ax25_rt_seqops); 1987 proc_create_seq("ax25", 0444, init_net.proc_net, &ax25_info_seqops); 1988 proc_create_seq("ax25_calls", 0444, init_net.proc_net, 1989 &ax25_uid_seqops); 1990 out: 1991 return rc; 1992 } 1993 module_init(ax25_init); 1994 1995 1996 MODULE_AUTHOR("Jonathan Naylor G4KLX <g4klx@g4klx.demon.co.uk>"); 1997 MODULE_DESCRIPTION("The amateur radio AX.25 link layer protocol"); 1998 MODULE_LICENSE("GPL"); 1999 MODULE_ALIAS_NETPROTO(PF_AX25); 2000 2001 static void __exit ax25_exit(void) 2002 { 2003 remove_proc_entry("ax25_route", init_net.proc_net); 2004 remove_proc_entry("ax25", init_net.proc_net); 2005 remove_proc_entry("ax25_calls", init_net.proc_net); 2006 2007 unregister_netdevice_notifier(&ax25_dev_notifier); 2008 2009 dev_remove_pack(&ax25_packet_type); 2010 2011 sock_unregister(PF_AX25); 2012 proto_unregister(&ax25_proto); 2013 2014 ax25_rt_free(); 2015 ax25_uid_free(); 2016 ax25_dev_free(); 2017 } 2018 module_exit(ax25_exit); 2019