net/netrom/af_netrom.c

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