blob: 8fd9febaa5bad8150bdf632b97221a140e0e3cbd [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>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090028#include <linux/slab.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070029#include <net/llc.h>
30#include <net/llc_sap.h>
31#include <net/llc_pdu.h>
32#include <net/llc_conn.h>
Arnaldo Carvalho de Meloc752f072005-08-09 20:08:28 -070033#include <net/tcp_states.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070034
35/* remember: uninitialized global data is zeroed because its in .bss */
36static u16 llc_ui_sap_last_autoport = LLC_SAP_DYN_START;
37static u16 llc_ui_sap_link_no_max[256];
38static struct sockaddr_llc llc_ui_addrnull;
Eric Dumazet90ddc4f2005-12-22 12:49:22 -080039static const struct proto_ops llc_ui_ops;
Linus Torvalds1da177e2005-04-16 15:20:36 -070040
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -030041static int llc_ui_wait_for_conn(struct sock *sk, long timeout);
42static int llc_ui_wait_for_disc(struct sock *sk, long timeout);
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -030043static int llc_ui_wait_for_busy_core(struct sock *sk, long timeout);
Linus Torvalds1da177e2005-04-16 15:20:36 -070044
45#if 0
46#define dprintk(args...) printk(KERN_DEBUG args)
47#else
48#define dprintk(args...)
49#endif
50
Octavian Purdilae5cd6fe2009-12-26 11:51:00 +000051/* Maybe we'll add some more in the future. */
52#define LLC_CMSG_PKTINFO 1
53
54
Linus Torvalds1da177e2005-04-16 15:20:36 -070055/**
56 * llc_ui_next_link_no - return the next unused link number for a sap
57 * @sap: Address of sap to get link number from.
58 *
59 * Return the next unused link number for a given sap.
60 */
Arnaldo Carvalho de Melo2342c992006-03-20 21:27:43 -080061static inline u16 llc_ui_next_link_no(int sap)
Linus Torvalds1da177e2005-04-16 15:20:36 -070062{
63 return llc_ui_sap_link_no_max[sap]++;
64}
65
66/**
67 * llc_proto_type - return eth protocol for ARP header type
68 * @arphrd: ARP header type.
69 *
70 * Given an ARP header type return the corresponding ethernet protocol.
71 */
Al Viro3fbd4182006-11-08 00:26:05 -080072static inline __be16 llc_proto_type(u16 arphrd)
Linus Torvalds1da177e2005-04-16 15:20:36 -070073{
Paul Gortmaker211ed862012-05-10 17:14:35 -040074 return htons(ETH_P_802_2);
Linus Torvalds1da177e2005-04-16 15:20:36 -070075}
76
77/**
78 * llc_ui_addr_null - determines if a address structure is null
79 * @addr: Address to test if null.
80 */
Arnaldo Carvalho de Melo2342c992006-03-20 21:27:43 -080081static inline u8 llc_ui_addr_null(struct sockaddr_llc *addr)
Linus Torvalds1da177e2005-04-16 15:20:36 -070082{
83 return !memcmp(addr, &llc_ui_addrnull, sizeof(*addr));
84}
85
86/**
87 * llc_ui_header_len - return length of llc header based on operation
88 * @sk: Socket which contains a valid llc socket type.
89 * @addr: Complete sockaddr_llc structure received from the user.
90 *
91 * Provide the length of the llc header depending on what kind of
92 * operation the user would like to perform and the type of socket.
93 * Returns the correct llc header length.
94 */
Arnaldo Carvalho de Melo2342c992006-03-20 21:27:43 -080095static inline u8 llc_ui_header_len(struct sock *sk, struct sockaddr_llc *addr)
Linus Torvalds1da177e2005-04-16 15:20:36 -070096{
97 u8 rc = LLC_PDU_LEN_U;
98
99 if (addr->sllc_test || addr->sllc_xid)
100 rc = LLC_PDU_LEN_U;
101 else if (sk->sk_type == SOCK_STREAM)
102 rc = LLC_PDU_LEN_I;
103 return rc;
104}
105
106/**
107 * llc_ui_send_data - send data via reliable llc2 connection
108 * @sk: Connection the socket is using.
109 * @skb: Data the user wishes to send.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700110 * @noblock: can we block waiting for data?
111 *
112 * Send data via reliable llc2 connection.
113 * Returns 0 upon success, non-zero if action did not succeed.
114 */
115static int llc_ui_send_data(struct sock* sk, struct sk_buff *skb, int noblock)
116{
117 struct llc_sock* llc = llc_sk(sk);
118 int rc = 0;
119
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900120 if (unlikely(llc_data_accept_state(llc->state) ||
Jochen Friedrich451677c2005-11-14 21:57:46 -0800121 llc->remote_busy_flag ||
122 llc->p_flag)) {
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300123 long timeout = sock_sndtimeo(sk, noblock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700124
125 rc = llc_ui_wait_for_busy_core(sk, timeout);
126 }
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300127 if (unlikely(!rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700128 rc = llc_build_and_send_pkt(sk, skb);
129 return rc;
130}
131
132static void llc_ui_sk_init(struct socket *sock, struct sock *sk)
133{
David S. Milleree5850d2008-06-17 01:21:03 -0700134 sock_graft(sk, sock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700135 sk->sk_type = sock->type;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700136 sock->ops = &llc_ui_ops;
137}
138
139static struct proto llc_proto = {
Arnaldo Carvalho de Melo9c005e02006-03-20 21:27:23 -0800140 .name = "LLC",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700141 .owner = THIS_MODULE,
142 .obj_size = sizeof(struct llc_sock),
Octavian Purdilab76f5a82009-12-26 11:51:02 +0000143 .slab_flags = SLAB_DESTROY_BY_RCU,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700144};
145
146/**
147 * llc_ui_create - alloc and init a new llc_ui socket
Eric Paris3f378b62009-11-05 22:18:14 -0800148 * @net: network namespace (must be default network)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700149 * @sock: Socket to initialize and attach allocated sk to.
150 * @protocol: Unused.
Eric Paris3f378b62009-11-05 22:18:14 -0800151 * @kern: on behalf of kernel or userspace
Linus Torvalds1da177e2005-04-16 15:20:36 -0700152 *
153 * Allocate and initialize a new llc_ui socket, validate the user wants a
154 * socket type we have available.
155 * Returns 0 upon success, negative upon failure.
156 */
Eric Paris3f378b62009-11-05 22:18:14 -0800157static int llc_ui_create(struct net *net, struct socket *sock, int protocol,
158 int kern)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700159{
160 struct sock *sk;
161 int rc = -ESOCKTNOSUPPORT;
162
Eric W. Biedermandf008c92012-11-16 03:03:07 +0000163 if (!ns_capable(net->user_ns, CAP_NET_RAW))
Patrick McHardy3480c632008-03-27 20:28:10 -0700164 return -EPERM;
165
Octavian Purdila09ad9bc2009-11-25 15:14:13 -0800166 if (!net_eq(net, &init_net))
Eric W. Biederman1b8d7ae2007-10-08 23:24:22 -0700167 return -EAFNOSUPPORT;
168
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300169 if (likely(sock->type == SOCK_DGRAM || sock->type == SOCK_STREAM)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700170 rc = -ENOMEM;
Eric W. Biederman11aa9c22015-05-08 21:09:13 -0500171 sk = llc_sk_alloc(net, PF_LLC, GFP_KERNEL, &llc_proto, kern);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700172 if (sk) {
173 rc = 0;
174 llc_ui_sk_init(sock, sk);
175 }
176 }
177 return rc;
178}
179
180/**
181 * llc_ui_release - shutdown socket
182 * @sock: Socket to release.
183 *
184 * Shutdown and deallocate an existing socket.
185 */
186static int llc_ui_release(struct socket *sock)
187{
188 struct sock *sk = sock->sk;
189 struct llc_sock *llc;
190
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300191 if (unlikely(sk == NULL))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700192 goto out;
193 sock_hold(sk);
194 lock_sock(sk);
195 llc = llc_sk(sk);
Harvey Harrison0dc47872008-03-05 20:47:47 -0800196 dprintk("%s: closing local(%02X) remote(%02X)\n", __func__,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700197 llc->laddr.lsap, llc->daddr.lsap);
198 if (!llc_send_disc(sk))
199 llc_ui_wait_for_disc(sk, sk->sk_rcvtimeo);
Octavian Purdila3100aa92009-12-26 11:51:08 +0000200 if (!sock_flag(sk, SOCK_ZAPPED))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700201 llc_sap_remove_socket(llc->sap, sk);
202 release_sock(sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700203 if (llc->dev)
204 dev_put(llc->dev);
205 sock_put(sk);
206 llc_sk_free(sk);
207out:
208 return 0;
209}
210
211/**
212 * llc_ui_autoport - provide dynamically allocate SAP number
213 *
214 * Provide the caller with a dynamically allocated SAP number according
215 * to the rules that are set in this function. Returns: 0, upon failure,
216 * SAP number otherwise.
217 */
218static int llc_ui_autoport(void)
219{
220 struct llc_sap *sap;
221 int i, tries = 0;
222
223 while (tries < LLC_SAP_DYN_TRIES) {
224 for (i = llc_ui_sap_last_autoport;
225 i < LLC_SAP_DYN_STOP; i += 2) {
226 sap = llc_sap_find(i);
227 if (!sap) {
228 llc_ui_sap_last_autoport = i + 2;
229 goto out;
230 }
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -0300231 llc_sap_put(sap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700232 }
233 llc_ui_sap_last_autoport = LLC_SAP_DYN_START;
234 tries++;
235 }
236 i = 0;
237out:
238 return i;
239}
240
241/**
Arnaldo Carvalho de Melo5a770c02005-09-22 03:56:26 -0300242 * llc_ui_autobind - automatically bind a socket to a sap
243 * @sock: socket to bind
244 * @addr: address to connect to
Linus Torvalds1da177e2005-04-16 15:20:36 -0700245 *
Arnaldo Carvalho de Melo5a770c02005-09-22 03:56:26 -0300246 * Used by llc_ui_connect and llc_ui_sendmsg when the user hasn't
247 * specifically used llc_ui_bind to bind to an specific address/sap
248 *
Linus Torvalds1da177e2005-04-16 15:20:36 -0700249 * Returns: 0 upon success, negative otherwise.
250 */
251static int llc_ui_autobind(struct socket *sock, struct sockaddr_llc *addr)
252{
253 struct sock *sk = sock->sk;
254 struct llc_sock *llc = llc_sk(sk);
255 struct llc_sap *sap;
256 int rc = -EINVAL;
257
258 if (!sock_flag(sk, SOCK_ZAPPED))
259 goto out;
260 rc = -ENODEV;
Octavian Purdilaabf9d532009-12-26 11:51:01 +0000261 if (sk->sk_bound_dev_if) {
262 llc->dev = dev_get_by_index(&init_net, sk->sk_bound_dev_if);
263 if (llc->dev && addr->sllc_arphrd != llc->dev->type) {
264 dev_put(llc->dev);
265 llc->dev = NULL;
266 }
267 } else
268 llc->dev = dev_getfirstbyhwtype(&init_net, addr->sllc_arphrd);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700269 if (!llc->dev)
270 goto out;
271 rc = -EUSERS;
272 llc->laddr.lsap = llc_ui_autoport();
273 if (!llc->laddr.lsap)
274 goto out;
275 rc = -EBUSY; /* some other network layer is using the sap */
276 sap = llc_sap_open(llc->laddr.lsap, NULL);
277 if (!sap)
278 goto out;
279 memcpy(llc->laddr.mac, llc->dev->dev_addr, IFHWADDRLEN);
280 memcpy(&llc->addr, addr, sizeof(llc->addr));
281 /* assign new connection to its SAP */
282 llc_sap_add_socket(sap, sk);
283 sock_reset_flag(sk, SOCK_ZAPPED);
284 rc = 0;
285out:
286 return rc;
287}
288
289/**
290 * llc_ui_bind - bind a socket to a specific address.
291 * @sock: Socket to bind an address to.
292 * @uaddr: Address the user wants the socket bound to.
293 * @addrlen: Length of the uaddr structure.
294 *
295 * 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 -0300296 * a specific sap only or mac + sap.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700297 * If the user desires to bind to a specific mac + sap, it is possible to
298 * have multiple sap connections via multiple macs.
299 * Bind and autobind for that matter must enforce the correct sap usage
300 * otherwise all hell will break loose.
301 * Returns: 0 upon success, negative otherwise.
302 */
303static int llc_ui_bind(struct socket *sock, struct sockaddr *uaddr, int addrlen)
304{
305 struct sockaddr_llc *addr = (struct sockaddr_llc *)uaddr;
306 struct sock *sk = sock->sk;
307 struct llc_sock *llc = llc_sk(sk);
308 struct llc_sap *sap;
309 int rc = -EINVAL;
310
Harvey Harrison0dc47872008-03-05 20:47:47 -0800311 dprintk("%s: binding %02X\n", __func__, addr->sllc_sap);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300312 if (unlikely(!sock_flag(sk, SOCK_ZAPPED) || addrlen != sizeof(*addr)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700313 goto out;
314 rc = -EAFNOSUPPORT;
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300315 if (unlikely(addr->sllc_family != AF_LLC))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700316 goto out;
Jochen Friedrichcf309e32005-09-22 04:44:55 -0300317 rc = -ENODEV;
Eric Dumazet941666c2010-12-05 01:23:53 +0000318 rcu_read_lock();
Octavian Purdilaabf9d532009-12-26 11:51:01 +0000319 if (sk->sk_bound_dev_if) {
Eric Dumazet941666c2010-12-05 01:23:53 +0000320 llc->dev = dev_get_by_index_rcu(&init_net, sk->sk_bound_dev_if);
Octavian Purdilaabf9d532009-12-26 11:51:01 +0000321 if (llc->dev) {
322 if (!addr->sllc_arphrd)
323 addr->sllc_arphrd = llc->dev->type;
Joe Perches951fd872013-09-01 13:11:55 -0700324 if (is_zero_ether_addr(addr->sllc_mac))
Octavian Purdilaabf9d532009-12-26 11:51:01 +0000325 memcpy(addr->sllc_mac, llc->dev->dev_addr,
326 IFHWADDRLEN);
327 if (addr->sllc_arphrd != llc->dev->type ||
Joe Perches951fd872013-09-01 13:11:55 -0700328 !ether_addr_equal(addr->sllc_mac,
329 llc->dev->dev_addr)) {
Octavian Purdilaabf9d532009-12-26 11:51:01 +0000330 rc = -EINVAL;
Octavian Purdilaabf9d532009-12-26 11:51:01 +0000331 llc->dev = NULL;
332 }
333 }
334 } else
Eric Dumazet941666c2010-12-05 01:23:53 +0000335 llc->dev = dev_getbyhwaddr_rcu(&init_net, addr->sllc_arphrd,
Octavian Purdilaabf9d532009-12-26 11:51:01 +0000336 addr->sllc_mac);
Eric Dumazet941666c2010-12-05 01:23:53 +0000337 if (llc->dev)
338 dev_hold(llc->dev);
339 rcu_read_unlock();
Jochen Friedrichcf309e32005-09-22 04:44:55 -0300340 if (!llc->dev)
341 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700342 if (!addr->sllc_sap) {
343 rc = -EUSERS;
344 addr->sllc_sap = llc_ui_autoport();
345 if (!addr->sllc_sap)
346 goto out;
347 }
348 sap = llc_sap_find(addr->sllc_sap);
349 if (!sap) {
350 sap = llc_sap_open(addr->sllc_sap, NULL);
351 rc = -EBUSY; /* some other network layer is using the sap */
352 if (!sap)
353 goto out;
354 } else {
355 struct llc_addr laddr, daddr;
356 struct sock *ask;
357
358 memset(&laddr, 0, sizeof(laddr));
359 memset(&daddr, 0, sizeof(daddr));
360 /*
Michael Opdenacker59c51592007-05-09 08:57:56 +0200361 * FIXME: check if the address is multicast,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700362 * only SOCK_DGRAM can do this.
363 */
364 memcpy(laddr.mac, addr->sllc_mac, IFHWADDRLEN);
365 laddr.lsap = addr->sllc_sap;
366 rc = -EADDRINUSE; /* mac + sap clash. */
367 ask = llc_lookup_established(sap, &daddr, &laddr);
368 if (ask) {
369 sock_put(ask);
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -0300370 goto out_put;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700371 }
372 }
373 llc->laddr.lsap = addr->sllc_sap;
374 memcpy(llc->laddr.mac, addr->sllc_mac, IFHWADDRLEN);
375 memcpy(&llc->addr, addr, sizeof(llc->addr));
376 /* assign new connection to its SAP */
377 llc_sap_add_socket(sap, sk);
378 sock_reset_flag(sk, SOCK_ZAPPED);
379 rc = 0;
Arnaldo Carvalho de Melo6e2144b2005-09-22 04:43:05 -0300380out_put:
381 llc_sap_put(sap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700382out:
383 return rc;
384}
385
386/**
387 * llc_ui_shutdown - shutdown a connect llc2 socket.
388 * @sock: Socket to shutdown.
389 * @how: What part of the socket to shutdown.
390 *
391 * Shutdown a connected llc2 socket. Currently this function only supports
392 * shutting down both sends and receives (2), we could probably make this
393 * function such that a user can shutdown only half the connection but not
394 * right now.
395 * Returns: 0 upon success, negative otherwise.
396 */
397static int llc_ui_shutdown(struct socket *sock, int how)
398{
399 struct sock *sk = sock->sk;
400 int rc = -ENOTCONN;
401
402 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300403 if (unlikely(sk->sk_state != TCP_ESTABLISHED))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700404 goto out;
405 rc = -EINVAL;
406 if (how != 2)
407 goto out;
408 rc = llc_send_disc(sk);
409 if (!rc)
410 rc = llc_ui_wait_for_disc(sk, sk->sk_rcvtimeo);
411 /* Wake up anyone sleeping in poll */
412 sk->sk_state_change(sk);
413out:
414 release_sock(sk);
415 return rc;
416}
417
418/**
419 * llc_ui_connect - Connect to a remote llc2 mac + sap.
420 * @sock: Socket which will be connected to the remote destination.
421 * @uaddr: Remote and possibly the local address of the new connection.
422 * @addrlen: Size of uaddr structure.
423 * @flags: Operational flags specified by the user.
424 *
425 * Connect to a remote llc2 mac + sap. The caller must specify the
426 * destination mac and address to connect to. If the user hasn't previously
427 * called bind(2) with a smac the address of the first interface of the
428 * specified arp type will be used.
429 * This function will autobind if user did not previously call bind.
430 * Returns: 0 upon success, negative otherwise.
431 */
432static int llc_ui_connect(struct socket *sock, struct sockaddr *uaddr,
433 int addrlen, int flags)
434{
435 struct sock *sk = sock->sk;
436 struct llc_sock *llc = llc_sk(sk);
437 struct sockaddr_llc *addr = (struct sockaddr_llc *)uaddr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700438 int rc = -EINVAL;
439
440 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300441 if (unlikely(addrlen != sizeof(*addr)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700442 goto out;
443 rc = -EAFNOSUPPORT;
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300444 if (unlikely(addr->sllc_family != AF_LLC))
445 goto out;
446 if (unlikely(sk->sk_type != SOCK_STREAM))
447 goto out;
448 rc = -EALREADY;
449 if (unlikely(sock->state == SS_CONNECTING))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700450 goto out;
451 /* bind connection to sap if user hasn't done it. */
452 if (sock_flag(sk, SOCK_ZAPPED)) {
453 /* bind to sap with null dev, exclusive */
454 rc = llc_ui_autobind(sock, addr);
455 if (rc)
456 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700457 }
Jochen Friedrich5564af22005-09-22 04:46:44 -0300458 llc->daddr.lsap = addr->sllc_sap;
459 memcpy(llc->daddr.mac, addr->sllc_mac, IFHWADDRLEN);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700460 sock->state = SS_CONNECTING;
461 sk->sk_state = TCP_SYN_SENT;
462 llc->link = llc_ui_next_link_no(llc->sap->laddr.lsap);
Arnaldo Carvalho de Melo774ccb42005-09-22 03:53:35 -0300463 rc = llc_establish_connection(sk, llc->dev->dev_addr,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700464 addr->sllc_mac, addr->sllc_sap);
465 if (rc) {
Harvey Harrison0dc47872008-03-05 20:47:47 -0800466 dprintk("%s: llc_ui_send_conn failed :-(\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700467 sock->state = SS_UNCONNECTED;
468 sk->sk_state = TCP_CLOSE;
469 goto out;
470 }
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300471
472 if (sk->sk_state == TCP_SYN_SENT) {
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300473 const long timeo = sock_sndtimeo(sk, flags & O_NONBLOCK);
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300474
475 if (!timeo || !llc_ui_wait_for_conn(sk, timeo))
476 goto out;
477
478 rc = sock_intr_errno(timeo);
479 if (signal_pending(current))
480 goto out;
481 }
482
483 if (sk->sk_state == TCP_CLOSE)
484 goto sock_error;
485
486 sock->state = SS_CONNECTED;
487 rc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700488out:
489 release_sock(sk);
490 return rc;
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300491sock_error:
492 rc = sock_error(sk) ? : -ECONNABORTED;
493 sock->state = SS_UNCONNECTED;
494 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700495}
496
497/**
498 * llc_ui_listen - allow a normal socket to accept incoming connections
499 * @sock: Socket to allow incoming connections on.
500 * @backlog: Number of connections to queue.
501 *
502 * Allow a normal socket to accept incoming connections.
503 * Returns 0 upon success, negative otherwise.
504 */
505static int llc_ui_listen(struct socket *sock, int backlog)
506{
507 struct sock *sk = sock->sk;
508 int rc = -EINVAL;
509
510 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300511 if (unlikely(sock->state != SS_UNCONNECTED))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700512 goto out;
513 rc = -EOPNOTSUPP;
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300514 if (unlikely(sk->sk_type != SOCK_STREAM))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700515 goto out;
516 rc = -EAGAIN;
517 if (sock_flag(sk, SOCK_ZAPPED))
518 goto out;
519 rc = 0;
Eric Dumazet95c96172012-04-15 05:58:06 +0000520 if (!(unsigned int)backlog) /* BSDism */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700521 backlog = 1;
522 sk->sk_max_ack_backlog = backlog;
523 if (sk->sk_state != TCP_LISTEN) {
524 sk->sk_ack_backlog = 0;
525 sk->sk_state = TCP_LISTEN;
526 }
527 sk->sk_socket->flags |= __SO_ACCEPTCON;
528out:
529 release_sock(sk);
530 return rc;
531}
532
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300533static int llc_ui_wait_for_disc(struct sock *sk, long timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700534{
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300535 DEFINE_WAIT(wait);
536 int rc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700537
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300538 while (1) {
Eric Dumazetaa395142010-04-20 13:03:51 +0000539 prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300540 if (sk_wait_event(sk, &timeout, sk->sk_state == TCP_CLOSE))
541 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700542 rc = -ERESTARTSYS;
543 if (signal_pending(current))
544 break;
545 rc = -EAGAIN;
546 if (!timeout)
547 break;
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300548 rc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700549 }
Eric Dumazetaa395142010-04-20 13:03:51 +0000550 finish_wait(sk_sleep(sk), &wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700551 return rc;
552}
553
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300554static int llc_ui_wait_for_conn(struct sock *sk, long timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700555{
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300556 DEFINE_WAIT(wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700557
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300558 while (1) {
Eric Dumazetaa395142010-04-20 13:03:51 +0000559 prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300560 if (sk_wait_event(sk, &timeout, sk->sk_state != TCP_SYN_SENT))
561 break;
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300562 if (signal_pending(current) || !timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700563 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700564 }
Eric Dumazetaa395142010-04-20 13:03:51 +0000565 finish_wait(sk_sleep(sk), &wait);
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300566 return timeout;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700567}
568
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300569static int llc_ui_wait_for_busy_core(struct sock *sk, long timeout)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700570{
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300571 DEFINE_WAIT(wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700572 struct llc_sock *llc = llc_sk(sk);
573 int rc;
574
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300575 while (1) {
Eric Dumazetaa395142010-04-20 13:03:51 +0000576 prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700577 rc = 0;
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300578 if (sk_wait_event(sk, &timeout,
579 (sk->sk_shutdown & RCV_SHUTDOWN) ||
580 (!llc_data_accept_state(llc->state) &&
Jochen Friedrich451677c2005-11-14 21:57:46 -0800581 !llc->remote_busy_flag &&
Arnaldo Carvalho de Melo54fb7f22005-09-22 04:26:14 -0300582 !llc->p_flag)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700583 break;
584 rc = -ERESTARTSYS;
585 if (signal_pending(current))
586 break;
587 rc = -EAGAIN;
588 if (!timeout)
589 break;
590 }
Eric Dumazetaa395142010-04-20 13:03:51 +0000591 finish_wait(sk_sleep(sk), &wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700592 return rc;
593}
594
Arnaldo Carvalho de Melo2928c192005-09-22 05:14:33 -0300595static int llc_wait_data(struct sock *sk, long timeo)
Arnaldo Carvalho de Meloafdbe352005-09-22 04:37:07 -0300596{
597 int rc;
598
599 while (1) {
600 /*
601 * POSIX 1003.1g mandates this order.
602 */
Benjamin LaHaisec1cbe4b2005-12-13 23:22:19 -0800603 rc = sock_error(sk);
604 if (rc)
Arnaldo Carvalho de Meloafdbe352005-09-22 04:37:07 -0300605 break;
Arnaldo Carvalho de Meloafdbe352005-09-22 04:37:07 -0300606 rc = 0;
607 if (sk->sk_shutdown & RCV_SHUTDOWN)
608 break;
609 rc = -EAGAIN;
610 if (!timeo)
611 break;
612 rc = sock_intr_errno(timeo);
613 if (signal_pending(current))
614 break;
615 rc = 0;
616 if (sk_wait_data(sk, &timeo))
617 break;
618 }
619 return rc;
620}
621
Octavian Purdilae5cd6fe2009-12-26 11:51:00 +0000622static void llc_cmsg_rcv(struct msghdr *msg, struct sk_buff *skb)
623{
624 struct llc_sock *llc = llc_sk(skb->sk);
625
626 if (llc->cmsg_flags & LLC_CMSG_PKTINFO) {
627 struct llc_pktinfo info;
628
629 info.lpi_ifindex = llc_sk(skb->sk)->dev->ifindex;
630 llc_pdu_decode_dsap(skb, &info.lpi_sap);
631 llc_pdu_decode_da(skb, info.lpi_mac);
632 put_cmsg(msg, SOL_LLC, LLC_OPT_PKTINFO, sizeof(info), &info);
633 }
634}
635
Linus Torvalds1da177e2005-04-16 15:20:36 -0700636/**
637 * llc_ui_accept - accept a new incoming connection.
638 * @sock: Socket which connections arrive on.
639 * @newsock: Socket to move incoming connection to.
640 * @flags: User specified operational flags.
641 *
642 * Accept a new incoming connection.
643 * Returns 0 upon success, negative otherwise.
644 */
645static int llc_ui_accept(struct socket *sock, struct socket *newsock, int flags)
646{
647 struct sock *sk = sock->sk, *newsk;
648 struct llc_sock *llc, *newllc;
649 struct sk_buff *skb;
650 int rc = -EOPNOTSUPP;
651
Harvey Harrison0dc47872008-03-05 20:47:47 -0800652 dprintk("%s: accepting on %02X\n", __func__,
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900653 llc_sk(sk)->laddr.lsap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700654 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300655 if (unlikely(sk->sk_type != SOCK_STREAM))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700656 goto out;
657 rc = -EINVAL;
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -0300658 if (unlikely(sock->state != SS_UNCONNECTED ||
659 sk->sk_state != TCP_LISTEN))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700660 goto out;
661 /* wait for a connection to arrive. */
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300662 if (skb_queue_empty(&sk->sk_receive_queue)) {
Arnaldo Carvalho de Meloafdbe352005-09-22 04:37:07 -0300663 rc = llc_wait_data(sk, sk->sk_rcvtimeo);
Arnaldo Carvalho de Melob35bd112005-09-22 04:22:39 -0300664 if (rc)
665 goto out;
666 }
Harvey Harrison0dc47872008-03-05 20:47:47 -0800667 dprintk("%s: got a new connection on %02X\n", __func__,
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900668 llc_sk(sk)->laddr.lsap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700669 skb = skb_dequeue(&sk->sk_receive_queue);
670 rc = -EINVAL;
671 if (!skb->sk)
672 goto frees;
673 rc = 0;
674 newsk = skb->sk;
675 /* attach connection to a new socket. */
676 llc_ui_sk_init(newsock, newsk);
677 sock_reset_flag(newsk, SOCK_ZAPPED);
678 newsk->sk_state = TCP_ESTABLISHED;
679 newsock->state = SS_CONNECTED;
680 llc = llc_sk(sk);
681 newllc = llc_sk(newsk);
682 memcpy(&newllc->addr, &llc->addr, sizeof(newllc->addr));
683 newllc->link = llc_ui_next_link_no(newllc->laddr.lsap);
684
685 /* put original socket back into a clean listen state. */
686 sk->sk_state = TCP_LISTEN;
687 sk->sk_ack_backlog--;
Harvey Harrison0dc47872008-03-05 20:47:47 -0800688 dprintk("%s: ok success on %02X, client on %02X\n", __func__,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700689 llc_sk(sk)->addr.sllc_sap, newllc->daddr.lsap);
690frees:
691 kfree_skb(skb);
692out:
693 release_sock(sk);
694 return rc;
695}
696
697/**
698 * llc_ui_recvmsg - copy received data to the socket user.
699 * @sock: Socket to copy data from.
700 * @msg: Various user space related information.
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300701 * @len: Size of user buffer.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700702 * @flags: User specified flags.
703 *
704 * Copy received data to the socket user.
705 * Returns non-negative upon success, negative otherwise.
706 */
Ying Xue1b784142015-03-02 15:37:48 +0800707static int llc_ui_recvmsg(struct socket *sock, struct msghdr *msg, size_t len,
708 int flags)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700709{
Steffen Hurrle342dfc32014-01-17 22:53:15 +0100710 DECLARE_SOCKADDR(struct sockaddr_llc *, uaddr, msg->msg_name);
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300711 const int nonblock = flags & MSG_DONTWAIT;
712 struct sk_buff *skb = NULL;
713 struct sock *sk = sock->sk;
714 struct llc_sock *llc = llc_sk(sk);
Radu Iliescu56ac11c2012-01-19 03:57:57 +0000715 unsigned long cpu_flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700716 size_t copied = 0;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300717 u32 peek_seq = 0;
Daniel Borkmann4d231b72013-12-30 23:40:50 +0100718 u32 *seq, skb_len;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300719 unsigned long used;
720 int target; /* Read at least this many bytes */
721 long timeo;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700722
Linus Torvalds1da177e2005-04-16 15:20:36 -0700723 lock_sock(sk);
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300724 copied = -ENOTCONN;
Stephen Hemminger29efcd22006-05-25 15:08:59 -0700725 if (unlikely(sk->sk_type == SOCK_STREAM && sk->sk_state == TCP_LISTEN))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700726 goto out;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300727
728 timeo = sock_rcvtimeo(sk, nonblock);
729
730 seq = &llc->copied_seq;
731 if (flags & MSG_PEEK) {
732 peek_seq = llc->copied_seq;
733 seq = &peek_seq;
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900734 }
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300735
736 target = sock_rcvlowat(sk, flags & MSG_WAITALL, len);
737 copied = 0;
738
739 do {
740 u32 offset;
741
742 /*
743 * We need to check signals first, to get correct SIGURG
744 * handling. FIXME: Need to check this doesn't impact 1003.1g
745 * and move it down to the bottom of the loop
746 */
747 if (signal_pending(current)) {
748 if (copied)
749 break;
750 copied = timeo ? sock_intr_errno(timeo) : -EAGAIN;
751 break;
752 }
753
754 /* Next get a buffer. */
755
756 skb = skb_peek(&sk->sk_receive_queue);
757 if (skb) {
758 offset = *seq;
759 goto found_ok_skb;
760 }
761 /* Well, if we have backlog, try to process it now yet. */
762
763 if (copied >= target && !sk->sk_backlog.tail)
764 break;
765
766 if (copied) {
767 if (sk->sk_err ||
768 sk->sk_state == TCP_CLOSE ||
769 (sk->sk_shutdown & RCV_SHUTDOWN) ||
770 !timeo ||
771 (flags & MSG_PEEK))
772 break;
773 } else {
774 if (sock_flag(sk, SOCK_DONE))
775 break;
776
777 if (sk->sk_err) {
778 copied = sock_error(sk);
779 break;
780 }
781 if (sk->sk_shutdown & RCV_SHUTDOWN)
782 break;
783
Stephen Hemminger29efcd22006-05-25 15:08:59 -0700784 if (sk->sk_type == SOCK_STREAM && sk->sk_state == TCP_CLOSE) {
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300785 if (!sock_flag(sk, SOCK_DONE)) {
786 /*
787 * This occurs when user tries to read
788 * from never connected socket.
789 */
790 copied = -ENOTCONN;
791 break;
792 }
793 break;
794 }
795 if (!timeo) {
796 copied = -EAGAIN;
797 break;
798 }
799 }
800
801 if (copied >= target) { /* Do not sleep, just process backlog. */
802 release_sock(sk);
803 lock_sock(sk);
804 } else
805 sk_wait_data(sk, &timeo);
806
807 if ((flags & MSG_PEEK) && peek_seq != llc->copied_seq) {
Joe Perchese87cc472012-05-13 21:56:26 +0000808 net_dbg_ratelimited("LLC(%s:%d): Application bug, race in MSG_PEEK\n",
809 current->comm,
810 task_pid_nr(current));
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300811 peek_seq = llc->copied_seq;
812 }
813 continue;
814 found_ok_skb:
Daniel Borkmann4d231b72013-12-30 23:40:50 +0100815 skb_len = skb->len;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300816 /* Ok so how much can we use? */
817 used = skb->len - offset;
818 if (len < used)
819 used = len;
820
821 if (!(flags & MSG_TRUNC)) {
David S. Miller51f3d022014-11-05 16:46:40 -0500822 int rc = skb_copy_datagram_msg(skb, offset, msg, used);
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300823 if (rc) {
824 /* Exception. Bailout! */
825 if (!copied)
826 copied = -EFAULT;
827 break;
828 }
829 }
830
831 *seq += used;
832 copied += used;
833 len -= used;
834
Alex Juncu9cef3102011-12-15 23:01:25 +0000835 /* For non stream protcols we get one packet per recvmsg call */
836 if (sk->sk_type != SOCK_STREAM)
837 goto copy_uaddr;
838
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300839 if (!(flags & MSG_PEEK)) {
Radu Iliescu56ac11c2012-01-19 03:57:57 +0000840 spin_lock_irqsave(&sk->sk_receive_queue.lock, cpu_flags);
Dan Williams7bced392013-12-30 12:37:29 -0800841 sk_eat_skb(sk, skb);
Radu Iliescu56ac11c2012-01-19 03:57:57 +0000842 spin_unlock_irqrestore(&sk->sk_receive_queue.lock, cpu_flags);
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300843 *seq = 0;
844 }
Stephen Hemminger30a584d2006-08-03 16:38:49 -0700845
Stephen Hemminger30a584d2006-08-03 16:38:49 -0700846 /* Partial read */
Daniel Borkmann4d231b72013-12-30 23:40:50 +0100847 if (used + offset < skb_len)
Stephen Hemminger30a584d2006-08-03 16:38:49 -0700848 continue;
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300849 } while (len > 0);
850
Linus Torvalds1da177e2005-04-16 15:20:36 -0700851out:
852 release_sock(sk);
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300853 return copied;
854copy_uaddr:
855 if (uaddr != NULL && skb != NULL) {
856 memcpy(uaddr, llc_ui_skb_cb(skb), sizeof(*uaddr));
857 msg->msg_namelen = sizeof(*uaddr);
858 }
Octavian Purdilae5cd6fe2009-12-26 11:51:00 +0000859 if (llc_sk(sk)->cmsg_flags)
860 llc_cmsg_rcv(msg, skb);
Alex Juncu9cef3102011-12-15 23:01:25 +0000861
862 if (!(flags & MSG_PEEK)) {
Dan Williams7bced392013-12-30 12:37:29 -0800863 spin_lock_irqsave(&sk->sk_receive_queue.lock, cpu_flags);
864 sk_eat_skb(sk, skb);
865 spin_unlock_irqrestore(&sk->sk_receive_queue.lock, cpu_flags);
866 *seq = 0;
Alex Juncu9cef3102011-12-15 23:01:25 +0000867 }
868
Arnaldo Carvalho de Melo8420e1b2005-09-22 08:29:08 -0300869 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700870}
871
872/**
873 * llc_ui_sendmsg - Transmit data provided by the socket user.
874 * @sock: Socket to transmit data from.
875 * @msg: Various user related information.
876 * @len: Length of data to transmit.
877 *
878 * Transmit data provided by the socket user.
879 * Returns non-negative upon success, negative otherwise.
880 */
Ying Xue1b784142015-03-02 15:37:48 +0800881static int llc_ui_sendmsg(struct socket *sock, struct msghdr *msg, size_t len)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700882{
883 struct sock *sk = sock->sk;
884 struct llc_sock *llc = llc_sk(sk);
Steffen Hurrle342dfc32014-01-17 22:53:15 +0100885 DECLARE_SOCKADDR(struct sockaddr_llc *, addr, msg->msg_name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700886 int flags = msg->msg_flags;
887 int noblock = flags & MSG_DONTWAIT;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700888 struct sk_buff *skb;
889 size_t size = 0;
890 int rc = -EINVAL, copied = 0, hdrlen;
891
Harvey Harrison0dc47872008-03-05 20:47:47 -0800892 dprintk("%s: sending from %02X to %02X\n", __func__,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700893 llc->laddr.lsap, llc->daddr.lsap);
894 lock_sock(sk);
895 if (addr) {
896 if (msg->msg_namelen < sizeof(*addr))
897 goto release;
898 } else {
899 if (llc_ui_addr_null(&llc->addr))
900 goto release;
901 addr = &llc->addr;
902 }
903 /* must bind connection to sap if user hasn't done it. */
904 if (sock_flag(sk, SOCK_ZAPPED)) {
905 /* bind to sap with null dev, exclusive. */
906 rc = llc_ui_autobind(sock, addr);
907 if (rc)
908 goto release;
909 }
Arnaldo Carvalho de Melo774ccb42005-09-22 03:53:35 -0300910 hdrlen = llc->dev->hard_header_len + llc_ui_header_len(sk, addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700911 size = hdrlen + len;
Arnaldo Carvalho de Melo774ccb42005-09-22 03:53:35 -0300912 if (size > llc->dev->mtu)
913 size = llc->dev->mtu;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700914 copied = size - hdrlen;
915 release_sock(sk);
916 skb = sock_alloc_send_skb(sk, size, noblock, &rc);
917 lock_sock(sk);
918 if (!skb)
919 goto release;
Arnaldo Carvalho de Melo774ccb42005-09-22 03:53:35 -0300920 skb->dev = llc->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700921 skb->protocol = llc_proto_type(addr->sllc_arphrd);
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +0900922 skb_reserve(skb, hdrlen);
Al Viro6ce8e9c2014-04-06 21:25:44 -0400923 rc = memcpy_from_msg(skb_put(skb, copied), msg, copied);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700924 if (rc)
925 goto out;
926 if (sk->sk_type == SOCK_DGRAM || addr->sllc_ua) {
927 llc_build_and_send_ui_pkt(llc->sap, skb, addr->sllc_mac,
928 addr->sllc_sap);
929 goto out;
930 }
931 if (addr->sllc_test) {
932 llc_build_and_send_test_pkt(llc->sap, skb, addr->sllc_mac,
933 addr->sllc_sap);
934 goto out;
935 }
936 if (addr->sllc_xid) {
937 llc_build_and_send_xid_pkt(llc->sap, skb, addr->sllc_mac,
938 addr->sllc_sap);
939 goto out;
940 }
941 rc = -ENOPROTOOPT;
942 if (!(sk->sk_type == SOCK_STREAM && !addr->sllc_ua))
943 goto out;
944 rc = llc_ui_send_data(sk, skb, noblock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700945out:
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300946 if (rc) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700947 kfree_skb(skb);
948release:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700949 dprintk("%s: failed sending from %02X to %02X: %d\n",
Harvey Harrison0dc47872008-03-05 20:47:47 -0800950 __func__, llc->laddr.lsap, llc->daddr.lsap, rc);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300951 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700952 release_sock(sk);
953 return rc ? : copied;
954}
955
956/**
957 * llc_ui_getname - return the address info of a socket
958 * @sock: Socket to get address of.
959 * @uaddr: Address structure to return information.
960 * @uaddrlen: Length of address structure.
961 * @peer: Does user want local or remote address information.
962 *
963 * Return the address information of a socket.
964 */
965static int llc_ui_getname(struct socket *sock, struct sockaddr *uaddr,
966 int *uaddrlen, int peer)
967{
968 struct sockaddr_llc sllc;
969 struct sock *sk = sock->sk;
970 struct llc_sock *llc = llc_sk(sk);
Mathias Krause3592aae2012-08-15 11:31:53 +0000971 int rc = -EBADF;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700972
Jiri Slaby28e9fc52009-08-23 22:55:51 -0700973 memset(&sllc, 0, sizeof(sllc));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700974 lock_sock(sk);
975 if (sock_flag(sk, SOCK_ZAPPED))
976 goto out;
977 *uaddrlen = sizeof(sllc);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700978 if (peer) {
979 rc = -ENOTCONN;
980 if (sk->sk_state != TCP_ESTABLISHED)
981 goto out;
982 if(llc->dev)
983 sllc.sllc_arphrd = llc->dev->type;
984 sllc.sllc_sap = llc->daddr.lsap;
985 memcpy(&sllc.sllc_mac, &llc->daddr.mac, IFHWADDRLEN);
986 } else {
987 rc = -EINVAL;
988 if (!llc->sap)
989 goto out;
990 sllc.sllc_sap = llc->sap->laddr.lsap;
991
992 if (llc->dev) {
993 sllc.sllc_arphrd = llc->dev->type;
Jiri Pirkoa186d2a2009-05-12 22:40:12 +0000994 memcpy(&sllc.sllc_mac, llc->dev->dev_addr,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700995 IFHWADDRLEN);
996 }
997 }
998 rc = 0;
999 sllc.sllc_family = AF_LLC;
1000 memcpy(uaddr, &sllc, sizeof(sllc));
1001out:
1002 release_sock(sk);
1003 return rc;
1004}
1005
1006/**
1007 * llc_ui_ioctl - io controls for PF_LLC
1008 * @sock: Socket to get/set info
1009 * @cmd: command
1010 * @arg: optional argument for cmd
1011 *
1012 * get/set info on llc sockets
1013 */
1014static int llc_ui_ioctl(struct socket *sock, unsigned int cmd,
1015 unsigned long arg)
1016{
Christoph Hellwigb5e5fa52006-01-03 14:18:33 -08001017 return -ENOIOCTLCMD;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001018}
1019
1020/**
1021 * llc_ui_setsockopt - set various connection specific parameters.
1022 * @sock: Socket to set options on.
1023 * @level: Socket level user is requesting operations on.
1024 * @optname: Operation name.
Ben Hutchings2c530402012-07-10 10:55:09 +00001025 * @optval: User provided operation data.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001026 * @optlen: Length of optval.
1027 *
1028 * Set various connection specific parameters.
1029 */
1030static int llc_ui_setsockopt(struct socket *sock, int level, int optname,
David S. Millerb7058842009-09-30 16:12:20 -07001031 char __user *optval, unsigned int optlen)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001032{
1033 struct sock *sk = sock->sk;
1034 struct llc_sock *llc = llc_sk(sk);
Dan Carpenter339db112010-09-10 01:56:16 +00001035 unsigned int opt;
1036 int rc = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001037
1038 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -03001039 if (unlikely(level != SOL_LLC || optlen != sizeof(int)))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001040 goto out;
1041 rc = get_user(opt, (int __user *)optval);
1042 if (rc)
1043 goto out;
1044 rc = -EINVAL;
1045 switch (optname) {
1046 case LLC_OPT_RETRY:
1047 if (opt > LLC_OPT_MAX_RETRY)
1048 goto out;
1049 llc->n2 = opt;
1050 break;
1051 case LLC_OPT_SIZE:
1052 if (opt > LLC_OPT_MAX_SIZE)
1053 goto out;
1054 llc->n1 = opt;
1055 break;
1056 case LLC_OPT_ACK_TMR_EXP:
1057 if (opt > LLC_OPT_MAX_ACK_TMR_EXP)
1058 goto out;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001059 llc->ack_timer.expire = opt * HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001060 break;
1061 case LLC_OPT_P_TMR_EXP:
1062 if (opt > LLC_OPT_MAX_P_TMR_EXP)
1063 goto out;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001064 llc->pf_cycle_timer.expire = opt * HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001065 break;
1066 case LLC_OPT_REJ_TMR_EXP:
1067 if (opt > LLC_OPT_MAX_REJ_TMR_EXP)
1068 goto out;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001069 llc->rej_sent_timer.expire = opt * HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001070 break;
1071 case LLC_OPT_BUSY_TMR_EXP:
1072 if (opt > LLC_OPT_MAX_BUSY_TMR_EXP)
1073 goto out;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001074 llc->busy_state_timer.expire = opt * HZ;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001075 break;
1076 case LLC_OPT_TX_WIN:
1077 if (opt > LLC_OPT_MAX_WIN)
1078 goto out;
1079 llc->k = opt;
1080 break;
1081 case LLC_OPT_RX_WIN:
1082 if (opt > LLC_OPT_MAX_WIN)
1083 goto out;
1084 llc->rw = opt;
1085 break;
Octavian Purdilae5cd6fe2009-12-26 11:51:00 +00001086 case LLC_OPT_PKTINFO:
1087 if (opt)
1088 llc->cmsg_flags |= LLC_CMSG_PKTINFO;
1089 else
1090 llc->cmsg_flags &= ~LLC_CMSG_PKTINFO;
1091 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001092 default:
1093 rc = -ENOPROTOOPT;
1094 goto out;
1095 }
1096 rc = 0;
1097out:
1098 release_sock(sk);
1099 return rc;
1100}
1101
1102/**
1103 * llc_ui_getsockopt - get connection specific socket info
1104 * @sock: Socket to get information from.
1105 * @level: Socket level user is requesting operations on.
1106 * @optname: Operation name.
1107 * @optval: Variable to return operation data in.
1108 * @optlen: Length of optval.
1109 *
1110 * Get connection specific socket information.
1111 */
1112static int llc_ui_getsockopt(struct socket *sock, int level, int optname,
1113 char __user *optval, int __user *optlen)
1114{
1115 struct sock *sk = sock->sk;
1116 struct llc_sock *llc = llc_sk(sk);
1117 int val = 0, len = 0, rc = -EINVAL;
1118
1119 lock_sock(sk);
Arnaldo Carvalho de Meloaf426d32005-09-22 03:59:22 -03001120 if (unlikely(level != SOL_LLC))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001121 goto out;
1122 rc = get_user(len, optlen);
1123 if (rc)
1124 goto out;
1125 rc = -EINVAL;
1126 if (len != sizeof(int))
1127 goto out;
1128 switch (optname) {
1129 case LLC_OPT_RETRY:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001130 val = llc->n2; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001131 case LLC_OPT_SIZE:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001132 val = llc->n1; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001133 case LLC_OPT_ACK_TMR_EXP:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001134 val = llc->ack_timer.expire / HZ; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001135 case LLC_OPT_P_TMR_EXP:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001136 val = llc->pf_cycle_timer.expire / HZ; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001137 case LLC_OPT_REJ_TMR_EXP:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001138 val = llc->rej_sent_timer.expire / HZ; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001139 case LLC_OPT_BUSY_TMR_EXP:
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001140 val = llc->busy_state_timer.expire / HZ; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001141 case LLC_OPT_TX_WIN:
1142 val = llc->k; break;
1143 case LLC_OPT_RX_WIN:
1144 val = llc->rw; break;
Octavian Purdilae5cd6fe2009-12-26 11:51:00 +00001145 case LLC_OPT_PKTINFO:
1146 val = (llc->cmsg_flags & LLC_CMSG_PKTINFO) != 0;
1147 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001148 default:
1149 rc = -ENOPROTOOPT;
1150 goto out;
1151 }
1152 rc = 0;
1153 if (put_user(len, optlen) || copy_to_user(optval, &val, len))
1154 rc = -EFAULT;
1155out:
1156 release_sock(sk);
1157 return rc;
1158}
1159
Stephen Hemmingerec1b4cf2009-10-05 05:58:39 +00001160static const struct net_proto_family llc_ui_family_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001161 .family = PF_LLC,
1162 .create = llc_ui_create,
1163 .owner = THIS_MODULE,
1164};
1165
Eric Dumazet90ddc4f2005-12-22 12:49:22 -08001166static const struct proto_ops llc_ui_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001167 .family = PF_LLC,
1168 .owner = THIS_MODULE,
1169 .release = llc_ui_release,
1170 .bind = llc_ui_bind,
1171 .connect = llc_ui_connect,
1172 .socketpair = sock_no_socketpair,
1173 .accept = llc_ui_accept,
1174 .getname = llc_ui_getname,
1175 .poll = datagram_poll,
1176 .ioctl = llc_ui_ioctl,
1177 .listen = llc_ui_listen,
1178 .shutdown = llc_ui_shutdown,
1179 .setsockopt = llc_ui_setsockopt,
1180 .getsockopt = llc_ui_getsockopt,
1181 .sendmsg = llc_ui_sendmsg,
1182 .recvmsg = llc_ui_recvmsg,
1183 .mmap = sock_no_mmap,
1184 .sendpage = sock_no_sendpage,
1185};
1186
Stephen Hemminger01af4a02009-02-22 00:02:44 -08001187static const char llc_proc_err_msg[] __initconst =
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +09001188 KERN_CRIT "LLC: Unable to register the proc_fs entries\n";
Stephen Hemminger01af4a02009-02-22 00:02:44 -08001189static const char llc_sysctl_err_msg[] __initconst =
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +09001190 KERN_CRIT "LLC: Unable to register the sysctl entries\n";
Stephen Hemminger01af4a02009-02-22 00:02:44 -08001191static const char llc_sock_err_msg[] __initconst =
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +09001192 KERN_CRIT "LLC: Unable to register the network family\n";
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001193
Linus Torvalds1da177e2005-04-16 15:20:36 -07001194static int __init llc2_init(void)
1195{
1196 int rc = proto_register(&llc_proto, 0);
1197
1198 if (rc != 0)
1199 goto out;
1200
1201 llc_build_offset_table();
1202 llc_station_init();
1203 llc_ui_sap_last_autoport = LLC_SAP_DYN_START;
1204 rc = llc_proc_init();
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001205 if (rc != 0) {
1206 printk(llc_proc_err_msg);
Ben Hutchingsf4f87202012-08-13 02:50:43 +00001207 goto out_station;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001208 }
1209 rc = llc_sysctl_init();
1210 if (rc) {
1211 printk(llc_sysctl_err_msg);
1212 goto out_proc;
1213 }
1214 rc = sock_register(&llc_ui_family_ops);
1215 if (rc) {
1216 printk(llc_sock_err_msg);
1217 goto out_sysctl;
1218 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001219 llc_add_pack(LLC_DEST_SAP, llc_sap_handler);
1220 llc_add_pack(LLC_DEST_CONN, llc_conn_handler);
1221out:
1222 return rc;
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001223out_sysctl:
1224 llc_sysctl_exit();
1225out_proc:
1226 llc_proc_exit();
Ben Hutchingsf4f87202012-08-13 02:50:43 +00001227out_station:
1228 llc_station_exit();
Linus Torvalds1da177e2005-04-16 15:20:36 -07001229 proto_unregister(&llc_proto);
1230 goto out;
1231}
1232
1233static void __exit llc2_exit(void)
1234{
1235 llc_station_exit();
1236 llc_remove_pack(LLC_DEST_SAP);
1237 llc_remove_pack(LLC_DEST_CONN);
1238 sock_unregister(PF_LLC);
1239 llc_proc_exit();
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001240 llc_sysctl_exit();
Linus Torvalds1da177e2005-04-16 15:20:36 -07001241 proto_unregister(&llc_proto);
1242}
1243
1244module_init(llc2_init);
1245module_exit(llc2_exit);
1246
1247MODULE_LICENSE("GPL");
1248MODULE_AUTHOR("Procom 1997, Jay Schullist 2001, Arnaldo C. Melo 2001-2003");
1249MODULE_DESCRIPTION("IEEE 802.2 PF_LLC support");
1250MODULE_ALIAS_NETPROTO(PF_LLC);