12874c5fdSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
2fd558d18SJames Chapman /*****************************************************************************
3fd558d18SJames Chapman * Linux PPP over L2TP (PPPoX/PPPoL2TP) Sockets
4fd558d18SJames Chapman *
5fd558d18SJames Chapman * PPPoX --- Generic PPP encapsulation socket family
6fd558d18SJames Chapman * PPPoL2TP --- PPP over L2TP (RFC 2661)
7fd558d18SJames Chapman *
8fd558d18SJames Chapman * Version: 2.0.0
9fd558d18SJames Chapman *
10fd558d18SJames Chapman * Authors: James Chapman (jchapman@katalix.com)
11fd558d18SJames Chapman *
12fd558d18SJames Chapman * Based on original work by Martijn van Oosterhout <kleptog@svana.org>
13fd558d18SJames Chapman *
14fd558d18SJames Chapman * License:
15fd558d18SJames Chapman */
16fd558d18SJames Chapman
17fd558d18SJames Chapman /* This driver handles only L2TP data frames; control frames are handled by a
18fd558d18SJames Chapman * userspace application.
19fd558d18SJames Chapman *
20fd558d18SJames Chapman * To send data in an L2TP session, userspace opens a PPPoL2TP socket and
21fd558d18SJames Chapman * attaches it to a bound UDP socket with local tunnel_id / session_id and
22fd558d18SJames Chapman * peer tunnel_id / session_id set. Data can then be sent or received using
23fd558d18SJames Chapman * regular socket sendmsg() / recvmsg() calls. Kernel parameters of the socket
24fd558d18SJames Chapman * can be read or modified using ioctl() or [gs]etsockopt() calls.
25fd558d18SJames Chapman *
26fd558d18SJames Chapman * When a PPPoL2TP socket is connected with local and peer session_id values
27fd558d18SJames Chapman * zero, the socket is treated as a special tunnel management socket.
28fd558d18SJames Chapman *
29fd558d18SJames Chapman * Here's example userspace code to create a socket for sending/receiving data
30fd558d18SJames Chapman * over an L2TP session:-
31fd558d18SJames Chapman *
32fd558d18SJames Chapman * struct sockaddr_pppol2tp sax;
33fd558d18SJames Chapman * int fd;
34fd558d18SJames Chapman * int session_fd;
35fd558d18SJames Chapman *
36fd558d18SJames Chapman * fd = socket(AF_PPPOX, SOCK_DGRAM, PX_PROTO_OL2TP);
37fd558d18SJames Chapman *
38fd558d18SJames Chapman * sax.sa_family = AF_PPPOX;
39fd558d18SJames Chapman * sax.sa_protocol = PX_PROTO_OL2TP;
40fd558d18SJames Chapman * sax.pppol2tp.fd = tunnel_fd; // bound UDP socket
41fd558d18SJames Chapman * sax.pppol2tp.addr.sin_addr.s_addr = addr->sin_addr.s_addr;
42fd558d18SJames Chapman * sax.pppol2tp.addr.sin_port = addr->sin_port;
43fd558d18SJames Chapman * sax.pppol2tp.addr.sin_family = AF_INET;
44fd558d18SJames Chapman * sax.pppol2tp.s_tunnel = tunnel_id;
45fd558d18SJames Chapman * sax.pppol2tp.s_session = session_id;
46fd558d18SJames Chapman * sax.pppol2tp.d_tunnel = peer_tunnel_id;
47fd558d18SJames Chapman * sax.pppol2tp.d_session = peer_session_id;
48fd558d18SJames Chapman *
49fd558d18SJames Chapman * session_fd = connect(fd, (struct sockaddr *)&sax, sizeof(sax));
50fd558d18SJames Chapman *
51fd558d18SJames Chapman * A pppd plugin that allows PPP traffic to be carried over L2TP using
52fd558d18SJames Chapman * this driver is available from the OpenL2TP project at
53fd558d18SJames Chapman * http://openl2tp.sourceforge.net.
54fd558d18SJames Chapman */
55fd558d18SJames Chapman
56a4ca44faSJoe Perches #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
57a4ca44faSJoe Perches
58fd558d18SJames Chapman #include <linux/module.h>
59fd558d18SJames Chapman #include <linux/string.h>
60fd558d18SJames Chapman #include <linux/list.h>
61fd558d18SJames Chapman #include <linux/uaccess.h>
62fd558d18SJames Chapman
63fd558d18SJames Chapman #include <linux/kernel.h>
64fd558d18SJames Chapman #include <linux/spinlock.h>
65fd558d18SJames Chapman #include <linux/kthread.h>
66fd558d18SJames Chapman #include <linux/sched.h>
67fd558d18SJames Chapman #include <linux/slab.h>
68fd558d18SJames Chapman #include <linux/errno.h>
69fd558d18SJames Chapman #include <linux/jiffies.h>
70fd558d18SJames Chapman
71fd558d18SJames Chapman #include <linux/netdevice.h>
72fd558d18SJames Chapman #include <linux/net.h>
73fd558d18SJames Chapman #include <linux/inetdevice.h>
74fd558d18SJames Chapman #include <linux/skbuff.h>
75fd558d18SJames Chapman #include <linux/init.h>
76fd558d18SJames Chapman #include <linux/ip.h>
77fd558d18SJames Chapman #include <linux/udp.h>
78fd558d18SJames Chapman #include <linux/if_pppox.h>
79fd558d18SJames Chapman #include <linux/if_pppol2tp.h>
80fd558d18SJames Chapman #include <net/sock.h>
81fd558d18SJames Chapman #include <linux/ppp_channel.h>
82fd558d18SJames Chapman #include <linux/ppp_defs.h>
834b32da2bSPaul Mackerras #include <linux/ppp-ioctl.h>
84fd558d18SJames Chapman #include <linux/file.h>
85fd558d18SJames Chapman #include <linux/hash.h>
86fd558d18SJames Chapman #include <linux/sort.h>
87fd558d18SJames Chapman #include <linux/proc_fs.h>
88309795f4SJames Chapman #include <linux/l2tp.h>
89fd558d18SJames Chapman #include <linux/nsproxy.h>
90fd558d18SJames Chapman #include <net/net_namespace.h>
91fd558d18SJames Chapman #include <net/netns/generic.h>
92fd558d18SJames Chapman #include <net/ip.h>
93fd558d18SJames Chapman #include <net/udp.h>
94cf2f5c88STom Parkin #include <net/inet_common.h>
95fd558d18SJames Chapman
96fd558d18SJames Chapman #include <asm/byteorder.h>
9760063497SArun Sharma #include <linux/atomic.h>
98fd558d18SJames Chapman
99fd558d18SJames Chapman #include "l2tp_core.h"
100fd558d18SJames Chapman
101fd558d18SJames Chapman #define PPPOL2TP_DRV_VERSION "V2.0"
102fd558d18SJames Chapman
103fd558d18SJames Chapman /* Space for UDP, L2TP and PPP headers */
104fd558d18SJames Chapman #define PPPOL2TP_HEADER_OVERHEAD 40
105fd558d18SJames Chapman
106fd558d18SJames Chapman /* Number of bytes to build transmit L2TP headers.
107fd558d18SJames Chapman * Unfortunately the size is different depending on whether sequence numbers
108fd558d18SJames Chapman * are enabled.
109fd558d18SJames Chapman */
110fd558d18SJames Chapman #define PPPOL2TP_L2TP_HDR_SIZE_SEQ 10
111fd558d18SJames Chapman #define PPPOL2TP_L2TP_HDR_SIZE_NOSEQ 6
112fd558d18SJames Chapman
113fd558d18SJames Chapman /* Private data of each session. This data lives at the end of struct
114fd558d18SJames Chapman * l2tp_session, referenced via session->priv[].
115fd558d18SJames Chapman */
116fd558d18SJames Chapman struct pppol2tp_session {
117fd558d18SJames Chapman int owner; /* pid that opened the socket */
118fd558d18SJames Chapman
119ee40fb2eSGuillaume Nault struct mutex sk_lock; /* Protects .sk */
12020dcb110STom Parkin struct sock __rcu *sk; /* Pointer to the session PPPoX socket */
121ee40fb2eSGuillaume Nault struct sock *__sk; /* Copy of .sk, for cleanup */
122ee40fb2eSGuillaume Nault struct rcu_head rcu; /* For asynchronous release */
123fd558d18SJames Chapman };
124fd558d18SJames Chapman
125fd558d18SJames Chapman static int pppol2tp_xmit(struct ppp_channel *chan, struct sk_buff *skb);
126fd558d18SJames Chapman
127d7100da0Sstephen hemminger static const struct ppp_channel_ops pppol2tp_chan_ops = {
128d7100da0Sstephen hemminger .start_xmit = pppol2tp_xmit,
129d7100da0Sstephen hemminger };
130d7100da0Sstephen hemminger
131fd558d18SJames Chapman static const struct proto_ops pppol2tp_ops;
132fd558d18SJames Chapman
133ee40fb2eSGuillaume Nault /* Retrieves the pppol2tp socket associated to a session.
134ee40fb2eSGuillaume Nault * A reference is held on the returned socket, so this function must be paired
135ee40fb2eSGuillaume Nault * with sock_put().
136ee40fb2eSGuillaume Nault */
pppol2tp_session_get_sock(struct l2tp_session * session)137ee40fb2eSGuillaume Nault static struct sock *pppol2tp_session_get_sock(struct l2tp_session *session)
138ee40fb2eSGuillaume Nault {
139ee40fb2eSGuillaume Nault struct pppol2tp_session *ps = l2tp_session_priv(session);
140ee40fb2eSGuillaume Nault struct sock *sk;
141ee40fb2eSGuillaume Nault
142ee40fb2eSGuillaume Nault rcu_read_lock();
143ee40fb2eSGuillaume Nault sk = rcu_dereference(ps->sk);
144ee40fb2eSGuillaume Nault if (sk)
145ee40fb2eSGuillaume Nault sock_hold(sk);
146ee40fb2eSGuillaume Nault rcu_read_unlock();
147ee40fb2eSGuillaume Nault
148ee40fb2eSGuillaume Nault return sk;
149ee40fb2eSGuillaume Nault }
150ee40fb2eSGuillaume Nault
151fd558d18SJames Chapman /* Helpers to obtain tunnel/session contexts from sockets.
152fd558d18SJames Chapman */
pppol2tp_sock_to_session(struct sock * sk)153fd558d18SJames Chapman static inline struct l2tp_session *pppol2tp_sock_to_session(struct sock *sk)
154fd558d18SJames Chapman {
155fd558d18SJames Chapman struct l2tp_session *session;
156fd558d18SJames Chapman
1570febc7b3STom Parkin if (!sk)
158fd558d18SJames Chapman return NULL;
159fd558d18SJames Chapman
160fd558d18SJames Chapman sock_hold(sk);
161fd558d18SJames Chapman session = (struct l2tp_session *)(sk->sk_user_data);
1620febc7b3STom Parkin if (!session) {
163fd558d18SJames Chapman sock_put(sk);
164fd558d18SJames Chapman goto out;
165fd558d18SJames Chapman }
1661aa646acSTom Parkin if (WARN_ON(session->magic != L2TP_SESSION_MAGIC)) {
1671aa646acSTom Parkin session = NULL;
1681aa646acSTom Parkin sock_put(sk);
1691aa646acSTom Parkin goto out;
1701aa646acSTom Parkin }
171fd558d18SJames Chapman
172fd558d18SJames Chapman out:
173fd558d18SJames Chapman return session;
174fd558d18SJames Chapman }
175fd558d18SJames Chapman
176fd558d18SJames Chapman /*****************************************************************************
177fd558d18SJames Chapman * Receive data handling
178fd558d18SJames Chapman *****************************************************************************/
179fd558d18SJames Chapman
180fd558d18SJames Chapman /* Receive message. This is the recvmsg for the PPPoL2TP socket.
181fd558d18SJames Chapman */
pppol2tp_recvmsg(struct socket * sock,struct msghdr * msg,size_t len,int flags)1821b784140SYing Xue static int pppol2tp_recvmsg(struct socket *sock, struct msghdr *msg,
1831b784140SYing Xue size_t len, int flags)
184fd558d18SJames Chapman {
185fd558d18SJames Chapman int err;
186fd558d18SJames Chapman struct sk_buff *skb;
187fd558d18SJames Chapman struct sock *sk = sock->sk;
188fd558d18SJames Chapman
189fd558d18SJames Chapman err = -EIO;
190fd558d18SJames Chapman if (sk->sk_state & PPPOX_BOUND)
191fd558d18SJames Chapman goto end;
192fd558d18SJames Chapman
193fd558d18SJames Chapman err = 0;
194f4b41f06SOliver Hartkopp skb = skb_recv_datagram(sk, flags, &err);
195fd558d18SJames Chapman if (!skb)
196fd558d18SJames Chapman goto end;
197fd558d18SJames Chapman
198fd558d18SJames Chapman if (len > skb->len)
199fd558d18SJames Chapman len = skb->len;
200fd558d18SJames Chapman else if (len < skb->len)
201fd558d18SJames Chapman msg->msg_flags |= MSG_TRUNC;
202fd558d18SJames Chapman
20351f3d02bSDavid S. Miller err = skb_copy_datagram_msg(skb, 0, msg, len);
204fd558d18SJames Chapman if (likely(err == 0))
205fd558d18SJames Chapman err = len;
206fd558d18SJames Chapman
207fd558d18SJames Chapman kfree_skb(skb);
208fd558d18SJames Chapman end:
209fd558d18SJames Chapman return err;
210fd558d18SJames Chapman }
211fd558d18SJames Chapman
pppol2tp_recv(struct l2tp_session * session,struct sk_buff * skb,int data_len)212fd558d18SJames Chapman static void pppol2tp_recv(struct l2tp_session *session, struct sk_buff *skb, int data_len)
213fd558d18SJames Chapman {
214fd558d18SJames Chapman struct pppol2tp_session *ps = l2tp_session_priv(session);
215fd558d18SJames Chapman struct sock *sk = NULL;
216fd558d18SJames Chapman
217fd558d18SJames Chapman /* If the socket is bound, send it in to PPP's input queue. Otherwise
218fd558d18SJames Chapman * queue it on the session socket.
219fd558d18SJames Chapman */
220ee40fb2eSGuillaume Nault rcu_read_lock();
221ee40fb2eSGuillaume Nault sk = rcu_dereference(ps->sk);
2220febc7b3STom Parkin if (!sk)
223fd558d18SJames Chapman goto no_sock;
224fd558d18SJames Chapman
2252b139e6bSGuillaume Nault /* If the first two bytes are 0xFF03, consider that it is the PPP's
2262b139e6bSGuillaume Nault * Address and Control fields and skip them. The L2TP module has always
2272b139e6bSGuillaume Nault * worked this way, although, in theory, the use of these fields should
2287f553ff2SZheng Yongjun * be negotiated and handled at the PPP layer. These fields are
2292b139e6bSGuillaume Nault * constant: 0xFF is the All-Stations Address and 0x03 the Unnumbered
2302b139e6bSGuillaume Nault * Information command with Poll/Final bit set to zero (RFC 1662).
2312b139e6bSGuillaume Nault */
2322b139e6bSGuillaume Nault if (pskb_may_pull(skb, 2) && skb->data[0] == PPP_ALLSTATIONS &&
2332b139e6bSGuillaume Nault skb->data[1] == PPP_UI)
2342b139e6bSGuillaume Nault skb_pull(skb, 2);
2352b139e6bSGuillaume Nault
236fd558d18SJames Chapman if (sk->sk_state & PPPOX_BOUND) {
237fd558d18SJames Chapman struct pppox_sock *po;
23898f40b3eSGuillaume Nault
239fd558d18SJames Chapman po = pppox_sk(sk);
240fd558d18SJames Chapman ppp_input(&po->chan, skb);
241fd558d18SJames Chapman } else {
2429e9cb622SGuillaume Nault if (sock_queue_rcv_skb(sk, skb) < 0) {
2437b7c0719STom Parkin atomic_long_inc(&session->stats.rx_errors);
244fd558d18SJames Chapman kfree_skb(skb);
245fd558d18SJames Chapman }
2469e9cb622SGuillaume Nault }
247ee40fb2eSGuillaume Nault rcu_read_unlock();
248fd558d18SJames Chapman
249fd558d18SJames Chapman return;
250fd558d18SJames Chapman
251fd558d18SJames Chapman no_sock:
252ee40fb2eSGuillaume Nault rcu_read_unlock();
2535ee759cdSTom Parkin pr_warn_ratelimited("%s: no socket in recv\n", session->name);
254fd558d18SJames Chapman kfree_skb(skb);
255fd558d18SJames Chapman }
256fd558d18SJames Chapman
257fd558d18SJames Chapman /************************************************************************
258fd558d18SJames Chapman * Transmit handling
259fd558d18SJames Chapman ***********************************************************************/
260fd558d18SJames Chapman
261fd558d18SJames Chapman /* This is the sendmsg for the PPPoL2TP pppol2tp_session socket. We come here
262fd558d18SJames Chapman * when a user application does a sendmsg() on the session socket. L2TP and
263fd558d18SJames Chapman * PPP headers must be inserted into the user's data.
264fd558d18SJames Chapman */
pppol2tp_sendmsg(struct socket * sock,struct msghdr * m,size_t total_len)2651b784140SYing Xue static int pppol2tp_sendmsg(struct socket *sock, struct msghdr *m,
266fd558d18SJames Chapman size_t total_len)
267fd558d18SJames Chapman {
268fd558d18SJames Chapman struct sock *sk = sock->sk;
269fd558d18SJames Chapman struct sk_buff *skb;
270fd558d18SJames Chapman int error;
271fd558d18SJames Chapman struct l2tp_session *session;
272fd558d18SJames Chapman struct l2tp_tunnel *tunnel;
2730d76751fSJames Chapman int uhlen;
274fd558d18SJames Chapman
275fd558d18SJames Chapman error = -ENOTCONN;
276fd558d18SJames Chapman if (sock_flag(sk, SOCK_DEAD) || !(sk->sk_state & PPPOX_CONNECTED))
277fd558d18SJames Chapman goto error;
278fd558d18SJames Chapman
279fd558d18SJames Chapman /* Get session and tunnel contexts */
280fd558d18SJames Chapman error = -EBADF;
281fd558d18SJames Chapman session = pppol2tp_sock_to_session(sk);
2820febc7b3STom Parkin if (!session)
283fd558d18SJames Chapman goto error;
284fd558d18SJames Chapman
2857198c77aSGuillaume Nault tunnel = session->tunnel;
286fd558d18SJames Chapman
2870d76751fSJames Chapman uhlen = (tunnel->encap == L2TP_ENCAPTYPE_UDP) ? sizeof(struct udphdr) : 0;
2880d76751fSJames Chapman
289fd558d18SJames Chapman /* Allocate a socket buffer */
290fd558d18SJames Chapman error = -ENOMEM;
291fd558d18SJames Chapman skb = sock_wmalloc(sk, NET_SKB_PAD + sizeof(struct iphdr) +
2920d76751fSJames Chapman uhlen + session->hdr_len +
29354c151d9SGao Feng 2 + total_len, /* 2 bytes for PPP_ALLSTATIONS & PPP_UI */
294fd558d18SJames Chapman 0, GFP_KERNEL);
295fd558d18SJames Chapman if (!skb)
2967198c77aSGuillaume Nault goto error_put_sess;
297fd558d18SJames Chapman
298fd558d18SJames Chapman /* Reserve space for headers. */
299fd558d18SJames Chapman skb_reserve(skb, NET_SKB_PAD);
300fd558d18SJames Chapman skb_reset_network_header(skb);
301fd558d18SJames Chapman skb_reserve(skb, sizeof(struct iphdr));
302fd558d18SJames Chapman skb_reset_transport_header(skb);
3030d76751fSJames Chapman skb_reserve(skb, uhlen);
304fd558d18SJames Chapman
305fd558d18SJames Chapman /* Add PPP header */
30654c151d9SGao Feng skb->data[0] = PPP_ALLSTATIONS;
30754c151d9SGao Feng skb->data[1] = PPP_UI;
308fd558d18SJames Chapman skb_put(skb, 2);
309fd558d18SJames Chapman
310fd558d18SJames Chapman /* Copy user data into skb */
3116ce8e9ceSAl Viro error = memcpy_from_msg(skb_put(skb, total_len), m, total_len);
312fd558d18SJames Chapman if (error < 0) {
313fd558d18SJames Chapman kfree_skb(skb);
3147198c77aSGuillaume Nault goto error_put_sess;
315fd558d18SJames Chapman }
316fd558d18SJames Chapman
317455cc32bSEric Dumazet local_bh_disable();
318efe05278STom Parkin l2tp_xmit_skb(session, skb);
319455cc32bSEric Dumazet local_bh_enable();
320fd558d18SJames Chapman
3218b82547eSGuillaume Nault sock_put(sk);
322fd558d18SJames Chapman
323a6f79d0fSGuillaume Nault return total_len;
324fd558d18SJames Chapman
325fd558d18SJames Chapman error_put_sess:
326fd558d18SJames Chapman sock_put(sk);
327fd558d18SJames Chapman error:
328fd558d18SJames Chapman return error;
329fd558d18SJames Chapman }
330fd558d18SJames Chapman
331fd558d18SJames Chapman /* Transmit function called by generic PPP driver. Sends PPP frame
332fd558d18SJames Chapman * over PPPoL2TP socket.
333fd558d18SJames Chapman *
334fd558d18SJames Chapman * This is almost the same as pppol2tp_sendmsg(), but rather than
335fd558d18SJames Chapman * being called with a msghdr from userspace, it is called with a skb
336fd558d18SJames Chapman * from the kernel.
337fd558d18SJames Chapman *
338fd558d18SJames Chapman * The supplied skb from ppp doesn't have enough headroom for the
339fd558d18SJames Chapman * insertion of L2TP, UDP and IP headers so we need to allocate more
340fd558d18SJames Chapman * headroom in the skb. This will create a cloned skb. But we must be
341fd558d18SJames Chapman * careful in the error case because the caller will expect to free
342fd558d18SJames Chapman * the skb it supplied, not our cloned skb. So we take care to always
343fd558d18SJames Chapman * leave the original skb unfreed if we return an error.
344fd558d18SJames Chapman */
pppol2tp_xmit(struct ppp_channel * chan,struct sk_buff * skb)345fd558d18SJames Chapman static int pppol2tp_xmit(struct ppp_channel *chan, struct sk_buff *skb)
346fd558d18SJames Chapman {
347fd558d18SJames Chapman struct sock *sk = (struct sock *)chan->private;
348fd558d18SJames Chapman struct l2tp_session *session;
349fd558d18SJames Chapman struct l2tp_tunnel *tunnel;
35009df57caSEric Dumazet int uhlen, headroom;
351fd558d18SJames Chapman
352fd558d18SJames Chapman if (sock_flag(sk, SOCK_DEAD) || !(sk->sk_state & PPPOX_CONNECTED))
353fd558d18SJames Chapman goto abort;
354fd558d18SJames Chapman
355fd558d18SJames Chapman /* Get session and tunnel contexts from the socket */
356fd558d18SJames Chapman session = pppol2tp_sock_to_session(sk);
3570febc7b3STom Parkin if (!session)
358fd558d18SJames Chapman goto abort;
359fd558d18SJames Chapman
3607198c77aSGuillaume Nault tunnel = session->tunnel;
361fd558d18SJames Chapman
36209df57caSEric Dumazet uhlen = (tunnel->encap == L2TP_ENCAPTYPE_UDP) ? sizeof(struct udphdr) : 0;
36309df57caSEric Dumazet headroom = NET_SKB_PAD +
36409df57caSEric Dumazet sizeof(struct iphdr) + /* IP header */
36509df57caSEric Dumazet uhlen + /* UDP header (if L2TP_ENCAPTYPE_UDP) */
36609df57caSEric Dumazet session->hdr_len + /* L2TP header */
36754c151d9SGao Feng 2; /* 2 bytes for PPP_ALLSTATIONS & PPP_UI */
36809df57caSEric Dumazet if (skb_cow_head(skb, headroom))
3697198c77aSGuillaume Nault goto abort_put_sess;
370fd558d18SJames Chapman
371fd558d18SJames Chapman /* Setup PPP header */
37254c151d9SGao Feng __skb_push(skb, 2);
37354c151d9SGao Feng skb->data[0] = PPP_ALLSTATIONS;
37454c151d9SGao Feng skb->data[1] = PPP_UI;
375fd558d18SJames Chapman
376455cc32bSEric Dumazet local_bh_disable();
377efe05278STom Parkin l2tp_xmit_skb(session, skb);
378455cc32bSEric Dumazet local_bh_enable();
379fd558d18SJames Chapman
380fd558d18SJames Chapman sock_put(sk);
3817198c77aSGuillaume Nault
382fd558d18SJames Chapman return 1;
383fd558d18SJames Chapman
384fd558d18SJames Chapman abort_put_sess:
385fd558d18SJames Chapman sock_put(sk);
386fd558d18SJames Chapman abort:
387fd558d18SJames Chapman /* Free the original skb */
388fd558d18SJames Chapman kfree_skb(skb);
389fd558d18SJames Chapman return 1;
390fd558d18SJames Chapman }
391fd558d18SJames Chapman
392fd558d18SJames Chapman /*****************************************************************************
393fd558d18SJames Chapman * Session (and tunnel control) socket create/destroy.
394fd558d18SJames Chapman *****************************************************************************/
395fd558d18SJames Chapman
pppol2tp_put_sk(struct rcu_head * head)396d02ba2a6SJames Chapman static void pppol2tp_put_sk(struct rcu_head *head)
397d02ba2a6SJames Chapman {
398d02ba2a6SJames Chapman struct pppol2tp_session *ps;
399d02ba2a6SJames Chapman
400d02ba2a6SJames Chapman ps = container_of(head, typeof(*ps), rcu);
401d02ba2a6SJames Chapman sock_put(ps->__sk);
402d02ba2a6SJames Chapman }
403d02ba2a6SJames Chapman
404fd558d18SJames Chapman /* Really kill the session socket. (Called from sock_put() if
405fd558d18SJames Chapman * refcnt == 0.)
406fd558d18SJames Chapman */
pppol2tp_session_destruct(struct sock * sk)407fd558d18SJames Chapman static void pppol2tp_session_destruct(struct sock *sk)
408fd558d18SJames Chapman {
409f6e16b29STom Parkin struct l2tp_session *session = sk->sk_user_data;
410e91793bbSGuillaume Nault
411e91793bbSGuillaume Nault skb_queue_purge(&sk->sk_receive_queue);
412e91793bbSGuillaume Nault skb_queue_purge(&sk->sk_write_queue);
413e91793bbSGuillaume Nault
414f6e16b29STom Parkin if (session) {
415fd558d18SJames Chapman sk->sk_user_data = NULL;
4161aa646acSTom Parkin if (WARN_ON(session->magic != L2TP_SESSION_MAGIC))
4171aa646acSTom Parkin return;
418fd558d18SJames Chapman l2tp_session_dec_refcount(session);
419fd558d18SJames Chapman }
420fd558d18SJames Chapman }
421fd558d18SJames Chapman
422fd558d18SJames Chapman /* Called when the PPPoX socket (session) is closed.
423fd558d18SJames Chapman */
pppol2tp_release(struct socket * sock)424fd558d18SJames Chapman static int pppol2tp_release(struct socket *sock)
425fd558d18SJames Chapman {
426fd558d18SJames Chapman struct sock *sk = sock->sk;
427fd558d18SJames Chapman struct l2tp_session *session;
428fd558d18SJames Chapman int error;
429fd558d18SJames Chapman
430fd558d18SJames Chapman if (!sk)
431fd558d18SJames Chapman return 0;
432fd558d18SJames Chapman
433fd558d18SJames Chapman error = -EBADF;
434fd558d18SJames Chapman lock_sock(sk);
435fd558d18SJames Chapman if (sock_flag(sk, SOCK_DEAD) != 0)
436fd558d18SJames Chapman goto error;
437fd558d18SJames Chapman
438fd558d18SJames Chapman pppox_unbind_sock(sk);
439fd558d18SJames Chapman
440fd558d18SJames Chapman /* Signal the death of the socket. */
441fd558d18SJames Chapman sk->sk_state = PPPOX_DEAD;
442fd558d18SJames Chapman sock_orphan(sk);
443fd558d18SJames Chapman sock->sk = NULL;
444fd558d18SJames Chapman
445d02ba2a6SJames Chapman session = pppol2tp_sock_to_session(sk);
446d02ba2a6SJames Chapman if (session) {
4473d609342SGuillaume Nault struct pppol2tp_session *ps;
4483d609342SGuillaume Nault
449d02ba2a6SJames Chapman l2tp_session_delete(session);
4503d609342SGuillaume Nault
4513d609342SGuillaume Nault ps = l2tp_session_priv(session);
4523d609342SGuillaume Nault mutex_lock(&ps->sk_lock);
4533d609342SGuillaume Nault ps->__sk = rcu_dereference_protected(ps->sk,
4543d609342SGuillaume Nault lockdep_is_held(&ps->sk_lock));
4553d609342SGuillaume Nault RCU_INIT_POINTER(ps->sk, NULL);
4563d609342SGuillaume Nault mutex_unlock(&ps->sk_lock);
4573d609342SGuillaume Nault call_rcu(&ps->rcu, pppol2tp_put_sk);
4583d609342SGuillaume Nault
4593d609342SGuillaume Nault /* Rely on the sock_put() call at the end of the function for
4603d609342SGuillaume Nault * dropping the reference held by pppol2tp_sock_to_session().
4613d609342SGuillaume Nault * The last reference will be dropped by pppol2tp_put_sk().
4623d609342SGuillaume Nault */
463cf2f5c88STom Parkin }
464d02ba2a6SJames Chapman
465fd558d18SJames Chapman release_sock(sk);
466fd558d18SJames Chapman
467fd558d18SJames Chapman /* This will delete the session context via
468fd558d18SJames Chapman * pppol2tp_session_destruct() if the socket's refcnt drops to
469fd558d18SJames Chapman * zero.
470fd558d18SJames Chapman */
471fd558d18SJames Chapman sock_put(sk);
472fd558d18SJames Chapman
473fd558d18SJames Chapman return 0;
474fd558d18SJames Chapman
475fd558d18SJames Chapman error:
476fd558d18SJames Chapman release_sock(sk);
477fd558d18SJames Chapman return error;
478fd558d18SJames Chapman }
479fd558d18SJames Chapman
480fd558d18SJames Chapman static struct proto pppol2tp_sk_proto = {
481fd558d18SJames Chapman .name = "PPPOL2TP",
482fd558d18SJames Chapman .owner = THIS_MODULE,
483fd558d18SJames Chapman .obj_size = sizeof(struct pppox_sock),
484fd558d18SJames Chapman };
485fd558d18SJames Chapman
pppol2tp_backlog_recv(struct sock * sk,struct sk_buff * skb)486fd558d18SJames Chapman static int pppol2tp_backlog_recv(struct sock *sk, struct sk_buff *skb)
487fd558d18SJames Chapman {
488fd558d18SJames Chapman int rc;
489fd558d18SJames Chapman
490fd558d18SJames Chapman rc = l2tp_udp_encap_recv(sk, skb);
491fd558d18SJames Chapman if (rc)
492fd558d18SJames Chapman kfree_skb(skb);
493fd558d18SJames Chapman
494fd558d18SJames Chapman return NET_RX_SUCCESS;
495fd558d18SJames Chapman }
496fd558d18SJames Chapman
497fd558d18SJames Chapman /* socket() handler. Initialize a new struct sock.
498fd558d18SJames Chapman */
pppol2tp_create(struct net * net,struct socket * sock,int kern)49911aa9c28SEric W. Biederman static int pppol2tp_create(struct net *net, struct socket *sock, int kern)
500fd558d18SJames Chapman {
501fd558d18SJames Chapman int error = -ENOMEM;
502fd558d18SJames Chapman struct sock *sk;
503fd558d18SJames Chapman
50411aa9c28SEric W. Biederman sk = sk_alloc(net, PF_PPPOX, GFP_KERNEL, &pppol2tp_sk_proto, kern);
505fd558d18SJames Chapman if (!sk)
506fd558d18SJames Chapman goto out;
507fd558d18SJames Chapman
508fd558d18SJames Chapman sock_init_data(sock, sk);
509fd558d18SJames Chapman
510fd558d18SJames Chapman sock->state = SS_UNCONNECTED;
511fd558d18SJames Chapman sock->ops = &pppol2tp_ops;
512fd558d18SJames Chapman
513fd558d18SJames Chapman sk->sk_backlog_rcv = pppol2tp_backlog_recv;
514fd558d18SJames Chapman sk->sk_protocol = PX_PROTO_OL2TP;
515fd558d18SJames Chapman sk->sk_family = PF_PPPOX;
516fd558d18SJames Chapman sk->sk_state = PPPOX_NONE;
517fd558d18SJames Chapman sk->sk_type = SOCK_STREAM;
518fd558d18SJames Chapman sk->sk_destruct = pppol2tp_session_destruct;
519fd558d18SJames Chapman
520fd558d18SJames Chapman error = 0;
521fd558d18SJames Chapman
522fd558d18SJames Chapman out:
523fd558d18SJames Chapman return error;
524fd558d18SJames Chapman }
525fd558d18SJames Chapman
pppol2tp_show(struct seq_file * m,void * arg)5260ad66140SJames Chapman static void pppol2tp_show(struct seq_file *m, void *arg)
5270ad66140SJames Chapman {
5280ad66140SJames Chapman struct l2tp_session *session = arg;
529ee40fb2eSGuillaume Nault struct sock *sk;
5300ad66140SJames Chapman
531ee40fb2eSGuillaume Nault sk = pppol2tp_session_get_sock(session);
532ee40fb2eSGuillaume Nault if (sk) {
533ee40fb2eSGuillaume Nault struct pppox_sock *po = pppox_sk(sk);
534ee40fb2eSGuillaume Nault
5350ad66140SJames Chapman seq_printf(m, " interface %s\n", ppp_dev_name(&po->chan));
536ee40fb2eSGuillaume Nault sock_put(sk);
5370ad66140SJames Chapman }
5380ad66140SJames Chapman }
5390ad66140SJames Chapman
pppol2tp_session_init(struct l2tp_session * session)540f98be6c6SGuillaume Nault static void pppol2tp_session_init(struct l2tp_session *session)
541f98be6c6SGuillaume Nault {
542f98be6c6SGuillaume Nault struct pppol2tp_session *ps;
543f98be6c6SGuillaume Nault
544f98be6c6SGuillaume Nault session->recv_skb = pppol2tp_recv;
545c2ebc256SArnd Bergmann if (IS_ENABLED(CONFIG_L2TP_DEBUGFS))
546f98be6c6SGuillaume Nault session->show = pppol2tp_show;
547f98be6c6SGuillaume Nault
548f98be6c6SGuillaume Nault ps = l2tp_session_priv(session);
549f98be6c6SGuillaume Nault mutex_init(&ps->sk_lock);
550f98be6c6SGuillaume Nault ps->owner = current->pid;
551f98be6c6SGuillaume Nault }
552f98be6c6SGuillaume Nault
553a408194aSGuillaume Nault struct l2tp_connect_info {
554a408194aSGuillaume Nault u8 version;
555a408194aSGuillaume Nault int fd;
556a408194aSGuillaume Nault u32 tunnel_id;
557a408194aSGuillaume Nault u32 peer_tunnel_id;
558a408194aSGuillaume Nault u32 session_id;
559a408194aSGuillaume Nault u32 peer_session_id;
560a408194aSGuillaume Nault };
561a408194aSGuillaume Nault
pppol2tp_sockaddr_get_info(const void * sa,int sa_len,struct l2tp_connect_info * info)562a408194aSGuillaume Nault static int pppol2tp_sockaddr_get_info(const void *sa, int sa_len,
563a408194aSGuillaume Nault struct l2tp_connect_info *info)
564a408194aSGuillaume Nault {
565a408194aSGuillaume Nault switch (sa_len) {
566a408194aSGuillaume Nault case sizeof(struct sockaddr_pppol2tp):
567a408194aSGuillaume Nault {
568a408194aSGuillaume Nault const struct sockaddr_pppol2tp *sa_v2in4 = sa;
569a408194aSGuillaume Nault
570a408194aSGuillaume Nault if (sa_v2in4->sa_protocol != PX_PROTO_OL2TP)
571a408194aSGuillaume Nault return -EINVAL;
572a408194aSGuillaume Nault
573a408194aSGuillaume Nault info->version = 2;
574a408194aSGuillaume Nault info->fd = sa_v2in4->pppol2tp.fd;
575a408194aSGuillaume Nault info->tunnel_id = sa_v2in4->pppol2tp.s_tunnel;
576a408194aSGuillaume Nault info->peer_tunnel_id = sa_v2in4->pppol2tp.d_tunnel;
577a408194aSGuillaume Nault info->session_id = sa_v2in4->pppol2tp.s_session;
578a408194aSGuillaume Nault info->peer_session_id = sa_v2in4->pppol2tp.d_session;
579a408194aSGuillaume Nault
580a408194aSGuillaume Nault break;
581a408194aSGuillaume Nault }
582a408194aSGuillaume Nault case sizeof(struct sockaddr_pppol2tpv3):
583a408194aSGuillaume Nault {
584a408194aSGuillaume Nault const struct sockaddr_pppol2tpv3 *sa_v3in4 = sa;
585a408194aSGuillaume Nault
586a408194aSGuillaume Nault if (sa_v3in4->sa_protocol != PX_PROTO_OL2TP)
587a408194aSGuillaume Nault return -EINVAL;
588a408194aSGuillaume Nault
589a408194aSGuillaume Nault info->version = 3;
590a408194aSGuillaume Nault info->fd = sa_v3in4->pppol2tp.fd;
591a408194aSGuillaume Nault info->tunnel_id = sa_v3in4->pppol2tp.s_tunnel;
592a408194aSGuillaume Nault info->peer_tunnel_id = sa_v3in4->pppol2tp.d_tunnel;
593a408194aSGuillaume Nault info->session_id = sa_v3in4->pppol2tp.s_session;
594a408194aSGuillaume Nault info->peer_session_id = sa_v3in4->pppol2tp.d_session;
595a408194aSGuillaume Nault
596a408194aSGuillaume Nault break;
597a408194aSGuillaume Nault }
598a408194aSGuillaume Nault case sizeof(struct sockaddr_pppol2tpin6):
599a408194aSGuillaume Nault {
600a408194aSGuillaume Nault const struct sockaddr_pppol2tpin6 *sa_v2in6 = sa;
601a408194aSGuillaume Nault
602a408194aSGuillaume Nault if (sa_v2in6->sa_protocol != PX_PROTO_OL2TP)
603a408194aSGuillaume Nault return -EINVAL;
604a408194aSGuillaume Nault
605a408194aSGuillaume Nault info->version = 2;
606a408194aSGuillaume Nault info->fd = sa_v2in6->pppol2tp.fd;
607a408194aSGuillaume Nault info->tunnel_id = sa_v2in6->pppol2tp.s_tunnel;
608a408194aSGuillaume Nault info->peer_tunnel_id = sa_v2in6->pppol2tp.d_tunnel;
609a408194aSGuillaume Nault info->session_id = sa_v2in6->pppol2tp.s_session;
610a408194aSGuillaume Nault info->peer_session_id = sa_v2in6->pppol2tp.d_session;
611a408194aSGuillaume Nault
612a408194aSGuillaume Nault break;
613a408194aSGuillaume Nault }
614a408194aSGuillaume Nault case sizeof(struct sockaddr_pppol2tpv3in6):
615a408194aSGuillaume Nault {
616a408194aSGuillaume Nault const struct sockaddr_pppol2tpv3in6 *sa_v3in6 = sa;
617a408194aSGuillaume Nault
618a408194aSGuillaume Nault if (sa_v3in6->sa_protocol != PX_PROTO_OL2TP)
619a408194aSGuillaume Nault return -EINVAL;
620a408194aSGuillaume Nault
621a408194aSGuillaume Nault info->version = 3;
622a408194aSGuillaume Nault info->fd = sa_v3in6->pppol2tp.fd;
623a408194aSGuillaume Nault info->tunnel_id = sa_v3in6->pppol2tp.s_tunnel;
624a408194aSGuillaume Nault info->peer_tunnel_id = sa_v3in6->pppol2tp.d_tunnel;
625a408194aSGuillaume Nault info->session_id = sa_v3in6->pppol2tp.s_session;
626a408194aSGuillaume Nault info->peer_session_id = sa_v3in6->pppol2tp.d_session;
627a408194aSGuillaume Nault
628a408194aSGuillaume Nault break;
629a408194aSGuillaume Nault }
630a408194aSGuillaume Nault default:
631a408194aSGuillaume Nault return -EINVAL;
632a408194aSGuillaume Nault }
633a408194aSGuillaume Nault
634a408194aSGuillaume Nault return 0;
635a408194aSGuillaume Nault }
636a408194aSGuillaume Nault
637789141b2SGuillaume Nault /* Rough estimation of the maximum payload size a tunnel can transmit without
638789141b2SGuillaume Nault * fragmenting at the lower IP layer. Assumes L2TPv2 with sequence
639789141b2SGuillaume Nault * numbers and no IP option. Not quite accurate, but the result is mostly
640789141b2SGuillaume Nault * unused anyway.
641789141b2SGuillaume Nault */
pppol2tp_tunnel_mtu(const struct l2tp_tunnel * tunnel)642789141b2SGuillaume Nault static int pppol2tp_tunnel_mtu(const struct l2tp_tunnel *tunnel)
643789141b2SGuillaume Nault {
644789141b2SGuillaume Nault int mtu;
645789141b2SGuillaume Nault
646789141b2SGuillaume Nault mtu = l2tp_tunnel_dst_mtu(tunnel);
647789141b2SGuillaume Nault if (mtu <= PPPOL2TP_HEADER_OVERHEAD)
648789141b2SGuillaume Nault return 1500 - PPPOL2TP_HEADER_OVERHEAD;
649789141b2SGuillaume Nault
650789141b2SGuillaume Nault return mtu - PPPOL2TP_HEADER_OVERHEAD;
651789141b2SGuillaume Nault }
652789141b2SGuillaume Nault
pppol2tp_tunnel_get(struct net * net,const struct l2tp_connect_info * info,bool * new_tunnel)6539ca5e7ecSShigeru Yoshida static struct l2tp_tunnel *pppol2tp_tunnel_get(struct net *net,
6549ca5e7ecSShigeru Yoshida const struct l2tp_connect_info *info,
6559ca5e7ecSShigeru Yoshida bool *new_tunnel)
6569ca5e7ecSShigeru Yoshida {
6579ca5e7ecSShigeru Yoshida struct l2tp_tunnel *tunnel;
6589ca5e7ecSShigeru Yoshida int error;
6599ca5e7ecSShigeru Yoshida
6609ca5e7ecSShigeru Yoshida *new_tunnel = false;
6619ca5e7ecSShigeru Yoshida
6629ca5e7ecSShigeru Yoshida tunnel = l2tp_tunnel_get(net, info->tunnel_id);
6639ca5e7ecSShigeru Yoshida
6649ca5e7ecSShigeru Yoshida /* Special case: create tunnel context if session_id and
6659ca5e7ecSShigeru Yoshida * peer_session_id is 0. Otherwise look up tunnel using supplied
6669ca5e7ecSShigeru Yoshida * tunnel id.
6679ca5e7ecSShigeru Yoshida */
6689ca5e7ecSShigeru Yoshida if (!info->session_id && !info->peer_session_id) {
6699ca5e7ecSShigeru Yoshida if (!tunnel) {
6709ca5e7ecSShigeru Yoshida struct l2tp_tunnel_cfg tcfg = {
6719ca5e7ecSShigeru Yoshida .encap = L2TP_ENCAPTYPE_UDP,
6729ca5e7ecSShigeru Yoshida };
6739ca5e7ecSShigeru Yoshida
6749ca5e7ecSShigeru Yoshida /* Prevent l2tp_tunnel_register() from trying to set up
6759ca5e7ecSShigeru Yoshida * a kernel socket.
6769ca5e7ecSShigeru Yoshida */
6779ca5e7ecSShigeru Yoshida if (info->fd < 0)
6789ca5e7ecSShigeru Yoshida return ERR_PTR(-EBADF);
6799ca5e7ecSShigeru Yoshida
6809ca5e7ecSShigeru Yoshida error = l2tp_tunnel_create(info->fd,
6819ca5e7ecSShigeru Yoshida info->version,
6829ca5e7ecSShigeru Yoshida info->tunnel_id,
6839ca5e7ecSShigeru Yoshida info->peer_tunnel_id, &tcfg,
6849ca5e7ecSShigeru Yoshida &tunnel);
6859ca5e7ecSShigeru Yoshida if (error < 0)
6869ca5e7ecSShigeru Yoshida return ERR_PTR(error);
6879ca5e7ecSShigeru Yoshida
6889ca5e7ecSShigeru Yoshida l2tp_tunnel_inc_refcount(tunnel);
6899ca5e7ecSShigeru Yoshida error = l2tp_tunnel_register(tunnel, net, &tcfg);
6909ca5e7ecSShigeru Yoshida if (error < 0) {
6919ca5e7ecSShigeru Yoshida kfree(tunnel);
6929ca5e7ecSShigeru Yoshida return ERR_PTR(error);
6939ca5e7ecSShigeru Yoshida }
6949ca5e7ecSShigeru Yoshida
6959ca5e7ecSShigeru Yoshida *new_tunnel = true;
6969ca5e7ecSShigeru Yoshida }
6979ca5e7ecSShigeru Yoshida } else {
6989ca5e7ecSShigeru Yoshida /* Error if we can't find the tunnel */
6999ca5e7ecSShigeru Yoshida if (!tunnel)
7009ca5e7ecSShigeru Yoshida return ERR_PTR(-ENOENT);
7019ca5e7ecSShigeru Yoshida
7029ca5e7ecSShigeru Yoshida /* Error if socket is not prepped */
7039ca5e7ecSShigeru Yoshida if (!tunnel->sock) {
7049ca5e7ecSShigeru Yoshida l2tp_tunnel_dec_refcount(tunnel);
7059ca5e7ecSShigeru Yoshida return ERR_PTR(-ENOENT);
7069ca5e7ecSShigeru Yoshida }
7079ca5e7ecSShigeru Yoshida }
7089ca5e7ecSShigeru Yoshida
7099ca5e7ecSShigeru Yoshida return tunnel;
7109ca5e7ecSShigeru Yoshida }
7119ca5e7ecSShigeru Yoshida
712fd558d18SJames Chapman /* connect() handler. Attach a PPPoX socket to a tunnel UDP socket
713fd558d18SJames Chapman */
pppol2tp_connect(struct socket * sock,struct sockaddr * uservaddr,int sockaddr_len,int flags)714fd558d18SJames Chapman static int pppol2tp_connect(struct socket *sock, struct sockaddr *uservaddr,
715fd558d18SJames Chapman int sockaddr_len, int flags)
716fd558d18SJames Chapman {
717fd558d18SJames Chapman struct sock *sk = sock->sk;
718fd558d18SJames Chapman struct pppox_sock *po = pppox_sk(sk);
719fd558d18SJames Chapman struct l2tp_session *session = NULL;
720a408194aSGuillaume Nault struct l2tp_connect_info info;
721fd558d18SJames Chapman struct l2tp_tunnel *tunnel;
722fd558d18SJames Chapman struct pppol2tp_session *ps;
723fd558d18SJames Chapman struct l2tp_session_cfg cfg = { 0, };
724dbdbc73bSGuillaume Nault bool drop_refcnt = false;
725bda06be2SGuillaume Nault bool new_session = false;
726bda06be2SGuillaume Nault bool new_tunnel = false;
727a408194aSGuillaume Nault int error;
728a408194aSGuillaume Nault
729a408194aSGuillaume Nault error = pppol2tp_sockaddr_get_info(uservaddr, sockaddr_len, &info);
730a408194aSGuillaume Nault if (error < 0)
731a408194aSGuillaume Nault return error;
732fd558d18SJames Chapman
7339ca5e7ecSShigeru Yoshida /* Don't bind if tunnel_id is 0 */
7349ca5e7ecSShigeru Yoshida if (!info.tunnel_id)
7359ca5e7ecSShigeru Yoshida return -EINVAL;
7369ca5e7ecSShigeru Yoshida
7379ca5e7ecSShigeru Yoshida tunnel = pppol2tp_tunnel_get(sock_net(sk), &info, &new_tunnel);
7389ca5e7ecSShigeru Yoshida if (IS_ERR(tunnel))
7399ca5e7ecSShigeru Yoshida return PTR_ERR(tunnel);
7409ca5e7ecSShigeru Yoshida
741fd558d18SJames Chapman lock_sock(sk);
742fd558d18SJames Chapman
743fd558d18SJames Chapman /* Check for already bound sockets */
744fd558d18SJames Chapman error = -EBUSY;
745fd558d18SJames Chapman if (sk->sk_state & PPPOX_CONNECTED)
746fd558d18SJames Chapman goto end;
747fd558d18SJames Chapman
748fd558d18SJames Chapman /* We don't supporting rebinding anyway */
749fd558d18SJames Chapman error = -EALREADY;
750fd558d18SJames Chapman if (sk->sk_user_data)
751fd558d18SJames Chapman goto end; /* socket is already attached */
752fd558d18SJames Chapman
753b79585f5SJames Chapman if (tunnel->peer_tunnel_id == 0)
754a408194aSGuillaume Nault tunnel->peer_tunnel_id = info.peer_tunnel_id;
755fd558d18SJames Chapman
75601e28b92SGuillaume Nault session = l2tp_tunnel_get_session(tunnel, info.session_id);
757dbdbc73bSGuillaume Nault if (session) {
758dbdbc73bSGuillaume Nault drop_refcnt = true;
7597ac6ab1fSGuillaume Nault
7607ac6ab1fSGuillaume Nault if (session->pwtype != L2TP_PWTYPE_PPP) {
7617ac6ab1fSGuillaume Nault error = -EPROTOTYPE;
7627ac6ab1fSGuillaume Nault goto end;
7637ac6ab1fSGuillaume Nault }
7647ac6ab1fSGuillaume Nault
765dbdbc73bSGuillaume Nault ps = l2tp_session_priv(session);
766fd558d18SJames Chapman
767dbdbc73bSGuillaume Nault /* Using a pre-existing session is fine as long as it hasn't
768dbdbc73bSGuillaume Nault * been connected yet.
769dbdbc73bSGuillaume Nault */
770ee40fb2eSGuillaume Nault mutex_lock(&ps->sk_lock);
771ee40fb2eSGuillaume Nault if (rcu_dereference_protected(ps->sk,
7723d609342SGuillaume Nault lockdep_is_held(&ps->sk_lock)) ||
7733d609342SGuillaume Nault ps->__sk) {
774ee40fb2eSGuillaume Nault mutex_unlock(&ps->sk_lock);
775dbdbc73bSGuillaume Nault error = -EEXIST;
776dbdbc73bSGuillaume Nault goto end;
777dbdbc73bSGuillaume Nault }
778309795f4SJames Chapman } else {
77990904ff5SGuillaume Nault cfg.pw_type = L2TP_PWTYPE_PPP;
780fd558d18SJames Chapman
781dbdbc73bSGuillaume Nault session = l2tp_session_create(sizeof(struct pppol2tp_session),
782a408194aSGuillaume Nault tunnel, info.session_id,
783a408194aSGuillaume Nault info.peer_session_id, &cfg);
784dbdbc73bSGuillaume Nault if (IS_ERR(session)) {
785dbdbc73bSGuillaume Nault error = PTR_ERR(session);
786309795f4SJames Chapman goto end;
787309795f4SJames Chapman }
7883953ae7bSGuillaume Nault
789f98be6c6SGuillaume Nault pppol2tp_session_init(session);
790ee40fb2eSGuillaume Nault ps = l2tp_session_priv(session);
7913953ae7bSGuillaume Nault l2tp_session_inc_refcount(session);
792ee40fb2eSGuillaume Nault
793ee40fb2eSGuillaume Nault mutex_lock(&ps->sk_lock);
7943953ae7bSGuillaume Nault error = l2tp_session_register(session, tunnel);
7953953ae7bSGuillaume Nault if (error < 0) {
796ee40fb2eSGuillaume Nault mutex_unlock(&ps->sk_lock);
7973953ae7bSGuillaume Nault kfree(session);
7983953ae7bSGuillaume Nault goto end;
7993953ae7bSGuillaume Nault }
8003953ae7bSGuillaume Nault drop_refcnt = true;
801bda06be2SGuillaume Nault new_session = true;
802dbdbc73bSGuillaume Nault }
803309795f4SJames Chapman
804fd558d18SJames Chapman /* Special case: if source & dest session_id == 0x0000, this
805fd558d18SJames Chapman * socket is being created to manage the tunnel. Just set up
806fd558d18SJames Chapman * the internal context for use by ioctl() and sockopt()
807fd558d18SJames Chapman * handlers.
808fd558d18SJames Chapman */
8096c0ec37bSTom Parkin if (session->session_id == 0 && session->peer_session_id == 0) {
810fd558d18SJames Chapman error = 0;
811fd558d18SJames Chapman goto out_no_ppp;
812fd558d18SJames Chapman }
813fd558d18SJames Chapman
814fd558d18SJames Chapman /* The only header we need to worry about is the L2TP
815fd558d18SJames Chapman * header. This size is different depending on whether
816fd558d18SJames Chapman * sequence numbers are enabled for the data channel.
817fd558d18SJames Chapman */
818fd558d18SJames Chapman po->chan.hdrlen = PPPOL2TP_L2TP_HDR_SIZE_NOSEQ;
819fd558d18SJames Chapman
820fd558d18SJames Chapman po->chan.private = sk;
821fd558d18SJames Chapman po->chan.ops = &pppol2tp_chan_ops;
822789141b2SGuillaume Nault po->chan.mtu = pppol2tp_tunnel_mtu(tunnel);
823fd558d18SJames Chapman
824fd558d18SJames Chapman error = ppp_register_net_channel(sock_net(sk), &po->chan);
825ee40fb2eSGuillaume Nault if (error) {
826ee40fb2eSGuillaume Nault mutex_unlock(&ps->sk_lock);
827fd558d18SJames Chapman goto end;
828ee40fb2eSGuillaume Nault }
829fd558d18SJames Chapman
830fd558d18SJames Chapman out_no_ppp:
831fd558d18SJames Chapman /* This is how we get the session context from the socket. */
832fd558d18SJames Chapman sk->sk_user_data = session;
833ee40fb2eSGuillaume Nault rcu_assign_pointer(ps->sk, sk);
834ee40fb2eSGuillaume Nault mutex_unlock(&ps->sk_lock);
835ee40fb2eSGuillaume Nault
836f98be6c6SGuillaume Nault /* Keep the reference we've grabbed on the session: sk doesn't expect
837f98be6c6SGuillaume Nault * the session to disappear. pppol2tp_session_destruct() is responsible
838f98be6c6SGuillaume Nault * for dropping it.
839f98be6c6SGuillaume Nault */
840f98be6c6SGuillaume Nault drop_refcnt = false;
841f98be6c6SGuillaume Nault
842fd558d18SJames Chapman sk->sk_state = PPPOX_CONNECTED;
843fd558d18SJames Chapman
844fd558d18SJames Chapman end:
845bda06be2SGuillaume Nault if (error) {
846bda06be2SGuillaume Nault if (new_session)
847bda06be2SGuillaume Nault l2tp_session_delete(session);
848bda06be2SGuillaume Nault if (new_tunnel)
849bda06be2SGuillaume Nault l2tp_tunnel_delete(tunnel);
850bda06be2SGuillaume Nault }
851dbdbc73bSGuillaume Nault if (drop_refcnt)
852dbdbc73bSGuillaume Nault l2tp_session_dec_refcount(session);
853f9e56bafSGuillaume Nault l2tp_tunnel_dec_refcount(tunnel);
854fd558d18SJames Chapman release_sock(sk);
855fd558d18SJames Chapman
856fd558d18SJames Chapman return error;
857fd558d18SJames Chapman }
858fd558d18SJames Chapman
859309795f4SJames Chapman #ifdef CONFIG_L2TP_V3
860309795f4SJames Chapman
861f026bc29SGuillaume Nault /* Called when creating sessions via the netlink interface. */
pppol2tp_session_create(struct net * net,struct l2tp_tunnel * tunnel,u32 session_id,u32 peer_session_id,struct l2tp_session_cfg * cfg)862f026bc29SGuillaume Nault static int pppol2tp_session_create(struct net *net, struct l2tp_tunnel *tunnel,
863f026bc29SGuillaume Nault u32 session_id, u32 peer_session_id,
864f026bc29SGuillaume Nault struct l2tp_session_cfg *cfg)
865309795f4SJames Chapman {
866309795f4SJames Chapman int error;
867309795f4SJames Chapman struct l2tp_session *session;
868309795f4SJames Chapman
869309795f4SJames Chapman /* Error if tunnel socket is not prepped */
870f026bc29SGuillaume Nault if (!tunnel->sock) {
871f026bc29SGuillaume Nault error = -ENOENT;
8723953ae7bSGuillaume Nault goto err;
873f026bc29SGuillaume Nault }
874309795f4SJames Chapman
875309795f4SJames Chapman /* Allocate and initialize a new session context. */
876309795f4SJames Chapman session = l2tp_session_create(sizeof(struct pppol2tp_session),
877309795f4SJames Chapman tunnel, session_id,
878309795f4SJames Chapman peer_session_id, cfg);
879dbdbc73bSGuillaume Nault if (IS_ERR(session)) {
880dbdbc73bSGuillaume Nault error = PTR_ERR(session);
8813953ae7bSGuillaume Nault goto err;
882dbdbc73bSGuillaume Nault }
883309795f4SJames Chapman
884f98be6c6SGuillaume Nault pppol2tp_session_init(session);
885309795f4SJames Chapman
8863953ae7bSGuillaume Nault error = l2tp_session_register(session, tunnel);
8873953ae7bSGuillaume Nault if (error < 0)
8883953ae7bSGuillaume Nault goto err_sess;
889309795f4SJames Chapman
8903953ae7bSGuillaume Nault return 0;
891309795f4SJames Chapman
8923953ae7bSGuillaume Nault err_sess:
8933953ae7bSGuillaume Nault kfree(session);
8943953ae7bSGuillaume Nault err:
895309795f4SJames Chapman return error;
896309795f4SJames Chapman }
897309795f4SJames Chapman
898309795f4SJames Chapman #endif /* CONFIG_L2TP_V3 */
899309795f4SJames Chapman
900fd558d18SJames Chapman /* getname() support.
901fd558d18SJames Chapman */
pppol2tp_getname(struct socket * sock,struct sockaddr * uaddr,int peer)902fd558d18SJames Chapman static int pppol2tp_getname(struct socket *sock, struct sockaddr *uaddr,
9039b2c45d4SDenys Vlasenko int peer)
904fd558d18SJames Chapman {
905e0d4435fSJames Chapman int len = 0;
906fd558d18SJames Chapman int error = 0;
907fd558d18SJames Chapman struct l2tp_session *session;
908fd558d18SJames Chapman struct l2tp_tunnel *tunnel;
909fd558d18SJames Chapman struct sock *sk = sock->sk;
910fd558d18SJames Chapman struct inet_sock *inet;
911fd558d18SJames Chapman struct pppol2tp_session *pls;
912fd558d18SJames Chapman
913fd558d18SJames Chapman error = -ENOTCONN;
9140febc7b3STom Parkin if (!sk)
915fd558d18SJames Chapman goto end;
91656cff471SGao Feng if (!(sk->sk_state & PPPOX_CONNECTED))
917fd558d18SJames Chapman goto end;
918fd558d18SJames Chapman
919fd558d18SJames Chapman error = -EBADF;
920fd558d18SJames Chapman session = pppol2tp_sock_to_session(sk);
9210febc7b3STom Parkin if (!session)
922fd558d18SJames Chapman goto end;
923fd558d18SJames Chapman
924fd558d18SJames Chapman pls = l2tp_session_priv(session);
9257198c77aSGuillaume Nault tunnel = session->tunnel;
926fd558d18SJames Chapman
927bbdb32cbSBenjamin LaHaise inet = inet_sk(tunnel->sock);
9286c0ec37bSTom Parkin if (tunnel->version == 2 && tunnel->sock->sk_family == AF_INET) {
929e0d4435fSJames Chapman struct sockaddr_pppol2tp sp;
930b71a61ccSTom Parkin
931e0d4435fSJames Chapman len = sizeof(sp);
932fd558d18SJames Chapman memset(&sp, 0, len);
933fd558d18SJames Chapman sp.sa_family = AF_PPPOX;
934fd558d18SJames Chapman sp.sa_protocol = PX_PROTO_OL2TP;
935fd558d18SJames Chapman sp.pppol2tp.fd = tunnel->fd;
936fd558d18SJames Chapman sp.pppol2tp.pid = pls->owner;
937fd558d18SJames Chapman sp.pppol2tp.s_tunnel = tunnel->tunnel_id;
938fd558d18SJames Chapman sp.pppol2tp.d_tunnel = tunnel->peer_tunnel_id;
939fd558d18SJames Chapman sp.pppol2tp.s_session = session->session_id;
940fd558d18SJames Chapman sp.pppol2tp.d_session = session->peer_session_id;
941fd558d18SJames Chapman sp.pppol2tp.addr.sin_family = AF_INET;
942fd558d18SJames Chapman sp.pppol2tp.addr.sin_port = inet->inet_dport;
943fd558d18SJames Chapman sp.pppol2tp.addr.sin_addr.s_addr = inet->inet_daddr;
944fd558d18SJames Chapman memcpy(uaddr, &sp, len);
945d2cf3361SBenjamin LaHaise #if IS_ENABLED(CONFIG_IPV6)
9466c0ec37bSTom Parkin } else if (tunnel->version == 2 && tunnel->sock->sk_family == AF_INET6) {
947d2cf3361SBenjamin LaHaise struct sockaddr_pppol2tpin6 sp;
948efe4208fSEric Dumazet
949d2cf3361SBenjamin LaHaise len = sizeof(sp);
950d2cf3361SBenjamin LaHaise memset(&sp, 0, len);
951d2cf3361SBenjamin LaHaise sp.sa_family = AF_PPPOX;
952d2cf3361SBenjamin LaHaise sp.sa_protocol = PX_PROTO_OL2TP;
953d2cf3361SBenjamin LaHaise sp.pppol2tp.fd = tunnel->fd;
954d2cf3361SBenjamin LaHaise sp.pppol2tp.pid = pls->owner;
955d2cf3361SBenjamin LaHaise sp.pppol2tp.s_tunnel = tunnel->tunnel_id;
956d2cf3361SBenjamin LaHaise sp.pppol2tp.d_tunnel = tunnel->peer_tunnel_id;
957d2cf3361SBenjamin LaHaise sp.pppol2tp.s_session = session->session_id;
958d2cf3361SBenjamin LaHaise sp.pppol2tp.d_session = session->peer_session_id;
959d2cf3361SBenjamin LaHaise sp.pppol2tp.addr.sin6_family = AF_INET6;
960d2cf3361SBenjamin LaHaise sp.pppol2tp.addr.sin6_port = inet->inet_dport;
961efe4208fSEric Dumazet memcpy(&sp.pppol2tp.addr.sin6_addr, &tunnel->sock->sk_v6_daddr,
962efe4208fSEric Dumazet sizeof(tunnel->sock->sk_v6_daddr));
963d2cf3361SBenjamin LaHaise memcpy(uaddr, &sp, len);
9646c0ec37bSTom Parkin } else if (tunnel->version == 3 && tunnel->sock->sk_family == AF_INET6) {
965d2cf3361SBenjamin LaHaise struct sockaddr_pppol2tpv3in6 sp;
966efe4208fSEric Dumazet
967d2cf3361SBenjamin LaHaise len = sizeof(sp);
968d2cf3361SBenjamin LaHaise memset(&sp, 0, len);
969d2cf3361SBenjamin LaHaise sp.sa_family = AF_PPPOX;
970d2cf3361SBenjamin LaHaise sp.sa_protocol = PX_PROTO_OL2TP;
971d2cf3361SBenjamin LaHaise sp.pppol2tp.fd = tunnel->fd;
972d2cf3361SBenjamin LaHaise sp.pppol2tp.pid = pls->owner;
973d2cf3361SBenjamin LaHaise sp.pppol2tp.s_tunnel = tunnel->tunnel_id;
974d2cf3361SBenjamin LaHaise sp.pppol2tp.d_tunnel = tunnel->peer_tunnel_id;
975d2cf3361SBenjamin LaHaise sp.pppol2tp.s_session = session->session_id;
976d2cf3361SBenjamin LaHaise sp.pppol2tp.d_session = session->peer_session_id;
977d2cf3361SBenjamin LaHaise sp.pppol2tp.addr.sin6_family = AF_INET6;
978d2cf3361SBenjamin LaHaise sp.pppol2tp.addr.sin6_port = inet->inet_dport;
979efe4208fSEric Dumazet memcpy(&sp.pppol2tp.addr.sin6_addr, &tunnel->sock->sk_v6_daddr,
980efe4208fSEric Dumazet sizeof(tunnel->sock->sk_v6_daddr));
981d2cf3361SBenjamin LaHaise memcpy(uaddr, &sp, len);
982d2cf3361SBenjamin LaHaise #endif
983e0d4435fSJames Chapman } else if (tunnel->version == 3) {
984e0d4435fSJames Chapman struct sockaddr_pppol2tpv3 sp;
985b71a61ccSTom Parkin
986e0d4435fSJames Chapman len = sizeof(sp);
987e0d4435fSJames Chapman memset(&sp, 0, len);
988e0d4435fSJames Chapman sp.sa_family = AF_PPPOX;
989e0d4435fSJames Chapman sp.sa_protocol = PX_PROTO_OL2TP;
990e0d4435fSJames Chapman sp.pppol2tp.fd = tunnel->fd;
991e0d4435fSJames Chapman sp.pppol2tp.pid = pls->owner;
992e0d4435fSJames Chapman sp.pppol2tp.s_tunnel = tunnel->tunnel_id;
993e0d4435fSJames Chapman sp.pppol2tp.d_tunnel = tunnel->peer_tunnel_id;
994e0d4435fSJames Chapman sp.pppol2tp.s_session = session->session_id;
995e0d4435fSJames Chapman sp.pppol2tp.d_session = session->peer_session_id;
996e0d4435fSJames Chapman sp.pppol2tp.addr.sin_family = AF_INET;
997e0d4435fSJames Chapman sp.pppol2tp.addr.sin_port = inet->inet_dport;
998e0d4435fSJames Chapman sp.pppol2tp.addr.sin_addr.s_addr = inet->inet_daddr;
999e0d4435fSJames Chapman memcpy(uaddr, &sp, len);
1000e0d4435fSJames Chapman }
1001fd558d18SJames Chapman
10029b2c45d4SDenys Vlasenko error = len;
1003fd558d18SJames Chapman
1004fd558d18SJames Chapman sock_put(sk);
1005fd558d18SJames Chapman end:
1006fd558d18SJames Chapman return error;
1007fd558d18SJames Chapman }
1008fd558d18SJames Chapman
1009fd558d18SJames Chapman /****************************************************************************
1010fd558d18SJames Chapman * ioctl() handlers.
1011fd558d18SJames Chapman *
1012fd558d18SJames Chapman * The PPPoX socket is created for L2TP sessions: tunnels have their own UDP
1013fd558d18SJames Chapman * sockets. However, in order to control kernel tunnel features, we allow
1014fd558d18SJames Chapman * userspace to create a special "tunnel" PPPoX socket which is used for
1015fd558d18SJames Chapman * control only. Tunnel PPPoX sockets have session_id == 0 and simply allow
1016fd558d18SJames Chapman * the user application to issue L2TP setsockopt(), getsockopt() and ioctl()
1017fd558d18SJames Chapman * calls.
1018fd558d18SJames Chapman ****************************************************************************/
1019fd558d18SJames Chapman
pppol2tp_copy_stats(struct pppol2tp_ioc_stats * dest,const struct l2tp_stats * stats)1020fd558d18SJames Chapman static void pppol2tp_copy_stats(struct pppol2tp_ioc_stats *dest,
10217390ed8aSGuillaume Nault const struct l2tp_stats *stats)
1022fd558d18SJames Chapman {
10237390ed8aSGuillaume Nault memset(dest, 0, sizeof(*dest));
10247390ed8aSGuillaume Nault
10257b7c0719STom Parkin dest->tx_packets = atomic_long_read(&stats->tx_packets);
10267b7c0719STom Parkin dest->tx_bytes = atomic_long_read(&stats->tx_bytes);
10277b7c0719STom Parkin dest->tx_errors = atomic_long_read(&stats->tx_errors);
10287b7c0719STom Parkin dest->rx_packets = atomic_long_read(&stats->rx_packets);
10297b7c0719STom Parkin dest->rx_bytes = atomic_long_read(&stats->rx_bytes);
10307b7c0719STom Parkin dest->rx_seq_discards = atomic_long_read(&stats->rx_seq_discards);
10317b7c0719STom Parkin dest->rx_oos_packets = atomic_long_read(&stats->rx_oos_packets);
10327b7c0719STom Parkin dest->rx_errors = atomic_long_read(&stats->rx_errors);
1033fd558d18SJames Chapman }
1034fd558d18SJames Chapman
pppol2tp_tunnel_copy_stats(struct pppol2tp_ioc_stats * stats,struct l2tp_tunnel * tunnel)1035528534f0SGuillaume Nault static int pppol2tp_tunnel_copy_stats(struct pppol2tp_ioc_stats *stats,
1036528534f0SGuillaume Nault struct l2tp_tunnel *tunnel)
1037528534f0SGuillaume Nault {
1038528534f0SGuillaume Nault struct l2tp_session *session;
1039528534f0SGuillaume Nault
1040528534f0SGuillaume Nault if (!stats->session_id) {
1041528534f0SGuillaume Nault pppol2tp_copy_stats(stats, &tunnel->stats);
1042528534f0SGuillaume Nault return 0;
1043528534f0SGuillaume Nault }
1044528534f0SGuillaume Nault
1045528534f0SGuillaume Nault /* If session_id is set, search the corresponding session in the
1046528534f0SGuillaume Nault * context of this tunnel and record the session's statistics.
1047528534f0SGuillaume Nault */
1048528534f0SGuillaume Nault session = l2tp_tunnel_get_session(tunnel, stats->session_id);
1049528534f0SGuillaume Nault if (!session)
1050528534f0SGuillaume Nault return -EBADR;
1051528534f0SGuillaume Nault
1052528534f0SGuillaume Nault if (session->pwtype != L2TP_PWTYPE_PPP) {
1053528534f0SGuillaume Nault l2tp_session_dec_refcount(session);
1054528534f0SGuillaume Nault return -EBADR;
1055528534f0SGuillaume Nault }
1056528534f0SGuillaume Nault
1057528534f0SGuillaume Nault pppol2tp_copy_stats(stats, &session->stats);
1058528534f0SGuillaume Nault l2tp_session_dec_refcount(session);
1059528534f0SGuillaume Nault
1060528534f0SGuillaume Nault return 0;
1061528534f0SGuillaume Nault }
1062528534f0SGuillaume Nault
pppol2tp_ioctl(struct socket * sock,unsigned int cmd,unsigned long arg)1063fd558d18SJames Chapman static int pppol2tp_ioctl(struct socket *sock, unsigned int cmd,
1064fd558d18SJames Chapman unsigned long arg)
1065fd558d18SJames Chapman {
1066528534f0SGuillaume Nault struct pppol2tp_ioc_stats stats;
1067fd558d18SJames Chapman struct l2tp_session *session;
1068fd558d18SJames Chapman
106979e6760eSGuillaume Nault switch (cmd) {
107079e6760eSGuillaume Nault case PPPIOCGMRU:
107179e6760eSGuillaume Nault case PPPIOCGFLAGS:
1072bdd0292fSGuillaume Nault session = sock->sk->sk_user_data;
1073bdd0292fSGuillaume Nault if (!session)
1074bdd0292fSGuillaume Nault return -ENOTCONN;
1075fd558d18SJames Chapman
107645faeff1STom Parkin if (WARN_ON(session->magic != L2TP_SESSION_MAGIC))
107745faeff1STom Parkin return -EBADF;
107845faeff1STom Parkin
107979e6760eSGuillaume Nault /* Not defined for tunnels */
108079e6760eSGuillaume Nault if (!session->session_id && !session->peer_session_id)
108179e6760eSGuillaume Nault return -ENOSYS;
1082bdd0292fSGuillaume Nault
108379e6760eSGuillaume Nault if (put_user(0, (int __user *)arg))
108479e6760eSGuillaume Nault return -EFAULT;
108579e6760eSGuillaume Nault break;
108679e6760eSGuillaume Nault
108779e6760eSGuillaume Nault case PPPIOCSMRU:
108879e6760eSGuillaume Nault case PPPIOCSFLAGS:
108979e6760eSGuillaume Nault session = sock->sk->sk_user_data;
109079e6760eSGuillaume Nault if (!session)
109179e6760eSGuillaume Nault return -ENOTCONN;
109279e6760eSGuillaume Nault
109345faeff1STom Parkin if (WARN_ON(session->magic != L2TP_SESSION_MAGIC))
109445faeff1STom Parkin return -EBADF;
109545faeff1STom Parkin
109679e6760eSGuillaume Nault /* Not defined for tunnels */
109779e6760eSGuillaume Nault if (!session->session_id && !session->peer_session_id)
109879e6760eSGuillaume Nault return -ENOSYS;
109979e6760eSGuillaume Nault
1100503c0188SJakub Kicinski if (!access_ok((int __user *)arg, sizeof(int)))
110179e6760eSGuillaume Nault return -EFAULT;
110279e6760eSGuillaume Nault break;
110379e6760eSGuillaume Nault
110479e6760eSGuillaume Nault case PPPIOCGL2TPSTATS:
110579e6760eSGuillaume Nault session = sock->sk->sk_user_data;
110679e6760eSGuillaume Nault if (!session)
110779e6760eSGuillaume Nault return -ENOTCONN;
110879e6760eSGuillaume Nault
110945faeff1STom Parkin if (WARN_ON(session->magic != L2TP_SESSION_MAGIC))
111045faeff1STom Parkin return -EBADF;
111145faeff1STom Parkin
111279e6760eSGuillaume Nault /* Session 0 represents the parent tunnel */
1113528534f0SGuillaume Nault if (!session->session_id && !session->peer_session_id) {
1114528534f0SGuillaume Nault u32 session_id;
1115528534f0SGuillaume Nault int err;
1116528534f0SGuillaume Nault
1117528534f0SGuillaume Nault if (copy_from_user(&stats, (void __user *)arg,
1118528534f0SGuillaume Nault sizeof(stats)))
1119528534f0SGuillaume Nault return -EFAULT;
1120528534f0SGuillaume Nault
1121528534f0SGuillaume Nault session_id = stats.session_id;
1122528534f0SGuillaume Nault err = pppol2tp_tunnel_copy_stats(&stats,
1123528534f0SGuillaume Nault session->tunnel);
1124528534f0SGuillaume Nault if (err < 0)
1125528534f0SGuillaume Nault return err;
1126528534f0SGuillaume Nault
1127528534f0SGuillaume Nault stats.session_id = session_id;
1128528534f0SGuillaume Nault } else {
1129b0e29063SGuillaume Nault pppol2tp_copy_stats(&stats, &session->stats);
1130b0e29063SGuillaume Nault stats.session_id = session->session_id;
1131528534f0SGuillaume Nault }
1132528534f0SGuillaume Nault stats.tunnel_id = session->tunnel->tunnel_id;
1133528534f0SGuillaume Nault stats.using_ipsec = l2tp_tunnel_uses_xfrm(session->tunnel);
1134528534f0SGuillaume Nault
1135528534f0SGuillaume Nault if (copy_to_user((void __user *)arg, &stats, sizeof(stats)))
1136528534f0SGuillaume Nault return -EFAULT;
113779e6760eSGuillaume Nault break;
113879e6760eSGuillaume Nault
113979e6760eSGuillaume Nault default:
11404f5f85e9SGuillaume Nault return -ENOIOCTLCMD;
1141fd558d18SJames Chapman }
1142fd558d18SJames Chapman
114379e6760eSGuillaume Nault return 0;
1144fd558d18SJames Chapman }
1145fd558d18SJames Chapman
1146fd558d18SJames Chapman /*****************************************************************************
1147fd558d18SJames Chapman * setsockopt() / getsockopt() support.
1148fd558d18SJames Chapman *
1149fd558d18SJames Chapman * The PPPoX socket is created for L2TP sessions: tunnels have their own UDP
1150fd558d18SJames Chapman * sockets. In order to control kernel tunnel features, we allow userspace to
1151fd558d18SJames Chapman * create a special "tunnel" PPPoX socket which is used for control only.
1152fd558d18SJames Chapman * Tunnel PPPoX sockets have session_id == 0 and simply allow the user
1153fd558d18SJames Chapman * application to issue L2TP setsockopt(), getsockopt() and ioctl() calls.
1154fd558d18SJames Chapman *****************************************************************************/
1155fd558d18SJames Chapman
1156fd558d18SJames Chapman /* Tunnel setsockopt() helper.
1157fd558d18SJames Chapman */
pppol2tp_tunnel_setsockopt(struct sock * sk,struct l2tp_tunnel * tunnel,int optname,int val)1158fd558d18SJames Chapman static int pppol2tp_tunnel_setsockopt(struct sock *sk,
1159fd558d18SJames Chapman struct l2tp_tunnel *tunnel,
1160fd558d18SJames Chapman int optname, int val)
1161fd558d18SJames Chapman {
1162fd558d18SJames Chapman int err = 0;
1163fd558d18SJames Chapman
1164fd558d18SJames Chapman switch (optname) {
1165fd558d18SJames Chapman case PPPOL2TP_SO_DEBUG:
1166eee049c0STom Parkin /* Tunnel debug flags option is deprecated */
1167fd558d18SJames Chapman break;
1168fd558d18SJames Chapman
1169fd558d18SJames Chapman default:
1170fd558d18SJames Chapman err = -ENOPROTOOPT;
1171fd558d18SJames Chapman break;
1172fd558d18SJames Chapman }
1173fd558d18SJames Chapman
1174fd558d18SJames Chapman return err;
1175fd558d18SJames Chapman }
1176fd558d18SJames Chapman
1177fd558d18SJames Chapman /* Session setsockopt helper.
1178fd558d18SJames Chapman */
pppol2tp_session_setsockopt(struct sock * sk,struct l2tp_session * session,int optname,int val)1179fd558d18SJames Chapman static int pppol2tp_session_setsockopt(struct sock *sk,
1180fd558d18SJames Chapman struct l2tp_session *session,
1181fd558d18SJames Chapman int optname, int val)
1182fd558d18SJames Chapman {
1183fd558d18SJames Chapman int err = 0;
1184fd558d18SJames Chapman
1185fd558d18SJames Chapman switch (optname) {
1186fd558d18SJames Chapman case PPPOL2TP_SO_RECVSEQ:
11876c0ec37bSTom Parkin if (val != 0 && val != 1) {
1188fd558d18SJames Chapman err = -EINVAL;
1189fd558d18SJames Chapman break;
1190fd558d18SJames Chapman }
11913f9b9770SAsbjørn Sloth Tønnesen session->recv_seq = !!val;
1192fd558d18SJames Chapman break;
1193fd558d18SJames Chapman
1194fd558d18SJames Chapman case PPPOL2TP_SO_SENDSEQ:
11956c0ec37bSTom Parkin if (val != 0 && val != 1) {
1196fd558d18SJames Chapman err = -EINVAL;
1197fd558d18SJames Chapman break;
1198fd558d18SJames Chapman }
11993f9b9770SAsbjørn Sloth Tønnesen session->send_seq = !!val;
1200fd558d18SJames Chapman {
1201ee40fb2eSGuillaume Nault struct pppox_sock *po = pppox_sk(sk);
1202ee40fb2eSGuillaume Nault
1203fd558d18SJames Chapman po->chan.hdrlen = val ? PPPOL2TP_L2TP_HDR_SIZE_SEQ :
1204fd558d18SJames Chapman PPPOL2TP_L2TP_HDR_SIZE_NOSEQ;
1205fd558d18SJames Chapman }
1206bb5016eaSGuillaume Nault l2tp_session_set_header_len(session, session->tunnel->version);
1207fd558d18SJames Chapman break;
1208fd558d18SJames Chapman
1209fd558d18SJames Chapman case PPPOL2TP_SO_LNSMODE:
12106c0ec37bSTom Parkin if (val != 0 && val != 1) {
1211fd558d18SJames Chapman err = -EINVAL;
1212fd558d18SJames Chapman break;
1213fd558d18SJames Chapman }
12143f9b9770SAsbjørn Sloth Tønnesen session->lns_mode = !!val;
1215fd558d18SJames Chapman break;
1216fd558d18SJames Chapman
1217fd558d18SJames Chapman case PPPOL2TP_SO_DEBUG:
1218eee049c0STom Parkin /* Session debug flags option is deprecated */
1219fd558d18SJames Chapman break;
1220fd558d18SJames Chapman
1221fd558d18SJames Chapman case PPPOL2TP_SO_REORDERTO:
1222fd558d18SJames Chapman session->reorder_timeout = msecs_to_jiffies(val);
1223fd558d18SJames Chapman break;
1224fd558d18SJames Chapman
1225fd558d18SJames Chapman default:
1226fd558d18SJames Chapman err = -ENOPROTOOPT;
1227fd558d18SJames Chapman break;
1228fd558d18SJames Chapman }
1229fd558d18SJames Chapman
1230fd558d18SJames Chapman return err;
1231fd558d18SJames Chapman }
1232fd558d18SJames Chapman
1233fd558d18SJames Chapman /* Main setsockopt() entry point.
1234fd558d18SJames Chapman * Does API checks, then calls either the tunnel or session setsockopt
1235fd558d18SJames Chapman * handler, according to whether the PPPoL2TP socket is a for a regular
1236fd558d18SJames Chapman * session or the special tunnel type.
1237fd558d18SJames Chapman */
pppol2tp_setsockopt(struct socket * sock,int level,int optname,sockptr_t optval,unsigned int optlen)1238fd558d18SJames Chapman static int pppol2tp_setsockopt(struct socket *sock, int level, int optname,
1239a7b75c5aSChristoph Hellwig sockptr_t optval, unsigned int optlen)
1240fd558d18SJames Chapman {
1241fd558d18SJames Chapman struct sock *sk = sock->sk;
1242fd558d18SJames Chapman struct l2tp_session *session;
1243fd558d18SJames Chapman struct l2tp_tunnel *tunnel;
1244fd558d18SJames Chapman int val;
1245fd558d18SJames Chapman int err;
1246fd558d18SJames Chapman
1247fd558d18SJames Chapman if (level != SOL_PPPOL2TP)
12483cf521f7SSasha Levin return -EINVAL;
1249fd558d18SJames Chapman
1250fd558d18SJames Chapman if (optlen < sizeof(int))
1251fd558d18SJames Chapman return -EINVAL;
1252fd558d18SJames Chapman
1253a7b75c5aSChristoph Hellwig if (copy_from_sockptr(&val, optval, sizeof(int)))
1254fd558d18SJames Chapman return -EFAULT;
1255fd558d18SJames Chapman
1256fd558d18SJames Chapman err = -ENOTCONN;
12570febc7b3STom Parkin if (!sk->sk_user_data)
1258fd558d18SJames Chapman goto end;
1259fd558d18SJames Chapman
1260fd558d18SJames Chapman /* Get session context from the socket */
1261fd558d18SJames Chapman err = -EBADF;
1262fd558d18SJames Chapman session = pppol2tp_sock_to_session(sk);
12630febc7b3STom Parkin if (!session)
1264fd558d18SJames Chapman goto end;
1265fd558d18SJames Chapman
1266fd558d18SJames Chapman /* Special case: if session_id == 0x0000, treat as operation on tunnel
1267fd558d18SJames Chapman */
12686c0ec37bSTom Parkin if (session->session_id == 0 && session->peer_session_id == 0) {
12697198c77aSGuillaume Nault tunnel = session->tunnel;
1270fd558d18SJames Chapman err = pppol2tp_tunnel_setsockopt(sk, tunnel, optname, val);
12717198c77aSGuillaume Nault } else {
1272fd558d18SJames Chapman err = pppol2tp_session_setsockopt(sk, session, optname, val);
12737198c77aSGuillaume Nault }
1274fd558d18SJames Chapman
1275fd558d18SJames Chapman sock_put(sk);
1276fd558d18SJames Chapman end:
1277fd558d18SJames Chapman return err;
1278fd558d18SJames Chapman }
1279fd558d18SJames Chapman
1280fd558d18SJames Chapman /* Tunnel getsockopt helper. Called with sock locked.
1281fd558d18SJames Chapman */
pppol2tp_tunnel_getsockopt(struct sock * sk,struct l2tp_tunnel * tunnel,int optname,int * val)1282fd558d18SJames Chapman static int pppol2tp_tunnel_getsockopt(struct sock *sk,
1283fd558d18SJames Chapman struct l2tp_tunnel *tunnel,
1284fd558d18SJames Chapman int optname, int *val)
1285fd558d18SJames Chapman {
1286fd558d18SJames Chapman int err = 0;
1287fd558d18SJames Chapman
1288fd558d18SJames Chapman switch (optname) {
1289fd558d18SJames Chapman case PPPOL2TP_SO_DEBUG:
1290eee049c0STom Parkin /* Tunnel debug flags option is deprecated */
1291eee049c0STom Parkin *val = 0;
1292fd558d18SJames Chapman break;
1293fd558d18SJames Chapman
1294fd558d18SJames Chapman default:
1295fd558d18SJames Chapman err = -ENOPROTOOPT;
1296fd558d18SJames Chapman break;
1297fd558d18SJames Chapman }
1298fd558d18SJames Chapman
1299fd558d18SJames Chapman return err;
1300fd558d18SJames Chapman }
1301fd558d18SJames Chapman
1302fd558d18SJames Chapman /* Session getsockopt helper. Called with sock locked.
1303fd558d18SJames Chapman */
pppol2tp_session_getsockopt(struct sock * sk,struct l2tp_session * session,int optname,int * val)1304fd558d18SJames Chapman static int pppol2tp_session_getsockopt(struct sock *sk,
1305fd558d18SJames Chapman struct l2tp_session *session,
1306fd558d18SJames Chapman int optname, int *val)
1307fd558d18SJames Chapman {
1308fd558d18SJames Chapman int err = 0;
1309fd558d18SJames Chapman
1310fd558d18SJames Chapman switch (optname) {
1311fd558d18SJames Chapman case PPPOL2TP_SO_RECVSEQ:
1312fd558d18SJames Chapman *val = session->recv_seq;
1313fd558d18SJames Chapman break;
1314fd558d18SJames Chapman
1315fd558d18SJames Chapman case PPPOL2TP_SO_SENDSEQ:
1316fd558d18SJames Chapman *val = session->send_seq;
1317fd558d18SJames Chapman break;
1318fd558d18SJames Chapman
1319fd558d18SJames Chapman case PPPOL2TP_SO_LNSMODE:
1320fd558d18SJames Chapman *val = session->lns_mode;
1321fd558d18SJames Chapman break;
1322fd558d18SJames Chapman
1323fd558d18SJames Chapman case PPPOL2TP_SO_DEBUG:
1324eee049c0STom Parkin /* Session debug flags option is deprecated */
1325eee049c0STom Parkin *val = 0;
1326fd558d18SJames Chapman break;
1327fd558d18SJames Chapman
1328fd558d18SJames Chapman case PPPOL2TP_SO_REORDERTO:
1329fd558d18SJames Chapman *val = (int)jiffies_to_msecs(session->reorder_timeout);
1330fd558d18SJames Chapman break;
1331fd558d18SJames Chapman
1332fd558d18SJames Chapman default:
1333fd558d18SJames Chapman err = -ENOPROTOOPT;
1334fd558d18SJames Chapman }
1335fd558d18SJames Chapman
1336fd558d18SJames Chapman return err;
1337fd558d18SJames Chapman }
1338fd558d18SJames Chapman
1339fd558d18SJames Chapman /* Main getsockopt() entry point.
1340fd558d18SJames Chapman * Does API checks, then calls either the tunnel or session getsockopt
1341fd558d18SJames Chapman * handler, according to whether the PPPoX socket is a for a regular session
1342fd558d18SJames Chapman * or the special tunnel type.
1343fd558d18SJames Chapman */
pppol2tp_getsockopt(struct socket * sock,int level,int optname,char __user * optval,int __user * optlen)1344e3192690SJoe Perches static int pppol2tp_getsockopt(struct socket *sock, int level, int optname,
1345e3192690SJoe Perches char __user *optval, int __user *optlen)
1346fd558d18SJames Chapman {
1347fd558d18SJames Chapman struct sock *sk = sock->sk;
1348fd558d18SJames Chapman struct l2tp_session *session;
1349fd558d18SJames Chapman struct l2tp_tunnel *tunnel;
1350fd558d18SJames Chapman int val, len;
1351fd558d18SJames Chapman int err;
1352fd558d18SJames Chapman
1353fd558d18SJames Chapman if (level != SOL_PPPOL2TP)
13543cf521f7SSasha Levin return -EINVAL;
1355fd558d18SJames Chapman
1356e3192690SJoe Perches if (get_user(len, optlen))
1357fd558d18SJames Chapman return -EFAULT;
1358fd558d18SJames Chapman
1359fd558d18SJames Chapman if (len < 0)
1360fd558d18SJames Chapman return -EINVAL;
1361fd558d18SJames Chapman
1362*4865e9fbSGavrilov Ilia len = min_t(unsigned int, len, sizeof(int));
1363*4865e9fbSGavrilov Ilia
1364fd558d18SJames Chapman err = -ENOTCONN;
13650febc7b3STom Parkin if (!sk->sk_user_data)
1366fd558d18SJames Chapman goto end;
1367fd558d18SJames Chapman
1368fd558d18SJames Chapman /* Get the session context */
1369fd558d18SJames Chapman err = -EBADF;
1370fd558d18SJames Chapman session = pppol2tp_sock_to_session(sk);
13710febc7b3STom Parkin if (!session)
1372fd558d18SJames Chapman goto end;
1373fd558d18SJames Chapman
1374fd558d18SJames Chapman /* Special case: if session_id == 0x0000, treat as operation on tunnel */
13756c0ec37bSTom Parkin if (session->session_id == 0 && session->peer_session_id == 0) {
13767198c77aSGuillaume Nault tunnel = session->tunnel;
1377fd558d18SJames Chapman err = pppol2tp_tunnel_getsockopt(sk, tunnel, optname, &val);
1378321a52a3SGuillaume Nault if (err)
1379321a52a3SGuillaume Nault goto end_put_sess;
1380321a52a3SGuillaume Nault } else {
1381fd558d18SJames Chapman err = pppol2tp_session_getsockopt(sk, session, optname, &val);
1382321a52a3SGuillaume Nault if (err)
1383321a52a3SGuillaume Nault goto end_put_sess;
1384321a52a3SGuillaume Nault }
1385fd558d18SJames Chapman
1386fd558d18SJames Chapman err = -EFAULT;
1387e3192690SJoe Perches if (put_user(len, optlen))
1388fd558d18SJames Chapman goto end_put_sess;
1389fd558d18SJames Chapman
1390fd558d18SJames Chapman if (copy_to_user((void __user *)optval, &val, len))
1391fd558d18SJames Chapman goto end_put_sess;
1392fd558d18SJames Chapman
1393fd558d18SJames Chapman err = 0;
1394fd558d18SJames Chapman
1395fd558d18SJames Chapman end_put_sess:
1396fd558d18SJames Chapman sock_put(sk);
1397fd558d18SJames Chapman end:
1398fd558d18SJames Chapman return err;
1399fd558d18SJames Chapman }
1400fd558d18SJames Chapman
1401fd558d18SJames Chapman /*****************************************************************************
1402fd558d18SJames Chapman * /proc filesystem for debug
1403f7faffa3SJames Chapman * Since the original pppol2tp driver provided /proc/net/pppol2tp for
1404f7faffa3SJames Chapman * L2TPv2, we dump only L2TPv2 tunnels and sessions here.
1405fd558d18SJames Chapman *****************************************************************************/
1406fd558d18SJames Chapman
1407fd558d18SJames Chapman static unsigned int pppol2tp_net_id;
1408fd558d18SJames Chapman
1409fd558d18SJames Chapman #ifdef CONFIG_PROC_FS
1410fd558d18SJames Chapman
1411fd558d18SJames Chapman struct pppol2tp_seq_data {
1412fd558d18SJames Chapman struct seq_net_private p;
1413fd558d18SJames Chapman int tunnel_idx; /* current tunnel */
1414fd558d18SJames Chapman int session_idx; /* index of session within current tunnel */
1415fd558d18SJames Chapman struct l2tp_tunnel *tunnel;
1416fd558d18SJames Chapman struct l2tp_session *session; /* NULL means get next tunnel */
1417fd558d18SJames Chapman };
1418fd558d18SJames Chapman
pppol2tp_next_tunnel(struct net * net,struct pppol2tp_seq_data * pd)1419fd558d18SJames Chapman static void pppol2tp_next_tunnel(struct net *net, struct pppol2tp_seq_data *pd)
1420fd558d18SJames Chapman {
14210e0c3feeSGuillaume Nault /* Drop reference taken during previous invocation */
14220e0c3feeSGuillaume Nault if (pd->tunnel)
14230e0c3feeSGuillaume Nault l2tp_tunnel_dec_refcount(pd->tunnel);
14240e0c3feeSGuillaume Nault
1425f7faffa3SJames Chapman for (;;) {
14260e0c3feeSGuillaume Nault pd->tunnel = l2tp_tunnel_get_nth(net, pd->tunnel_idx);
1427fd558d18SJames Chapman pd->tunnel_idx++;
1428f7faffa3SJames Chapman
14290e0c3feeSGuillaume Nault /* Only accept L2TPv2 tunnels */
14300e0c3feeSGuillaume Nault if (!pd->tunnel || pd->tunnel->version == 2)
14310e0c3feeSGuillaume Nault return;
1432f7faffa3SJames Chapman
14330e0c3feeSGuillaume Nault l2tp_tunnel_dec_refcount(pd->tunnel);
1434f7faffa3SJames Chapman }
1435fd558d18SJames Chapman }
1436fd558d18SJames Chapman
pppol2tp_next_session(struct net * net,struct pppol2tp_seq_data * pd)1437fd558d18SJames Chapman static void pppol2tp_next_session(struct net *net, struct pppol2tp_seq_data *pd)
1438fd558d18SJames Chapman {
143983494407SGuillaume Nault /* Drop reference taken during previous invocation */
144083494407SGuillaume Nault if (pd->session)
144183494407SGuillaume Nault l2tp_session_dec_refcount(pd->session);
144283494407SGuillaume Nault
1443a4346210SGuillaume Nault pd->session = l2tp_session_get_nth(pd->tunnel, pd->session_idx);
1444fd558d18SJames Chapman pd->session_idx++;
1445f7faffa3SJames Chapman
14460febc7b3STom Parkin if (!pd->session) {
1447fd558d18SJames Chapman pd->session_idx = 0;
1448fd558d18SJames Chapman pppol2tp_next_tunnel(net, pd);
1449fd558d18SJames Chapman }
1450fd558d18SJames Chapman }
1451fd558d18SJames Chapman
pppol2tp_seq_start(struct seq_file * m,loff_t * offs)1452fd558d18SJames Chapman static void *pppol2tp_seq_start(struct seq_file *m, loff_t *offs)
1453fd558d18SJames Chapman {
1454fd558d18SJames Chapman struct pppol2tp_seq_data *pd = SEQ_START_TOKEN;
1455fd558d18SJames Chapman loff_t pos = *offs;
1456fd558d18SJames Chapman struct net *net;
1457fd558d18SJames Chapman
1458fd558d18SJames Chapman if (!pos)
1459fd558d18SJames Chapman goto out;
1460fd558d18SJames Chapman
1461ebb4f5e6STom Parkin if (WARN_ON(!m->private)) {
1462ebb4f5e6STom Parkin pd = NULL;
1463ebb4f5e6STom Parkin goto out;
1464ebb4f5e6STom Parkin }
1465ebb4f5e6STom Parkin
1466fd558d18SJames Chapman pd = m->private;
1467fd558d18SJames Chapman net = seq_file_net(m);
1468fd558d18SJames Chapman
14690febc7b3STom Parkin if (!pd->tunnel)
1470fd558d18SJames Chapman pppol2tp_next_tunnel(net, pd);
1471fd558d18SJames Chapman else
1472fd558d18SJames Chapman pppol2tp_next_session(net, pd);
1473fd558d18SJames Chapman
1474fd558d18SJames Chapman /* NULL tunnel and session indicates end of list */
14750febc7b3STom Parkin if (!pd->tunnel && !pd->session)
1476fd558d18SJames Chapman pd = NULL;
1477fd558d18SJames Chapman
1478fd558d18SJames Chapman out:
1479fd558d18SJames Chapman return pd;
1480fd558d18SJames Chapman }
1481fd558d18SJames Chapman
pppol2tp_seq_next(struct seq_file * m,void * v,loff_t * pos)1482fd558d18SJames Chapman static void *pppol2tp_seq_next(struct seq_file *m, void *v, loff_t *pos)
1483fd558d18SJames Chapman {
1484fd558d18SJames Chapman (*pos)++;
1485fd558d18SJames Chapman return NULL;
1486fd558d18SJames Chapman }
1487fd558d18SJames Chapman
pppol2tp_seq_stop(struct seq_file * p,void * v)1488fd558d18SJames Chapman static void pppol2tp_seq_stop(struct seq_file *p, void *v)
1489fd558d18SJames Chapman {
14900e0c3feeSGuillaume Nault struct pppol2tp_seq_data *pd = v;
14910e0c3feeSGuillaume Nault
14920e0c3feeSGuillaume Nault if (!pd || pd == SEQ_START_TOKEN)
14930e0c3feeSGuillaume Nault return;
14940e0c3feeSGuillaume Nault
149583494407SGuillaume Nault /* Drop reference taken by last invocation of pppol2tp_next_session()
149683494407SGuillaume Nault * or pppol2tp_next_tunnel().
149783494407SGuillaume Nault */
149883494407SGuillaume Nault if (pd->session) {
149983494407SGuillaume Nault l2tp_session_dec_refcount(pd->session);
150083494407SGuillaume Nault pd->session = NULL;
150183494407SGuillaume Nault }
15025411b618SGuillaume Nault if (pd->tunnel) {
15030e0c3feeSGuillaume Nault l2tp_tunnel_dec_refcount(pd->tunnel);
15045411b618SGuillaume Nault pd->tunnel = NULL;
15055411b618SGuillaume Nault }
1506fd558d18SJames Chapman }
1507fd558d18SJames Chapman
pppol2tp_seq_tunnel_show(struct seq_file * m,void * v)1508fd558d18SJames Chapman static void pppol2tp_seq_tunnel_show(struct seq_file *m, void *v)
1509fd558d18SJames Chapman {
1510fd558d18SJames Chapman struct l2tp_tunnel *tunnel = v;
1511fd558d18SJames Chapman
1512fd558d18SJames Chapman seq_printf(m, "\nTUNNEL '%s', %c %d\n",
1513fd558d18SJames Chapman tunnel->name,
1514fd558d18SJames Chapman (tunnel == tunnel->sock->sk_user_data) ? 'Y' : 'N',
1515fbea9e07SReshetova, Elena refcount_read(&tunnel->ref_count) - 1);
15167b7c0719STom Parkin seq_printf(m, " %08x %ld/%ld/%ld %ld/%ld/%ld\n",
1517eee049c0STom Parkin 0,
15187b7c0719STom Parkin atomic_long_read(&tunnel->stats.tx_packets),
15197b7c0719STom Parkin atomic_long_read(&tunnel->stats.tx_bytes),
15207b7c0719STom Parkin atomic_long_read(&tunnel->stats.tx_errors),
15217b7c0719STom Parkin atomic_long_read(&tunnel->stats.rx_packets),
15227b7c0719STom Parkin atomic_long_read(&tunnel->stats.rx_bytes),
15237b7c0719STom Parkin atomic_long_read(&tunnel->stats.rx_errors));
1524fd558d18SJames Chapman }
1525fd558d18SJames Chapman
pppol2tp_seq_session_show(struct seq_file * m,void * v)1526fd558d18SJames Chapman static void pppol2tp_seq_session_show(struct seq_file *m, void *v)
1527fd558d18SJames Chapman {
1528fd558d18SJames Chapman struct l2tp_session *session = v;
1529fd558d18SJames Chapman struct l2tp_tunnel *tunnel = session->tunnel;
1530ee40fb2eSGuillaume Nault unsigned char state;
1531ee40fb2eSGuillaume Nault char user_data_ok;
1532ee40fb2eSGuillaume Nault struct sock *sk;
1533fd558d18SJames Chapman u32 ip = 0;
1534fd558d18SJames Chapman u16 port = 0;
1535fd558d18SJames Chapman
1536fd558d18SJames Chapman if (tunnel->sock) {
1537fd558d18SJames Chapman struct inet_sock *inet = inet_sk(tunnel->sock);
1538b71a61ccSTom Parkin
1539fd558d18SJames Chapman ip = ntohl(inet->inet_saddr);
1540fd558d18SJames Chapman port = ntohs(inet->inet_sport);
1541fd558d18SJames Chapman }
1542fd558d18SJames Chapman
1543ee40fb2eSGuillaume Nault sk = pppol2tp_session_get_sock(session);
1544ee40fb2eSGuillaume Nault if (sk) {
1545ee40fb2eSGuillaume Nault state = sk->sk_state;
1546ee40fb2eSGuillaume Nault user_data_ok = (session == sk->sk_user_data) ? 'Y' : 'N';
1547ee40fb2eSGuillaume Nault } else {
1548ee40fb2eSGuillaume Nault state = 0;
1549ee40fb2eSGuillaume Nault user_data_ok = 'N';
1550ee40fb2eSGuillaume Nault }
1551ee40fb2eSGuillaume Nault
15529f7da9a0STom Parkin seq_printf(m, " SESSION '%s' %08X/%d %04X/%04X -> %04X/%04X %d %c\n",
1553fd558d18SJames Chapman session->name, ip, port,
1554fd558d18SJames Chapman tunnel->tunnel_id,
1555fd558d18SJames Chapman session->session_id,
1556fd558d18SJames Chapman tunnel->peer_tunnel_id,
1557fd558d18SJames Chapman session->peer_session_id,
1558ee40fb2eSGuillaume Nault state, user_data_ok);
1559789141b2SGuillaume Nault seq_printf(m, " 0/0/%c/%c/%s %08x %u\n",
1560fd558d18SJames Chapman session->recv_seq ? 'R' : '-',
1561fd558d18SJames Chapman session->send_seq ? 'S' : '-',
1562fd558d18SJames Chapman session->lns_mode ? "LNS" : "LAC",
1563eee049c0STom Parkin 0,
1564fd558d18SJames Chapman jiffies_to_msecs(session->reorder_timeout));
1565a2b6111bSJustin Stitt seq_printf(m, " %u/%u %ld/%ld/%ld %ld/%ld/%ld\n",
1566fd558d18SJames Chapman session->nr, session->ns,
15677b7c0719STom Parkin atomic_long_read(&session->stats.tx_packets),
15687b7c0719STom Parkin atomic_long_read(&session->stats.tx_bytes),
15697b7c0719STom Parkin atomic_long_read(&session->stats.tx_errors),
15707b7c0719STom Parkin atomic_long_read(&session->stats.rx_packets),
15717b7c0719STom Parkin atomic_long_read(&session->stats.rx_bytes),
15727b7c0719STom Parkin atomic_long_read(&session->stats.rx_errors));
15739345471bSJames Chapman
1574ee40fb2eSGuillaume Nault if (sk) {
1575ee40fb2eSGuillaume Nault struct pppox_sock *po = pppox_sk(sk);
1576ee40fb2eSGuillaume Nault
15779345471bSJames Chapman seq_printf(m, " interface %s\n", ppp_dev_name(&po->chan));
1578ee40fb2eSGuillaume Nault sock_put(sk);
1579ee40fb2eSGuillaume Nault }
1580fd558d18SJames Chapman }
1581fd558d18SJames Chapman
pppol2tp_seq_show(struct seq_file * m,void * v)1582fd558d18SJames Chapman static int pppol2tp_seq_show(struct seq_file *m, void *v)
1583fd558d18SJames Chapman {
1584fd558d18SJames Chapman struct pppol2tp_seq_data *pd = v;
1585fd558d18SJames Chapman
1586fd558d18SJames Chapman /* display header on line 1 */
1587fd558d18SJames Chapman if (v == SEQ_START_TOKEN) {
1588fd558d18SJames Chapman seq_puts(m, "PPPoL2TP driver info, " PPPOL2TP_DRV_VERSION "\n");
1589fd558d18SJames Chapman seq_puts(m, "TUNNEL name, user-data-ok session-count\n");
1590fd558d18SJames Chapman seq_puts(m, " debug tx-pkts/bytes/errs rx-pkts/bytes/errs\n");
15919f7da9a0STom Parkin seq_puts(m, " SESSION name, addr/port src-tid/sid dest-tid/sid state user-data-ok\n");
1592fd558d18SJames Chapman seq_puts(m, " mtu/mru/rcvseq/sendseq/lns debug reorderto\n");
1593fd558d18SJames Chapman seq_puts(m, " nr/ns tx-pkts/bytes/errs rx-pkts/bytes/errs\n");
1594fd558d18SJames Chapman goto out;
1595fd558d18SJames Chapman }
1596fd558d18SJames Chapman
159783494407SGuillaume Nault if (!pd->session)
1598fd558d18SJames Chapman pppol2tp_seq_tunnel_show(m, pd->tunnel);
159983494407SGuillaume Nault else
1600fd558d18SJames Chapman pppol2tp_seq_session_show(m, pd->session);
1601fd558d18SJames Chapman
1602fd558d18SJames Chapman out:
1603fd558d18SJames Chapman return 0;
1604fd558d18SJames Chapman }
1605fd558d18SJames Chapman
1606fd558d18SJames Chapman static const struct seq_operations pppol2tp_seq_ops = {
1607fd558d18SJames Chapman .start = pppol2tp_seq_start,
1608fd558d18SJames Chapman .next = pppol2tp_seq_next,
1609fd558d18SJames Chapman .stop = pppol2tp_seq_stop,
1610fd558d18SJames Chapman .show = pppol2tp_seq_show,
1611fd558d18SJames Chapman };
1612fd558d18SJames Chapman #endif /* CONFIG_PROC_FS */
1613fd558d18SJames Chapman
1614fd558d18SJames Chapman /*****************************************************************************
1615fd558d18SJames Chapman * Network namespace
1616fd558d18SJames Chapman *****************************************************************************/
1617fd558d18SJames Chapman
pppol2tp_init_net(struct net * net)1618fd558d18SJames Chapman static __net_init int pppol2tp_init_net(struct net *net)
1619fd558d18SJames Chapman {
1620fd558d18SJames Chapman struct proc_dir_entry *pde;
1621fd558d18SJames Chapman int err = 0;
1622fd558d18SJames Chapman
1623c3506372SChristoph Hellwig pde = proc_create_net("pppol2tp", 0444, net->proc_net,
1624c3506372SChristoph Hellwig &pppol2tp_seq_ops, sizeof(struct pppol2tp_seq_data));
1625fd558d18SJames Chapman if (!pde) {
1626fd558d18SJames Chapman err = -ENOMEM;
1627fd558d18SJames Chapman goto out;
1628fd558d18SJames Chapman }
1629fd558d18SJames Chapman
1630fd558d18SJames Chapman out:
1631fd558d18SJames Chapman return err;
1632fd558d18SJames Chapman }
1633fd558d18SJames Chapman
pppol2tp_exit_net(struct net * net)1634fd558d18SJames Chapman static __net_exit void pppol2tp_exit_net(struct net *net)
1635fd558d18SJames Chapman {
1636ece31ffdSGao feng remove_proc_entry("pppol2tp", net->proc_net);
1637fd558d18SJames Chapman }
1638fd558d18SJames Chapman
1639fd558d18SJames Chapman static struct pernet_operations pppol2tp_net_ops = {
1640fd558d18SJames Chapman .init = pppol2tp_init_net,
1641fd558d18SJames Chapman .exit = pppol2tp_exit_net,
1642fd558d18SJames Chapman .id = &pppol2tp_net_id,
1643fd558d18SJames Chapman };
1644fd558d18SJames Chapman
1645fd558d18SJames Chapman /*****************************************************************************
1646fd558d18SJames Chapman * Init and cleanup
1647fd558d18SJames Chapman *****************************************************************************/
1648fd558d18SJames Chapman
1649fd558d18SJames Chapman static const struct proto_ops pppol2tp_ops = {
1650fd558d18SJames Chapman .family = AF_PPPOX,
1651fd558d18SJames Chapman .owner = THIS_MODULE,
1652fd558d18SJames Chapman .release = pppol2tp_release,
1653fd558d18SJames Chapman .bind = sock_no_bind,
1654fd558d18SJames Chapman .connect = pppol2tp_connect,
1655fd558d18SJames Chapman .socketpair = sock_no_socketpair,
1656fd558d18SJames Chapman .accept = sock_no_accept,
1657fd558d18SJames Chapman .getname = pppol2tp_getname,
1658a11e1d43SLinus Torvalds .poll = datagram_poll,
1659fd558d18SJames Chapman .listen = sock_no_listen,
1660fd558d18SJames Chapman .shutdown = sock_no_shutdown,
1661fd558d18SJames Chapman .setsockopt = pppol2tp_setsockopt,
1662fd558d18SJames Chapman .getsockopt = pppol2tp_getsockopt,
1663fd558d18SJames Chapman .sendmsg = pppol2tp_sendmsg,
1664fd558d18SJames Chapman .recvmsg = pppol2tp_recvmsg,
1665fd558d18SJames Chapman .mmap = sock_no_mmap,
1666fd558d18SJames Chapman .ioctl = pppox_ioctl,
1667055d8824SArnd Bergmann #ifdef CONFIG_COMPAT
1668055d8824SArnd Bergmann .compat_ioctl = pppox_compat_ioctl,
1669055d8824SArnd Bergmann #endif
1670fd558d18SJames Chapman };
1671fd558d18SJames Chapman
1672756e64a0SEric Dumazet static const struct pppox_proto pppol2tp_proto = {
1673fd558d18SJames Chapman .create = pppol2tp_create,
1674e1558a93SWei Yongjun .ioctl = pppol2tp_ioctl,
1675e1558a93SWei Yongjun .owner = THIS_MODULE,
1676fd558d18SJames Chapman };
1677fd558d18SJames Chapman
1678309795f4SJames Chapman #ifdef CONFIG_L2TP_V3
1679309795f4SJames Chapman
1680309795f4SJames Chapman static const struct l2tp_nl_cmd_ops pppol2tp_nl_cmd_ops = {
1681309795f4SJames Chapman .session_create = pppol2tp_session_create,
1682cf2f5c88STom Parkin .session_delete = l2tp_session_delete,
1683309795f4SJames Chapman };
1684309795f4SJames Chapman
1685309795f4SJames Chapman #endif /* CONFIG_L2TP_V3 */
1686309795f4SJames Chapman
pppol2tp_init(void)1687fd558d18SJames Chapman static int __init pppol2tp_init(void)
1688fd558d18SJames Chapman {
1689fd558d18SJames Chapman int err;
1690fd558d18SJames Chapman
1691fd558d18SJames Chapman err = register_pernet_device(&pppol2tp_net_ops);
1692fd558d18SJames Chapman if (err)
1693fd558d18SJames Chapman goto out;
1694fd558d18SJames Chapman
1695fd558d18SJames Chapman err = proto_register(&pppol2tp_sk_proto, 0);
1696fd558d18SJames Chapman if (err)
1697fd558d18SJames Chapman goto out_unregister_pppol2tp_pernet;
1698fd558d18SJames Chapman
1699fd558d18SJames Chapman err = register_pppox_proto(PX_PROTO_OL2TP, &pppol2tp_proto);
1700fd558d18SJames Chapman if (err)
1701fd558d18SJames Chapman goto out_unregister_pppol2tp_proto;
1702fd558d18SJames Chapman
1703309795f4SJames Chapman #ifdef CONFIG_L2TP_V3
1704309795f4SJames Chapman err = l2tp_nl_register_ops(L2TP_PWTYPE_PPP, &pppol2tp_nl_cmd_ops);
1705309795f4SJames Chapman if (err)
1706309795f4SJames Chapman goto out_unregister_pppox;
1707309795f4SJames Chapman #endif
1708309795f4SJames Chapman
1709a4ca44faSJoe Perches pr_info("PPPoL2TP kernel driver, %s\n", PPPOL2TP_DRV_VERSION);
1710fd558d18SJames Chapman
1711fd558d18SJames Chapman out:
1712fd558d18SJames Chapman return err;
1713309795f4SJames Chapman
1714309795f4SJames Chapman #ifdef CONFIG_L2TP_V3
1715309795f4SJames Chapman out_unregister_pppox:
1716309795f4SJames Chapman unregister_pppox_proto(PX_PROTO_OL2TP);
1717309795f4SJames Chapman #endif
1718fd558d18SJames Chapman out_unregister_pppol2tp_proto:
1719fd558d18SJames Chapman proto_unregister(&pppol2tp_sk_proto);
1720fd558d18SJames Chapman out_unregister_pppol2tp_pernet:
1721fd558d18SJames Chapman unregister_pernet_device(&pppol2tp_net_ops);
1722fd558d18SJames Chapman goto out;
1723fd558d18SJames Chapman }
1724fd558d18SJames Chapman
pppol2tp_exit(void)1725fd558d18SJames Chapman static void __exit pppol2tp_exit(void)
1726fd558d18SJames Chapman {
1727309795f4SJames Chapman #ifdef CONFIG_L2TP_V3
1728309795f4SJames Chapman l2tp_nl_unregister_ops(L2TP_PWTYPE_PPP);
1729309795f4SJames Chapman #endif
1730fd558d18SJames Chapman unregister_pppox_proto(PX_PROTO_OL2TP);
1731fd558d18SJames Chapman proto_unregister(&pppol2tp_sk_proto);
1732fd558d18SJames Chapman unregister_pernet_device(&pppol2tp_net_ops);
1733fd558d18SJames Chapman }
1734fd558d18SJames Chapman
1735fd558d18SJames Chapman module_init(pppol2tp_init);
1736fd558d18SJames Chapman module_exit(pppol2tp_exit);
1737fd558d18SJames Chapman
1738fd558d18SJames Chapman MODULE_AUTHOR("James Chapman <jchapman@katalix.com>");
1739fd558d18SJames Chapman MODULE_DESCRIPTION("PPP over L2TP over UDP");
1740fd558d18SJames Chapman MODULE_LICENSE("GPL");
1741fd558d18SJames Chapman MODULE_VERSION(PPPOL2TP_DRV_VERSION);
1742681b4d88SGuillaume Nault MODULE_ALIAS_NET_PF_PROTO(PF_PPPOX, PX_PROTO_OL2TP);
1743249ee819SGuillaume Nault MODULE_ALIAS_L2TP_PWTYPE(7);
1744