projects / deliverable / linux.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
Merge tag 'kvm-3.15-1' of git://git.kernel.org/pub/scm/virt/kvm/kvm
[deliverable/linux.git] / net / l2tp / l2tp_ppp.c
1 /*****************************************************************************
2 * Linux PPP over L2TP (PPPoX/PPPoL2TP) Sockets
3 *
4 * PPPoX --- Generic PPP encapsulation socket family
5 * PPPoL2TP --- PPP over L2TP (RFC 2661)
6 *
7 * Version: 2.0.0
8 *
9 * Authors: James Chapman (jchapman@katalix.com)
10 *
11 * Based on original work by Martijn van Oosterhout <kleptog@svana.org>
12 *
13 * License:
14 * This program is free software; you can redistribute it and/or
15 * modify it under the terms of the GNU General Public License
16 * as published by the Free Software Foundation; either version
17 * 2 of the License, or (at your option) any later version.
18 *
19 */
20
21 /* This driver handles only L2TP data frames; control frames are handled by a
22 * userspace application.
23 *
24 * To send data in an L2TP session, userspace opens a PPPoL2TP socket and
25 * attaches it to a bound UDP socket with local tunnel_id / session_id and
26 * peer tunnel_id / session_id set. Data can then be sent or received using
27 * regular socket sendmsg() / recvmsg() calls. Kernel parameters of the socket
28 * can be read or modified using ioctl() or [gs]etsockopt() calls.
29 *
30 * When a PPPoL2TP socket is connected with local and peer session_id values
31 * zero, the socket is treated as a special tunnel management socket.
32 *
33 * Here's example userspace code to create a socket for sending/receiving data
34 * over an L2TP session:-
35 *
36 * struct sockaddr_pppol2tp sax;
37 * int fd;
38 * int session_fd;
39 *
40 * fd = socket(AF_PPPOX, SOCK_DGRAM, PX_PROTO_OL2TP);
41 *
42 * sax.sa_family = AF_PPPOX;
43 * sax.sa_protocol = PX_PROTO_OL2TP;
44 * sax.pppol2tp.fd = tunnel_fd; // bound UDP socket
45 * sax.pppol2tp.addr.sin_addr.s_addr = addr->sin_addr.s_addr;
46 * sax.pppol2tp.addr.sin_port = addr->sin_port;
47 * sax.pppol2tp.addr.sin_family = AF_INET;
48 * sax.pppol2tp.s_tunnel = tunnel_id;
49 * sax.pppol2tp.s_session = session_id;
50 * sax.pppol2tp.d_tunnel = peer_tunnel_id;
51 * sax.pppol2tp.d_session = peer_session_id;
52 *
53 * session_fd = connect(fd, (struct sockaddr *)&sax, sizeof(sax));
54 *
55 * A pppd plugin that allows PPP traffic to be carried over L2TP using
56 * this driver is available from the OpenL2TP project at
57 * http://openl2tp.sourceforge.net.
58 */
59
60 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
61
62 #include <linux/module.h>
63 #include <linux/string.h>
64 #include <linux/list.h>
65 #include <linux/uaccess.h>
66
67 #include <linux/kernel.h>
68 #include <linux/spinlock.h>
69 #include <linux/kthread.h>
70 #include <linux/sched.h>
71 #include <linux/slab.h>
72 #include <linux/errno.h>
73 #include <linux/jiffies.h>
74
75 #include <linux/netdevice.h>
76 #include <linux/net.h>
77 #include <linux/inetdevice.h>
78 #include <linux/skbuff.h>
79 #include <linux/init.h>
80 #include <linux/ip.h>
81 #include <linux/udp.h>
82 #include <linux/if_pppox.h>
83 #include <linux/if_pppol2tp.h>
84 #include <net/sock.h>
85 #include <linux/ppp_channel.h>
86 #include <linux/ppp_defs.h>
87 #include <linux/ppp-ioctl.h>
88 #include <linux/file.h>
89 #include <linux/hash.h>
90 #include <linux/sort.h>
91 #include <linux/proc_fs.h>
92 #include <linux/l2tp.h>
93 #include <linux/nsproxy.h>
94 #include <net/net_namespace.h>
95 #include <net/netns/generic.h>
96 #include <net/dst.h>
97 #include <net/ip.h>
98 #include <net/udp.h>
99 #include <net/xfrm.h>
100 #include <net/inet_common.h>
101
102 #include <asm/byteorder.h>
103 #include <linux/atomic.h>
104
105 #include "l2tp_core.h"
106
107 #define PPPOL2TP_DRV_VERSION "V2.0"
108
109 /* Space for UDP, L2TP and PPP headers */
110 #define PPPOL2TP_HEADER_OVERHEAD 40
111
112 /* Number of bytes to build transmit L2TP headers.
113 * Unfortunately the size is different depending on whether sequence numbers
114 * are enabled.
115 */
116 #define PPPOL2TP_L2TP_HDR_SIZE_SEQ 10
117 #define PPPOL2TP_L2TP_HDR_SIZE_NOSEQ 6
118
119 /* Private data of each session. This data lives at the end of struct
120 * l2tp_session, referenced via session->priv[].
121 */
122 struct pppol2tp_session {
123 int owner; /* pid that opened the socket */
124
125 struct sock *sock; /* Pointer to the session
126 * PPPoX socket */
127 struct sock *tunnel_sock; /* Pointer to the tunnel UDP
128 * socket */
129 int flags; /* accessed by PPPIOCGFLAGS.
130 * Unused. */
131 };
132
133 static int pppol2tp_xmit(struct ppp_channel *chan, struct sk_buff *skb);
134
135 static const struct ppp_channel_ops pppol2tp_chan_ops = {
136 .start_xmit = pppol2tp_xmit,
137 };
138
139 static const struct proto_ops pppol2tp_ops;
140
141 /* Helpers to obtain tunnel/session contexts from sockets.
142 */
143 static inline struct l2tp_session *pppol2tp_sock_to_session(struct sock *sk)
144 {
145 struct l2tp_session *session;
146
147 if (sk == NULL)
148 return NULL;
149
150 sock_hold(sk);
151 session = (struct l2tp_session *)(sk->sk_user_data);
152 if (session == NULL) {
153 sock_put(sk);
154 goto out;
155 }
156
157 BUG_ON(session->magic != L2TP_SESSION_MAGIC);
158
159 out:
160 return session;
161 }
162
163 /*****************************************************************************
164 * Receive data handling
165 *****************************************************************************/
166
167 static int pppol2tp_recv_payload_hook(struct sk_buff *skb)
168 {
169 /* Skip PPP header, if present. In testing, Microsoft L2TP clients
170 * don't send the PPP header (PPP header compression enabled), but
171 * other clients can include the header. So we cope with both cases
172 * here. The PPP header is always FF03 when using L2TP.
173 *
174 * Note that skb->data[] isn't dereferenced from a u16 ptr here since
175 * the field may be unaligned.
176 */
177 if (!pskb_may_pull(skb, 2))
178 return 1;
179
180 if ((skb->data[0] == 0xff) && (skb->data[1] == 0x03))
181 skb_pull(skb, 2);
182
183 return 0;
184 }
185
186 /* Receive message. This is the recvmsg for the PPPoL2TP socket.
187 */
188 static int pppol2tp_recvmsg(struct kiocb *iocb, struct socket *sock,
189 struct msghdr *msg, size_t len,
190 int flags)
191 {
192 int err;
193 struct sk_buff *skb;
194 struct sock *sk = sock->sk;
195
196 err = -EIO;
197 if (sk->sk_state & PPPOX_BOUND)
198 goto end;
199
200 err = 0;
201 skb = skb_recv_datagram(sk, flags & ~MSG_DONTWAIT,
202 flags & MSG_DONTWAIT, &err);
203 if (!skb)
204 goto end;
205
206 if (len > skb->len)
207 len = skb->len;
208 else if (len < skb->len)
209 msg->msg_flags |= MSG_TRUNC;
210
211 err = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, len);
212 if (likely(err == 0))
213 err = len;
214
215 kfree_skb(skb);
216 end:
217 return err;
218 }
219
220 static void pppol2tp_recv(struct l2tp_session *session, struct sk_buff *skb, int data_len)
221 {
222 struct pppol2tp_session *ps = l2tp_session_priv(session);
223 struct sock *sk = NULL;
224
225 /* If the socket is bound, send it in to PPP's input queue. Otherwise
226 * queue it on the session socket.
227 */
228 sk = ps->sock;
229 if (sk == NULL)
230 goto no_sock;
231
232 if (sk->sk_state & PPPOX_BOUND) {
233 struct pppox_sock *po;
234 l2tp_dbg(session, PPPOL2TP_MSG_DATA,
235 "%s: recv %d byte data frame, passing to ppp\n",
236 session->name, data_len);
237
238 /* We need to forget all info related to the L2TP packet
239 * gathered in the skb as we are going to reuse the same
240 * skb for the inner packet.
241 * Namely we need to:
242 * - reset xfrm (IPSec) information as it applies to
243 * the outer L2TP packet and not to the inner one
244 * - release the dst to force a route lookup on the inner
245 * IP packet since skb->dst currently points to the dst
246 * of the UDP tunnel
247 * - reset netfilter information as it doesn't apply
248 * to the inner packet either
249 */
250 secpath_reset(skb);
251 skb_dst_drop(skb);
252 nf_reset(skb);
253
254 po = pppox_sk(sk);
255 ppp_input(&po->chan, skb);
256 } else {
257 l2tp_dbg(session, PPPOL2TP_MSG_DATA,
258 "%s: recv %d byte data frame, passing to L2TP socket\n",
259 session->name, data_len);
260
261 if (sock_queue_rcv_skb(sk, skb) < 0) {
262 atomic_long_inc(&session->stats.rx_errors);
263 kfree_skb(skb);
264 }
265 }
266
267 return;
268
269 no_sock:
270 l2tp_info(session, PPPOL2TP_MSG_DATA, "%s: no socket\n", session->name);
271 kfree_skb(skb);
272 }
273
274 static void pppol2tp_session_sock_hold(struct l2tp_session *session)
275 {
276 struct pppol2tp_session *ps = l2tp_session_priv(session);
277
278 if (ps->sock)
279 sock_hold(ps->sock);
280 }
281
282 static void pppol2tp_session_sock_put(struct l2tp_session *session)
283 {
284 struct pppol2tp_session *ps = l2tp_session_priv(session);
285
286 if (ps->sock)
287 sock_put(ps->sock);
288 }
289
290 /************************************************************************
291 * Transmit handling
292 ***********************************************************************/
293
294 /* This is the sendmsg for the PPPoL2TP pppol2tp_session socket. We come here
295 * when a user application does a sendmsg() on the session socket. L2TP and
296 * PPP headers must be inserted into the user's data.
297 */
298 static int pppol2tp_sendmsg(struct kiocb *iocb, struct socket *sock, struct msghdr *m,
299 size_t total_len)
300 {
301 static const unsigned char ppph[2] = { 0xff, 0x03 };
302 struct sock *sk = sock->sk;
303 struct sk_buff *skb;
304 int error;
305 struct l2tp_session *session;
306 struct l2tp_tunnel *tunnel;
307 struct pppol2tp_session *ps;
308 int uhlen;
309
310 error = -ENOTCONN;
311 if (sock_flag(sk, SOCK_DEAD) || !(sk->sk_state & PPPOX_CONNECTED))
312 goto error;
313
314 /* Get session and tunnel contexts */
315 error = -EBADF;
316 session = pppol2tp_sock_to_session(sk);
317 if (session == NULL)
318 goto error;
319
320 ps = l2tp_session_priv(session);
321 tunnel = l2tp_sock_to_tunnel(ps->tunnel_sock);
322 if (tunnel == NULL)
323 goto error_put_sess;
324
325 uhlen = (tunnel->encap == L2TP_ENCAPTYPE_UDP) ? sizeof(struct udphdr) : 0;
326
327 /* Allocate a socket buffer */
328 error = -ENOMEM;
329 skb = sock_wmalloc(sk, NET_SKB_PAD + sizeof(struct iphdr) +
330 uhlen + session->hdr_len +
331 sizeof(ppph) + total_len,
332 0, GFP_KERNEL);
333 if (!skb)
334 goto error_put_sess_tun;
335
336 /* Reserve space for headers. */
337 skb_reserve(skb, NET_SKB_PAD);
338 skb_reset_network_header(skb);
339 skb_reserve(skb, sizeof(struct iphdr));
340 skb_reset_transport_header(skb);
341 skb_reserve(skb, uhlen);
342
343 /* Add PPP header */
344 skb->data[0] = ppph[0];
345 skb->data[1] = ppph[1];
346 skb_put(skb, 2);
347
348 /* Copy user data into skb */
349 error = memcpy_fromiovec(skb_put(skb, total_len), m->msg_iov,
350 total_len);
351 if (error < 0) {
352 kfree_skb(skb);
353 goto error_put_sess_tun;
354 }
355
356 local_bh_disable();
357 l2tp_xmit_skb(session, skb, session->hdr_len);
358 local_bh_enable();
359
360 sock_put(ps->tunnel_sock);
361 sock_put(sk);
362
363 return total_len;
364
365 error_put_sess_tun:
366 sock_put(ps->tunnel_sock);
367 error_put_sess:
368 sock_put(sk);
369 error:
370 return error;
371 }
372
373 /* Transmit function called by generic PPP driver. Sends PPP frame
374 * over PPPoL2TP socket.
375 *
376 * This is almost the same as pppol2tp_sendmsg(), but rather than
377 * being called with a msghdr from userspace, it is called with a skb
378 * from the kernel.
379 *
380 * The supplied skb from ppp doesn't have enough headroom for the
381 * insertion of L2TP, UDP and IP headers so we need to allocate more
382 * headroom in the skb. This will create a cloned skb. But we must be
383 * careful in the error case because the caller will expect to free
384 * the skb it supplied, not our cloned skb. So we take care to always
385 * leave the original skb unfreed if we return an error.
386 */
387 static int pppol2tp_xmit(struct ppp_channel *chan, struct sk_buff *skb)
388 {
389 static const u8 ppph[2] = { 0xff, 0x03 };
390 struct sock *sk = (struct sock *) chan->private;
391 struct sock *sk_tun;
392 struct l2tp_session *session;
393 struct l2tp_tunnel *tunnel;
394 struct pppol2tp_session *ps;
395 int uhlen, headroom;
396
397 if (sock_flag(sk, SOCK_DEAD) || !(sk->sk_state & PPPOX_CONNECTED))
398 goto abort;
399
400 /* Get session and tunnel contexts from the socket */
401 session = pppol2tp_sock_to_session(sk);
402 if (session == NULL)
403 goto abort;
404
405 ps = l2tp_session_priv(session);
406 sk_tun = ps->tunnel_sock;
407 if (sk_tun == NULL)
408 goto abort_put_sess;
409 tunnel = l2tp_sock_to_tunnel(sk_tun);
410 if (tunnel == NULL)
411 goto abort_put_sess;
412
413 uhlen = (tunnel->encap == L2TP_ENCAPTYPE_UDP) ? sizeof(struct udphdr) : 0;
414 headroom = NET_SKB_PAD +
415 sizeof(struct iphdr) + /* IP header */
416 uhlen + /* UDP header (if L2TP_ENCAPTYPE_UDP) */
417 session->hdr_len + /* L2TP header */
418 sizeof(ppph); /* PPP header */
419 if (skb_cow_head(skb, headroom))
420 goto abort_put_sess_tun;
421
422 /* Setup PPP header */
423 __skb_push(skb, sizeof(ppph));
424 skb->data[0] = ppph[0];
425 skb->data[1] = ppph[1];
426
427 local_bh_disable();
428 l2tp_xmit_skb(session, skb, session->hdr_len);
429 local_bh_enable();
430
431 sock_put(sk_tun);
432 sock_put(sk);
433 return 1;
434
435 abort_put_sess_tun:
436 sock_put(sk_tun);
437 abort_put_sess:
438 sock_put(sk);
439 abort:
440 /* Free the original skb */
441 kfree_skb(skb);
442 return 1;
443 }
444
445 /*****************************************************************************
446 * Session (and tunnel control) socket create/destroy.
447 *****************************************************************************/
448
449 /* Called by l2tp_core when a session socket is being closed.
450 */
451 static void pppol2tp_session_close(struct l2tp_session *session)
452 {
453 struct pppol2tp_session *ps = l2tp_session_priv(session);
454 struct sock *sk = ps->sock;
455 struct socket *sock = sk->sk_socket;
456
457 BUG_ON(session->magic != L2TP_SESSION_MAGIC);
458
459
460 if (sock) {
461 inet_shutdown(sock, 2);
462 /* Don't let the session go away before our socket does */
463 l2tp_session_inc_refcount(session);
464 }
465 return;
466 }
467
468 /* Really kill the session socket. (Called from sock_put() if
469 * refcnt == 0.)
470 */
471 static void pppol2tp_session_destruct(struct sock *sk)
472 {
473 struct l2tp_session *session = sk->sk_user_data;
474 if (session) {
475 sk->sk_user_data = NULL;
476 BUG_ON(session->magic != L2TP_SESSION_MAGIC);
477 l2tp_session_dec_refcount(session);
478 }
479 return;
480 }
481
482 /* Called when the PPPoX socket (session) is closed.
483 */
484 static int pppol2tp_release(struct socket *sock)
485 {
486 struct sock *sk = sock->sk;
487 struct l2tp_session *session;
488 int error;
489
490 if (!sk)
491 return 0;
492
493 error = -EBADF;
494 lock_sock(sk);
495 if (sock_flag(sk, SOCK_DEAD) != 0)
496 goto error;
497
498 pppox_unbind_sock(sk);
499
500 /* Signal the death of the socket. */
501 sk->sk_state = PPPOX_DEAD;
502 sock_orphan(sk);
503 sock->sk = NULL;
504
505 session = pppol2tp_sock_to_session(sk);
506
507 /* Purge any queued data */
508 if (session != NULL) {
509 __l2tp_session_unhash(session);
510 l2tp_session_queue_purge(session);
511 sock_put(sk);
512 }
513 skb_queue_purge(&sk->sk_receive_queue);
514 skb_queue_purge(&sk->sk_write_queue);
515
516 release_sock(sk);
517
518 /* This will delete the session context via
519 * pppol2tp_session_destruct() if the socket's refcnt drops to
520 * zero.
521 */
522 sock_put(sk);
523
524 return 0;
525
526 error:
527 release_sock(sk);
528 return error;
529 }
530
531 static struct proto pppol2tp_sk_proto = {
532 .name = "PPPOL2TP",
533 .owner = THIS_MODULE,
534 .obj_size = sizeof(struct pppox_sock),
535 };
536
537 static int pppol2tp_backlog_recv(struct sock *sk, struct sk_buff *skb)
538 {
539 int rc;
540
541 rc = l2tp_udp_encap_recv(sk, skb);
542 if (rc)
543 kfree_skb(skb);
544
545 return NET_RX_SUCCESS;
546 }
547
548 /* socket() handler. Initialize a new struct sock.
549 */
550 static int pppol2tp_create(struct net *net, struct socket *sock)
551 {
552 int error = -ENOMEM;
553 struct sock *sk;
554
555 sk = sk_alloc(net, PF_PPPOX, GFP_KERNEL, &pppol2tp_sk_proto);
556 if (!sk)
557 goto out;
558
559 sock_init_data(sock, sk);
560
561 sock->state = SS_UNCONNECTED;
562 sock->ops = &pppol2tp_ops;
563
564 sk->sk_backlog_rcv = pppol2tp_backlog_recv;
565 sk->sk_protocol = PX_PROTO_OL2TP;
566 sk->sk_family = PF_PPPOX;
567 sk->sk_state = PPPOX_NONE;
568 sk->sk_type = SOCK_STREAM;
569 sk->sk_destruct = pppol2tp_session_destruct;
570
571 error = 0;
572
573 out:
574 return error;
575 }
576
577 #if defined(CONFIG_L2TP_DEBUGFS) || defined(CONFIG_L2TP_DEBUGFS_MODULE)
578 static void pppol2tp_show(struct seq_file *m, void *arg)
579 {
580 struct l2tp_session *session = arg;
581 struct pppol2tp_session *ps = l2tp_session_priv(session);
582
583 if (ps) {
584 struct pppox_sock *po = pppox_sk(ps->sock);
585 if (po)
586 seq_printf(m, " interface %s\n", ppp_dev_name(&po->chan));
587 }
588 }
589 #endif
590
591 /* connect() handler. Attach a PPPoX socket to a tunnel UDP socket
592 */
593 static int pppol2tp_connect(struct socket *sock, struct sockaddr *uservaddr,
594 int sockaddr_len, int flags)
595 {
596 struct sock *sk = sock->sk;
597 struct sockaddr_pppol2tp *sp = (struct sockaddr_pppol2tp *) uservaddr;
598 struct pppox_sock *po = pppox_sk(sk);
599 struct l2tp_session *session = NULL;
600 struct l2tp_tunnel *tunnel;
601 struct pppol2tp_session *ps;
602 struct dst_entry *dst;
603 struct l2tp_session_cfg cfg = { 0, };
604 int error = 0;
605 u32 tunnel_id, peer_tunnel_id;
606 u32 session_id, peer_session_id;
607 int ver = 2;
608 int fd;
609
610 lock_sock(sk);
611
612 error = -EINVAL;
613 if (sp->sa_protocol != PX_PROTO_OL2TP)
614 goto end;
615
616 /* Check for already bound sockets */
617 error = -EBUSY;
618 if (sk->sk_state & PPPOX_CONNECTED)
619 goto end;
620
621 /* We don't supporting rebinding anyway */
622 error = -EALREADY;
623 if (sk->sk_user_data)
624 goto end; /* socket is already attached */
625
626 /* Get params from socket address. Handle L2TPv2 and L2TPv3.
627 * This is nasty because there are different sockaddr_pppol2tp
628 * structs for L2TPv2, L2TPv3, over IPv4 and IPv6. We use
629 * the sockaddr size to determine which structure the caller
630 * is using.
631 */
632 peer_tunnel_id = 0;
633 if (sockaddr_len == sizeof(struct sockaddr_pppol2tp)) {
634 fd = sp->pppol2tp.fd;
635 tunnel_id = sp->pppol2tp.s_tunnel;
636 peer_tunnel_id = sp->pppol2tp.d_tunnel;
637 session_id = sp->pppol2tp.s_session;
638 peer_session_id = sp->pppol2tp.d_session;
639 } else if (sockaddr_len == sizeof(struct sockaddr_pppol2tpv3)) {
640 struct sockaddr_pppol2tpv3 *sp3 =
641 (struct sockaddr_pppol2tpv3 *) sp;
642 ver = 3;
643 fd = sp3->pppol2tp.fd;
644 tunnel_id = sp3->pppol2tp.s_tunnel;
645 peer_tunnel_id = sp3->pppol2tp.d_tunnel;
646 session_id = sp3->pppol2tp.s_session;
647 peer_session_id = sp3->pppol2tp.d_session;
648 } else if (sockaddr_len == sizeof(struct sockaddr_pppol2tpin6)) {
649 struct sockaddr_pppol2tpin6 *sp6 =
650 (struct sockaddr_pppol2tpin6 *) sp;
651 fd = sp6->pppol2tp.fd;
652 tunnel_id = sp6->pppol2tp.s_tunnel;
653 peer_tunnel_id = sp6->pppol2tp.d_tunnel;
654 session_id = sp6->pppol2tp.s_session;
655 peer_session_id = sp6->pppol2tp.d_session;
656 } else if (sockaddr_len == sizeof(struct sockaddr_pppol2tpv3in6)) {
657 struct sockaddr_pppol2tpv3in6 *sp6 =
658 (struct sockaddr_pppol2tpv3in6 *) sp;
659 ver = 3;
660 fd = sp6->pppol2tp.fd;
661 tunnel_id = sp6->pppol2tp.s_tunnel;
662 peer_tunnel_id = sp6->pppol2tp.d_tunnel;
663 session_id = sp6->pppol2tp.s_session;
664 peer_session_id = sp6->pppol2tp.d_session;
665 } else {
666 error = -EINVAL;
667 goto end; /* bad socket address */
668 }
669
670 /* Don't bind if tunnel_id is 0 */
671 error = -EINVAL;
672 if (tunnel_id == 0)
673 goto end;
674
675 tunnel = l2tp_tunnel_find(sock_net(sk), tunnel_id);
676
677 /* Special case: create tunnel context if session_id and
678 * peer_session_id is 0. Otherwise look up tunnel using supplied
679 * tunnel id.
680 */
681 if ((session_id == 0) && (peer_session_id == 0)) {
682 if (tunnel == NULL) {
683 struct l2tp_tunnel_cfg tcfg = {
684 .encap = L2TP_ENCAPTYPE_UDP,
685 .debug = 0,
686 };
687 error = l2tp_tunnel_create(sock_net(sk), fd, ver, tunnel_id, peer_tunnel_id, &tcfg, &tunnel);
688 if (error < 0)
689 goto end;
690 }
691 } else {
692 /* Error if we can't find the tunnel */
693 error = -ENOENT;
694 if (tunnel == NULL)
695 goto end;
696
697 /* Error if socket is not prepped */
698 if (tunnel->sock == NULL)
699 goto end;
700 }
701
702 if (tunnel->recv_payload_hook == NULL)
703 tunnel->recv_payload_hook = pppol2tp_recv_payload_hook;
704
705 if (tunnel->peer_tunnel_id == 0)
706 tunnel->peer_tunnel_id = peer_tunnel_id;
707
708 /* Create session if it doesn't already exist. We handle the
709 * case where a session was previously created by the netlink
710 * interface by checking that the session doesn't already have
711 * a socket and its tunnel socket are what we expect. If any
712 * of those checks fail, return EEXIST to the caller.
713 */
714 session = l2tp_session_find(sock_net(sk), tunnel, session_id);
715 if (session == NULL) {
716 /* Default MTU must allow space for UDP/L2TP/PPP
717 * headers.
718 */
719 cfg.mtu = cfg.mru = 1500 - PPPOL2TP_HEADER_OVERHEAD;
720
721 /* Allocate and initialize a new session context. */
722 session = l2tp_session_create(sizeof(struct pppol2tp_session),
723 tunnel, session_id,
724 peer_session_id, &cfg);
725 if (session == NULL) {
726 error = -ENOMEM;
727 goto end;
728 }
729 } else {
730 ps = l2tp_session_priv(session);
731 error = -EEXIST;
732 if (ps->sock != NULL)
733 goto end;
734
735 /* consistency checks */
736 if (ps->tunnel_sock != tunnel->sock)
737 goto end;
738 }
739
740 /* Associate session with its PPPoL2TP socket */
741 ps = l2tp_session_priv(session);
742 ps->owner = current->pid;
743 ps->sock = sk;
744 ps->tunnel_sock = tunnel->sock;
745
746 session->recv_skb = pppol2tp_recv;
747 session->session_close = pppol2tp_session_close;
748 #if defined(CONFIG_L2TP_DEBUGFS) || defined(CONFIG_L2TP_DEBUGFS_MODULE)
749 session->show = pppol2tp_show;
750 #endif
751
752 /* We need to know each time a skb is dropped from the reorder
753 * queue.
754 */
755 session->ref = pppol2tp_session_sock_hold;
756 session->deref = pppol2tp_session_sock_put;
757
758 /* If PMTU discovery was enabled, use the MTU that was discovered */
759 dst = sk_dst_get(sk);
760 if (dst != NULL) {
761 u32 pmtu = dst_mtu(__sk_dst_get(sk));
762 if (pmtu != 0)
763 session->mtu = session->mru = pmtu -
764 PPPOL2TP_HEADER_OVERHEAD;
765 dst_release(dst);
766 }
767
768 /* Special case: if source & dest session_id == 0x0000, this
769 * socket is being created to manage the tunnel. Just set up
770 * the internal context for use by ioctl() and sockopt()
771 * handlers.
772 */
773 if ((session->session_id == 0) &&
774 (session->peer_session_id == 0)) {
775 error = 0;
776 goto out_no_ppp;
777 }
778
779 /* The only header we need to worry about is the L2TP
780 * header. This size is different depending on whether
781 * sequence numbers are enabled for the data channel.
782 */
783 po->chan.hdrlen = PPPOL2TP_L2TP_HDR_SIZE_NOSEQ;
784
785 po->chan.private = sk;
786 po->chan.ops = &pppol2tp_chan_ops;
787 po->chan.mtu = session->mtu;
788
789 error = ppp_register_net_channel(sock_net(sk), &po->chan);
790 if (error)
791 goto end;
792
793 out_no_ppp:
794 /* This is how we get the session context from the socket. */
795 sk->sk_user_data = session;
796 sk->sk_state = PPPOX_CONNECTED;
797 l2tp_info(session, PPPOL2TP_MSG_CONTROL, "%s: created\n",
798 session->name);
799
800 end:
801 release_sock(sk);
802
803 return error;
804 }
805
806 #ifdef CONFIG_L2TP_V3
807
808 /* Called when creating sessions via the netlink interface.
809 */
810 static int pppol2tp_session_create(struct net *net, u32 tunnel_id, u32 session_id, u32 peer_session_id, struct l2tp_session_cfg *cfg)
811 {
812 int error;
813 struct l2tp_tunnel *tunnel;
814 struct l2tp_session *session;
815 struct pppol2tp_session *ps;
816
817 tunnel = l2tp_tunnel_find(net, tunnel_id);
818
819 /* Error if we can't find the tunnel */
820 error = -ENOENT;
821 if (tunnel == NULL)
822 goto out;
823
824 /* Error if tunnel socket is not prepped */
825 if (tunnel->sock == NULL)
826 goto out;
827
828 /* Check that this session doesn't already exist */
829 error = -EEXIST;
830 session = l2tp_session_find(net, tunnel, session_id);
831 if (session != NULL)
832 goto out;
833
834 /* Default MTU values. */
835 if (cfg->mtu == 0)
836 cfg->mtu = 1500 - PPPOL2TP_HEADER_OVERHEAD;
837 if (cfg->mru == 0)
838 cfg->mru = cfg->mtu;
839
840 /* Allocate and initialize a new session context. */
841 error = -ENOMEM;
842 session = l2tp_session_create(sizeof(struct pppol2tp_session),
843 tunnel, session_id,
844 peer_session_id, cfg);
845 if (session == NULL)
846 goto out;
847
848 ps = l2tp_session_priv(session);
849 ps->tunnel_sock = tunnel->sock;
850
851 l2tp_info(session, PPPOL2TP_MSG_CONTROL, "%s: created\n",
852 session->name);
853
854 error = 0;
855
856 out:
857 return error;
858 }
859
860 #endif /* CONFIG_L2TP_V3 */
861
862 /* getname() support.
863 */
864 static int pppol2tp_getname(struct socket *sock, struct sockaddr *uaddr,
865 int *usockaddr_len, int peer)
866 {
867 int len = 0;
868 int error = 0;
869 struct l2tp_session *session;
870 struct l2tp_tunnel *tunnel;
871 struct sock *sk = sock->sk;
872 struct inet_sock *inet;
873 struct pppol2tp_session *pls;
874
875 error = -ENOTCONN;
876 if (sk == NULL)
877 goto end;
878 if (sk->sk_state != PPPOX_CONNECTED)
879 goto end;
880
881 error = -EBADF;
882 session = pppol2tp_sock_to_session(sk);
883 if (session == NULL)
884 goto end;
885
886 pls = l2tp_session_priv(session);
887 tunnel = l2tp_sock_to_tunnel(pls->tunnel_sock);
888 if (tunnel == NULL) {
889 error = -EBADF;
890 goto end_put_sess;
891 }
892
893 inet = inet_sk(tunnel->sock);
894 if ((tunnel->version == 2) && (tunnel->sock->sk_family == AF_INET)) {
895 struct sockaddr_pppol2tp sp;
896 len = sizeof(sp);
897 memset(&sp, 0, len);
898 sp.sa_family = AF_PPPOX;
899 sp.sa_protocol = PX_PROTO_OL2TP;
900 sp.pppol2tp.fd = tunnel->fd;
901 sp.pppol2tp.pid = pls->owner;
902 sp.pppol2tp.s_tunnel = tunnel->tunnel_id;
903 sp.pppol2tp.d_tunnel = tunnel->peer_tunnel_id;
904 sp.pppol2tp.s_session = session->session_id;
905 sp.pppol2tp.d_session = session->peer_session_id;
906 sp.pppol2tp.addr.sin_family = AF_INET;
907 sp.pppol2tp.addr.sin_port = inet->inet_dport;
908 sp.pppol2tp.addr.sin_addr.s_addr = inet->inet_daddr;
909 memcpy(uaddr, &sp, len);
910 #if IS_ENABLED(CONFIG_IPV6)
911 } else if ((tunnel->version == 2) &&
912 (tunnel->sock->sk_family == AF_INET6)) {
913 struct sockaddr_pppol2tpin6 sp;
914
915 len = sizeof(sp);
916 memset(&sp, 0, len);
917 sp.sa_family = AF_PPPOX;
918 sp.sa_protocol = PX_PROTO_OL2TP;
919 sp.pppol2tp.fd = tunnel->fd;
920 sp.pppol2tp.pid = pls->owner;
921 sp.pppol2tp.s_tunnel = tunnel->tunnel_id;
922 sp.pppol2tp.d_tunnel = tunnel->peer_tunnel_id;
923 sp.pppol2tp.s_session = session->session_id;
924 sp.pppol2tp.d_session = session->peer_session_id;
925 sp.pppol2tp.addr.sin6_family = AF_INET6;
926 sp.pppol2tp.addr.sin6_port = inet->inet_dport;
927 memcpy(&sp.pppol2tp.addr.sin6_addr, &tunnel->sock->sk_v6_daddr,
928 sizeof(tunnel->sock->sk_v6_daddr));
929 memcpy(uaddr, &sp, len);
930 } else if ((tunnel->version == 3) &&
931 (tunnel->sock->sk_family == AF_INET6)) {
932 struct sockaddr_pppol2tpv3in6 sp;
933
934 len = sizeof(sp);
935 memset(&sp, 0, len);
936 sp.sa_family = AF_PPPOX;
937 sp.sa_protocol = PX_PROTO_OL2TP;
938 sp.pppol2tp.fd = tunnel->fd;
939 sp.pppol2tp.pid = pls->owner;
940 sp.pppol2tp.s_tunnel = tunnel->tunnel_id;
941 sp.pppol2tp.d_tunnel = tunnel->peer_tunnel_id;
942 sp.pppol2tp.s_session = session->session_id;
943 sp.pppol2tp.d_session = session->peer_session_id;
944 sp.pppol2tp.addr.sin6_family = AF_INET6;
945 sp.pppol2tp.addr.sin6_port = inet->inet_dport;
946 memcpy(&sp.pppol2tp.addr.sin6_addr, &tunnel->sock->sk_v6_daddr,
947 sizeof(tunnel->sock->sk_v6_daddr));
948 memcpy(uaddr, &sp, len);
949 #endif
950 } else if (tunnel->version == 3) {
951 struct sockaddr_pppol2tpv3 sp;
952 len = sizeof(sp);
953 memset(&sp, 0, len);
954 sp.sa_family = AF_PPPOX;
955 sp.sa_protocol = PX_PROTO_OL2TP;
956 sp.pppol2tp.fd = tunnel->fd;
957 sp.pppol2tp.pid = pls->owner;
958 sp.pppol2tp.s_tunnel = tunnel->tunnel_id;
959 sp.pppol2tp.d_tunnel = tunnel->peer_tunnel_id;
960 sp.pppol2tp.s_session = session->session_id;
961 sp.pppol2tp.d_session = session->peer_session_id;
962 sp.pppol2tp.addr.sin_family = AF_INET;
963 sp.pppol2tp.addr.sin_port = inet->inet_dport;
964 sp.pppol2tp.addr.sin_addr.s_addr = inet->inet_daddr;
965 memcpy(uaddr, &sp, len);
966 }
967
968 *usockaddr_len = len;
969
970 sock_put(pls->tunnel_sock);
971 end_put_sess:
972 sock_put(sk);
973 error = 0;
974
975 end:
976 return error;
977 }
978
979 /****************************************************************************
980 * ioctl() handlers.
981 *
982 * The PPPoX socket is created for L2TP sessions: tunnels have their own UDP
983 * sockets. However, in order to control kernel tunnel features, we allow
984 * userspace to create a special "tunnel" PPPoX socket which is used for
985 * control only. Tunnel PPPoX sockets have session_id == 0 and simply allow
986 * the user application to issue L2TP setsockopt(), getsockopt() and ioctl()
987 * calls.
988 ****************************************************************************/
989
990 static void pppol2tp_copy_stats(struct pppol2tp_ioc_stats *dest,
991 struct l2tp_stats *stats)
992 {
993 dest->tx_packets = atomic_long_read(&stats->tx_packets);
994 dest->tx_bytes = atomic_long_read(&stats->tx_bytes);
995 dest->tx_errors = atomic_long_read(&stats->tx_errors);
996 dest->rx_packets = atomic_long_read(&stats->rx_packets);
997 dest->rx_bytes = atomic_long_read(&stats->rx_bytes);
998 dest->rx_seq_discards = atomic_long_read(&stats->rx_seq_discards);
999 dest->rx_oos_packets = atomic_long_read(&stats->rx_oos_packets);
1000 dest->rx_errors = atomic_long_read(&stats->rx_errors);
1001 }
1002
1003 /* Session ioctl helper.
1004 */
1005 static int pppol2tp_session_ioctl(struct l2tp_session *session,
1006 unsigned int cmd, unsigned long arg)
1007 {
1008 struct ifreq ifr;
1009 int err = 0;
1010 struct sock *sk;
1011 int val = (int) arg;
1012 struct pppol2tp_session *ps = l2tp_session_priv(session);
1013 struct l2tp_tunnel *tunnel = session->tunnel;
1014 struct pppol2tp_ioc_stats stats;
1015
1016 l2tp_dbg(session, PPPOL2TP_MSG_CONTROL,
1017 "%s: pppol2tp_session_ioctl(cmd=%#x, arg=%#lx)\n",
1018 session->name, cmd, arg);
1019
1020 sk = ps->sock;
1021 sock_hold(sk);
1022
1023 switch (cmd) {
1024 case SIOCGIFMTU:
1025 err = -ENXIO;
1026 if (!(sk->sk_state & PPPOX_CONNECTED))
1027 break;
1028
1029 err = -EFAULT;
1030 if (copy_from_user(&ifr, (void __user *) arg, sizeof(struct ifreq)))
1031 break;
1032 ifr.ifr_mtu = session->mtu;
1033 if (copy_to_user((void __user *) arg, &ifr, sizeof(struct ifreq)))
1034 break;
1035
1036 l2tp_info(session, PPPOL2TP_MSG_CONTROL, "%s: get mtu=%d\n",
1037 session->name, session->mtu);
1038 err = 0;
1039 break;
1040
1041 case SIOCSIFMTU:
1042 err = -ENXIO;
1043 if (!(sk->sk_state & PPPOX_CONNECTED))
1044 break;
1045
1046 err = -EFAULT;
1047 if (copy_from_user(&ifr, (void __user *) arg, sizeof(struct ifreq)))
1048 break;
1049
1050 session->mtu = ifr.ifr_mtu;
1051
1052 l2tp_info(session, PPPOL2TP_MSG_CONTROL, "%s: set mtu=%d\n",
1053 session->name, session->mtu);
1054 err = 0;
1055 break;
1056
1057 case PPPIOCGMRU:
1058 err = -ENXIO;
1059 if (!(sk->sk_state & PPPOX_CONNECTED))
1060 break;
1061
1062 err = -EFAULT;
1063 if (put_user(session->mru, (int __user *) arg))
1064 break;
1065
1066 l2tp_info(session, PPPOL2TP_MSG_CONTROL, "%s: get mru=%d\n",
1067 session->name, session->mru);
1068 err = 0;
1069 break;
1070
1071 case PPPIOCSMRU:
1072 err = -ENXIO;
1073 if (!(sk->sk_state & PPPOX_CONNECTED))
1074 break;
1075
1076 err = -EFAULT;
1077 if (get_user(val, (int __user *) arg))
1078 break;
1079
1080 session->mru = val;
1081 l2tp_info(session, PPPOL2TP_MSG_CONTROL, "%s: set mru=%d\n",
1082 session->name, session->mru);
1083 err = 0;
1084 break;
1085
1086 case PPPIOCGFLAGS:
1087 err = -EFAULT;
1088 if (put_user(ps->flags, (int __user *) arg))
1089 break;
1090
1091 l2tp_info(session, PPPOL2TP_MSG_CONTROL, "%s: get flags=%d\n",
1092 session->name, ps->flags);
1093 err = 0;
1094 break;
1095
1096 case PPPIOCSFLAGS:
1097 err = -EFAULT;
1098 if (get_user(val, (int __user *) arg))
1099 break;
1100 ps->flags = val;
1101 l2tp_info(session, PPPOL2TP_MSG_CONTROL, "%s: set flags=%d\n",
1102 session->name, ps->flags);
1103 err = 0;
1104 break;
1105
1106 case PPPIOCGL2TPSTATS:
1107 err = -ENXIO;
1108 if (!(sk->sk_state & PPPOX_CONNECTED))
1109 break;
1110
1111 memset(&stats, 0, sizeof(stats));
1112 stats.tunnel_id = tunnel->tunnel_id;
1113 stats.session_id = session->session_id;
1114 pppol2tp_copy_stats(&stats, &session->stats);
1115 if (copy_to_user((void __user *) arg, &stats,
1116 sizeof(stats)))
1117 break;
1118 l2tp_info(session, PPPOL2TP_MSG_CONTROL, "%s: get L2TP stats\n",
1119 session->name);
1120 err = 0;
1121 break;
1122
1123 default:
1124 err = -ENOSYS;
1125 break;
1126 }
1127
1128 sock_put(sk);
1129
1130 return err;
1131 }
1132
1133 /* Tunnel ioctl helper.
1134 *
1135 * Note the special handling for PPPIOCGL2TPSTATS below. If the ioctl data
1136 * specifies a session_id, the session ioctl handler is called. This allows an
1137 * application to retrieve session stats via a tunnel socket.
1138 */
1139 static int pppol2tp_tunnel_ioctl(struct l2tp_tunnel *tunnel,
1140 unsigned int cmd, unsigned long arg)
1141 {
1142 int err = 0;
1143 struct sock *sk;
1144 struct pppol2tp_ioc_stats stats;
1145
1146 l2tp_dbg(tunnel, PPPOL2TP_MSG_CONTROL,
1147 "%s: pppol2tp_tunnel_ioctl(cmd=%#x, arg=%#lx)\n",
1148 tunnel->name, cmd, arg);
1149
1150 sk = tunnel->sock;
1151 sock_hold(sk);
1152
1153 switch (cmd) {
1154 case PPPIOCGL2TPSTATS:
1155 err = -ENXIO;
1156 if (!(sk->sk_state & PPPOX_CONNECTED))
1157 break;
1158
1159 if (copy_from_user(&stats, (void __user *) arg,
1160 sizeof(stats))) {
1161 err = -EFAULT;
1162 break;
1163 }
1164 if (stats.session_id != 0) {
1165 /* resend to session ioctl handler */
1166 struct l2tp_session *session =
1167 l2tp_session_find(sock_net(sk), tunnel, stats.session_id);
1168 if (session != NULL)
1169 err = pppol2tp_session_ioctl(session, cmd, arg);
1170 else
1171 err = -EBADR;
1172 break;
1173 }
1174 #ifdef CONFIG_XFRM
1175 stats.using_ipsec = (sk->sk_policy[0] || sk->sk_policy[1]) ? 1 : 0;
1176 #endif
1177 pppol2tp_copy_stats(&stats, &tunnel->stats);
1178 if (copy_to_user((void __user *) arg, &stats, sizeof(stats))) {
1179 err = -EFAULT;
1180 break;
1181 }
1182 l2tp_info(tunnel, PPPOL2TP_MSG_CONTROL, "%s: get L2TP stats\n",
1183 tunnel->name);
1184 err = 0;
1185 break;
1186
1187 default:
1188 err = -ENOSYS;
1189 break;
1190 }
1191
1192 sock_put(sk);
1193
1194 return err;
1195 }
1196
1197 /* Main ioctl() handler.
1198 * Dispatch to tunnel or session helpers depending on the socket.
1199 */
1200 static int pppol2tp_ioctl(struct socket *sock, unsigned int cmd,
1201 unsigned long arg)
1202 {
1203 struct sock *sk = sock->sk;
1204 struct l2tp_session *session;
1205 struct l2tp_tunnel *tunnel;
1206 struct pppol2tp_session *ps;
1207 int err;
1208
1209 if (!sk)
1210 return 0;
1211
1212 err = -EBADF;
1213 if (sock_flag(sk, SOCK_DEAD) != 0)
1214 goto end;
1215
1216 err = -ENOTCONN;
1217 if ((sk->sk_user_data == NULL) ||
1218 (!(sk->sk_state & (PPPOX_CONNECTED | PPPOX_BOUND))))
1219 goto end;
1220
1221 /* Get session context from the socket */
1222 err = -EBADF;
1223 session = pppol2tp_sock_to_session(sk);
1224 if (session == NULL)
1225 goto end;
1226
1227 /* Special case: if session's session_id is zero, treat ioctl as a
1228 * tunnel ioctl
1229 */
1230 ps = l2tp_session_priv(session);
1231 if ((session->session_id == 0) &&
1232 (session->peer_session_id == 0)) {
1233 err = -EBADF;
1234 tunnel = l2tp_sock_to_tunnel(ps->tunnel_sock);
1235 if (tunnel == NULL)
1236 goto end_put_sess;
1237
1238 err = pppol2tp_tunnel_ioctl(tunnel, cmd, arg);
1239 sock_put(ps->tunnel_sock);
1240 goto end_put_sess;
1241 }
1242
1243 err = pppol2tp_session_ioctl(session, cmd, arg);
1244
1245 end_put_sess:
1246 sock_put(sk);
1247 end:
1248 return err;
1249 }
1250
1251 /*****************************************************************************
1252 * setsockopt() / getsockopt() support.
1253 *
1254 * The PPPoX socket is created for L2TP sessions: tunnels have their own UDP
1255 * sockets. In order to control kernel tunnel features, we allow userspace to
1256 * create a special "tunnel" PPPoX socket which is used for control only.
1257 * Tunnel PPPoX sockets have session_id == 0 and simply allow the user
1258 * application to issue L2TP setsockopt(), getsockopt() and ioctl() calls.
1259 *****************************************************************************/
1260
1261 /* Tunnel setsockopt() helper.
1262 */
1263 static int pppol2tp_tunnel_setsockopt(struct sock *sk,
1264 struct l2tp_tunnel *tunnel,
1265 int optname, int val)
1266 {
1267 int err = 0;
1268
1269 switch (optname) {
1270 case PPPOL2TP_SO_DEBUG:
1271 tunnel->debug = val;
1272 l2tp_info(tunnel, PPPOL2TP_MSG_CONTROL, "%s: set debug=%x\n",
1273 tunnel->name, tunnel->debug);
1274 break;
1275
1276 default:
1277 err = -ENOPROTOOPT;
1278 break;
1279 }
1280
1281 return err;
1282 }
1283
1284 /* Session setsockopt helper.
1285 */
1286 static int pppol2tp_session_setsockopt(struct sock *sk,
1287 struct l2tp_session *session,
1288 int optname, int val)
1289 {
1290 int err = 0;
1291 struct pppol2tp_session *ps = l2tp_session_priv(session);
1292
1293 switch (optname) {
1294 case PPPOL2TP_SO_RECVSEQ:
1295 if ((val != 0) && (val != 1)) {
1296 err = -EINVAL;
1297 break;
1298 }
1299 session->recv_seq = val ? -1 : 0;
1300 l2tp_info(session, PPPOL2TP_MSG_CONTROL,
1301 "%s: set recv_seq=%d\n",
1302 session->name, session->recv_seq);
1303 break;
1304
1305 case PPPOL2TP_SO_SENDSEQ:
1306 if ((val != 0) && (val != 1)) {
1307 err = -EINVAL;
1308 break;
1309 }
1310 session->send_seq = val ? -1 : 0;
1311 {
1312 struct sock *ssk = ps->sock;
1313 struct pppox_sock *po = pppox_sk(ssk);
1314 po->chan.hdrlen = val ? PPPOL2TP_L2TP_HDR_SIZE_SEQ :
1315 PPPOL2TP_L2TP_HDR_SIZE_NOSEQ;
1316 }
1317 l2tp_session_set_header_len(session, session->tunnel->version);
1318 l2tp_info(session, PPPOL2TP_MSG_CONTROL,
1319 "%s: set send_seq=%d\n",
1320 session->name, session->send_seq);
1321 break;
1322
1323 case PPPOL2TP_SO_LNSMODE:
1324 if ((val != 0) && (val != 1)) {
1325 err = -EINVAL;
1326 break;
1327 }
1328 session->lns_mode = val ? -1 : 0;
1329 l2tp_info(session, PPPOL2TP_MSG_CONTROL,
1330 "%s: set lns_mode=%d\n",
1331 session->name, session->lns_mode);
1332 break;
1333
1334 case PPPOL2TP_SO_DEBUG:
1335 session->debug = val;
1336 l2tp_info(session, PPPOL2TP_MSG_CONTROL, "%s: set debug=%x\n",
1337 session->name, session->debug);
1338 break;
1339
1340 case PPPOL2TP_SO_REORDERTO:
1341 session->reorder_timeout = msecs_to_jiffies(val);
1342 l2tp_info(session, PPPOL2TP_MSG_CONTROL,
1343 "%s: set reorder_timeout=%d\n",
1344 session->name, session->reorder_timeout);
1345 break;
1346
1347 default:
1348 err = -ENOPROTOOPT;
1349 break;
1350 }
1351
1352 return err;
1353 }
1354
1355 /* Main setsockopt() entry point.
1356 * Does API checks, then calls either the tunnel or session setsockopt
1357 * handler, according to whether the PPPoL2TP socket is a for a regular
1358 * session or the special tunnel type.
1359 */
1360 static int pppol2tp_setsockopt(struct socket *sock, int level, int optname,
1361 char __user *optval, unsigned int optlen)
1362 {
1363 struct sock *sk = sock->sk;
1364 struct l2tp_session *session;
1365 struct l2tp_tunnel *tunnel;
1366 struct pppol2tp_session *ps;
1367 int val;
1368 int err;
1369
1370 if (level != SOL_PPPOL2TP)
1371 return udp_prot.setsockopt(sk, level, optname, optval, optlen);
1372
1373 if (optlen < sizeof(int))
1374 return -EINVAL;
1375
1376 if (get_user(val, (int __user *)optval))
1377 return -EFAULT;
1378
1379 err = -ENOTCONN;
1380 if (sk->sk_user_data == NULL)
1381 goto end;
1382
1383 /* Get session context from the socket */
1384 err = -EBADF;
1385 session = pppol2tp_sock_to_session(sk);
1386 if (session == NULL)
1387 goto end;
1388
1389 /* Special case: if session_id == 0x0000, treat as operation on tunnel
1390 */
1391 ps = l2tp_session_priv(session);
1392 if ((session->session_id == 0) &&
1393 (session->peer_session_id == 0)) {
1394 err = -EBADF;
1395 tunnel = l2tp_sock_to_tunnel(ps->tunnel_sock);
1396 if (tunnel == NULL)
1397 goto end_put_sess;
1398
1399 err = pppol2tp_tunnel_setsockopt(sk, tunnel, optname, val);
1400 sock_put(ps->tunnel_sock);
1401 } else
1402 err = pppol2tp_session_setsockopt(sk, session, optname, val);
1403
1404 err = 0;
1405
1406 end_put_sess:
1407 sock_put(sk);
1408 end:
1409 return err;
1410 }
1411
1412 /* Tunnel getsockopt helper. Called with sock locked.
1413 */
1414 static int pppol2tp_tunnel_getsockopt(struct sock *sk,
1415 struct l2tp_tunnel *tunnel,
1416 int optname, int *val)
1417 {
1418 int err = 0;
1419
1420 switch (optname) {
1421 case PPPOL2TP_SO_DEBUG:
1422 *val = tunnel->debug;
1423 l2tp_info(tunnel, PPPOL2TP_MSG_CONTROL, "%s: get debug=%x\n",
1424 tunnel->name, tunnel->debug);
1425 break;
1426
1427 default:
1428 err = -ENOPROTOOPT;
1429 break;
1430 }
1431
1432 return err;
1433 }
1434
1435 /* Session getsockopt helper. Called with sock locked.
1436 */
1437 static int pppol2tp_session_getsockopt(struct sock *sk,
1438 struct l2tp_session *session,
1439 int optname, int *val)
1440 {
1441 int err = 0;
1442
1443 switch (optname) {
1444 case PPPOL2TP_SO_RECVSEQ:
1445 *val = session->recv_seq;
1446 l2tp_info(session, PPPOL2TP_MSG_CONTROL,
1447 "%s: get recv_seq=%d\n", session->name, *val);
1448 break;
1449
1450 case PPPOL2TP_SO_SENDSEQ:
1451 *val = session->send_seq;
1452 l2tp_info(session, PPPOL2TP_MSG_CONTROL,
1453 "%s: get send_seq=%d\n", session->name, *val);
1454 break;
1455
1456 case PPPOL2TP_SO_LNSMODE:
1457 *val = session->lns_mode;
1458 l2tp_info(session, PPPOL2TP_MSG_CONTROL,
1459 "%s: get lns_mode=%d\n", session->name, *val);
1460 break;
1461
1462 case PPPOL2TP_SO_DEBUG:
1463 *val = session->debug;
1464 l2tp_info(session, PPPOL2TP_MSG_CONTROL, "%s: get debug=%d\n",
1465 session->name, *val);
1466 break;
1467
1468 case PPPOL2TP_SO_REORDERTO:
1469 *val = (int) jiffies_to_msecs(session->reorder_timeout);
1470 l2tp_info(session, PPPOL2TP_MSG_CONTROL,
1471 "%s: get reorder_timeout=%d\n", session->name, *val);
1472 break;
1473
1474 default:
1475 err = -ENOPROTOOPT;
1476 }
1477
1478 return err;
1479 }
1480
1481 /* Main getsockopt() entry point.
1482 * Does API checks, then calls either the tunnel or session getsockopt
1483 * handler, according to whether the PPPoX socket is a for a regular session
1484 * or the special tunnel type.
1485 */
1486 static int pppol2tp_getsockopt(struct socket *sock, int level, int optname,
1487 char __user *optval, int __user *optlen)
1488 {
1489 struct sock *sk = sock->sk;
1490 struct l2tp_session *session;
1491 struct l2tp_tunnel *tunnel;
1492 int val, len;
1493 int err;
1494 struct pppol2tp_session *ps;
1495
1496 if (level != SOL_PPPOL2TP)
1497 return udp_prot.getsockopt(sk, level, optname, optval, optlen);
1498
1499 if (get_user(len, optlen))
1500 return -EFAULT;
1501
1502 len = min_t(unsigned int, len, sizeof(int));
1503
1504 if (len < 0)
1505 return -EINVAL;
1506
1507 err = -ENOTCONN;
1508 if (sk->sk_user_data == NULL)
1509 goto end;
1510
1511 /* Get the session context */
1512 err = -EBADF;
1513 session = pppol2tp_sock_to_session(sk);
1514 if (session == NULL)
1515 goto end;
1516
1517 /* Special case: if session_id == 0x0000, treat as operation on tunnel */
1518 ps = l2tp_session_priv(session);
1519 if ((session->session_id == 0) &&
1520 (session->peer_session_id == 0)) {
1521 err = -EBADF;
1522 tunnel = l2tp_sock_to_tunnel(ps->tunnel_sock);
1523 if (tunnel == NULL)
1524 goto end_put_sess;
1525
1526 err = pppol2tp_tunnel_getsockopt(sk, tunnel, optname, &val);
1527 sock_put(ps->tunnel_sock);
1528 } else
1529 err = pppol2tp_session_getsockopt(sk, session, optname, &val);
1530
1531 err = -EFAULT;
1532 if (put_user(len, optlen))
1533 goto end_put_sess;
1534
1535 if (copy_to_user((void __user *) optval, &val, len))
1536 goto end_put_sess;
1537
1538 err = 0;
1539
1540 end_put_sess:
1541 sock_put(sk);
1542 end:
1543 return err;
1544 }
1545
1546 /*****************************************************************************
1547 * /proc filesystem for debug
1548 * Since the original pppol2tp driver provided /proc/net/pppol2tp for
1549 * L2TPv2, we dump only L2TPv2 tunnels and sessions here.
1550 *****************************************************************************/
1551
1552 static unsigned int pppol2tp_net_id;
1553
1554 #ifdef CONFIG_PROC_FS
1555
1556 struct pppol2tp_seq_data {
1557 struct seq_net_private p;
1558 int tunnel_idx; /* current tunnel */
1559 int session_idx; /* index of session within current tunnel */
1560 struct l2tp_tunnel *tunnel;
1561 struct l2tp_session *session; /* NULL means get next tunnel */
1562 };
1563
1564 static void pppol2tp_next_tunnel(struct net *net, struct pppol2tp_seq_data *pd)
1565 {
1566 for (;;) {
1567 pd->tunnel = l2tp_tunnel_find_nth(net, pd->tunnel_idx);
1568 pd->tunnel_idx++;
1569
1570 if (pd->tunnel == NULL)
1571 break;
1572
1573 /* Ignore L2TPv3 tunnels */
1574 if (pd->tunnel->version < 3)
1575 break;
1576 }
1577 }
1578
1579 static void pppol2tp_next_session(struct net *net, struct pppol2tp_seq_data *pd)
1580 {
1581 pd->session = l2tp_session_find_nth(pd->tunnel, pd->session_idx);
1582 pd->session_idx++;
1583
1584 if (pd->session == NULL) {
1585 pd->session_idx = 0;
1586 pppol2tp_next_tunnel(net, pd);
1587 }
1588 }
1589
1590 static void *pppol2tp_seq_start(struct seq_file *m, loff_t *offs)
1591 {
1592 struct pppol2tp_seq_data *pd = SEQ_START_TOKEN;
1593 loff_t pos = *offs;
1594 struct net *net;
1595
1596 if (!pos)
1597 goto out;
1598
1599 BUG_ON(m->private == NULL);
1600 pd = m->private;
1601 net = seq_file_net(m);
1602
1603 if (pd->tunnel == NULL)
1604 pppol2tp_next_tunnel(net, pd);
1605 else
1606 pppol2tp_next_session(net, pd);
1607
1608 /* NULL tunnel and session indicates end of list */
1609 if ((pd->tunnel == NULL) && (pd->session == NULL))
1610 pd = NULL;
1611
1612 out:
1613 return pd;
1614 }
1615
1616 static void *pppol2tp_seq_next(struct seq_file *m, void *v, loff_t *pos)
1617 {
1618 (*pos)++;
1619 return NULL;
1620 }
1621
1622 static void pppol2tp_seq_stop(struct seq_file *p, void *v)
1623 {
1624 /* nothing to do */
1625 }
1626
1627 static void pppol2tp_seq_tunnel_show(struct seq_file *m, void *v)
1628 {
1629 struct l2tp_tunnel *tunnel = v;
1630
1631 seq_printf(m, "\nTUNNEL '%s', %c %d\n",
1632 tunnel->name,
1633 (tunnel == tunnel->sock->sk_user_data) ? 'Y' : 'N',
1634 atomic_read(&tunnel->ref_count) - 1);
1635 seq_printf(m, " %08x %ld/%ld/%ld %ld/%ld/%ld\n",
1636 tunnel->debug,
1637 atomic_long_read(&tunnel->stats.tx_packets),
1638 atomic_long_read(&tunnel->stats.tx_bytes),
1639 atomic_long_read(&tunnel->stats.tx_errors),
1640 atomic_long_read(&tunnel->stats.rx_packets),
1641 atomic_long_read(&tunnel->stats.rx_bytes),
1642 atomic_long_read(&tunnel->stats.rx_errors));
1643 }
1644
1645 static void pppol2tp_seq_session_show(struct seq_file *m, void *v)
1646 {
1647 struct l2tp_session *session = v;
1648 struct l2tp_tunnel *tunnel = session->tunnel;
1649 struct pppol2tp_session *ps = l2tp_session_priv(session);
1650 struct pppox_sock *po = pppox_sk(ps->sock);
1651 u32 ip = 0;
1652 u16 port = 0;
1653
1654 if (tunnel->sock) {
1655 struct inet_sock *inet = inet_sk(tunnel->sock);
1656 ip = ntohl(inet->inet_saddr);
1657 port = ntohs(inet->inet_sport);
1658 }
1659
1660 seq_printf(m, " SESSION '%s' %08X/%d %04X/%04X -> "
1661 "%04X/%04X %d %c\n",
1662 session->name, ip, port,
1663 tunnel->tunnel_id,
1664 session->session_id,
1665 tunnel->peer_tunnel_id,
1666 session->peer_session_id,
1667 ps->sock->sk_state,
1668 (session == ps->sock->sk_user_data) ?
1669 'Y' : 'N');
1670 seq_printf(m, " %d/%d/%c/%c/%s %08x %u\n",
1671 session->mtu, session->mru,
1672 session->recv_seq ? 'R' : '-',
1673 session->send_seq ? 'S' : '-',
1674 session->lns_mode ? "LNS" : "LAC",
1675 session->debug,
1676 jiffies_to_msecs(session->reorder_timeout));
1677 seq_printf(m, " %hu/%hu %ld/%ld/%ld %ld/%ld/%ld\n",
1678 session->nr, session->ns,
1679 atomic_long_read(&session->stats.tx_packets),
1680 atomic_long_read(&session->stats.tx_bytes),
1681 atomic_long_read(&session->stats.tx_errors),
1682 atomic_long_read(&session->stats.rx_packets),
1683 atomic_long_read(&session->stats.rx_bytes),
1684 atomic_long_read(&session->stats.rx_errors));
1685
1686 if (po)
1687 seq_printf(m, " interface %s\n", ppp_dev_name(&po->chan));
1688 }
1689
1690 static int pppol2tp_seq_show(struct seq_file *m, void *v)
1691 {
1692 struct pppol2tp_seq_data *pd = v;
1693
1694 /* display header on line 1 */
1695 if (v == SEQ_START_TOKEN) {
1696 seq_puts(m, "PPPoL2TP driver info, " PPPOL2TP_DRV_VERSION "\n");
1697 seq_puts(m, "TUNNEL name, user-data-ok session-count\n");
1698 seq_puts(m, " debug tx-pkts/bytes/errs rx-pkts/bytes/errs\n");
1699 seq_puts(m, " SESSION name, addr/port src-tid/sid "
1700 "dest-tid/sid state user-data-ok\n");
1701 seq_puts(m, " mtu/mru/rcvseq/sendseq/lns debug reorderto\n");
1702 seq_puts(m, " nr/ns tx-pkts/bytes/errs rx-pkts/bytes/errs\n");
1703 goto out;
1704 }
1705
1706 /* Show the tunnel or session context.
1707 */
1708 if (pd->session == NULL)
1709 pppol2tp_seq_tunnel_show(m, pd->tunnel);
1710 else
1711 pppol2tp_seq_session_show(m, pd->session);
1712
1713 out:
1714 return 0;
1715 }
1716
1717 static const struct seq_operations pppol2tp_seq_ops = {
1718 .start = pppol2tp_seq_start,
1719 .next = pppol2tp_seq_next,
1720 .stop = pppol2tp_seq_stop,
1721 .show = pppol2tp_seq_show,
1722 };
1723
1724 /* Called when our /proc file is opened. We allocate data for use when
1725 * iterating our tunnel / session contexts and store it in the private
1726 * data of the seq_file.
1727 */
1728 static int pppol2tp_proc_open(struct inode *inode, struct file *file)
1729 {
1730 return seq_open_net(inode, file, &pppol2tp_seq_ops,
1731 sizeof(struct pppol2tp_seq_data));
1732 }
1733
1734 static const struct file_operations pppol2tp_proc_fops = {
1735 .owner = THIS_MODULE,
1736 .open = pppol2tp_proc_open,
1737 .read = seq_read,
1738 .llseek = seq_lseek,
1739 .release = seq_release_net,
1740 };
1741
1742 #endif /* CONFIG_PROC_FS */
1743
1744 /*****************************************************************************
1745 * Network namespace
1746 *****************************************************************************/
1747
1748 static __net_init int pppol2tp_init_net(struct net *net)
1749 {
1750 struct proc_dir_entry *pde;
1751 int err = 0;
1752
1753 pde = proc_create("pppol2tp", S_IRUGO, net->proc_net,
1754 &pppol2tp_proc_fops);
1755 if (!pde) {
1756 err = -ENOMEM;
1757 goto out;
1758 }
1759
1760 out:
1761 return err;
1762 }
1763
1764 static __net_exit void pppol2tp_exit_net(struct net *net)
1765 {
1766 remove_proc_entry("pppol2tp", net->proc_net);
1767 }
1768
1769 static struct pernet_operations pppol2tp_net_ops = {
1770 .init = pppol2tp_init_net,
1771 .exit = pppol2tp_exit_net,
1772 .id = &pppol2tp_net_id,
1773 };
1774
1775 /*****************************************************************************
1776 * Init and cleanup
1777 *****************************************************************************/
1778
1779 static const struct proto_ops pppol2tp_ops = {
1780 .family = AF_PPPOX,
1781 .owner = THIS_MODULE,
1782 .release = pppol2tp_release,
1783 .bind = sock_no_bind,
1784 .connect = pppol2tp_connect,
1785 .socketpair = sock_no_socketpair,
1786 .accept = sock_no_accept,
1787 .getname = pppol2tp_getname,
1788 .poll = datagram_poll,
1789 .listen = sock_no_listen,
1790 .shutdown = sock_no_shutdown,
1791 .setsockopt = pppol2tp_setsockopt,
1792 .getsockopt = pppol2tp_getsockopt,
1793 .sendmsg = pppol2tp_sendmsg,
1794 .recvmsg = pppol2tp_recvmsg,
1795 .mmap = sock_no_mmap,
1796 .ioctl = pppox_ioctl,
1797 };
1798
1799 static const struct pppox_proto pppol2tp_proto = {
1800 .create = pppol2tp_create,
1801 .ioctl = pppol2tp_ioctl,
1802 .owner = THIS_MODULE,
1803 };
1804
1805 #ifdef CONFIG_L2TP_V3
1806
1807 static const struct l2tp_nl_cmd_ops pppol2tp_nl_cmd_ops = {
1808 .session_create = pppol2tp_session_create,
1809 .session_delete = l2tp_session_delete,
1810 };
1811
1812 #endif /* CONFIG_L2TP_V3 */
1813
1814 static int __init pppol2tp_init(void)
1815 {
1816 int err;
1817
1818 err = register_pernet_device(&pppol2tp_net_ops);
1819 if (err)
1820 goto out;
1821
1822 err = proto_register(&pppol2tp_sk_proto, 0);
1823 if (err)
1824 goto out_unregister_pppol2tp_pernet;
1825
1826 err = register_pppox_proto(PX_PROTO_OL2TP, &pppol2tp_proto);
1827 if (err)
1828 goto out_unregister_pppol2tp_proto;
1829
1830 #ifdef CONFIG_L2TP_V3
1831 err = l2tp_nl_register_ops(L2TP_PWTYPE_PPP, &pppol2tp_nl_cmd_ops);
1832 if (err)
1833 goto out_unregister_pppox;
1834 #endif
1835
1836 pr_info("PPPoL2TP kernel driver, %s\n", PPPOL2TP_DRV_VERSION);
1837
1838 out:
1839 return err;
1840
1841 #ifdef CONFIG_L2TP_V3
1842 out_unregister_pppox:
1843 unregister_pppox_proto(PX_PROTO_OL2TP);
1844 #endif
1845 out_unregister_pppol2tp_proto:
1846 proto_unregister(&pppol2tp_sk_proto);
1847 out_unregister_pppol2tp_pernet:
1848 unregister_pernet_device(&pppol2tp_net_ops);
1849 goto out;
1850 }
1851
1852 static void __exit pppol2tp_exit(void)
1853 {
1854 #ifdef CONFIG_L2TP_V3
1855 l2tp_nl_unregister_ops(L2TP_PWTYPE_PPP);
1856 #endif
1857 unregister_pppox_proto(PX_PROTO_OL2TP);
1858 proto_unregister(&pppol2tp_sk_proto);
1859 unregister_pernet_device(&pppol2tp_net_ops);
1860 }
1861
1862 module_init(pppol2tp_init);
1863 module_exit(pppol2tp_exit);
1864
1865 MODULE_AUTHOR("James Chapman <jchapman@katalix.com>");
1866 MODULE_DESCRIPTION("PPP over L2TP over UDP");
1867 MODULE_LICENSE("GPL");
1868 MODULE_VERSION(PPPOL2TP_DRV_VERSION);
1869 MODULE_ALIAS("pppox-proto-" __stringify(PX_PROTO_OL2TP));
Linux kernel - Deliverables
This page took 0.088882 seconds and 6 git commands to generate.