1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37#include <linux/module.h>
38#include <linux/types.h>
39#include <linux/net.h>
40#include <linux/socket.h>
41#include <linux/errno.h>
42#include <linux/mm.h>
43#include <linux/slab.h>
44#include <linux/poll.h>
45#include <linux/fcntl.h>
46#include <asm/semaphore.h>
47#include <asm/string.h>
48#include <asm/atomic.h>
49#include <net/sock.h>
50
51#include <linux/tipc.h>
52#include <linux/tipc_config.h>
53#include <net/tipc/tipc_msg.h>
54#include <net/tipc/tipc_port.h>
55
56#include "core.h"
57
58#define SS_LISTENING -1
59#define SS_READY -2
60
61#define OVERLOAD_LIMIT_BASE 5000
62
63struct tipc_sock {
64 struct sock sk;
65 struct tipc_port *p;
66 struct semaphore sem;
67};
68
69#define tipc_sk(sk) ((struct tipc_sock*)sk)
70
71static u32 dispatch(struct tipc_port *tport, struct sk_buff *buf);
72static void wakeupdispatch(struct tipc_port *tport);
73
74static struct proto_ops packet_ops;
75static struct proto_ops stream_ops;
76static struct proto_ops msg_ops;
77
78static struct proto tipc_proto;
79
80static int sockets_enabled = 0;
81
82static atomic_t tipc_queue_size = ATOMIC_INIT(0);
83
84
85
86
87
88
89
90
91static void sock_lock(struct tipc_sock* tsock)
92{
93 spin_lock_bh(tsock->p->lock);
94}
95
96
97
98
99static void sock_unlock(struct tipc_sock* tsock)
100{
101 spin_unlock_bh(tsock->p->lock);
102}
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122static u32 pollmask(struct socket *sock)
123{
124 u32 mask;
125
126 if ((skb_queue_len(&sock->sk->sk_receive_queue) != 0) ||
127 (sock->state == SS_UNCONNECTED) ||
128 (sock->state == SS_DISCONNECTING))
129 mask = (POLLRDNORM | POLLIN);
130 else
131 mask = 0;
132
133 if (sock->state == SS_DISCONNECTING)
134 mask |= POLLHUP;
135 else
136 mask |= POLLOUT;
137
138 return mask;
139}
140
141
142
143
144
145
146
147static void advance_queue(struct tipc_sock *tsock)
148{
149 sock_lock(tsock);
150 buf_discard(skb_dequeue(&tsock->sk.sk_receive_queue));
151 sock_unlock(tsock);
152 atomic_dec(&tipc_queue_size);
153}
154
155
156
157
158
159
160
161
162
163
164
165static int tipc_create(struct net *net, struct socket *sock, int protocol)
166{
167 struct tipc_sock *tsock;
168 struct tipc_port *port;
169 struct sock *sk;
170 u32 ref;
171
172 if (net != &init_net)
173 return -EAFNOSUPPORT;
174
175 if (unlikely(protocol != 0))
176 return -EPROTONOSUPPORT;
177
178 ref = tipc_createport_raw(NULL, &dispatch, &wakeupdispatch, TIPC_LOW_IMPORTANCE);
179 if (unlikely(!ref))
180 return -ENOMEM;
181
182 sock->state = SS_UNCONNECTED;
183
184 switch (sock->type) {
185 case SOCK_STREAM:
186 sock->ops = &stream_ops;
187 break;
188 case SOCK_SEQPACKET:
189 sock->ops = &packet_ops;
190 break;
191 case SOCK_DGRAM:
192 tipc_set_portunreliable(ref, 1);
193
194 case SOCK_RDM:
195 tipc_set_portunreturnable(ref, 1);
196 sock->ops = &msg_ops;
197 sock->state = SS_READY;
198 break;
199 default:
200 tipc_deleteport(ref);
201 return -EPROTOTYPE;
202 }
203
204 sk = sk_alloc(net, AF_TIPC, GFP_KERNEL, &tipc_proto);
205 if (!sk) {
206 tipc_deleteport(ref);
207 return -ENOMEM;
208 }
209
210 sock_init_data(sock, sk);
211 init_waitqueue_head(sk->sk_sleep);
212 sk->sk_rcvtimeo = 8 * HZ;
213
214 tsock = tipc_sk(sk);
215 port = tipc_get_port(ref);
216
217 tsock->p = port;
218 port->usr_handle = tsock;
219
220 init_MUTEX(&tsock->sem);
221
222 dbg("sock_create: %x\n",tsock);
223
224 atomic_inc(&tipc_user_count);
225
226 return 0;
227}
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246static int release(struct socket *sock)
247{
248 struct tipc_sock *tsock = tipc_sk(sock->sk);
249 struct sock *sk = sock->sk;
250 int res = TIPC_OK;
251 struct sk_buff *buf;
252
253 dbg("sock_delete: %x\n",tsock);
254 if (!tsock)
255 return 0;
256 down(&tsock->sem);
257 if (!sock->sk) {
258 up(&tsock->sem);
259 return 0;
260 }
261
262
263
264 while (sock->state != SS_DISCONNECTING) {
265 sock_lock(tsock);
266 buf = skb_dequeue(&sk->sk_receive_queue);
267 if (!buf)
268 tsock->p->usr_handle = NULL;
269 sock_unlock(tsock);
270 if (!buf)
271 break;
272 if (TIPC_SKB_CB(buf)->handle != msg_data(buf_msg(buf)))
273 buf_discard(buf);
274 else
275 tipc_reject_msg(buf, TIPC_ERR_NO_PORT);
276 atomic_dec(&tipc_queue_size);
277 }
278
279
280
281 res = tipc_deleteport(tsock->p->ref);
282 sock->sk = NULL;
283
284
285
286 while ((buf = skb_dequeue(&sk->sk_receive_queue))) {
287 buf_discard(buf);
288 atomic_dec(&tipc_queue_size);
289 }
290
291 up(&tsock->sem);
292
293 sock_put(sk);
294
295 atomic_dec(&tipc_user_count);
296 return res;
297}
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312static int bind(struct socket *sock, struct sockaddr *uaddr, int uaddr_len)
313{
314 struct tipc_sock *tsock = tipc_sk(sock->sk);
315 struct sockaddr_tipc *addr = (struct sockaddr_tipc *)uaddr;
316 int res;
317
318 if (down_interruptible(&tsock->sem))
319 return -ERESTARTSYS;
320
321 if (unlikely(!uaddr_len)) {
322 res = tipc_withdraw(tsock->p->ref, 0, NULL);
323 goto exit;
324 }
325
326 if (uaddr_len < sizeof(struct sockaddr_tipc)) {
327 res = -EINVAL;
328 goto exit;
329 }
330
331 if (addr->family != AF_TIPC) {
332 res = -EAFNOSUPPORT;
333 goto exit;
334 }
335 if (addr->addrtype == TIPC_ADDR_NAME)
336 addr->addr.nameseq.upper = addr->addr.nameseq.lower;
337 else if (addr->addrtype != TIPC_ADDR_NAMESEQ) {
338 res = -EAFNOSUPPORT;
339 goto exit;
340 }
341
342 if (addr->scope > 0)
343 res = tipc_publish(tsock->p->ref, addr->scope,
344 &addr->addr.nameseq);
345 else
346 res = tipc_withdraw(tsock->p->ref, -addr->scope,
347 &addr->addr.nameseq);
348exit:
349 up(&tsock->sem);
350 return res;
351}
352
353
354
355
356
357
358
359
360
361
362
363static int get_name(struct socket *sock, struct sockaddr *uaddr,
364 int *uaddr_len, int peer)
365{
366 struct tipc_sock *tsock = tipc_sk(sock->sk);
367 struct sockaddr_tipc *addr = (struct sockaddr_tipc *)uaddr;
368 u32 res;
369
370 if (down_interruptible(&tsock->sem))
371 return -ERESTARTSYS;
372
373 *uaddr_len = sizeof(*addr);
374 addr->addrtype = TIPC_ADDR_ID;
375 addr->family = AF_TIPC;
376 addr->scope = 0;
377 if (peer)
378 res = tipc_peer(tsock->p->ref, &addr->addr.id);
379 else
380 res = tipc_ownidentity(tsock->p->ref, &addr->addr.id);
381 addr->addr.name.domain = 0;
382
383 up(&tsock->sem);
384 return res;
385}
386
387
388
389
390
391
392
393
394
395
396static unsigned int poll(struct file *file, struct socket *sock,
397 poll_table *wait)
398{
399 poll_wait(file, sock->sk->sk_sleep, wait);
400
401 return pollmask(sock);
402}
403
404
405
406
407
408
409
410
411
412
413
414
415static int dest_name_check(struct sockaddr_tipc *dest, struct msghdr *m)
416{
417 struct tipc_cfg_msg_hdr hdr;
418
419 if (likely(dest->addr.name.name.type >= TIPC_RESERVED_TYPES))
420 return 0;
421 if (likely(dest->addr.name.name.type == TIPC_TOP_SRV))
422 return 0;
423
424 if (likely(dest->addr.name.name.type != TIPC_CFG_SRV))
425 return -EACCES;
426
427 if (copy_from_user(&hdr, m->msg_iov[0].iov_base, sizeof(hdr)))
428 return -EFAULT;
429 if ((ntohs(hdr.tcm_type) & 0xC000) && (!capable(CAP_NET_ADMIN)))
430 return -EACCES;
431
432 return 0;
433}
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450static int send_msg(struct kiocb *iocb, struct socket *sock,
451 struct msghdr *m, size_t total_len)
452{
453 struct tipc_sock *tsock = tipc_sk(sock->sk);
454 struct sockaddr_tipc *dest = (struct sockaddr_tipc *)m->msg_name;
455 struct sk_buff *buf;
456 int needs_conn;
457 int res = -EINVAL;
458
459 if (unlikely(!dest))
460 return -EDESTADDRREQ;
461 if (unlikely((m->msg_namelen < sizeof(*dest)) ||
462 (dest->family != AF_TIPC)))
463 return -EINVAL;
464
465 needs_conn = (sock->state != SS_READY);
466 if (unlikely(needs_conn)) {
467 if (sock->state == SS_LISTENING)
468 return -EPIPE;
469 if (sock->state != SS_UNCONNECTED)
470 return -EISCONN;
471 if ((tsock->p->published) ||
472 ((sock->type == SOCK_STREAM) && (total_len != 0)))
473 return -EOPNOTSUPP;
474 if (dest->addrtype == TIPC_ADDR_NAME) {
475 tsock->p->conn_type = dest->addr.name.name.type;
476 tsock->p->conn_instance = dest->addr.name.name.instance;
477 }
478 }
479
480 if (down_interruptible(&tsock->sem))
481 return -ERESTARTSYS;
482
483 if (needs_conn) {
484
485
486
487 while ((buf = skb_dequeue(&sock->sk->sk_receive_queue))) {
488 tipc_reject_msg(buf, TIPC_ERR_NO_PORT);
489 atomic_dec(&tipc_queue_size);
490 }
491
492 sock->state = SS_CONNECTING;
493 }
494
495 do {
496 if (dest->addrtype == TIPC_ADDR_NAME) {
497 if ((res = dest_name_check(dest, m)))
498 goto exit;
499 res = tipc_send2name(tsock->p->ref,
500 &dest->addr.name.name,
501 dest->addr.name.domain,
502 m->msg_iovlen,
503 m->msg_iov);
504 }
505 else if (dest->addrtype == TIPC_ADDR_ID) {
506 res = tipc_send2port(tsock->p->ref,
507 &dest->addr.id,
508 m->msg_iovlen,
509 m->msg_iov);
510 }
511 else if (dest->addrtype == TIPC_ADDR_MCAST) {
512 if (needs_conn) {
513 res = -EOPNOTSUPP;
514 goto exit;
515 }
516 if ((res = dest_name_check(dest, m)))
517 goto exit;
518 res = tipc_multicast(tsock->p->ref,
519 &dest->addr.nameseq,
520 0,
521 m->msg_iovlen,
522 m->msg_iov);
523 }
524 if (likely(res != -ELINKCONG)) {
525exit:
526 up(&tsock->sem);
527 return res;
528 }
529 if (m->msg_flags & MSG_DONTWAIT) {
530 res = -EWOULDBLOCK;
531 goto exit;
532 }
533 if (wait_event_interruptible(*sock->sk->sk_sleep,
534 !tsock->p->congested)) {
535 res = -ERESTARTSYS;
536 goto exit;
537 }
538 } while (1);
539}
540
541
542
543
544
545
546
547
548
549
550
551
552
553static int send_packet(struct kiocb *iocb, struct socket *sock,
554 struct msghdr *m, size_t total_len)
555{
556 struct tipc_sock *tsock = tipc_sk(sock->sk);
557 struct sockaddr_tipc *dest = (struct sockaddr_tipc *)m->msg_name;
558 int res;
559
560
561
562 if (unlikely(dest))
563 return send_msg(iocb, sock, m, total_len);
564
565 if (down_interruptible(&tsock->sem)) {
566 return -ERESTARTSYS;
567 }
568
569 do {
570 if (unlikely(sock->state != SS_CONNECTED)) {
571 if (sock->state == SS_DISCONNECTING)
572 res = -EPIPE;
573 else
574 res = -ENOTCONN;
575 goto exit;
576 }
577
578 res = tipc_send(tsock->p->ref, m->msg_iovlen, m->msg_iov);
579 if (likely(res != -ELINKCONG)) {
580exit:
581 up(&tsock->sem);
582 return res;
583 }
584 if (m->msg_flags & MSG_DONTWAIT) {
585 res = -EWOULDBLOCK;
586 goto exit;
587 }
588 if (wait_event_interruptible(*sock->sk->sk_sleep,
589 !tsock->p->congested)) {
590 res = -ERESTARTSYS;
591 goto exit;
592 }
593 } while (1);
594}
595
596
597
598
599
600
601
602
603
604
605
606
607
608
609
610static int send_stream(struct kiocb *iocb, struct socket *sock,
611 struct msghdr *m, size_t total_len)
612{
613 struct tipc_port *tport;
614 struct msghdr my_msg;
615 struct iovec my_iov;
616 struct iovec *curr_iov;
617 int curr_iovlen;
618 char __user *curr_start;
619 u32 hdr_size;
620 int curr_left;
621 int bytes_to_send;
622 int bytes_sent;
623 int res;
624
625
626
627 if (unlikely(sock->state != SS_CONNECTED)) {
628 if (sock->state == SS_UNCONNECTED)
629 return send_packet(iocb, sock, m, total_len);
630 else if (sock->state == SS_DISCONNECTING)
631 return -EPIPE;
632 else
633 return -ENOTCONN;
634 }
635
636 if (unlikely(m->msg_name))
637 return -EISCONN;
638
639
640
641
642
643
644
645
646
647 curr_iov = m->msg_iov;
648 curr_iovlen = m->msg_iovlen;
649 my_msg.msg_iov = &my_iov;
650 my_msg.msg_iovlen = 1;
651 my_msg.msg_flags = m->msg_flags;
652 my_msg.msg_name = NULL;
653 bytes_sent = 0;
654
655 tport = tipc_sk(sock->sk)->p;
656 hdr_size = msg_hdr_sz(&tport->phdr);
657
658 while (curr_iovlen--) {
659 curr_start = curr_iov->iov_base;
660 curr_left = curr_iov->iov_len;
661
662 while (curr_left) {
663 bytes_to_send = tport->max_pkt - hdr_size;
664 if (bytes_to_send > TIPC_MAX_USER_MSG_SIZE)
665 bytes_to_send = TIPC_MAX_USER_MSG_SIZE;
666 if (curr_left < bytes_to_send)
667 bytes_to_send = curr_left;
668 my_iov.iov_base = curr_start;
669 my_iov.iov_len = bytes_to_send;
670 if ((res = send_packet(iocb, sock, &my_msg, 0)) < 0) {
671 if (bytes_sent != 0)
672 res = bytes_sent;
673 return res;
674 }
675 curr_left -= bytes_to_send;
676 curr_start += bytes_to_send;
677 bytes_sent += bytes_to_send;
678 }
679
680 curr_iov++;
681 }
682
683 return bytes_sent;
684}
685
686
687
688
689
690
691
692
693
694
695static int auto_connect(struct socket *sock, struct tipc_sock *tsock,
696 struct tipc_msg *msg)
697{
698 struct tipc_portid peer;
699
700 if (msg_errcode(msg)) {
701 sock->state = SS_DISCONNECTING;
702 return -ECONNREFUSED;
703 }
704
705 peer.ref = msg_origport(msg);
706 peer.node = msg_orignode(msg);
707 tipc_connect2port(tsock->p->ref, &peer);
708 tipc_set_portimportance(tsock->p->ref, msg_importance(msg));
709 sock->state = SS_CONNECTED;
710 return 0;
711}
712
713
714
715
716
717
718
719
720
721static void set_orig_addr(struct msghdr *m, struct tipc_msg *msg)
722{
723 struct sockaddr_tipc *addr = (struct sockaddr_tipc *)m->msg_name;
724
725 if (addr) {
726 addr->family = AF_TIPC;
727 addr->addrtype = TIPC_ADDR_ID;
728 addr->addr.id.ref = msg_origport(msg);
729 addr->addr.id.node = msg_orignode(msg);
730 addr->addr.name.domain = 0;
731 addr->scope = 0;
732 m->msg_namelen = sizeof(struct sockaddr_tipc);
733 }
734}
735
736
737
738
739
740
741
742
743
744
745
746
747static int anc_data_recv(struct msghdr *m, struct tipc_msg *msg,
748 struct tipc_port *tport)
749{
750 u32 anc_data[3];
751 u32 err;
752 u32 dest_type;
753 int has_name;
754 int res;
755
756 if (likely(m->msg_controllen == 0))
757 return 0;
758
759
760
761 err = msg ? msg_errcode(msg) : 0;
762 if (unlikely(err)) {
763 anc_data[0] = err;
764 anc_data[1] = msg_data_sz(msg);
765 if ((res = put_cmsg(m, SOL_TIPC, TIPC_ERRINFO, 8, anc_data)))
766 return res;
767 if (anc_data[1] &&
768 (res = put_cmsg(m, SOL_TIPC, TIPC_RETDATA, anc_data[1],
769 msg_data(msg))))
770 return res;
771 }
772
773
774
775 dest_type = msg ? msg_type(msg) : TIPC_DIRECT_MSG;
776 switch (dest_type) {
777 case TIPC_NAMED_MSG:
778 has_name = 1;
779 anc_data[0] = msg_nametype(msg);
780 anc_data[1] = msg_namelower(msg);
781 anc_data[2] = msg_namelower(msg);
782 break;
783 case TIPC_MCAST_MSG:
784 has_name = 1;
785 anc_data[0] = msg_nametype(msg);
786 anc_data[1] = msg_namelower(msg);
787 anc_data[2] = msg_nameupper(msg);
788 break;
789 case TIPC_CONN_MSG:
790 has_name = (tport->conn_type != 0);
791 anc_data[0] = tport->conn_type;
792 anc_data[1] = tport->conn_instance;
793 anc_data[2] = tport->conn_instance;
794 break;
795 default:
796 has_name = 0;
797 }
798 if (has_name &&
799 (res = put_cmsg(m, SOL_TIPC, TIPC_DESTNAME, 12, anc_data)))
800 return res;
801
802 return 0;
803}
804
805
806
807
808
809
810
811
812
813
814
815
816
817
818static int recv_msg(struct kiocb *iocb, struct socket *sock,
819 struct msghdr *m, size_t buf_len, int flags)
820{
821 struct tipc_sock *tsock = tipc_sk(sock->sk);
822 struct sk_buff *buf;
823 struct tipc_msg *msg;
824 unsigned int q_len;
825 unsigned int sz;
826 u32 err;
827 int res;
828
829
830
831 if (m->msg_iovlen != 1)
832 return -EOPNOTSUPP;
833
834
835
836 if (unlikely(!buf_len))
837 return -EINVAL;
838
839 if (sock->type == SOCK_SEQPACKET) {
840 if (unlikely(sock->state == SS_UNCONNECTED))
841 return -ENOTCONN;
842 if (unlikely((sock->state == SS_DISCONNECTING) &&
843 (skb_queue_len(&sock->sk->sk_receive_queue) == 0)))
844 return -ENOTCONN;
845 }
846
847
848
849 if (unlikely(down_interruptible(&tsock->sem)))
850 return -ERESTARTSYS;
851
852restart:
853 if (unlikely((skb_queue_len(&sock->sk->sk_receive_queue) == 0) &&
854 (flags & MSG_DONTWAIT))) {
855 res = -EWOULDBLOCK;
856 goto exit;
857 }
858
859 if ((res = wait_event_interruptible(
860 *sock->sk->sk_sleep,
861 ((q_len = skb_queue_len(&sock->sk->sk_receive_queue)) ||
862 (sock->state == SS_DISCONNECTING))) )) {
863 goto exit;
864 }
865
866
867
868
869 if (!q_len) {
870 res = -ENOTCONN;
871 goto exit;
872 }
873
874
875
876 buf = skb_peek(&sock->sk->sk_receive_queue);
877 msg = buf_msg(buf);
878 sz = msg_data_sz(msg);
879 err = msg_errcode(msg);
880
881
882
883 if (unlikely(sock->state == SS_CONNECTING)) {
884 if ((res = auto_connect(sock, tsock, msg)))
885 goto exit;
886 }
887
888
889
890 if ((!sz) && (!err)) {
891 advance_queue(tsock);
892 goto restart;
893 }
894
895
896
897 set_orig_addr(m, msg);
898
899
900
901 if ((res = anc_data_recv(m, msg, tsock->p)))
902 goto exit;
903
904
905
906 if (!err) {
907 if (unlikely(buf_len < sz)) {
908 sz = buf_len;
909 m->msg_flags |= MSG_TRUNC;
910 }
911 if (unlikely(copy_to_user(m->msg_iov->iov_base, msg_data(msg),
912 sz))) {
913 res = -EFAULT;
914 goto exit;
915 }
916 res = sz;
917 } else {
918 if ((sock->state == SS_READY) ||
919 ((err == TIPC_CONN_SHUTDOWN) || m->msg_control))
920 res = 0;
921 else
922 res = -ECONNRESET;
923 }
924
925
926
927 if (likely(!(flags & MSG_PEEK))) {
928 if (unlikely(++tsock->p->conn_unacked >= TIPC_FLOW_CONTROL_WIN))
929 tipc_acknowledge(tsock->p->ref, tsock->p->conn_unacked);
930 advance_queue(tsock);
931 }
932exit:
933 up(&tsock->sem);
934 return res;
935}
936
937
938
939
940
941
942
943
944
945
946
947
948
949
950static int recv_stream(struct kiocb *iocb, struct socket *sock,
951 struct msghdr *m, size_t buf_len, int flags)
952{
953 struct tipc_sock *tsock = tipc_sk(sock->sk);
954 struct sk_buff *buf;
955 struct tipc_msg *msg;
956 unsigned int q_len;
957 unsigned int sz;
958 int sz_to_copy;
959 int sz_copied = 0;
960 int needed;
961 char __user *crs = m->msg_iov->iov_base;
962 unsigned char *buf_crs;
963 u32 err;
964 int res;
965
966
967
968 if (m->msg_iovlen != 1)
969 return -EOPNOTSUPP;
970
971
972
973 if (unlikely(!buf_len))
974 return -EINVAL;
975
976 if (unlikely(sock->state == SS_DISCONNECTING)) {
977 if (skb_queue_len(&sock->sk->sk_receive_queue) == 0)
978 return -ENOTCONN;
979 } else if (unlikely(sock->state != SS_CONNECTED))
980 return -ENOTCONN;
981
982
983
984 if (unlikely(down_interruptible(&tsock->sem)))
985 return -ERESTARTSYS;
986
987restart:
988 if (unlikely((skb_queue_len(&sock->sk->sk_receive_queue) == 0) &&
989 (flags & MSG_DONTWAIT))) {
990 res = -EWOULDBLOCK;
991 goto exit;
992 }
993
994 if ((res = wait_event_interruptible(
995 *sock->sk->sk_sleep,
996 ((q_len = skb_queue_len(&sock->sk->sk_receive_queue)) ||
997 (sock->state == SS_DISCONNECTING))) )) {
998 goto exit;
999 }
1000
1001
1002
1003
1004 if (!q_len) {
1005 res = -ENOTCONN;
1006 goto exit;
1007 }
1008
1009
1010
1011 buf = skb_peek(&sock->sk->sk_receive_queue);
1012 msg = buf_msg(buf);
1013 sz = msg_data_sz(msg);
1014 err = msg_errcode(msg);
1015
1016
1017
1018 if ((!sz) && (!err)) {
1019 advance_queue(tsock);
1020 goto restart;
1021 }
1022
1023
1024
1025 if (sz_copied == 0) {
1026 set_orig_addr(m, msg);
1027 if ((res = anc_data_recv(m, msg, tsock->p)))
1028 goto exit;
1029 }
1030
1031
1032
1033 if (!err) {
1034 buf_crs = (unsigned char *)(TIPC_SKB_CB(buf)->handle);
1035 sz = skb_tail_pointer(buf) - buf_crs;
1036
1037 needed = (buf_len - sz_copied);
1038 sz_to_copy = (sz <= needed) ? sz : needed;
1039 if (unlikely(copy_to_user(crs, buf_crs, sz_to_copy))) {
1040 res = -EFAULT;
1041 goto exit;
1042 }
1043 sz_copied += sz_to_copy;
1044
1045 if (sz_to_copy < sz) {
1046 if (!(flags & MSG_PEEK))
1047 TIPC_SKB_CB(buf)->handle = buf_crs + sz_to_copy;
1048 goto exit;
1049 }
1050
1051 crs += sz_to_copy;
1052 } else {
1053 if (sz_copied != 0)
1054 goto exit;
1055
1056 if ((err == TIPC_CONN_SHUTDOWN) || m->msg_control)
1057 res = 0;
1058 else
1059 res = -ECONNRESET;
1060 }
1061
1062
1063
1064 if (likely(!(flags & MSG_PEEK))) {
1065 if (unlikely(++tsock->p->conn_unacked >= TIPC_FLOW_CONTROL_WIN))
1066 tipc_acknowledge(tsock->p->ref, tsock->p->conn_unacked);
1067 advance_queue(tsock);
1068 }
1069
1070
1071
1072 if ((sz_copied < buf_len)
1073 && (flags & MSG_WAITALL)
1074 && (!(flags & MSG_PEEK))
1075 && (!err)
1076 )
1077 goto restart;
1078
1079exit:
1080 up(&tsock->sem);
1081 return sz_copied ? sz_copied : res;
1082}
1083
1084
1085
1086
1087
1088
1089
1090
1091
1092
1093static int queue_overloaded(u32 queue_size, u32 base, struct tipc_msg *msg)
1094{
1095 u32 threshold;
1096 u32 imp = msg_importance(msg);
1097
1098 if (imp == TIPC_LOW_IMPORTANCE)
1099 threshold = base;
1100 else if (imp == TIPC_MEDIUM_IMPORTANCE)
1101 threshold = base * 2;
1102 else if (imp == TIPC_HIGH_IMPORTANCE)
1103 threshold = base * 100;
1104 else
1105 return 0;
1106
1107 if (msg_connected(msg))
1108 threshold *= 4;
1109
1110 return (queue_size > threshold);
1111}
1112
1113
1114
1115
1116
1117
1118static void async_disconnect(unsigned long portref)
1119{
1120 tipc_disconnect((u32)portref);
1121}
1122
1123
1124
1125
1126
1127
1128
1129
1130
1131
1132
1133static u32 dispatch(struct tipc_port *tport, struct sk_buff *buf)
1134{
1135 struct tipc_msg *msg = buf_msg(buf);
1136 struct tipc_sock *tsock = (struct tipc_sock *)tport->usr_handle;
1137 struct socket *sock;
1138 u32 recv_q_len;
1139
1140
1141
1142 if (!tsock)
1143 return TIPC_ERR_NO_PORT;
1144
1145
1146
1147
1148
1149
1150
1151
1152 sock = tsock->sk.sk_socket;
1153 if (sock->state == SS_READY) {
1154 if (msg_connected(msg)) {
1155 msg_dbg(msg, "dispatch filter 1\n");
1156 return TIPC_ERR_NO_PORT;
1157 }
1158 } else {
1159 if (msg_mcast(msg)) {
1160 msg_dbg(msg, "dispatch filter 2\n");
1161 return TIPC_ERR_NO_PORT;
1162 }
1163 if (sock->state == SS_CONNECTED) {
1164 if (!msg_connected(msg)) {
1165 msg_dbg(msg, "dispatch filter 3\n");
1166 return TIPC_ERR_NO_PORT;
1167 }
1168 }
1169 else if (sock->state == SS_CONNECTING) {
1170 if (!msg_connected(msg) && (msg_errcode(msg) == 0)) {
1171 msg_dbg(msg, "dispatch filter 4\n");
1172 return TIPC_ERR_NO_PORT;
1173 }
1174 }
1175 else if (sock->state == SS_LISTENING) {
1176 if (msg_connected(msg) || msg_errcode(msg)) {
1177 msg_dbg(msg, "dispatch filter 5\n");
1178 return TIPC_ERR_NO_PORT;
1179 }
1180 }
1181 else if (sock->state == SS_DISCONNECTING) {
1182 msg_dbg(msg, "dispatch filter 6\n");
1183 return TIPC_ERR_NO_PORT;
1184 }
1185 else {
1186 if (msg_connected(msg) || msg_errcode(msg)) {
1187 msg_dbg(msg, "dispatch filter 7\n");
1188 return TIPC_ERR_NO_PORT;
1189 }
1190 }
1191 }
1192
1193
1194
1195 if (unlikely((u32)atomic_read(&tipc_queue_size) >
1196 OVERLOAD_LIMIT_BASE)) {
1197 if (queue_overloaded(atomic_read(&tipc_queue_size),
1198 OVERLOAD_LIMIT_BASE, msg))
1199 return TIPC_ERR_OVERLOAD;
1200 }
1201 recv_q_len = skb_queue_len(&tsock->sk.sk_receive_queue);
1202 if (unlikely(recv_q_len > (OVERLOAD_LIMIT_BASE / 2))) {
1203 if (queue_overloaded(recv_q_len,
1204 OVERLOAD_LIMIT_BASE / 2, msg))
1205 return TIPC_ERR_OVERLOAD;
1206 }
1207
1208
1209
1210 if (unlikely(msg_errcode(msg) && (sock->state == SS_CONNECTED))) {
1211 sock->state = SS_DISCONNECTING;
1212
1213 tipc_k_signal((Handler)async_disconnect, tport->ref);
1214 }
1215
1216
1217
1218 msg_dbg(msg,"<DISP<: ");
1219 TIPC_SKB_CB(buf)->handle = msg_data(msg);
1220 atomic_inc(&tipc_queue_size);
1221 skb_queue_tail(&sock->sk->sk_receive_queue, buf);
1222
1223 if (waitqueue_active(sock->sk->sk_sleep))
1224 wake_up_interruptible(sock->sk->sk_sleep);
1225 return TIPC_OK;
1226}
1227
1228
1229
1230
1231
1232
1233
1234
1235static void wakeupdispatch(struct tipc_port *tport)
1236{
1237 struct tipc_sock *tsock = (struct tipc_sock *)tport->usr_handle;
1238
1239 if (waitqueue_active(tsock->sk.sk_sleep))
1240 wake_up_interruptible(tsock->sk.sk_sleep);
1241}
1242
1243
1244
1245
1246
1247
1248
1249
1250
1251
1252
1253static int connect(struct socket *sock, struct sockaddr *dest, int destlen,
1254 int flags)
1255{
1256 struct tipc_sock *tsock = tipc_sk(sock->sk);
1257 struct sockaddr_tipc *dst = (struct sockaddr_tipc *)dest;
1258 struct msghdr m = {NULL,};
1259 struct sk_buff *buf;
1260 struct tipc_msg *msg;
1261 int res;
1262
1263
1264
1265 if (sock->state == SS_READY)
1266 return -EOPNOTSUPP;
1267
1268
1269
1270 if (sock->state == SS_LISTENING)
1271 return -EOPNOTSUPP;
1272 if (sock->state == SS_CONNECTING)
1273 return -EALREADY;
1274 if (sock->state != SS_UNCONNECTED)
1275 return -EISCONN;
1276
1277
1278
1279
1280
1281
1282
1283
1284 if (dst->addrtype == TIPC_ADDR_MCAST)
1285 return -EINVAL;
1286
1287
1288
1289 m.msg_name = dest;
1290 m.msg_namelen = destlen;
1291 if ((res = send_msg(NULL, sock, &m, 0)) < 0) {
1292 sock->state = SS_DISCONNECTING;
1293 return res;
1294 }
1295
1296 if (down_interruptible(&tsock->sem))
1297 return -ERESTARTSYS;
1298
1299
1300
1301 res = wait_event_interruptible_timeout(*sock->sk->sk_sleep,
1302 skb_queue_len(&sock->sk->sk_receive_queue),
1303 sock->sk->sk_rcvtimeo);
1304 buf = skb_peek(&sock->sk->sk_receive_queue);
1305 if (res > 0) {
1306 msg = buf_msg(buf);
1307 res = auto_connect(sock, tsock, msg);
1308 if (!res) {
1309 if (!msg_data_sz(msg))
1310 advance_queue(tsock);
1311 }
1312 } else {
1313 if (res == 0) {
1314 res = -ETIMEDOUT;
1315 } else
1316 { }
1317 sock->state = SS_DISCONNECTING;
1318 }
1319
1320 up(&tsock->sem);
1321 return res;
1322}
1323
1324
1325
1326
1327
1328
1329
1330
1331
1332static int listen(struct socket *sock, int len)
1333{
1334
1335
1336 if (sock->state == SS_READY)
1337 return -EOPNOTSUPP;
1338 if (sock->state != SS_UNCONNECTED)
1339 return -EINVAL;
1340 sock->state = SS_LISTENING;
1341 return 0;
1342}
1343
1344
1345
1346
1347
1348
1349
1350
1351
1352
1353static int accept(struct socket *sock, struct socket *newsock, int flags)
1354{
1355 struct tipc_sock *tsock = tipc_sk(sock->sk);
1356 struct sk_buff *buf;
1357 int res = -EFAULT;
1358
1359 if (sock->state == SS_READY)
1360 return -EOPNOTSUPP;
1361 if (sock->state != SS_LISTENING)
1362 return -EINVAL;
1363
1364 if (unlikely((skb_queue_len(&sock->sk->sk_receive_queue) == 0) &&
1365 (flags & O_NONBLOCK)))
1366 return -EWOULDBLOCK;
1367
1368 if (down_interruptible(&tsock->sem))
1369 return -ERESTARTSYS;
1370
1371 if (wait_event_interruptible(*sock->sk->sk_sleep,
1372 skb_queue_len(&sock->sk->sk_receive_queue))) {
1373 res = -ERESTARTSYS;
1374 goto exit;
1375 }
1376 buf = skb_peek(&sock->sk->sk_receive_queue);
1377
1378 res = tipc_create(sock->sk->sk_net, newsock, 0);
1379 if (!res) {
1380 struct tipc_sock *new_tsock = tipc_sk(newsock->sk);
1381 struct tipc_portid id;
1382 struct tipc_msg *msg = buf_msg(buf);
1383 u32 new_ref = new_tsock->p->ref;
1384
1385 id.ref = msg_origport(msg);
1386 id.node = msg_orignode(msg);
1387 tipc_connect2port(new_ref, &id);
1388 newsock->state = SS_CONNECTED;
1389
1390 tipc_set_portimportance(new_ref, msg_importance(msg));
1391 if (msg_named(msg)) {
1392 new_tsock->p->conn_type = msg_nametype(msg);
1393 new_tsock->p->conn_instance = msg_nameinst(msg);
1394 }
1395
1396
1397
1398
1399
1400
1401 msg_dbg(msg,"<ACC<: ");
1402 if (!msg_data_sz(msg)) {
1403 struct msghdr m = {NULL,};
1404
1405 send_packet(NULL, newsock, &m, 0);
1406 advance_queue(tsock);
1407 } else {
1408 sock_lock(tsock);
1409 skb_dequeue(&sock->sk->sk_receive_queue);
1410 sock_unlock(tsock);
1411 skb_queue_head(&newsock->sk->sk_receive_queue, buf);
1412 }
1413 }
1414exit:
1415 up(&tsock->sem);
1416 return res;
1417}
1418
1419
1420
1421
1422
1423
1424
1425
1426
1427
1428
1429static int shutdown(struct socket *sock, int how)
1430{
1431 struct tipc_sock* tsock = tipc_sk(sock->sk);
1432 struct sk_buff *buf;
1433 int res;
1434
1435
1436
1437 if (down_interruptible(&tsock->sem))
1438 return -ERESTARTSYS;
1439
1440 sock_lock(tsock);
1441
1442 switch (sock->state) {
1443 case SS_CONNECTED:
1444
1445
1446
1447 sock_unlock(tsock);
1448restart:
1449 if ((buf = skb_dequeue(&sock->sk->sk_receive_queue))) {
1450 atomic_dec(&tipc_queue_size);
1451 if (TIPC_SKB_CB(buf)->handle != msg_data(buf_msg(buf))) {
1452 buf_discard(buf);
1453 goto restart;
1454 }
1455 tipc_reject_msg(buf, TIPC_CONN_SHUTDOWN);
1456 }
1457 else {
1458 tipc_shutdown(tsock->p->ref);
1459 }
1460 sock_lock(tsock);
1461
1462
1463
1464 case SS_DISCONNECTING:
1465
1466
1467
1468 while ((buf = skb_dequeue(&sock->sk->sk_receive_queue))) {
1469 atomic_dec(&tipc_queue_size);
1470 buf_discard(buf);
1471 }
1472 tsock->p->conn_unacked = 0;
1473
1474
1475
1476 case SS_CONNECTING:
1477 sock->state = SS_DISCONNECTING;
1478 res = 0;
1479 break;
1480
1481 default:
1482 res = -ENOTCONN;
1483 }
1484
1485 sock_unlock(tsock);
1486
1487 up(&tsock->sem);
1488 return res;
1489}
1490
1491
1492
1493
1494
1495
1496
1497
1498
1499
1500
1501
1502
1503
1504
1505static int setsockopt(struct socket *sock,
1506 int lvl, int opt, char __user *ov, int ol)
1507{
1508 struct tipc_sock *tsock = tipc_sk(sock->sk);
1509 u32 value;
1510 int res;
1511
1512 if ((lvl == IPPROTO_TCP) && (sock->type == SOCK_STREAM))
1513 return 0;
1514 if (lvl != SOL_TIPC)
1515 return -ENOPROTOOPT;
1516 if (ol < sizeof(value))
1517 return -EINVAL;
1518 if ((res = get_user(value, (u32 __user *)ov)))
1519 return res;
1520
1521 if (down_interruptible(&tsock->sem))
1522 return -ERESTARTSYS;
1523
1524 switch (opt) {
1525 case TIPC_IMPORTANCE:
1526 res = tipc_set_portimportance(tsock->p->ref, value);
1527 break;
1528 case TIPC_SRC_DROPPABLE:
1529 if (sock->type != SOCK_STREAM)
1530 res = tipc_set_portunreliable(tsock->p->ref, value);
1531 else
1532 res = -ENOPROTOOPT;
1533 break;
1534 case TIPC_DEST_DROPPABLE:
1535 res = tipc_set_portunreturnable(tsock->p->ref, value);
1536 break;
1537 case TIPC_CONN_TIMEOUT:
1538 sock->sk->sk_rcvtimeo = (value * HZ / 1000);
1539 break;
1540 default:
1541 res = -EINVAL;
1542 }
1543
1544 up(&tsock->sem);
1545 return res;
1546}
1547
1548
1549
1550
1551
1552
1553
1554
1555
1556
1557
1558
1559
1560
1561
1562static int getsockopt(struct socket *sock,
1563 int lvl, int opt, char __user *ov, int __user *ol)
1564{
1565 struct tipc_sock *tsock = tipc_sk(sock->sk);
1566 int len;
1567 u32 value;
1568 int res;
1569
1570 if ((lvl == IPPROTO_TCP) && (sock->type == SOCK_STREAM))
1571 return put_user(0, ol);
1572 if (lvl != SOL_TIPC)
1573 return -ENOPROTOOPT;
1574 if ((res = get_user(len, ol)))
1575 return res;
1576
1577 if (down_interruptible(&tsock->sem))
1578 return -ERESTARTSYS;
1579
1580 switch (opt) {
1581 case TIPC_IMPORTANCE:
1582 res = tipc_portimportance(tsock->p->ref, &value);
1583 break;
1584 case TIPC_SRC_DROPPABLE:
1585 res = tipc_portunreliable(tsock->p->ref, &value);
1586 break;
1587 case TIPC_DEST_DROPPABLE:
1588 res = tipc_portunreturnable(tsock->p->ref, &value);
1589 break;
1590 case TIPC_CONN_TIMEOUT:
1591 value = (sock->sk->sk_rcvtimeo * 1000) / HZ;
1592 break;
1593 default:
1594 res = -EINVAL;
1595 }
1596
1597 if (res) {
1598
1599 }
1600 else if (len < sizeof(value)) {
1601 res = -EINVAL;
1602 }
1603 else if ((res = copy_to_user(ov, &value, sizeof(value)))) {
1604
1605 }
1606 else {
1607 res = put_user(sizeof(value), ol);
1608 }
1609
1610 up(&tsock->sem);
1611 return res;
1612}
1613
1614
1615
1616
1617
1618static struct proto_ops msg_ops = {
1619 .owner = THIS_MODULE,
1620 .family = AF_TIPC,
1621 .release = release,
1622 .bind = bind,
1623 .connect = connect,
1624 .socketpair = sock_no_socketpair,
1625 .accept = accept,
1626 .getname = get_name,
1627 .poll = poll,
1628 .ioctl = sock_no_ioctl,
1629 .listen = listen,
1630 .shutdown = shutdown,
1631 .setsockopt = setsockopt,
1632 .getsockopt = getsockopt,
1633 .sendmsg = send_msg,
1634 .recvmsg = recv_msg,
1635 .mmap = sock_no_mmap,
1636 .sendpage = sock_no_sendpage
1637};
1638
1639static struct proto_ops packet_ops = {
1640 .owner = THIS_MODULE,
1641 .family = AF_TIPC,
1642 .release = release,
1643 .bind = bind,
1644 .connect = connect,
1645 .socketpair = sock_no_socketpair,
1646 .accept = accept,
1647 .getname = get_name,
1648 .poll = poll,
1649 .ioctl = sock_no_ioctl,
1650 .listen = listen,
1651 .shutdown = shutdown,
1652 .setsockopt = setsockopt,
1653 .getsockopt = getsockopt,
1654 .sendmsg = send_packet,
1655 .recvmsg = recv_msg,
1656 .mmap = sock_no_mmap,
1657 .sendpage = sock_no_sendpage
1658};
1659
1660static struct proto_ops stream_ops = {
1661 .owner = THIS_MODULE,
1662 .family = AF_TIPC,
1663 .release = release,
1664 .bind = bind,
1665 .connect = connect,
1666 .socketpair = sock_no_socketpair,
1667 .accept = accept,
1668 .getname = get_name,
1669 .poll = poll,
1670 .ioctl = sock_no_ioctl,
1671 .listen = listen,
1672 .shutdown = shutdown,
1673 .setsockopt = setsockopt,
1674 .getsockopt = getsockopt,
1675 .sendmsg = send_stream,
1676 .recvmsg = recv_stream,
1677 .mmap = sock_no_mmap,
1678 .sendpage = sock_no_sendpage
1679};
1680
1681static struct net_proto_family tipc_family_ops = {
1682 .owner = THIS_MODULE,
1683 .family = AF_TIPC,
1684 .create = tipc_create
1685};
1686
1687static struct proto tipc_proto = {
1688 .name = "TIPC",
1689 .owner = THIS_MODULE,
1690 .obj_size = sizeof(struct tipc_sock)
1691};
1692
1693
1694
1695
1696
1697
1698int tipc_socket_init(void)
1699{
1700 int res;
1701
1702 res = proto_register(&tipc_proto, 1);
1703 if (res) {
1704 err("Failed to register TIPC protocol type\n");
1705 goto out;
1706 }
1707
1708 res = sock_register(&tipc_family_ops);
1709 if (res) {
1710 err("Failed to register TIPC socket type\n");
1711 proto_unregister(&tipc_proto);
1712 goto out;
1713 }
1714
1715 sockets_enabled = 1;
1716 out:
1717 return res;
1718}
1719
1720
1721
1722
1723void tipc_socket_stop(void)
1724{
1725 if (!sockets_enabled)
1726 return;
1727
1728 sockets_enabled = 0;
1729 sock_unregister(tipc_family_ops.family);
1730 proto_unregister(&tipc_proto);
1731}
1732
1733