blob: 9208cf5f2bd554fb4d66fba51c327bcc3d7a5aae [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
50/**
51 * llc_ui_next_link_no - return the next unused link number for a sap
52 * @sap: Address of sap to get link number from.
53 *
54 * Return the next unused link number for a given sap.
55 */
Arnaldo Carvalho de Melo2342c992006-03-20 21:27:43 -080056static inline u16 llc_ui_next_link_no(int sap)
Linus Torvalds1da177e2005-04-16 15:20:36 -070057{
58 return llc_ui_sap_link_no_max[sap]++;
59}
60
61/**
62 * llc_proto_type - return eth protocol for ARP header type
63 * @arphrd: ARP header type.
64 *
65 * Given an ARP header type return the corresponding ethernet protocol.
66 */
Al Viro3fbd4182006-11-08 00:26:05 -080067static inline __be16 llc_proto_type(u16 arphrd)
Linus Torvalds1da177e2005-04-16 15:20:36 -070068{
69 return arphrd == ARPHRD_IEEE802_TR ?
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +090070 htons(ETH_P_TR_802_2) : htons(ETH_P_802_2);
Linus Torvalds1da177e2005-04-16 15:20:36 -070071}
72
73/**
74 * llc_ui_addr_null - determines if a address structure is null
75 * @addr: Address to test if null.
76 */
Arnaldo Carvalho de Melo2342c992006-03-20 21:27:43 -080077static inline u8 llc_ui_addr_null(struct sockaddr_llc *addr)
Linus Torvalds1da177e2005-04-16 15:20:36 -070078{
79 return !memcmp(addr, &llc_ui_addrnull, sizeof(*addr));
80}
81
82/**
83 * llc_ui_header_len - return length of llc header based on operation
84 * @sk: Socket which contains a valid llc socket type.
85 * @addr: Complete sockaddr_llc structure received from the user.
86 *
87 * Provide the length of the llc header depending on what kind of
88 * operation the user would like to perform and the type of socket.
89 * Returns the correct llc header length.
90 */
Arnaldo Carvalho de Melo2342c992006-03-20 21:27:43 -080091static inline u8 llc_ui_header_len(struct sock *sk, struct sockaddr_llc *addr)
Linus Torvalds1da177e2005-04-16 15:20:36 -070092{
93 u8 rc = LLC_PDU_LEN_U;
94
95 if (addr->sllc_test || addr->sllc_xid)
96 rc = LLC_PDU_LEN_U;
97 else if (sk->sk_type == SOCK_STREAM)
98 rc = LLC_PDU_LEN_I;
99 return rc;
100}
101
102/**
103 * llc_ui_send_data - send data via reliable llc2 connection
104 * @sk: Connection the socket is using.
105 * @skb: Data the user wishes to send.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700106 * @noblock: can we block waiting for data?
107 *
108 * Send data via reliable llc2 connection.
109 * Returns 0 upon success, non-zero if action did not succeed.
110 */
111static int llc_ui_send_data(struct sock* sk, struct sk_buff *skb, int noblock)
112{
113 struct llc_sock* llc = llc_sk(sk);
114 int rc = 0;
115
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900116 if (unlikely(llc_data_accept_state(llc->state) ||
Jochen Friedrich451677c2005-11-14 21:57:46 -0800117 llc->remote_busy_flag ||
118 llc->p_flag)) {
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300119 long timeout = sock_sndtimeo(sk, noblock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700120
121 rc = llc_ui_wait_for_busy_core(sk, timeout);
122 }
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300123 if (unlikely(!rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700124 rc = llc_build_and_send_pkt(sk, skb);
125 return rc;
126}
127
128static void llc_ui_sk_init(struct socket *sock, struct sock *sk)
129{
David S. Milleree5850d2008-06-17 01:21:03 -0700130 sock_graft(sk, sock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700131 sk->sk_type = sock->type;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700132 sock->ops = &llc_ui_ops;
133}
134
135static struct proto llc_proto = {
Arnaldo Carvalho de Melo9c005e02006-03-20 21:27:23 -0800136 .name = "LLC",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700137 .owner = THIS_MODULE,
138 .obj_size = sizeof(struct llc_sock),
139};
140
141/**
142 * llc_ui_create - alloc and init a new llc_ui socket
143 * @sock: Socket to initialize and attach allocated sk to.
144 * @protocol: Unused.
145 *
146 * Allocate and initialize a new llc_ui socket, validate the user wants a
147 * socket type we have available.
148 * Returns 0 upon success, negative upon failure.
149 */
Eric W. Biederman1b8d7ae2007-10-08 23:24:22 -0700150static int llc_ui_create(struct net *net, struct socket *sock, int protocol)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700151{
152 struct sock *sk;
153 int rc = -ESOCKTNOSUPPORT;
154
Patrick McHardy3480c632008-03-27 20:28:10 -0700155 if (!capable(CAP_NET_RAW))
156 return -EPERM;
157
Eric W. Biederman1b8d7ae2007-10-08 23:24:22 -0700158 if (net != &init_net)
159 return -EAFNOSUPPORT;
160
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300161 if (likely(sock->type == SOCK_DGRAM || sock->type == SOCK_STREAM)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700162 rc = -ENOMEM;
Eric W. Biederman1b8d7ae2007-10-08 23:24:22 -0700163 sk = llc_sk_alloc(net, PF_LLC, GFP_KERNEL, &llc_proto);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700164 if (sk) {
165 rc = 0;
166 llc_ui_sk_init(sock, sk);
167 }
168 }
169 return rc;
170}
171
172/**
173 * llc_ui_release - shutdown socket
174 * @sock: Socket to release.
175 *
176 * Shutdown and deallocate an existing socket.
177 */
178static int llc_ui_release(struct socket *sock)
179{
180 struct sock *sk = sock->sk;
181 struct llc_sock *llc;
182
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300183 if (unlikely(sk == NULL))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700184 goto out;
185 sock_hold(sk);
186 lock_sock(sk);
187 llc = llc_sk(sk);
Harvey Harrison0dc47872008-03-05 20:47:47 -0800188 dprintk("%s: closing local(%02X) remote(%02X)\n", __func__,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700189 llc->laddr.lsap, llc->daddr.lsap);
190 if (!llc_send_disc(sk))
191 llc_ui_wait_for_disc(sk, sk->sk_rcvtimeo);
Arnaldo Carvalho de Melo2e1f47c2006-03-20 21:28:11 -0800192 if (!sock_flag(sk, SOCK_ZAPPED)) {
193 llc_sap_put(llc->sap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700194 llc_sap_remove_socket(llc->sap, sk);
Arnaldo Carvalho de Melo2e1f47c2006-03-20 21:28:11 -0800195 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700196 release_sock(sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700197 if (llc->dev)
198 dev_put(llc->dev);
199 sock_put(sk);
200 llc_sk_free(sk);
201out:
202 return 0;
203}
204
205/**
206 * llc_ui_autoport - provide dynamically allocate SAP number
207 *
208 * Provide the caller with a dynamically allocated SAP number according
209 * to the rules that are set in this function. Returns: 0, upon failure,
210 * SAP number otherwise.
211 */
212static int llc_ui_autoport(void)
213{
214 struct llc_sap *sap;
215 int i, tries = 0;
216
217 while (tries < LLC_SAP_DYN_TRIES) {
218 for (i = llc_ui_sap_last_autoport;
219 i < LLC_SAP_DYN_STOP; i += 2) {
220 sap = llc_sap_find(i);
221 if (!sap) {
222 llc_ui_sap_last_autoport = i + 2;
223 goto out;
224 }
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -0300225 llc_sap_put(sap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700226 }
227 llc_ui_sap_last_autoport = LLC_SAP_DYN_START;
228 tries++;
229 }
230 i = 0;
231out:
232 return i;
233}
234
235/**
Arnaldo Carvalho de Melo5a770c02005-09-22 03:56:26 -0300236 * llc_ui_autobind - automatically bind a socket to a sap
237 * @sock: socket to bind
238 * @addr: address to connect to
Linus Torvalds1da177e2005-04-16 15:20:36 -0700239 *
Arnaldo Carvalho de Melo5a770c02005-09-22 03:56:26 -0300240 * Used by llc_ui_connect and llc_ui_sendmsg when the user hasn't
241 * specifically used llc_ui_bind to bind to an specific address/sap
242 *
Linus Torvalds1da177e2005-04-16 15:20:36 -0700243 * Returns: 0 upon success, negative otherwise.
244 */
245static int llc_ui_autobind(struct socket *sock, struct sockaddr_llc *addr)
246{
247 struct sock *sk = sock->sk;
248 struct llc_sock *llc = llc_sk(sk);
249 struct llc_sap *sap;
250 int rc = -EINVAL;
251
252 if (!sock_flag(sk, SOCK_ZAPPED))
253 goto out;
254 rc = -ENODEV;
Eric W. Biederman881d9662007-09-17 11:56:21 -0700255 llc->dev = dev_getfirstbyhwtype(&init_net, addr->sllc_arphrd);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700256 if (!llc->dev)
257 goto out;
258 rc = -EUSERS;
259 llc->laddr.lsap = llc_ui_autoport();
260 if (!llc->laddr.lsap)
261 goto out;
262 rc = -EBUSY; /* some other network layer is using the sap */
263 sap = llc_sap_open(llc->laddr.lsap, NULL);
264 if (!sap)
265 goto out;
266 memcpy(llc->laddr.mac, llc->dev->dev_addr, IFHWADDRLEN);
267 memcpy(&llc->addr, addr, sizeof(llc->addr));
268 /* assign new connection to its SAP */
269 llc_sap_add_socket(sap, sk);
270 sock_reset_flag(sk, SOCK_ZAPPED);
271 rc = 0;
272out:
273 return rc;
274}
275
276/**
277 * llc_ui_bind - bind a socket to a specific address.
278 * @sock: Socket to bind an address to.
279 * @uaddr: Address the user wants the socket bound to.
280 * @addrlen: Length of the uaddr structure.
281 *
282 * 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 -0300283 * a specific sap only or mac + sap.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700284 * If the user desires to bind to a specific mac + sap, it is possible to
285 * have multiple sap connections via multiple macs.
286 * Bind and autobind for that matter must enforce the correct sap usage
287 * otherwise all hell will break loose.
288 * Returns: 0 upon success, negative otherwise.
289 */
290static int llc_ui_bind(struct socket *sock, struct sockaddr *uaddr, int addrlen)
291{
292 struct sockaddr_llc *addr = (struct sockaddr_llc *)uaddr;
293 struct sock *sk = sock->sk;
294 struct llc_sock *llc = llc_sk(sk);
295 struct llc_sap *sap;
296 int rc = -EINVAL;
297
Harvey Harrison0dc47872008-03-05 20:47:47 -0800298 dprintk("%s: binding %02X\n", __func__, addr->sllc_sap);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300299 if (unlikely(!sock_flag(sk, SOCK_ZAPPED) || addrlen != sizeof(*addr)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700300 goto out;
301 rc = -EAFNOSUPPORT;
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300302 if (unlikely(addr->sllc_family != AF_LLC))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700303 goto out;
Jochen Friedrichcf309e32005-09-22 04:44:55 -0300304 rc = -ENODEV;
305 rtnl_lock();
Eric W. Biederman881d9662007-09-17 11:56:21 -0700306 llc->dev = dev_getbyhwaddr(&init_net, addr->sllc_arphrd, addr->sllc_mac);
Jochen Friedrichcf309e32005-09-22 04:44:55 -0300307 rtnl_unlock();
308 if (!llc->dev)
309 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700310 if (!addr->sllc_sap) {
311 rc = -EUSERS;
312 addr->sllc_sap = llc_ui_autoport();
313 if (!addr->sllc_sap)
314 goto out;
315 }
316 sap = llc_sap_find(addr->sllc_sap);
317 if (!sap) {
318 sap = llc_sap_open(addr->sllc_sap, NULL);
319 rc = -EBUSY; /* some other network layer is using the sap */
320 if (!sap)
321 goto out;
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -0300322 llc_sap_hold(sap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700323 } else {
324 struct llc_addr laddr, daddr;
325 struct sock *ask;
326
327 memset(&laddr, 0, sizeof(laddr));
328 memset(&daddr, 0, sizeof(daddr));
329 /*
Michael Opdenacker59c51592007-05-09 08:57:56 +0200330 * FIXME: check if the address is multicast,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700331 * only SOCK_DGRAM can do this.
332 */
333 memcpy(laddr.mac, addr->sllc_mac, IFHWADDRLEN);
334 laddr.lsap = addr->sllc_sap;
335 rc = -EADDRINUSE; /* mac + sap clash. */
336 ask = llc_lookup_established(sap, &daddr, &laddr);
337 if (ask) {
338 sock_put(ask);
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -0300339 goto out_put;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700340 }
341 }
342 llc->laddr.lsap = addr->sllc_sap;
343 memcpy(llc->laddr.mac, addr->sllc_mac, IFHWADDRLEN);
344 memcpy(&llc->addr, addr, sizeof(llc->addr));
345 /* assign new connection to its SAP */
346 llc_sap_add_socket(sap, sk);
347 sock_reset_flag(sk, SOCK_ZAPPED);
348 rc = 0;
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -0300349out_put:
350 llc_sap_put(sap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700351out:
352 return rc;
353}
354
355/**
356 * llc_ui_shutdown - shutdown a connect llc2 socket.
357 * @sock: Socket to shutdown.
358 * @how: What part of the socket to shutdown.
359 *
360 * Shutdown a connected llc2 socket. Currently this function only supports
361 * shutting down both sends and receives (2), we could probably make this
362 * function such that a user can shutdown only half the connection but not
363 * right now.
364 * Returns: 0 upon success, negative otherwise.
365 */
366static int llc_ui_shutdown(struct socket *sock, int how)
367{
368 struct sock *sk = sock->sk;
369 int rc = -ENOTCONN;
370
371 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300372 if (unlikely(sk->sk_state != TCP_ESTABLISHED))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700373 goto out;
374 rc = -EINVAL;
375 if (how != 2)
376 goto out;
377 rc = llc_send_disc(sk);
378 if (!rc)
379 rc = llc_ui_wait_for_disc(sk, sk->sk_rcvtimeo);
380 /* Wake up anyone sleeping in poll */
381 sk->sk_state_change(sk);
382out:
383 release_sock(sk);
384 return rc;
385}
386
387/**
388 * llc_ui_connect - Connect to a remote llc2 mac + sap.
389 * @sock: Socket which will be connected to the remote destination.
390 * @uaddr: Remote and possibly the local address of the new connection.
391 * @addrlen: Size of uaddr structure.
392 * @flags: Operational flags specified by the user.
393 *
394 * Connect to a remote llc2 mac + sap. The caller must specify the
395 * destination mac and address to connect to. If the user hasn't previously
396 * called bind(2) with a smac the address of the first interface of the
397 * specified arp type will be used.
398 * This function will autobind if user did not previously call bind.
399 * Returns: 0 upon success, negative otherwise.
400 */
401static int llc_ui_connect(struct socket *sock, struct sockaddr *uaddr,
402 int addrlen, int flags)
403{
404 struct sock *sk = sock->sk;
405 struct llc_sock *llc = llc_sk(sk);
406 struct sockaddr_llc *addr = (struct sockaddr_llc *)uaddr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700407 int rc = -EINVAL;
408
409 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300410 if (unlikely(addrlen != sizeof(*addr)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700411 goto out;
412 rc = -EAFNOSUPPORT;
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300413 if (unlikely(addr->sllc_family != AF_LLC))
414 goto out;
415 if (unlikely(sk->sk_type != SOCK_STREAM))
416 goto out;
417 rc = -EALREADY;
418 if (unlikely(sock->state == SS_CONNECTING))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700419 goto out;
420 /* bind connection to sap if user hasn't done it. */
421 if (sock_flag(sk, SOCK_ZAPPED)) {
422 /* bind to sap with null dev, exclusive */
423 rc = llc_ui_autobind(sock, addr);
424 if (rc)
425 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700426 }
Jochen Friedrich5564af22005-09-22 04:46:44 -0300427 llc->daddr.lsap = addr->sllc_sap;
428 memcpy(llc->daddr.mac, addr->sllc_mac, IFHWADDRLEN);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700429 sock->state = SS_CONNECTING;
430 sk->sk_state = TCP_SYN_SENT;
431 llc->link = llc_ui_next_link_no(llc->sap->laddr.lsap);
Arnaldo Carvalho de Melo774ccb42005-09-22 03:53:35 -0300432 rc = llc_establish_connection(sk, llc->dev->dev_addr,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700433 addr->sllc_mac, addr->sllc_sap);
434 if (rc) {
Harvey Harrison0dc47872008-03-05 20:47:47 -0800435 dprintk("%s: llc_ui_send_conn failed :-(\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700436 sock->state = SS_UNCONNECTED;
437 sk->sk_state = TCP_CLOSE;
438 goto out;
439 }
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300440
441 if (sk->sk_state == TCP_SYN_SENT) {
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300442 const long timeo = sock_sndtimeo(sk, flags & O_NONBLOCK);
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300443
444 if (!timeo || !llc_ui_wait_for_conn(sk, timeo))
445 goto out;
446
447 rc = sock_intr_errno(timeo);
448 if (signal_pending(current))
449 goto out;
450 }
451
452 if (sk->sk_state == TCP_CLOSE)
453 goto sock_error;
454
455 sock->state = SS_CONNECTED;
456 rc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700457out:
458 release_sock(sk);
459 return rc;
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300460sock_error:
461 rc = sock_error(sk) ? : -ECONNABORTED;
462 sock->state = SS_UNCONNECTED;
463 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700464}
465
466/**
467 * llc_ui_listen - allow a normal socket to accept incoming connections
468 * @sock: Socket to allow incoming connections on.
469 * @backlog: Number of connections to queue.
470 *
471 * Allow a normal socket to accept incoming connections.
472 * Returns 0 upon success, negative otherwise.
473 */
474static int llc_ui_listen(struct socket *sock, int backlog)
475{
476 struct sock *sk = sock->sk;
477 int rc = -EINVAL;
478
479 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300480 if (unlikely(sock->state != SS_UNCONNECTED))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700481 goto out;
482 rc = -EOPNOTSUPP;
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300483 if (unlikely(sk->sk_type != SOCK_STREAM))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700484 goto out;
485 rc = -EAGAIN;
486 if (sock_flag(sk, SOCK_ZAPPED))
487 goto out;
488 rc = 0;
489 if (!(unsigned)backlog) /* BSDism */
490 backlog = 1;
491 sk->sk_max_ack_backlog = backlog;
492 if (sk->sk_state != TCP_LISTEN) {
493 sk->sk_ack_backlog = 0;
494 sk->sk_state = TCP_LISTEN;
495 }
496 sk->sk_socket->flags |= __SO_ACCEPTCON;
497out:
498 release_sock(sk);
499 return rc;
500}
501
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300502static int llc_ui_wait_for_disc(struct sock *sk, long timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700503{
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300504 DEFINE_WAIT(wait);
505 int rc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700506
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300507 while (1) {
508 prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE);
509 if (sk_wait_event(sk, &timeout, sk->sk_state == TCP_CLOSE))
510 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700511 rc = -ERESTARTSYS;
512 if (signal_pending(current))
513 break;
514 rc = -EAGAIN;
515 if (!timeout)
516 break;
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300517 rc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700518 }
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300519 finish_wait(sk->sk_sleep, &wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700520 return rc;
521}
522
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300523static int llc_ui_wait_for_conn(struct sock *sk, long timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700524{
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300525 DEFINE_WAIT(wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700526
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300527 while (1) {
528 prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE);
529 if (sk_wait_event(sk, &timeout, sk->sk_state != TCP_SYN_SENT))
530 break;
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300531 if (signal_pending(current) || !timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700532 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700533 }
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300534 finish_wait(sk->sk_sleep, &wait);
535 return timeout;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700536}
537
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300538static int llc_ui_wait_for_busy_core(struct sock *sk, long timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700539{
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300540 DEFINE_WAIT(wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700541 struct llc_sock *llc = llc_sk(sk);
542 int rc;
543
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300544 while (1) {
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300545 prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700546 rc = 0;
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300547 if (sk_wait_event(sk, &timeout,
548 (sk->sk_shutdown & RCV_SHUTDOWN) ||
549 (!llc_data_accept_state(llc->state) &&
Jochen Friedrich451677c2005-11-14 21:57:46 -0800550 !llc->remote_busy_flag &&
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300551 !llc->p_flag)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700552 break;
553 rc = -ERESTARTSYS;
554 if (signal_pending(current))
555 break;
556 rc = -EAGAIN;
557 if (!timeout)
558 break;
559 }
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300560 finish_wait(sk->sk_sleep, &wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700561 return rc;
562}
563
Arnaldo Carvalho de Melo2928c192005-09-22 05:14:33 -0300564static int llc_wait_data(struct sock *sk, long timeo)
Arnaldo Carvalho de Meloafdbe352005-09-22 04:37:07 -0300565{
566 int rc;
567
568 while (1) {
569 /*
570 * POSIX 1003.1g mandates this order.
571 */
Benjamin LaHaisec1cbe4b2005-12-13 23:22:19 -0800572 rc = sock_error(sk);
573 if (rc)
Arnaldo Carvalho de Meloafdbe352005-09-22 04:37:07 -0300574 break;
Arnaldo Carvalho de Meloafdbe352005-09-22 04:37:07 -0300575 rc = 0;
576 if (sk->sk_shutdown & RCV_SHUTDOWN)
577 break;
578 rc = -EAGAIN;
579 if (!timeo)
580 break;
581 rc = sock_intr_errno(timeo);
582 if (signal_pending(current))
583 break;
584 rc = 0;
585 if (sk_wait_data(sk, &timeo))
586 break;
587 }
588 return rc;
589}
590
Linus Torvalds1da177e2005-04-16 15:20:36 -0700591/**
592 * llc_ui_accept - accept a new incoming connection.
593 * @sock: Socket which connections arrive on.
594 * @newsock: Socket to move incoming connection to.
595 * @flags: User specified operational flags.
596 *
597 * Accept a new incoming connection.
598 * Returns 0 upon success, negative otherwise.
599 */
600static int llc_ui_accept(struct socket *sock, struct socket *newsock, int flags)
601{
602 struct sock *sk = sock->sk, *newsk;
603 struct llc_sock *llc, *newllc;
604 struct sk_buff *skb;
605 int rc = -EOPNOTSUPP;
606
Harvey Harrison0dc47872008-03-05 20:47:47 -0800607 dprintk("%s: accepting on %02X\n", __func__,
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900608 llc_sk(sk)->laddr.lsap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700609 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300610 if (unlikely(sk->sk_type != SOCK_STREAM))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700611 goto out;
612 rc = -EINVAL;
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300613 if (unlikely(sock->state != SS_UNCONNECTED ||
614 sk->sk_state != TCP_LISTEN))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700615 goto out;
616 /* wait for a connection to arrive. */
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300617 if (skb_queue_empty(&sk->sk_receive_queue)) {
Arnaldo Carvalho de Meloafdbe352005-09-22 04:37:07 -0300618 rc = llc_wait_data(sk, sk->sk_rcvtimeo);
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300619 if (rc)
620 goto out;
621 }
Harvey Harrison0dc47872008-03-05 20:47:47 -0800622 dprintk("%s: got a new connection on %02X\n", __func__,
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900623 llc_sk(sk)->laddr.lsap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700624 skb = skb_dequeue(&sk->sk_receive_queue);
625 rc = -EINVAL;
626 if (!skb->sk)
627 goto frees;
628 rc = 0;
629 newsk = skb->sk;
630 /* attach connection to a new socket. */
631 llc_ui_sk_init(newsock, newsk);
632 sock_reset_flag(newsk, SOCK_ZAPPED);
633 newsk->sk_state = TCP_ESTABLISHED;
634 newsock->state = SS_CONNECTED;
635 llc = llc_sk(sk);
636 newllc = llc_sk(newsk);
637 memcpy(&newllc->addr, &llc->addr, sizeof(newllc->addr));
638 newllc->link = llc_ui_next_link_no(newllc->laddr.lsap);
639
640 /* put original socket back into a clean listen state. */
641 sk->sk_state = TCP_LISTEN;
642 sk->sk_ack_backlog--;
Harvey Harrison0dc47872008-03-05 20:47:47 -0800643 dprintk("%s: ok success on %02X, client on %02X\n", __func__,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700644 llc_sk(sk)->addr.sllc_sap, newllc->daddr.lsap);
645frees:
646 kfree_skb(skb);
647out:
648 release_sock(sk);
649 return rc;
650}
651
652/**
653 * llc_ui_recvmsg - copy received data to the socket user.
654 * @sock: Socket to copy data from.
655 * @msg: Various user space related information.
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300656 * @len: Size of user buffer.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700657 * @flags: User specified flags.
658 *
659 * Copy received data to the socket user.
660 * Returns non-negative upon success, negative otherwise.
661 */
662static int llc_ui_recvmsg(struct kiocb *iocb, struct socket *sock,
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300663 struct msghdr *msg, size_t len, int flags)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700664{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700665 struct sockaddr_llc *uaddr = (struct sockaddr_llc *)msg->msg_name;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300666 const int nonblock = flags & MSG_DONTWAIT;
667 struct sk_buff *skb = NULL;
668 struct sock *sk = sock->sk;
669 struct llc_sock *llc = llc_sk(sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700670 size_t copied = 0;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300671 u32 peek_seq = 0;
672 u32 *seq;
673 unsigned long used;
674 int target; /* Read at least this many bytes */
675 long timeo;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700676
Linus Torvalds1da177e2005-04-16 15:20:36 -0700677 lock_sock(sk);
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300678 copied = -ENOTCONN;
Stephen Hemminger29efcd22006-05-25 15:08:59 -0700679 if (unlikely(sk->sk_type == SOCK_STREAM && sk->sk_state == TCP_LISTEN))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700680 goto out;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300681
682 timeo = sock_rcvtimeo(sk, nonblock);
683
684 seq = &llc->copied_seq;
685 if (flags & MSG_PEEK) {
686 peek_seq = llc->copied_seq;
687 seq = &peek_seq;
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900688 }
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300689
690 target = sock_rcvlowat(sk, flags & MSG_WAITALL, len);
691 copied = 0;
692
693 do {
694 u32 offset;
695
696 /*
697 * We need to check signals first, to get correct SIGURG
698 * handling. FIXME: Need to check this doesn't impact 1003.1g
699 * and move it down to the bottom of the loop
700 */
701 if (signal_pending(current)) {
702 if (copied)
703 break;
704 copied = timeo ? sock_intr_errno(timeo) : -EAGAIN;
705 break;
706 }
707
708 /* Next get a buffer. */
709
710 skb = skb_peek(&sk->sk_receive_queue);
711 if (skb) {
712 offset = *seq;
713 goto found_ok_skb;
714 }
715 /* Well, if we have backlog, try to process it now yet. */
716
717 if (copied >= target && !sk->sk_backlog.tail)
718 break;
719
720 if (copied) {
721 if (sk->sk_err ||
722 sk->sk_state == TCP_CLOSE ||
723 (sk->sk_shutdown & RCV_SHUTDOWN) ||
724 !timeo ||
725 (flags & MSG_PEEK))
726 break;
727 } else {
728 if (sock_flag(sk, SOCK_DONE))
729 break;
730
731 if (sk->sk_err) {
732 copied = sock_error(sk);
733 break;
734 }
735 if (sk->sk_shutdown & RCV_SHUTDOWN)
736 break;
737
Stephen Hemminger29efcd22006-05-25 15:08:59 -0700738 if (sk->sk_type == SOCK_STREAM && sk->sk_state == TCP_CLOSE) {
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300739 if (!sock_flag(sk, SOCK_DONE)) {
740 /*
741 * This occurs when user tries to read
742 * from never connected socket.
743 */
744 copied = -ENOTCONN;
745 break;
746 }
747 break;
748 }
749 if (!timeo) {
750 copied = -EAGAIN;
751 break;
752 }
753 }
754
755 if (copied >= target) { /* Do not sleep, just process backlog. */
756 release_sock(sk);
757 lock_sock(sk);
758 } else
759 sk_wait_data(sk, &timeo);
760
761 if ((flags & MSG_PEEK) && peek_seq != llc->copied_seq) {
762 if (net_ratelimit())
763 printk(KERN_DEBUG "LLC(%s:%d): Application "
764 "bug, race in MSG_PEEK.\n",
Pavel Emelyanovba25f9d2007-10-18 23:40:40 -0700765 current->comm, task_pid_nr(current));
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300766 peek_seq = llc->copied_seq;
767 }
768 continue;
769 found_ok_skb:
770 /* Ok so how much can we use? */
771 used = skb->len - offset;
772 if (len < used)
773 used = len;
774
775 if (!(flags & MSG_TRUNC)) {
776 int rc = skb_copy_datagram_iovec(skb, offset,
777 msg->msg_iov, used);
778 if (rc) {
779 /* Exception. Bailout! */
780 if (!copied)
781 copied = -EFAULT;
782 break;
783 }
784 }
785
786 *seq += used;
787 copied += used;
788 len -= used;
789
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300790 if (!(flags & MSG_PEEK)) {
Chris Leech624d1162006-05-23 18:01:28 -0700791 sk_eat_skb(sk, skb, 0);
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300792 *seq = 0;
793 }
Stephen Hemminger30a584d2006-08-03 16:38:49 -0700794
795 /* For non stream protcols we get one packet per recvmsg call */
796 if (sk->sk_type != SOCK_STREAM)
797 goto copy_uaddr;
798
799 /* Partial read */
800 if (used + offset < skb->len)
801 continue;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300802 } while (len > 0);
803
Linus Torvalds1da177e2005-04-16 15:20:36 -0700804out:
805 release_sock(sk);
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300806 return copied;
807copy_uaddr:
808 if (uaddr != NULL && skb != NULL) {
809 memcpy(uaddr, llc_ui_skb_cb(skb), sizeof(*uaddr));
810 msg->msg_namelen = sizeof(*uaddr);
811 }
812 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700813}
814
815/**
816 * llc_ui_sendmsg - Transmit data provided by the socket user.
817 * @sock: Socket to transmit data from.
818 * @msg: Various user related information.
819 * @len: Length of data to transmit.
820 *
821 * Transmit data provided by the socket user.
822 * Returns non-negative upon success, negative otherwise.
823 */
824static int llc_ui_sendmsg(struct kiocb *iocb, struct socket *sock,
825 struct msghdr *msg, size_t len)
826{
827 struct sock *sk = sock->sk;
828 struct llc_sock *llc = llc_sk(sk);
829 struct sockaddr_llc *addr = (struct sockaddr_llc *)msg->msg_name;
830 int flags = msg->msg_flags;
831 int noblock = flags & MSG_DONTWAIT;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700832 struct sk_buff *skb;
833 size_t size = 0;
834 int rc = -EINVAL, copied = 0, hdrlen;
835
Harvey Harrison0dc47872008-03-05 20:47:47 -0800836 dprintk("%s: sending from %02X to %02X\n", __func__,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700837 llc->laddr.lsap, llc->daddr.lsap);
838 lock_sock(sk);
839 if (addr) {
840 if (msg->msg_namelen < sizeof(*addr))
841 goto release;
842 } else {
843 if (llc_ui_addr_null(&llc->addr))
844 goto release;
845 addr = &llc->addr;
846 }
847 /* must bind connection to sap if user hasn't done it. */
848 if (sock_flag(sk, SOCK_ZAPPED)) {
849 /* bind to sap with null dev, exclusive. */
850 rc = llc_ui_autobind(sock, addr);
851 if (rc)
852 goto release;
853 }
Arnaldo Carvalho de Melo774ccb42005-09-22 03:53:35 -0300854 hdrlen = llc->dev->hard_header_len + llc_ui_header_len(sk, addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700855 size = hdrlen + len;
Arnaldo Carvalho de Melo774ccb42005-09-22 03:53:35 -0300856 if (size > llc->dev->mtu)
857 size = llc->dev->mtu;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700858 copied = size - hdrlen;
859 release_sock(sk);
860 skb = sock_alloc_send_skb(sk, size, noblock, &rc);
861 lock_sock(sk);
862 if (!skb)
863 goto release;
Arnaldo Carvalho de Melo774ccb42005-09-22 03:53:35 -0300864 skb->dev = llc->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700865 skb->protocol = llc_proto_type(addr->sllc_arphrd);
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900866 skb_reserve(skb, hdrlen);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700867 rc = memcpy_fromiovec(skb_put(skb, copied), msg->msg_iov, copied);
868 if (rc)
869 goto out;
870 if (sk->sk_type == SOCK_DGRAM || addr->sllc_ua) {
871 llc_build_and_send_ui_pkt(llc->sap, skb, addr->sllc_mac,
872 addr->sllc_sap);
873 goto out;
874 }
875 if (addr->sllc_test) {
876 llc_build_and_send_test_pkt(llc->sap, skb, addr->sllc_mac,
877 addr->sllc_sap);
878 goto out;
879 }
880 if (addr->sllc_xid) {
881 llc_build_and_send_xid_pkt(llc->sap, skb, addr->sllc_mac,
882 addr->sllc_sap);
883 goto out;
884 }
885 rc = -ENOPROTOOPT;
886 if (!(sk->sk_type == SOCK_STREAM && !addr->sllc_ua))
887 goto out;
888 rc = llc_ui_send_data(sk, skb, noblock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700889out:
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300890 if (rc) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700891 kfree_skb(skb);
892release:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700893 dprintk("%s: failed sending from %02X to %02X: %d\n",
Harvey Harrison0dc47872008-03-05 20:47:47 -0800894 __func__, llc->laddr.lsap, llc->daddr.lsap, rc);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300895 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700896 release_sock(sk);
897 return rc ? : copied;
898}
899
900/**
901 * llc_ui_getname - return the address info of a socket
902 * @sock: Socket to get address of.
903 * @uaddr: Address structure to return information.
904 * @uaddrlen: Length of address structure.
905 * @peer: Does user want local or remote address information.
906 *
907 * Return the address information of a socket.
908 */
909static int llc_ui_getname(struct socket *sock, struct sockaddr *uaddr,
910 int *uaddrlen, int peer)
911{
912 struct sockaddr_llc sllc;
913 struct sock *sk = sock->sk;
914 struct llc_sock *llc = llc_sk(sk);
915 int rc = 0;
916
917 lock_sock(sk);
918 if (sock_flag(sk, SOCK_ZAPPED))
919 goto out;
920 *uaddrlen = sizeof(sllc);
921 memset(uaddr, 0, *uaddrlen);
922 if (peer) {
923 rc = -ENOTCONN;
924 if (sk->sk_state != TCP_ESTABLISHED)
925 goto out;
926 if(llc->dev)
927 sllc.sllc_arphrd = llc->dev->type;
928 sllc.sllc_sap = llc->daddr.lsap;
929 memcpy(&sllc.sllc_mac, &llc->daddr.mac, IFHWADDRLEN);
930 } else {
931 rc = -EINVAL;
932 if (!llc->sap)
933 goto out;
934 sllc.sllc_sap = llc->sap->laddr.lsap;
935
936 if (llc->dev) {
937 sllc.sllc_arphrd = llc->dev->type;
Jiri Pirkoa186d2a2009-05-12 22:40:12 +0000938 memcpy(&sllc.sllc_mac, llc->dev->dev_addr,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700939 IFHWADDRLEN);
940 }
941 }
942 rc = 0;
943 sllc.sllc_family = AF_LLC;
944 memcpy(uaddr, &sllc, sizeof(sllc));
945out:
946 release_sock(sk);
947 return rc;
948}
949
950/**
951 * llc_ui_ioctl - io controls for PF_LLC
952 * @sock: Socket to get/set info
953 * @cmd: command
954 * @arg: optional argument for cmd
955 *
956 * get/set info on llc sockets
957 */
958static int llc_ui_ioctl(struct socket *sock, unsigned int cmd,
959 unsigned long arg)
960{
Christoph Hellwigb5e5fa52006-01-03 14:18:33 -0800961 return -ENOIOCTLCMD;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700962}
963
964/**
965 * llc_ui_setsockopt - set various connection specific parameters.
966 * @sock: Socket to set options on.
967 * @level: Socket level user is requesting operations on.
968 * @optname: Operation name.
969 * @optval User provided operation data.
970 * @optlen: Length of optval.
971 *
972 * Set various connection specific parameters.
973 */
974static int llc_ui_setsockopt(struct socket *sock, int level, int optname,
975 char __user *optval, int optlen)
976{
977 struct sock *sk = sock->sk;
978 struct llc_sock *llc = llc_sk(sk);
979 int rc = -EINVAL, opt;
980
981 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300982 if (unlikely(level != SOL_LLC || optlen != sizeof(int)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700983 goto out;
984 rc = get_user(opt, (int __user *)optval);
985 if (rc)
986 goto out;
987 rc = -EINVAL;
988 switch (optname) {
989 case LLC_OPT_RETRY:
990 if (opt > LLC_OPT_MAX_RETRY)
991 goto out;
992 llc->n2 = opt;
993 break;
994 case LLC_OPT_SIZE:
995 if (opt > LLC_OPT_MAX_SIZE)
996 goto out;
997 llc->n1 = opt;
998 break;
999 case LLC_OPT_ACK_TMR_EXP:
1000 if (opt > LLC_OPT_MAX_ACK_TMR_EXP)
1001 goto out;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001002 llc->ack_timer.expire = opt * HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001003 break;
1004 case LLC_OPT_P_TMR_EXP:
1005 if (opt > LLC_OPT_MAX_P_TMR_EXP)
1006 goto out;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001007 llc->pf_cycle_timer.expire = opt * HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001008 break;
1009 case LLC_OPT_REJ_TMR_EXP:
1010 if (opt > LLC_OPT_MAX_REJ_TMR_EXP)
1011 goto out;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001012 llc->rej_sent_timer.expire = opt * HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001013 break;
1014 case LLC_OPT_BUSY_TMR_EXP:
1015 if (opt > LLC_OPT_MAX_BUSY_TMR_EXP)
1016 goto out;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001017 llc->busy_state_timer.expire = opt * HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001018 break;
1019 case LLC_OPT_TX_WIN:
1020 if (opt > LLC_OPT_MAX_WIN)
1021 goto out;
1022 llc->k = opt;
1023 break;
1024 case LLC_OPT_RX_WIN:
1025 if (opt > LLC_OPT_MAX_WIN)
1026 goto out;
1027 llc->rw = opt;
1028 break;
1029 default:
1030 rc = -ENOPROTOOPT;
1031 goto out;
1032 }
1033 rc = 0;
1034out:
1035 release_sock(sk);
1036 return rc;
1037}
1038
1039/**
1040 * llc_ui_getsockopt - get connection specific socket info
1041 * @sock: Socket to get information from.
1042 * @level: Socket level user is requesting operations on.
1043 * @optname: Operation name.
1044 * @optval: Variable to return operation data in.
1045 * @optlen: Length of optval.
1046 *
1047 * Get connection specific socket information.
1048 */
1049static int llc_ui_getsockopt(struct socket *sock, int level, int optname,
1050 char __user *optval, int __user *optlen)
1051{
1052 struct sock *sk = sock->sk;
1053 struct llc_sock *llc = llc_sk(sk);
1054 int val = 0, len = 0, rc = -EINVAL;
1055
1056 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -03001057 if (unlikely(level != SOL_LLC))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001058 goto out;
1059 rc = get_user(len, optlen);
1060 if (rc)
1061 goto out;
1062 rc = -EINVAL;
1063 if (len != sizeof(int))
1064 goto out;
1065 switch (optname) {
1066 case LLC_OPT_RETRY:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001067 val = llc->n2; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001068 case LLC_OPT_SIZE:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001069 val = llc->n1; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001070 case LLC_OPT_ACK_TMR_EXP:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001071 val = llc->ack_timer.expire / HZ; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001072 case LLC_OPT_P_TMR_EXP:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001073 val = llc->pf_cycle_timer.expire / HZ; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001074 case LLC_OPT_REJ_TMR_EXP:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001075 val = llc->rej_sent_timer.expire / HZ; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001076 case LLC_OPT_BUSY_TMR_EXP:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001077 val = llc->busy_state_timer.expire / HZ; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001078 case LLC_OPT_TX_WIN:
1079 val = llc->k; break;
1080 case LLC_OPT_RX_WIN:
1081 val = llc->rw; break;
1082 default:
1083 rc = -ENOPROTOOPT;
1084 goto out;
1085 }
1086 rc = 0;
1087 if (put_user(len, optlen) || copy_to_user(optval, &val, len))
1088 rc = -EFAULT;
1089out:
1090 release_sock(sk);
1091 return rc;
1092}
1093
1094static struct net_proto_family llc_ui_family_ops = {
1095 .family = PF_LLC,
1096 .create = llc_ui_create,
1097 .owner = THIS_MODULE,
1098};
1099
Eric Dumazet90ddc4f2005-12-22 12:49:22 -08001100static const struct proto_ops llc_ui_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001101 .family = PF_LLC,
1102 .owner = THIS_MODULE,
1103 .release = llc_ui_release,
1104 .bind = llc_ui_bind,
1105 .connect = llc_ui_connect,
1106 .socketpair = sock_no_socketpair,
1107 .accept = llc_ui_accept,
1108 .getname = llc_ui_getname,
1109 .poll = datagram_poll,
1110 .ioctl = llc_ui_ioctl,
1111 .listen = llc_ui_listen,
1112 .shutdown = llc_ui_shutdown,
1113 .setsockopt = llc_ui_setsockopt,
1114 .getsockopt = llc_ui_getsockopt,
1115 .sendmsg = llc_ui_sendmsg,
1116 .recvmsg = llc_ui_recvmsg,
1117 .mmap = sock_no_mmap,
1118 .sendpage = sock_no_sendpage,
1119};
1120
Stephen Hemminger01af4a02009-02-22 00:02:44 -08001121static const char llc_proc_err_msg[] __initconst =
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +09001122 KERN_CRIT "LLC: Unable to register the proc_fs entries\n";
Stephen Hemminger01af4a02009-02-22 00:02:44 -08001123static const char llc_sysctl_err_msg[] __initconst =
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +09001124 KERN_CRIT "LLC: Unable to register the sysctl entries\n";
Stephen Hemminger01af4a02009-02-22 00:02:44 -08001125static const char llc_sock_err_msg[] __initconst =
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +09001126 KERN_CRIT "LLC: Unable to register the network family\n";
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001127
Linus Torvalds1da177e2005-04-16 15:20:36 -07001128static int __init llc2_init(void)
1129{
1130 int rc = proto_register(&llc_proto, 0);
1131
1132 if (rc != 0)
1133 goto out;
1134
1135 llc_build_offset_table();
1136 llc_station_init();
1137 llc_ui_sap_last_autoport = LLC_SAP_DYN_START;
1138 rc = llc_proc_init();
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001139 if (rc != 0) {
1140 printk(llc_proc_err_msg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001141 goto out_unregister_llc_proto;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001142 }
1143 rc = llc_sysctl_init();
1144 if (rc) {
1145 printk(llc_sysctl_err_msg);
1146 goto out_proc;
1147 }
1148 rc = sock_register(&llc_ui_family_ops);
1149 if (rc) {
1150 printk(llc_sock_err_msg);
1151 goto out_sysctl;
1152 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001153 llc_add_pack(LLC_DEST_SAP, llc_sap_handler);
1154 llc_add_pack(LLC_DEST_CONN, llc_conn_handler);
1155out:
1156 return rc;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001157out_sysctl:
1158 llc_sysctl_exit();
1159out_proc:
1160 llc_proc_exit();
Linus Torvalds1da177e2005-04-16 15:20:36 -07001161out_unregister_llc_proto:
1162 proto_unregister(&llc_proto);
1163 goto out;
1164}
1165
1166static void __exit llc2_exit(void)
1167{
1168 llc_station_exit();
1169 llc_remove_pack(LLC_DEST_SAP);
1170 llc_remove_pack(LLC_DEST_CONN);
1171 sock_unregister(PF_LLC);
1172 llc_proc_exit();
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001173 llc_sysctl_exit();
Linus Torvalds1da177e2005-04-16 15:20:36 -07001174 proto_unregister(&llc_proto);
1175}
1176
1177module_init(llc2_init);
1178module_exit(llc2_exit);
1179
1180MODULE_LICENSE("GPL");
1181MODULE_AUTHOR("Procom 1997, Jay Schullist 2001, Arnaldo C. Melo 2001-2003");
1182MODULE_DESCRIPTION("IEEE 802.2 PF_LLC support");
1183MODULE_ALIAS_NETPROTO(PF_LLC);