blob: 7d9fa38b6a7d14ca5a35d8c782d5b7e0f383a34a [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 */
153static int llc_ui_create(struct socket *sock, int protocol)
154{
155 struct sock *sk;
156 int rc = -ESOCKTNOSUPPORT;
157
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300158 if (likely(sock->type == SOCK_DGRAM || sock->type == SOCK_STREAM)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700159 rc = -ENOMEM;
160 sk = llc_sk_alloc(PF_LLC, GFP_KERNEL, &llc_proto);
161 if (sk) {
162 rc = 0;
163 llc_ui_sk_init(sock, sk);
164 }
165 }
166 return rc;
167}
168
169/**
170 * llc_ui_release - shutdown socket
171 * @sock: Socket to release.
172 *
173 * Shutdown and deallocate an existing socket.
174 */
175static int llc_ui_release(struct socket *sock)
176{
177 struct sock *sk = sock->sk;
178 struct llc_sock *llc;
179
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300180 if (unlikely(sk == NULL))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700181 goto out;
182 sock_hold(sk);
183 lock_sock(sk);
184 llc = llc_sk(sk);
185 dprintk("%s: closing local(%02X) remote(%02X)\n", __FUNCTION__,
186 llc->laddr.lsap, llc->daddr.lsap);
187 if (!llc_send_disc(sk))
188 llc_ui_wait_for_disc(sk, sk->sk_rcvtimeo);
Arnaldo Carvalho de Melo2e1f47c2006-03-20 21:28:11 -0800189 if (!sock_flag(sk, SOCK_ZAPPED)) {
190 llc_sap_put(llc->sap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700191 llc_sap_remove_socket(llc->sap, sk);
Arnaldo Carvalho de Melo2e1f47c2006-03-20 21:28:11 -0800192 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700193 release_sock(sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700194 if (llc->dev)
195 dev_put(llc->dev);
196 sock_put(sk);
197 llc_sk_free(sk);
198out:
199 return 0;
200}
201
202/**
203 * llc_ui_autoport - provide dynamically allocate SAP number
204 *
205 * Provide the caller with a dynamically allocated SAP number according
206 * to the rules that are set in this function. Returns: 0, upon failure,
207 * SAP number otherwise.
208 */
209static int llc_ui_autoport(void)
210{
211 struct llc_sap *sap;
212 int i, tries = 0;
213
214 while (tries < LLC_SAP_DYN_TRIES) {
215 for (i = llc_ui_sap_last_autoport;
216 i < LLC_SAP_DYN_STOP; i += 2) {
217 sap = llc_sap_find(i);
218 if (!sap) {
219 llc_ui_sap_last_autoport = i + 2;
220 goto out;
221 }
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -0300222 llc_sap_put(sap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700223 }
224 llc_ui_sap_last_autoport = LLC_SAP_DYN_START;
225 tries++;
226 }
227 i = 0;
228out:
229 return i;
230}
231
232/**
Arnaldo Carvalho de Melo5a770c02005-09-22 03:56:26 -0300233 * llc_ui_autobind - automatically bind a socket to a sap
234 * @sock: socket to bind
235 * @addr: address to connect to
Linus Torvalds1da177e2005-04-16 15:20:36 -0700236 *
Arnaldo Carvalho de Melo5a770c02005-09-22 03:56:26 -0300237 * Used by llc_ui_connect and llc_ui_sendmsg when the user hasn't
238 * specifically used llc_ui_bind to bind to an specific address/sap
239 *
Linus Torvalds1da177e2005-04-16 15:20:36 -0700240 * Returns: 0 upon success, negative otherwise.
241 */
242static int llc_ui_autobind(struct socket *sock, struct sockaddr_llc *addr)
243{
244 struct sock *sk = sock->sk;
245 struct llc_sock *llc = llc_sk(sk);
246 struct llc_sap *sap;
247 int rc = -EINVAL;
248
249 if (!sock_flag(sk, SOCK_ZAPPED))
250 goto out;
251 rc = -ENODEV;
252 llc->dev = dev_getfirstbyhwtype(addr->sllc_arphrd);
253 if (!llc->dev)
254 goto out;
255 rc = -EUSERS;
256 llc->laddr.lsap = llc_ui_autoport();
257 if (!llc->laddr.lsap)
258 goto out;
259 rc = -EBUSY; /* some other network layer is using the sap */
260 sap = llc_sap_open(llc->laddr.lsap, NULL);
261 if (!sap)
262 goto out;
263 memcpy(llc->laddr.mac, llc->dev->dev_addr, IFHWADDRLEN);
264 memcpy(&llc->addr, addr, sizeof(llc->addr));
265 /* assign new connection to its SAP */
266 llc_sap_add_socket(sap, sk);
267 sock_reset_flag(sk, SOCK_ZAPPED);
268 rc = 0;
269out:
270 return rc;
271}
272
273/**
274 * llc_ui_bind - bind a socket to a specific address.
275 * @sock: Socket to bind an address to.
276 * @uaddr: Address the user wants the socket bound to.
277 * @addrlen: Length of the uaddr structure.
278 *
279 * 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 -0300280 * a specific sap only or mac + sap.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700281 * If the user desires to bind to a specific mac + sap, it is possible to
282 * have multiple sap connections via multiple macs.
283 * Bind and autobind for that matter must enforce the correct sap usage
284 * otherwise all hell will break loose.
285 * Returns: 0 upon success, negative otherwise.
286 */
287static int llc_ui_bind(struct socket *sock, struct sockaddr *uaddr, int addrlen)
288{
289 struct sockaddr_llc *addr = (struct sockaddr_llc *)uaddr;
290 struct sock *sk = sock->sk;
291 struct llc_sock *llc = llc_sk(sk);
292 struct llc_sap *sap;
293 int rc = -EINVAL;
294
295 dprintk("%s: binding %02X\n", __FUNCTION__, addr->sllc_sap);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300296 if (unlikely(!sock_flag(sk, SOCK_ZAPPED) || addrlen != sizeof(*addr)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700297 goto out;
298 rc = -EAFNOSUPPORT;
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300299 if (unlikely(addr->sllc_family != AF_LLC))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700300 goto out;
Jochen Friedrichcf309e32005-09-22 04:44:55 -0300301 rc = -ENODEV;
302 rtnl_lock();
303 llc->dev = dev_getbyhwaddr(addr->sllc_arphrd, addr->sllc_mac);
304 rtnl_unlock();
305 if (!llc->dev)
306 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700307 if (!addr->sllc_sap) {
308 rc = -EUSERS;
309 addr->sllc_sap = llc_ui_autoport();
310 if (!addr->sllc_sap)
311 goto out;
312 }
313 sap = llc_sap_find(addr->sllc_sap);
314 if (!sap) {
315 sap = llc_sap_open(addr->sllc_sap, NULL);
316 rc = -EBUSY; /* some other network layer is using the sap */
317 if (!sap)
318 goto out;
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -0300319 llc_sap_hold(sap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700320 } else {
321 struct llc_addr laddr, daddr;
322 struct sock *ask;
323
324 memset(&laddr, 0, sizeof(laddr));
325 memset(&daddr, 0, sizeof(daddr));
326 /*
327 * FIXME: check if the the address is multicast,
328 * only SOCK_DGRAM can do this.
329 */
330 memcpy(laddr.mac, addr->sllc_mac, IFHWADDRLEN);
331 laddr.lsap = addr->sllc_sap;
332 rc = -EADDRINUSE; /* mac + sap clash. */
333 ask = llc_lookup_established(sap, &daddr, &laddr);
334 if (ask) {
335 sock_put(ask);
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -0300336 goto out_put;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700337 }
338 }
339 llc->laddr.lsap = addr->sllc_sap;
340 memcpy(llc->laddr.mac, addr->sllc_mac, IFHWADDRLEN);
341 memcpy(&llc->addr, addr, sizeof(llc->addr));
342 /* assign new connection to its SAP */
343 llc_sap_add_socket(sap, sk);
344 sock_reset_flag(sk, SOCK_ZAPPED);
345 rc = 0;
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -0300346out_put:
347 llc_sap_put(sap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700348out:
349 return rc;
350}
351
352/**
353 * llc_ui_shutdown - shutdown a connect llc2 socket.
354 * @sock: Socket to shutdown.
355 * @how: What part of the socket to shutdown.
356 *
357 * Shutdown a connected llc2 socket. Currently this function only supports
358 * shutting down both sends and receives (2), we could probably make this
359 * function such that a user can shutdown only half the connection but not
360 * right now.
361 * Returns: 0 upon success, negative otherwise.
362 */
363static int llc_ui_shutdown(struct socket *sock, int how)
364{
365 struct sock *sk = sock->sk;
366 int rc = -ENOTCONN;
367
368 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300369 if (unlikely(sk->sk_state != TCP_ESTABLISHED))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700370 goto out;
371 rc = -EINVAL;
372 if (how != 2)
373 goto out;
374 rc = llc_send_disc(sk);
375 if (!rc)
376 rc = llc_ui_wait_for_disc(sk, sk->sk_rcvtimeo);
377 /* Wake up anyone sleeping in poll */
378 sk->sk_state_change(sk);
379out:
380 release_sock(sk);
381 return rc;
382}
383
384/**
385 * llc_ui_connect - Connect to a remote llc2 mac + sap.
386 * @sock: Socket which will be connected to the remote destination.
387 * @uaddr: Remote and possibly the local address of the new connection.
388 * @addrlen: Size of uaddr structure.
389 * @flags: Operational flags specified by the user.
390 *
391 * Connect to a remote llc2 mac + sap. The caller must specify the
392 * destination mac and address to connect to. If the user hasn't previously
393 * called bind(2) with a smac the address of the first interface of the
394 * specified arp type will be used.
395 * This function will autobind if user did not previously call bind.
396 * Returns: 0 upon success, negative otherwise.
397 */
398static int llc_ui_connect(struct socket *sock, struct sockaddr *uaddr,
399 int addrlen, int flags)
400{
401 struct sock *sk = sock->sk;
402 struct llc_sock *llc = llc_sk(sk);
403 struct sockaddr_llc *addr = (struct sockaddr_llc *)uaddr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700404 int rc = -EINVAL;
405
406 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300407 if (unlikely(addrlen != sizeof(*addr)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700408 goto out;
409 rc = -EAFNOSUPPORT;
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300410 if (unlikely(addr->sllc_family != AF_LLC))
411 goto out;
412 if (unlikely(sk->sk_type != SOCK_STREAM))
413 goto out;
414 rc = -EALREADY;
415 if (unlikely(sock->state == SS_CONNECTING))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700416 goto out;
417 /* bind connection to sap if user hasn't done it. */
418 if (sock_flag(sk, SOCK_ZAPPED)) {
419 /* bind to sap with null dev, exclusive */
420 rc = llc_ui_autobind(sock, addr);
421 if (rc)
422 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700423 }
Jochen Friedrich5564af22005-09-22 04:46:44 -0300424 llc->daddr.lsap = addr->sllc_sap;
425 memcpy(llc->daddr.mac, addr->sllc_mac, IFHWADDRLEN);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700426 sock->state = SS_CONNECTING;
427 sk->sk_state = TCP_SYN_SENT;
428 llc->link = llc_ui_next_link_no(llc->sap->laddr.lsap);
Arnaldo Carvalho de Melo774ccb42005-09-22 03:53:35 -0300429 rc = llc_establish_connection(sk, llc->dev->dev_addr,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700430 addr->sllc_mac, addr->sllc_sap);
431 if (rc) {
432 dprintk("%s: llc_ui_send_conn failed :-(\n", __FUNCTION__);
433 sock->state = SS_UNCONNECTED;
434 sk->sk_state = TCP_CLOSE;
435 goto out;
436 }
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300437
438 if (sk->sk_state == TCP_SYN_SENT) {
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300439 const long timeo = sock_sndtimeo(sk, flags & O_NONBLOCK);
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300440
441 if (!timeo || !llc_ui_wait_for_conn(sk, timeo))
442 goto out;
443
444 rc = sock_intr_errno(timeo);
445 if (signal_pending(current))
446 goto out;
447 }
448
449 if (sk->sk_state == TCP_CLOSE)
450 goto sock_error;
451
452 sock->state = SS_CONNECTED;
453 rc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700454out:
455 release_sock(sk);
456 return rc;
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300457sock_error:
458 rc = sock_error(sk) ? : -ECONNABORTED;
459 sock->state = SS_UNCONNECTED;
460 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700461}
462
463/**
464 * llc_ui_listen - allow a normal socket to accept incoming connections
465 * @sock: Socket to allow incoming connections on.
466 * @backlog: Number of connections to queue.
467 *
468 * Allow a normal socket to accept incoming connections.
469 * Returns 0 upon success, negative otherwise.
470 */
471static int llc_ui_listen(struct socket *sock, int backlog)
472{
473 struct sock *sk = sock->sk;
474 int rc = -EINVAL;
475
476 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300477 if (unlikely(sock->state != SS_UNCONNECTED))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700478 goto out;
479 rc = -EOPNOTSUPP;
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300480 if (unlikely(sk->sk_type != SOCK_STREAM))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700481 goto out;
482 rc = -EAGAIN;
483 if (sock_flag(sk, SOCK_ZAPPED))
484 goto out;
485 rc = 0;
486 if (!(unsigned)backlog) /* BSDism */
487 backlog = 1;
488 sk->sk_max_ack_backlog = backlog;
489 if (sk->sk_state != TCP_LISTEN) {
490 sk->sk_ack_backlog = 0;
491 sk->sk_state = TCP_LISTEN;
492 }
493 sk->sk_socket->flags |= __SO_ACCEPTCON;
494out:
495 release_sock(sk);
496 return rc;
497}
498
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300499static int llc_ui_wait_for_disc(struct sock *sk, long timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700500{
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300501 DEFINE_WAIT(wait);
502 int rc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700503
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300504 while (1) {
505 prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE);
506 if (sk_wait_event(sk, &timeout, sk->sk_state == TCP_CLOSE))
507 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700508 rc = -ERESTARTSYS;
509 if (signal_pending(current))
510 break;
511 rc = -EAGAIN;
512 if (!timeout)
513 break;
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300514 rc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700515 }
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300516 finish_wait(sk->sk_sleep, &wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700517 return rc;
518}
519
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300520static int llc_ui_wait_for_conn(struct sock *sk, long timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700521{
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300522 DEFINE_WAIT(wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700523
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300524 while (1) {
525 prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE);
526 if (sk_wait_event(sk, &timeout, sk->sk_state != TCP_SYN_SENT))
527 break;
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300528 if (signal_pending(current) || !timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700529 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700530 }
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300531 finish_wait(sk->sk_sleep, &wait);
532 return timeout;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700533}
534
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300535static int llc_ui_wait_for_busy_core(struct sock *sk, long timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700536{
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300537 DEFINE_WAIT(wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700538 struct llc_sock *llc = llc_sk(sk);
539 int rc;
540
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300541 while (1) {
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300542 prepare_to_wait(sk->sk_sleep, &wait, TASK_INTERRUPTIBLE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700543 rc = 0;
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300544 if (sk_wait_event(sk, &timeout,
545 (sk->sk_shutdown & RCV_SHUTDOWN) ||
546 (!llc_data_accept_state(llc->state) &&
Jochen Friedrich451677c2005-11-14 21:57:46 -0800547 !llc->remote_busy_flag &&
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300548 !llc->p_flag)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700549 break;
550 rc = -ERESTARTSYS;
551 if (signal_pending(current))
552 break;
553 rc = -EAGAIN;
554 if (!timeout)
555 break;
556 }
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300557 finish_wait(sk->sk_sleep, &wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700558 return rc;
559}
560
Arnaldo Carvalho de Melo2928c192005-09-22 05:14:33 -0300561static int llc_wait_data(struct sock *sk, long timeo)
Arnaldo Carvalho de Meloafdbe352005-09-22 04:37:07 -0300562{
563 int rc;
564
565 while (1) {
566 /*
567 * POSIX 1003.1g mandates this order.
568 */
Benjamin LaHaisec1cbe4b2005-12-13 23:22:19 -0800569 rc = sock_error(sk);
570 if (rc)
Arnaldo Carvalho de Meloafdbe352005-09-22 04:37:07 -0300571 break;
Arnaldo Carvalho de Meloafdbe352005-09-22 04:37:07 -0300572 rc = 0;
573 if (sk->sk_shutdown & RCV_SHUTDOWN)
574 break;
575 rc = -EAGAIN;
576 if (!timeo)
577 break;
578 rc = sock_intr_errno(timeo);
579 if (signal_pending(current))
580 break;
581 rc = 0;
582 if (sk_wait_data(sk, &timeo))
583 break;
584 }
585 return rc;
586}
587
Linus Torvalds1da177e2005-04-16 15:20:36 -0700588/**
589 * llc_ui_accept - accept a new incoming connection.
590 * @sock: Socket which connections arrive on.
591 * @newsock: Socket to move incoming connection to.
592 * @flags: User specified operational flags.
593 *
594 * Accept a new incoming connection.
595 * Returns 0 upon success, negative otherwise.
596 */
597static int llc_ui_accept(struct socket *sock, struct socket *newsock, int flags)
598{
599 struct sock *sk = sock->sk, *newsk;
600 struct llc_sock *llc, *newllc;
601 struct sk_buff *skb;
602 int rc = -EOPNOTSUPP;
603
604 dprintk("%s: accepting on %02X\n", __FUNCTION__,
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900605 llc_sk(sk)->laddr.lsap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700606 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300607 if (unlikely(sk->sk_type != SOCK_STREAM))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700608 goto out;
609 rc = -EINVAL;
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300610 if (unlikely(sock->state != SS_UNCONNECTED ||
611 sk->sk_state != TCP_LISTEN))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700612 goto out;
613 /* wait for a connection to arrive. */
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300614 if (skb_queue_empty(&sk->sk_receive_queue)) {
Arnaldo Carvalho de Meloafdbe352005-09-22 04:37:07 -0300615 rc = llc_wait_data(sk, sk->sk_rcvtimeo);
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300616 if (rc)
617 goto out;
618 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700619 dprintk("%s: got a new connection on %02X\n", __FUNCTION__,
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900620 llc_sk(sk)->laddr.lsap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700621 skb = skb_dequeue(&sk->sk_receive_queue);
622 rc = -EINVAL;
623 if (!skb->sk)
624 goto frees;
625 rc = 0;
626 newsk = skb->sk;
627 /* attach connection to a new socket. */
628 llc_ui_sk_init(newsock, newsk);
629 sock_reset_flag(newsk, SOCK_ZAPPED);
630 newsk->sk_state = TCP_ESTABLISHED;
631 newsock->state = SS_CONNECTED;
632 llc = llc_sk(sk);
633 newllc = llc_sk(newsk);
634 memcpy(&newllc->addr, &llc->addr, sizeof(newllc->addr));
635 newllc->link = llc_ui_next_link_no(newllc->laddr.lsap);
636
637 /* put original socket back into a clean listen state. */
638 sk->sk_state = TCP_LISTEN;
639 sk->sk_ack_backlog--;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700640 dprintk("%s: ok success on %02X, client on %02X\n", __FUNCTION__,
641 llc_sk(sk)->addr.sllc_sap, newllc->daddr.lsap);
642frees:
643 kfree_skb(skb);
644out:
645 release_sock(sk);
646 return rc;
647}
648
649/**
650 * llc_ui_recvmsg - copy received data to the socket user.
651 * @sock: Socket to copy data from.
652 * @msg: Various user space related information.
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300653 * @len: Size of user buffer.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700654 * @flags: User specified flags.
655 *
656 * Copy received data to the socket user.
657 * Returns non-negative upon success, negative otherwise.
658 */
659static int llc_ui_recvmsg(struct kiocb *iocb, struct socket *sock,
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300660 struct msghdr *msg, size_t len, int flags)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700661{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700662 struct sockaddr_llc *uaddr = (struct sockaddr_llc *)msg->msg_name;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300663 const int nonblock = flags & MSG_DONTWAIT;
664 struct sk_buff *skb = NULL;
665 struct sock *sk = sock->sk;
666 struct llc_sock *llc = llc_sk(sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700667 size_t copied = 0;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300668 u32 peek_seq = 0;
669 u32 *seq;
670 unsigned long used;
671 int target; /* Read at least this many bytes */
672 long timeo;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700673
Linus Torvalds1da177e2005-04-16 15:20:36 -0700674 lock_sock(sk);
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300675 copied = -ENOTCONN;
Stephen Hemminger29efcd22006-05-25 15:08:59 -0700676 if (unlikely(sk->sk_type == SOCK_STREAM && sk->sk_state == TCP_LISTEN))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700677 goto out;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300678
679 timeo = sock_rcvtimeo(sk, nonblock);
680
681 seq = &llc->copied_seq;
682 if (flags & MSG_PEEK) {
683 peek_seq = llc->copied_seq;
684 seq = &peek_seq;
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900685 }
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300686
687 target = sock_rcvlowat(sk, flags & MSG_WAITALL, len);
688 copied = 0;
689
690 do {
691 u32 offset;
692
693 /*
694 * We need to check signals first, to get correct SIGURG
695 * handling. FIXME: Need to check this doesn't impact 1003.1g
696 * and move it down to the bottom of the loop
697 */
698 if (signal_pending(current)) {
699 if (copied)
700 break;
701 copied = timeo ? sock_intr_errno(timeo) : -EAGAIN;
702 break;
703 }
704
705 /* Next get a buffer. */
706
707 skb = skb_peek(&sk->sk_receive_queue);
708 if (skb) {
709 offset = *seq;
710 goto found_ok_skb;
711 }
712 /* Well, if we have backlog, try to process it now yet. */
713
714 if (copied >= target && !sk->sk_backlog.tail)
715 break;
716
717 if (copied) {
718 if (sk->sk_err ||
719 sk->sk_state == TCP_CLOSE ||
720 (sk->sk_shutdown & RCV_SHUTDOWN) ||
721 !timeo ||
722 (flags & MSG_PEEK))
723 break;
724 } else {
725 if (sock_flag(sk, SOCK_DONE))
726 break;
727
728 if (sk->sk_err) {
729 copied = sock_error(sk);
730 break;
731 }
732 if (sk->sk_shutdown & RCV_SHUTDOWN)
733 break;
734
Stephen Hemminger29efcd22006-05-25 15:08:59 -0700735 if (sk->sk_type == SOCK_STREAM && sk->sk_state == TCP_CLOSE) {
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300736 if (!sock_flag(sk, SOCK_DONE)) {
737 /*
738 * This occurs when user tries to read
739 * from never connected socket.
740 */
741 copied = -ENOTCONN;
742 break;
743 }
744 break;
745 }
746 if (!timeo) {
747 copied = -EAGAIN;
748 break;
749 }
750 }
751
752 if (copied >= target) { /* Do not sleep, just process backlog. */
753 release_sock(sk);
754 lock_sock(sk);
755 } else
756 sk_wait_data(sk, &timeo);
757
758 if ((flags & MSG_PEEK) && peek_seq != llc->copied_seq) {
759 if (net_ratelimit())
760 printk(KERN_DEBUG "LLC(%s:%d): Application "
761 "bug, race in MSG_PEEK.\n",
762 current->comm, current->pid);
763 peek_seq = llc->copied_seq;
764 }
765 continue;
766 found_ok_skb:
767 /* Ok so how much can we use? */
768 used = skb->len - offset;
769 if (len < used)
770 used = len;
771
772 if (!(flags & MSG_TRUNC)) {
773 int rc = skb_copy_datagram_iovec(skb, offset,
774 msg->msg_iov, used);
775 if (rc) {
776 /* Exception. Bailout! */
777 if (!copied)
778 copied = -EFAULT;
779 break;
780 }
781 }
782
783 *seq += used;
784 copied += used;
785 len -= used;
786
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300787 if (!(flags & MSG_PEEK)) {
Chris Leech624d1162006-05-23 18:01:28 -0700788 sk_eat_skb(sk, skb, 0);
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300789 *seq = 0;
790 }
Stephen Hemminger30a584d2006-08-03 16:38:49 -0700791
792 /* For non stream protcols we get one packet per recvmsg call */
793 if (sk->sk_type != SOCK_STREAM)
794 goto copy_uaddr;
795
796 /* Partial read */
797 if (used + offset < skb->len)
798 continue;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300799 } while (len > 0);
800
Linus Torvalds1da177e2005-04-16 15:20:36 -0700801out:
802 release_sock(sk);
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300803 return copied;
804copy_uaddr:
805 if (uaddr != NULL && skb != NULL) {
806 memcpy(uaddr, llc_ui_skb_cb(skb), sizeof(*uaddr));
807 msg->msg_namelen = sizeof(*uaddr);
808 }
809 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700810}
811
812/**
813 * llc_ui_sendmsg - Transmit data provided by the socket user.
814 * @sock: Socket to transmit data from.
815 * @msg: Various user related information.
816 * @len: Length of data to transmit.
817 *
818 * Transmit data provided by the socket user.
819 * Returns non-negative upon success, negative otherwise.
820 */
821static int llc_ui_sendmsg(struct kiocb *iocb, struct socket *sock,
822 struct msghdr *msg, size_t len)
823{
824 struct sock *sk = sock->sk;
825 struct llc_sock *llc = llc_sk(sk);
826 struct sockaddr_llc *addr = (struct sockaddr_llc *)msg->msg_name;
827 int flags = msg->msg_flags;
828 int noblock = flags & MSG_DONTWAIT;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700829 struct sk_buff *skb;
830 size_t size = 0;
831 int rc = -EINVAL, copied = 0, hdrlen;
832
833 dprintk("%s: sending from %02X to %02X\n", __FUNCTION__,
834 llc->laddr.lsap, llc->daddr.lsap);
835 lock_sock(sk);
836 if (addr) {
837 if (msg->msg_namelen < sizeof(*addr))
838 goto release;
839 } else {
840 if (llc_ui_addr_null(&llc->addr))
841 goto release;
842 addr = &llc->addr;
843 }
844 /* must bind connection to sap if user hasn't done it. */
845 if (sock_flag(sk, SOCK_ZAPPED)) {
846 /* bind to sap with null dev, exclusive. */
847 rc = llc_ui_autobind(sock, addr);
848 if (rc)
849 goto release;
850 }
Arnaldo Carvalho de Melo774ccb42005-09-22 03:53:35 -0300851 hdrlen = llc->dev->hard_header_len + llc_ui_header_len(sk, addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700852 size = hdrlen + len;
Arnaldo Carvalho de Melo774ccb42005-09-22 03:53:35 -0300853 if (size > llc->dev->mtu)
854 size = llc->dev->mtu;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700855 copied = size - hdrlen;
856 release_sock(sk);
857 skb = sock_alloc_send_skb(sk, size, noblock, &rc);
858 lock_sock(sk);
859 if (!skb)
860 goto release;
Arnaldo Carvalho de Melo774ccb42005-09-22 03:53:35 -0300861 skb->dev = llc->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700862 skb->protocol = llc_proto_type(addr->sllc_arphrd);
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900863 skb_reserve(skb, hdrlen);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700864 rc = memcpy_fromiovec(skb_put(skb, copied), msg->msg_iov, copied);
865 if (rc)
866 goto out;
867 if (sk->sk_type == SOCK_DGRAM || addr->sllc_ua) {
868 llc_build_and_send_ui_pkt(llc->sap, skb, addr->sllc_mac,
869 addr->sllc_sap);
870 goto out;
871 }
872 if (addr->sllc_test) {
873 llc_build_and_send_test_pkt(llc->sap, skb, addr->sllc_mac,
874 addr->sllc_sap);
875 goto out;
876 }
877 if (addr->sllc_xid) {
878 llc_build_and_send_xid_pkt(llc->sap, skb, addr->sllc_mac,
879 addr->sllc_sap);
880 goto out;
881 }
882 rc = -ENOPROTOOPT;
883 if (!(sk->sk_type == SOCK_STREAM && !addr->sllc_ua))
884 goto out;
885 rc = llc_ui_send_data(sk, skb, noblock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700886out:
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300887 if (rc) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700888 kfree_skb(skb);
889release:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700890 dprintk("%s: failed sending from %02X to %02X: %d\n",
891 __FUNCTION__, llc->laddr.lsap, llc->daddr.lsap, rc);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300892 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700893 release_sock(sk);
894 return rc ? : copied;
895}
896
897/**
898 * llc_ui_getname - return the address info of a socket
899 * @sock: Socket to get address of.
900 * @uaddr: Address structure to return information.
901 * @uaddrlen: Length of address structure.
902 * @peer: Does user want local or remote address information.
903 *
904 * Return the address information of a socket.
905 */
906static int llc_ui_getname(struct socket *sock, struct sockaddr *uaddr,
907 int *uaddrlen, int peer)
908{
909 struct sockaddr_llc sllc;
910 struct sock *sk = sock->sk;
911 struct llc_sock *llc = llc_sk(sk);
912 int rc = 0;
913
914 lock_sock(sk);
915 if (sock_flag(sk, SOCK_ZAPPED))
916 goto out;
917 *uaddrlen = sizeof(sllc);
918 memset(uaddr, 0, *uaddrlen);
919 if (peer) {
920 rc = -ENOTCONN;
921 if (sk->sk_state != TCP_ESTABLISHED)
922 goto out;
923 if(llc->dev)
924 sllc.sllc_arphrd = llc->dev->type;
925 sllc.sllc_sap = llc->daddr.lsap;
926 memcpy(&sllc.sllc_mac, &llc->daddr.mac, IFHWADDRLEN);
927 } else {
928 rc = -EINVAL;
929 if (!llc->sap)
930 goto out;
931 sllc.sllc_sap = llc->sap->laddr.lsap;
932
933 if (llc->dev) {
934 sllc.sllc_arphrd = llc->dev->type;
935 memcpy(&sllc.sllc_mac, &llc->dev->dev_addr,
936 IFHWADDRLEN);
937 }
938 }
939 rc = 0;
940 sllc.sllc_family = AF_LLC;
941 memcpy(uaddr, &sllc, sizeof(sllc));
942out:
943 release_sock(sk);
944 return rc;
945}
946
947/**
948 * llc_ui_ioctl - io controls for PF_LLC
949 * @sock: Socket to get/set info
950 * @cmd: command
951 * @arg: optional argument for cmd
952 *
953 * get/set info on llc sockets
954 */
955static int llc_ui_ioctl(struct socket *sock, unsigned int cmd,
956 unsigned long arg)
957{
Christoph Hellwigb5e5fa52006-01-03 14:18:33 -0800958 return -ENOIOCTLCMD;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700959}
960
961/**
962 * llc_ui_setsockopt - set various connection specific parameters.
963 * @sock: Socket to set options on.
964 * @level: Socket level user is requesting operations on.
965 * @optname: Operation name.
966 * @optval User provided operation data.
967 * @optlen: Length of optval.
968 *
969 * Set various connection specific parameters.
970 */
971static int llc_ui_setsockopt(struct socket *sock, int level, int optname,
972 char __user *optval, int optlen)
973{
974 struct sock *sk = sock->sk;
975 struct llc_sock *llc = llc_sk(sk);
976 int rc = -EINVAL, opt;
977
978 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300979 if (unlikely(level != SOL_LLC || optlen != sizeof(int)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700980 goto out;
981 rc = get_user(opt, (int __user *)optval);
982 if (rc)
983 goto out;
984 rc = -EINVAL;
985 switch (optname) {
986 case LLC_OPT_RETRY:
987 if (opt > LLC_OPT_MAX_RETRY)
988 goto out;
989 llc->n2 = opt;
990 break;
991 case LLC_OPT_SIZE:
992 if (opt > LLC_OPT_MAX_SIZE)
993 goto out;
994 llc->n1 = opt;
995 break;
996 case LLC_OPT_ACK_TMR_EXP:
997 if (opt > LLC_OPT_MAX_ACK_TMR_EXP)
998 goto out;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -0300999 llc->ack_timer.expire = opt * HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001000 break;
1001 case LLC_OPT_P_TMR_EXP:
1002 if (opt > LLC_OPT_MAX_P_TMR_EXP)
1003 goto out;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001004 llc->pf_cycle_timer.expire = opt * HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001005 break;
1006 case LLC_OPT_REJ_TMR_EXP:
1007 if (opt > LLC_OPT_MAX_REJ_TMR_EXP)
1008 goto out;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001009 llc->rej_sent_timer.expire = opt * HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001010 break;
1011 case LLC_OPT_BUSY_TMR_EXP:
1012 if (opt > LLC_OPT_MAX_BUSY_TMR_EXP)
1013 goto out;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001014 llc->busy_state_timer.expire = opt * HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001015 break;
1016 case LLC_OPT_TX_WIN:
1017 if (opt > LLC_OPT_MAX_WIN)
1018 goto out;
1019 llc->k = opt;
1020 break;
1021 case LLC_OPT_RX_WIN:
1022 if (opt > LLC_OPT_MAX_WIN)
1023 goto out;
1024 llc->rw = opt;
1025 break;
1026 default:
1027 rc = -ENOPROTOOPT;
1028 goto out;
1029 }
1030 rc = 0;
1031out:
1032 release_sock(sk);
1033 return rc;
1034}
1035
1036/**
1037 * llc_ui_getsockopt - get connection specific socket info
1038 * @sock: Socket to get information from.
1039 * @level: Socket level user is requesting operations on.
1040 * @optname: Operation name.
1041 * @optval: Variable to return operation data in.
1042 * @optlen: Length of optval.
1043 *
1044 * Get connection specific socket information.
1045 */
1046static int llc_ui_getsockopt(struct socket *sock, int level, int optname,
1047 char __user *optval, int __user *optlen)
1048{
1049 struct sock *sk = sock->sk;
1050 struct llc_sock *llc = llc_sk(sk);
1051 int val = 0, len = 0, rc = -EINVAL;
1052
1053 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -03001054 if (unlikely(level != SOL_LLC))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001055 goto out;
1056 rc = get_user(len, optlen);
1057 if (rc)
1058 goto out;
1059 rc = -EINVAL;
1060 if (len != sizeof(int))
1061 goto out;
1062 switch (optname) {
1063 case LLC_OPT_RETRY:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001064 val = llc->n2; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001065 case LLC_OPT_SIZE:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001066 val = llc->n1; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001067 case LLC_OPT_ACK_TMR_EXP:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001068 val = llc->ack_timer.expire / HZ; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001069 case LLC_OPT_P_TMR_EXP:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001070 val = llc->pf_cycle_timer.expire / HZ; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001071 case LLC_OPT_REJ_TMR_EXP:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001072 val = llc->rej_sent_timer.expire / HZ; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001073 case LLC_OPT_BUSY_TMR_EXP:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001074 val = llc->busy_state_timer.expire / HZ; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001075 case LLC_OPT_TX_WIN:
1076 val = llc->k; break;
1077 case LLC_OPT_RX_WIN:
1078 val = llc->rw; break;
1079 default:
1080 rc = -ENOPROTOOPT;
1081 goto out;
1082 }
1083 rc = 0;
1084 if (put_user(len, optlen) || copy_to_user(optval, &val, len))
1085 rc = -EFAULT;
1086out:
1087 release_sock(sk);
1088 return rc;
1089}
1090
1091static struct net_proto_family llc_ui_family_ops = {
1092 .family = PF_LLC,
1093 .create = llc_ui_create,
1094 .owner = THIS_MODULE,
1095};
1096
Eric Dumazet90ddc4f2005-12-22 12:49:22 -08001097static const struct proto_ops llc_ui_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001098 .family = PF_LLC,
1099 .owner = THIS_MODULE,
1100 .release = llc_ui_release,
1101 .bind = llc_ui_bind,
1102 .connect = llc_ui_connect,
1103 .socketpair = sock_no_socketpair,
1104 .accept = llc_ui_accept,
1105 .getname = llc_ui_getname,
1106 .poll = datagram_poll,
1107 .ioctl = llc_ui_ioctl,
1108 .listen = llc_ui_listen,
1109 .shutdown = llc_ui_shutdown,
1110 .setsockopt = llc_ui_setsockopt,
1111 .getsockopt = llc_ui_getsockopt,
1112 .sendmsg = llc_ui_sendmsg,
1113 .recvmsg = llc_ui_recvmsg,
1114 .mmap = sock_no_mmap,
1115 .sendpage = sock_no_sendpage,
1116};
1117
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001118static char llc_proc_err_msg[] __initdata =
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +09001119 KERN_CRIT "LLC: Unable to register the proc_fs entries\n";
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001120static char llc_sysctl_err_msg[] __initdata =
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +09001121 KERN_CRIT "LLC: Unable to register the sysctl entries\n";
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001122static char llc_sock_err_msg[] __initdata =
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +09001123 KERN_CRIT "LLC: Unable to register the network family\n";
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001124
Linus Torvalds1da177e2005-04-16 15:20:36 -07001125static int __init llc2_init(void)
1126{
1127 int rc = proto_register(&llc_proto, 0);
1128
1129 if (rc != 0)
1130 goto out;
1131
1132 llc_build_offset_table();
1133 llc_station_init();
1134 llc_ui_sap_last_autoport = LLC_SAP_DYN_START;
1135 rc = llc_proc_init();
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001136 if (rc != 0) {
1137 printk(llc_proc_err_msg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001138 goto out_unregister_llc_proto;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001139 }
1140 rc = llc_sysctl_init();
1141 if (rc) {
1142 printk(llc_sysctl_err_msg);
1143 goto out_proc;
1144 }
1145 rc = sock_register(&llc_ui_family_ops);
1146 if (rc) {
1147 printk(llc_sock_err_msg);
1148 goto out_sysctl;
1149 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001150 llc_add_pack(LLC_DEST_SAP, llc_sap_handler);
1151 llc_add_pack(LLC_DEST_CONN, llc_conn_handler);
1152out:
1153 return rc;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001154out_sysctl:
1155 llc_sysctl_exit();
1156out_proc:
1157 llc_proc_exit();
Linus Torvalds1da177e2005-04-16 15:20:36 -07001158out_unregister_llc_proto:
1159 proto_unregister(&llc_proto);
1160 goto out;
1161}
1162
1163static void __exit llc2_exit(void)
1164{
1165 llc_station_exit();
1166 llc_remove_pack(LLC_DEST_SAP);
1167 llc_remove_pack(LLC_DEST_CONN);
1168 sock_unregister(PF_LLC);
1169 llc_proc_exit();
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001170 llc_sysctl_exit();
Linus Torvalds1da177e2005-04-16 15:20:36 -07001171 proto_unregister(&llc_proto);
1172}
1173
1174module_init(llc2_init);
1175module_exit(llc2_exit);
1176
1177MODULE_LICENSE("GPL");
1178MODULE_AUTHOR("Procom 1997, Jay Schullist 2001, Arnaldo C. Melo 2001-2003");
1179MODULE_DESCRIPTION("IEEE 802.2 PF_LLC support");
1180MODULE_ALIAS_NETPROTO(PF_LLC);