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