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