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