xref: /openbmc/linux/net/l2tp/l2tp_ppp.c (revision 45faeff11b48b9390ee946668119472b8941de90)
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  */
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  */
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  */
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;
194fd558d18SJames Chapman 	skb = skb_recv_datagram(sk, flags & ~MSG_DONTWAIT,
195fd558d18SJames Chapman 				flags & MSG_DONTWAIT, &err);
196fd558d18SJames Chapman 	if (!skb)
197fd558d18SJames Chapman 		goto end;
198fd558d18SJames Chapman 
199fd558d18SJames Chapman 	if (len > skb->len)
200fd558d18SJames Chapman 		len = skb->len;
201fd558d18SJames Chapman 	else if (len < skb->len)
202fd558d18SJames Chapman 		msg->msg_flags |= MSG_TRUNC;
203fd558d18SJames Chapman 
20451f3d02bSDavid S. Miller 	err = skb_copy_datagram_msg(skb, 0, msg, len);
205fd558d18SJames Chapman 	if (likely(err == 0))
206fd558d18SJames Chapman 		err = len;
207fd558d18SJames Chapman 
208fd558d18SJames Chapman 	kfree_skb(skb);
209fd558d18SJames Chapman end:
210fd558d18SJames Chapman 	return err;
211fd558d18SJames Chapman }
212fd558d18SJames Chapman 
213fd558d18SJames Chapman static void pppol2tp_recv(struct l2tp_session *session, struct sk_buff *skb, int data_len)
214fd558d18SJames Chapman {
215fd558d18SJames Chapman 	struct pppol2tp_session *ps = l2tp_session_priv(session);
216fd558d18SJames Chapman 	struct sock *sk = NULL;
217fd558d18SJames Chapman 
218fd558d18SJames Chapman 	/* If the socket is bound, send it in to PPP's input queue. Otherwise
219fd558d18SJames Chapman 	 * queue it on the session socket.
220fd558d18SJames Chapman 	 */
221ee40fb2eSGuillaume Nault 	rcu_read_lock();
222ee40fb2eSGuillaume Nault 	sk = rcu_dereference(ps->sk);
2230febc7b3STom Parkin 	if (!sk)
224fd558d18SJames Chapman 		goto no_sock;
225fd558d18SJames Chapman 
2262b139e6bSGuillaume Nault 	/* If the first two bytes are 0xFF03, consider that it is the PPP's
2272b139e6bSGuillaume Nault 	 * Address and Control fields and skip them. The L2TP module has always
2282b139e6bSGuillaume Nault 	 * worked this way, although, in theory, the use of these fields should
2292b139e6bSGuillaume Nault 	 * be negociated and handled at the PPP layer. These fields are
2302b139e6bSGuillaume Nault 	 * constant: 0xFF is the All-Stations Address and 0x03 the Unnumbered
2312b139e6bSGuillaume Nault 	 * Information command with Poll/Final bit set to zero (RFC 1662).
2322b139e6bSGuillaume Nault 	 */
2332b139e6bSGuillaume Nault 	if (pskb_may_pull(skb, 2) && skb->data[0] == PPP_ALLSTATIONS &&
2342b139e6bSGuillaume Nault 	    skb->data[1] == PPP_UI)
2352b139e6bSGuillaume Nault 		skb_pull(skb, 2);
2362b139e6bSGuillaume Nault 
237fd558d18SJames Chapman 	if (sk->sk_state & PPPOX_BOUND) {
238fd558d18SJames Chapman 		struct pppox_sock *po;
23998f40b3eSGuillaume Nault 
240fd558d18SJames Chapman 		po = pppox_sk(sk);
241fd558d18SJames Chapman 		ppp_input(&po->chan, skb);
242fd558d18SJames Chapman 	} else {
2439e9cb622SGuillaume Nault 		if (sock_queue_rcv_skb(sk, skb) < 0) {
2447b7c0719STom Parkin 			atomic_long_inc(&session->stats.rx_errors);
245fd558d18SJames Chapman 			kfree_skb(skb);
246fd558d18SJames Chapman 		}
2479e9cb622SGuillaume Nault 	}
248ee40fb2eSGuillaume Nault 	rcu_read_unlock();
249fd558d18SJames Chapman 
250fd558d18SJames Chapman 	return;
251fd558d18SJames Chapman 
252fd558d18SJames Chapman no_sock:
253ee40fb2eSGuillaume Nault 	rcu_read_unlock();
2545ee759cdSTom Parkin 	pr_warn_ratelimited("%s: no socket in recv\n", session->name);
255fd558d18SJames Chapman 	kfree_skb(skb);
256fd558d18SJames Chapman }
257fd558d18SJames Chapman 
258fd558d18SJames Chapman /************************************************************************
259fd558d18SJames Chapman  * Transmit handling
260fd558d18SJames Chapman  ***********************************************************************/
261fd558d18SJames Chapman 
262fd558d18SJames Chapman /* This is the sendmsg for the PPPoL2TP pppol2tp_session socket.  We come here
263fd558d18SJames Chapman  * when a user application does a sendmsg() on the session socket. L2TP and
264fd558d18SJames Chapman  * PPP headers must be inserted into the user's data.
265fd558d18SJames Chapman  */
2661b784140SYing Xue static int pppol2tp_sendmsg(struct socket *sock, struct msghdr *m,
267fd558d18SJames Chapman 			    size_t total_len)
268fd558d18SJames Chapman {
269fd558d18SJames Chapman 	struct sock *sk = sock->sk;
270fd558d18SJames Chapman 	struct sk_buff *skb;
271fd558d18SJames Chapman 	int error;
272fd558d18SJames Chapman 	struct l2tp_session *session;
273fd558d18SJames Chapman 	struct l2tp_tunnel *tunnel;
2740d76751fSJames Chapman 	int uhlen;
275fd558d18SJames Chapman 
276fd558d18SJames Chapman 	error = -ENOTCONN;
277fd558d18SJames Chapman 	if (sock_flag(sk, SOCK_DEAD) || !(sk->sk_state & PPPOX_CONNECTED))
278fd558d18SJames Chapman 		goto error;
279fd558d18SJames Chapman 
280fd558d18SJames Chapman 	/* Get session and tunnel contexts */
281fd558d18SJames Chapman 	error = -EBADF;
282fd558d18SJames Chapman 	session = pppol2tp_sock_to_session(sk);
2830febc7b3STom Parkin 	if (!session)
284fd558d18SJames Chapman 		goto error;
285fd558d18SJames Chapman 
2867198c77aSGuillaume Nault 	tunnel = session->tunnel;
287fd558d18SJames Chapman 
2880d76751fSJames Chapman 	uhlen = (tunnel->encap == L2TP_ENCAPTYPE_UDP) ? sizeof(struct udphdr) : 0;
2890d76751fSJames Chapman 
290fd558d18SJames Chapman 	/* Allocate a socket buffer */
291fd558d18SJames Chapman 	error = -ENOMEM;
292fd558d18SJames Chapman 	skb = sock_wmalloc(sk, NET_SKB_PAD + sizeof(struct iphdr) +
2930d76751fSJames Chapman 			   uhlen + session->hdr_len +
29454c151d9SGao Feng 			   2 + total_len, /* 2 bytes for PPP_ALLSTATIONS & PPP_UI */
295fd558d18SJames Chapman 			   0, GFP_KERNEL);
296fd558d18SJames Chapman 	if (!skb)
2977198c77aSGuillaume Nault 		goto error_put_sess;
298fd558d18SJames Chapman 
299fd558d18SJames Chapman 	/* Reserve space for headers. */
300fd558d18SJames Chapman 	skb_reserve(skb, NET_SKB_PAD);
301fd558d18SJames Chapman 	skb_reset_network_header(skb);
302fd558d18SJames Chapman 	skb_reserve(skb, sizeof(struct iphdr));
303fd558d18SJames Chapman 	skb_reset_transport_header(skb);
3040d76751fSJames Chapman 	skb_reserve(skb, uhlen);
305fd558d18SJames Chapman 
306fd558d18SJames Chapman 	/* Add PPP header */
30754c151d9SGao Feng 	skb->data[0] = PPP_ALLSTATIONS;
30854c151d9SGao Feng 	skb->data[1] = PPP_UI;
309fd558d18SJames Chapman 	skb_put(skb, 2);
310fd558d18SJames Chapman 
311fd558d18SJames Chapman 	/* Copy user data into skb */
3126ce8e9ceSAl Viro 	error = memcpy_from_msg(skb_put(skb, total_len), m, total_len);
313fd558d18SJames Chapman 	if (error < 0) {
314fd558d18SJames Chapman 		kfree_skb(skb);
3157198c77aSGuillaume Nault 		goto error_put_sess;
316fd558d18SJames Chapman 	}
317fd558d18SJames Chapman 
318455cc32bSEric Dumazet 	local_bh_disable();
319efe05278STom Parkin 	l2tp_xmit_skb(session, skb);
320455cc32bSEric Dumazet 	local_bh_enable();
321fd558d18SJames Chapman 
3228b82547eSGuillaume Nault 	sock_put(sk);
323fd558d18SJames Chapman 
324a6f79d0fSGuillaume Nault 	return total_len;
325fd558d18SJames Chapman 
326fd558d18SJames Chapman error_put_sess:
327fd558d18SJames Chapman 	sock_put(sk);
328fd558d18SJames Chapman error:
329fd558d18SJames Chapman 	return error;
330fd558d18SJames Chapman }
331fd558d18SJames Chapman 
332fd558d18SJames Chapman /* Transmit function called by generic PPP driver.  Sends PPP frame
333fd558d18SJames Chapman  * over PPPoL2TP socket.
334fd558d18SJames Chapman  *
335fd558d18SJames Chapman  * This is almost the same as pppol2tp_sendmsg(), but rather than
336fd558d18SJames Chapman  * being called with a msghdr from userspace, it is called with a skb
337fd558d18SJames Chapman  * from the kernel.
338fd558d18SJames Chapman  *
339fd558d18SJames Chapman  * The supplied skb from ppp doesn't have enough headroom for the
340fd558d18SJames Chapman  * insertion of L2TP, UDP and IP headers so we need to allocate more
341fd558d18SJames Chapman  * headroom in the skb. This will create a cloned skb. But we must be
342fd558d18SJames Chapman  * careful in the error case because the caller will expect to free
343fd558d18SJames Chapman  * the skb it supplied, not our cloned skb. So we take care to always
344fd558d18SJames Chapman  * leave the original skb unfreed if we return an error.
345fd558d18SJames Chapman  */
346fd558d18SJames Chapman static int pppol2tp_xmit(struct ppp_channel *chan, struct sk_buff *skb)
347fd558d18SJames Chapman {
348fd558d18SJames Chapman 	struct sock *sk = (struct sock *)chan->private;
349fd558d18SJames Chapman 	struct l2tp_session *session;
350fd558d18SJames Chapman 	struct l2tp_tunnel *tunnel;
35109df57caSEric Dumazet 	int uhlen, headroom;
352fd558d18SJames Chapman 
353fd558d18SJames Chapman 	if (sock_flag(sk, SOCK_DEAD) || !(sk->sk_state & PPPOX_CONNECTED))
354fd558d18SJames Chapman 		goto abort;
355fd558d18SJames Chapman 
356fd558d18SJames Chapman 	/* Get session and tunnel contexts from the socket */
357fd558d18SJames Chapman 	session = pppol2tp_sock_to_session(sk);
3580febc7b3STom Parkin 	if (!session)
359fd558d18SJames Chapman 		goto abort;
360fd558d18SJames Chapman 
3617198c77aSGuillaume Nault 	tunnel = session->tunnel;
362fd558d18SJames Chapman 
36309df57caSEric Dumazet 	uhlen = (tunnel->encap == L2TP_ENCAPTYPE_UDP) ? sizeof(struct udphdr) : 0;
36409df57caSEric Dumazet 	headroom = NET_SKB_PAD +
36509df57caSEric Dumazet 		   sizeof(struct iphdr) + /* IP header */
36609df57caSEric Dumazet 		   uhlen +		/* UDP header (if L2TP_ENCAPTYPE_UDP) */
36709df57caSEric Dumazet 		   session->hdr_len +	/* L2TP header */
36854c151d9SGao Feng 		   2;			/* 2 bytes for PPP_ALLSTATIONS & PPP_UI */
36909df57caSEric Dumazet 	if (skb_cow_head(skb, headroom))
3707198c77aSGuillaume Nault 		goto abort_put_sess;
371fd558d18SJames Chapman 
372fd558d18SJames Chapman 	/* Setup PPP header */
37354c151d9SGao Feng 	__skb_push(skb, 2);
37454c151d9SGao Feng 	skb->data[0] = PPP_ALLSTATIONS;
37554c151d9SGao Feng 	skb->data[1] = PPP_UI;
376fd558d18SJames Chapman 
377455cc32bSEric Dumazet 	local_bh_disable();
378efe05278STom Parkin 	l2tp_xmit_skb(session, skb);
379455cc32bSEric Dumazet 	local_bh_enable();
380fd558d18SJames Chapman 
381fd558d18SJames Chapman 	sock_put(sk);
3827198c77aSGuillaume Nault 
383fd558d18SJames Chapman 	return 1;
384fd558d18SJames Chapman 
385fd558d18SJames Chapman abort_put_sess:
386fd558d18SJames Chapman 	sock_put(sk);
387fd558d18SJames Chapman abort:
388fd558d18SJames Chapman 	/* Free the original skb */
389fd558d18SJames Chapman 	kfree_skb(skb);
390fd558d18SJames Chapman 	return 1;
391fd558d18SJames Chapman }
392fd558d18SJames Chapman 
393fd558d18SJames Chapman /*****************************************************************************
394fd558d18SJames Chapman  * Session (and tunnel control) socket create/destroy.
395fd558d18SJames Chapman  *****************************************************************************/
396fd558d18SJames Chapman 
397d02ba2a6SJames Chapman static void pppol2tp_put_sk(struct rcu_head *head)
398d02ba2a6SJames Chapman {
399d02ba2a6SJames Chapman 	struct pppol2tp_session *ps;
400d02ba2a6SJames Chapman 
401d02ba2a6SJames Chapman 	ps = container_of(head, typeof(*ps), rcu);
402d02ba2a6SJames Chapman 	sock_put(ps->__sk);
403d02ba2a6SJames Chapman }
404d02ba2a6SJames Chapman 
405fd558d18SJames Chapman /* Really kill the session socket. (Called from sock_put() if
406fd558d18SJames Chapman  * refcnt == 0.)
407fd558d18SJames Chapman  */
408fd558d18SJames Chapman static void pppol2tp_session_destruct(struct sock *sk)
409fd558d18SJames Chapman {
410f6e16b29STom Parkin 	struct l2tp_session *session = sk->sk_user_data;
411e91793bbSGuillaume Nault 
412e91793bbSGuillaume Nault 	skb_queue_purge(&sk->sk_receive_queue);
413e91793bbSGuillaume Nault 	skb_queue_purge(&sk->sk_write_queue);
414e91793bbSGuillaume Nault 
415f6e16b29STom Parkin 	if (session) {
416fd558d18SJames Chapman 		sk->sk_user_data = NULL;
4171aa646acSTom Parkin 		if (WARN_ON(session->magic != L2TP_SESSION_MAGIC))
4181aa646acSTom Parkin 			return;
419fd558d18SJames Chapman 		l2tp_session_dec_refcount(session);
420fd558d18SJames Chapman 	}
421fd558d18SJames Chapman }
422fd558d18SJames Chapman 
423fd558d18SJames Chapman /* Called when the PPPoX socket (session) is closed.
424fd558d18SJames Chapman  */
425fd558d18SJames Chapman static int pppol2tp_release(struct socket *sock)
426fd558d18SJames Chapman {
427fd558d18SJames Chapman 	struct sock *sk = sock->sk;
428fd558d18SJames Chapman 	struct l2tp_session *session;
429fd558d18SJames Chapman 	int error;
430fd558d18SJames Chapman 
431fd558d18SJames Chapman 	if (!sk)
432fd558d18SJames Chapman 		return 0;
433fd558d18SJames Chapman 
434fd558d18SJames Chapman 	error = -EBADF;
435fd558d18SJames Chapman 	lock_sock(sk);
436fd558d18SJames Chapman 	if (sock_flag(sk, SOCK_DEAD) != 0)
437fd558d18SJames Chapman 		goto error;
438fd558d18SJames Chapman 
439fd558d18SJames Chapman 	pppox_unbind_sock(sk);
440fd558d18SJames Chapman 
441fd558d18SJames Chapman 	/* Signal the death of the socket. */
442fd558d18SJames Chapman 	sk->sk_state = PPPOX_DEAD;
443fd558d18SJames Chapman 	sock_orphan(sk);
444fd558d18SJames Chapman 	sock->sk = NULL;
445fd558d18SJames Chapman 
446d02ba2a6SJames Chapman 	session = pppol2tp_sock_to_session(sk);
447d02ba2a6SJames Chapman 	if (session) {
4483d609342SGuillaume Nault 		struct pppol2tp_session *ps;
4493d609342SGuillaume Nault 
450d02ba2a6SJames Chapman 		l2tp_session_delete(session);
4513d609342SGuillaume Nault 
4523d609342SGuillaume Nault 		ps = l2tp_session_priv(session);
4533d609342SGuillaume Nault 		mutex_lock(&ps->sk_lock);
4543d609342SGuillaume Nault 		ps->__sk = rcu_dereference_protected(ps->sk,
4553d609342SGuillaume Nault 						     lockdep_is_held(&ps->sk_lock));
4563d609342SGuillaume Nault 		RCU_INIT_POINTER(ps->sk, NULL);
4573d609342SGuillaume Nault 		mutex_unlock(&ps->sk_lock);
4583d609342SGuillaume Nault 		call_rcu(&ps->rcu, pppol2tp_put_sk);
4593d609342SGuillaume Nault 
4603d609342SGuillaume Nault 		/* Rely on the sock_put() call at the end of the function for
4613d609342SGuillaume Nault 		 * dropping the reference held by pppol2tp_sock_to_session().
4623d609342SGuillaume Nault 		 * The last reference will be dropped by pppol2tp_put_sk().
4633d609342SGuillaume Nault 		 */
464cf2f5c88STom Parkin 	}
465d02ba2a6SJames Chapman 
466fd558d18SJames Chapman 	release_sock(sk);
467fd558d18SJames Chapman 
468fd558d18SJames Chapman 	/* This will delete the session context via
469fd558d18SJames Chapman 	 * pppol2tp_session_destruct() if the socket's refcnt drops to
470fd558d18SJames Chapman 	 * zero.
471fd558d18SJames Chapman 	 */
472fd558d18SJames Chapman 	sock_put(sk);
473fd558d18SJames Chapman 
474fd558d18SJames Chapman 	return 0;
475fd558d18SJames Chapman 
476fd558d18SJames Chapman error:
477fd558d18SJames Chapman 	release_sock(sk);
478fd558d18SJames Chapman 	return error;
479fd558d18SJames Chapman }
480fd558d18SJames Chapman 
481fd558d18SJames Chapman static struct proto pppol2tp_sk_proto = {
482fd558d18SJames Chapman 	.name	  = "PPPOL2TP",
483fd558d18SJames Chapman 	.owner	  = THIS_MODULE,
484fd558d18SJames Chapman 	.obj_size = sizeof(struct pppox_sock),
485fd558d18SJames Chapman };
486fd558d18SJames Chapman 
487fd558d18SJames Chapman static int pppol2tp_backlog_recv(struct sock *sk, struct sk_buff *skb)
488fd558d18SJames Chapman {
489fd558d18SJames Chapman 	int rc;
490fd558d18SJames Chapman 
491fd558d18SJames Chapman 	rc = l2tp_udp_encap_recv(sk, skb);
492fd558d18SJames Chapman 	if (rc)
493fd558d18SJames Chapman 		kfree_skb(skb);
494fd558d18SJames Chapman 
495fd558d18SJames Chapman 	return NET_RX_SUCCESS;
496fd558d18SJames Chapman }
497fd558d18SJames Chapman 
498fd558d18SJames Chapman /* socket() handler. Initialize a new struct sock.
499fd558d18SJames Chapman  */
50011aa9c28SEric W. Biederman static int pppol2tp_create(struct net *net, struct socket *sock, int kern)
501fd558d18SJames Chapman {
502fd558d18SJames Chapman 	int error = -ENOMEM;
503fd558d18SJames Chapman 	struct sock *sk;
504fd558d18SJames Chapman 
50511aa9c28SEric W. Biederman 	sk = sk_alloc(net, PF_PPPOX, GFP_KERNEL, &pppol2tp_sk_proto, kern);
506fd558d18SJames Chapman 	if (!sk)
507fd558d18SJames Chapman 		goto out;
508fd558d18SJames Chapman 
509fd558d18SJames Chapman 	sock_init_data(sock, sk);
510fd558d18SJames Chapman 
511fd558d18SJames Chapman 	sock->state  = SS_UNCONNECTED;
512fd558d18SJames Chapman 	sock->ops    = &pppol2tp_ops;
513fd558d18SJames Chapman 
514fd558d18SJames Chapman 	sk->sk_backlog_rcv = pppol2tp_backlog_recv;
515fd558d18SJames Chapman 	sk->sk_protocol	   = PX_PROTO_OL2TP;
516fd558d18SJames Chapman 	sk->sk_family	   = PF_PPPOX;
517fd558d18SJames Chapman 	sk->sk_state	   = PPPOX_NONE;
518fd558d18SJames Chapman 	sk->sk_type	   = SOCK_STREAM;
519fd558d18SJames Chapman 	sk->sk_destruct	   = pppol2tp_session_destruct;
520fd558d18SJames Chapman 
521fd558d18SJames Chapman 	error = 0;
522fd558d18SJames Chapman 
523fd558d18SJames Chapman out:
524fd558d18SJames Chapman 	return error;
525fd558d18SJames Chapman }
526fd558d18SJames Chapman 
5270ad66140SJames Chapman static void pppol2tp_show(struct seq_file *m, void *arg)
5280ad66140SJames Chapman {
5290ad66140SJames Chapman 	struct l2tp_session *session = arg;
530ee40fb2eSGuillaume Nault 	struct sock *sk;
5310ad66140SJames Chapman 
532ee40fb2eSGuillaume Nault 	sk = pppol2tp_session_get_sock(session);
533ee40fb2eSGuillaume Nault 	if (sk) {
534ee40fb2eSGuillaume Nault 		struct pppox_sock *po = pppox_sk(sk);
535ee40fb2eSGuillaume Nault 
5360ad66140SJames Chapman 		seq_printf(m, "   interface %s\n", ppp_dev_name(&po->chan));
537ee40fb2eSGuillaume Nault 		sock_put(sk);
5380ad66140SJames Chapman 	}
5390ad66140SJames Chapman }
5400ad66140SJames Chapman 
541f98be6c6SGuillaume Nault static void pppol2tp_session_init(struct l2tp_session *session)
542f98be6c6SGuillaume Nault {
543f98be6c6SGuillaume Nault 	struct pppol2tp_session *ps;
544f98be6c6SGuillaume Nault 
545f98be6c6SGuillaume Nault 	session->recv_skb = pppol2tp_recv;
546c2ebc256SArnd Bergmann 	if (IS_ENABLED(CONFIG_L2TP_DEBUGFS))
547f98be6c6SGuillaume Nault 		session->show = pppol2tp_show;
548f98be6c6SGuillaume Nault 
549f98be6c6SGuillaume Nault 	ps = l2tp_session_priv(session);
550f98be6c6SGuillaume Nault 	mutex_init(&ps->sk_lock);
551f98be6c6SGuillaume Nault 	ps->owner = current->pid;
552f98be6c6SGuillaume Nault }
553f98be6c6SGuillaume Nault 
554a408194aSGuillaume Nault struct l2tp_connect_info {
555a408194aSGuillaume Nault 	u8 version;
556a408194aSGuillaume Nault 	int fd;
557a408194aSGuillaume Nault 	u32 tunnel_id;
558a408194aSGuillaume Nault 	u32 peer_tunnel_id;
559a408194aSGuillaume Nault 	u32 session_id;
560a408194aSGuillaume Nault 	u32 peer_session_id;
561a408194aSGuillaume Nault };
562a408194aSGuillaume Nault 
563a408194aSGuillaume Nault static int pppol2tp_sockaddr_get_info(const void *sa, int sa_len,
564a408194aSGuillaume Nault 				      struct l2tp_connect_info *info)
565a408194aSGuillaume Nault {
566a408194aSGuillaume Nault 	switch (sa_len) {
567a408194aSGuillaume Nault 	case sizeof(struct sockaddr_pppol2tp):
568a408194aSGuillaume Nault 	{
569a408194aSGuillaume Nault 		const struct sockaddr_pppol2tp *sa_v2in4 = sa;
570a408194aSGuillaume Nault 
571a408194aSGuillaume Nault 		if (sa_v2in4->sa_protocol != PX_PROTO_OL2TP)
572a408194aSGuillaume Nault 			return -EINVAL;
573a408194aSGuillaume Nault 
574a408194aSGuillaume Nault 		info->version = 2;
575a408194aSGuillaume Nault 		info->fd = sa_v2in4->pppol2tp.fd;
576a408194aSGuillaume Nault 		info->tunnel_id = sa_v2in4->pppol2tp.s_tunnel;
577a408194aSGuillaume Nault 		info->peer_tunnel_id = sa_v2in4->pppol2tp.d_tunnel;
578a408194aSGuillaume Nault 		info->session_id = sa_v2in4->pppol2tp.s_session;
579a408194aSGuillaume Nault 		info->peer_session_id = sa_v2in4->pppol2tp.d_session;
580a408194aSGuillaume Nault 
581a408194aSGuillaume Nault 		break;
582a408194aSGuillaume Nault 	}
583a408194aSGuillaume Nault 	case sizeof(struct sockaddr_pppol2tpv3):
584a408194aSGuillaume Nault 	{
585a408194aSGuillaume Nault 		const struct sockaddr_pppol2tpv3 *sa_v3in4 = sa;
586a408194aSGuillaume Nault 
587a408194aSGuillaume Nault 		if (sa_v3in4->sa_protocol != PX_PROTO_OL2TP)
588a408194aSGuillaume Nault 			return -EINVAL;
589a408194aSGuillaume Nault 
590a408194aSGuillaume Nault 		info->version = 3;
591a408194aSGuillaume Nault 		info->fd = sa_v3in4->pppol2tp.fd;
592a408194aSGuillaume Nault 		info->tunnel_id = sa_v3in4->pppol2tp.s_tunnel;
593a408194aSGuillaume Nault 		info->peer_tunnel_id = sa_v3in4->pppol2tp.d_tunnel;
594a408194aSGuillaume Nault 		info->session_id = sa_v3in4->pppol2tp.s_session;
595a408194aSGuillaume Nault 		info->peer_session_id = sa_v3in4->pppol2tp.d_session;
596a408194aSGuillaume Nault 
597a408194aSGuillaume Nault 		break;
598a408194aSGuillaume Nault 	}
599a408194aSGuillaume Nault 	case sizeof(struct sockaddr_pppol2tpin6):
600a408194aSGuillaume Nault 	{
601a408194aSGuillaume Nault 		const struct sockaddr_pppol2tpin6 *sa_v2in6 = sa;
602a408194aSGuillaume Nault 
603a408194aSGuillaume Nault 		if (sa_v2in6->sa_protocol != PX_PROTO_OL2TP)
604a408194aSGuillaume Nault 			return -EINVAL;
605a408194aSGuillaume Nault 
606a408194aSGuillaume Nault 		info->version = 2;
607a408194aSGuillaume Nault 		info->fd = sa_v2in6->pppol2tp.fd;
608a408194aSGuillaume Nault 		info->tunnel_id = sa_v2in6->pppol2tp.s_tunnel;
609a408194aSGuillaume Nault 		info->peer_tunnel_id = sa_v2in6->pppol2tp.d_tunnel;
610a408194aSGuillaume Nault 		info->session_id = sa_v2in6->pppol2tp.s_session;
611a408194aSGuillaume Nault 		info->peer_session_id = sa_v2in6->pppol2tp.d_session;
612a408194aSGuillaume Nault 
613a408194aSGuillaume Nault 		break;
614a408194aSGuillaume Nault 	}
615a408194aSGuillaume Nault 	case sizeof(struct sockaddr_pppol2tpv3in6):
616a408194aSGuillaume Nault 	{
617a408194aSGuillaume Nault 		const struct sockaddr_pppol2tpv3in6 *sa_v3in6 = sa;
618a408194aSGuillaume Nault 
619a408194aSGuillaume Nault 		if (sa_v3in6->sa_protocol != PX_PROTO_OL2TP)
620a408194aSGuillaume Nault 			return -EINVAL;
621a408194aSGuillaume Nault 
622a408194aSGuillaume Nault 		info->version = 3;
623a408194aSGuillaume Nault 		info->fd = sa_v3in6->pppol2tp.fd;
624a408194aSGuillaume Nault 		info->tunnel_id = sa_v3in6->pppol2tp.s_tunnel;
625a408194aSGuillaume Nault 		info->peer_tunnel_id = sa_v3in6->pppol2tp.d_tunnel;
626a408194aSGuillaume Nault 		info->session_id = sa_v3in6->pppol2tp.s_session;
627a408194aSGuillaume Nault 		info->peer_session_id = sa_v3in6->pppol2tp.d_session;
628a408194aSGuillaume Nault 
629a408194aSGuillaume Nault 		break;
630a408194aSGuillaume Nault 	}
631a408194aSGuillaume Nault 	default:
632a408194aSGuillaume Nault 		return -EINVAL;
633a408194aSGuillaume Nault 	}
634a408194aSGuillaume Nault 
635a408194aSGuillaume Nault 	return 0;
636a408194aSGuillaume Nault }
637a408194aSGuillaume Nault 
638789141b2SGuillaume Nault /* Rough estimation of the maximum payload size a tunnel can transmit without
639789141b2SGuillaume Nault  * fragmenting at the lower IP layer. Assumes L2TPv2 with sequence
640789141b2SGuillaume Nault  * numbers and no IP option. Not quite accurate, but the result is mostly
641789141b2SGuillaume Nault  * unused anyway.
642789141b2SGuillaume Nault  */
643789141b2SGuillaume Nault static int pppol2tp_tunnel_mtu(const struct l2tp_tunnel *tunnel)
644789141b2SGuillaume Nault {
645789141b2SGuillaume Nault 	int mtu;
646789141b2SGuillaume Nault 
647789141b2SGuillaume Nault 	mtu = l2tp_tunnel_dst_mtu(tunnel);
648789141b2SGuillaume Nault 	if (mtu <= PPPOL2TP_HEADER_OVERHEAD)
649789141b2SGuillaume Nault 		return 1500 - PPPOL2TP_HEADER_OVERHEAD;
650789141b2SGuillaume Nault 
651789141b2SGuillaume Nault 	return mtu - PPPOL2TP_HEADER_OVERHEAD;
652789141b2SGuillaume Nault }
653789141b2SGuillaume Nault 
654fd558d18SJames Chapman /* connect() handler. Attach a PPPoX socket to a tunnel UDP socket
655fd558d18SJames Chapman  */
656fd558d18SJames Chapman static int pppol2tp_connect(struct socket *sock, struct sockaddr *uservaddr,
657fd558d18SJames Chapman 			    int sockaddr_len, int flags)
658fd558d18SJames Chapman {
659fd558d18SJames Chapman 	struct sock *sk = sock->sk;
660fd558d18SJames Chapman 	struct pppox_sock *po = pppox_sk(sk);
661fd558d18SJames Chapman 	struct l2tp_session *session = NULL;
662a408194aSGuillaume Nault 	struct l2tp_connect_info info;
663fd558d18SJames Chapman 	struct l2tp_tunnel *tunnel;
664fd558d18SJames Chapman 	struct pppol2tp_session *ps;
665fd558d18SJames Chapman 	struct l2tp_session_cfg cfg = { 0, };
666dbdbc73bSGuillaume Nault 	bool drop_refcnt = false;
667f9e56bafSGuillaume Nault 	bool drop_tunnel = false;
668bda06be2SGuillaume Nault 	bool new_session = false;
669bda06be2SGuillaume Nault 	bool new_tunnel = false;
670a408194aSGuillaume Nault 	int error;
671a408194aSGuillaume Nault 
672a408194aSGuillaume Nault 	error = pppol2tp_sockaddr_get_info(uservaddr, sockaddr_len, &info);
673a408194aSGuillaume Nault 	if (error < 0)
674a408194aSGuillaume Nault 		return error;
675fd558d18SJames Chapman 
676fd558d18SJames Chapman 	lock_sock(sk);
677fd558d18SJames Chapman 
678fd558d18SJames Chapman 	/* Check for already bound sockets */
679fd558d18SJames Chapman 	error = -EBUSY;
680fd558d18SJames Chapman 	if (sk->sk_state & PPPOX_CONNECTED)
681fd558d18SJames Chapman 		goto end;
682fd558d18SJames Chapman 
683fd558d18SJames Chapman 	/* We don't supporting rebinding anyway */
684fd558d18SJames Chapman 	error = -EALREADY;
685fd558d18SJames Chapman 	if (sk->sk_user_data)
686fd558d18SJames Chapman 		goto end; /* socket is already attached */
687fd558d18SJames Chapman 
688e0d4435fSJames Chapman 	/* Don't bind if tunnel_id is 0 */
689e0d4435fSJames Chapman 	error = -EINVAL;
690a408194aSGuillaume Nault 	if (!info.tunnel_id)
691fd558d18SJames Chapman 		goto end;
692fd558d18SJames Chapman 
693a408194aSGuillaume Nault 	tunnel = l2tp_tunnel_get(sock_net(sk), info.tunnel_id);
694f9e56bafSGuillaume Nault 	if (tunnel)
695f9e56bafSGuillaume Nault 		drop_tunnel = true;
696309795f4SJames Chapman 
697e0d4435fSJames Chapman 	/* Special case: create tunnel context if session_id and
698e0d4435fSJames Chapman 	 * peer_session_id is 0. Otherwise look up tunnel using supplied
699fd558d18SJames Chapman 	 * tunnel id.
700fd558d18SJames Chapman 	 */
701a408194aSGuillaume Nault 	if (!info.session_id && !info.peer_session_id) {
7020febc7b3STom Parkin 		if (!tunnel) {
703309795f4SJames Chapman 			struct l2tp_tunnel_cfg tcfg = {
704309795f4SJames Chapman 				.encap = L2TP_ENCAPTYPE_UDP,
705309795f4SJames Chapman 			};
7063e1bc8bfSGuillaume Nault 
7073e1bc8bfSGuillaume Nault 			/* Prevent l2tp_tunnel_register() from trying to set up
7083e1bc8bfSGuillaume Nault 			 * a kernel socket.
7093e1bc8bfSGuillaume Nault 			 */
710a408194aSGuillaume Nault 			if (info.fd < 0) {
7113e1bc8bfSGuillaume Nault 				error = -EBADF;
7123e1bc8bfSGuillaume Nault 				goto end;
7133e1bc8bfSGuillaume Nault 			}
7143e1bc8bfSGuillaume Nault 
715c9ccd4c6STom Parkin 			error = l2tp_tunnel_create(info.fd,
716a408194aSGuillaume Nault 						   info.version,
717a408194aSGuillaume Nault 						   info.tunnel_id,
718a408194aSGuillaume Nault 						   info.peer_tunnel_id, &tcfg,
719a408194aSGuillaume Nault 						   &tunnel);
720fd558d18SJames Chapman 			if (error < 0)
721fd558d18SJames Chapman 				goto end;
7226b9f3423SGuillaume Nault 
7236b9f3423SGuillaume Nault 			l2tp_tunnel_inc_refcount(tunnel);
7246b9f3423SGuillaume Nault 			error = l2tp_tunnel_register(tunnel, sock_net(sk),
7256b9f3423SGuillaume Nault 						     &tcfg);
7266b9f3423SGuillaume Nault 			if (error < 0) {
7276b9f3423SGuillaume Nault 				kfree(tunnel);
7286b9f3423SGuillaume Nault 				goto end;
7296b9f3423SGuillaume Nault 			}
7306b9f3423SGuillaume Nault 			drop_tunnel = true;
731bda06be2SGuillaume Nault 			new_tunnel = true;
732309795f4SJames Chapman 		}
733fd558d18SJames Chapman 	} else {
734fd558d18SJames Chapman 		/* Error if we can't find the tunnel */
735fd558d18SJames Chapman 		error = -ENOENT;
7360febc7b3STom Parkin 		if (!tunnel)
737fd558d18SJames Chapman 			goto end;
738fd558d18SJames Chapman 
739fd558d18SJames Chapman 		/* Error if socket is not prepped */
7400febc7b3STom Parkin 		if (!tunnel->sock)
741fd558d18SJames Chapman 			goto end;
742fd558d18SJames Chapman 	}
743fd558d18SJames Chapman 
744b79585f5SJames Chapman 	if (tunnel->peer_tunnel_id == 0)
745a408194aSGuillaume Nault 		tunnel->peer_tunnel_id = info.peer_tunnel_id;
746fd558d18SJames Chapman 
74701e28b92SGuillaume Nault 	session = l2tp_tunnel_get_session(tunnel, info.session_id);
748dbdbc73bSGuillaume Nault 	if (session) {
749dbdbc73bSGuillaume Nault 		drop_refcnt = true;
7507ac6ab1fSGuillaume Nault 
7517ac6ab1fSGuillaume Nault 		if (session->pwtype != L2TP_PWTYPE_PPP) {
7527ac6ab1fSGuillaume Nault 			error = -EPROTOTYPE;
7537ac6ab1fSGuillaume Nault 			goto end;
7547ac6ab1fSGuillaume Nault 		}
7557ac6ab1fSGuillaume Nault 
756dbdbc73bSGuillaume Nault 		ps = l2tp_session_priv(session);
757fd558d18SJames Chapman 
758dbdbc73bSGuillaume Nault 		/* Using a pre-existing session is fine as long as it hasn't
759dbdbc73bSGuillaume Nault 		 * been connected yet.
760dbdbc73bSGuillaume Nault 		 */
761ee40fb2eSGuillaume Nault 		mutex_lock(&ps->sk_lock);
762ee40fb2eSGuillaume Nault 		if (rcu_dereference_protected(ps->sk,
7633d609342SGuillaume Nault 					      lockdep_is_held(&ps->sk_lock)) ||
7643d609342SGuillaume Nault 		    ps->__sk) {
765ee40fb2eSGuillaume Nault 			mutex_unlock(&ps->sk_lock);
766dbdbc73bSGuillaume Nault 			error = -EEXIST;
767dbdbc73bSGuillaume Nault 			goto end;
768dbdbc73bSGuillaume Nault 		}
769309795f4SJames Chapman 	} else {
77090904ff5SGuillaume Nault 		cfg.pw_type = L2TP_PWTYPE_PPP;
771fd558d18SJames Chapman 
772dbdbc73bSGuillaume Nault 		session = l2tp_session_create(sizeof(struct pppol2tp_session),
773a408194aSGuillaume Nault 					      tunnel, info.session_id,
774a408194aSGuillaume Nault 					      info.peer_session_id, &cfg);
775dbdbc73bSGuillaume Nault 		if (IS_ERR(session)) {
776dbdbc73bSGuillaume Nault 			error = PTR_ERR(session);
777309795f4SJames Chapman 			goto end;
778309795f4SJames Chapman 		}
7793953ae7bSGuillaume Nault 
780f98be6c6SGuillaume Nault 		pppol2tp_session_init(session);
781ee40fb2eSGuillaume Nault 		ps = l2tp_session_priv(session);
7823953ae7bSGuillaume Nault 		l2tp_session_inc_refcount(session);
783ee40fb2eSGuillaume Nault 
784ee40fb2eSGuillaume Nault 		mutex_lock(&ps->sk_lock);
7853953ae7bSGuillaume Nault 		error = l2tp_session_register(session, tunnel);
7863953ae7bSGuillaume Nault 		if (error < 0) {
787ee40fb2eSGuillaume Nault 			mutex_unlock(&ps->sk_lock);
7883953ae7bSGuillaume Nault 			kfree(session);
7893953ae7bSGuillaume Nault 			goto end;
7903953ae7bSGuillaume Nault 		}
7913953ae7bSGuillaume Nault 		drop_refcnt = true;
792bda06be2SGuillaume Nault 		new_session = true;
793dbdbc73bSGuillaume Nault 	}
794309795f4SJames Chapman 
795fd558d18SJames Chapman 	/* Special case: if source & dest session_id == 0x0000, this
796fd558d18SJames Chapman 	 * socket is being created to manage the tunnel. Just set up
797fd558d18SJames Chapman 	 * the internal context for use by ioctl() and sockopt()
798fd558d18SJames Chapman 	 * handlers.
799fd558d18SJames Chapman 	 */
8006c0ec37bSTom Parkin 	if (session->session_id == 0 && session->peer_session_id == 0) {
801fd558d18SJames Chapman 		error = 0;
802fd558d18SJames Chapman 		goto out_no_ppp;
803fd558d18SJames Chapman 	}
804fd558d18SJames Chapman 
805fd558d18SJames Chapman 	/* The only header we need to worry about is the L2TP
806fd558d18SJames Chapman 	 * header. This size is different depending on whether
807fd558d18SJames Chapman 	 * sequence numbers are enabled for the data channel.
808fd558d18SJames Chapman 	 */
809fd558d18SJames Chapman 	po->chan.hdrlen = PPPOL2TP_L2TP_HDR_SIZE_NOSEQ;
810fd558d18SJames Chapman 
811fd558d18SJames Chapman 	po->chan.private = sk;
812fd558d18SJames Chapman 	po->chan.ops	 = &pppol2tp_chan_ops;
813789141b2SGuillaume Nault 	po->chan.mtu	 = pppol2tp_tunnel_mtu(tunnel);
814fd558d18SJames Chapman 
815fd558d18SJames Chapman 	error = ppp_register_net_channel(sock_net(sk), &po->chan);
816ee40fb2eSGuillaume Nault 	if (error) {
817ee40fb2eSGuillaume Nault 		mutex_unlock(&ps->sk_lock);
818fd558d18SJames Chapman 		goto end;
819ee40fb2eSGuillaume Nault 	}
820fd558d18SJames Chapman 
821fd558d18SJames Chapman out_no_ppp:
822fd558d18SJames Chapman 	/* This is how we get the session context from the socket. */
823fd558d18SJames Chapman 	sk->sk_user_data = session;
824ee40fb2eSGuillaume Nault 	rcu_assign_pointer(ps->sk, sk);
825ee40fb2eSGuillaume Nault 	mutex_unlock(&ps->sk_lock);
826ee40fb2eSGuillaume Nault 
827f98be6c6SGuillaume Nault 	/* Keep the reference we've grabbed on the session: sk doesn't expect
828f98be6c6SGuillaume Nault 	 * the session to disappear. pppol2tp_session_destruct() is responsible
829f98be6c6SGuillaume Nault 	 * for dropping it.
830f98be6c6SGuillaume Nault 	 */
831f98be6c6SGuillaume Nault 	drop_refcnt = false;
832f98be6c6SGuillaume Nault 
833fd558d18SJames Chapman 	sk->sk_state = PPPOX_CONNECTED;
834fd558d18SJames Chapman 
835fd558d18SJames Chapman end:
836bda06be2SGuillaume Nault 	if (error) {
837bda06be2SGuillaume Nault 		if (new_session)
838bda06be2SGuillaume Nault 			l2tp_session_delete(session);
839bda06be2SGuillaume Nault 		if (new_tunnel)
840bda06be2SGuillaume Nault 			l2tp_tunnel_delete(tunnel);
841bda06be2SGuillaume Nault 	}
842dbdbc73bSGuillaume Nault 	if (drop_refcnt)
843dbdbc73bSGuillaume Nault 		l2tp_session_dec_refcount(session);
844f9e56bafSGuillaume Nault 	if (drop_tunnel)
845f9e56bafSGuillaume Nault 		l2tp_tunnel_dec_refcount(tunnel);
846fd558d18SJames Chapman 	release_sock(sk);
847fd558d18SJames Chapman 
848fd558d18SJames Chapman 	return error;
849fd558d18SJames Chapman }
850fd558d18SJames Chapman 
851309795f4SJames Chapman #ifdef CONFIG_L2TP_V3
852309795f4SJames Chapman 
853f026bc29SGuillaume Nault /* Called when creating sessions via the netlink interface. */
854f026bc29SGuillaume Nault static int pppol2tp_session_create(struct net *net, struct l2tp_tunnel *tunnel,
855f026bc29SGuillaume Nault 				   u32 session_id, u32 peer_session_id,
856f026bc29SGuillaume Nault 				   struct l2tp_session_cfg *cfg)
857309795f4SJames Chapman {
858309795f4SJames Chapman 	int error;
859309795f4SJames Chapman 	struct l2tp_session *session;
860309795f4SJames Chapman 
861309795f4SJames Chapman 	/* Error if tunnel socket is not prepped */
862f026bc29SGuillaume Nault 	if (!tunnel->sock) {
863f026bc29SGuillaume Nault 		error = -ENOENT;
8643953ae7bSGuillaume Nault 		goto err;
865f026bc29SGuillaume Nault 	}
866309795f4SJames Chapman 
867309795f4SJames Chapman 	/* Allocate and initialize a new session context. */
868309795f4SJames Chapman 	session = l2tp_session_create(sizeof(struct pppol2tp_session),
869309795f4SJames Chapman 				      tunnel, session_id,
870309795f4SJames Chapman 				      peer_session_id, cfg);
871dbdbc73bSGuillaume Nault 	if (IS_ERR(session)) {
872dbdbc73bSGuillaume Nault 		error = PTR_ERR(session);
8733953ae7bSGuillaume Nault 		goto err;
874dbdbc73bSGuillaume Nault 	}
875309795f4SJames Chapman 
876f98be6c6SGuillaume Nault 	pppol2tp_session_init(session);
877309795f4SJames Chapman 
8783953ae7bSGuillaume Nault 	error = l2tp_session_register(session, tunnel);
8793953ae7bSGuillaume Nault 	if (error < 0)
8803953ae7bSGuillaume Nault 		goto err_sess;
881309795f4SJames Chapman 
8823953ae7bSGuillaume Nault 	return 0;
883309795f4SJames Chapman 
8843953ae7bSGuillaume Nault err_sess:
8853953ae7bSGuillaume Nault 	kfree(session);
8863953ae7bSGuillaume Nault err:
887309795f4SJames Chapman 	return error;
888309795f4SJames Chapman }
889309795f4SJames Chapman 
890309795f4SJames Chapman #endif /* CONFIG_L2TP_V3 */
891309795f4SJames Chapman 
892fd558d18SJames Chapman /* getname() support.
893fd558d18SJames Chapman  */
894fd558d18SJames Chapman static int pppol2tp_getname(struct socket *sock, struct sockaddr *uaddr,
8959b2c45d4SDenys Vlasenko 			    int peer)
896fd558d18SJames Chapman {
897e0d4435fSJames Chapman 	int len = 0;
898fd558d18SJames Chapman 	int error = 0;
899fd558d18SJames Chapman 	struct l2tp_session *session;
900fd558d18SJames Chapman 	struct l2tp_tunnel *tunnel;
901fd558d18SJames Chapman 	struct sock *sk = sock->sk;
902fd558d18SJames Chapman 	struct inet_sock *inet;
903fd558d18SJames Chapman 	struct pppol2tp_session *pls;
904fd558d18SJames Chapman 
905fd558d18SJames Chapman 	error = -ENOTCONN;
9060febc7b3STom Parkin 	if (!sk)
907fd558d18SJames Chapman 		goto end;
90856cff471SGao Feng 	if (!(sk->sk_state & PPPOX_CONNECTED))
909fd558d18SJames Chapman 		goto end;
910fd558d18SJames Chapman 
911fd558d18SJames Chapman 	error = -EBADF;
912fd558d18SJames Chapman 	session = pppol2tp_sock_to_session(sk);
9130febc7b3STom Parkin 	if (!session)
914fd558d18SJames Chapman 		goto end;
915fd558d18SJames Chapman 
916fd558d18SJames Chapman 	pls = l2tp_session_priv(session);
9177198c77aSGuillaume Nault 	tunnel = session->tunnel;
918fd558d18SJames Chapman 
919bbdb32cbSBenjamin LaHaise 	inet = inet_sk(tunnel->sock);
9206c0ec37bSTom Parkin 	if (tunnel->version == 2 && tunnel->sock->sk_family == AF_INET) {
921e0d4435fSJames Chapman 		struct sockaddr_pppol2tp sp;
922b71a61ccSTom Parkin 
923e0d4435fSJames Chapman 		len = sizeof(sp);
924fd558d18SJames Chapman 		memset(&sp, 0, len);
925fd558d18SJames Chapman 		sp.sa_family	= AF_PPPOX;
926fd558d18SJames Chapman 		sp.sa_protocol	= PX_PROTO_OL2TP;
927fd558d18SJames Chapman 		sp.pppol2tp.fd  = tunnel->fd;
928fd558d18SJames Chapman 		sp.pppol2tp.pid = pls->owner;
929fd558d18SJames Chapman 		sp.pppol2tp.s_tunnel = tunnel->tunnel_id;
930fd558d18SJames Chapman 		sp.pppol2tp.d_tunnel = tunnel->peer_tunnel_id;
931fd558d18SJames Chapman 		sp.pppol2tp.s_session = session->session_id;
932fd558d18SJames Chapman 		sp.pppol2tp.d_session = session->peer_session_id;
933fd558d18SJames Chapman 		sp.pppol2tp.addr.sin_family = AF_INET;
934fd558d18SJames Chapman 		sp.pppol2tp.addr.sin_port = inet->inet_dport;
935fd558d18SJames Chapman 		sp.pppol2tp.addr.sin_addr.s_addr = inet->inet_daddr;
936fd558d18SJames Chapman 		memcpy(uaddr, &sp, len);
937d2cf3361SBenjamin LaHaise #if IS_ENABLED(CONFIG_IPV6)
9386c0ec37bSTom Parkin 	} else if (tunnel->version == 2 && tunnel->sock->sk_family == AF_INET6) {
939d2cf3361SBenjamin LaHaise 		struct sockaddr_pppol2tpin6 sp;
940efe4208fSEric Dumazet 
941d2cf3361SBenjamin LaHaise 		len = sizeof(sp);
942d2cf3361SBenjamin LaHaise 		memset(&sp, 0, len);
943d2cf3361SBenjamin LaHaise 		sp.sa_family	= AF_PPPOX;
944d2cf3361SBenjamin LaHaise 		sp.sa_protocol	= PX_PROTO_OL2TP;
945d2cf3361SBenjamin LaHaise 		sp.pppol2tp.fd  = tunnel->fd;
946d2cf3361SBenjamin LaHaise 		sp.pppol2tp.pid = pls->owner;
947d2cf3361SBenjamin LaHaise 		sp.pppol2tp.s_tunnel = tunnel->tunnel_id;
948d2cf3361SBenjamin LaHaise 		sp.pppol2tp.d_tunnel = tunnel->peer_tunnel_id;
949d2cf3361SBenjamin LaHaise 		sp.pppol2tp.s_session = session->session_id;
950d2cf3361SBenjamin LaHaise 		sp.pppol2tp.d_session = session->peer_session_id;
951d2cf3361SBenjamin LaHaise 		sp.pppol2tp.addr.sin6_family = AF_INET6;
952d2cf3361SBenjamin LaHaise 		sp.pppol2tp.addr.sin6_port = inet->inet_dport;
953efe4208fSEric Dumazet 		memcpy(&sp.pppol2tp.addr.sin6_addr, &tunnel->sock->sk_v6_daddr,
954efe4208fSEric Dumazet 		       sizeof(tunnel->sock->sk_v6_daddr));
955d2cf3361SBenjamin LaHaise 		memcpy(uaddr, &sp, len);
9566c0ec37bSTom Parkin 	} else if (tunnel->version == 3 && tunnel->sock->sk_family == AF_INET6) {
957d2cf3361SBenjamin LaHaise 		struct sockaddr_pppol2tpv3in6 sp;
958efe4208fSEric Dumazet 
959d2cf3361SBenjamin LaHaise 		len = sizeof(sp);
960d2cf3361SBenjamin LaHaise 		memset(&sp, 0, len);
961d2cf3361SBenjamin LaHaise 		sp.sa_family	= AF_PPPOX;
962d2cf3361SBenjamin LaHaise 		sp.sa_protocol	= PX_PROTO_OL2TP;
963d2cf3361SBenjamin LaHaise 		sp.pppol2tp.fd  = tunnel->fd;
964d2cf3361SBenjamin LaHaise 		sp.pppol2tp.pid = pls->owner;
965d2cf3361SBenjamin LaHaise 		sp.pppol2tp.s_tunnel = tunnel->tunnel_id;
966d2cf3361SBenjamin LaHaise 		sp.pppol2tp.d_tunnel = tunnel->peer_tunnel_id;
967d2cf3361SBenjamin LaHaise 		sp.pppol2tp.s_session = session->session_id;
968d2cf3361SBenjamin LaHaise 		sp.pppol2tp.d_session = session->peer_session_id;
969d2cf3361SBenjamin LaHaise 		sp.pppol2tp.addr.sin6_family = AF_INET6;
970d2cf3361SBenjamin LaHaise 		sp.pppol2tp.addr.sin6_port = inet->inet_dport;
971efe4208fSEric Dumazet 		memcpy(&sp.pppol2tp.addr.sin6_addr, &tunnel->sock->sk_v6_daddr,
972efe4208fSEric Dumazet 		       sizeof(tunnel->sock->sk_v6_daddr));
973d2cf3361SBenjamin LaHaise 		memcpy(uaddr, &sp, len);
974d2cf3361SBenjamin LaHaise #endif
975e0d4435fSJames Chapman 	} else if (tunnel->version == 3) {
976e0d4435fSJames Chapman 		struct sockaddr_pppol2tpv3 sp;
977b71a61ccSTom Parkin 
978e0d4435fSJames Chapman 		len = sizeof(sp);
979e0d4435fSJames Chapman 		memset(&sp, 0, len);
980e0d4435fSJames Chapman 		sp.sa_family	= AF_PPPOX;
981e0d4435fSJames Chapman 		sp.sa_protocol	= PX_PROTO_OL2TP;
982e0d4435fSJames Chapman 		sp.pppol2tp.fd  = tunnel->fd;
983e0d4435fSJames Chapman 		sp.pppol2tp.pid = pls->owner;
984e0d4435fSJames Chapman 		sp.pppol2tp.s_tunnel = tunnel->tunnel_id;
985e0d4435fSJames Chapman 		sp.pppol2tp.d_tunnel = tunnel->peer_tunnel_id;
986e0d4435fSJames Chapman 		sp.pppol2tp.s_session = session->session_id;
987e0d4435fSJames Chapman 		sp.pppol2tp.d_session = session->peer_session_id;
988e0d4435fSJames Chapman 		sp.pppol2tp.addr.sin_family = AF_INET;
989e0d4435fSJames Chapman 		sp.pppol2tp.addr.sin_port = inet->inet_dport;
990e0d4435fSJames Chapman 		sp.pppol2tp.addr.sin_addr.s_addr = inet->inet_daddr;
991e0d4435fSJames Chapman 		memcpy(uaddr, &sp, len);
992e0d4435fSJames Chapman 	}
993fd558d18SJames Chapman 
9949b2c45d4SDenys Vlasenko 	error = len;
995fd558d18SJames Chapman 
996fd558d18SJames Chapman 	sock_put(sk);
997fd558d18SJames Chapman end:
998fd558d18SJames Chapman 	return error;
999fd558d18SJames Chapman }
1000fd558d18SJames Chapman 
1001fd558d18SJames Chapman /****************************************************************************
1002fd558d18SJames Chapman  * ioctl() handlers.
1003fd558d18SJames Chapman  *
1004fd558d18SJames Chapman  * The PPPoX socket is created for L2TP sessions: tunnels have their own UDP
1005fd558d18SJames Chapman  * sockets. However, in order to control kernel tunnel features, we allow
1006fd558d18SJames Chapman  * userspace to create a special "tunnel" PPPoX socket which is used for
1007fd558d18SJames Chapman  * control only.  Tunnel PPPoX sockets have session_id == 0 and simply allow
1008fd558d18SJames Chapman  * the user application to issue L2TP setsockopt(), getsockopt() and ioctl()
1009fd558d18SJames Chapman  * calls.
1010fd558d18SJames Chapman  ****************************************************************************/
1011fd558d18SJames Chapman 
1012fd558d18SJames Chapman static void pppol2tp_copy_stats(struct pppol2tp_ioc_stats *dest,
10137390ed8aSGuillaume Nault 				const struct l2tp_stats *stats)
1014fd558d18SJames Chapman {
10157390ed8aSGuillaume Nault 	memset(dest, 0, sizeof(*dest));
10167390ed8aSGuillaume Nault 
10177b7c0719STom Parkin 	dest->tx_packets = atomic_long_read(&stats->tx_packets);
10187b7c0719STom Parkin 	dest->tx_bytes = atomic_long_read(&stats->tx_bytes);
10197b7c0719STom Parkin 	dest->tx_errors = atomic_long_read(&stats->tx_errors);
10207b7c0719STom Parkin 	dest->rx_packets = atomic_long_read(&stats->rx_packets);
10217b7c0719STom Parkin 	dest->rx_bytes = atomic_long_read(&stats->rx_bytes);
10227b7c0719STom Parkin 	dest->rx_seq_discards = atomic_long_read(&stats->rx_seq_discards);
10237b7c0719STom Parkin 	dest->rx_oos_packets = atomic_long_read(&stats->rx_oos_packets);
10247b7c0719STom Parkin 	dest->rx_errors = atomic_long_read(&stats->rx_errors);
1025fd558d18SJames Chapman }
1026fd558d18SJames Chapman 
1027528534f0SGuillaume Nault static int pppol2tp_tunnel_copy_stats(struct pppol2tp_ioc_stats *stats,
1028528534f0SGuillaume Nault 				      struct l2tp_tunnel *tunnel)
1029528534f0SGuillaume Nault {
1030528534f0SGuillaume Nault 	struct l2tp_session *session;
1031528534f0SGuillaume Nault 
1032528534f0SGuillaume Nault 	if (!stats->session_id) {
1033528534f0SGuillaume Nault 		pppol2tp_copy_stats(stats, &tunnel->stats);
1034528534f0SGuillaume Nault 		return 0;
1035528534f0SGuillaume Nault 	}
1036528534f0SGuillaume Nault 
1037528534f0SGuillaume Nault 	/* If session_id is set, search the corresponding session in the
1038528534f0SGuillaume Nault 	 * context of this tunnel and record the session's statistics.
1039528534f0SGuillaume Nault 	 */
1040528534f0SGuillaume Nault 	session = l2tp_tunnel_get_session(tunnel, stats->session_id);
1041528534f0SGuillaume Nault 	if (!session)
1042528534f0SGuillaume Nault 		return -EBADR;
1043528534f0SGuillaume Nault 
1044528534f0SGuillaume Nault 	if (session->pwtype != L2TP_PWTYPE_PPP) {
1045528534f0SGuillaume Nault 		l2tp_session_dec_refcount(session);
1046528534f0SGuillaume Nault 		return -EBADR;
1047528534f0SGuillaume Nault 	}
1048528534f0SGuillaume Nault 
1049528534f0SGuillaume Nault 	pppol2tp_copy_stats(stats, &session->stats);
1050528534f0SGuillaume Nault 	l2tp_session_dec_refcount(session);
1051528534f0SGuillaume Nault 
1052528534f0SGuillaume Nault 	return 0;
1053528534f0SGuillaume Nault }
1054528534f0SGuillaume Nault 
1055fd558d18SJames Chapman static int pppol2tp_ioctl(struct socket *sock, unsigned int cmd,
1056fd558d18SJames Chapman 			  unsigned long arg)
1057fd558d18SJames Chapman {
1058528534f0SGuillaume Nault 	struct pppol2tp_ioc_stats stats;
1059fd558d18SJames Chapman 	struct l2tp_session *session;
1060fd558d18SJames Chapman 
106179e6760eSGuillaume Nault 	switch (cmd) {
106279e6760eSGuillaume Nault 	case PPPIOCGMRU:
106379e6760eSGuillaume Nault 	case PPPIOCGFLAGS:
1064bdd0292fSGuillaume Nault 		session = sock->sk->sk_user_data;
1065bdd0292fSGuillaume Nault 		if (!session)
1066bdd0292fSGuillaume Nault 			return -ENOTCONN;
1067fd558d18SJames Chapman 
1068*45faeff1STom Parkin 		if (WARN_ON(session->magic != L2TP_SESSION_MAGIC))
1069*45faeff1STom Parkin 			return -EBADF;
1070*45faeff1STom Parkin 
107179e6760eSGuillaume Nault 		/* Not defined for tunnels */
107279e6760eSGuillaume Nault 		if (!session->session_id && !session->peer_session_id)
107379e6760eSGuillaume Nault 			return -ENOSYS;
1074bdd0292fSGuillaume Nault 
107579e6760eSGuillaume Nault 		if (put_user(0, (int __user *)arg))
107679e6760eSGuillaume Nault 			return -EFAULT;
107779e6760eSGuillaume Nault 		break;
107879e6760eSGuillaume Nault 
107979e6760eSGuillaume Nault 	case PPPIOCSMRU:
108079e6760eSGuillaume Nault 	case PPPIOCSFLAGS:
108179e6760eSGuillaume Nault 		session = sock->sk->sk_user_data;
108279e6760eSGuillaume Nault 		if (!session)
108379e6760eSGuillaume Nault 			return -ENOTCONN;
108479e6760eSGuillaume Nault 
1085*45faeff1STom Parkin 		if (WARN_ON(session->magic != L2TP_SESSION_MAGIC))
1086*45faeff1STom Parkin 			return -EBADF;
1087*45faeff1STom Parkin 
108879e6760eSGuillaume Nault 		/* Not defined for tunnels */
108979e6760eSGuillaume Nault 		if (!session->session_id && !session->peer_session_id)
109079e6760eSGuillaume Nault 			return -ENOSYS;
109179e6760eSGuillaume Nault 
1092503c0188SJakub Kicinski 		if (!access_ok((int __user *)arg, sizeof(int)))
109379e6760eSGuillaume Nault 			return -EFAULT;
109479e6760eSGuillaume Nault 		break;
109579e6760eSGuillaume Nault 
109679e6760eSGuillaume Nault 	case PPPIOCGL2TPSTATS:
109779e6760eSGuillaume Nault 		session = sock->sk->sk_user_data;
109879e6760eSGuillaume Nault 		if (!session)
109979e6760eSGuillaume Nault 			return -ENOTCONN;
110079e6760eSGuillaume Nault 
1101*45faeff1STom Parkin 		if (WARN_ON(session->magic != L2TP_SESSION_MAGIC))
1102*45faeff1STom Parkin 			return -EBADF;
1103*45faeff1STom Parkin 
110479e6760eSGuillaume Nault 		/* Session 0 represents the parent tunnel */
1105528534f0SGuillaume Nault 		if (!session->session_id && !session->peer_session_id) {
1106528534f0SGuillaume Nault 			u32 session_id;
1107528534f0SGuillaume Nault 			int err;
1108528534f0SGuillaume Nault 
1109528534f0SGuillaume Nault 			if (copy_from_user(&stats, (void __user *)arg,
1110528534f0SGuillaume Nault 					   sizeof(stats)))
1111528534f0SGuillaume Nault 				return -EFAULT;
1112528534f0SGuillaume Nault 
1113528534f0SGuillaume Nault 			session_id = stats.session_id;
1114528534f0SGuillaume Nault 			err = pppol2tp_tunnel_copy_stats(&stats,
1115528534f0SGuillaume Nault 							 session->tunnel);
1116528534f0SGuillaume Nault 			if (err < 0)
1117528534f0SGuillaume Nault 				return err;
1118528534f0SGuillaume Nault 
1119528534f0SGuillaume Nault 			stats.session_id = session_id;
1120528534f0SGuillaume Nault 		} else {
1121b0e29063SGuillaume Nault 			pppol2tp_copy_stats(&stats, &session->stats);
1122b0e29063SGuillaume Nault 			stats.session_id = session->session_id;
1123528534f0SGuillaume Nault 		}
1124528534f0SGuillaume Nault 		stats.tunnel_id = session->tunnel->tunnel_id;
1125528534f0SGuillaume Nault 		stats.using_ipsec = l2tp_tunnel_uses_xfrm(session->tunnel);
1126528534f0SGuillaume Nault 
1127528534f0SGuillaume Nault 		if (copy_to_user((void __user *)arg, &stats, sizeof(stats)))
1128528534f0SGuillaume Nault 			return -EFAULT;
112979e6760eSGuillaume Nault 		break;
113079e6760eSGuillaume Nault 
113179e6760eSGuillaume Nault 	default:
11324f5f85e9SGuillaume Nault 		return -ENOIOCTLCMD;
1133fd558d18SJames Chapman 	}
1134fd558d18SJames Chapman 
113579e6760eSGuillaume Nault 	return 0;
1136fd558d18SJames Chapman }
1137fd558d18SJames Chapman 
1138fd558d18SJames Chapman /*****************************************************************************
1139fd558d18SJames Chapman  * setsockopt() / getsockopt() support.
1140fd558d18SJames Chapman  *
1141fd558d18SJames Chapman  * The PPPoX socket is created for L2TP sessions: tunnels have their own UDP
1142fd558d18SJames Chapman  * sockets. In order to control kernel tunnel features, we allow userspace to
1143fd558d18SJames Chapman  * create a special "tunnel" PPPoX socket which is used for control only.
1144fd558d18SJames Chapman  * Tunnel PPPoX sockets have session_id == 0 and simply allow the user
1145fd558d18SJames Chapman  * application to issue L2TP setsockopt(), getsockopt() and ioctl() calls.
1146fd558d18SJames Chapman  *****************************************************************************/
1147fd558d18SJames Chapman 
1148fd558d18SJames Chapman /* Tunnel setsockopt() helper.
1149fd558d18SJames Chapman  */
1150fd558d18SJames Chapman static int pppol2tp_tunnel_setsockopt(struct sock *sk,
1151fd558d18SJames Chapman 				      struct l2tp_tunnel *tunnel,
1152fd558d18SJames Chapman 				      int optname, int val)
1153fd558d18SJames Chapman {
1154fd558d18SJames Chapman 	int err = 0;
1155fd558d18SJames Chapman 
1156fd558d18SJames Chapman 	switch (optname) {
1157fd558d18SJames Chapman 	case PPPOL2TP_SO_DEBUG:
1158eee049c0STom Parkin 		/* Tunnel debug flags option is deprecated */
1159fd558d18SJames Chapman 		break;
1160fd558d18SJames Chapman 
1161fd558d18SJames Chapman 	default:
1162fd558d18SJames Chapman 		err = -ENOPROTOOPT;
1163fd558d18SJames Chapman 		break;
1164fd558d18SJames Chapman 	}
1165fd558d18SJames Chapman 
1166fd558d18SJames Chapman 	return err;
1167fd558d18SJames Chapman }
1168fd558d18SJames Chapman 
1169fd558d18SJames Chapman /* Session setsockopt helper.
1170fd558d18SJames Chapman  */
1171fd558d18SJames Chapman static int pppol2tp_session_setsockopt(struct sock *sk,
1172fd558d18SJames Chapman 				       struct l2tp_session *session,
1173fd558d18SJames Chapman 				       int optname, int val)
1174fd558d18SJames Chapman {
1175fd558d18SJames Chapman 	int err = 0;
1176fd558d18SJames Chapman 
1177fd558d18SJames Chapman 	switch (optname) {
1178fd558d18SJames Chapman 	case PPPOL2TP_SO_RECVSEQ:
11796c0ec37bSTom Parkin 		if (val != 0 && val != 1) {
1180fd558d18SJames Chapman 			err = -EINVAL;
1181fd558d18SJames Chapman 			break;
1182fd558d18SJames Chapman 		}
11833f9b9770SAsbjørn Sloth Tønnesen 		session->recv_seq = !!val;
1184fd558d18SJames Chapman 		break;
1185fd558d18SJames Chapman 
1186fd558d18SJames Chapman 	case PPPOL2TP_SO_SENDSEQ:
11876c0ec37bSTom Parkin 		if (val != 0 && val != 1) {
1188fd558d18SJames Chapman 			err = -EINVAL;
1189fd558d18SJames Chapman 			break;
1190fd558d18SJames Chapman 		}
11913f9b9770SAsbjørn Sloth Tønnesen 		session->send_seq = !!val;
1192fd558d18SJames Chapman 		{
1193ee40fb2eSGuillaume Nault 			struct pppox_sock *po = pppox_sk(sk);
1194ee40fb2eSGuillaume Nault 
1195fd558d18SJames Chapman 			po->chan.hdrlen = val ? PPPOL2TP_L2TP_HDR_SIZE_SEQ :
1196fd558d18SJames Chapman 				PPPOL2TP_L2TP_HDR_SIZE_NOSEQ;
1197fd558d18SJames Chapman 		}
1198bb5016eaSGuillaume Nault 		l2tp_session_set_header_len(session, session->tunnel->version);
1199fd558d18SJames Chapman 		break;
1200fd558d18SJames Chapman 
1201fd558d18SJames Chapman 	case PPPOL2TP_SO_LNSMODE:
12026c0ec37bSTom Parkin 		if (val != 0 && val != 1) {
1203fd558d18SJames Chapman 			err = -EINVAL;
1204fd558d18SJames Chapman 			break;
1205fd558d18SJames Chapman 		}
12063f9b9770SAsbjørn Sloth Tønnesen 		session->lns_mode = !!val;
1207fd558d18SJames Chapman 		break;
1208fd558d18SJames Chapman 
1209fd558d18SJames Chapman 	case PPPOL2TP_SO_DEBUG:
1210eee049c0STom Parkin 		/* Session debug flags option is deprecated */
1211fd558d18SJames Chapman 		break;
1212fd558d18SJames Chapman 
1213fd558d18SJames Chapman 	case PPPOL2TP_SO_REORDERTO:
1214fd558d18SJames Chapman 		session->reorder_timeout = msecs_to_jiffies(val);
1215fd558d18SJames Chapman 		break;
1216fd558d18SJames Chapman 
1217fd558d18SJames Chapman 	default:
1218fd558d18SJames Chapman 		err = -ENOPROTOOPT;
1219fd558d18SJames Chapman 		break;
1220fd558d18SJames Chapman 	}
1221fd558d18SJames Chapman 
1222fd558d18SJames Chapman 	return err;
1223fd558d18SJames Chapman }
1224fd558d18SJames Chapman 
1225fd558d18SJames Chapman /* Main setsockopt() entry point.
1226fd558d18SJames Chapman  * Does API checks, then calls either the tunnel or session setsockopt
1227fd558d18SJames Chapman  * handler, according to whether the PPPoL2TP socket is a for a regular
1228fd558d18SJames Chapman  * session or the special tunnel type.
1229fd558d18SJames Chapman  */
1230fd558d18SJames Chapman static int pppol2tp_setsockopt(struct socket *sock, int level, int optname,
1231a7b75c5aSChristoph Hellwig 			       sockptr_t optval, unsigned int optlen)
1232fd558d18SJames Chapman {
1233fd558d18SJames Chapman 	struct sock *sk = sock->sk;
1234fd558d18SJames Chapman 	struct l2tp_session *session;
1235fd558d18SJames Chapman 	struct l2tp_tunnel *tunnel;
1236fd558d18SJames Chapman 	int val;
1237fd558d18SJames Chapman 	int err;
1238fd558d18SJames Chapman 
1239fd558d18SJames Chapman 	if (level != SOL_PPPOL2TP)
12403cf521f7SSasha Levin 		return -EINVAL;
1241fd558d18SJames Chapman 
1242fd558d18SJames Chapman 	if (optlen < sizeof(int))
1243fd558d18SJames Chapman 		return -EINVAL;
1244fd558d18SJames Chapman 
1245a7b75c5aSChristoph Hellwig 	if (copy_from_sockptr(&val, optval, sizeof(int)))
1246fd558d18SJames Chapman 		return -EFAULT;
1247fd558d18SJames Chapman 
1248fd558d18SJames Chapman 	err = -ENOTCONN;
12490febc7b3STom Parkin 	if (!sk->sk_user_data)
1250fd558d18SJames Chapman 		goto end;
1251fd558d18SJames Chapman 
1252fd558d18SJames Chapman 	/* Get session context from the socket */
1253fd558d18SJames Chapman 	err = -EBADF;
1254fd558d18SJames Chapman 	session = pppol2tp_sock_to_session(sk);
12550febc7b3STom Parkin 	if (!session)
1256fd558d18SJames Chapman 		goto end;
1257fd558d18SJames Chapman 
1258fd558d18SJames Chapman 	/* Special case: if session_id == 0x0000, treat as operation on tunnel
1259fd558d18SJames Chapman 	 */
12606c0ec37bSTom Parkin 	if (session->session_id == 0 && session->peer_session_id == 0) {
12617198c77aSGuillaume Nault 		tunnel = session->tunnel;
1262fd558d18SJames Chapman 		err = pppol2tp_tunnel_setsockopt(sk, tunnel, optname, val);
12637198c77aSGuillaume Nault 	} else {
1264fd558d18SJames Chapman 		err = pppol2tp_session_setsockopt(sk, session, optname, val);
12657198c77aSGuillaume Nault 	}
1266fd558d18SJames Chapman 
1267fd558d18SJames Chapman 	sock_put(sk);
1268fd558d18SJames Chapman end:
1269fd558d18SJames Chapman 	return err;
1270fd558d18SJames Chapman }
1271fd558d18SJames Chapman 
1272fd558d18SJames Chapman /* Tunnel getsockopt helper. Called with sock locked.
1273fd558d18SJames Chapman  */
1274fd558d18SJames Chapman static int pppol2tp_tunnel_getsockopt(struct sock *sk,
1275fd558d18SJames Chapman 				      struct l2tp_tunnel *tunnel,
1276fd558d18SJames Chapman 				      int optname, int *val)
1277fd558d18SJames Chapman {
1278fd558d18SJames Chapman 	int err = 0;
1279fd558d18SJames Chapman 
1280fd558d18SJames Chapman 	switch (optname) {
1281fd558d18SJames Chapman 	case PPPOL2TP_SO_DEBUG:
1282eee049c0STom Parkin 		/* Tunnel debug flags option is deprecated */
1283eee049c0STom Parkin 		*val = 0;
1284fd558d18SJames Chapman 		break;
1285fd558d18SJames Chapman 
1286fd558d18SJames Chapman 	default:
1287fd558d18SJames Chapman 		err = -ENOPROTOOPT;
1288fd558d18SJames Chapman 		break;
1289fd558d18SJames Chapman 	}
1290fd558d18SJames Chapman 
1291fd558d18SJames Chapman 	return err;
1292fd558d18SJames Chapman }
1293fd558d18SJames Chapman 
1294fd558d18SJames Chapman /* Session getsockopt helper. Called with sock locked.
1295fd558d18SJames Chapman  */
1296fd558d18SJames Chapman static int pppol2tp_session_getsockopt(struct sock *sk,
1297fd558d18SJames Chapman 				       struct l2tp_session *session,
1298fd558d18SJames Chapman 				       int optname, int *val)
1299fd558d18SJames Chapman {
1300fd558d18SJames Chapman 	int err = 0;
1301fd558d18SJames Chapman 
1302fd558d18SJames Chapman 	switch (optname) {
1303fd558d18SJames Chapman 	case PPPOL2TP_SO_RECVSEQ:
1304fd558d18SJames Chapman 		*val = session->recv_seq;
1305fd558d18SJames Chapman 		break;
1306fd558d18SJames Chapman 
1307fd558d18SJames Chapman 	case PPPOL2TP_SO_SENDSEQ:
1308fd558d18SJames Chapman 		*val = session->send_seq;
1309fd558d18SJames Chapman 		break;
1310fd558d18SJames Chapman 
1311fd558d18SJames Chapman 	case PPPOL2TP_SO_LNSMODE:
1312fd558d18SJames Chapman 		*val = session->lns_mode;
1313fd558d18SJames Chapman 		break;
1314fd558d18SJames Chapman 
1315fd558d18SJames Chapman 	case PPPOL2TP_SO_DEBUG:
1316eee049c0STom Parkin 		/* Session debug flags option is deprecated */
1317eee049c0STom Parkin 		*val = 0;
1318fd558d18SJames Chapman 		break;
1319fd558d18SJames Chapman 
1320fd558d18SJames Chapman 	case PPPOL2TP_SO_REORDERTO:
1321fd558d18SJames Chapman 		*val = (int)jiffies_to_msecs(session->reorder_timeout);
1322fd558d18SJames Chapman 		break;
1323fd558d18SJames Chapman 
1324fd558d18SJames Chapman 	default:
1325fd558d18SJames Chapman 		err = -ENOPROTOOPT;
1326fd558d18SJames Chapman 	}
1327fd558d18SJames Chapman 
1328fd558d18SJames Chapman 	return err;
1329fd558d18SJames Chapman }
1330fd558d18SJames Chapman 
1331fd558d18SJames Chapman /* Main getsockopt() entry point.
1332fd558d18SJames Chapman  * Does API checks, then calls either the tunnel or session getsockopt
1333fd558d18SJames Chapman  * handler, according to whether the PPPoX socket is a for a regular session
1334fd558d18SJames Chapman  * or the special tunnel type.
1335fd558d18SJames Chapman  */
1336e3192690SJoe Perches static int pppol2tp_getsockopt(struct socket *sock, int level, int optname,
1337e3192690SJoe Perches 			       char __user *optval, int __user *optlen)
1338fd558d18SJames Chapman {
1339fd558d18SJames Chapman 	struct sock *sk = sock->sk;
1340fd558d18SJames Chapman 	struct l2tp_session *session;
1341fd558d18SJames Chapman 	struct l2tp_tunnel *tunnel;
1342fd558d18SJames Chapman 	int val, len;
1343fd558d18SJames Chapman 	int err;
1344fd558d18SJames Chapman 
1345fd558d18SJames Chapman 	if (level != SOL_PPPOL2TP)
13463cf521f7SSasha Levin 		return -EINVAL;
1347fd558d18SJames Chapman 
1348e3192690SJoe Perches 	if (get_user(len, optlen))
1349fd558d18SJames Chapman 		return -EFAULT;
1350fd558d18SJames Chapman 
1351fd558d18SJames Chapman 	len = min_t(unsigned int, len, sizeof(int));
1352fd558d18SJames Chapman 
1353fd558d18SJames Chapman 	if (len < 0)
1354fd558d18SJames Chapman 		return -EINVAL;
1355fd558d18SJames Chapman 
1356fd558d18SJames Chapman 	err = -ENOTCONN;
13570febc7b3STom Parkin 	if (!sk->sk_user_data)
1358fd558d18SJames Chapman 		goto end;
1359fd558d18SJames Chapman 
1360fd558d18SJames Chapman 	/* Get the session context */
1361fd558d18SJames Chapman 	err = -EBADF;
1362fd558d18SJames Chapman 	session = pppol2tp_sock_to_session(sk);
13630febc7b3STom Parkin 	if (!session)
1364fd558d18SJames Chapman 		goto end;
1365fd558d18SJames Chapman 
1366fd558d18SJames Chapman 	/* Special case: if session_id == 0x0000, treat as operation on tunnel */
13676c0ec37bSTom Parkin 	if (session->session_id == 0 && session->peer_session_id == 0) {
13687198c77aSGuillaume Nault 		tunnel = session->tunnel;
1369fd558d18SJames Chapman 		err = pppol2tp_tunnel_getsockopt(sk, tunnel, optname, &val);
1370321a52a3SGuillaume Nault 		if (err)
1371321a52a3SGuillaume Nault 			goto end_put_sess;
1372321a52a3SGuillaume Nault 	} else {
1373fd558d18SJames Chapman 		err = pppol2tp_session_getsockopt(sk, session, optname, &val);
1374321a52a3SGuillaume Nault 		if (err)
1375321a52a3SGuillaume Nault 			goto end_put_sess;
1376321a52a3SGuillaume Nault 	}
1377fd558d18SJames Chapman 
1378fd558d18SJames Chapman 	err = -EFAULT;
1379e3192690SJoe Perches 	if (put_user(len, optlen))
1380fd558d18SJames Chapman 		goto end_put_sess;
1381fd558d18SJames Chapman 
1382fd558d18SJames Chapman 	if (copy_to_user((void __user *)optval, &val, len))
1383fd558d18SJames Chapman 		goto end_put_sess;
1384fd558d18SJames Chapman 
1385fd558d18SJames Chapman 	err = 0;
1386fd558d18SJames Chapman 
1387fd558d18SJames Chapman end_put_sess:
1388fd558d18SJames Chapman 	sock_put(sk);
1389fd558d18SJames Chapman end:
1390fd558d18SJames Chapman 	return err;
1391fd558d18SJames Chapman }
1392fd558d18SJames Chapman 
1393fd558d18SJames Chapman /*****************************************************************************
1394fd558d18SJames Chapman  * /proc filesystem for debug
1395f7faffa3SJames Chapman  * Since the original pppol2tp driver provided /proc/net/pppol2tp for
1396f7faffa3SJames Chapman  * L2TPv2, we dump only L2TPv2 tunnels and sessions here.
1397fd558d18SJames Chapman  *****************************************************************************/
1398fd558d18SJames Chapman 
1399fd558d18SJames Chapman static unsigned int pppol2tp_net_id;
1400fd558d18SJames Chapman 
1401fd558d18SJames Chapman #ifdef CONFIG_PROC_FS
1402fd558d18SJames Chapman 
1403fd558d18SJames Chapman struct pppol2tp_seq_data {
1404fd558d18SJames Chapman 	struct seq_net_private p;
1405fd558d18SJames Chapman 	int tunnel_idx;			/* current tunnel */
1406fd558d18SJames Chapman 	int session_idx;		/* index of session within current tunnel */
1407fd558d18SJames Chapman 	struct l2tp_tunnel *tunnel;
1408fd558d18SJames Chapman 	struct l2tp_session *session;	/* NULL means get next tunnel */
1409fd558d18SJames Chapman };
1410fd558d18SJames Chapman 
1411fd558d18SJames Chapman static void pppol2tp_next_tunnel(struct net *net, struct pppol2tp_seq_data *pd)
1412fd558d18SJames Chapman {
14130e0c3feeSGuillaume Nault 	/* Drop reference taken during previous invocation */
14140e0c3feeSGuillaume Nault 	if (pd->tunnel)
14150e0c3feeSGuillaume Nault 		l2tp_tunnel_dec_refcount(pd->tunnel);
14160e0c3feeSGuillaume Nault 
1417f7faffa3SJames Chapman 	for (;;) {
14180e0c3feeSGuillaume Nault 		pd->tunnel = l2tp_tunnel_get_nth(net, pd->tunnel_idx);
1419fd558d18SJames Chapman 		pd->tunnel_idx++;
1420f7faffa3SJames Chapman 
14210e0c3feeSGuillaume Nault 		/* Only accept L2TPv2 tunnels */
14220e0c3feeSGuillaume Nault 		if (!pd->tunnel || pd->tunnel->version == 2)
14230e0c3feeSGuillaume Nault 			return;
1424f7faffa3SJames Chapman 
14250e0c3feeSGuillaume Nault 		l2tp_tunnel_dec_refcount(pd->tunnel);
1426f7faffa3SJames Chapman 	}
1427fd558d18SJames Chapman }
1428fd558d18SJames Chapman 
1429fd558d18SJames Chapman static void pppol2tp_next_session(struct net *net, struct pppol2tp_seq_data *pd)
1430fd558d18SJames Chapman {
143183494407SGuillaume Nault 	/* Drop reference taken during previous invocation */
143283494407SGuillaume Nault 	if (pd->session)
143383494407SGuillaume Nault 		l2tp_session_dec_refcount(pd->session);
143483494407SGuillaume Nault 
1435a4346210SGuillaume Nault 	pd->session = l2tp_session_get_nth(pd->tunnel, pd->session_idx);
1436fd558d18SJames Chapman 	pd->session_idx++;
1437f7faffa3SJames Chapman 
14380febc7b3STom Parkin 	if (!pd->session) {
1439fd558d18SJames Chapman 		pd->session_idx = 0;
1440fd558d18SJames Chapman 		pppol2tp_next_tunnel(net, pd);
1441fd558d18SJames Chapman 	}
1442fd558d18SJames Chapman }
1443fd558d18SJames Chapman 
1444fd558d18SJames Chapman static void *pppol2tp_seq_start(struct seq_file *m, loff_t *offs)
1445fd558d18SJames Chapman {
1446fd558d18SJames Chapman 	struct pppol2tp_seq_data *pd = SEQ_START_TOKEN;
1447fd558d18SJames Chapman 	loff_t pos = *offs;
1448fd558d18SJames Chapman 	struct net *net;
1449fd558d18SJames Chapman 
1450fd558d18SJames Chapman 	if (!pos)
1451fd558d18SJames Chapman 		goto out;
1452fd558d18SJames Chapman 
1453ebb4f5e6STom Parkin 	if (WARN_ON(!m->private)) {
1454ebb4f5e6STom Parkin 		pd = NULL;
1455ebb4f5e6STom Parkin 		goto out;
1456ebb4f5e6STom Parkin 	}
1457ebb4f5e6STom Parkin 
1458fd558d18SJames Chapman 	pd = m->private;
1459fd558d18SJames Chapman 	net = seq_file_net(m);
1460fd558d18SJames Chapman 
14610febc7b3STom Parkin 	if (!pd->tunnel)
1462fd558d18SJames Chapman 		pppol2tp_next_tunnel(net, pd);
1463fd558d18SJames Chapman 	else
1464fd558d18SJames Chapman 		pppol2tp_next_session(net, pd);
1465fd558d18SJames Chapman 
1466fd558d18SJames Chapman 	/* NULL tunnel and session indicates end of list */
14670febc7b3STom Parkin 	if (!pd->tunnel && !pd->session)
1468fd558d18SJames Chapman 		pd = NULL;
1469fd558d18SJames Chapman 
1470fd558d18SJames Chapman out:
1471fd558d18SJames Chapman 	return pd;
1472fd558d18SJames Chapman }
1473fd558d18SJames Chapman 
1474fd558d18SJames Chapman static void *pppol2tp_seq_next(struct seq_file *m, void *v, loff_t *pos)
1475fd558d18SJames Chapman {
1476fd558d18SJames Chapman 	(*pos)++;
1477fd558d18SJames Chapman 	return NULL;
1478fd558d18SJames Chapman }
1479fd558d18SJames Chapman 
1480fd558d18SJames Chapman static void pppol2tp_seq_stop(struct seq_file *p, void *v)
1481fd558d18SJames Chapman {
14820e0c3feeSGuillaume Nault 	struct pppol2tp_seq_data *pd = v;
14830e0c3feeSGuillaume Nault 
14840e0c3feeSGuillaume Nault 	if (!pd || pd == SEQ_START_TOKEN)
14850e0c3feeSGuillaume Nault 		return;
14860e0c3feeSGuillaume Nault 
148783494407SGuillaume Nault 	/* Drop reference taken by last invocation of pppol2tp_next_session()
148883494407SGuillaume Nault 	 * or pppol2tp_next_tunnel().
148983494407SGuillaume Nault 	 */
149083494407SGuillaume Nault 	if (pd->session) {
149183494407SGuillaume Nault 		l2tp_session_dec_refcount(pd->session);
149283494407SGuillaume Nault 		pd->session = NULL;
149383494407SGuillaume Nault 	}
14945411b618SGuillaume Nault 	if (pd->tunnel) {
14950e0c3feeSGuillaume Nault 		l2tp_tunnel_dec_refcount(pd->tunnel);
14965411b618SGuillaume Nault 		pd->tunnel = NULL;
14975411b618SGuillaume Nault 	}
1498fd558d18SJames Chapman }
1499fd558d18SJames Chapman 
1500fd558d18SJames Chapman static void pppol2tp_seq_tunnel_show(struct seq_file *m, void *v)
1501fd558d18SJames Chapman {
1502fd558d18SJames Chapman 	struct l2tp_tunnel *tunnel = v;
1503fd558d18SJames Chapman 
1504fd558d18SJames Chapman 	seq_printf(m, "\nTUNNEL '%s', %c %d\n",
1505fd558d18SJames Chapman 		   tunnel->name,
1506fd558d18SJames Chapman 		   (tunnel == tunnel->sock->sk_user_data) ? 'Y' : 'N',
1507fbea9e07SReshetova, Elena 		   refcount_read(&tunnel->ref_count) - 1);
15087b7c0719STom Parkin 	seq_printf(m, " %08x %ld/%ld/%ld %ld/%ld/%ld\n",
1509eee049c0STom Parkin 		   0,
15107b7c0719STom Parkin 		   atomic_long_read(&tunnel->stats.tx_packets),
15117b7c0719STom Parkin 		   atomic_long_read(&tunnel->stats.tx_bytes),
15127b7c0719STom Parkin 		   atomic_long_read(&tunnel->stats.tx_errors),
15137b7c0719STom Parkin 		   atomic_long_read(&tunnel->stats.rx_packets),
15147b7c0719STom Parkin 		   atomic_long_read(&tunnel->stats.rx_bytes),
15157b7c0719STom Parkin 		   atomic_long_read(&tunnel->stats.rx_errors));
1516fd558d18SJames Chapman }
1517fd558d18SJames Chapman 
1518fd558d18SJames Chapman static void pppol2tp_seq_session_show(struct seq_file *m, void *v)
1519fd558d18SJames Chapman {
1520fd558d18SJames Chapman 	struct l2tp_session *session = v;
1521fd558d18SJames Chapman 	struct l2tp_tunnel *tunnel = session->tunnel;
1522ee40fb2eSGuillaume Nault 	unsigned char state;
1523ee40fb2eSGuillaume Nault 	char user_data_ok;
1524ee40fb2eSGuillaume Nault 	struct sock *sk;
1525fd558d18SJames Chapman 	u32 ip = 0;
1526fd558d18SJames Chapman 	u16 port = 0;
1527fd558d18SJames Chapman 
1528fd558d18SJames Chapman 	if (tunnel->sock) {
1529fd558d18SJames Chapman 		struct inet_sock *inet = inet_sk(tunnel->sock);
1530b71a61ccSTom Parkin 
1531fd558d18SJames Chapman 		ip = ntohl(inet->inet_saddr);
1532fd558d18SJames Chapman 		port = ntohs(inet->inet_sport);
1533fd558d18SJames Chapman 	}
1534fd558d18SJames Chapman 
1535ee40fb2eSGuillaume Nault 	sk = pppol2tp_session_get_sock(session);
1536ee40fb2eSGuillaume Nault 	if (sk) {
1537ee40fb2eSGuillaume Nault 		state = sk->sk_state;
1538ee40fb2eSGuillaume Nault 		user_data_ok = (session == sk->sk_user_data) ? 'Y' : 'N';
1539ee40fb2eSGuillaume Nault 	} else {
1540ee40fb2eSGuillaume Nault 		state = 0;
1541ee40fb2eSGuillaume Nault 		user_data_ok = 'N';
1542ee40fb2eSGuillaume Nault 	}
1543ee40fb2eSGuillaume Nault 
15449f7da9a0STom Parkin 	seq_printf(m, "  SESSION '%s' %08X/%d %04X/%04X -> %04X/%04X %d %c\n",
1545fd558d18SJames Chapman 		   session->name, ip, port,
1546fd558d18SJames Chapman 		   tunnel->tunnel_id,
1547fd558d18SJames Chapman 		   session->session_id,
1548fd558d18SJames Chapman 		   tunnel->peer_tunnel_id,
1549fd558d18SJames Chapman 		   session->peer_session_id,
1550ee40fb2eSGuillaume Nault 		   state, user_data_ok);
1551789141b2SGuillaume Nault 	seq_printf(m, "   0/0/%c/%c/%s %08x %u\n",
1552fd558d18SJames Chapman 		   session->recv_seq ? 'R' : '-',
1553fd558d18SJames Chapman 		   session->send_seq ? 'S' : '-',
1554fd558d18SJames Chapman 		   session->lns_mode ? "LNS" : "LAC",
1555eee049c0STom Parkin 		   0,
1556fd558d18SJames Chapman 		   jiffies_to_msecs(session->reorder_timeout));
15577b7c0719STom Parkin 	seq_printf(m, "   %hu/%hu %ld/%ld/%ld %ld/%ld/%ld\n",
1558fd558d18SJames Chapman 		   session->nr, session->ns,
15597b7c0719STom Parkin 		   atomic_long_read(&session->stats.tx_packets),
15607b7c0719STom Parkin 		   atomic_long_read(&session->stats.tx_bytes),
15617b7c0719STom Parkin 		   atomic_long_read(&session->stats.tx_errors),
15627b7c0719STom Parkin 		   atomic_long_read(&session->stats.rx_packets),
15637b7c0719STom Parkin 		   atomic_long_read(&session->stats.rx_bytes),
15647b7c0719STom Parkin 		   atomic_long_read(&session->stats.rx_errors));
15659345471bSJames Chapman 
1566ee40fb2eSGuillaume Nault 	if (sk) {
1567ee40fb2eSGuillaume Nault 		struct pppox_sock *po = pppox_sk(sk);
1568ee40fb2eSGuillaume Nault 
15699345471bSJames Chapman 		seq_printf(m, "   interface %s\n", ppp_dev_name(&po->chan));
1570ee40fb2eSGuillaume Nault 		sock_put(sk);
1571ee40fb2eSGuillaume Nault 	}
1572fd558d18SJames Chapman }
1573fd558d18SJames Chapman 
1574fd558d18SJames Chapman static int pppol2tp_seq_show(struct seq_file *m, void *v)
1575fd558d18SJames Chapman {
1576fd558d18SJames Chapman 	struct pppol2tp_seq_data *pd = v;
1577fd558d18SJames Chapman 
1578fd558d18SJames Chapman 	/* display header on line 1 */
1579fd558d18SJames Chapman 	if (v == SEQ_START_TOKEN) {
1580fd558d18SJames Chapman 		seq_puts(m, "PPPoL2TP driver info, " PPPOL2TP_DRV_VERSION "\n");
1581fd558d18SJames Chapman 		seq_puts(m, "TUNNEL name, user-data-ok session-count\n");
1582fd558d18SJames Chapman 		seq_puts(m, " debug tx-pkts/bytes/errs rx-pkts/bytes/errs\n");
15839f7da9a0STom Parkin 		seq_puts(m, "  SESSION name, addr/port src-tid/sid dest-tid/sid state user-data-ok\n");
1584fd558d18SJames Chapman 		seq_puts(m, "   mtu/mru/rcvseq/sendseq/lns debug reorderto\n");
1585fd558d18SJames Chapman 		seq_puts(m, "   nr/ns tx-pkts/bytes/errs rx-pkts/bytes/errs\n");
1586fd558d18SJames Chapman 		goto out;
1587fd558d18SJames Chapman 	}
1588fd558d18SJames Chapman 
158983494407SGuillaume Nault 	if (!pd->session)
1590fd558d18SJames Chapman 		pppol2tp_seq_tunnel_show(m, pd->tunnel);
159183494407SGuillaume Nault 	else
1592fd558d18SJames Chapman 		pppol2tp_seq_session_show(m, pd->session);
1593fd558d18SJames Chapman 
1594fd558d18SJames Chapman out:
1595fd558d18SJames Chapman 	return 0;
1596fd558d18SJames Chapman }
1597fd558d18SJames Chapman 
1598fd558d18SJames Chapman static const struct seq_operations pppol2tp_seq_ops = {
1599fd558d18SJames Chapman 	.start		= pppol2tp_seq_start,
1600fd558d18SJames Chapman 	.next		= pppol2tp_seq_next,
1601fd558d18SJames Chapman 	.stop		= pppol2tp_seq_stop,
1602fd558d18SJames Chapman 	.show		= pppol2tp_seq_show,
1603fd558d18SJames Chapman };
1604fd558d18SJames Chapman #endif /* CONFIG_PROC_FS */
1605fd558d18SJames Chapman 
1606fd558d18SJames Chapman /*****************************************************************************
1607fd558d18SJames Chapman  * Network namespace
1608fd558d18SJames Chapman  *****************************************************************************/
1609fd558d18SJames Chapman 
1610fd558d18SJames Chapman static __net_init int pppol2tp_init_net(struct net *net)
1611fd558d18SJames Chapman {
1612fd558d18SJames Chapman 	struct proc_dir_entry *pde;
1613fd558d18SJames Chapman 	int err = 0;
1614fd558d18SJames Chapman 
1615c3506372SChristoph Hellwig 	pde = proc_create_net("pppol2tp", 0444, net->proc_net,
1616c3506372SChristoph Hellwig 			      &pppol2tp_seq_ops, sizeof(struct pppol2tp_seq_data));
1617fd558d18SJames Chapman 	if (!pde) {
1618fd558d18SJames Chapman 		err = -ENOMEM;
1619fd558d18SJames Chapman 		goto out;
1620fd558d18SJames Chapman 	}
1621fd558d18SJames Chapman 
1622fd558d18SJames Chapman out:
1623fd558d18SJames Chapman 	return err;
1624fd558d18SJames Chapman }
1625fd558d18SJames Chapman 
1626fd558d18SJames Chapman static __net_exit void pppol2tp_exit_net(struct net *net)
1627fd558d18SJames Chapman {
1628ece31ffdSGao feng 	remove_proc_entry("pppol2tp", net->proc_net);
1629fd558d18SJames Chapman }
1630fd558d18SJames Chapman 
1631fd558d18SJames Chapman static struct pernet_operations pppol2tp_net_ops = {
1632fd558d18SJames Chapman 	.init = pppol2tp_init_net,
1633fd558d18SJames Chapman 	.exit = pppol2tp_exit_net,
1634fd558d18SJames Chapman 	.id   = &pppol2tp_net_id,
1635fd558d18SJames Chapman };
1636fd558d18SJames Chapman 
1637fd558d18SJames Chapman /*****************************************************************************
1638fd558d18SJames Chapman  * Init and cleanup
1639fd558d18SJames Chapman  *****************************************************************************/
1640fd558d18SJames Chapman 
1641fd558d18SJames Chapman static const struct proto_ops pppol2tp_ops = {
1642fd558d18SJames Chapman 	.family		= AF_PPPOX,
1643fd558d18SJames Chapman 	.owner		= THIS_MODULE,
1644fd558d18SJames Chapman 	.release	= pppol2tp_release,
1645fd558d18SJames Chapman 	.bind		= sock_no_bind,
1646fd558d18SJames Chapman 	.connect	= pppol2tp_connect,
1647fd558d18SJames Chapman 	.socketpair	= sock_no_socketpair,
1648fd558d18SJames Chapman 	.accept		= sock_no_accept,
1649fd558d18SJames Chapman 	.getname	= pppol2tp_getname,
1650a11e1d43SLinus Torvalds 	.poll		= datagram_poll,
1651fd558d18SJames Chapman 	.listen		= sock_no_listen,
1652fd558d18SJames Chapman 	.shutdown	= sock_no_shutdown,
1653fd558d18SJames Chapman 	.setsockopt	= pppol2tp_setsockopt,
1654fd558d18SJames Chapman 	.getsockopt	= pppol2tp_getsockopt,
1655fd558d18SJames Chapman 	.sendmsg	= pppol2tp_sendmsg,
1656fd558d18SJames Chapman 	.recvmsg	= pppol2tp_recvmsg,
1657fd558d18SJames Chapman 	.mmap		= sock_no_mmap,
1658fd558d18SJames Chapman 	.ioctl		= pppox_ioctl,
1659055d8824SArnd Bergmann #ifdef CONFIG_COMPAT
1660055d8824SArnd Bergmann 	.compat_ioctl = pppox_compat_ioctl,
1661055d8824SArnd Bergmann #endif
1662fd558d18SJames Chapman };
1663fd558d18SJames Chapman 
1664756e64a0SEric Dumazet static const struct pppox_proto pppol2tp_proto = {
1665fd558d18SJames Chapman 	.create		= pppol2tp_create,
1666e1558a93SWei Yongjun 	.ioctl		= pppol2tp_ioctl,
1667e1558a93SWei Yongjun 	.owner		= THIS_MODULE,
1668fd558d18SJames Chapman };
1669fd558d18SJames Chapman 
1670309795f4SJames Chapman #ifdef CONFIG_L2TP_V3
1671309795f4SJames Chapman 
1672309795f4SJames Chapman static const struct l2tp_nl_cmd_ops pppol2tp_nl_cmd_ops = {
1673309795f4SJames Chapman 	.session_create	= pppol2tp_session_create,
1674cf2f5c88STom Parkin 	.session_delete	= l2tp_session_delete,
1675309795f4SJames Chapman };
1676309795f4SJames Chapman 
1677309795f4SJames Chapman #endif /* CONFIG_L2TP_V3 */
1678309795f4SJames Chapman 
1679fd558d18SJames Chapman static int __init pppol2tp_init(void)
1680fd558d18SJames Chapman {
1681fd558d18SJames Chapman 	int err;
1682fd558d18SJames Chapman 
1683fd558d18SJames Chapman 	err = register_pernet_device(&pppol2tp_net_ops);
1684fd558d18SJames Chapman 	if (err)
1685fd558d18SJames Chapman 		goto out;
1686fd558d18SJames Chapman 
1687fd558d18SJames Chapman 	err = proto_register(&pppol2tp_sk_proto, 0);
1688fd558d18SJames Chapman 	if (err)
1689fd558d18SJames Chapman 		goto out_unregister_pppol2tp_pernet;
1690fd558d18SJames Chapman 
1691fd558d18SJames Chapman 	err = register_pppox_proto(PX_PROTO_OL2TP, &pppol2tp_proto);
1692fd558d18SJames Chapman 	if (err)
1693fd558d18SJames Chapman 		goto out_unregister_pppol2tp_proto;
1694fd558d18SJames Chapman 
1695309795f4SJames Chapman #ifdef CONFIG_L2TP_V3
1696309795f4SJames Chapman 	err = l2tp_nl_register_ops(L2TP_PWTYPE_PPP, &pppol2tp_nl_cmd_ops);
1697309795f4SJames Chapman 	if (err)
1698309795f4SJames Chapman 		goto out_unregister_pppox;
1699309795f4SJames Chapman #endif
1700309795f4SJames Chapman 
1701a4ca44faSJoe Perches 	pr_info("PPPoL2TP kernel driver, %s\n", PPPOL2TP_DRV_VERSION);
1702fd558d18SJames Chapman 
1703fd558d18SJames Chapman out:
1704fd558d18SJames Chapman 	return err;
1705309795f4SJames Chapman 
1706309795f4SJames Chapman #ifdef CONFIG_L2TP_V3
1707309795f4SJames Chapman out_unregister_pppox:
1708309795f4SJames Chapman 	unregister_pppox_proto(PX_PROTO_OL2TP);
1709309795f4SJames Chapman #endif
1710fd558d18SJames Chapman out_unregister_pppol2tp_proto:
1711fd558d18SJames Chapman 	proto_unregister(&pppol2tp_sk_proto);
1712fd558d18SJames Chapman out_unregister_pppol2tp_pernet:
1713fd558d18SJames Chapman 	unregister_pernet_device(&pppol2tp_net_ops);
1714fd558d18SJames Chapman 	goto out;
1715fd558d18SJames Chapman }
1716fd558d18SJames Chapman 
1717fd558d18SJames Chapman static void __exit pppol2tp_exit(void)
1718fd558d18SJames Chapman {
1719309795f4SJames Chapman #ifdef CONFIG_L2TP_V3
1720309795f4SJames Chapman 	l2tp_nl_unregister_ops(L2TP_PWTYPE_PPP);
1721309795f4SJames Chapman #endif
1722fd558d18SJames Chapman 	unregister_pppox_proto(PX_PROTO_OL2TP);
1723fd558d18SJames Chapman 	proto_unregister(&pppol2tp_sk_proto);
1724fd558d18SJames Chapman 	unregister_pernet_device(&pppol2tp_net_ops);
1725fd558d18SJames Chapman }
1726fd558d18SJames Chapman 
1727fd558d18SJames Chapman module_init(pppol2tp_init);
1728fd558d18SJames Chapman module_exit(pppol2tp_exit);
1729fd558d18SJames Chapman 
1730fd558d18SJames Chapman MODULE_AUTHOR("James Chapman <jchapman@katalix.com>");
1731fd558d18SJames Chapman MODULE_DESCRIPTION("PPP over L2TP over UDP");
1732fd558d18SJames Chapman MODULE_LICENSE("GPL");
1733fd558d18SJames Chapman MODULE_VERSION(PPPOL2TP_DRV_VERSION);
1734681b4d88SGuillaume Nault MODULE_ALIAS_NET_PF_PROTO(PF_PPPOX, PX_PROTO_OL2TP);
1735249ee819SGuillaume Nault MODULE_ALIAS_L2TP_PWTYPE(7);
1736