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