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