xref: /openbmc/linux/net/l2tp/l2tp_ppp.c (revision 5ee9cd065836e5934710ca35653bce7905add20b)
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