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