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