GNU Linux-libre 4.9.309-gnu1
[releases.git] / net / llc / af_llc.c
1 /*
2  * af_llc.c - LLC User Interface SAPs
3  * Description:
4  *   Functions in this module are implementation of socket based llc
5  *   communications for the Linux operating system. Support of llc class
6  *   one and class two is provided via SOCK_DGRAM and SOCK_STREAM
7  *   respectively.
8  *
9  *   An llc2 connection is (mac + sap), only one llc2 sap connection
10  *   is allowed per mac. Though one sap may have multiple mac + sap
11  *   connections.
12  *
13  * Copyright (c) 2001 by Jay Schulist <jschlst@samba.org>
14  *               2002-2003 by Arnaldo Carvalho de Melo <acme@conectiva.com.br>
15  *
16  * This program can be redistributed or modified under the terms of the
17  * GNU General Public License as published by the Free Software Foundation.
18  * This program is distributed without any warranty or implied warranty
19  * of merchantability or fitness for a particular purpose.
20  *
21  * See the GNU General Public License for more details.
22  */
23 #include <linux/compiler.h>
24 #include <linux/kernel.h>
25 #include <linux/module.h>
26 #include <linux/rtnetlink.h>
27 #include <linux/init.h>
28 #include <linux/slab.h>
29 #include <net/llc.h>
30 #include <net/llc_sap.h>
31 #include <net/llc_pdu.h>
32 #include <net/llc_conn.h>
33 #include <net/tcp_states.h>
34
35 /* remember: uninitialized global data is zeroed because its in .bss */
36 static u16 llc_ui_sap_last_autoport = LLC_SAP_DYN_START;
37 static u16 llc_ui_sap_link_no_max[256];
38 static struct sockaddr_llc llc_ui_addrnull;
39 static const struct proto_ops llc_ui_ops;
40
41 static bool llc_ui_wait_for_conn(struct sock *sk, long timeout);
42 static int llc_ui_wait_for_disc(struct sock *sk, long timeout);
43 static int llc_ui_wait_for_busy_core(struct sock *sk, long timeout);
44
45 #if 0
46 #define dprintk(args...) printk(KERN_DEBUG args)
47 #else
48 #define dprintk(args...)
49 #endif
50
51 /* Maybe we'll add some more in the future. */
52 #define LLC_CMSG_PKTINFO        1
53
54
55 /**
56  *      llc_ui_next_link_no - return the next unused link number for a sap
57  *      @sap: Address of sap to get link number from.
58  *
59  *      Return the next unused link number for a given sap.
60  */
61 static inline u16 llc_ui_next_link_no(int sap)
62 {
63         return llc_ui_sap_link_no_max[sap]++;
64 }
65
66 /**
67  *      llc_proto_type - return eth protocol for ARP header type
68  *      @arphrd: ARP header type.
69  *
70  *      Given an ARP header type return the corresponding ethernet protocol.
71  */
72 static inline __be16 llc_proto_type(u16 arphrd)
73 {
74         return htons(ETH_P_802_2);
75 }
76
77 /**
78  *      llc_ui_addr_null - determines if a address structure is null
79  *      @addr: Address to test if null.
80  */
81 static inline u8 llc_ui_addr_null(struct sockaddr_llc *addr)
82 {
83         return !memcmp(addr, &llc_ui_addrnull, sizeof(*addr));
84 }
85
86 /**
87  *      llc_ui_header_len - return length of llc header based on operation
88  *      @sk: Socket which contains a valid llc socket type.
89  *      @addr: Complete sockaddr_llc structure received from the user.
90  *
91  *      Provide the length of the llc header depending on what kind of
92  *      operation the user would like to perform and the type of socket.
93  *      Returns the correct llc header length.
94  */
95 static inline u8 llc_ui_header_len(struct sock *sk, struct sockaddr_llc *addr)
96 {
97         u8 rc = LLC_PDU_LEN_U;
98
99         if (addr->sllc_test)
100                 rc = LLC_PDU_LEN_U;
101         else if (addr->sllc_xid)
102                 /* We need to expand header to sizeof(struct llc_xid_info)
103                  * since llc_pdu_init_as_xid_cmd() sets 4,5,6 bytes of LLC header
104                  * as XID PDU. In llc_ui_sendmsg() we reserved header size and then
105                  * filled all other space with user data. If we won't reserve this
106                  * bytes, llc_pdu_init_as_xid_cmd() will overwrite user data
107                  */
108                 rc = LLC_PDU_LEN_U_XID;
109         else if (sk->sk_type == SOCK_STREAM)
110                 rc = LLC_PDU_LEN_I;
111         return rc;
112 }
113
114 /**
115  *      llc_ui_send_data - send data via reliable llc2 connection
116  *      @sk: Connection the socket is using.
117  *      @skb: Data the user wishes to send.
118  *      @noblock: can we block waiting for data?
119  *
120  *      Send data via reliable llc2 connection.
121  *      Returns 0 upon success, non-zero if action did not succeed.
122  *
123  *      This function always consumes a reference to the skb.
124  */
125 static int llc_ui_send_data(struct sock* sk, struct sk_buff *skb, int noblock)
126 {
127         struct llc_sock* llc = llc_sk(sk);
128
129         if (unlikely(llc_data_accept_state(llc->state) ||
130                      llc->remote_busy_flag ||
131                      llc->p_flag)) {
132                 long timeout = sock_sndtimeo(sk, noblock);
133                 int rc;
134
135                 rc = llc_ui_wait_for_busy_core(sk, timeout);
136                 if (rc) {
137                         kfree_skb(skb);
138                         return rc;
139                 }
140         }
141         return llc_build_and_send_pkt(sk, skb);
142 }
143
144 static void llc_ui_sk_init(struct socket *sock, struct sock *sk)
145 {
146         sock_graft(sk, sock);
147         sk->sk_type     = sock->type;
148         sock->ops       = &llc_ui_ops;
149 }
150
151 static struct proto llc_proto = {
152         .name     = "LLC",
153         .owner    = THIS_MODULE,
154         .obj_size = sizeof(struct llc_sock),
155         .slab_flags = SLAB_DESTROY_BY_RCU,
156 };
157
158 /**
159  *      llc_ui_create - alloc and init a new llc_ui socket
160  *      @net: network namespace (must be default network)
161  *      @sock: Socket to initialize and attach allocated sk to.
162  *      @protocol: Unused.
163  *      @kern: on behalf of kernel or userspace
164  *
165  *      Allocate and initialize a new llc_ui socket, validate the user wants a
166  *      socket type we have available.
167  *      Returns 0 upon success, negative upon failure.
168  */
169 static int llc_ui_create(struct net *net, struct socket *sock, int protocol,
170                          int kern)
171 {
172         struct sock *sk;
173         int rc = -ESOCKTNOSUPPORT;
174
175         if (!ns_capable(net->user_ns, CAP_NET_RAW))
176                 return -EPERM;
177
178         if (!net_eq(net, &init_net))
179                 return -EAFNOSUPPORT;
180
181         if (likely(sock->type == SOCK_DGRAM || sock->type == SOCK_STREAM)) {
182                 rc = -ENOMEM;
183                 sk = llc_sk_alloc(net, PF_LLC, GFP_KERNEL, &llc_proto, kern);
184                 if (sk) {
185                         rc = 0;
186                         llc_ui_sk_init(sock, sk);
187                 }
188         }
189         return rc;
190 }
191
192 /**
193  *      llc_ui_release - shutdown socket
194  *      @sock: Socket to release.
195  *
196  *      Shutdown and deallocate an existing socket.
197  */
198 static int llc_ui_release(struct socket *sock)
199 {
200         struct sock *sk = sock->sk;
201         struct llc_sock *llc;
202
203         if (unlikely(sk == NULL))
204                 goto out;
205         sock_hold(sk);
206         lock_sock(sk);
207         llc = llc_sk(sk);
208         dprintk("%s: closing local(%02X) remote(%02X)\n", __func__,
209                 llc->laddr.lsap, llc->daddr.lsap);
210         if (!llc_send_disc(sk))
211                 llc_ui_wait_for_disc(sk, sk->sk_rcvtimeo);
212         if (!sock_flag(sk, SOCK_ZAPPED)) {
213                 struct llc_sap *sap = llc->sap;
214
215                 /* Hold this for release_sock(), so that llc_backlog_rcv()
216                  * could still use it.
217                  */
218                 llc_sap_hold(sap);
219                 llc_sap_remove_socket(llc->sap, sk);
220                 release_sock(sk);
221                 llc_sap_put(sap);
222         } else {
223                 release_sock(sk);
224         }
225         if (llc->dev)
226                 dev_put(llc->dev);
227         sock_put(sk);
228         llc_sk_free(sk);
229 out:
230         return 0;
231 }
232
233 /**
234  *      llc_ui_autoport - provide dynamically allocate SAP number
235  *
236  *      Provide the caller with a dynamically allocated SAP number according
237  *      to the rules that are set in this function. Returns: 0, upon failure,
238  *      SAP number otherwise.
239  */
240 static int llc_ui_autoport(void)
241 {
242         struct llc_sap *sap;
243         int i, tries = 0;
244
245         while (tries < LLC_SAP_DYN_TRIES) {
246                 for (i = llc_ui_sap_last_autoport;
247                      i < LLC_SAP_DYN_STOP; i += 2) {
248                         sap = llc_sap_find(i);
249                         if (!sap) {
250                                 llc_ui_sap_last_autoport = i + 2;
251                                 goto out;
252                         }
253                         llc_sap_put(sap);
254                 }
255                 llc_ui_sap_last_autoport = LLC_SAP_DYN_START;
256                 tries++;
257         }
258         i = 0;
259 out:
260         return i;
261 }
262
263 /**
264  *      llc_ui_autobind - automatically bind a socket to a sap
265  *      @sock: socket to bind
266  *      @addr: address to connect to
267  *
268  *      Used by llc_ui_connect and llc_ui_sendmsg when the user hasn't
269  *      specifically used llc_ui_bind to bind to an specific address/sap
270  *
271  *      Returns: 0 upon success, negative otherwise.
272  */
273 static int llc_ui_autobind(struct socket *sock, struct sockaddr_llc *addr)
274 {
275         struct sock *sk = sock->sk;
276         struct llc_sock *llc = llc_sk(sk);
277         struct net_device *dev = NULL;
278         struct llc_sap *sap;
279         int rc = -EINVAL;
280
281         if (!sock_flag(sk, SOCK_ZAPPED))
282                 goto out;
283         if (!addr->sllc_arphrd)
284                 addr->sllc_arphrd = ARPHRD_ETHER;
285         if (addr->sllc_arphrd != ARPHRD_ETHER)
286                 goto out;
287         rc = -ENODEV;
288         if (sk->sk_bound_dev_if) {
289                 dev = dev_get_by_index(&init_net, sk->sk_bound_dev_if);
290                 if (dev && addr->sllc_arphrd != dev->type) {
291                         dev_put(dev);
292                         dev = NULL;
293                 }
294         } else
295                 dev = dev_getfirstbyhwtype(&init_net, addr->sllc_arphrd);
296         if (!dev)
297                 goto out;
298         rc = -EUSERS;
299         llc->laddr.lsap = llc_ui_autoport();
300         if (!llc->laddr.lsap)
301                 goto out;
302         rc = -EBUSY; /* some other network layer is using the sap */
303         sap = llc_sap_open(llc->laddr.lsap, NULL);
304         if (!sap)
305                 goto out;
306
307         /* Note: We do not expect errors from this point. */
308         llc->dev = dev;
309         dev = NULL;
310
311         memcpy(llc->laddr.mac, llc->dev->dev_addr, IFHWADDRLEN);
312         memcpy(&llc->addr, addr, sizeof(llc->addr));
313         /* assign new connection to its SAP */
314         llc_sap_add_socket(sap, sk);
315         sock_reset_flag(sk, SOCK_ZAPPED);
316         rc = 0;
317 out:
318         dev_put(dev);
319         return rc;
320 }
321
322 /**
323  *      llc_ui_bind - bind a socket to a specific address.
324  *      @sock: Socket to bind an address to.
325  *      @uaddr: Address the user wants the socket bound to.
326  *      @addrlen: Length of the uaddr structure.
327  *
328  *      Bind a socket to a specific address. For llc a user is able to bind to
329  *      a specific sap only or mac + sap.
330  *      If the user desires to bind to a specific mac + sap, it is possible to
331  *      have multiple sap connections via multiple macs.
332  *      Bind and autobind for that matter must enforce the correct sap usage
333  *      otherwise all hell will break loose.
334  *      Returns: 0 upon success, negative otherwise.
335  */
336 static int llc_ui_bind(struct socket *sock, struct sockaddr *uaddr, int addrlen)
337 {
338         struct sockaddr_llc *addr = (struct sockaddr_llc *)uaddr;
339         struct sock *sk = sock->sk;
340         struct llc_sock *llc = llc_sk(sk);
341         struct net_device *dev = NULL;
342         struct llc_sap *sap;
343         int rc = -EINVAL;
344
345         dprintk("%s: binding %02X\n", __func__, addr->sllc_sap);
346
347         lock_sock(sk);
348         if (unlikely(!sock_flag(sk, SOCK_ZAPPED) || addrlen != sizeof(*addr)))
349                 goto out;
350         rc = -EAFNOSUPPORT;
351         if (!addr->sllc_arphrd)
352                 addr->sllc_arphrd = ARPHRD_ETHER;
353         if (unlikely(addr->sllc_family != AF_LLC || addr->sllc_arphrd != ARPHRD_ETHER))
354                 goto out;
355         rc = -ENODEV;
356         rcu_read_lock();
357         if (sk->sk_bound_dev_if) {
358                 dev = dev_get_by_index_rcu(&init_net, sk->sk_bound_dev_if);
359                 if (dev) {
360                         if (is_zero_ether_addr(addr->sllc_mac))
361                                 memcpy(addr->sllc_mac, dev->dev_addr,
362                                        IFHWADDRLEN);
363                         if (addr->sllc_arphrd != dev->type ||
364                             !ether_addr_equal(addr->sllc_mac,
365                                               dev->dev_addr)) {
366                                 rc = -EINVAL;
367                                 dev = NULL;
368                         }
369                 }
370         } else {
371                 dev = dev_getbyhwaddr_rcu(&init_net, addr->sllc_arphrd,
372                                            addr->sllc_mac);
373         }
374         if (dev)
375                 dev_hold(dev);
376         rcu_read_unlock();
377         if (!dev)
378                 goto out;
379         if (!addr->sllc_sap) {
380                 rc = -EUSERS;
381                 addr->sllc_sap = llc_ui_autoport();
382                 if (!addr->sllc_sap)
383                         goto out;
384         }
385         sap = llc_sap_find(addr->sllc_sap);
386         if (!sap) {
387                 sap = llc_sap_open(addr->sllc_sap, NULL);
388                 rc = -EBUSY; /* some other network layer is using the sap */
389                 if (!sap)
390                         goto out;
391         } else {
392                 struct llc_addr laddr, daddr;
393                 struct sock *ask;
394
395                 memset(&laddr, 0, sizeof(laddr));
396                 memset(&daddr, 0, sizeof(daddr));
397                 /*
398                  * FIXME: check if the address is multicast,
399                  *        only SOCK_DGRAM can do this.
400                  */
401                 memcpy(laddr.mac, addr->sllc_mac, IFHWADDRLEN);
402                 laddr.lsap = addr->sllc_sap;
403                 rc = -EADDRINUSE; /* mac + sap clash. */
404                 ask = llc_lookup_established(sap, &daddr, &laddr);
405                 if (ask) {
406                         sock_put(ask);
407                         goto out_put;
408                 }
409         }
410
411         /* Note: We do not expect errors from this point. */
412         llc->dev = dev;
413         dev = NULL;
414
415         llc->laddr.lsap = addr->sllc_sap;
416         memcpy(llc->laddr.mac, addr->sllc_mac, IFHWADDRLEN);
417         memcpy(&llc->addr, addr, sizeof(llc->addr));
418         /* assign new connection to its SAP */
419         llc_sap_add_socket(sap, sk);
420         sock_reset_flag(sk, SOCK_ZAPPED);
421         rc = 0;
422 out_put:
423         llc_sap_put(sap);
424 out:
425         dev_put(dev);
426         release_sock(sk);
427         return rc;
428 }
429
430 /**
431  *      llc_ui_shutdown - shutdown a connect llc2 socket.
432  *      @sock: Socket to shutdown.
433  *      @how: What part of the socket to shutdown.
434  *
435  *      Shutdown a connected llc2 socket. Currently this function only supports
436  *      shutting down both sends and receives (2), we could probably make this
437  *      function such that a user can shutdown only half the connection but not
438  *      right now.
439  *      Returns: 0 upon success, negative otherwise.
440  */
441 static int llc_ui_shutdown(struct socket *sock, int how)
442 {
443         struct sock *sk = sock->sk;
444         int rc = -ENOTCONN;
445
446         lock_sock(sk);
447         if (unlikely(sk->sk_state != TCP_ESTABLISHED))
448                 goto out;
449         rc = -EINVAL;
450         if (how != 2)
451                 goto out;
452         rc = llc_send_disc(sk);
453         if (!rc)
454                 rc = llc_ui_wait_for_disc(sk, sk->sk_rcvtimeo);
455         /* Wake up anyone sleeping in poll */
456         sk->sk_state_change(sk);
457 out:
458         release_sock(sk);
459         return rc;
460 }
461
462 /**
463  *      llc_ui_connect - Connect to a remote llc2 mac + sap.
464  *      @sock: Socket which will be connected to the remote destination.
465  *      @uaddr: Remote and possibly the local address of the new connection.
466  *      @addrlen: Size of uaddr structure.
467  *      @flags: Operational flags specified by the user.
468  *
469  *      Connect to a remote llc2 mac + sap. The caller must specify the
470  *      destination mac and address to connect to. If the user hasn't previously
471  *      called bind(2) with a smac the address of the first interface of the
472  *      specified arp type will be used.
473  *      This function will autobind if user did not previously call bind.
474  *      Returns: 0 upon success, negative otherwise.
475  */
476 static int llc_ui_connect(struct socket *sock, struct sockaddr *uaddr,
477                           int addrlen, int flags)
478 {
479         struct sock *sk = sock->sk;
480         struct llc_sock *llc = llc_sk(sk);
481         struct sockaddr_llc *addr = (struct sockaddr_llc *)uaddr;
482         int rc = -EINVAL;
483
484         lock_sock(sk);
485         if (unlikely(addrlen != sizeof(*addr)))
486                 goto out;
487         rc = -EAFNOSUPPORT;
488         if (unlikely(addr->sllc_family != AF_LLC))
489                 goto out;
490         if (unlikely(sk->sk_type != SOCK_STREAM))
491                 goto out;
492         rc = -EALREADY;
493         if (unlikely(sock->state == SS_CONNECTING))
494                 goto out;
495         /* bind connection to sap if user hasn't done it. */
496         if (sock_flag(sk, SOCK_ZAPPED)) {
497                 /* bind to sap with null dev, exclusive */
498                 rc = llc_ui_autobind(sock, addr);
499                 if (rc)
500                         goto out;
501         }
502         llc->daddr.lsap = addr->sllc_sap;
503         memcpy(llc->daddr.mac, addr->sllc_mac, IFHWADDRLEN);
504         sock->state = SS_CONNECTING;
505         sk->sk_state   = TCP_SYN_SENT;
506         llc->link   = llc_ui_next_link_no(llc->sap->laddr.lsap);
507         rc = llc_establish_connection(sk, llc->dev->dev_addr,
508                                       addr->sllc_mac, addr->sllc_sap);
509         if (rc) {
510                 dprintk("%s: llc_ui_send_conn failed :-(\n", __func__);
511                 sock->state  = SS_UNCONNECTED;
512                 sk->sk_state = TCP_CLOSE;
513                 goto out;
514         }
515
516         if (sk->sk_state == TCP_SYN_SENT) {
517                 const long timeo = sock_sndtimeo(sk, flags & O_NONBLOCK);
518
519                 if (!timeo || !llc_ui_wait_for_conn(sk, timeo))
520                         goto out;
521
522                 rc = sock_intr_errno(timeo);
523                 if (signal_pending(current))
524                         goto out;
525         }
526
527         if (sk->sk_state == TCP_CLOSE)
528                 goto sock_error;
529
530         sock->state = SS_CONNECTED;
531         rc = 0;
532 out:
533         release_sock(sk);
534         return rc;
535 sock_error:
536         rc = sock_error(sk) ? : -ECONNABORTED;
537         sock->state = SS_UNCONNECTED;
538         goto out;
539 }
540
541 /**
542  *      llc_ui_listen - allow a normal socket to accept incoming connections
543  *      @sock: Socket to allow incoming connections on.
544  *      @backlog: Number of connections to queue.
545  *
546  *      Allow a normal socket to accept incoming connections.
547  *      Returns 0 upon success, negative otherwise.
548  */
549 static int llc_ui_listen(struct socket *sock, int backlog)
550 {
551         struct sock *sk = sock->sk;
552         int rc = -EINVAL;
553
554         lock_sock(sk);
555         if (unlikely(sock->state != SS_UNCONNECTED))
556                 goto out;
557         rc = -EOPNOTSUPP;
558         if (unlikely(sk->sk_type != SOCK_STREAM))
559                 goto out;
560         rc = -EAGAIN;
561         if (sock_flag(sk, SOCK_ZAPPED))
562                 goto out;
563         rc = 0;
564         if (!(unsigned int)backlog)     /* BSDism */
565                 backlog = 1;
566         sk->sk_max_ack_backlog = backlog;
567         if (sk->sk_state != TCP_LISTEN) {
568                 sk->sk_ack_backlog = 0;
569                 sk->sk_state       = TCP_LISTEN;
570         }
571         sk->sk_socket->flags |= __SO_ACCEPTCON;
572 out:
573         release_sock(sk);
574         return rc;
575 }
576
577 static int llc_ui_wait_for_disc(struct sock *sk, long timeout)
578 {
579         DEFINE_WAIT(wait);
580         int rc = 0;
581
582         while (1) {
583                 prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
584                 if (sk_wait_event(sk, &timeout, sk->sk_state == TCP_CLOSE))
585                         break;
586                 rc = -ERESTARTSYS;
587                 if (signal_pending(current))
588                         break;
589                 rc = -EAGAIN;
590                 if (!timeout)
591                         break;
592                 rc = 0;
593         }
594         finish_wait(sk_sleep(sk), &wait);
595         return rc;
596 }
597
598 static bool llc_ui_wait_for_conn(struct sock *sk, long timeout)
599 {
600         DEFINE_WAIT(wait);
601
602         while (1) {
603                 prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
604                 if (sk_wait_event(sk, &timeout, sk->sk_state != TCP_SYN_SENT))
605                         break;
606                 if (signal_pending(current) || !timeout)
607                         break;
608         }
609         finish_wait(sk_sleep(sk), &wait);
610         return timeout;
611 }
612
613 static int llc_ui_wait_for_busy_core(struct sock *sk, long timeout)
614 {
615         DEFINE_WAIT(wait);
616         struct llc_sock *llc = llc_sk(sk);
617         int rc;
618
619         while (1) {
620                 prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
621                 rc = 0;
622                 if (sk_wait_event(sk, &timeout,
623                                   (sk->sk_shutdown & RCV_SHUTDOWN) ||
624                                   (!llc_data_accept_state(llc->state) &&
625                                    !llc->remote_busy_flag &&
626                                    !llc->p_flag)))
627                         break;
628                 rc = -ERESTARTSYS;
629                 if (signal_pending(current))
630                         break;
631                 rc = -EAGAIN;
632                 if (!timeout)
633                         break;
634         }
635         finish_wait(sk_sleep(sk), &wait);
636         return rc;
637 }
638
639 static int llc_wait_data(struct sock *sk, long timeo)
640 {
641         int rc;
642
643         while (1) {
644                 /*
645                  * POSIX 1003.1g mandates this order.
646                  */
647                 rc = sock_error(sk);
648                 if (rc)
649                         break;
650                 rc = 0;
651                 if (sk->sk_shutdown & RCV_SHUTDOWN)
652                         break;
653                 rc = -EAGAIN;
654                 if (!timeo)
655                         break;
656                 rc = sock_intr_errno(timeo);
657                 if (signal_pending(current))
658                         break;
659                 rc = 0;
660                 if (sk_wait_data(sk, &timeo, NULL))
661                         break;
662         }
663         return rc;
664 }
665
666 static void llc_cmsg_rcv(struct msghdr *msg, struct sk_buff *skb)
667 {
668         struct llc_sock *llc = llc_sk(skb->sk);
669
670         if (llc->cmsg_flags & LLC_CMSG_PKTINFO) {
671                 struct llc_pktinfo info;
672
673                 memset(&info, 0, sizeof(info));
674                 info.lpi_ifindex = llc_sk(skb->sk)->dev->ifindex;
675                 llc_pdu_decode_dsap(skb, &info.lpi_sap);
676                 llc_pdu_decode_da(skb, info.lpi_mac);
677                 put_cmsg(msg, SOL_LLC, LLC_OPT_PKTINFO, sizeof(info), &info);
678         }
679 }
680
681 /**
682  *      llc_ui_accept - accept a new incoming connection.
683  *      @sock: Socket which connections arrive on.
684  *      @newsock: Socket to move incoming connection to.
685  *      @flags: User specified operational flags.
686  *
687  *      Accept a new incoming connection.
688  *      Returns 0 upon success, negative otherwise.
689  */
690 static int llc_ui_accept(struct socket *sock, struct socket *newsock, int flags)
691 {
692         struct sock *sk = sock->sk, *newsk;
693         struct llc_sock *llc, *newllc;
694         struct sk_buff *skb;
695         int rc = -EOPNOTSUPP;
696
697         dprintk("%s: accepting on %02X\n", __func__,
698                 llc_sk(sk)->laddr.lsap);
699         lock_sock(sk);
700         if (unlikely(sk->sk_type != SOCK_STREAM))
701                 goto out;
702         rc = -EINVAL;
703         if (unlikely(sock->state != SS_UNCONNECTED ||
704                      sk->sk_state != TCP_LISTEN))
705                 goto out;
706         /* wait for a connection to arrive. */
707         if (skb_queue_empty(&sk->sk_receive_queue)) {
708                 rc = llc_wait_data(sk, sk->sk_rcvtimeo);
709                 if (rc)
710                         goto out;
711         }
712         dprintk("%s: got a new connection on %02X\n", __func__,
713                 llc_sk(sk)->laddr.lsap);
714         skb = skb_dequeue(&sk->sk_receive_queue);
715         rc = -EINVAL;
716         if (!skb->sk)
717                 goto frees;
718         rc = 0;
719         newsk = skb->sk;
720         /* attach connection to a new socket. */
721         llc_ui_sk_init(newsock, newsk);
722         sock_reset_flag(newsk, SOCK_ZAPPED);
723         newsk->sk_state         = TCP_ESTABLISHED;
724         newsock->state          = SS_CONNECTED;
725         llc                     = llc_sk(sk);
726         newllc                  = llc_sk(newsk);
727         memcpy(&newllc->addr, &llc->addr, sizeof(newllc->addr));
728         newllc->link = llc_ui_next_link_no(newllc->laddr.lsap);
729
730         /* put original socket back into a clean listen state. */
731         sk->sk_state = TCP_LISTEN;
732         sk->sk_ack_backlog--;
733         dprintk("%s: ok success on %02X, client on %02X\n", __func__,
734                 llc_sk(sk)->addr.sllc_sap, newllc->daddr.lsap);
735 frees:
736         kfree_skb(skb);
737 out:
738         release_sock(sk);
739         return rc;
740 }
741
742 /**
743  *      llc_ui_recvmsg - copy received data to the socket user.
744  *      @sock: Socket to copy data from.
745  *      @msg: Various user space related information.
746  *      @len: Size of user buffer.
747  *      @flags: User specified flags.
748  *
749  *      Copy received data to the socket user.
750  *      Returns non-negative upon success, negative otherwise.
751  */
752 static int llc_ui_recvmsg(struct socket *sock, struct msghdr *msg, size_t len,
753                           int flags)
754 {
755         DECLARE_SOCKADDR(struct sockaddr_llc *, uaddr, msg->msg_name);
756         const int nonblock = flags & MSG_DONTWAIT;
757         struct sk_buff *skb = NULL;
758         struct sock *sk = sock->sk;
759         struct llc_sock *llc = llc_sk(sk);
760         size_t copied = 0;
761         u32 peek_seq = 0;
762         u32 *seq, skb_len;
763         unsigned long used;
764         int target;     /* Read at least this many bytes */
765         long timeo;
766
767         lock_sock(sk);
768         copied = -ENOTCONN;
769         if (unlikely(sk->sk_type == SOCK_STREAM && sk->sk_state == TCP_LISTEN))
770                 goto out;
771
772         timeo = sock_rcvtimeo(sk, nonblock);
773
774         seq = &llc->copied_seq;
775         if (flags & MSG_PEEK) {
776                 peek_seq = llc->copied_seq;
777                 seq = &peek_seq;
778         }
779
780         target = sock_rcvlowat(sk, flags & MSG_WAITALL, len);
781         copied = 0;
782
783         do {
784                 u32 offset;
785
786                 /*
787                  * We need to check signals first, to get correct SIGURG
788                  * handling. FIXME: Need to check this doesn't impact 1003.1g
789                  * and move it down to the bottom of the loop
790                  */
791                 if (signal_pending(current)) {
792                         if (copied)
793                                 break;
794                         copied = timeo ? sock_intr_errno(timeo) : -EAGAIN;
795                         break;
796                 }
797
798                 /* Next get a buffer. */
799
800                 skb = skb_peek(&sk->sk_receive_queue);
801                 if (skb) {
802                         offset = *seq;
803                         goto found_ok_skb;
804                 }
805                 /* Well, if we have backlog, try to process it now yet. */
806
807                 if (copied >= target && !sk->sk_backlog.tail)
808                         break;
809
810                 if (copied) {
811                         if (sk->sk_err ||
812                             sk->sk_state == TCP_CLOSE ||
813                             (sk->sk_shutdown & RCV_SHUTDOWN) ||
814                             !timeo ||
815                             (flags & MSG_PEEK))
816                                 break;
817                 } else {
818                         if (sock_flag(sk, SOCK_DONE))
819                                 break;
820
821                         if (sk->sk_err) {
822                                 copied = sock_error(sk);
823                                 break;
824                         }
825                         if (sk->sk_shutdown & RCV_SHUTDOWN)
826                                 break;
827
828                         if (sk->sk_type == SOCK_STREAM && sk->sk_state == TCP_CLOSE) {
829                                 if (!sock_flag(sk, SOCK_DONE)) {
830                                         /*
831                                          * This occurs when user tries to read
832                                          * from never connected socket.
833                                          */
834                                         copied = -ENOTCONN;
835                                         break;
836                                 }
837                                 break;
838                         }
839                         if (!timeo) {
840                                 copied = -EAGAIN;
841                                 break;
842                         }
843                 }
844
845                 if (copied >= target) { /* Do not sleep, just process backlog. */
846                         release_sock(sk);
847                         lock_sock(sk);
848                 } else
849                         sk_wait_data(sk, &timeo, NULL);
850
851                 if ((flags & MSG_PEEK) && peek_seq != llc->copied_seq) {
852                         net_dbg_ratelimited("LLC(%s:%d): Application bug, race in MSG_PEEK\n",
853                                             current->comm,
854                                             task_pid_nr(current));
855                         peek_seq = llc->copied_seq;
856                 }
857                 continue;
858         found_ok_skb:
859                 skb_len = skb->len;
860                 /* Ok so how much can we use? */
861                 used = skb->len - offset;
862                 if (len < used)
863                         used = len;
864
865                 if (!(flags & MSG_TRUNC)) {
866                         int rc = skb_copy_datagram_msg(skb, offset, msg, used);
867                         if (rc) {
868                                 /* Exception. Bailout! */
869                                 if (!copied)
870                                         copied = -EFAULT;
871                                 break;
872                         }
873                 }
874
875                 *seq += used;
876                 copied += used;
877                 len -= used;
878
879                 /* For non stream protcols we get one packet per recvmsg call */
880                 if (sk->sk_type != SOCK_STREAM)
881                         goto copy_uaddr;
882
883                 if (!(flags & MSG_PEEK)) {
884                         skb_unlink(skb, &sk->sk_receive_queue);
885                         kfree_skb(skb);
886                         *seq = 0;
887                 }
888
889                 /* Partial read */
890                 if (used + offset < skb_len)
891                         continue;
892         } while (len > 0);
893
894 out:
895         release_sock(sk);
896         return copied;
897 copy_uaddr:
898         if (uaddr != NULL && skb != NULL) {
899                 memcpy(uaddr, llc_ui_skb_cb(skb), sizeof(*uaddr));
900                 msg->msg_namelen = sizeof(*uaddr);
901         }
902         if (llc_sk(sk)->cmsg_flags)
903                 llc_cmsg_rcv(msg, skb);
904
905         if (!(flags & MSG_PEEK)) {
906                 skb_unlink(skb, &sk->sk_receive_queue);
907                 kfree_skb(skb);
908                 *seq = 0;
909         }
910
911         goto out;
912 }
913
914 /**
915  *      llc_ui_sendmsg - Transmit data provided by the socket user.
916  *      @sock: Socket to transmit data from.
917  *      @msg: Various user related information.
918  *      @len: Length of data to transmit.
919  *
920  *      Transmit data provided by the socket user.
921  *      Returns non-negative upon success, negative otherwise.
922  */
923 static int llc_ui_sendmsg(struct socket *sock, struct msghdr *msg, size_t len)
924 {
925         struct sock *sk = sock->sk;
926         struct llc_sock *llc = llc_sk(sk);
927         DECLARE_SOCKADDR(struct sockaddr_llc *, addr, msg->msg_name);
928         int flags = msg->msg_flags;
929         int noblock = flags & MSG_DONTWAIT;
930         struct sk_buff *skb = NULL;
931         size_t size = 0;
932         int rc = -EINVAL, copied = 0, hdrlen;
933
934         dprintk("%s: sending from %02X to %02X\n", __func__,
935                 llc->laddr.lsap, llc->daddr.lsap);
936         lock_sock(sk);
937         if (addr) {
938                 if (msg->msg_namelen < sizeof(*addr))
939                         goto out;
940         } else {
941                 if (llc_ui_addr_null(&llc->addr))
942                         goto out;
943                 addr = &llc->addr;
944         }
945         /* must bind connection to sap if user hasn't done it. */
946         if (sock_flag(sk, SOCK_ZAPPED)) {
947                 /* bind to sap with null dev, exclusive. */
948                 rc = llc_ui_autobind(sock, addr);
949                 if (rc)
950                         goto out;
951         }
952         hdrlen = llc->dev->hard_header_len + llc_ui_header_len(sk, addr);
953         size = hdrlen + len;
954         if (size > llc->dev->mtu)
955                 size = llc->dev->mtu;
956         copied = size - hdrlen;
957         rc = -EINVAL;
958         if (copied < 0)
959                 goto out;
960         release_sock(sk);
961         skb = sock_alloc_send_skb(sk, size, noblock, &rc);
962         lock_sock(sk);
963         if (!skb)
964                 goto out;
965         skb->dev      = llc->dev;
966         skb->protocol = llc_proto_type(addr->sllc_arphrd);
967         skb_reserve(skb, hdrlen);
968         rc = memcpy_from_msg(skb_put(skb, copied), msg, copied);
969         if (rc)
970                 goto out;
971         if (sk->sk_type == SOCK_DGRAM || addr->sllc_ua) {
972                 llc_build_and_send_ui_pkt(llc->sap, skb, addr->sllc_mac,
973                                           addr->sllc_sap);
974                 skb = NULL;
975                 goto out;
976         }
977         if (addr->sllc_test) {
978                 llc_build_and_send_test_pkt(llc->sap, skb, addr->sllc_mac,
979                                             addr->sllc_sap);
980                 skb = NULL;
981                 goto out;
982         }
983         if (addr->sllc_xid) {
984                 llc_build_and_send_xid_pkt(llc->sap, skb, addr->sllc_mac,
985                                            addr->sllc_sap);
986                 skb = NULL;
987                 goto out;
988         }
989         rc = -ENOPROTOOPT;
990         if (!(sk->sk_type == SOCK_STREAM && !addr->sllc_ua))
991                 goto out;
992         rc = llc_ui_send_data(sk, skb, noblock);
993         skb = NULL;
994 out:
995         kfree_skb(skb);
996         if (rc)
997                 dprintk("%s: failed sending from %02X to %02X: %d\n",
998                         __func__, llc->laddr.lsap, llc->daddr.lsap, rc);
999         release_sock(sk);
1000         return rc ? : copied;
1001 }
1002
1003 /**
1004  *      llc_ui_getname - return the address info of a socket
1005  *      @sock: Socket to get address of.
1006  *      @uaddr: Address structure to return information.
1007  *      @uaddrlen: Length of address structure.
1008  *      @peer: Does user want local or remote address information.
1009  *
1010  *      Return the address information of a socket.
1011  */
1012 static int llc_ui_getname(struct socket *sock, struct sockaddr *uaddr,
1013                           int *uaddrlen, int peer)
1014 {
1015         struct sockaddr_llc sllc;
1016         struct sock *sk = sock->sk;
1017         struct llc_sock *llc = llc_sk(sk);
1018         int rc = -EBADF;
1019
1020         memset(&sllc, 0, sizeof(sllc));
1021         lock_sock(sk);
1022         if (sock_flag(sk, SOCK_ZAPPED))
1023                 goto out;
1024         *uaddrlen = sizeof(sllc);
1025         if (peer) {
1026                 rc = -ENOTCONN;
1027                 if (sk->sk_state != TCP_ESTABLISHED)
1028                         goto out;
1029                 if(llc->dev)
1030                         sllc.sllc_arphrd = llc->dev->type;
1031                 sllc.sllc_sap = llc->daddr.lsap;
1032                 memcpy(&sllc.sllc_mac, &llc->daddr.mac, IFHWADDRLEN);
1033         } else {
1034                 rc = -EINVAL;
1035                 if (!llc->sap)
1036                         goto out;
1037                 sllc.sllc_sap = llc->sap->laddr.lsap;
1038
1039                 if (llc->dev) {
1040                         sllc.sllc_arphrd = llc->dev->type;
1041                         memcpy(&sllc.sllc_mac, llc->dev->dev_addr,
1042                                IFHWADDRLEN);
1043                 }
1044         }
1045         rc = 0;
1046         sllc.sllc_family = AF_LLC;
1047         memcpy(uaddr, &sllc, sizeof(sllc));
1048 out:
1049         release_sock(sk);
1050         return rc;
1051 }
1052
1053 /**
1054  *      llc_ui_ioctl - io controls for PF_LLC
1055  *      @sock: Socket to get/set info
1056  *      @cmd: command
1057  *      @arg: optional argument for cmd
1058  *
1059  *      get/set info on llc sockets
1060  */
1061 static int llc_ui_ioctl(struct socket *sock, unsigned int cmd,
1062                         unsigned long arg)
1063 {
1064         return -ENOIOCTLCMD;
1065 }
1066
1067 /**
1068  *      llc_ui_setsockopt - set various connection specific parameters.
1069  *      @sock: Socket to set options on.
1070  *      @level: Socket level user is requesting operations on.
1071  *      @optname: Operation name.
1072  *      @optval: User provided operation data.
1073  *      @optlen: Length of optval.
1074  *
1075  *      Set various connection specific parameters.
1076  */
1077 static int llc_ui_setsockopt(struct socket *sock, int level, int optname,
1078                              char __user *optval, unsigned int optlen)
1079 {
1080         struct sock *sk = sock->sk;
1081         struct llc_sock *llc = llc_sk(sk);
1082         unsigned int opt;
1083         int rc = -EINVAL;
1084
1085         lock_sock(sk);
1086         if (unlikely(level != SOL_LLC || optlen != sizeof(int)))
1087                 goto out;
1088         rc = get_user(opt, (int __user *)optval);
1089         if (rc)
1090                 goto out;
1091         rc = -EINVAL;
1092         switch (optname) {
1093         case LLC_OPT_RETRY:
1094                 if (opt > LLC_OPT_MAX_RETRY)
1095                         goto out;
1096                 llc->n2 = opt;
1097                 break;
1098         case LLC_OPT_SIZE:
1099                 if (opt > LLC_OPT_MAX_SIZE)
1100                         goto out;
1101                 llc->n1 = opt;
1102                 break;
1103         case LLC_OPT_ACK_TMR_EXP:
1104                 if (opt > LLC_OPT_MAX_ACK_TMR_EXP)
1105                         goto out;
1106                 llc->ack_timer.expire = opt * HZ;
1107                 break;
1108         case LLC_OPT_P_TMR_EXP:
1109                 if (opt > LLC_OPT_MAX_P_TMR_EXP)
1110                         goto out;
1111                 llc->pf_cycle_timer.expire = opt * HZ;
1112                 break;
1113         case LLC_OPT_REJ_TMR_EXP:
1114                 if (opt > LLC_OPT_MAX_REJ_TMR_EXP)
1115                         goto out;
1116                 llc->rej_sent_timer.expire = opt * HZ;
1117                 break;
1118         case LLC_OPT_BUSY_TMR_EXP:
1119                 if (opt > LLC_OPT_MAX_BUSY_TMR_EXP)
1120                         goto out;
1121                 llc->busy_state_timer.expire = opt * HZ;
1122                 break;
1123         case LLC_OPT_TX_WIN:
1124                 if (opt > LLC_OPT_MAX_WIN)
1125                         goto out;
1126                 llc->k = opt;
1127                 break;
1128         case LLC_OPT_RX_WIN:
1129                 if (opt > LLC_OPT_MAX_WIN)
1130                         goto out;
1131                 llc->rw = opt;
1132                 break;
1133         case LLC_OPT_PKTINFO:
1134                 if (opt)
1135                         llc->cmsg_flags |= LLC_CMSG_PKTINFO;
1136                 else
1137                         llc->cmsg_flags &= ~LLC_CMSG_PKTINFO;
1138                 break;
1139         default:
1140                 rc = -ENOPROTOOPT;
1141                 goto out;
1142         }
1143         rc = 0;
1144 out:
1145         release_sock(sk);
1146         return rc;
1147 }
1148
1149 /**
1150  *      llc_ui_getsockopt - get connection specific socket info
1151  *      @sock: Socket to get information from.
1152  *      @level: Socket level user is requesting operations on.
1153  *      @optname: Operation name.
1154  *      @optval: Variable to return operation data in.
1155  *      @optlen: Length of optval.
1156  *
1157  *      Get connection specific socket information.
1158  */
1159 static int llc_ui_getsockopt(struct socket *sock, int level, int optname,
1160                              char __user *optval, int __user *optlen)
1161 {
1162         struct sock *sk = sock->sk;
1163         struct llc_sock *llc = llc_sk(sk);
1164         int val = 0, len = 0, rc = -EINVAL;
1165
1166         lock_sock(sk);
1167         if (unlikely(level != SOL_LLC))
1168                 goto out;
1169         rc = get_user(len, optlen);
1170         if (rc)
1171                 goto out;
1172         rc = -EINVAL;
1173         if (len != sizeof(int))
1174                 goto out;
1175         switch (optname) {
1176         case LLC_OPT_RETRY:
1177                 val = llc->n2;                                  break;
1178         case LLC_OPT_SIZE:
1179                 val = llc->n1;                                  break;
1180         case LLC_OPT_ACK_TMR_EXP:
1181                 val = llc->ack_timer.expire / HZ;               break;
1182         case LLC_OPT_P_TMR_EXP:
1183                 val = llc->pf_cycle_timer.expire / HZ;          break;
1184         case LLC_OPT_REJ_TMR_EXP:
1185                 val = llc->rej_sent_timer.expire / HZ;          break;
1186         case LLC_OPT_BUSY_TMR_EXP:
1187                 val = llc->busy_state_timer.expire / HZ;        break;
1188         case LLC_OPT_TX_WIN:
1189                 val = llc->k;                           break;
1190         case LLC_OPT_RX_WIN:
1191                 val = llc->rw;                          break;
1192         case LLC_OPT_PKTINFO:
1193                 val = (llc->cmsg_flags & LLC_CMSG_PKTINFO) != 0;
1194                 break;
1195         default:
1196                 rc = -ENOPROTOOPT;
1197                 goto out;
1198         }
1199         rc = 0;
1200         if (put_user(len, optlen) || copy_to_user(optval, &val, len))
1201                 rc = -EFAULT;
1202 out:
1203         release_sock(sk);
1204         return rc;
1205 }
1206
1207 static const struct net_proto_family llc_ui_family_ops = {
1208         .family = PF_LLC,
1209         .create = llc_ui_create,
1210         .owner  = THIS_MODULE,
1211 };
1212
1213 static const struct proto_ops llc_ui_ops = {
1214         .family      = PF_LLC,
1215         .owner       = THIS_MODULE,
1216         .release     = llc_ui_release,
1217         .bind        = llc_ui_bind,
1218         .connect     = llc_ui_connect,
1219         .socketpair  = sock_no_socketpair,
1220         .accept      = llc_ui_accept,
1221         .getname     = llc_ui_getname,
1222         .poll        = datagram_poll,
1223         .ioctl       = llc_ui_ioctl,
1224         .listen      = llc_ui_listen,
1225         .shutdown    = llc_ui_shutdown,
1226         .setsockopt  = llc_ui_setsockopt,
1227         .getsockopt  = llc_ui_getsockopt,
1228         .sendmsg     = llc_ui_sendmsg,
1229         .recvmsg     = llc_ui_recvmsg,
1230         .mmap        = sock_no_mmap,
1231         .sendpage    = sock_no_sendpage,
1232 };
1233
1234 static const char llc_proc_err_msg[] __initconst =
1235         KERN_CRIT "LLC: Unable to register the proc_fs entries\n";
1236 static const char llc_sysctl_err_msg[] __initconst =
1237         KERN_CRIT "LLC: Unable to register the sysctl entries\n";
1238 static const char llc_sock_err_msg[] __initconst =
1239         KERN_CRIT "LLC: Unable to register the network family\n";
1240
1241 static int __init llc2_init(void)
1242 {
1243         int rc = proto_register(&llc_proto, 0);
1244
1245         if (rc != 0)
1246                 goto out;
1247
1248         llc_build_offset_table();
1249         llc_station_init();
1250         llc_ui_sap_last_autoport = LLC_SAP_DYN_START;
1251         rc = llc_proc_init();
1252         if (rc != 0) {
1253                 printk(llc_proc_err_msg);
1254                 goto out_station;
1255         }
1256         rc = llc_sysctl_init();
1257         if (rc) {
1258                 printk(llc_sysctl_err_msg);
1259                 goto out_proc;
1260         }
1261         rc = sock_register(&llc_ui_family_ops);
1262         if (rc) {
1263                 printk(llc_sock_err_msg);
1264                 goto out_sysctl;
1265         }
1266         llc_add_pack(LLC_DEST_SAP, llc_sap_handler);
1267         llc_add_pack(LLC_DEST_CONN, llc_conn_handler);
1268 out:
1269         return rc;
1270 out_sysctl:
1271         llc_sysctl_exit();
1272 out_proc:
1273         llc_proc_exit();
1274 out_station:
1275         llc_station_exit();
1276         proto_unregister(&llc_proto);
1277         goto out;
1278 }
1279
1280 static void __exit llc2_exit(void)
1281 {
1282         llc_station_exit();
1283         llc_remove_pack(LLC_DEST_SAP);
1284         llc_remove_pack(LLC_DEST_CONN);
1285         sock_unregister(PF_LLC);
1286         llc_proc_exit();
1287         llc_sysctl_exit();
1288         proto_unregister(&llc_proto);
1289 }
1290
1291 module_init(llc2_init);
1292 module_exit(llc2_exit);
1293
1294 MODULE_LICENSE("GPL");
1295 MODULE_AUTHOR("Procom 1997, Jay Schullist 2001, Arnaldo C. Melo 2001-2003");
1296 MODULE_DESCRIPTION("IEEE 802.2 PF_LLC support");
1297 MODULE_ALIAS_NETPROTO(PF_LLC);