net/decnet/af_decnet.c

   1
   2 /*
   3  * DECnet       An implementation of the DECnet protocol suite for the LINUX
   4  *              operating system.  DECnet is implemented using the  BSD Socket
   5  *              interface as the means of communication with the user level.
   6  *
   7  *              DECnet Socket Layer Interface
   8  *
   9  * Authors:     Eduardo Marcelo Serrat <emserrat@geocities.com>
  10  *              Patrick Caulfield <patrick@pandh.demon.co.uk>
  11  *
  12  * Changes:
  13  *        Steve Whitehouse: Copied from Eduardo Serrat and Patrick Caulfield's
  14  *                          version of the code. Original copyright preserved
  15  *                          below.
  16  *        Steve Whitehouse: Some bug fixes, cleaning up some code to make it
  17  *                          compatible with my routing layer.
  18  *        Steve Whitehouse: Merging changes from Eduardo Serrat and Patrick
  19  *                          Caulfield.
  20  *        Steve Whitehouse: Further bug fixes, checking module code still works
  21  *                          with new routing layer.
  22  *        Steve Whitehouse: Additional set/get_sockopt() calls.
  23  *        Steve Whitehouse: Fixed TIOCINQ ioctl to be same as Eduardo's new
  24  *                          code.
  25  *        Steve Whitehouse: recvmsg() changed to try and behave in a POSIX like
  26  *                          way. Didn't manage it entirely, but its better.
  27  *        Steve Whitehouse: ditto for sendmsg().
  28  *        Steve Whitehouse: A selection of bug fixes to various things.
  29  *        Steve Whitehouse: Added TIOCOUTQ ioctl.
  30  *        Steve Whitehouse: Fixes to username2sockaddr & sockaddr2username.
  31  *        Steve Whitehouse: Fixes to connect() error returns.
  32  *       Patrick Caulfield: Fixes to delayed acceptance logic.
  33  *         David S. Miller: New socket locking
  34  *        Steve Whitehouse: Socket list hashing/locking
  35  *         Arnaldo C. Melo: use capable, not suser
  36  *        Steve Whitehouse: Removed unused code. Fix to use sk->allocation
  37  *                          when required.
  38  *       Patrick Caulfield: /proc/net/decnet now has object name/number
  39  *        Steve Whitehouse: Fixed local port allocation, hashed sk list
  40  *          Matthew Wilcox: Fixes for dn_ioctl()
  41  *        Steve Whitehouse: New connect/accept logic to allow timeouts and
  42  *                          prepare for sendpage etc.
  43  */
  44
  45
  46 /******************************************************************************
  47     (c) 1995-1998 E.M. Serrat           emserrat@geocities.com
  48
  49     This program is free software; you can redistribute it and/or modify
  50     it under the terms of the GNU General Public License as published by
  51     the Free Software Foundation; either version 2 of the License, or
  52     any later version.
  53
  54     This program is distributed in the hope that it will be useful,
  55     but WITHOUT ANY WARRANTY; without even the implied warranty of
  56     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  57     GNU General Public License for more details.
  58
  59 HISTORY:
  60
  61 Version           Kernel     Date       Author/Comments
  62 -------           ------     ----       ---------------
  63 Version 0.0.1     2.0.30    01-dic-97   Eduardo Marcelo Serrat
  64                                         (emserrat@geocities.com)
  65
  66                                         First Development of DECnet Socket La-
  67                                         yer for Linux. Only supports outgoing
  68                                         connections.
  69
  70 Version 0.0.2     2.1.105   20-jun-98   Patrick J. Caulfield
  71                                         (patrick@pandh.demon.co.uk)
  72
  73                                         Port to new kernel development version.
  74
  75 Version 0.0.3     2.1.106   25-jun-98   Eduardo Marcelo Serrat
  76                                         (emserrat@geocities.com)
  77                                         _
  78                                         Added support for incoming connections
  79                                         so we can start developing server apps
  80                                         on Linux.
  81                                         -
  82                                         Module Support
  83 Version 0.0.4     2.1.109   21-jul-98   Eduardo Marcelo Serrat
  84                                        (emserrat@geocities.com)
  85                                        _
  86                                         Added support for X11R6.4. Now we can
  87                                         use DECnet transport for X on Linux!!!
  88                                        -
  89 Version 0.0.5    2.1.110   01-aug-98   Eduardo Marcelo Serrat
  90                                        (emserrat@geocities.com)
  91                                        Removed bugs on flow control
  92                                        Removed bugs on incoming accessdata
  93                                        order
  94                                        -
  95 Version 0.0.6    2.1.110   07-aug-98   Eduardo Marcelo Serrat
  96                                        dn_recvmsg fixes
  97
  98                                         Patrick J. Caulfield
  99                                        dn_bind fixes
 100 *******************************************************************************/
 101
 102 #include <linux/module.h>
 103 #include <linux/errno.h>
 104 #include <linux/types.h>
 105 #include <linux/slab.h>
 106 #include <linux/socket.h>
 107 #include <linux/in.h>
 108 #include <linux/kernel.h>
 109 #include <linux/sched.h>
 110 #include <linux/timer.h>
 111 #include <linux/string.h>
 112 #include <linux/sockios.h>
 113 #include <linux/net.h>
 114 #include <linux/netdevice.h>
 115 #include <linux/inet.h>
 116 #include <linux/route.h>
 117 #include <linux/netfilter.h>
 118 #include <linux/seq_file.h>
 119 #include <net/sock.h>
 120 #include <net/tcp_states.h>
 121 #include <net/flow.h>
 122 #include <asm/system.h>
 123 #include <asm/ioctls.h>
 124 #include <linux/capability.h>
 125 #include <linux/mm.h>
 126 #include <linux/interrupt.h>
 127 #include <linux/proc_fs.h>
 128 #include <linux/stat.h>
 129 #include <linux/init.h>
 130 #include <linux/poll.h>
 131 #include <net/neighbour.h>
 132 #include <net/dst.h>
 133 #include <net/dn.h>
 134 #include <net/dn_nsp.h>
 135 #include <net/dn_dev.h>
 136 #include <net/dn_route.h>
 137 #include <net/dn_fib.h>
 138 #include <net/dn_neigh.h>
 139
 140 struct dn_sock {
 141         struct sock sk;
 142         struct dn_scp scp;
 143 };
 144
 145 static void dn_keepalive(struct sock *sk);
 146
 147 #define DN_SK_HASH_SHIFT 8
 148 #define DN_SK_HASH_SIZE (1 << DN_SK_HASH_SHIFT)
 149 #define DN_SK_HASH_MASK (DN_SK_HASH_SIZE - 1)
 150
 151
 152 static const struct proto_ops dn_proto_ops;
 153 static DEFINE_RWLOCK(dn_hash_lock);
 154 static struct hlist_head dn_sk_hash[DN_SK_HASH_SIZE];
 155 static struct hlist_head dn_wild_sk;
 156 static atomic_t decnet_memory_allocated;
 157
 158 static int __dn_setsockopt(struct socket *sock, int level, int optname, char __user *optval, int optlen, int flags);
 159 static int __dn_getsockopt(struct socket *sock, int level, int optname, char __user *optval, int __user *optlen, int flags);
 160
 161 static struct hlist_head *dn_find_list(struct sock *sk)
 162 {
 163         struct dn_scp *scp = DN_SK(sk);
 164
 165         if (scp->addr.sdn_flags & SDF_WILD)
 166                 return hlist_empty(&dn_wild_sk) ? &dn_wild_sk : NULL;
 167
 168         return &dn_sk_hash[scp->addrloc & DN_SK_HASH_MASK];
 169 }
 170
 171 /*
 172  * Valid ports are those greater than zero and not already in use.
 173  */
 174 static int check_port(__le16 port)
 175 {
 176         struct sock *sk;
 177         struct hlist_node *node;
 178
 179         if (port == 0)
 180                 return -1;
 181
 182         sk_for_each(sk, node, &dn_sk_hash[port & DN_SK_HASH_MASK]) {
 183                 struct dn_scp *scp = DN_SK(sk);
 184                 if (scp->addrloc == port)
 185                         return -1;
 186         }
 187         return 0;
 188 }
 189
 190 static unsigned short port_alloc(struct sock *sk)
 191 {
 192         struct dn_scp *scp = DN_SK(sk);
 193 static unsigned short port = 0x2000;
 194         unsigned short i_port = port;
 195
 196         while(check_port(++port) != 0) {
 197                 if (port == i_port)
 198                         return 0;
 199         }
 200
 201         scp->addrloc = port;
 202
 203         return 1;
 204 }
 205
 206 /*
 207  * Since this is only ever called from user
 208  * level, we don't need a write_lock() version
 209  * of this.
 210  */
 211 static int dn_hash_sock(struct sock *sk)
 212 {
 213         struct dn_scp *scp = DN_SK(sk);
 214         struct hlist_head *list;
 215         int rv = -EUSERS;
 216
 217         BUG_ON(sk_hashed(sk));
 218
 219         write_lock_bh(&dn_hash_lock);
 220
 221         if (!scp->addrloc && !port_alloc(sk))
 222                 goto out;
 223
 224         rv = -EADDRINUSE;
 225         if ((list = dn_find_list(sk)) == NULL)
 226                 goto out;
 227
 228         sk_add_node(sk, list);
 229         rv = 0;
 230 out:
 231         write_unlock_bh(&dn_hash_lock);
 232         return rv;
 233 }
 234
 235 static void dn_unhash_sock(struct sock *sk)
 236 {
 237         write_lock(&dn_hash_lock);
 238         sk_del_node_init(sk);
 239         write_unlock(&dn_hash_lock);
 240 }
 241
 242 static void dn_unhash_sock_bh(struct sock *sk)
 243 {
 244         write_lock_bh(&dn_hash_lock);
 245         sk_del_node_init(sk);
 246         write_unlock_bh(&dn_hash_lock);
 247 }
 248
 249 static struct hlist_head *listen_hash(struct sockaddr_dn *addr)
 250 {
 251         int i;
 252         unsigned hash = addr->sdn_objnum;
 253
 254         if (hash == 0) {
 255                 hash = addr->sdn_objnamel;
 256                 for(i = 0; i < dn_ntohs(addr->sdn_objnamel); i++) {
 257                         hash ^= addr->sdn_objname[i];
 258                         hash ^= (hash << 3);
 259                 }
 260         }
 261
 262         return &dn_sk_hash[hash & DN_SK_HASH_MASK];
 263 }
 264
 265 /*
 266  * Called to transform a socket from bound (i.e. with a local address)
 267  * into a listening socket (doesn't need a local port number) and rehashes
 268  * based upon the object name/number.
 269  */
 270 static void dn_rehash_sock(struct sock *sk)
 271 {
 272         struct hlist_head *list;
 273         struct dn_scp *scp = DN_SK(sk);
 274
 275         if (scp->addr.sdn_flags & SDF_WILD)
 276                 return;
 277
 278         write_lock_bh(&dn_hash_lock);
 279         sk_del_node_init(sk);
 280         DN_SK(sk)->addrloc = 0;
 281         list = listen_hash(&DN_SK(sk)->addr);
 282         sk_add_node(sk, list);
 283         write_unlock_bh(&dn_hash_lock);
 284 }
 285
 286 int dn_sockaddr2username(struct sockaddr_dn *sdn, unsigned char *buf, unsigned char type)
 287 {
 288         int len = 2;
 289
 290         *buf++ = type;
 291
 292         switch(type) {
 293                 case 0:
 294                         *buf++ = sdn->sdn_objnum;
 295                         break;
 296                 case 1:
 297                         *buf++ = 0;
 298                         *buf++ = dn_ntohs(sdn->sdn_objnamel);
 299                         memcpy(buf, sdn->sdn_objname, dn_ntohs(sdn->sdn_objnamel));
 300                         len = 3 + dn_ntohs(sdn->sdn_objnamel);
 301                         break;
 302                 case 2:
 303                         memset(buf, 0, 5);
 304                         buf += 5;
 305                         *buf++ = dn_ntohs(sdn->sdn_objnamel);
 306                         memcpy(buf, sdn->sdn_objname, dn_ntohs(sdn->sdn_objnamel));
 307                         len = 7 + dn_ntohs(sdn->sdn_objnamel);
 308                         break;
 309         }
 310
 311         return len;
 312 }
 313
 314 /*
 315  * On reception of usernames, we handle types 1 and 0 for destination
 316  * addresses only. Types 2 and 4 are used for source addresses, but the
 317  * UIC, GIC are ignored and they are both treated the same way. Type 3
 318  * is never used as I've no idea what its purpose might be or what its
 319  * format is.
 320  */
 321 int dn_username2sockaddr(unsigned char *data, int len, struct sockaddr_dn *sdn, unsigned char *fmt)
 322 {
 323         unsigned char type;
 324         int size = len;
 325         int namel = 12;
 326
 327         sdn->sdn_objnum = 0;
 328         sdn->sdn_objnamel = dn_htons(0);
 329         memset(sdn->sdn_objname, 0, DN_MAXOBJL);
 330
 331         if (len < 2)
 332                 return -1;
 333
 334         len -= 2;
 335         *fmt = *data++;
 336         type = *data++;
 337
 338         switch(*fmt) {
 339                 case 0:
 340                         sdn->sdn_objnum = type;
 341                         return 2;
 342                 case 1:
 343                         namel = 16;
 344                         break;
 345                 case 2:
 346                         len  -= 4;
 347                         data += 4;
 348                         break;
 349                 case 4:
 350                         len  -= 8;
 351                         data += 8;
 352                         break;
 353                 default:
 354                         return -1;
 355         }
 356
 357         len -= 1;
 358
 359         if (len < 0)
 360                 return -1;
 361
 362         sdn->sdn_objnamel = dn_htons(*data++);
 363         len -= dn_ntohs(sdn->sdn_objnamel);
 364
 365         if ((len < 0) || (dn_ntohs(sdn->sdn_objnamel) > namel))
 366                 return -1;
 367
 368         memcpy(sdn->sdn_objname, data, dn_ntohs(sdn->sdn_objnamel));
 369
 370         return size - len;
 371 }
 372
 373 struct sock *dn_sklist_find_listener(struct sockaddr_dn *addr)
 374 {
 375         struct hlist_head *list = listen_hash(addr);
 376         struct hlist_node *node;
 377         struct sock *sk;
 378
 379         read_lock(&dn_hash_lock);
 380         sk_for_each(sk, node, list) {
 381                 struct dn_scp *scp = DN_SK(sk);
 382                 if (sk->sk_state != TCP_LISTEN)
 383                         continue;
 384                 if (scp->addr.sdn_objnum) {
 385                         if (scp->addr.sdn_objnum != addr->sdn_objnum)
 386                                 continue;
 387                 } else {
 388                         if (addr->sdn_objnum)
 389                                 continue;
 390                         if (scp->addr.sdn_objnamel != addr->sdn_objnamel)
 391                                 continue;
 392                         if (memcmp(scp->addr.sdn_objname, addr->sdn_objname, dn_ntohs(addr->sdn_objnamel)) != 0)
 393                                 continue;
 394                 }
 395                 sock_hold(sk);
 396                 read_unlock(&dn_hash_lock);
 397                 return sk;
 398         }
 399
 400         sk = sk_head(&dn_wild_sk);
 401         if (sk) {
 402                 if (sk->sk_state == TCP_LISTEN)
 403                         sock_hold(sk);
 404                 else
 405                         sk = NULL;
 406         }
 407
 408         read_unlock(&dn_hash_lock);
 409         return sk;
 410 }
 411
 412 struct sock *dn_find_by_skb(struct sk_buff *skb)
 413 {
 414         struct dn_skb_cb *cb = DN_SKB_CB(skb);
 415         struct sock *sk;
 416         struct hlist_node *node;
 417         struct dn_scp *scp;
 418
 419         read_lock(&dn_hash_lock);
 420         sk_for_each(sk, node, &dn_sk_hash[cb->dst_port & DN_SK_HASH_MASK]) {
 421                 scp = DN_SK(sk);
 422                 if (cb->src != dn_saddr2dn(&scp->peer))
 423                         continue;
 424                 if (cb->dst_port != scp->addrloc)
 425                         continue;
 426                 if (scp->addrrem && (cb->src_port != scp->addrrem))
 427                         continue;
 428                 sock_hold(sk);
 429                 goto found;
 430         }
 431         sk = NULL;
 432 found:
 433         read_unlock(&dn_hash_lock);
 434         return sk;
 435 }
 436
 437
 438
 439 static void dn_destruct(struct sock *sk)
 440 {
 441         struct dn_scp *scp = DN_SK(sk);
 442
 443         skb_queue_purge(&scp->data_xmit_queue);
 444         skb_queue_purge(&scp->other_xmit_queue);
 445         skb_queue_purge(&scp->other_receive_queue);
 446
 447         dst_release(xchg(&sk->sk_dst_cache, NULL));
 448 }
 449
 450 static int dn_memory_pressure;
 451
 452 static void dn_enter_memory_pressure(void)
 453 {
 454         if (!dn_memory_pressure) {
 455                 dn_memory_pressure = 1;
 456         }
 457 }
 458
 459 static struct proto dn_proto = {
 460         .name                   = "NSP",
 461         .owner                  = THIS_MODULE,
 462         .enter_memory_pressure  = dn_enter_memory_pressure,
 463         .memory_pressure        = &dn_memory_pressure,
 464         .memory_allocated       = &decnet_memory_allocated,
 465         .sysctl_mem             = sysctl_decnet_mem,
 466         .sysctl_wmem            = sysctl_decnet_wmem,
 467         .sysctl_rmem            = sysctl_decnet_rmem,
 468         .max_header             = DN_MAX_NSP_DATA_HEADER + 64,
 469         .obj_size               = sizeof(struct dn_sock),
 470 };
 471
 472 static struct sock *dn_alloc_sock(struct socket *sock, gfp_t gfp)
 473 {
 474         struct dn_scp *scp;
 475         struct sock *sk = sk_alloc(PF_DECnet, gfp, &dn_proto, 1);
 476
 477         if  (!sk)
 478                 goto out;
 479
 480         if (sock)
 481                 sock->ops = &dn_proto_ops;
 482         sock_init_data(sock, sk);
 483
 484         sk->sk_backlog_rcv = dn_nsp_backlog_rcv;
 485         sk->sk_destruct    = dn_destruct;
 486         sk->sk_no_check    = 1;
 487         sk->sk_family      = PF_DECnet;
 488         sk->sk_protocol    = 0;
 489         sk->sk_allocation  = gfp;
 490         sk->sk_sndbuf      = sysctl_decnet_wmem[1];
 491         sk->sk_rcvbuf      = sysctl_decnet_rmem[1];
 492
 493         /* Initialization of DECnet Session Control Port                */
 494         scp = DN_SK(sk);
 495         scp->state      = DN_O;         /* Open                 */
 496         scp->numdat     = 1;            /* Next data seg to tx  */
 497         scp->numoth     = 1;            /* Next oth data to tx  */
 498         scp->ackxmt_dat = 0;            /* Last data seg ack'ed */
 499         scp->ackxmt_oth = 0;            /* Last oth data ack'ed */
 500         scp->ackrcv_dat = 0;            /* Highest data ack recv*/
 501         scp->ackrcv_oth = 0;            /* Last oth data ack rec*/
 502         scp->flowrem_sw = DN_SEND;
 503         scp->flowloc_sw = DN_SEND;
 504         scp->flowrem_dat = 0;
 505         scp->flowrem_oth = 1;
 506         scp->flowloc_dat = 0;
 507         scp->flowloc_oth = 1;
 508         scp->services_rem = 0;
 509         scp->services_loc = 1 | NSP_FC_NONE;
 510         scp->info_rem = 0;
 511         scp->info_loc = 0x03; /* NSP version 4.1 */
 512         scp->segsize_rem = 230 - DN_MAX_NSP_DATA_HEADER; /* Default: Updated by remote segsize */
 513         scp->nonagle = 0;
 514         scp->multi_ireq = 1;
 515         scp->accept_mode = ACC_IMMED;
 516         scp->addr.sdn_family    = AF_DECnet;
 517         scp->peer.sdn_family    = AF_DECnet;
 518         scp->accessdata.acc_accl = 5;
 519         memcpy(scp->accessdata.acc_acc, "LINUX", 5);
 520
 521         scp->max_window   = NSP_MAX_WINDOW;
 522         scp->snd_window   = NSP_MIN_WINDOW;
 523         scp->nsp_srtt     = NSP_INITIAL_SRTT;
 524         scp->nsp_rttvar   = NSP_INITIAL_RTTVAR;
 525         scp->nsp_rxtshift = 0;
 526
 527         skb_queue_head_init(&scp->data_xmit_queue);
 528         skb_queue_head_init(&scp->other_xmit_queue);
 529         skb_queue_head_init(&scp->other_receive_queue);
 530
 531         scp->persist = 0;
 532         scp->persist_fxn = NULL;
 533         scp->keepalive = 10 * HZ;
 534         scp->keepalive_fxn = dn_keepalive;
 535
 536         init_timer(&scp->delack_timer);
 537         scp->delack_pending = 0;
 538         scp->delack_fxn = dn_nsp_delayed_ack;
 539
 540         dn_start_slow_timer(sk);
 541 out:
 542         return sk;
 543 }
 544
 545 /*
 546  * Keepalive timer.
 547  * FIXME: Should respond to SO_KEEPALIVE etc.
 548  */
 549 static void dn_keepalive(struct sock *sk)
 550 {
 551         struct dn_scp *scp = DN_SK(sk);
 552
 553         /*
 554          * By checking the other_data transmit queue is empty
 555          * we are double checking that we are not sending too
 556          * many of these keepalive frames.
 557          */
 558         if (skb_queue_empty(&scp->other_xmit_queue))
 559                 dn_nsp_send_link(sk, DN_NOCHANGE, 0);
 560 }
 561
 562
 563 /*
 564  * Timer for shutdown/destroyed sockets.
 565  * When socket is dead & no packets have been sent for a
 566  * certain amount of time, they are removed by this
 567  * routine. Also takes care of sending out DI & DC
 568  * frames at correct times.
 569  */
 570 int dn_destroy_timer(struct sock *sk)
 571 {
 572         struct dn_scp *scp = DN_SK(sk);
 573
 574         scp->persist = dn_nsp_persist(sk);
 575
 576         switch(scp->state) {
 577                 case DN_DI:
 578                         dn_nsp_send_disc(sk, NSP_DISCINIT, 0, GFP_ATOMIC);
 579                         if (scp->nsp_rxtshift >= decnet_di_count)
 580                                 scp->state = DN_CN;
 581                         return 0;
 582
 583                 case DN_DR:
 584                         dn_nsp_send_disc(sk, NSP_DISCINIT, 0, GFP_ATOMIC);
 585                         if (scp->nsp_rxtshift >= decnet_dr_count)
 586                                 scp->state = DN_DRC;
 587                         return 0;
 588
 589                 case DN_DN:
 590                         if (scp->nsp_rxtshift < decnet_dn_count) {
 591                                 /* printk(KERN_DEBUG "dn_destroy_timer: DN\n"); */
 592                                 dn_nsp_send_disc(sk, NSP_DISCCONF, NSP_REASON_DC, GFP_ATOMIC);
 593                                 return 0;
 594                         }
 595         }
 596
 597         scp->persist = (HZ * decnet_time_wait);
 598
 599         if (sk->sk_socket)
 600                 return 0;
 601
 602         if ((jiffies - scp->stamp) >= (HZ * decnet_time_wait)) {
 603                 dn_unhash_sock(sk);
 604                 sock_put(sk);
 605                 return 1;
 606         }
 607
 608         return 0;
 609 }
 610
 611 static void dn_destroy_sock(struct sock *sk)
 612 {
 613         struct dn_scp *scp = DN_SK(sk);
 614
 615         scp->nsp_rxtshift = 0; /* reset back off */
 616
 617         if (sk->sk_socket) {
 618                 if (sk->sk_socket->state != SS_UNCONNECTED)
 619                         sk->sk_socket->state = SS_DISCONNECTING;
 620         }
 621
 622         sk->sk_state = TCP_CLOSE;
 623
 624         switch(scp->state) {
 625                 case DN_DN:
 626                         dn_nsp_send_disc(sk, NSP_DISCCONF, NSP_REASON_DC,
 627                                          sk->sk_allocation);
 628                         scp->persist_fxn = dn_destroy_timer;
 629                         scp->persist = dn_nsp_persist(sk);
 630                         break;
 631                 case DN_CR:
 632                         scp->state = DN_DR;
 633                         goto disc_reject;
 634                 case DN_RUN:
 635                         scp->state = DN_DI;
 636                 case DN_DI:
 637                 case DN_DR:
 638 disc_reject:
 639                         dn_nsp_send_disc(sk, NSP_DISCINIT, 0, sk->sk_allocation);
 640                 case DN_NC:
 641                 case DN_NR:
 642                 case DN_RJ:
 643                 case DN_DIC:
 644                 case DN_CN:
 645                 case DN_DRC:
 646                 case DN_CI:
 647                 case DN_CD:
 648                         scp->persist_fxn = dn_destroy_timer;
 649                         scp->persist = dn_nsp_persist(sk);
 650                         break;
 651                 default:
 652                         printk(KERN_DEBUG "DECnet: dn_destroy_sock passed socket in invalid state\n");
 653                 case DN_O:
 654                         dn_stop_slow_timer(sk);
 655
 656                         dn_unhash_sock_bh(sk);
 657                         sock_put(sk);
 658
 659                         break;
 660         }
 661 }
 662
 663 char *dn_addr2asc(__u16 addr, char *buf)
 664 {
 665         unsigned short node, area;
 666
 667         node = addr & 0x03ff;
 668         area = addr >> 10;
 669         sprintf(buf, "%hd.%hd", area, node);
 670
 671         return buf;
 672 }
 673
 674
 675
 676 static int dn_create(struct socket *sock, int protocol)
 677 {
 678         struct sock *sk;
 679
 680         switch(sock->type) {
 681                 case SOCK_SEQPACKET:
 682                         if (protocol != DNPROTO_NSP)
 683                                 return -EPROTONOSUPPORT;
 684                         break;
 685                 case SOCK_STREAM:
 686                         break;
 687                 default:
 688                         return -ESOCKTNOSUPPORT;
 689         }
 690
 691
 692         if ((sk = dn_alloc_sock(sock, GFP_KERNEL)) == NULL)
 693                 return -ENOBUFS;
 694
 695         sk->sk_protocol = protocol;
 696
 697         return 0;
 698 }
 699
 700
 701 static int
 702 dn_release(struct socket *sock)
 703 {
 704         struct sock *sk = sock->sk;
 705
 706         if (sk) {
 707                 sock_orphan(sk);
 708                 sock_hold(sk);
 709                 lock_sock(sk);
 710                 dn_destroy_sock(sk);
 711                 release_sock(sk);
 712                 sock_put(sk);
 713         }
 714
 715         return 0;
 716 }
 717
 718 static int dn_bind(struct socket *sock, struct sockaddr *uaddr, int addr_len)
 719 {
 720         struct sock *sk = sock->sk;
 721         struct dn_scp *scp = DN_SK(sk);
 722         struct sockaddr_dn *saddr = (struct sockaddr_dn *)uaddr;
 723         struct net_device *dev;
 724         int rv;
 725
 726         if (addr_len != sizeof(struct sockaddr_dn))
 727                 return -EINVAL;
 728
 729         if (saddr->sdn_family != AF_DECnet)
 730                 return -EINVAL;
 731
 732         if (dn_ntohs(saddr->sdn_nodeaddrl) && (dn_ntohs(saddr->sdn_nodeaddrl) != 2))
 733                 return -EINVAL;
 734
 735         if (dn_ntohs(saddr->sdn_objnamel) > DN_MAXOBJL)
 736                 return -EINVAL;
 737
 738         if (saddr->sdn_flags & ~SDF_WILD)
 739                 return -EINVAL;
 740
 741         if (!capable(CAP_NET_BIND_SERVICE) && (saddr->sdn_objnum ||
 742             (saddr->sdn_flags & SDF_WILD)))
 743                 return -EACCES;
 744
 745         if (!(saddr->sdn_flags & SDF_WILD)) {
 746                 if (dn_ntohs(saddr->sdn_nodeaddrl)) {
 747                         read_lock(&dev_base_lock);
 748                         for(dev = dev_base; dev; dev = dev->next) {
 749                                 if (!dev->dn_ptr)
 750                                         continue;
 751                                 if (dn_dev_islocal(dev, dn_saddr2dn(saddr)))
 752                                         break;
 753                         }
 754                         read_unlock(&dev_base_lock);
 755                         if (dev == NULL)
 756                                 return -EADDRNOTAVAIL;
 757                 }
 758         }
 759
 760         rv = -EINVAL;
 761         lock_sock(sk);
 762         if (sock_flag(sk, SOCK_ZAPPED)) {
 763                 memcpy(&scp->addr, saddr, addr_len);
 764                 sock_reset_flag(sk, SOCK_ZAPPED);
 765
 766                 rv = dn_hash_sock(sk);
 767                 if (rv)
 768                         sock_set_flag(sk, SOCK_ZAPPED);
 769         }
 770         release_sock(sk);
 771
 772         return rv;
 773 }
 774
 775
 776 static int dn_auto_bind(struct socket *sock)
 777 {
 778         struct sock *sk = sock->sk;
 779         struct dn_scp *scp = DN_SK(sk);
 780         int rv;
 781
 782         sock_reset_flag(sk, SOCK_ZAPPED);
 783
 784         scp->addr.sdn_flags  = 0;
 785         scp->addr.sdn_objnum = 0;
 786
 787         /*
 788          * This stuff is to keep compatibility with Eduardo's
 789          * patch. I hope I can dispense with it shortly...
 790          */
 791         if ((scp->accessdata.acc_accl != 0) &&
 792                 (scp->accessdata.acc_accl <= 12)) {
 793
 794                 scp->addr.sdn_objnamel = dn_htons(scp->accessdata.acc_accl);
 795                 memcpy(scp->addr.sdn_objname, scp->accessdata.acc_acc, dn_ntohs(scp->addr.sdn_objnamel));
 796
 797                 scp->accessdata.acc_accl = 0;
 798                 memset(scp->accessdata.acc_acc, 0, 40);
 799         }
 800         /* End of compatibility stuff */
 801
 802         scp->addr.sdn_add.a_len = dn_htons(2);
 803         rv = dn_dev_bind_default((__le16 *)scp->addr.sdn_add.a_addr);
 804         if (rv == 0) {
 805                 rv = dn_hash_sock(sk);
 806                 if (rv)
 807                         sock_set_flag(sk, SOCK_ZAPPED);
 808         }
 809
 810         return rv;
 811 }
 812
 813 static int dn_confirm_accept(struct sock *sk, long *timeo, gfp_t allocation)
 814 {
 815         struct dn_scp *scp = DN_SK(sk);
 816         DEFINE_WAIT(wait);
 817         int err;
 818
 819         if (scp->state != DN_CR)
 820                 return -EINVAL;
 821
 822         scp->state = DN_CC;
 823         scp->segsize_loc = dst_metric(__sk_dst_get(sk), RTAX_ADVMSS);
 824         dn_send_conn_conf(sk, allocation);
 825
 826         prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE);
 827         for(;;) {
 828                 release_sock(sk);
 829                 if (scp->state == DN_CC)
 830                         *timeo = schedule_timeout(*timeo);
 831                 lock_sock(sk);
 832                 err = 0;
 833                 if (scp->state == DN_RUN)
 834                         break;
 835                 err = sock_error(sk);
 836                 if (err)
 837                         break;
 838                 err = sock_intr_errno(*timeo);
 839                 if (signal_pending(current))
 840                         break;
 841                 err = -EAGAIN;
 842                 if (!*timeo)
 843                         break;
 844                 prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE);
 845         }
 846         finish_wait(sk->sk_sleep, &wait);
 847         if (err == 0) {
 848                 sk->sk_socket->state = SS_CONNECTED;
 849         } else if (scp->state != DN_CC) {
 850                 sk->sk_socket->state = SS_UNCONNECTED;
 851         }
 852         return err;
 853 }
 854
 855 static int dn_wait_run(struct sock *sk, long *timeo)
 856 {
 857         struct dn_scp *scp = DN_SK(sk);
 858         DEFINE_WAIT(wait);
 859         int err = 0;
 860
 861         if (scp->state == DN_RUN)
 862                 goto out;
 863
 864         if (!*timeo)
 865                 return -EALREADY;
 866
 867         prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE);
 868         for(;;) {
 869                 release_sock(sk);
 870                 if (scp->state == DN_CI || scp->state == DN_CC)
 871                         *timeo = schedule_timeout(*timeo);
 872                 lock_sock(sk);
 873                 err = 0;
 874                 if (scp->state == DN_RUN)
 875                         break;
 876                 err = sock_error(sk);
 877                 if (err)
 878                         break;
 879                 err = sock_intr_errno(*timeo);
 880                 if (signal_pending(current))
 881                         break;
 882                 err = -ETIMEDOUT;
 883                 if (!*timeo)
 884                         break;
 885                 prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE);
 886         }
 887         finish_wait(sk->sk_sleep, &wait);
 888 out:
 889         if (err == 0) {
 890                 sk->sk_socket->state = SS_CONNECTED;
 891         } else if (scp->state != DN_CI && scp->state != DN_CC) {
 892                 sk->sk_socket->state = SS_UNCONNECTED;
 893         }
 894         return err;
 895 }
 896
 897 static int __dn_connect(struct sock *sk, struct sockaddr_dn *addr, int addrlen, long *timeo, int flags)
 898 {
 899         struct socket *sock = sk->sk_socket;
 900         struct dn_scp *scp = DN_SK(sk);
 901         int err = -EISCONN;
 902         struct flowi fl;
 903
 904         if (sock->state == SS_CONNECTED)
 905                 goto out;
 906
 907         if (sock->state == SS_CONNECTING) {
 908                 err = 0;
 909                 if (scp->state == DN_RUN) {
 910                         sock->state = SS_CONNECTED;
 911                         goto out;
 912                 }
 913                 err = -ECONNREFUSED;
 914                 if (scp->state != DN_CI && scp->state != DN_CC) {
 915                         sock->state = SS_UNCONNECTED;
 916                         goto out;
 917                 }
 918                 return dn_wait_run(sk, timeo);
 919         }
 920
 921         err = -EINVAL;
 922         if (scp->state != DN_O)
 923                 goto out;
 924
 925         if (addr == NULL || addrlen != sizeof(struct sockaddr_dn))
 926                 goto out;
 927         if (addr->sdn_family != AF_DECnet)
 928                 goto out;
 929         if (addr->sdn_flags & SDF_WILD)
 930                 goto out;
 931
 932         if (sock_flag(sk, SOCK_ZAPPED)) {
 933                 err = dn_auto_bind(sk->sk_socket);
 934                 if (err)
 935                         goto out;
 936         }
 937
 938         memcpy(&scp->peer, addr, sizeof(struct sockaddr_dn));
 939
 940         err = -EHOSTUNREACH;
 941         memset(&fl, 0, sizeof(fl));
 942         fl.oif = sk->sk_bound_dev_if;
 943         fl.fld_dst = dn_saddr2dn(&scp->peer);
 944         fl.fld_src = dn_saddr2dn(&scp->addr);
 945         dn_sk_ports_copy(&fl, scp);
 946         fl.proto = DNPROTO_NSP;
 947         if (dn_route_output_sock(&sk->sk_dst_cache, &fl, sk, flags) < 0)
 948                 goto out;
 949         sk->sk_route_caps = sk->sk_dst_cache->dev->features;
 950         sock->state = SS_CONNECTING;
 951         scp->state = DN_CI;
 952         scp->segsize_loc = dst_metric(sk->sk_dst_cache, RTAX_ADVMSS);
 953
 954         dn_nsp_send_conninit(sk, NSP_CI);
 955         err = -EINPROGRESS;
 956         if (*timeo) {
 957                 err = dn_wait_run(sk, timeo);
 958         }
 959 out:
 960         return err;
 961 }
 962
 963 static int dn_connect(struct socket *sock, struct sockaddr *uaddr, int addrlen, int flags)
 964 {
 965         struct sockaddr_dn *addr = (struct sockaddr_dn *)uaddr;
 966         struct sock *sk = sock->sk;
 967         int err;
 968         long timeo = sock_sndtimeo(sk, flags & O_NONBLOCK);
 969
 970         lock_sock(sk);
 971         err = __dn_connect(sk, addr, addrlen, &timeo, 0);
 972         release_sock(sk);
 973
 974         return err;
 975 }
 976
 977 static inline int dn_check_state(struct sock *sk, struct sockaddr_dn *addr, int addrlen, long *timeo, int flags)
 978 {
 979         struct dn_scp *scp = DN_SK(sk);
 980
 981         switch(scp->state) {
 982                 case DN_RUN:
 983                         return 0;
 984                 case DN_CR:
 985                         return dn_confirm_accept(sk, timeo, sk->sk_allocation);
 986                 case DN_CI:
 987                 case DN_CC:
 988                         return dn_wait_run(sk, timeo);
 989                 case DN_O:
 990                         return __dn_connect(sk, addr, addrlen, timeo, flags);
 991         }
 992
 993         return -EINVAL;
 994 }
 995
 996
 997 static void dn_access_copy(struct sk_buff *skb, struct accessdata_dn *acc)
 998 {
 999         unsigned char *ptr = skb->data;
1000
1001         acc->acc_userl = *ptr++;
1002         memcpy(&acc->acc_user, ptr, acc->acc_userl);
1003         ptr += acc->acc_userl;
1004
1005         acc->acc_passl = *ptr++;
1006         memcpy(&acc->acc_pass, ptr, acc->acc_passl);
1007         ptr += acc->acc_passl;
1008
1009         acc->acc_accl = *ptr++;
1010         memcpy(&acc->acc_acc, ptr, acc->acc_accl);
1011
1012         skb_pull(skb, acc->acc_accl + acc->acc_passl + acc->acc_userl + 3);
1013
1014 }
1015
1016 static void dn_user_copy(struct sk_buff *skb, struct optdata_dn *opt)
1017 {
1018         unsigned char *ptr = skb->data;
1019
1020         opt->opt_optl   = *ptr++;
1021         opt->opt_status = 0;
1022         memcpy(opt->opt_data, ptr, opt->opt_optl);
1023         skb_pull(skb, dn_ntohs(opt->opt_optl) + 1);
1024
1025 }
1026
1027 static struct sk_buff *dn_wait_for_connect(struct sock *sk, long *timeo)
1028 {
1029         DEFINE_WAIT(wait);
1030         struct sk_buff *skb = NULL;
1031         int err = 0;
1032
1033         prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE);
1034         for(;;) {
1035                 release_sock(sk);
1036                 skb = skb_dequeue(&sk->sk_receive_queue);
1037                 if (skb == NULL) {
1038                         *timeo = schedule_timeout(*timeo);
1039                         skb = skb_dequeue(&sk->sk_receive_queue);
1040                 }
1041                 lock_sock(sk);
1042                 if (skb != NULL)
1043                         break;
1044                 err = -EINVAL;
1045                 if (sk->sk_state != TCP_LISTEN)
1046                         break;
1047                 err = sock_intr_errno(*timeo);
1048                 if (signal_pending(current))
1049                         break;
1050                 err = -EAGAIN;
1051                 if (!*timeo)
1052                         break;
1053                 prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE);
1054         }
1055         finish_wait(sk->sk_sleep, &wait);
1056
1057         return skb == NULL ? ERR_PTR(err) : skb;
1058 }
1059
1060 static int dn_accept(struct socket *sock, struct socket *newsock, int flags)
1061 {
1062         struct sock *sk = sock->sk, *newsk;
1063         struct sk_buff *skb = NULL;
1064         struct dn_skb_cb *cb;
1065         unsigned char menuver;
1066         int err = 0;
1067         unsigned char type;
1068         long timeo = sock_rcvtimeo(sk, flags & O_NONBLOCK);
1069
1070         lock_sock(sk);
1071
1072         if (sk->sk_state != TCP_LISTEN || DN_SK(sk)->state != DN_O) {
1073                 release_sock(sk);
1074                 return -EINVAL;
1075         }
1076
1077         skb = skb_dequeue(&sk->sk_receive_queue);
1078         if (skb == NULL) {
1079                 skb = dn_wait_for_connect(sk, &timeo);
1080                 if (IS_ERR(skb)) {
1081                         release_sock(sk);
1082                         return PTR_ERR(skb);
1083                 }
1084         }
1085
1086         cb = DN_SKB_CB(skb);
1087         sk->sk_ack_backlog--;
1088         newsk = dn_alloc_sock(newsock, sk->sk_allocation);
1089         if (newsk == NULL) {
1090                 release_sock(sk);
1091                 kfree_skb(skb);
1092                 return -ENOBUFS;
1093         }
1094         release_sock(sk);
1095
1096         dst_release(xchg(&newsk->sk_dst_cache, skb->dst));
1097         skb->dst = NULL;
1098
1099         DN_SK(newsk)->state        = DN_CR;
1100         DN_SK(newsk)->addrrem      = cb->src_port;
1101         DN_SK(newsk)->services_rem = cb->services;
1102         DN_SK(newsk)->info_rem     = cb->info;
1103         DN_SK(newsk)->segsize_rem  = cb->segsize;
1104         DN_SK(newsk)->accept_mode  = DN_SK(sk)->accept_mode;
1105
1106         if (DN_SK(newsk)->segsize_rem < 230)
1107                 DN_SK(newsk)->segsize_rem = 230;
1108
1109         if ((DN_SK(newsk)->services_rem & NSP_FC_MASK) == NSP_FC_NONE)
1110                 DN_SK(newsk)->max_window = decnet_no_fc_max_cwnd;
1111
1112         newsk->sk_state  = TCP_LISTEN;
1113         memcpy(&(DN_SK(newsk)->addr), &(DN_SK(sk)->addr), sizeof(struct sockaddr_dn));
1114
1115         /*
1116          * If we are listening on a wild socket, we don't want
1117          * the newly created socket on the wrong hash queue.
1118          */
1119         DN_SK(newsk)->addr.sdn_flags &= ~SDF_WILD;
1120
1121         skb_pull(skb, dn_username2sockaddr(skb->data, skb->len, &(DN_SK(newsk)->addr), &type));
1122         skb_pull(skb, dn_username2sockaddr(skb->data, skb->len, &(DN_SK(newsk)->peer), &type));
1123         *(__le16 *)(DN_SK(newsk)->peer.sdn_add.a_addr) = cb->src;
1124         *(__le16 *)(DN_SK(newsk)->addr.sdn_add.a_addr) = cb->dst;
1125
1126         menuver = *skb->data;
1127         skb_pull(skb, 1);
1128
1129         if (menuver & DN_MENUVER_ACC)
1130                 dn_access_copy(skb, &(DN_SK(newsk)->accessdata));
1131
1132         if (menuver & DN_MENUVER_USR)
1133                 dn_user_copy(skb, &(DN_SK(newsk)->conndata_in));
1134
1135         if (menuver & DN_MENUVER_PRX)
1136                 DN_SK(newsk)->peer.sdn_flags |= SDF_PROXY;
1137
1138         if (menuver & DN_MENUVER_UIC)
1139                 DN_SK(newsk)->peer.sdn_flags |= SDF_UICPROXY;
1140
1141         kfree_skb(skb);
1142
1143         memcpy(&(DN_SK(newsk)->conndata_out), &(DN_SK(sk)->conndata_out),
1144                 sizeof(struct optdata_dn));
1145         memcpy(&(DN_SK(newsk)->discdata_out), &(DN_SK(sk)->discdata_out),
1146                 sizeof(struct optdata_dn));
1147
1148         lock_sock(newsk);
1149         err = dn_hash_sock(newsk);
1150         if (err == 0) {
1151                 sock_reset_flag(newsk, SOCK_ZAPPED);
1152                 dn_send_conn_ack(newsk);
1153
1154                 /*
1155                  * Here we use sk->sk_allocation since although the conn conf is
1156                  * for the newsk, the context is the old socket.
1157                  */
1158                 if (DN_SK(newsk)->accept_mode == ACC_IMMED)
1159                         err = dn_confirm_accept(newsk, &timeo,
1160                                                 sk->sk_allocation);
1161         }
1162         release_sock(newsk);
1163         return err;
1164 }
1165
1166
1167 static int dn_getname(struct socket *sock, struct sockaddr *uaddr,int *uaddr_len,int peer)
1168 {
1169         struct sockaddr_dn *sa = (struct sockaddr_dn *)uaddr;
1170         struct sock *sk = sock->sk;
1171         struct dn_scp *scp = DN_SK(sk);
1172
1173         *uaddr_len = sizeof(struct sockaddr_dn);
1174
1175         lock_sock(sk);
1176
1177         if (peer) {
1178                 if ((sock->state != SS_CONNECTED &&
1179                      sock->state != SS_CONNECTING) &&
1180                     scp->accept_mode == ACC_IMMED) {
1181                         release_sock(sk);
1182                         return -ENOTCONN;
1183                 }
1184
1185                 memcpy(sa, &scp->peer, sizeof(struct sockaddr_dn));
1186         } else {
1187                 memcpy(sa, &scp->addr, sizeof(struct sockaddr_dn));
1188         }
1189
1190         release_sock(sk);
1191
1192         return 0;
1193 }
1194
1195
1196 static unsigned int dn_poll(struct file *file, struct socket *sock, poll_table  *wait)
1197 {
1198         struct sock *sk = sock->sk;
1199         struct dn_scp *scp = DN_SK(sk);
1200         int mask = datagram_poll(file, sock, wait);
1201
1202         if (!skb_queue_empty(&scp->other_receive_queue))
1203                 mask |= POLLRDBAND;
1204
1205         return mask;
1206 }
1207
1208 static int dn_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
1209 {
1210         struct sock *sk = sock->sk;
1211         struct dn_scp *scp = DN_SK(sk);
1212         int err = -EOPNOTSUPP;
1213         long amount = 0;
1214         struct sk_buff *skb;
1215         int val;
1216
1217         switch(cmd)
1218         {
1219         case SIOCGIFADDR:
1220         case SIOCSIFADDR:
1221                 return dn_dev_ioctl(cmd, (void __user *)arg);
1222
1223         case SIOCATMARK:
1224                 lock_sock(sk);
1225                 val = !skb_queue_empty(&scp->other_receive_queue);
1226                 if (scp->state != DN_RUN)
1227                         val = -ENOTCONN;
1228                 release_sock(sk);
1229                 return val;
1230
1231         case TIOCOUTQ:
1232                 amount = sk->sk_sndbuf - atomic_read(&sk->sk_wmem_alloc);
1233                 if (amount < 0)
1234                         amount = 0;
1235                 err = put_user(amount, (int __user *)arg);
1236                 break;
1237
1238         case TIOCINQ:
1239                 lock_sock(sk);
1240                 if ((skb = skb_peek(&scp->other_receive_queue)) != NULL) {
1241                         amount = skb->len;
1242                 } else {
1243                         struct sk_buff *skb = sk->sk_receive_queue.next;
1244                         for(;;) {
1245                                 if (skb ==
1246                                     (struct sk_buff *)&sk->sk_receive_queue)
1247                                         break;
1248                                 amount += skb->len;
1249                                 skb = skb->next;
1250                         }
1251                 }
1252                 release_sock(sk);
1253                 err = put_user(amount, (int __user *)arg);
1254                 break;
1255
1256         default:
1257                 err = -ENOIOCTLCMD;
1258                 break;
1259         }
1260
1261         return err;
1262 }
1263
1264 static int dn_listen(struct socket *sock, int backlog)
1265 {
1266         struct sock *sk = sock->sk;
1267         int err = -EINVAL;
1268
1269         lock_sock(sk);
1270
1271         if (sock_flag(sk, SOCK_ZAPPED))
1272                 goto out;
1273
1274         if ((DN_SK(sk)->state != DN_O) || (sk->sk_state == TCP_LISTEN))
1275                 goto out;
1276
1277         sk->sk_max_ack_backlog = backlog;
1278         sk->sk_ack_backlog     = 0;
1279         sk->sk_state           = TCP_LISTEN;
1280         err                 = 0;
1281         dn_rehash_sock(sk);
1282
1283 out:
1284         release_sock(sk);
1285
1286         return err;
1287 }
1288
1289
1290 static int dn_shutdown(struct socket *sock, int how)
1291 {
1292         struct sock *sk = sock->sk;
1293         struct dn_scp *scp = DN_SK(sk);
1294         int err = -ENOTCONN;
1295
1296         lock_sock(sk);
1297
1298         if (sock->state == SS_UNCONNECTED)
1299                 goto out;
1300
1301         err = 0;
1302         if (sock->state == SS_DISCONNECTING)
1303                 goto out;
1304
1305         err = -EINVAL;
1306         if (scp->state == DN_O)
1307                 goto out;
1308
1309         if (how != SHUTDOWN_MASK)
1310                 goto out;
1311
1312         sk->sk_shutdown = how;
1313         dn_destroy_sock(sk);
1314         err = 0;
1315
1316 out:
1317         release_sock(sk);
1318
1319         return err;
1320 }
1321
1322 static int dn_setsockopt(struct socket *sock, int level, int optname, char __user *optval, int optlen)
1323 {
1324         struct sock *sk = sock->sk;
1325         int err;
1326
1327         lock_sock(sk);
1328         err = __dn_setsockopt(sock, level, optname, optval, optlen, 0);
1329         release_sock(sk);
1330
1331         return err;
1332 }
1333
1334 static int __dn_setsockopt(struct socket *sock, int level,int optname, char __user *optval, int optlen, int flags)
1335 {
1336         struct  sock *sk = sock->sk;
1337         struct dn_scp *scp = DN_SK(sk);
1338         long timeo;
1339         union {
1340                 struct optdata_dn opt;
1341                 struct accessdata_dn acc;
1342                 int mode;
1343                 unsigned long win;
1344                 int val;
1345                 unsigned char services;
1346                 unsigned char info;
1347         } u;
1348         int err;
1349
1350         if (optlen && !optval)
1351                 return -EINVAL;
1352
1353         if (optlen > sizeof(u))
1354                 return -EINVAL;
1355
1356         if (copy_from_user(&u, optval, optlen))
1357                 return -EFAULT;
1358
1359         switch(optname) {
1360                 case DSO_CONDATA:
1361                         if (sock->state == SS_CONNECTED)
1362                                 return -EISCONN;
1363                         if ((scp->state != DN_O) && (scp->state != DN_CR))
1364                                 return -EINVAL;
1365
1366                         if (optlen != sizeof(struct optdata_dn))
1367                                 return -EINVAL;
1368
1369                         if (dn_ntohs(u.opt.opt_optl) > 16)
1370                                 return -EINVAL;
1371
1372                         memcpy(&scp->conndata_out, &u.opt, optlen);
1373                         break;
1374
1375                 case DSO_DISDATA:
1376                         if (sock->state != SS_CONNECTED && scp->accept_mode == ACC_IMMED)
1377                                 return -ENOTCONN;
1378
1379                         if (optlen != sizeof(struct optdata_dn))
1380                                 return -EINVAL;
1381
1382                         if (dn_ntohs(u.opt.opt_optl) > 16)
1383                                 return -EINVAL;
1384
1385                         memcpy(&scp->discdata_out, &u.opt, optlen);
1386                         break;
1387
1388                 case DSO_CONACCESS:
1389                         if (sock->state == SS_CONNECTED)
1390                                 return -EISCONN;
1391                         if (scp->state != DN_O)
1392                                 return -EINVAL;
1393
1394                         if (optlen != sizeof(struct accessdata_dn))
1395                                 return -EINVAL;
1396
1397                         if ((u.acc.acc_accl > DN_MAXACCL) ||
1398                                         (u.acc.acc_passl > DN_MAXACCL) ||
1399                                         (u.acc.acc_userl > DN_MAXACCL))
1400                                 return -EINVAL;
1401
1402                         memcpy(&scp->accessdata, &u.acc, optlen);
1403                         break;
1404
1405                 case DSO_ACCEPTMODE:
1406                         if (sock->state == SS_CONNECTED)
1407                                 return -EISCONN;
1408                         if (scp->state != DN_O)
1409                                 return -EINVAL;
1410
1411                         if (optlen != sizeof(int))
1412                                 return -EINVAL;
1413
1414                         if ((u.mode != ACC_IMMED) && (u.mode != ACC_DEFER))
1415                                 return -EINVAL;
1416
1417                         scp->accept_mode = (unsigned char)u.mode;
1418                         break;
1419
1420                 case DSO_CONACCEPT:
1421
1422                         if (scp->state != DN_CR)
1423                                 return -EINVAL;
1424                         timeo = sock_rcvtimeo(sk, 0);
1425                         err = dn_confirm_accept(sk, &timeo, sk->sk_allocation);
1426                         return err;
1427
1428                 case DSO_CONREJECT:
1429
1430                         if (scp->state != DN_CR)
1431                                 return -EINVAL;
1432
1433                         scp->state = DN_DR;
1434                         sk->sk_shutdown = SHUTDOWN_MASK;
1435                         dn_nsp_send_disc(sk, 0x38, 0, sk->sk_allocation);
1436                         break;
1437
1438                 default:
1439 #ifdef CONFIG_NETFILTER
1440                 return nf_setsockopt(sk, PF_DECnet, optname, optval, optlen);
1441 #endif
1442                 case DSO_LINKINFO:
1443                 case DSO_STREAM:
1444                 case DSO_SEQPACKET:
1445                         return -ENOPROTOOPT;
1446
1447                 case DSO_MAXWINDOW:
1448                         if (optlen != sizeof(unsigned long))
1449                                 return -EINVAL;
1450                         if (u.win > NSP_MAX_WINDOW)
1451                                 u.win = NSP_MAX_WINDOW;
1452                         if (u.win == 0)
1453                                 return -EINVAL;
1454                         scp->max_window = u.win;
1455                         if (scp->snd_window > u.win)
1456                                 scp->snd_window = u.win;
1457                         break;
1458
1459                 case DSO_NODELAY:
1460                         if (optlen != sizeof(int))
1461                                 return -EINVAL;
1462                         if (scp->nonagle == 2)
1463                                 return -EINVAL;
1464                         scp->nonagle = (u.val == 0) ? 0 : 1;
1465                         /* if (scp->nonagle == 1) { Push pending frames } */
1466                         break;
1467
1468                 case DSO_CORK:
1469                         if (optlen != sizeof(int))
1470                                 return -EINVAL;
1471                         if (scp->nonagle == 1)
1472                                 return -EINVAL;
1473                         scp->nonagle = (u.val == 0) ? 0 : 2;
1474                         /* if (scp->nonagle == 0) { Push pending frames } */
1475                         break;
1476
1477                 case DSO_SERVICES:
1478                         if (optlen != sizeof(unsigned char))
1479                                 return -EINVAL;
1480                         if ((u.services & ~NSP_FC_MASK) != 0x01)
1481                                 return -EINVAL;
1482                         if ((u.services & NSP_FC_MASK) == NSP_FC_MASK)
1483                                 return -EINVAL;
1484                         scp->services_loc = u.services;
1485                         break;
1486
1487                 case DSO_INFO:
1488                         if (optlen != sizeof(unsigned char))
1489                                 return -EINVAL;
1490                         if (u.info & 0xfc)
1491                                 return -EINVAL;
1492                         scp->info_loc = u.info;
1493                         break;
1494         }
1495
1496         return 0;
1497 }
1498
1499 static int dn_getsockopt(struct socket *sock, int level, int optname, char __user *optval, int __user *optlen)
1500 {
1501         struct sock *sk = sock->sk;
1502         int err;
1503
1504         lock_sock(sk);
1505         err = __dn_getsockopt(sock, level, optname, optval, optlen, 0);
1506         release_sock(sk);
1507
1508         return err;
1509 }
1510
1511 static int __dn_getsockopt(struct socket *sock, int level,int optname, char __user *optval,int __user *optlen, int flags)
1512 {
1513         struct  sock *sk = sock->sk;
1514         struct dn_scp *scp = DN_SK(sk);
1515         struct linkinfo_dn link;
1516         unsigned int r_len;
1517         void *r_data = NULL;
1518         unsigned int val;
1519
1520         if(get_user(r_len , optlen))
1521                 return -EFAULT;
1522
1523         switch(optname) {
1524                 case DSO_CONDATA:
1525                         if (r_len > sizeof(struct optdata_dn))
1526                                 r_len = sizeof(struct optdata_dn);
1527                         r_data = &scp->conndata_in;
1528                         break;
1529
1530                 case DSO_DISDATA:
1531                         if (r_len > sizeof(struct optdata_dn))
1532                                 r_len = sizeof(struct optdata_dn);
1533                         r_data = &scp->discdata_in;
1534                         break;
1535
1536                 case DSO_CONACCESS:
1537                         if (r_len > sizeof(struct accessdata_dn))
1538                                 r_len = sizeof(struct accessdata_dn);
1539                         r_data = &scp->accessdata;
1540                         break;
1541
1542                 case DSO_ACCEPTMODE:
1543                         if (r_len > sizeof(unsigned char))
1544                                 r_len = sizeof(unsigned char);
1545                         r_data = &scp->accept_mode;
1546                         break;
1547
1548                 case DSO_LINKINFO:
1549                         if (r_len > sizeof(struct linkinfo_dn))
1550                                 r_len = sizeof(struct linkinfo_dn);
1551
1552                         switch(sock->state) {
1553                                 case SS_CONNECTING:
1554                                         link.idn_linkstate = LL_CONNECTING;
1555                                         break;
1556                                 case SS_DISCONNECTING:
1557                                         link.idn_linkstate = LL_DISCONNECTING;
1558                                         break;
1559                                 case SS_CONNECTED:
1560                                         link.idn_linkstate = LL_RUNNING;
1561                                         break;
1562                                 default:
1563                                         link.idn_linkstate = LL_INACTIVE;
1564                         }
1565
1566                         link.idn_segsize = scp->segsize_rem;
1567                         r_data = &link;
1568                         break;
1569
1570                 default:
1571 #ifdef CONFIG_NETFILTER
1572                 {
1573                         int val, len;
1574
1575                         if(get_user(len, optlen))
1576                                 return -EFAULT;
1577
1578                         val = nf_getsockopt(sk, PF_DECnet, optname,
1579                                                         optval, &len);
1580                         if (val >= 0)
1581                                 val = put_user(len, optlen);
1582                         return val;
1583                 }
1584 #endif
1585                 case DSO_STREAM:
1586                 case DSO_SEQPACKET:
1587                 case DSO_CONACCEPT:
1588                 case DSO_CONREJECT:
1589                         return -ENOPROTOOPT;
1590
1591                 case DSO_MAXWINDOW:
1592                         if (r_len > sizeof(unsigned long))
1593                                 r_len = sizeof(unsigned long);
1594                         r_data = &scp->max_window;
1595                         break;
1596
1597                 case DSO_NODELAY:
1598                         if (r_len > sizeof(int))
1599                                 r_len = sizeof(int);
1600                         val = (scp->nonagle == 1);
1601                         r_data = &val;
1602                         break;
1603
1604                 case DSO_CORK:
1605                         if (r_len > sizeof(int))
1606                                 r_len = sizeof(int);
1607                         val = (scp->nonagle == 2);
1608                         r_data = &val;
1609                         break;
1610
1611                 case DSO_SERVICES:
1612                         if (r_len > sizeof(unsigned char))
1613                                 r_len = sizeof(unsigned char);
1614                         r_data = &scp->services_rem;
1615                         break;
1616
1617                 case DSO_INFO:
1618                         if (r_len > sizeof(unsigned char))
1619                                 r_len = sizeof(unsigned char);
1620                         r_data = &scp->info_rem;
1621                         break;
1622         }
1623
1624         if (r_data) {
1625                 if (copy_to_user(optval, r_data, r_len))
1626                         return -EFAULT;
1627                 if (put_user(r_len, optlen))
1628                         return -EFAULT;
1629         }
1630
1631         return 0;
1632 }
1633
1634
1635 static int dn_data_ready(struct sock *sk, struct sk_buff_head *q, int flags, int target)
1636 {
1637         struct sk_buff *skb = q->next;
1638         int len = 0;
1639
1640         if (flags & MSG_OOB)
1641                 return !skb_queue_empty(q) ? 1 : 0;
1642
1643         while(skb != (struct sk_buff *)q) {
1644                 struct dn_skb_cb *cb = DN_SKB_CB(skb);
1645                 len += skb->len;
1646
1647                 if (cb->nsp_flags & 0x40) {
1648                         /* SOCK_SEQPACKET reads to EOM */
1649                         if (sk->sk_type == SOCK_SEQPACKET)
1650                                 return 1;
1651                         /* so does SOCK_STREAM unless WAITALL is specified */
1652                         if (!(flags & MSG_WAITALL))
1653                                 return 1;
1654                 }
1655
1656                 /* minimum data length for read exceeded */
1657                 if (len >= target)
1658                         return 1;
1659
1660                 skb = skb->next;
1661         }
1662
1663         return 0;
1664 }
1665
1666
1667 static int dn_recvmsg(struct kiocb *iocb, struct socket *sock,
1668         struct msghdr *msg, size_t size, int flags)
1669 {
1670         struct sock *sk = sock->sk;
1671         struct dn_scp *scp = DN_SK(sk);
1672         struct sk_buff_head *queue = &sk->sk_receive_queue;
1673         size_t target = size > 1 ? 1 : 0;
1674         size_t copied = 0;
1675         int rv = 0;
1676         struct sk_buff *skb, *nskb;
1677         struct dn_skb_cb *cb = NULL;
1678         unsigned char eor = 0;
1679         long timeo = sock_rcvtimeo(sk, flags & MSG_DONTWAIT);
1680
1681         lock_sock(sk);
1682
1683         if (sock_flag(sk, SOCK_ZAPPED)) {
1684                 rv = -EADDRNOTAVAIL;
1685                 goto out;
1686         }
1687
1688         if (sk->sk_shutdown & RCV_SHUTDOWN) {
1689                 rv = 0;
1690                 goto out;
1691         }
1692
1693         rv = dn_check_state(sk, NULL, 0, &timeo, flags);
1694         if (rv)
1695                 goto out;
1696
1697         if (flags & ~(MSG_CMSG_COMPAT|MSG_PEEK|MSG_OOB|MSG_WAITALL|MSG_DONTWAIT|MSG_NOSIGNAL)) {
1698                 rv = -EOPNOTSUPP;
1699                 goto out;
1700         }
1701
1702         if (flags & MSG_OOB)
1703                 queue = &scp->other_receive_queue;
1704
1705         if (flags & MSG_WAITALL)
1706                 target = size;
1707
1708
1709         /*
1710          * See if there is data ready to read, sleep if there isn't
1711          */
1712         for(;;) {
1713                 if (sk->sk_err)
1714                         goto out;
1715
1716                 if (!skb_queue_empty(&scp->other_receive_queue)) {
1717                         if (!(flags & MSG_OOB)) {
1718                                 msg->msg_flags |= MSG_OOB;
1719                                 if (!scp->other_report) {
1720                                         scp->other_report = 1;
1721                                         goto out;
1722                                 }
1723                         }
1724                 }
1725
1726                 if (scp->state != DN_RUN)
1727                         goto out;
1728
1729                 if (signal_pending(current)) {
1730                         rv = sock_intr_errno(timeo);
1731                         goto out;
1732                 }
1733
1734                 if (dn_data_ready(sk, queue, flags, target))
1735                         break;
1736
1737                 if (flags & MSG_DONTWAIT) {
1738                         rv = -EWOULDBLOCK;
1739                         goto out;
1740                 }
1741
1742                 set_bit(SOCK_ASYNC_WAITDATA, &sock->flags);
1743                 SOCK_SLEEP_PRE(sk)
1744
1745                 if (!dn_data_ready(sk, queue, flags, target))
1746                         schedule();
1747
1748                 SOCK_SLEEP_POST(sk)
1749                 clear_bit(SOCK_ASYNC_WAITDATA, &sock->flags);
1750         }
1751
1752         for(skb = queue->next; skb != (struct sk_buff *)queue; skb = nskb) {
1753                 unsigned int chunk = skb->len;
1754                 cb = DN_SKB_CB(skb);
1755
1756                 if ((chunk + copied) > size)
1757                         chunk = size - copied;
1758
1759                 if (memcpy_toiovec(msg->msg_iov, skb->data, chunk)) {
1760                         rv = -EFAULT;
1761                         break;
1762                 }
1763                 copied += chunk;
1764
1765                 if (!(flags & MSG_PEEK))
1766                         skb_pull(skb, chunk);
1767
1768                 eor = cb->nsp_flags & 0x40;
1769                 nskb = skb->next;
1770
1771                 if (skb->len == 0) {
1772                         skb_unlink(skb, queue);
1773                         kfree_skb(skb);
1774                         /*
1775                          * N.B. Don't refer to skb or cb after this point
1776                          * in loop.
1777                          */
1778                         if ((scp->flowloc_sw == DN_DONTSEND) && !dn_congested(sk)) {
1779                                 scp->flowloc_sw = DN_SEND;
1780                                 dn_nsp_send_link(sk, DN_SEND, 0);
1781                         }
1782                 }
1783
1784                 if (eor) {
1785                         if (sk->sk_type == SOCK_SEQPACKET)
1786                                 break;
1787                         if (!(flags & MSG_WAITALL))
1788                                 break;
1789                 }
1790
1791                 if (flags & MSG_OOB)
1792                         break;
1793
1794                 if (copied >= target)
1795                         break;
1796         }
1797
1798         rv = copied;
1799
1800
1801         if (eor && (sk->sk_type == SOCK_SEQPACKET))
1802                 msg->msg_flags |= MSG_EOR;
1803
1804 out:
1805         if (rv == 0)
1806                 rv = (flags & MSG_PEEK) ? -sk->sk_err : sock_error(sk);
1807
1808         if ((rv >= 0) && msg->msg_name) {
1809                 memcpy(msg->msg_name, &scp->peer, sizeof(struct sockaddr_dn));
1810                 msg->msg_namelen = sizeof(struct sockaddr_dn);
1811         }
1812
1813         release_sock(sk);
1814
1815         return rv;
1816 }
1817
1818
1819 static inline int dn_queue_too_long(struct dn_scp *scp, struct sk_buff_head *queue, int flags)
1820 {
1821         unsigned char fctype = scp->services_rem & NSP_FC_MASK;
1822         if (skb_queue_len(queue) >= scp->snd_window)
1823                 return 1;
1824         if (fctype != NSP_FC_NONE) {
1825                 if (flags & MSG_OOB) {
1826                         if (scp->flowrem_oth == 0)
1827                                 return 1;
1828                 } else {
1829                         if (scp->flowrem_dat == 0)
1830                                 return 1;
1831                 }
1832         }
1833         return 0;
1834 }
1835
1836 /*
1837  * The DECnet spec requires the the "routing layer" accepts packets which
1838  * are at least 230 bytes in size. This excludes any headers which the NSP
1839  * layer might add, so we always assume that we'll be using the maximal
1840  * length header on data packets. The variation in length is due to the
1841  * inclusion (or not) of the two 16 bit acknowledgement fields so it doesn't
1842  * make much practical difference.
1843  */
1844 unsigned dn_mss_from_pmtu(struct net_device *dev, int mtu)
1845 {
1846         unsigned mss = 230 - DN_MAX_NSP_DATA_HEADER;
1847         if (dev) {
1848                 struct dn_dev *dn_db = dev->dn_ptr;
1849                 mtu -= LL_RESERVED_SPACE(dev);
1850                 if (dn_db->use_long)
1851                         mtu -= 21;
1852                 else
1853                         mtu -= 6;
1854                 mtu -= DN_MAX_NSP_DATA_HEADER;
1855         } else {
1856                 /*
1857                  * 21 = long header, 16 = guess at MAC header length
1858                  */
1859                 mtu -= (21 + DN_MAX_NSP_DATA_HEADER + 16);
1860         }
1861         if (mtu > mss)
1862                 mss = mtu;
1863         return mss;
1864 }
1865
1866 static inline unsigned int dn_current_mss(struct sock *sk, int flags)
1867 {
1868         struct dst_entry *dst = __sk_dst_get(sk);
1869         struct dn_scp *scp = DN_SK(sk);
1870         int mss_now = min_t(int, scp->segsize_loc, scp->segsize_rem);
1871
1872         /* Other data messages are limited to 16 bytes per packet */
1873         if (flags & MSG_OOB)
1874                 return 16;
1875
1876         /* This works out the maximum size of segment we can send out */
1877         if (dst) {
1878                 u32 mtu = dst_mtu(dst);
1879                 mss_now = min_t(int, dn_mss_from_pmtu(dst->dev, mtu), mss_now);
1880         }
1881
1882         return mss_now;
1883 }
1884
1885 /*
1886  * N.B. We get the timeout wrong here, but then we always did get it
1887  * wrong before and this is another step along the road to correcting
1888  * it. It ought to get updated each time we pass through the routine,
1889  * but in practise it probably doesn't matter too much for now.
1890  */
1891 static inline struct sk_buff *dn_alloc_send_pskb(struct sock *sk,
1892                               unsigned long datalen, int noblock,
1893                               int *errcode)
1894 {
1895         struct sk_buff *skb = sock_alloc_send_skb(sk, datalen,
1896                                                    noblock, errcode);
1897         if (skb) {
1898                 skb->protocol = __constant_htons(ETH_P_DNA_RT);
1899                 skb->pkt_type = PACKET_OUTGOING;
1900         }
1901         return skb;
1902 }
1903
1904 static int dn_sendmsg(struct kiocb *iocb, struct socket *sock,
1905                       struct msghdr *msg, size_t size)
1906 {
1907         struct sock *sk = sock->sk;
1908         struct dn_scp *scp = DN_SK(sk);
1909         size_t mss;
1910         struct sk_buff_head *queue = &scp->data_xmit_queue;
1911         int flags = msg->msg_flags;
1912         int err = 0;
1913         size_t sent = 0;
1914         int addr_len = msg->msg_namelen;
1915         struct sockaddr_dn *addr = (struct sockaddr_dn *)msg->msg_name;
1916         struct sk_buff *skb = NULL;
1917         struct dn_skb_cb *cb;
1918         size_t len;
1919         unsigned char fctype;
1920         long timeo;
1921
1922         if (flags & ~(MSG_TRYHARD|MSG_OOB|MSG_DONTWAIT|MSG_EOR|MSG_NOSIGNAL|MSG_MORE|MSG_CMSG_COMPAT))
1923                 return -EOPNOTSUPP;
1924
1925         if (addr_len && (addr_len != sizeof(struct sockaddr_dn)))
1926                 return -EINVAL;
1927
1928         lock_sock(sk);
1929         timeo = sock_sndtimeo(sk, flags & MSG_DONTWAIT);
1930         /*
1931          * The only difference between stream sockets and sequenced packet
1932          * sockets is that the stream sockets always behave as if MSG_EOR
1933          * has been set.
1934          */
1935         if (sock->type == SOCK_STREAM) {
1936                 if (flags & MSG_EOR) {
1937                         err = -EINVAL;
1938                         goto out;
1939                 }
1940                 flags |= MSG_EOR;
1941         }
1942
1943
1944         err = dn_check_state(sk, addr, addr_len, &timeo, flags);
1945         if (err)
1946                 goto out_err;
1947
1948         if (sk->sk_shutdown & SEND_SHUTDOWN) {
1949                 err = -EPIPE;
1950                 if (!(flags & MSG_NOSIGNAL))
1951                         send_sig(SIGPIPE, current, 0);
1952                 goto out_err;
1953         }
1954
1955         if ((flags & MSG_TRYHARD) && sk->sk_dst_cache)
1956                 dst_negative_advice(&sk->sk_dst_cache);
1957
1958         mss = scp->segsize_rem;
1959         fctype = scp->services_rem & NSP_FC_MASK;
1960
1961         mss = dn_current_mss(sk, flags);
1962
1963         if (flags & MSG_OOB) {
1964                 queue = &scp->other_xmit_queue;
1965                 if (size > mss) {
1966                         err = -EMSGSIZE;
1967                         goto out;
1968                 }
1969         }
1970
1971         scp->persist_fxn = dn_nsp_xmit_timeout;
1972
1973         while(sent < size) {
1974                 err = sock_error(sk);
1975                 if (err)
1976                         goto out;
1977
1978                 if (signal_pending(current)) {
1979                         err = sock_intr_errno(timeo);
1980                         goto out;
1981                 }
1982
1983                 /*
1984                  * Calculate size that we wish to send.
1985                  */
1986                 len = size - sent;
1987
1988                 if (len > mss)
1989                         len = mss;
1990
1991                 /*
1992                  * Wait for queue size to go down below the window
1993                  * size.
1994                  */
1995                 if (dn_queue_too_long(scp, queue, flags)) {
1996                         if (flags & MSG_DONTWAIT) {
1997                                 err = -EWOULDBLOCK;
1998                                 goto out;
1999                         }
2000
2001                         SOCK_SLEEP_PRE(sk)
2002
2003                         if (dn_queue_too_long(scp, queue, flags))
2004                                 schedule();
2005
2006                         SOCK_SLEEP_POST(sk)
2007
2008                         continue;
2009                 }
2010
2011                 /*
2012                  * Get a suitably sized skb.
2013                  * 64 is a bit of a hack really, but its larger than any
2014                  * link-layer headers and has served us well as a good
2015                  * guess as to their real length.
2016                  */
2017                 skb = dn_alloc_send_pskb(sk, len + 64 + DN_MAX_NSP_DATA_HEADER,
2018                                          flags & MSG_DONTWAIT, &err);
2019
2020                 if (err)
2021                         break;
2022
2023                 if (!skb)
2024                         continue;
2025
2026                 cb = DN_SKB_CB(skb);
2027
2028                 skb_reserve(skb, 64 + DN_MAX_NSP_DATA_HEADER);
2029
2030                 if (memcpy_fromiovec(skb_put(skb, len), msg->msg_iov, len)) {
2031                         err = -EFAULT;
2032                         goto out;
2033                 }
2034
2035                 if (flags & MSG_OOB) {
2036                         cb->nsp_flags = 0x30;
2037                         if (fctype != NSP_FC_NONE)
2038                                 scp->flowrem_oth--;
2039                 } else {
2040                         cb->nsp_flags = 0x00;
2041                         if (scp->seg_total == 0)
2042                                 cb->nsp_flags |= 0x20;
2043
2044                         scp->seg_total += len;
2045
2046                         if (((sent + len) == size) && (flags & MSG_EOR)) {
2047                                 cb->nsp_flags |= 0x40;
2048                                 scp->seg_total = 0;
2049                                 if (fctype == NSP_FC_SCMC)
2050                                         scp->flowrem_dat--;
2051                         }
2052                         if (fctype == NSP_FC_SRC)
2053                                 scp->flowrem_dat--;
2054                 }
2055
2056                 sent += len;
2057                 dn_nsp_queue_xmit(sk, skb, sk->sk_allocation, flags & MSG_OOB);
2058                 skb = NULL;
2059
2060                 scp->persist = dn_nsp_persist(sk);
2061
2062         }
2063 out:
2064
2065         if (skb)
2066                 kfree_skb(skb);
2067
2068         release_sock(sk);
2069
2070         return sent ? sent : err;
2071
2072 out_err:
2073         err = sk_stream_error(sk, flags, err);
2074         release_sock(sk);
2075         return err;
2076 }
2077
2078 static int dn_device_event(struct notifier_block *this, unsigned long event,
2079                         void *ptr)
2080 {
2081         struct net_device *dev = (struct net_device *)ptr;
2082
2083         switch(event) {
2084                 case NETDEV_UP:
2085                         dn_dev_up(dev);
2086                         break;
2087                 case NETDEV_DOWN:
2088                         dn_dev_down(dev);
2089                         break;
2090                 default:
2091                         break;
2092         }
2093
2094         return NOTIFY_DONE;
2095 }
2096
2097 static struct notifier_block dn_dev_notifier = {
2098         .notifier_call = dn_device_event,
2099 };
2100
2101 extern int dn_route_rcv(struct sk_buff *, struct net_device *, struct packet_type *, struct net_device *);
2102
2103 static struct packet_type dn_dix_packet_type = {
2104         .type =         __constant_htons(ETH_P_DNA_RT),
2105         .dev =          NULL,           /* All devices */
2106         .func =         dn_route_rcv,
2107 };
2108
2109 #ifdef CONFIG_PROC_FS
2110 struct dn_iter_state {
2111         int bucket;
2112 };
2113
2114 static struct sock *dn_socket_get_first(struct seq_file *seq)
2115 {
2116         struct dn_iter_state *state = seq->private;
2117         struct sock *n = NULL;
2118
2119         for(state->bucket = 0;
2120             state->bucket < DN_SK_HASH_SIZE;
2121             ++state->bucket) {
2122                 n = sk_head(&dn_sk_hash[state->bucket]);
2123                 if (n)
2124                         break;
2125         }
2126
2127         return n;
2128 }
2129
2130 static struct sock *dn_socket_get_next(struct seq_file *seq,
2131                                        struct sock *n)
2132 {
2133         struct dn_iter_state *state = seq->private;
2134
2135         n = sk_next(n);
2136 try_again:
2137         if (n)
2138                 goto out;
2139         if (++state->bucket >= DN_SK_HASH_SIZE)
2140                 goto out;
2141         n = sk_head(&dn_sk_hash[state->bucket]);
2142         goto try_again;
2143 out:
2144         return n;
2145 }
2146
2147 static struct sock *socket_get_idx(struct seq_file *seq, loff_t *pos)
2148 {
2149         struct sock *sk = dn_socket_get_first(seq);
2150
2151         if (sk) {
2152                 while(*pos && (sk = dn_socket_get_next(seq, sk)))
2153                         --*pos;
2154         }
2155         return *pos ? NULL : sk;
2156 }
2157
2158 static void *dn_socket_get_idx(struct seq_file *seq, loff_t pos)
2159 {
2160         void *rc;
2161         read_lock_bh(&dn_hash_lock);
2162         rc = socket_get_idx(seq, &pos);
2163         if (!rc) {
2164                 read_unlock_bh(&dn_hash_lock);
2165         }
2166         return rc;
2167 }
2168
2169 static void *dn_socket_seq_start(struct seq_file *seq, loff_t *pos)
2170 {
2171         return *pos ? dn_socket_get_idx(seq, *pos - 1) : SEQ_START_TOKEN;
2172 }
2173
2174 static void *dn_socket_seq_next(struct seq_file *seq, void *v, loff_t *pos)
2175 {
2176         void *rc;
2177
2178         if (v == SEQ_START_TOKEN) {
2179                 rc = dn_socket_get_idx(seq, 0);
2180                 goto out;
2181         }
2182
2183         rc = dn_socket_get_next(seq, v);
2184         if (rc)
2185                 goto out;
2186         read_unlock_bh(&dn_hash_lock);
2187 out:
2188         ++*pos;
2189         return rc;
2190 }
2191
2192 static void dn_socket_seq_stop(struct seq_file *seq, void *v)
2193 {
2194         if (v && v != SEQ_START_TOKEN)
2195                 read_unlock_bh(&dn_hash_lock);
2196 }
2197
2198 #define IS_NOT_PRINTABLE(x) ((x) < 32 || (x) > 126)
2199
2200 static void dn_printable_object(struct sockaddr_dn *dn, unsigned char *buf)
2201 {
2202         int i;
2203
2204         switch (dn_ntohs(dn->sdn_objnamel)) {
2205                 case 0:
2206                         sprintf(buf, "%d", dn->sdn_objnum);
2207                         break;
2208                 default:
2209                         for (i = 0; i < dn_ntohs(dn->sdn_objnamel); i++) {
2210                                 buf[i] = dn->sdn_objname[i];
2211                                 if (IS_NOT_PRINTABLE(buf[i]))
2212                                         buf[i] = '.';
2213                         }
2214                         buf[i] = 0;
2215         }
2216 }
2217
2218 static char *dn_state2asc(unsigned char state)
2219 {
2220         switch(state) {
2221                 case DN_O:
2222                         return "OPEN";
2223                 case DN_CR:
2224                         return "  CR";
2225                 case DN_DR:
2226                         return "  DR";
2227                 case DN_DRC:
2228                         return " DRC";
2229                 case DN_CC:
2230                         return "  CC";
2231                 case DN_CI:
2232                         return "  CI";
2233                 case DN_NR:
2234                         return "  NR";
2235                 case DN_NC:
2236                         return "  NC";
2237                 case DN_CD:
2238                         return "  CD";
2239                 case DN_RJ:
2240                         return "  RJ";
2241                 case DN_RUN:
2242                         return " RUN";
2243                 case DN_DI:
2244                         return "  DI";
2245                 case DN_DIC:
2246                         return " DIC";
2247                 case DN_DN:
2248                         return "  DN";
2249                 case DN_CL:
2250                         return "  CL";
2251                 case DN_CN:
2252                         return "  CN";
2253         }
2254
2255         return "????";
2256 }
2257
2258 static inline void dn_socket_format_entry(struct seq_file *seq, struct sock *sk)
2259 {
2260         struct dn_scp *scp = DN_SK(sk);
2261         char buf1[DN_ASCBUF_LEN];
2262         char buf2[DN_ASCBUF_LEN];
2263         char local_object[DN_MAXOBJL+3];
2264         char remote_object[DN_MAXOBJL+3];
2265
2266         dn_printable_object(&scp->addr, local_object);
2267         dn_printable_object(&scp->peer, remote_object);
2268
2269         seq_printf(seq,
2270                    "%6s/%04X %04d:%04d %04d:%04d %01d %-16s "
2271                    "%6s/%04X %04d:%04d %04d:%04d %01d %-16s %4s %s\n",
2272                    dn_addr2asc(dn_ntohs(dn_saddr2dn(&scp->addr)), buf1),
2273                    scp->addrloc,
2274                    scp->numdat,
2275                    scp->numoth,
2276                    scp->ackxmt_dat,
2277                    scp->ackxmt_oth,
2278                    scp->flowloc_sw,
2279                    local_object,
2280                    dn_addr2asc(dn_ntohs(dn_saddr2dn(&scp->peer)), buf2),
2281                    scp->addrrem,
2282                    scp->numdat_rcv,
2283                    scp->numoth_rcv,
2284                    scp->ackrcv_dat,
2285                    scp->ackrcv_oth,
2286                    scp->flowrem_sw,
2287                    remote_object,
2288                    dn_state2asc(scp->state),
2289                    ((scp->accept_mode == ACC_IMMED) ? "IMMED" : "DEFER"));
2290 }
2291
2292 static int dn_socket_seq_show(struct seq_file *seq, void *v)
2293 {
2294         if (v == SEQ_START_TOKEN) {
2295                 seq_puts(seq, "Local                                              Remote\n");
2296         } else {
2297                 dn_socket_format_entry(seq, v);
2298         }
2299         return 0;
2300 }
2301
2302 static struct seq_operations dn_socket_seq_ops = {
2303         .start  = dn_socket_seq_start,
2304         .next   = dn_socket_seq_next,
2305         .stop   = dn_socket_seq_stop,
2306         .show   = dn_socket_seq_show,
2307 };
2308
2309 static int dn_socket_seq_open(struct inode *inode, struct file *file)
2310 {
2311         struct seq_file *seq;
2312         int rc = -ENOMEM;
2313         struct dn_iter_state *s = kmalloc(sizeof(*s), GFP_KERNEL);
2314
2315         if (!s)
2316                 goto out;
2317
2318         rc = seq_open(file, &dn_socket_seq_ops);
2319         if (rc)
2320                 goto out_kfree;
2321
2322         seq             = file->private_data;
2323         seq->private    = s;
2324         memset(s, 0, sizeof(*s));
2325 out:
2326         return rc;
2327 out_kfree:
2328         kfree(s);
2329         goto out;
2330 }
2331
2332 static struct file_operations dn_socket_seq_fops = {
2333         .owner          = THIS_MODULE,
2334         .open           = dn_socket_seq_open,
2335         .read           = seq_read,
2336         .llseek         = seq_lseek,
2337         .release        = seq_release_private,
2338 };
2339 #endif
2340
2341 static struct net_proto_family  dn_family_ops = {
2342         .family =       AF_DECnet,
2343         .create =       dn_create,
2344         .owner  =       THIS_MODULE,
2345 };
2346
2347 static const struct proto_ops dn_proto_ops = {
2348         .family =       AF_DECnet,
2349         .owner =        THIS_MODULE,
2350         .release =      dn_release,
2351         .bind =         dn_bind,
2352         .connect =      dn_connect,
2353         .socketpair =   sock_no_socketpair,
2354         .accept =       dn_accept,
2355         .getname =      dn_getname,
2356         .poll =         dn_poll,
2357         .ioctl =        dn_ioctl,
2358         .listen =       dn_listen,
2359         .shutdown =     dn_shutdown,
2360         .setsockopt =   dn_setsockopt,
2361         .getsockopt =   dn_getsockopt,
2362         .sendmsg =      dn_sendmsg,
2363         .recvmsg =      dn_recvmsg,
2364         .mmap =         sock_no_mmap,
2365         .sendpage =     sock_no_sendpage,
2366 };
2367
2368 void dn_register_sysctl(void);
2369 void dn_unregister_sysctl(void);
2370
2371 MODULE_DESCRIPTION("The Linux DECnet Network Protocol");
2372 MODULE_AUTHOR("Linux DECnet Project Team");
2373 MODULE_LICENSE("GPL");
2374 MODULE_ALIAS_NETPROTO(PF_DECnet);
2375
2376 static char banner[] __initdata = KERN_INFO "NET4: DECnet for Linux: V.2.5.68s (C) 1995-2003 Linux DECnet Project Team\n";
2377
2378 static int __init decnet_init(void)
2379 {
2380         int rc;
2381
2382         printk(banner);
2383
2384         rc = proto_register(&dn_proto, 1);
2385         if (rc != 0)
2386                 goto out;
2387
2388         dn_neigh_init();
2389         dn_dev_init();
2390         dn_route_init();
2391         dn_fib_init();
2392
2393         sock_register(&dn_family_ops);
2394         dev_add_pack(&dn_dix_packet_type);
2395         register_netdevice_notifier(&dn_dev_notifier);
2396
2397         proc_net_fops_create("decnet", S_IRUGO, &dn_socket_seq_fops);
2398         dn_register_sysctl();
2399 out:
2400         return rc;
2401
2402 }
2403 module_init(decnet_init);
2404
2405 /*
2406  * Prevent DECnet module unloading until its fixed properly.
2407  * Requires an audit of the code to check for memory leaks and
2408  * initialisation problems etc.
2409  */
2410 #if 0
2411 static void __exit decnet_exit(void)
2412 {
2413         sock_unregister(AF_DECnet);
2414         dev_remove_pack(&dn_dix_packet_type);
2415
2416         dn_unregister_sysctl();
2417
2418         unregister_netdevice_notifier(&dn_dev_notifier);
2419
2420         dn_route_cleanup();
2421         dn_dev_cleanup();
2422         dn_neigh_cleanup();
2423         dn_fib_cleanup();
2424
2425         proc_net_remove("decnet");
2426
2427         proto_unregister(&dn_proto);
2428 }
2429 module_exit(decnet_exit);
2430 #endif