blob: 97101dcde4c0c70179aca1e52a300307a0c8354c [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.
106 * @addr: Source and destination fields provided by the user.
107 * @noblock: can we block waiting for data?
108 *
109 * Send data via reliable llc2 connection.
110 * Returns 0 upon success, non-zero if action did not succeed.
111 */
112static int llc_ui_send_data(struct sock* sk, struct sk_buff *skb, int noblock)
113{
114 struct llc_sock* llc = llc_sk(sk);
115 int rc = 0;
116
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900117 if (unlikely(llc_data_accept_state(llc->state) ||
Jochen Friedrich451677c2005-11-14 21:57:46 -0800118 llc->remote_busy_flag ||
119 llc->p_flag)) {
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300120 long timeout = sock_sndtimeo(sk, noblock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700121
122 rc = llc_ui_wait_for_busy_core(sk, timeout);
123 }
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300124 if (unlikely(!rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700125 rc = llc_build_and_send_pkt(sk, skb);
126 return rc;
127}
128
129static void llc_ui_sk_init(struct socket *sock, struct sock *sk)
130{
131 sk->sk_type = sock->type;
132 sk->sk_sleep = &sock->wait;
133 sk->sk_socket = sock;
134 sock->sk = sk;
135 sock->ops = &llc_ui_ops;
136}
137
138static struct proto llc_proto = {
Arnaldo Carvalho de Melo9c005e02006-03-20 21:27:23 -0800139 .name = "LLC",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700140 .owner = THIS_MODULE,
141 .obj_size = sizeof(struct llc_sock),
142};
143
144/**
145 * llc_ui_create - alloc and init a new llc_ui socket
146 * @sock: Socket to initialize and attach allocated sk to.
147 * @protocol: Unused.
148 *
149 * Allocate and initialize a new llc_ui socket, validate the user wants a
150 * socket type we have available.
151 * Returns 0 upon success, negative upon failure.
152 */
Eric W. Biederman1b8d7ae2007-10-08 23:24:22 -0700153static int llc_ui_create(struct net *net, struct socket *sock, int protocol)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700154{
155 struct sock *sk;
156 int rc = -ESOCKTNOSUPPORT;
157
Patrick McHardy3480c632008-03-27 20:28:10 -0700158 if (!capable(CAP_NET_RAW))
159 return -EPERM;
160
Eric W. Biederman1b8d7ae2007-10-08 23:24:22 -0700161 if (net != &init_net)
162 return -EAFNOSUPPORT;
163
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300164 if (likely(sock->type == SOCK_DGRAM || sock->type == SOCK_STREAM)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700165 rc = -ENOMEM;
Eric W. Biederman1b8d7ae2007-10-08 23:24:22 -0700166 sk = llc_sk_alloc(net, PF_LLC, GFP_KERNEL, &llc_proto);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700167 if (sk) {
168 rc = 0;
169 llc_ui_sk_init(sock, sk);
170 }
171 }
172 return rc;
173}
174
175/**
176 * llc_ui_release - shutdown socket
177 * @sock: Socket to release.
178 *
179 * Shutdown and deallocate an existing socket.
180 */
181static int llc_ui_release(struct socket *sock)
182{
183 struct sock *sk = sock->sk;
184 struct llc_sock *llc;
185
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300186 if (unlikely(sk == NULL))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700187 goto out;
188 sock_hold(sk);
189 lock_sock(sk);
190 llc = llc_sk(sk);
Harvey Harrison0dc47872008-03-05 20:47:47 -0800191 dprintk("%s: closing local(%02X) remote(%02X)\n", __func__,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700192 llc->laddr.lsap, llc->daddr.lsap);
193 if (!llc_send_disc(sk))
194 llc_ui_wait_for_disc(sk, sk->sk_rcvtimeo);
Arnaldo Carvalho de Melo2e1f47c2006-03-20 21:28:11 -0800195 if (!sock_flag(sk, SOCK_ZAPPED)) {
196 llc_sap_put(llc->sap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700197 llc_sap_remove_socket(llc->sap, sk);
Arnaldo Carvalho de Melo2e1f47c2006-03-20 21:28:11 -0800198 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700199 release_sock(sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700200 if (llc->dev)
201 dev_put(llc->dev);
202 sock_put(sk);
203 llc_sk_free(sk);
204out:
205 return 0;
206}
207
208/**
209 * llc_ui_autoport - provide dynamically allocate SAP number
210 *
211 * Provide the caller with a dynamically allocated SAP number according
212 * to the rules that are set in this function. Returns: 0, upon failure,
213 * SAP number otherwise.
214 */
215static int llc_ui_autoport(void)
216{
217 struct llc_sap *sap;
218 int i, tries = 0;
219
220 while (tries < LLC_SAP_DYN_TRIES) {
221 for (i = llc_ui_sap_last_autoport;
222 i < LLC_SAP_DYN_STOP; i += 2) {
223 sap = llc_sap_find(i);
224 if (!sap) {
225 llc_ui_sap_last_autoport = i + 2;
226 goto out;
227 }
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -0300228 llc_sap_put(sap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700229 }
230 llc_ui_sap_last_autoport = LLC_SAP_DYN_START;
231 tries++;
232 }
233 i = 0;
234out:
235 return i;
236}
237
238/**
Arnaldo Carvalho de Melo5a770c02005-09-22 03:56:26 -0300239 * llc_ui_autobind - automatically bind a socket to a sap
240 * @sock: socket to bind
241 * @addr: address to connect to
Linus Torvalds1da177e2005-04-16 15:20:36 -0700242 *
Arnaldo Carvalho de Melo5a770c02005-09-22 03:56:26 -0300243 * Used by llc_ui_connect and llc_ui_sendmsg when the user hasn't
244 * specifically used llc_ui_bind to bind to an specific address/sap
245 *
Linus Torvalds1da177e2005-04-16 15:20:36 -0700246 * Returns: 0 upon success, negative otherwise.
247 */
248static int llc_ui_autobind(struct socket *sock, struct sockaddr_llc *addr)
249{
250 struct sock *sk = sock->sk;
251 struct llc_sock *llc = llc_sk(sk);
252 struct llc_sap *sap;
253 int rc = -EINVAL;
254
255 if (!sock_flag(sk, SOCK_ZAPPED))
256 goto out;
257 rc = -ENODEV;
Eric W. Biederman881d9662007-09-17 11:56:21 -0700258 llc->dev = dev_getfirstbyhwtype(&init_net, addr->sllc_arphrd);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700259 if (!llc->dev)
260 goto out;
261 rc = -EUSERS;
262 llc->laddr.lsap = llc_ui_autoport();
263 if (!llc->laddr.lsap)
264 goto out;
265 rc = -EBUSY; /* some other network layer is using the sap */
266 sap = llc_sap_open(llc->laddr.lsap, NULL);
267 if (!sap)
268 goto out;
269 memcpy(llc->laddr.mac, llc->dev->dev_addr, IFHWADDRLEN);
270 memcpy(&llc->addr, addr, sizeof(llc->addr));
271 /* assign new connection to its SAP */
272 llc_sap_add_socket(sap, sk);
273 sock_reset_flag(sk, SOCK_ZAPPED);
274 rc = 0;
275out:
276 return rc;
277}
278
279/**
280 * llc_ui_bind - bind a socket to a specific address.
281 * @sock: Socket to bind an address to.
282 * @uaddr: Address the user wants the socket bound to.
283 * @addrlen: Length of the uaddr structure.
284 *
285 * 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 -0300286 * a specific sap only or mac + sap.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700287 * If the user desires to bind to a specific mac + sap, it is possible to
288 * have multiple sap connections via multiple macs.
289 * Bind and autobind for that matter must enforce the correct sap usage
290 * otherwise all hell will break loose.
291 * Returns: 0 upon success, negative otherwise.
292 */
293static int llc_ui_bind(struct socket *sock, struct sockaddr *uaddr, int addrlen)
294{
295 struct sockaddr_llc *addr = (struct sockaddr_llc *)uaddr;
296 struct sock *sk = sock->sk;
297 struct llc_sock *llc = llc_sk(sk);
298 struct llc_sap *sap;
299 int rc = -EINVAL;
300
Harvey Harrison0dc47872008-03-05 20:47:47 -0800301 dprintk("%s: binding %02X\n", __func__, addr->sllc_sap);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300302 if (unlikely(!sock_flag(sk, SOCK_ZAPPED) || addrlen != sizeof(*addr)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700303 goto out;
304 rc = -EAFNOSUPPORT;
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300305 if (unlikely(addr->sllc_family != AF_LLC))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700306 goto out;
Jochen Friedrichcf309e32005-09-22 04:44:55 -0300307 rc = -ENODEV;
308 rtnl_lock();
Eric W. Biederman881d9662007-09-17 11:56:21 -0700309 llc->dev = dev_getbyhwaddr(&init_net, addr->sllc_arphrd, addr->sllc_mac);
Jochen Friedrichcf309e32005-09-22 04:44:55 -0300310 rtnl_unlock();
311 if (!llc->dev)
312 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700313 if (!addr->sllc_sap) {
314 rc = -EUSERS;
315 addr->sllc_sap = llc_ui_autoport();
316 if (!addr->sllc_sap)
317 goto out;
318 }
319 sap = llc_sap_find(addr->sllc_sap);
320 if (!sap) {
321 sap = llc_sap_open(addr->sllc_sap, NULL);
322 rc = -EBUSY; /* some other network layer is using the sap */
323 if (!sap)
324 goto out;
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -0300325 llc_sap_hold(sap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700326 } else {
327 struct llc_addr laddr, daddr;
328 struct sock *ask;
329
330 memset(&laddr, 0, sizeof(laddr));
331 memset(&daddr, 0, sizeof(daddr));
332 /*
Michael Opdenacker59c51592007-05-09 08:57:56 +0200333 * FIXME: check if the address is multicast,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700334 * only SOCK_DGRAM can do this.
335 */
336 memcpy(laddr.mac, addr->sllc_mac, IFHWADDRLEN);
337 laddr.lsap = addr->sllc_sap;
338 rc = -EADDRINUSE; /* mac + sap clash. */
339 ask = llc_lookup_established(sap, &daddr, &laddr);
340 if (ask) {
341 sock_put(ask);
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -0300342 goto out_put;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700343 }
344 }
345 llc->laddr.lsap = addr->sllc_sap;
346 memcpy(llc->laddr.mac, addr->sllc_mac, IFHWADDRLEN);
347 memcpy(&llc->addr, addr, sizeof(llc->addr));
348 /* assign new connection to its SAP */
349 llc_sap_add_socket(sap, sk);
350 sock_reset_flag(sk, SOCK_ZAPPED);
351 rc = 0;
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -0300352out_put:
353 llc_sap_put(sap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700354out:
355 return rc;
356}
357
358/**
359 * llc_ui_shutdown - shutdown a connect llc2 socket.
360 * @sock: Socket to shutdown.
361 * @how: What part of the socket to shutdown.
362 *
363 * Shutdown a connected llc2 socket. Currently this function only supports
364 * shutting down both sends and receives (2), we could probably make this
365 * function such that a user can shutdown only half the connection but not
366 * right now.
367 * Returns: 0 upon success, negative otherwise.
368 */
369static int llc_ui_shutdown(struct socket *sock, int how)
370{
371 struct sock *sk = sock->sk;
372 int rc = -ENOTCONN;
373
374 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300375 if (unlikely(sk->sk_state != TCP_ESTABLISHED))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700376 goto out;
377 rc = -EINVAL;
378 if (how != 2)
379 goto out;
380 rc = llc_send_disc(sk);
381 if (!rc)
382 rc = llc_ui_wait_for_disc(sk, sk->sk_rcvtimeo);
383 /* Wake up anyone sleeping in poll */
384 sk->sk_state_change(sk);
385out:
386 release_sock(sk);
387 return rc;
388}
389
390/**
391 * llc_ui_connect - Connect to a remote llc2 mac + sap.
392 * @sock: Socket which will be connected to the remote destination.
393 * @uaddr: Remote and possibly the local address of the new connection.
394 * @addrlen: Size of uaddr structure.
395 * @flags: Operational flags specified by the user.
396 *
397 * Connect to a remote llc2 mac + sap. The caller must specify the
398 * destination mac and address to connect to. If the user hasn't previously
399 * called bind(2) with a smac the address of the first interface of the
400 * specified arp type will be used.
401 * This function will autobind if user did not previously call bind.
402 * Returns: 0 upon success, negative otherwise.
403 */
404static int llc_ui_connect(struct socket *sock, struct sockaddr *uaddr,
405 int addrlen, int flags)
406{
407 struct sock *sk = sock->sk;
408 struct llc_sock *llc = llc_sk(sk);
409 struct sockaddr_llc *addr = (struct sockaddr_llc *)uaddr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700410 int rc = -EINVAL;
411
412 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300413 if (unlikely(addrlen != sizeof(*addr)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700414 goto out;
415 rc = -EAFNOSUPPORT;
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300416 if (unlikely(addr->sllc_family != AF_LLC))
417 goto out;
418 if (unlikely(sk->sk_type != SOCK_STREAM))
419 goto out;
420 rc = -EALREADY;
421 if (unlikely(sock->state == SS_CONNECTING))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700422 goto out;
423 /* bind connection to sap if user hasn't done it. */
424 if (sock_flag(sk, SOCK_ZAPPED)) {
425 /* bind to sap with null dev, exclusive */
426 rc = llc_ui_autobind(sock, addr);
427 if (rc)
428 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700429 }
Jochen Friedrich5564af22005-09-22 04:46:44 -0300430 llc->daddr.lsap = addr->sllc_sap;
431 memcpy(llc->daddr.mac, addr->sllc_mac, IFHWADDRLEN);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700432 sock->state = SS_CONNECTING;
433 sk->sk_state = TCP_SYN_SENT;
434 llc->link = llc_ui_next_link_no(llc->sap->laddr.lsap);
Arnaldo Carvalho de Melo774ccb42005-09-22 03:53:35 -0300435 rc = llc_establish_connection(sk, llc->dev->dev_addr,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700436 addr->sllc_mac, addr->sllc_sap);
437 if (rc) {
Harvey Harrison0dc47872008-03-05 20:47:47 -0800438 dprintk("%s: llc_ui_send_conn failed :-(\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700439 sock->state = SS_UNCONNECTED;
440 sk->sk_state = TCP_CLOSE;
441 goto out;
442 }
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300443
444 if (sk->sk_state == TCP_SYN_SENT) {
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300445 const long timeo = sock_sndtimeo(sk, flags & O_NONBLOCK);
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300446
447 if (!timeo || !llc_ui_wait_for_conn(sk, timeo))
448 goto out;
449
450 rc = sock_intr_errno(timeo);
451 if (signal_pending(current))
452 goto out;
453 }
454
455 if (sk->sk_state == TCP_CLOSE)
456 goto sock_error;
457
458 sock->state = SS_CONNECTED;
459 rc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700460out:
461 release_sock(sk);
462 return rc;
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300463sock_error:
464 rc = sock_error(sk) ? : -ECONNABORTED;
465 sock->state = SS_UNCONNECTED;
466 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700467}
468
469/**
470 * llc_ui_listen - allow a normal socket to accept incoming connections
471 * @sock: Socket to allow incoming connections on.
472 * @backlog: Number of connections to queue.
473 *
474 * Allow a normal socket to accept incoming connections.
475 * Returns 0 upon success, negative otherwise.
476 */
477static int llc_ui_listen(struct socket *sock, int backlog)
478{
479 struct sock *sk = sock->sk;
480 int rc = -EINVAL;
481
482 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300483 if (unlikely(sock->state != SS_UNCONNECTED))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700484 goto out;
485 rc = -EOPNOTSUPP;
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300486 if (unlikely(sk->sk_type != SOCK_STREAM))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700487 goto out;
488 rc = -EAGAIN;
489 if (sock_flag(sk, SOCK_ZAPPED))
490 goto out;
491 rc = 0;
492 if (!(unsigned)backlog) /* BSDism */
493 backlog = 1;
494 sk->sk_max_ack_backlog = backlog;
495 if (sk->sk_state != TCP_LISTEN) {
496 sk->sk_ack_backlog = 0;
497 sk->sk_state = TCP_LISTEN;
498 }
499 sk->sk_socket->flags |= __SO_ACCEPTCON;
500out:
501 release_sock(sk);
502 return rc;
503}
504
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300505static int llc_ui_wait_for_disc(struct sock *sk, long timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700506{
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300507 DEFINE_WAIT(wait);
508 int rc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700509
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300510 while (1) {
511 prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE);
512 if (sk_wait_event(sk, &timeout, sk->sk_state == TCP_CLOSE))
513 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700514 rc = -ERESTARTSYS;
515 if (signal_pending(current))
516 break;
517 rc = -EAGAIN;
518 if (!timeout)
519 break;
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300520 rc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700521 }
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300522 finish_wait(sk->sk_sleep, &wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700523 return rc;
524}
525
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300526static int llc_ui_wait_for_conn(struct sock *sk, long timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700527{
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300528 DEFINE_WAIT(wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700529
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300530 while (1) {
531 prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE);
532 if (sk_wait_event(sk, &timeout, sk->sk_state != TCP_SYN_SENT))
533 break;
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300534 if (signal_pending(current) || !timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700535 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700536 }
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300537 finish_wait(sk->sk_sleep, &wait);
538 return timeout;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700539}
540
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300541static int llc_ui_wait_for_busy_core(struct sock *sk, long timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700542{
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300543 DEFINE_WAIT(wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700544 struct llc_sock *llc = llc_sk(sk);
545 int rc;
546
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300547 while (1) {
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300548 prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700549 rc = 0;
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300550 if (sk_wait_event(sk, &timeout,
551 (sk->sk_shutdown & RCV_SHUTDOWN) ||
552 (!llc_data_accept_state(llc->state) &&
Jochen Friedrich451677c2005-11-14 21:57:46 -0800553 !llc->remote_busy_flag &&
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300554 !llc->p_flag)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700555 break;
556 rc = -ERESTARTSYS;
557 if (signal_pending(current))
558 break;
559 rc = -EAGAIN;
560 if (!timeout)
561 break;
562 }
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300563 finish_wait(sk->sk_sleep, &wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700564 return rc;
565}
566
Arnaldo Carvalho de Melo2928c192005-09-22 05:14:33 -0300567static int llc_wait_data(struct sock *sk, long timeo)
Arnaldo Carvalho de Meloafdbe352005-09-22 04:37:07 -0300568{
569 int rc;
570
571 while (1) {
572 /*
573 * POSIX 1003.1g mandates this order.
574 */
Benjamin LaHaisec1cbe4b2005-12-13 23:22:19 -0800575 rc = sock_error(sk);
576 if (rc)
Arnaldo Carvalho de Meloafdbe352005-09-22 04:37:07 -0300577 break;
Arnaldo Carvalho de Meloafdbe352005-09-22 04:37:07 -0300578 rc = 0;
579 if (sk->sk_shutdown & RCV_SHUTDOWN)
580 break;
581 rc = -EAGAIN;
582 if (!timeo)
583 break;
584 rc = sock_intr_errno(timeo);
585 if (signal_pending(current))
586 break;
587 rc = 0;
588 if (sk_wait_data(sk, &timeo))
589 break;
590 }
591 return rc;
592}
593
Linus Torvalds1da177e2005-04-16 15:20:36 -0700594/**
595 * llc_ui_accept - accept a new incoming connection.
596 * @sock: Socket which connections arrive on.
597 * @newsock: Socket to move incoming connection to.
598 * @flags: User specified operational flags.
599 *
600 * Accept a new incoming connection.
601 * Returns 0 upon success, negative otherwise.
602 */
603static int llc_ui_accept(struct socket *sock, struct socket *newsock, int flags)
604{
605 struct sock *sk = sock->sk, *newsk;
606 struct llc_sock *llc, *newllc;
607 struct sk_buff *skb;
608 int rc = -EOPNOTSUPP;
609
Harvey Harrison0dc47872008-03-05 20:47:47 -0800610 dprintk("%s: accepting on %02X\n", __func__,
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900611 llc_sk(sk)->laddr.lsap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700612 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300613 if (unlikely(sk->sk_type != SOCK_STREAM))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700614 goto out;
615 rc = -EINVAL;
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300616 if (unlikely(sock->state != SS_UNCONNECTED ||
617 sk->sk_state != TCP_LISTEN))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700618 goto out;
619 /* wait for a connection to arrive. */
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300620 if (skb_queue_empty(&sk->sk_receive_queue)) {
Arnaldo Carvalho de Meloafdbe352005-09-22 04:37:07 -0300621 rc = llc_wait_data(sk, sk->sk_rcvtimeo);
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300622 if (rc)
623 goto out;
624 }
Harvey Harrison0dc47872008-03-05 20:47:47 -0800625 dprintk("%s: got a new connection on %02X\n", __func__,
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900626 llc_sk(sk)->laddr.lsap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700627 skb = skb_dequeue(&sk->sk_receive_queue);
628 rc = -EINVAL;
629 if (!skb->sk)
630 goto frees;
631 rc = 0;
632 newsk = skb->sk;
633 /* attach connection to a new socket. */
634 llc_ui_sk_init(newsock, newsk);
635 sock_reset_flag(newsk, SOCK_ZAPPED);
636 newsk->sk_state = TCP_ESTABLISHED;
637 newsock->state = SS_CONNECTED;
638 llc = llc_sk(sk);
639 newllc = llc_sk(newsk);
640 memcpy(&newllc->addr, &llc->addr, sizeof(newllc->addr));
641 newllc->link = llc_ui_next_link_no(newllc->laddr.lsap);
642
643 /* put original socket back into a clean listen state. */
644 sk->sk_state = TCP_LISTEN;
645 sk->sk_ack_backlog--;
Harvey Harrison0dc47872008-03-05 20:47:47 -0800646 dprintk("%s: ok success on %02X, client on %02X\n", __func__,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700647 llc_sk(sk)->addr.sllc_sap, newllc->daddr.lsap);
648frees:
649 kfree_skb(skb);
650out:
651 release_sock(sk);
652 return rc;
653}
654
655/**
656 * llc_ui_recvmsg - copy received data to the socket user.
657 * @sock: Socket to copy data from.
658 * @msg: Various user space related information.
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300659 * @len: Size of user buffer.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700660 * @flags: User specified flags.
661 *
662 * Copy received data to the socket user.
663 * Returns non-negative upon success, negative otherwise.
664 */
665static int llc_ui_recvmsg(struct kiocb *iocb, struct socket *sock,
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300666 struct msghdr *msg, size_t len, int flags)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700667{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700668 struct sockaddr_llc *uaddr = (struct sockaddr_llc *)msg->msg_name;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300669 const int nonblock = flags & MSG_DONTWAIT;
670 struct sk_buff *skb = NULL;
671 struct sock *sk = sock->sk;
672 struct llc_sock *llc = llc_sk(sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700673 size_t copied = 0;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300674 u32 peek_seq = 0;
675 u32 *seq;
676 unsigned long used;
677 int target; /* Read at least this many bytes */
678 long timeo;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700679
Linus Torvalds1da177e2005-04-16 15:20:36 -0700680 lock_sock(sk);
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300681 copied = -ENOTCONN;
Stephen Hemminger29efcd22006-05-25 15:08:59 -0700682 if (unlikely(sk->sk_type == SOCK_STREAM && sk->sk_state == TCP_LISTEN))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700683 goto out;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300684
685 timeo = sock_rcvtimeo(sk, nonblock);
686
687 seq = &llc->copied_seq;
688 if (flags & MSG_PEEK) {
689 peek_seq = llc->copied_seq;
690 seq = &peek_seq;
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900691 }
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300692
693 target = sock_rcvlowat(sk, flags & MSG_WAITALL, len);
694 copied = 0;
695
696 do {
697 u32 offset;
698
699 /*
700 * We need to check signals first, to get correct SIGURG
701 * handling. FIXME: Need to check this doesn't impact 1003.1g
702 * and move it down to the bottom of the loop
703 */
704 if (signal_pending(current)) {
705 if (copied)
706 break;
707 copied = timeo ? sock_intr_errno(timeo) : -EAGAIN;
708 break;
709 }
710
711 /* Next get a buffer. */
712
713 skb = skb_peek(&sk->sk_receive_queue);
714 if (skb) {
715 offset = *seq;
716 goto found_ok_skb;
717 }
718 /* Well, if we have backlog, try to process it now yet. */
719
720 if (copied >= target && !sk->sk_backlog.tail)
721 break;
722
723 if (copied) {
724 if (sk->sk_err ||
725 sk->sk_state == TCP_CLOSE ||
726 (sk->sk_shutdown & RCV_SHUTDOWN) ||
727 !timeo ||
728 (flags & MSG_PEEK))
729 break;
730 } else {
731 if (sock_flag(sk, SOCK_DONE))
732 break;
733
734 if (sk->sk_err) {
735 copied = sock_error(sk);
736 break;
737 }
738 if (sk->sk_shutdown & RCV_SHUTDOWN)
739 break;
740
Stephen Hemminger29efcd22006-05-25 15:08:59 -0700741 if (sk->sk_type == SOCK_STREAM && sk->sk_state == TCP_CLOSE) {
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300742 if (!sock_flag(sk, SOCK_DONE)) {
743 /*
744 * This occurs when user tries to read
745 * from never connected socket.
746 */
747 copied = -ENOTCONN;
748 break;
749 }
750 break;
751 }
752 if (!timeo) {
753 copied = -EAGAIN;
754 break;
755 }
756 }
757
758 if (copied >= target) { /* Do not sleep, just process backlog. */
759 release_sock(sk);
760 lock_sock(sk);
761 } else
762 sk_wait_data(sk, &timeo);
763
764 if ((flags & MSG_PEEK) && peek_seq != llc->copied_seq) {
765 if (net_ratelimit())
766 printk(KERN_DEBUG "LLC(%s:%d): Application "
767 "bug, race in MSG_PEEK.\n",
Pavel Emelyanovba25f9d2007-10-18 23:40:40 -0700768 current->comm, task_pid_nr(current));
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300769 peek_seq = llc->copied_seq;
770 }
771 continue;
772 found_ok_skb:
773 /* Ok so how much can we use? */
774 used = skb->len - offset;
775 if (len < used)
776 used = len;
777
778 if (!(flags & MSG_TRUNC)) {
779 int rc = skb_copy_datagram_iovec(skb, offset,
780 msg->msg_iov, used);
781 if (rc) {
782 /* Exception. Bailout! */
783 if (!copied)
784 copied = -EFAULT;
785 break;
786 }
787 }
788
789 *seq += used;
790 copied += used;
791 len -= used;
792
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300793 if (!(flags & MSG_PEEK)) {
Chris Leech624d1162006-05-23 18:01:28 -0700794 sk_eat_skb(sk, skb, 0);
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300795 *seq = 0;
796 }
Stephen Hemminger30a584d2006-08-03 16:38:49 -0700797
798 /* For non stream protcols we get one packet per recvmsg call */
799 if (sk->sk_type != SOCK_STREAM)
800 goto copy_uaddr;
801
802 /* Partial read */
803 if (used + offset < skb->len)
804 continue;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300805 } while (len > 0);
806
Linus Torvalds1da177e2005-04-16 15:20:36 -0700807out:
808 release_sock(sk);
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300809 return copied;
810copy_uaddr:
811 if (uaddr != NULL && skb != NULL) {
812 memcpy(uaddr, llc_ui_skb_cb(skb), sizeof(*uaddr));
813 msg->msg_namelen = sizeof(*uaddr);
814 }
815 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700816}
817
818/**
819 * llc_ui_sendmsg - Transmit data provided by the socket user.
820 * @sock: Socket to transmit data from.
821 * @msg: Various user related information.
822 * @len: Length of data to transmit.
823 *
824 * Transmit data provided by the socket user.
825 * Returns non-negative upon success, negative otherwise.
826 */
827static int llc_ui_sendmsg(struct kiocb *iocb, struct socket *sock,
828 struct msghdr *msg, size_t len)
829{
830 struct sock *sk = sock->sk;
831 struct llc_sock *llc = llc_sk(sk);
832 struct sockaddr_llc *addr = (struct sockaddr_llc *)msg->msg_name;
833 int flags = msg->msg_flags;
834 int noblock = flags & MSG_DONTWAIT;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700835 struct sk_buff *skb;
836 size_t size = 0;
837 int rc = -EINVAL, copied = 0, hdrlen;
838
Harvey Harrison0dc47872008-03-05 20:47:47 -0800839 dprintk("%s: sending from %02X to %02X\n", __func__,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700840 llc->laddr.lsap, llc->daddr.lsap);
841 lock_sock(sk);
842 if (addr) {
843 if (msg->msg_namelen < sizeof(*addr))
844 goto release;
845 } else {
846 if (llc_ui_addr_null(&llc->addr))
847 goto release;
848 addr = &llc->addr;
849 }
850 /* must bind connection to sap if user hasn't done it. */
851 if (sock_flag(sk, SOCK_ZAPPED)) {
852 /* bind to sap with null dev, exclusive. */
853 rc = llc_ui_autobind(sock, addr);
854 if (rc)
855 goto release;
856 }
Arnaldo Carvalho de Melo774ccb42005-09-22 03:53:35 -0300857 hdrlen = llc->dev->hard_header_len + llc_ui_header_len(sk, addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700858 size = hdrlen + len;
Arnaldo Carvalho de Melo774ccb42005-09-22 03:53:35 -0300859 if (size > llc->dev->mtu)
860 size = llc->dev->mtu;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700861 copied = size - hdrlen;
862 release_sock(sk);
863 skb = sock_alloc_send_skb(sk, size, noblock, &rc);
864 lock_sock(sk);
865 if (!skb)
866 goto release;
Arnaldo Carvalho de Melo774ccb42005-09-22 03:53:35 -0300867 skb->dev = llc->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700868 skb->protocol = llc_proto_type(addr->sllc_arphrd);
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900869 skb_reserve(skb, hdrlen);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700870 rc = memcpy_fromiovec(skb_put(skb, copied), msg->msg_iov, copied);
871 if (rc)
872 goto out;
873 if (sk->sk_type == SOCK_DGRAM || addr->sllc_ua) {
874 llc_build_and_send_ui_pkt(llc->sap, skb, addr->sllc_mac,
875 addr->sllc_sap);
876 goto out;
877 }
878 if (addr->sllc_test) {
879 llc_build_and_send_test_pkt(llc->sap, skb, addr->sllc_mac,
880 addr->sllc_sap);
881 goto out;
882 }
883 if (addr->sllc_xid) {
884 llc_build_and_send_xid_pkt(llc->sap, skb, addr->sllc_mac,
885 addr->sllc_sap);
886 goto out;
887 }
888 rc = -ENOPROTOOPT;
889 if (!(sk->sk_type == SOCK_STREAM && !addr->sllc_ua))
890 goto out;
891 rc = llc_ui_send_data(sk, skb, noblock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700892out:
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300893 if (rc) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700894 kfree_skb(skb);
895release:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700896 dprintk("%s: failed sending from %02X to %02X: %d\n",
Harvey Harrison0dc47872008-03-05 20:47:47 -0800897 __func__, llc->laddr.lsap, llc->daddr.lsap, rc);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300898 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700899 release_sock(sk);
900 return rc ? : copied;
901}
902
903/**
904 * llc_ui_getname - return the address info of a socket
905 * @sock: Socket to get address of.
906 * @uaddr: Address structure to return information.
907 * @uaddrlen: Length of address structure.
908 * @peer: Does user want local or remote address information.
909 *
910 * Return the address information of a socket.
911 */
912static int llc_ui_getname(struct socket *sock, struct sockaddr *uaddr,
913 int *uaddrlen, int peer)
914{
915 struct sockaddr_llc sllc;
916 struct sock *sk = sock->sk;
917 struct llc_sock *llc = llc_sk(sk);
918 int rc = 0;
919
920 lock_sock(sk);
921 if (sock_flag(sk, SOCK_ZAPPED))
922 goto out;
923 *uaddrlen = sizeof(sllc);
924 memset(uaddr, 0, *uaddrlen);
925 if (peer) {
926 rc = -ENOTCONN;
927 if (sk->sk_state != TCP_ESTABLISHED)
928 goto out;
929 if(llc->dev)
930 sllc.sllc_arphrd = llc->dev->type;
931 sllc.sllc_sap = llc->daddr.lsap;
932 memcpy(&sllc.sllc_mac, &llc->daddr.mac, IFHWADDRLEN);
933 } else {
934 rc = -EINVAL;
935 if (!llc->sap)
936 goto out;
937 sllc.sllc_sap = llc->sap->laddr.lsap;
938
939 if (llc->dev) {
940 sllc.sllc_arphrd = llc->dev->type;
941 memcpy(&sllc.sllc_mac, &llc->dev->dev_addr,
942 IFHWADDRLEN);
943 }
944 }
945 rc = 0;
946 sllc.sllc_family = AF_LLC;
947 memcpy(uaddr, &sllc, sizeof(sllc));
948out:
949 release_sock(sk);
950 return rc;
951}
952
953/**
954 * llc_ui_ioctl - io controls for PF_LLC
955 * @sock: Socket to get/set info
956 * @cmd: command
957 * @arg: optional argument for cmd
958 *
959 * get/set info on llc sockets
960 */
961static int llc_ui_ioctl(struct socket *sock, unsigned int cmd,
962 unsigned long arg)
963{
Christoph Hellwigb5e5fa52006-01-03 14:18:33 -0800964 return -ENOIOCTLCMD;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700965}
966
967/**
968 * llc_ui_setsockopt - set various connection specific parameters.
969 * @sock: Socket to set options on.
970 * @level: Socket level user is requesting operations on.
971 * @optname: Operation name.
972 * @optval User provided operation data.
973 * @optlen: Length of optval.
974 *
975 * Set various connection specific parameters.
976 */
977static int llc_ui_setsockopt(struct socket *sock, int level, int optname,
978 char __user *optval, int optlen)
979{
980 struct sock *sk = sock->sk;
981 struct llc_sock *llc = llc_sk(sk);
982 int rc = -EINVAL, opt;
983
984 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300985 if (unlikely(level != SOL_LLC || optlen != sizeof(int)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700986 goto out;
987 rc = get_user(opt, (int __user *)optval);
988 if (rc)
989 goto out;
990 rc = -EINVAL;
991 switch (optname) {
992 case LLC_OPT_RETRY:
993 if (opt > LLC_OPT_MAX_RETRY)
994 goto out;
995 llc->n2 = opt;
996 break;
997 case LLC_OPT_SIZE:
998 if (opt > LLC_OPT_MAX_SIZE)
999 goto out;
1000 llc->n1 = opt;
1001 break;
1002 case LLC_OPT_ACK_TMR_EXP:
1003 if (opt > LLC_OPT_MAX_ACK_TMR_EXP)
1004 goto out;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001005 llc->ack_timer.expire = opt * HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001006 break;
1007 case LLC_OPT_P_TMR_EXP:
1008 if (opt > LLC_OPT_MAX_P_TMR_EXP)
1009 goto out;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001010 llc->pf_cycle_timer.expire = opt * HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001011 break;
1012 case LLC_OPT_REJ_TMR_EXP:
1013 if (opt > LLC_OPT_MAX_REJ_TMR_EXP)
1014 goto out;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001015 llc->rej_sent_timer.expire = opt * HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001016 break;
1017 case LLC_OPT_BUSY_TMR_EXP:
1018 if (opt > LLC_OPT_MAX_BUSY_TMR_EXP)
1019 goto out;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001020 llc->busy_state_timer.expire = opt * HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001021 break;
1022 case LLC_OPT_TX_WIN:
1023 if (opt > LLC_OPT_MAX_WIN)
1024 goto out;
1025 llc->k = opt;
1026 break;
1027 case LLC_OPT_RX_WIN:
1028 if (opt > LLC_OPT_MAX_WIN)
1029 goto out;
1030 llc->rw = opt;
1031 break;
1032 default:
1033 rc = -ENOPROTOOPT;
1034 goto out;
1035 }
1036 rc = 0;
1037out:
1038 release_sock(sk);
1039 return rc;
1040}
1041
1042/**
1043 * llc_ui_getsockopt - get connection specific socket info
1044 * @sock: Socket to get information from.
1045 * @level: Socket level user is requesting operations on.
1046 * @optname: Operation name.
1047 * @optval: Variable to return operation data in.
1048 * @optlen: Length of optval.
1049 *
1050 * Get connection specific socket information.
1051 */
1052static int llc_ui_getsockopt(struct socket *sock, int level, int optname,
1053 char __user *optval, int __user *optlen)
1054{
1055 struct sock *sk = sock->sk;
1056 struct llc_sock *llc = llc_sk(sk);
1057 int val = 0, len = 0, rc = -EINVAL;
1058
1059 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -03001060 if (unlikely(level != SOL_LLC))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001061 goto out;
1062 rc = get_user(len, optlen);
1063 if (rc)
1064 goto out;
1065 rc = -EINVAL;
1066 if (len != sizeof(int))
1067 goto out;
1068 switch (optname) {
1069 case LLC_OPT_RETRY:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001070 val = llc->n2; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001071 case LLC_OPT_SIZE:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001072 val = llc->n1; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001073 case LLC_OPT_ACK_TMR_EXP:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001074 val = llc->ack_timer.expire / HZ; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001075 case LLC_OPT_P_TMR_EXP:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001076 val = llc->pf_cycle_timer.expire / HZ; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001077 case LLC_OPT_REJ_TMR_EXP:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001078 val = llc->rej_sent_timer.expire / HZ; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001079 case LLC_OPT_BUSY_TMR_EXP:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001080 val = llc->busy_state_timer.expire / HZ; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001081 case LLC_OPT_TX_WIN:
1082 val = llc->k; break;
1083 case LLC_OPT_RX_WIN:
1084 val = llc->rw; break;
1085 default:
1086 rc = -ENOPROTOOPT;
1087 goto out;
1088 }
1089 rc = 0;
1090 if (put_user(len, optlen) || copy_to_user(optval, &val, len))
1091 rc = -EFAULT;
1092out:
1093 release_sock(sk);
1094 return rc;
1095}
1096
1097static struct net_proto_family llc_ui_family_ops = {
1098 .family = PF_LLC,
1099 .create = llc_ui_create,
1100 .owner = THIS_MODULE,
1101};
1102
Eric Dumazet90ddc4f2005-12-22 12:49:22 -08001103static const struct proto_ops llc_ui_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001104 .family = PF_LLC,
1105 .owner = THIS_MODULE,
1106 .release = llc_ui_release,
1107 .bind = llc_ui_bind,
1108 .connect = llc_ui_connect,
1109 .socketpair = sock_no_socketpair,
1110 .accept = llc_ui_accept,
1111 .getname = llc_ui_getname,
1112 .poll = datagram_poll,
1113 .ioctl = llc_ui_ioctl,
1114 .listen = llc_ui_listen,
1115 .shutdown = llc_ui_shutdown,
1116 .setsockopt = llc_ui_setsockopt,
1117 .getsockopt = llc_ui_getsockopt,
1118 .sendmsg = llc_ui_sendmsg,
1119 .recvmsg = llc_ui_recvmsg,
1120 .mmap = sock_no_mmap,
1121 .sendpage = sock_no_sendpage,
1122};
1123
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001124static char llc_proc_err_msg[] __initdata =
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +09001125 KERN_CRIT "LLC: Unable to register the proc_fs entries\n";
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001126static char llc_sysctl_err_msg[] __initdata =
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +09001127 KERN_CRIT "LLC: Unable to register the sysctl entries\n";
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001128static char llc_sock_err_msg[] __initdata =
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +09001129 KERN_CRIT "LLC: Unable to register the network family\n";
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001130
Linus Torvalds1da177e2005-04-16 15:20:36 -07001131static int __init llc2_init(void)
1132{
1133 int rc = proto_register(&llc_proto, 0);
1134
1135 if (rc != 0)
1136 goto out;
1137
1138 llc_build_offset_table();
1139 llc_station_init();
1140 llc_ui_sap_last_autoport = LLC_SAP_DYN_START;
1141 rc = llc_proc_init();
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001142 if (rc != 0) {
1143 printk(llc_proc_err_msg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001144 goto out_unregister_llc_proto;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001145 }
1146 rc = llc_sysctl_init();
1147 if (rc) {
1148 printk(llc_sysctl_err_msg);
1149 goto out_proc;
1150 }
1151 rc = sock_register(&llc_ui_family_ops);
1152 if (rc) {
1153 printk(llc_sock_err_msg);
1154 goto out_sysctl;
1155 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001156 llc_add_pack(LLC_DEST_SAP, llc_sap_handler);
1157 llc_add_pack(LLC_DEST_CONN, llc_conn_handler);
1158out:
1159 return rc;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001160out_sysctl:
1161 llc_sysctl_exit();
1162out_proc:
1163 llc_proc_exit();
Linus Torvalds1da177e2005-04-16 15:20:36 -07001164out_unregister_llc_proto:
1165 proto_unregister(&llc_proto);
1166 goto out;
1167}
1168
1169static void __exit llc2_exit(void)
1170{
1171 llc_station_exit();
1172 llc_remove_pack(LLC_DEST_SAP);
1173 llc_remove_pack(LLC_DEST_CONN);
1174 sock_unregister(PF_LLC);
1175 llc_proc_exit();
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001176 llc_sysctl_exit();
Linus Torvalds1da177e2005-04-16 15:20:36 -07001177 proto_unregister(&llc_proto);
1178}
1179
1180module_init(llc2_init);
1181module_exit(llc2_exit);
1182
1183MODULE_LICENSE("GPL");
1184MODULE_AUTHOR("Procom 1997, Jay Schullist 2001, Arnaldo C. Melo 2001-2003");
1185MODULE_DESCRIPTION("IEEE 802.2 PF_LLC support");
1186MODULE_ALIAS_NETPROTO(PF_LLC);