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