blob: c4d1a1da813cdfccae6ead39c0a1fda255b471d1 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
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 */
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -030023#include <linux/compiler.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070024#include <linux/kernel.h>
25#include <linux/module.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070026#include <linux/rtnetlink.h>
27#include <linux/init.h>
28#include <net/llc.h>
29#include <net/llc_sap.h>
30#include <net/llc_pdu.h>
31#include <net/llc_conn.h>
Arnaldo Carvalho de Meloc752f072005-08-09 20:08:28 -070032#include <net/tcp_states.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070033
34/* remember: uninitialized global data is zeroed because its in .bss */
35static u16 llc_ui_sap_last_autoport = LLC_SAP_DYN_START;
36static u16 llc_ui_sap_link_no_max[256];
37static struct sockaddr_llc llc_ui_addrnull;
Eric Dumazet90ddc4f2005-12-22 12:49:22 -080038static const struct proto_ops llc_ui_ops;
Linus Torvalds1da177e2005-04-16 15:20:36 -070039
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -030040static int llc_ui_wait_for_conn(struct sock *sk, long timeout);
41static int llc_ui_wait_for_disc(struct sock *sk, long timeout);
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -030042static int llc_ui_wait_for_busy_core(struct sock *sk, long timeout);
Linus Torvalds1da177e2005-04-16 15:20:36 -070043
44#if 0
45#define dprintk(args...) printk(KERN_DEBUG args)
46#else
47#define dprintk(args...)
48#endif
49
Octavian Purdilae5cd6fe2009-12-26 11:51:00 +000050/* Maybe we'll add some more in the future. */
51#define LLC_CMSG_PKTINFO 1
52
53
Linus Torvalds1da177e2005-04-16 15:20:36 -070054/**
55 * llc_ui_next_link_no - return the next unused link number for a sap
56 * @sap: Address of sap to get link number from.
57 *
58 * Return the next unused link number for a given sap.
59 */
Arnaldo Carvalho de Melo2342c992006-03-20 21:27:43 -080060static inline u16 llc_ui_next_link_no(int sap)
Linus Torvalds1da177e2005-04-16 15:20:36 -070061{
62 return llc_ui_sap_link_no_max[sap]++;
63}
64
65/**
66 * llc_proto_type - return eth protocol for ARP header type
67 * @arphrd: ARP header type.
68 *
69 * Given an ARP header type return the corresponding ethernet protocol.
70 */
Al Viro3fbd4182006-11-08 00:26:05 -080071static inline __be16 llc_proto_type(u16 arphrd)
Linus Torvalds1da177e2005-04-16 15:20:36 -070072{
73 return arphrd == ARPHRD_IEEE802_TR ?
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +090074 htons(ETH_P_TR_802_2) : htons(ETH_P_802_2);
Linus Torvalds1da177e2005-04-16 15:20:36 -070075}
76
77/**
78 * llc_ui_addr_null - determines if a address structure is null
79 * @addr: Address to test if null.
80 */
Arnaldo Carvalho de Melo2342c992006-03-20 21:27:43 -080081static inline u8 llc_ui_addr_null(struct sockaddr_llc *addr)
Linus Torvalds1da177e2005-04-16 15:20:36 -070082{
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 */
Arnaldo Carvalho de Melo2342c992006-03-20 21:27:43 -080095static inline u8 llc_ui_header_len(struct sock *sk, struct sockaddr_llc *addr)
Linus Torvalds1da177e2005-04-16 15:20:36 -070096{
97 u8 rc = LLC_PDU_LEN_U;
98
99 if (addr->sllc_test || addr->sllc_xid)
100 rc = LLC_PDU_LEN_U;
101 else if (sk->sk_type == SOCK_STREAM)
102 rc = LLC_PDU_LEN_I;
103 return rc;
104}
105
106/**
107 * llc_ui_send_data - send data via reliable llc2 connection
108 * @sk: Connection the socket is using.
109 * @skb: Data the user wishes to send.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700110 * @noblock: can we block waiting for data?
111 *
112 * Send data via reliable llc2 connection.
113 * Returns 0 upon success, non-zero if action did not succeed.
114 */
115static int llc_ui_send_data(struct sock* sk, struct sk_buff *skb, int noblock)
116{
117 struct llc_sock* llc = llc_sk(sk);
118 int rc = 0;
119
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900120 if (unlikely(llc_data_accept_state(llc->state) ||
Jochen Friedrich451677c2005-11-14 21:57:46 -0800121 llc->remote_busy_flag ||
122 llc->p_flag)) {
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300123 long timeout = sock_sndtimeo(sk, noblock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700124
125 rc = llc_ui_wait_for_busy_core(sk, timeout);
126 }
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300127 if (unlikely(!rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700128 rc = llc_build_and_send_pkt(sk, skb);
129 return rc;
130}
131
132static void llc_ui_sk_init(struct socket *sock, struct sock *sk)
133{
David S. Milleree5850d2008-06-17 01:21:03 -0700134 sock_graft(sk, sock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700135 sk->sk_type = sock->type;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700136 sock->ops = &llc_ui_ops;
137}
138
139static struct proto llc_proto = {
Arnaldo Carvalho de Melo9c005e02006-03-20 21:27:23 -0800140 .name = "LLC",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700141 .owner = THIS_MODULE,
142 .obj_size = sizeof(struct llc_sock),
143};
144
145/**
146 * llc_ui_create - alloc and init a new llc_ui socket
Eric Paris3f378b62009-11-05 22:18:14 -0800147 * @net: network namespace (must be default network)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700148 * @sock: Socket to initialize and attach allocated sk to.
149 * @protocol: Unused.
Eric Paris3f378b62009-11-05 22:18:14 -0800150 * @kern: on behalf of kernel or userspace
Linus Torvalds1da177e2005-04-16 15:20:36 -0700151 *
152 * Allocate and initialize a new llc_ui socket, validate the user wants a
153 * socket type we have available.
154 * Returns 0 upon success, negative upon failure.
155 */
Eric Paris3f378b62009-11-05 22:18:14 -0800156static int llc_ui_create(struct net *net, struct socket *sock, int protocol,
157 int kern)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700158{
159 struct sock *sk;
160 int rc = -ESOCKTNOSUPPORT;
161
Patrick McHardy3480c632008-03-27 20:28:10 -0700162 if (!capable(CAP_NET_RAW))
163 return -EPERM;
164
Octavian Purdila09ad9bc2009-11-25 15:14:13 -0800165 if (!net_eq(net, &init_net))
Eric W. Biederman1b8d7ae2007-10-08 23:24:22 -0700166 return -EAFNOSUPPORT;
167
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300168 if (likely(sock->type == SOCK_DGRAM || sock->type == SOCK_STREAM)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700169 rc = -ENOMEM;
Eric W. Biederman1b8d7ae2007-10-08 23:24:22 -0700170 sk = llc_sk_alloc(net, PF_LLC, GFP_KERNEL, &llc_proto);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700171 if (sk) {
172 rc = 0;
173 llc_ui_sk_init(sock, sk);
174 }
175 }
176 return rc;
177}
178
179/**
180 * llc_ui_release - shutdown socket
181 * @sock: Socket to release.
182 *
183 * Shutdown and deallocate an existing socket.
184 */
185static int llc_ui_release(struct socket *sock)
186{
187 struct sock *sk = sock->sk;
188 struct llc_sock *llc;
189
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300190 if (unlikely(sk == NULL))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700191 goto out;
192 sock_hold(sk);
193 lock_sock(sk);
194 llc = llc_sk(sk);
Harvey Harrison0dc47872008-03-05 20:47:47 -0800195 dprintk("%s: closing local(%02X) remote(%02X)\n", __func__,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700196 llc->laddr.lsap, llc->daddr.lsap);
197 if (!llc_send_disc(sk))
198 llc_ui_wait_for_disc(sk, sk->sk_rcvtimeo);
Arnaldo Carvalho de Melo2e1f47c2006-03-20 21:28:11 -0800199 if (!sock_flag(sk, SOCK_ZAPPED)) {
200 llc_sap_put(llc->sap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700201 llc_sap_remove_socket(llc->sap, sk);
Arnaldo Carvalho de Melo2e1f47c2006-03-20 21:28:11 -0800202 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700203 release_sock(sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700204 if (llc->dev)
205 dev_put(llc->dev);
206 sock_put(sk);
207 llc_sk_free(sk);
208out:
209 return 0;
210}
211
212/**
213 * llc_ui_autoport - provide dynamically allocate SAP number
214 *
215 * Provide the caller with a dynamically allocated SAP number according
216 * to the rules that are set in this function. Returns: 0, upon failure,
217 * SAP number otherwise.
218 */
219static int llc_ui_autoport(void)
220{
221 struct llc_sap *sap;
222 int i, tries = 0;
223
224 while (tries < LLC_SAP_DYN_TRIES) {
225 for (i = llc_ui_sap_last_autoport;
226 i < LLC_SAP_DYN_STOP; i += 2) {
227 sap = llc_sap_find(i);
228 if (!sap) {
229 llc_ui_sap_last_autoport = i + 2;
230 goto out;
231 }
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -0300232 llc_sap_put(sap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700233 }
234 llc_ui_sap_last_autoport = LLC_SAP_DYN_START;
235 tries++;
236 }
237 i = 0;
238out:
239 return i;
240}
241
242/**
Arnaldo Carvalho de Melo5a770c02005-09-22 03:56:26 -0300243 * llc_ui_autobind - automatically bind a socket to a sap
244 * @sock: socket to bind
245 * @addr: address to connect to
Linus Torvalds1da177e2005-04-16 15:20:36 -0700246 *
Arnaldo Carvalho de Melo5a770c02005-09-22 03:56:26 -0300247 * Used by llc_ui_connect and llc_ui_sendmsg when the user hasn't
248 * specifically used llc_ui_bind to bind to an specific address/sap
249 *
Linus Torvalds1da177e2005-04-16 15:20:36 -0700250 * Returns: 0 upon success, negative otherwise.
251 */
252static int llc_ui_autobind(struct socket *sock, struct sockaddr_llc *addr)
253{
254 struct sock *sk = sock->sk;
255 struct llc_sock *llc = llc_sk(sk);
256 struct llc_sap *sap;
257 int rc = -EINVAL;
258
259 if (!sock_flag(sk, SOCK_ZAPPED))
260 goto out;
261 rc = -ENODEV;
Octavian Purdilaabf9d532009-12-26 11:51:01 +0000262 if (sk->sk_bound_dev_if) {
263 llc->dev = dev_get_by_index(&init_net, sk->sk_bound_dev_if);
264 if (llc->dev && addr->sllc_arphrd != llc->dev->type) {
265 dev_put(llc->dev);
266 llc->dev = NULL;
267 }
268 } else
269 llc->dev = dev_getfirstbyhwtype(&init_net, addr->sllc_arphrd);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700270 if (!llc->dev)
271 goto out;
272 rc = -EUSERS;
273 llc->laddr.lsap = llc_ui_autoport();
274 if (!llc->laddr.lsap)
275 goto out;
276 rc = -EBUSY; /* some other network layer is using the sap */
277 sap = llc_sap_open(llc->laddr.lsap, NULL);
278 if (!sap)
279 goto out;
280 memcpy(llc->laddr.mac, llc->dev->dev_addr, IFHWADDRLEN);
281 memcpy(&llc->addr, addr, sizeof(llc->addr));
282 /* assign new connection to its SAP */
283 llc_sap_add_socket(sap, sk);
284 sock_reset_flag(sk, SOCK_ZAPPED);
285 rc = 0;
286out:
287 return rc;
288}
289
290/**
291 * llc_ui_bind - bind a socket to a specific address.
292 * @sock: Socket to bind an address to.
293 * @uaddr: Address the user wants the socket bound to.
294 * @addrlen: Length of the uaddr structure.
295 *
296 * Bind a socket to a specific address. For llc a user is able to bind to
Arnaldo Carvalho de Melo5a770c02005-09-22 03:56:26 -0300297 * a specific sap only or mac + sap.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298 * If the user desires to bind to a specific mac + sap, it is possible to
299 * have multiple sap connections via multiple macs.
300 * Bind and autobind for that matter must enforce the correct sap usage
301 * otherwise all hell will break loose.
302 * Returns: 0 upon success, negative otherwise.
303 */
304static int llc_ui_bind(struct socket *sock, struct sockaddr *uaddr, int addrlen)
305{
306 struct sockaddr_llc *addr = (struct sockaddr_llc *)uaddr;
307 struct sock *sk = sock->sk;
308 struct llc_sock *llc = llc_sk(sk);
309 struct llc_sap *sap;
310 int rc = -EINVAL;
311
Harvey Harrison0dc47872008-03-05 20:47:47 -0800312 dprintk("%s: binding %02X\n", __func__, addr->sllc_sap);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300313 if (unlikely(!sock_flag(sk, SOCK_ZAPPED) || addrlen != sizeof(*addr)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700314 goto out;
315 rc = -EAFNOSUPPORT;
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300316 if (unlikely(addr->sllc_family != AF_LLC))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700317 goto out;
Jochen Friedrichcf309e32005-09-22 04:44:55 -0300318 rc = -ENODEV;
319 rtnl_lock();
Octavian Purdilaabf9d532009-12-26 11:51:01 +0000320 if (sk->sk_bound_dev_if) {
321 llc->dev = dev_get_by_index(&init_net, sk->sk_bound_dev_if);
322 if (llc->dev) {
323 if (!addr->sllc_arphrd)
324 addr->sllc_arphrd = llc->dev->type;
325 if (llc_mac_null(addr->sllc_mac))
326 memcpy(addr->sllc_mac, llc->dev->dev_addr,
327 IFHWADDRLEN);
328 if (addr->sllc_arphrd != llc->dev->type ||
329 !llc_mac_match(addr->sllc_mac,
330 llc->dev->dev_addr)) {
331 rc = -EINVAL;
332 dev_put(llc->dev);
333 llc->dev = NULL;
334 }
335 }
336 } else
337 llc->dev = dev_getbyhwaddr(&init_net, addr->sllc_arphrd,
338 addr->sllc_mac);
Jochen Friedrichcf309e32005-09-22 04:44:55 -0300339 rtnl_unlock();
340 if (!llc->dev)
341 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700342 if (!addr->sllc_sap) {
343 rc = -EUSERS;
344 addr->sllc_sap = llc_ui_autoport();
345 if (!addr->sllc_sap)
346 goto out;
347 }
348 sap = llc_sap_find(addr->sllc_sap);
349 if (!sap) {
350 sap = llc_sap_open(addr->sllc_sap, NULL);
351 rc = -EBUSY; /* some other network layer is using the sap */
352 if (!sap)
353 goto out;
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -0300354 llc_sap_hold(sap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700355 } else {
356 struct llc_addr laddr, daddr;
357 struct sock *ask;
358
359 memset(&laddr, 0, sizeof(laddr));
360 memset(&daddr, 0, sizeof(daddr));
361 /*
Michael Opdenacker59c51592007-05-09 08:57:56 +0200362 * FIXME: check if the address is multicast,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700363 * only SOCK_DGRAM can do this.
364 */
365 memcpy(laddr.mac, addr->sllc_mac, IFHWADDRLEN);
366 laddr.lsap = addr->sllc_sap;
367 rc = -EADDRINUSE; /* mac + sap clash. */
368 ask = llc_lookup_established(sap, &daddr, &laddr);
369 if (ask) {
370 sock_put(ask);
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -0300371 goto out_put;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700372 }
373 }
374 llc->laddr.lsap = addr->sllc_sap;
375 memcpy(llc->laddr.mac, addr->sllc_mac, IFHWADDRLEN);
376 memcpy(&llc->addr, addr, sizeof(llc->addr));
377 /* assign new connection to its SAP */
378 llc_sap_add_socket(sap, sk);
379 sock_reset_flag(sk, SOCK_ZAPPED);
380 rc = 0;
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -0300381out_put:
382 llc_sap_put(sap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700383out:
384 return rc;
385}
386
387/**
388 * llc_ui_shutdown - shutdown a connect llc2 socket.
389 * @sock: Socket to shutdown.
390 * @how: What part of the socket to shutdown.
391 *
392 * Shutdown a connected llc2 socket. Currently this function only supports
393 * shutting down both sends and receives (2), we could probably make this
394 * function such that a user can shutdown only half the connection but not
395 * right now.
396 * Returns: 0 upon success, negative otherwise.
397 */
398static int llc_ui_shutdown(struct socket *sock, int how)
399{
400 struct sock *sk = sock->sk;
401 int rc = -ENOTCONN;
402
403 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300404 if (unlikely(sk->sk_state != TCP_ESTABLISHED))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700405 goto out;
406 rc = -EINVAL;
407 if (how != 2)
408 goto out;
409 rc = llc_send_disc(sk);
410 if (!rc)
411 rc = llc_ui_wait_for_disc(sk, sk->sk_rcvtimeo);
412 /* Wake up anyone sleeping in poll */
413 sk->sk_state_change(sk);
414out:
415 release_sock(sk);
416 return rc;
417}
418
419/**
420 * llc_ui_connect - Connect to a remote llc2 mac + sap.
421 * @sock: Socket which will be connected to the remote destination.
422 * @uaddr: Remote and possibly the local address of the new connection.
423 * @addrlen: Size of uaddr structure.
424 * @flags: Operational flags specified by the user.
425 *
426 * Connect to a remote llc2 mac + sap. The caller must specify the
427 * destination mac and address to connect to. If the user hasn't previously
428 * called bind(2) with a smac the address of the first interface of the
429 * specified arp type will be used.
430 * This function will autobind if user did not previously call bind.
431 * Returns: 0 upon success, negative otherwise.
432 */
433static int llc_ui_connect(struct socket *sock, struct sockaddr *uaddr,
434 int addrlen, int flags)
435{
436 struct sock *sk = sock->sk;
437 struct llc_sock *llc = llc_sk(sk);
438 struct sockaddr_llc *addr = (struct sockaddr_llc *)uaddr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700439 int rc = -EINVAL;
440
441 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300442 if (unlikely(addrlen != sizeof(*addr)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700443 goto out;
444 rc = -EAFNOSUPPORT;
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300445 if (unlikely(addr->sllc_family != AF_LLC))
446 goto out;
447 if (unlikely(sk->sk_type != SOCK_STREAM))
448 goto out;
449 rc = -EALREADY;
450 if (unlikely(sock->state == SS_CONNECTING))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700451 goto out;
452 /* bind connection to sap if user hasn't done it. */
453 if (sock_flag(sk, SOCK_ZAPPED)) {
454 /* bind to sap with null dev, exclusive */
455 rc = llc_ui_autobind(sock, addr);
456 if (rc)
457 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700458 }
Jochen Friedrich5564af22005-09-22 04:46:44 -0300459 llc->daddr.lsap = addr->sllc_sap;
460 memcpy(llc->daddr.mac, addr->sllc_mac, IFHWADDRLEN);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700461 sock->state = SS_CONNECTING;
462 sk->sk_state = TCP_SYN_SENT;
463 llc->link = llc_ui_next_link_no(llc->sap->laddr.lsap);
Arnaldo Carvalho de Melo774ccb42005-09-22 03:53:35 -0300464 rc = llc_establish_connection(sk, llc->dev->dev_addr,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700465 addr->sllc_mac, addr->sllc_sap);
466 if (rc) {
Harvey Harrison0dc47872008-03-05 20:47:47 -0800467 dprintk("%s: llc_ui_send_conn failed :-(\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700468 sock->state = SS_UNCONNECTED;
469 sk->sk_state = TCP_CLOSE;
470 goto out;
471 }
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300472
473 if (sk->sk_state == TCP_SYN_SENT) {
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300474 const long timeo = sock_sndtimeo(sk, flags & O_NONBLOCK);
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300475
476 if (!timeo || !llc_ui_wait_for_conn(sk, timeo))
477 goto out;
478
479 rc = sock_intr_errno(timeo);
480 if (signal_pending(current))
481 goto out;
482 }
483
484 if (sk->sk_state == TCP_CLOSE)
485 goto sock_error;
486
487 sock->state = SS_CONNECTED;
488 rc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700489out:
490 release_sock(sk);
491 return rc;
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300492sock_error:
493 rc = sock_error(sk) ? : -ECONNABORTED;
494 sock->state = SS_UNCONNECTED;
495 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700496}
497
498/**
499 * llc_ui_listen - allow a normal socket to accept incoming connections
500 * @sock: Socket to allow incoming connections on.
501 * @backlog: Number of connections to queue.
502 *
503 * Allow a normal socket to accept incoming connections.
504 * Returns 0 upon success, negative otherwise.
505 */
506static int llc_ui_listen(struct socket *sock, int backlog)
507{
508 struct sock *sk = sock->sk;
509 int rc = -EINVAL;
510
511 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300512 if (unlikely(sock->state != SS_UNCONNECTED))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700513 goto out;
514 rc = -EOPNOTSUPP;
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300515 if (unlikely(sk->sk_type != SOCK_STREAM))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700516 goto out;
517 rc = -EAGAIN;
518 if (sock_flag(sk, SOCK_ZAPPED))
519 goto out;
520 rc = 0;
521 if (!(unsigned)backlog) /* BSDism */
522 backlog = 1;
523 sk->sk_max_ack_backlog = backlog;
524 if (sk->sk_state != TCP_LISTEN) {
525 sk->sk_ack_backlog = 0;
526 sk->sk_state = TCP_LISTEN;
527 }
528 sk->sk_socket->flags |= __SO_ACCEPTCON;
529out:
530 release_sock(sk);
531 return rc;
532}
533
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300534static int llc_ui_wait_for_disc(struct sock *sk, long timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700535{
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300536 DEFINE_WAIT(wait);
537 int rc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700538
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300539 while (1) {
540 prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE);
541 if (sk_wait_event(sk, &timeout, sk->sk_state == TCP_CLOSE))
542 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700543 rc = -ERESTARTSYS;
544 if (signal_pending(current))
545 break;
546 rc = -EAGAIN;
547 if (!timeout)
548 break;
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300549 rc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700550 }
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300551 finish_wait(sk->sk_sleep, &wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700552 return rc;
553}
554
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300555static int llc_ui_wait_for_conn(struct sock *sk, long timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700556{
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300557 DEFINE_WAIT(wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700558
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300559 while (1) {
560 prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE);
561 if (sk_wait_event(sk, &timeout, sk->sk_state != TCP_SYN_SENT))
562 break;
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300563 if (signal_pending(current) || !timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700564 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700565 }
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300566 finish_wait(sk->sk_sleep, &wait);
567 return timeout;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700568}
569
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300570static int llc_ui_wait_for_busy_core(struct sock *sk, long timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700571{
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300572 DEFINE_WAIT(wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700573 struct llc_sock *llc = llc_sk(sk);
574 int rc;
575
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300576 while (1) {
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300577 prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700578 rc = 0;
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300579 if (sk_wait_event(sk, &timeout,
580 (sk->sk_shutdown & RCV_SHUTDOWN) ||
581 (!llc_data_accept_state(llc->state) &&
Jochen Friedrich451677c2005-11-14 21:57:46 -0800582 !llc->remote_busy_flag &&
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300583 !llc->p_flag)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700584 break;
585 rc = -ERESTARTSYS;
586 if (signal_pending(current))
587 break;
588 rc = -EAGAIN;
589 if (!timeout)
590 break;
591 }
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300592 finish_wait(sk->sk_sleep, &wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700593 return rc;
594}
595
Arnaldo Carvalho de Melo2928c192005-09-22 05:14:33 -0300596static int llc_wait_data(struct sock *sk, long timeo)
Arnaldo Carvalho de Meloafdbe352005-09-22 04:37:07 -0300597{
598 int rc;
599
600 while (1) {
601 /*
602 * POSIX 1003.1g mandates this order.
603 */
Benjamin LaHaisec1cbe4b2005-12-13 23:22:19 -0800604 rc = sock_error(sk);
605 if (rc)
Arnaldo Carvalho de Meloafdbe352005-09-22 04:37:07 -0300606 break;
Arnaldo Carvalho de Meloafdbe352005-09-22 04:37:07 -0300607 rc = 0;
608 if (sk->sk_shutdown & RCV_SHUTDOWN)
609 break;
610 rc = -EAGAIN;
611 if (!timeo)
612 break;
613 rc = sock_intr_errno(timeo);
614 if (signal_pending(current))
615 break;
616 rc = 0;
617 if (sk_wait_data(sk, &timeo))
618 break;
619 }
620 return rc;
621}
622
Octavian Purdilae5cd6fe2009-12-26 11:51:00 +0000623static void llc_cmsg_rcv(struct msghdr *msg, struct sk_buff *skb)
624{
625 struct llc_sock *llc = llc_sk(skb->sk);
626
627 if (llc->cmsg_flags & LLC_CMSG_PKTINFO) {
628 struct llc_pktinfo info;
629
630 info.lpi_ifindex = llc_sk(skb->sk)->dev->ifindex;
631 llc_pdu_decode_dsap(skb, &info.lpi_sap);
632 llc_pdu_decode_da(skb, info.lpi_mac);
633 put_cmsg(msg, SOL_LLC, LLC_OPT_PKTINFO, sizeof(info), &info);
634 }
635}
636
Linus Torvalds1da177e2005-04-16 15:20:36 -0700637/**
638 * llc_ui_accept - accept a new incoming connection.
639 * @sock: Socket which connections arrive on.
640 * @newsock: Socket to move incoming connection to.
641 * @flags: User specified operational flags.
642 *
643 * Accept a new incoming connection.
644 * Returns 0 upon success, negative otherwise.
645 */
646static int llc_ui_accept(struct socket *sock, struct socket *newsock, int flags)
647{
648 struct sock *sk = sock->sk, *newsk;
649 struct llc_sock *llc, *newllc;
650 struct sk_buff *skb;
651 int rc = -EOPNOTSUPP;
652
Harvey Harrison0dc47872008-03-05 20:47:47 -0800653 dprintk("%s: accepting on %02X\n", __func__,
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900654 llc_sk(sk)->laddr.lsap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700655 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300656 if (unlikely(sk->sk_type != SOCK_STREAM))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700657 goto out;
658 rc = -EINVAL;
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300659 if (unlikely(sock->state != SS_UNCONNECTED ||
660 sk->sk_state != TCP_LISTEN))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700661 goto out;
662 /* wait for a connection to arrive. */
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300663 if (skb_queue_empty(&sk->sk_receive_queue)) {
Arnaldo Carvalho de Meloafdbe352005-09-22 04:37:07 -0300664 rc = llc_wait_data(sk, sk->sk_rcvtimeo);
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300665 if (rc)
666 goto out;
667 }
Harvey Harrison0dc47872008-03-05 20:47:47 -0800668 dprintk("%s: got a new connection on %02X\n", __func__,
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900669 llc_sk(sk)->laddr.lsap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700670 skb = skb_dequeue(&sk->sk_receive_queue);
671 rc = -EINVAL;
672 if (!skb->sk)
673 goto frees;
674 rc = 0;
675 newsk = skb->sk;
676 /* attach connection to a new socket. */
677 llc_ui_sk_init(newsock, newsk);
678 sock_reset_flag(newsk, SOCK_ZAPPED);
679 newsk->sk_state = TCP_ESTABLISHED;
680 newsock->state = SS_CONNECTED;
681 llc = llc_sk(sk);
682 newllc = llc_sk(newsk);
683 memcpy(&newllc->addr, &llc->addr, sizeof(newllc->addr));
684 newllc->link = llc_ui_next_link_no(newllc->laddr.lsap);
685
686 /* put original socket back into a clean listen state. */
687 sk->sk_state = TCP_LISTEN;
688 sk->sk_ack_backlog--;
Harvey Harrison0dc47872008-03-05 20:47:47 -0800689 dprintk("%s: ok success on %02X, client on %02X\n", __func__,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700690 llc_sk(sk)->addr.sllc_sap, newllc->daddr.lsap);
691frees:
692 kfree_skb(skb);
693out:
694 release_sock(sk);
695 return rc;
696}
697
698/**
699 * llc_ui_recvmsg - copy received data to the socket user.
700 * @sock: Socket to copy data from.
701 * @msg: Various user space related information.
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300702 * @len: Size of user buffer.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700703 * @flags: User specified flags.
704 *
705 * Copy received data to the socket user.
706 * Returns non-negative upon success, negative otherwise.
707 */
708static int llc_ui_recvmsg(struct kiocb *iocb, struct socket *sock,
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300709 struct msghdr *msg, size_t len, int flags)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700710{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700711 struct sockaddr_llc *uaddr = (struct sockaddr_llc *)msg->msg_name;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300712 const int nonblock = flags & MSG_DONTWAIT;
713 struct sk_buff *skb = NULL;
714 struct sock *sk = sock->sk;
715 struct llc_sock *llc = llc_sk(sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700716 size_t copied = 0;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300717 u32 peek_seq = 0;
718 u32 *seq;
719 unsigned long used;
720 int target; /* Read at least this many bytes */
721 long timeo;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700722
Linus Torvalds1da177e2005-04-16 15:20:36 -0700723 lock_sock(sk);
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300724 copied = -ENOTCONN;
Stephen Hemminger29efcd22006-05-25 15:08:59 -0700725 if (unlikely(sk->sk_type == SOCK_STREAM && sk->sk_state == TCP_LISTEN))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700726 goto out;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300727
728 timeo = sock_rcvtimeo(sk, nonblock);
729
730 seq = &llc->copied_seq;
731 if (flags & MSG_PEEK) {
732 peek_seq = llc->copied_seq;
733 seq = &peek_seq;
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900734 }
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300735
736 target = sock_rcvlowat(sk, flags & MSG_WAITALL, len);
737 copied = 0;
738
739 do {
740 u32 offset;
741
742 /*
743 * We need to check signals first, to get correct SIGURG
744 * handling. FIXME: Need to check this doesn't impact 1003.1g
745 * and move it down to the bottom of the loop
746 */
747 if (signal_pending(current)) {
748 if (copied)
749 break;
750 copied = timeo ? sock_intr_errno(timeo) : -EAGAIN;
751 break;
752 }
753
754 /* Next get a buffer. */
755
756 skb = skb_peek(&sk->sk_receive_queue);
757 if (skb) {
758 offset = *seq;
759 goto found_ok_skb;
760 }
761 /* Well, if we have backlog, try to process it now yet. */
762
763 if (copied >= target && !sk->sk_backlog.tail)
764 break;
765
766 if (copied) {
767 if (sk->sk_err ||
768 sk->sk_state == TCP_CLOSE ||
769 (sk->sk_shutdown & RCV_SHUTDOWN) ||
770 !timeo ||
771 (flags & MSG_PEEK))
772 break;
773 } else {
774 if (sock_flag(sk, SOCK_DONE))
775 break;
776
777 if (sk->sk_err) {
778 copied = sock_error(sk);
779 break;
780 }
781 if (sk->sk_shutdown & RCV_SHUTDOWN)
782 break;
783
Stephen Hemminger29efcd22006-05-25 15:08:59 -0700784 if (sk->sk_type == SOCK_STREAM && sk->sk_state == TCP_CLOSE) {
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300785 if (!sock_flag(sk, SOCK_DONE)) {
786 /*
787 * This occurs when user tries to read
788 * from never connected socket.
789 */
790 copied = -ENOTCONN;
791 break;
792 }
793 break;
794 }
795 if (!timeo) {
796 copied = -EAGAIN;
797 break;
798 }
799 }
800
801 if (copied >= target) { /* Do not sleep, just process backlog. */
802 release_sock(sk);
803 lock_sock(sk);
804 } else
805 sk_wait_data(sk, &timeo);
806
807 if ((flags & MSG_PEEK) && peek_seq != llc->copied_seq) {
808 if (net_ratelimit())
809 printk(KERN_DEBUG "LLC(%s:%d): Application "
810 "bug, race in MSG_PEEK.\n",
Pavel Emelyanovba25f9d2007-10-18 23:40:40 -0700811 current->comm, task_pid_nr(current));
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300812 peek_seq = llc->copied_seq;
813 }
814 continue;
815 found_ok_skb:
816 /* Ok so how much can we use? */
817 used = skb->len - offset;
818 if (len < used)
819 used = len;
820
821 if (!(flags & MSG_TRUNC)) {
822 int rc = skb_copy_datagram_iovec(skb, offset,
823 msg->msg_iov, used);
824 if (rc) {
825 /* Exception. Bailout! */
826 if (!copied)
827 copied = -EFAULT;
828 break;
829 }
830 }
831
832 *seq += used;
833 copied += used;
834 len -= used;
835
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300836 if (!(flags & MSG_PEEK)) {
Chris Leech624d1162006-05-23 18:01:28 -0700837 sk_eat_skb(sk, skb, 0);
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300838 *seq = 0;
839 }
Stephen Hemminger30a584d2006-08-03 16:38:49 -0700840
841 /* For non stream protcols we get one packet per recvmsg call */
842 if (sk->sk_type != SOCK_STREAM)
843 goto copy_uaddr;
844
845 /* Partial read */
846 if (used + offset < skb->len)
847 continue;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300848 } while (len > 0);
849
Linus Torvalds1da177e2005-04-16 15:20:36 -0700850out:
851 release_sock(sk);
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300852 return copied;
853copy_uaddr:
854 if (uaddr != NULL && skb != NULL) {
855 memcpy(uaddr, llc_ui_skb_cb(skb), sizeof(*uaddr));
856 msg->msg_namelen = sizeof(*uaddr);
857 }
Octavian Purdilae5cd6fe2009-12-26 11:51:00 +0000858 if (llc_sk(sk)->cmsg_flags)
859 llc_cmsg_rcv(msg, skb);
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300860 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700861}
862
863/**
864 * llc_ui_sendmsg - Transmit data provided by the socket user.
865 * @sock: Socket to transmit data from.
866 * @msg: Various user related information.
867 * @len: Length of data to transmit.
868 *
869 * Transmit data provided by the socket user.
870 * Returns non-negative upon success, negative otherwise.
871 */
872static int llc_ui_sendmsg(struct kiocb *iocb, struct socket *sock,
873 struct msghdr *msg, size_t len)
874{
875 struct sock *sk = sock->sk;
876 struct llc_sock *llc = llc_sk(sk);
877 struct sockaddr_llc *addr = (struct sockaddr_llc *)msg->msg_name;
878 int flags = msg->msg_flags;
879 int noblock = flags & MSG_DONTWAIT;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700880 struct sk_buff *skb;
881 size_t size = 0;
882 int rc = -EINVAL, copied = 0, hdrlen;
883
Harvey Harrison0dc47872008-03-05 20:47:47 -0800884 dprintk("%s: sending from %02X to %02X\n", __func__,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700885 llc->laddr.lsap, llc->daddr.lsap);
886 lock_sock(sk);
887 if (addr) {
888 if (msg->msg_namelen < sizeof(*addr))
889 goto release;
890 } else {
891 if (llc_ui_addr_null(&llc->addr))
892 goto release;
893 addr = &llc->addr;
894 }
895 /* must bind connection to sap if user hasn't done it. */
896 if (sock_flag(sk, SOCK_ZAPPED)) {
897 /* bind to sap with null dev, exclusive. */
898 rc = llc_ui_autobind(sock, addr);
899 if (rc)
900 goto release;
901 }
Arnaldo Carvalho de Melo774ccb42005-09-22 03:53:35 -0300902 hdrlen = llc->dev->hard_header_len + llc_ui_header_len(sk, addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700903 size = hdrlen + len;
Arnaldo Carvalho de Melo774ccb42005-09-22 03:53:35 -0300904 if (size > llc->dev->mtu)
905 size = llc->dev->mtu;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700906 copied = size - hdrlen;
907 release_sock(sk);
908 skb = sock_alloc_send_skb(sk, size, noblock, &rc);
909 lock_sock(sk);
910 if (!skb)
911 goto release;
Arnaldo Carvalho de Melo774ccb42005-09-22 03:53:35 -0300912 skb->dev = llc->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700913 skb->protocol = llc_proto_type(addr->sllc_arphrd);
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900914 skb_reserve(skb, hdrlen);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700915 rc = memcpy_fromiovec(skb_put(skb, copied), msg->msg_iov, copied);
916 if (rc)
917 goto out;
918 if (sk->sk_type == SOCK_DGRAM || addr->sllc_ua) {
919 llc_build_and_send_ui_pkt(llc->sap, skb, addr->sllc_mac,
920 addr->sllc_sap);
921 goto out;
922 }
923 if (addr->sllc_test) {
924 llc_build_and_send_test_pkt(llc->sap, skb, addr->sllc_mac,
925 addr->sllc_sap);
926 goto out;
927 }
928 if (addr->sllc_xid) {
929 llc_build_and_send_xid_pkt(llc->sap, skb, addr->sllc_mac,
930 addr->sllc_sap);
931 goto out;
932 }
933 rc = -ENOPROTOOPT;
934 if (!(sk->sk_type == SOCK_STREAM && !addr->sllc_ua))
935 goto out;
936 rc = llc_ui_send_data(sk, skb, noblock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700937out:
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300938 if (rc) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700939 kfree_skb(skb);
940release:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700941 dprintk("%s: failed sending from %02X to %02X: %d\n",
Harvey Harrison0dc47872008-03-05 20:47:47 -0800942 __func__, llc->laddr.lsap, llc->daddr.lsap, rc);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300943 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700944 release_sock(sk);
945 return rc ? : copied;
946}
947
948/**
949 * llc_ui_getname - return the address info of a socket
950 * @sock: Socket to get address of.
951 * @uaddr: Address structure to return information.
952 * @uaddrlen: Length of address structure.
953 * @peer: Does user want local or remote address information.
954 *
955 * Return the address information of a socket.
956 */
957static int llc_ui_getname(struct socket *sock, struct sockaddr *uaddr,
958 int *uaddrlen, int peer)
959{
960 struct sockaddr_llc sllc;
961 struct sock *sk = sock->sk;
962 struct llc_sock *llc = llc_sk(sk);
963 int rc = 0;
964
Jiri Slaby28e9fc52009-08-23 22:55:51 -0700965 memset(&sllc, 0, sizeof(sllc));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700966 lock_sock(sk);
967 if (sock_flag(sk, SOCK_ZAPPED))
968 goto out;
969 *uaddrlen = sizeof(sllc);
970 memset(uaddr, 0, *uaddrlen);
971 if (peer) {
972 rc = -ENOTCONN;
973 if (sk->sk_state != TCP_ESTABLISHED)
974 goto out;
975 if(llc->dev)
976 sllc.sllc_arphrd = llc->dev->type;
977 sllc.sllc_sap = llc->daddr.lsap;
978 memcpy(&sllc.sllc_mac, &llc->daddr.mac, IFHWADDRLEN);
979 } else {
980 rc = -EINVAL;
981 if (!llc->sap)
982 goto out;
983 sllc.sllc_sap = llc->sap->laddr.lsap;
984
985 if (llc->dev) {
986 sllc.sllc_arphrd = llc->dev->type;
Jiri Pirkoa186d2a2009-05-12 22:40:12 +0000987 memcpy(&sllc.sllc_mac, llc->dev->dev_addr,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700988 IFHWADDRLEN);
989 }
990 }
991 rc = 0;
992 sllc.sllc_family = AF_LLC;
993 memcpy(uaddr, &sllc, sizeof(sllc));
994out:
995 release_sock(sk);
996 return rc;
997}
998
999/**
1000 * llc_ui_ioctl - io controls for PF_LLC
1001 * @sock: Socket to get/set info
1002 * @cmd: command
1003 * @arg: optional argument for cmd
1004 *
1005 * get/set info on llc sockets
1006 */
1007static int llc_ui_ioctl(struct socket *sock, unsigned int cmd,
1008 unsigned long arg)
1009{
Christoph Hellwigb5e5fa52006-01-03 14:18:33 -08001010 return -ENOIOCTLCMD;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001011}
1012
1013/**
1014 * llc_ui_setsockopt - set various connection specific parameters.
1015 * @sock: Socket to set options on.
1016 * @level: Socket level user is requesting operations on.
1017 * @optname: Operation name.
1018 * @optval User provided operation data.
1019 * @optlen: Length of optval.
1020 *
1021 * Set various connection specific parameters.
1022 */
1023static int llc_ui_setsockopt(struct socket *sock, int level, int optname,
David S. Millerb7058842009-09-30 16:12:20 -07001024 char __user *optval, unsigned int optlen)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001025{
1026 struct sock *sk = sock->sk;
1027 struct llc_sock *llc = llc_sk(sk);
1028 int rc = -EINVAL, opt;
1029
1030 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -03001031 if (unlikely(level != SOL_LLC || optlen != sizeof(int)))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001032 goto out;
1033 rc = get_user(opt, (int __user *)optval);
1034 if (rc)
1035 goto out;
1036 rc = -EINVAL;
1037 switch (optname) {
1038 case LLC_OPT_RETRY:
1039 if (opt > LLC_OPT_MAX_RETRY)
1040 goto out;
1041 llc->n2 = opt;
1042 break;
1043 case LLC_OPT_SIZE:
1044 if (opt > LLC_OPT_MAX_SIZE)
1045 goto out;
1046 llc->n1 = opt;
1047 break;
1048 case LLC_OPT_ACK_TMR_EXP:
1049 if (opt > LLC_OPT_MAX_ACK_TMR_EXP)
1050 goto out;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001051 llc->ack_timer.expire = opt * HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001052 break;
1053 case LLC_OPT_P_TMR_EXP:
1054 if (opt > LLC_OPT_MAX_P_TMR_EXP)
1055 goto out;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001056 llc->pf_cycle_timer.expire = opt * HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001057 break;
1058 case LLC_OPT_REJ_TMR_EXP:
1059 if (opt > LLC_OPT_MAX_REJ_TMR_EXP)
1060 goto out;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001061 llc->rej_sent_timer.expire = opt * HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001062 break;
1063 case LLC_OPT_BUSY_TMR_EXP:
1064 if (opt > LLC_OPT_MAX_BUSY_TMR_EXP)
1065 goto out;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001066 llc->busy_state_timer.expire = opt * HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001067 break;
1068 case LLC_OPT_TX_WIN:
1069 if (opt > LLC_OPT_MAX_WIN)
1070 goto out;
1071 llc->k = opt;
1072 break;
1073 case LLC_OPT_RX_WIN:
1074 if (opt > LLC_OPT_MAX_WIN)
1075 goto out;
1076 llc->rw = opt;
1077 break;
Octavian Purdilae5cd6fe2009-12-26 11:51:00 +00001078 case LLC_OPT_PKTINFO:
1079 if (opt)
1080 llc->cmsg_flags |= LLC_CMSG_PKTINFO;
1081 else
1082 llc->cmsg_flags &= ~LLC_CMSG_PKTINFO;
1083 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001084 default:
1085 rc = -ENOPROTOOPT;
1086 goto out;
1087 }
1088 rc = 0;
1089out:
1090 release_sock(sk);
1091 return rc;
1092}
1093
1094/**
1095 * llc_ui_getsockopt - get connection specific socket info
1096 * @sock: Socket to get information from.
1097 * @level: Socket level user is requesting operations on.
1098 * @optname: Operation name.
1099 * @optval: Variable to return operation data in.
1100 * @optlen: Length of optval.
1101 *
1102 * Get connection specific socket information.
1103 */
1104static int llc_ui_getsockopt(struct socket *sock, int level, int optname,
1105 char __user *optval, int __user *optlen)
1106{
1107 struct sock *sk = sock->sk;
1108 struct llc_sock *llc = llc_sk(sk);
1109 int val = 0, len = 0, rc = -EINVAL;
1110
1111 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -03001112 if (unlikely(level != SOL_LLC))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001113 goto out;
1114 rc = get_user(len, optlen);
1115 if (rc)
1116 goto out;
1117 rc = -EINVAL;
1118 if (len != sizeof(int))
1119 goto out;
1120 switch (optname) {
1121 case LLC_OPT_RETRY:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001122 val = llc->n2; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001123 case LLC_OPT_SIZE:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001124 val = llc->n1; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001125 case LLC_OPT_ACK_TMR_EXP:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001126 val = llc->ack_timer.expire / HZ; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001127 case LLC_OPT_P_TMR_EXP:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001128 val = llc->pf_cycle_timer.expire / HZ; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001129 case LLC_OPT_REJ_TMR_EXP:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001130 val = llc->rej_sent_timer.expire / HZ; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001131 case LLC_OPT_BUSY_TMR_EXP:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001132 val = llc->busy_state_timer.expire / HZ; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001133 case LLC_OPT_TX_WIN:
1134 val = llc->k; break;
1135 case LLC_OPT_RX_WIN:
1136 val = llc->rw; break;
Octavian Purdilae5cd6fe2009-12-26 11:51:00 +00001137 case LLC_OPT_PKTINFO:
1138 val = (llc->cmsg_flags & LLC_CMSG_PKTINFO) != 0;
1139 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001140 default:
1141 rc = -ENOPROTOOPT;
1142 goto out;
1143 }
1144 rc = 0;
1145 if (put_user(len, optlen) || copy_to_user(optval, &val, len))
1146 rc = -EFAULT;
1147out:
1148 release_sock(sk);
1149 return rc;
1150}
1151
Stephen Hemmingerec1b4cf2009-10-05 05:58:39 +00001152static const struct net_proto_family llc_ui_family_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001153 .family = PF_LLC,
1154 .create = llc_ui_create,
1155 .owner = THIS_MODULE,
1156};
1157
Eric Dumazet90ddc4f2005-12-22 12:49:22 -08001158static const struct proto_ops llc_ui_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001159 .family = PF_LLC,
1160 .owner = THIS_MODULE,
1161 .release = llc_ui_release,
1162 .bind = llc_ui_bind,
1163 .connect = llc_ui_connect,
1164 .socketpair = sock_no_socketpair,
1165 .accept = llc_ui_accept,
1166 .getname = llc_ui_getname,
1167 .poll = datagram_poll,
1168 .ioctl = llc_ui_ioctl,
1169 .listen = llc_ui_listen,
1170 .shutdown = llc_ui_shutdown,
1171 .setsockopt = llc_ui_setsockopt,
1172 .getsockopt = llc_ui_getsockopt,
1173 .sendmsg = llc_ui_sendmsg,
1174 .recvmsg = llc_ui_recvmsg,
1175 .mmap = sock_no_mmap,
1176 .sendpage = sock_no_sendpage,
1177};
1178
Stephen Hemminger01af4a02009-02-22 00:02:44 -08001179static const char llc_proc_err_msg[] __initconst =
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +09001180 KERN_CRIT "LLC: Unable to register the proc_fs entries\n";
Stephen Hemminger01af4a02009-02-22 00:02:44 -08001181static const char llc_sysctl_err_msg[] __initconst =
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +09001182 KERN_CRIT "LLC: Unable to register the sysctl entries\n";
Stephen Hemminger01af4a02009-02-22 00:02:44 -08001183static const char llc_sock_err_msg[] __initconst =
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +09001184 KERN_CRIT "LLC: Unable to register the network family\n";
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001185
Linus Torvalds1da177e2005-04-16 15:20:36 -07001186static int __init llc2_init(void)
1187{
1188 int rc = proto_register(&llc_proto, 0);
1189
1190 if (rc != 0)
1191 goto out;
1192
1193 llc_build_offset_table();
1194 llc_station_init();
1195 llc_ui_sap_last_autoport = LLC_SAP_DYN_START;
1196 rc = llc_proc_init();
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001197 if (rc != 0) {
1198 printk(llc_proc_err_msg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001199 goto out_unregister_llc_proto;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001200 }
1201 rc = llc_sysctl_init();
1202 if (rc) {
1203 printk(llc_sysctl_err_msg);
1204 goto out_proc;
1205 }
1206 rc = sock_register(&llc_ui_family_ops);
1207 if (rc) {
1208 printk(llc_sock_err_msg);
1209 goto out_sysctl;
1210 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001211 llc_add_pack(LLC_DEST_SAP, llc_sap_handler);
1212 llc_add_pack(LLC_DEST_CONN, llc_conn_handler);
1213out:
1214 return rc;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001215out_sysctl:
1216 llc_sysctl_exit();
1217out_proc:
1218 llc_proc_exit();
Linus Torvalds1da177e2005-04-16 15:20:36 -07001219out_unregister_llc_proto:
1220 proto_unregister(&llc_proto);
1221 goto out;
1222}
1223
1224static void __exit llc2_exit(void)
1225{
1226 llc_station_exit();
1227 llc_remove_pack(LLC_DEST_SAP);
1228 llc_remove_pack(LLC_DEST_CONN);
1229 sock_unregister(PF_LLC);
1230 llc_proc_exit();
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001231 llc_sysctl_exit();
Linus Torvalds1da177e2005-04-16 15:20:36 -07001232 proto_unregister(&llc_proto);
1233}
1234
1235module_init(llc2_init);
1236module_exit(llc2_exit);
1237
1238MODULE_LICENSE("GPL");
1239MODULE_AUTHOR("Procom 1997, Jay Schullist 2001, Arnaldo C. Melo 2001-2003");
1240MODULE_DESCRIPTION("IEEE 802.2 PF_LLC support");
1241MODULE_ALIAS_NETPROTO(PF_LLC);