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