ipv4: l2tp: fix a potential issue in l2tp_ip_recv
[pandora-kernel.git] / net / l2tp / l2tp_ip.c
1 /*
2  * L2TPv3 IP encapsulation support
3  *
4  * Copyright (c) 2008,2009,2010 Katalix Systems Ltd
5  *
6  *      This program is free software; you can redistribute it and/or
7  *      modify it under the terms of the GNU General Public License
8  *      as published by the Free Software Foundation; either version
9  *      2 of the License, or (at your option) any later version.
10  */
11
12 #include <linux/icmp.h>
13 #include <linux/module.h>
14 #include <linux/skbuff.h>
15 #include <linux/random.h>
16 #include <linux/socket.h>
17 #include <linux/l2tp.h>
18 #include <linux/in.h>
19 #include <net/sock.h>
20 #include <net/ip.h>
21 #include <net/icmp.h>
22 #include <net/udp.h>
23 #include <net/inet_common.h>
24 #include <net/inet_hashtables.h>
25 #include <net/tcp_states.h>
26 #include <net/protocol.h>
27 #include <net/xfrm.h>
28
29 #include "l2tp_core.h"
30
31 struct l2tp_ip_sock {
32         /* inet_sock has to be the first member of l2tp_ip_sock */
33         struct inet_sock        inet;
34
35         __u32                   conn_id;
36         __u32                   peer_conn_id;
37
38         __u64                   tx_packets;
39         __u64                   tx_bytes;
40         __u64                   tx_errors;
41         __u64                   rx_packets;
42         __u64                   rx_bytes;
43         __u64                   rx_errors;
44 };
45
46 static DEFINE_RWLOCK(l2tp_ip_lock);
47 static struct hlist_head l2tp_ip_table;
48 static struct hlist_head l2tp_ip_bind_table;
49
50 static inline struct l2tp_ip_sock *l2tp_ip_sk(const struct sock *sk)
51 {
52         return (struct l2tp_ip_sock *)sk;
53 }
54
55 static struct sock *__l2tp_ip_bind_lookup(struct net *net, __be32 laddr, int dif, u32 tunnel_id)
56 {
57         struct hlist_node *node;
58         struct sock *sk;
59
60         sk_for_each_bound(sk, node, &l2tp_ip_bind_table) {
61                 struct inet_sock *inet = inet_sk(sk);
62                 struct l2tp_ip_sock *l2tp = l2tp_ip_sk(sk);
63
64                 if (l2tp == NULL)
65                         continue;
66
67                 if ((l2tp->conn_id == tunnel_id) &&
68                     net_eq(sock_net(sk), net) &&
69                     !(inet->inet_rcv_saddr && inet->inet_rcv_saddr != laddr) &&
70                     !(sk->sk_bound_dev_if && sk->sk_bound_dev_if != dif))
71                         goto found;
72         }
73
74         sk = NULL;
75 found:
76         return sk;
77 }
78
79 static inline struct sock *l2tp_ip_bind_lookup(struct net *net, __be32 laddr, int dif, u32 tunnel_id)
80 {
81         struct sock *sk = __l2tp_ip_bind_lookup(net, laddr, dif, tunnel_id);
82         if (sk)
83                 sock_hold(sk);
84
85         return sk;
86 }
87
88 /* When processing receive frames, there are two cases to
89  * consider. Data frames consist of a non-zero session-id and an
90  * optional cookie. Control frames consist of a regular L2TP header
91  * preceded by 32-bits of zeros.
92  *
93  * L2TPv3 Session Header Over IP
94  *
95  *  0                   1                   2                   3
96  *  0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
97  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
98  * |                           Session ID                          |
99  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
100  * |               Cookie (optional, maximum 64 bits)...
101  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
102  *                                                                 |
103  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
104  *
105  * L2TPv3 Control Message Header Over IP
106  *
107  *  0                   1                   2                   3
108  *  0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
109  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
110  * |                      (32 bits of zeros)                       |
111  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
112  * |T|L|x|x|S|x|x|x|x|x|x|x|  Ver  |             Length            |
113  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
114  * |                     Control Connection ID                     |
115  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
116  * |               Ns              |               Nr              |
117  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
118  *
119  * All control frames are passed to userspace.
120  */
121 static int l2tp_ip_recv(struct sk_buff *skb)
122 {
123         struct sock *sk;
124         u32 session_id;
125         u32 tunnel_id;
126         unsigned char *ptr, *optr;
127         struct l2tp_session *session;
128         struct l2tp_tunnel *tunnel = NULL;
129         int length;
130         int offset;
131
132         if (!pskb_may_pull(skb, 4))
133                 goto discard;
134
135         /* Point to L2TP header */
136         optr = ptr = skb->data;
137         session_id = ntohl(*((__be32 *) ptr));
138         ptr += 4;
139
140         /* RFC3931: L2TP/IP packets have the first 4 bytes containing
141          * the session_id. If it is 0, the packet is a L2TP control
142          * frame and the session_id value can be discarded.
143          */
144         if (session_id == 0) {
145                 __skb_pull(skb, 4);
146                 goto pass_up;
147         }
148
149         /* Ok, this is a data packet. Lookup the session. */
150         session = l2tp_session_find(&init_net, NULL, session_id);
151         if (session == NULL)
152                 goto discard;
153
154         tunnel = session->tunnel;
155         if (tunnel == NULL)
156                 goto discard;
157
158         /* Trace packet contents, if enabled */
159         if (tunnel->debug & L2TP_MSG_DATA) {
160                 length = min(32u, skb->len);
161                 if (!pskb_may_pull(skb, length))
162                         goto discard;
163
164                 /* Point to L2TP header */
165                 optr = ptr = skb->data;
166                 ptr += 4;
167                 printk(KERN_DEBUG "%s: ip recv: ", tunnel->name);
168
169                 offset = 0;
170                 do {
171                         printk(" %02X", ptr[offset]);
172                 } while (++offset < length);
173
174                 printk("\n");
175         }
176
177         l2tp_recv_common(session, skb, ptr, optr, 0, skb->len, tunnel->recv_payload_hook);
178
179         return 0;
180
181 pass_up:
182         /* Get the tunnel_id from the L2TP header */
183         if (!pskb_may_pull(skb, 12))
184                 goto discard;
185
186         if ((skb->data[0] & 0xc0) != 0xc0)
187                 goto discard;
188
189         tunnel_id = ntohl(*(__be32 *) &skb->data[4]);
190         tunnel = l2tp_tunnel_find(&init_net, tunnel_id);
191         if (tunnel != NULL)
192                 sk = tunnel->sock;
193         else {
194                 struct iphdr *iph = (struct iphdr *) skb_network_header(skb);
195
196                 read_lock_bh(&l2tp_ip_lock);
197                 sk = __l2tp_ip_bind_lookup(&init_net, iph->daddr, 0, tunnel_id);
198                 read_unlock_bh(&l2tp_ip_lock);
199         }
200
201         if (sk == NULL)
202                 goto discard;
203
204         sock_hold(sk);
205
206         if (!xfrm4_policy_check(sk, XFRM_POLICY_IN, skb))
207                 goto discard_put;
208
209         nf_reset(skb);
210
211         return sk_receive_skb(sk, skb, 1);
212
213 discard_put:
214         sock_put(sk);
215
216 discard:
217         kfree_skb(skb);
218         return 0;
219 }
220
221 static int l2tp_ip_open(struct sock *sk)
222 {
223         /* Prevent autobind. We don't have ports. */
224         inet_sk(sk)->inet_num = IPPROTO_L2TP;
225
226         write_lock_bh(&l2tp_ip_lock);
227         sk_add_node(sk, &l2tp_ip_table);
228         write_unlock_bh(&l2tp_ip_lock);
229
230         return 0;
231 }
232
233 static void l2tp_ip_close(struct sock *sk, long timeout)
234 {
235         write_lock_bh(&l2tp_ip_lock);
236         hlist_del_init(&sk->sk_bind_node);
237         hlist_del_init(&sk->sk_node);
238         write_unlock_bh(&l2tp_ip_lock);
239         sk_common_release(sk);
240 }
241
242 static void l2tp_ip_destroy_sock(struct sock *sk)
243 {
244         struct sk_buff *skb;
245
246         while ((skb = __skb_dequeue_tail(&sk->sk_write_queue)) != NULL)
247                 kfree_skb(skb);
248
249         sk_refcnt_debug_dec(sk);
250 }
251
252 static int l2tp_ip_bind(struct sock *sk, struct sockaddr *uaddr, int addr_len)
253 {
254         struct inet_sock *inet = inet_sk(sk);
255         struct sockaddr_l2tpip *addr = (struct sockaddr_l2tpip *) uaddr;
256         int ret;
257         int chk_addr_ret;
258
259         if (!sock_flag(sk, SOCK_ZAPPED))
260                 return -EINVAL;
261         if (addr_len < sizeof(struct sockaddr_l2tpip))
262                 return -EINVAL;
263         if (addr->l2tp_family != AF_INET)
264                 return -EINVAL;
265
266         ret = -EADDRINUSE;
267         read_lock_bh(&l2tp_ip_lock);
268         if (__l2tp_ip_bind_lookup(&init_net, addr->l2tp_addr.s_addr, sk->sk_bound_dev_if, addr->l2tp_conn_id))
269                 goto out_in_use;
270
271         read_unlock_bh(&l2tp_ip_lock);
272
273         lock_sock(sk);
274         if (sk->sk_state != TCP_CLOSE || addr_len < sizeof(struct sockaddr_l2tpip))
275                 goto out;
276
277         chk_addr_ret = inet_addr_type(&init_net, addr->l2tp_addr.s_addr);
278         ret = -EADDRNOTAVAIL;
279         if (addr->l2tp_addr.s_addr && chk_addr_ret != RTN_LOCAL &&
280             chk_addr_ret != RTN_MULTICAST && chk_addr_ret != RTN_BROADCAST)
281                 goto out;
282
283         inet->inet_rcv_saddr = inet->inet_saddr = addr->l2tp_addr.s_addr;
284         if (chk_addr_ret == RTN_MULTICAST || chk_addr_ret == RTN_BROADCAST)
285                 inet->inet_saddr = 0;  /* Use device */
286         sk_dst_reset(sk);
287
288         l2tp_ip_sk(sk)->conn_id = addr->l2tp_conn_id;
289
290         write_lock_bh(&l2tp_ip_lock);
291         sk_add_bind_node(sk, &l2tp_ip_bind_table);
292         sk_del_node_init(sk);
293         write_unlock_bh(&l2tp_ip_lock);
294         ret = 0;
295         sock_reset_flag(sk, SOCK_ZAPPED);
296
297 out:
298         release_sock(sk);
299
300         return ret;
301
302 out_in_use:
303         read_unlock_bh(&l2tp_ip_lock);
304
305         return ret;
306 }
307
308 static int l2tp_ip_connect(struct sock *sk, struct sockaddr *uaddr, int addr_len)
309 {
310         struct sockaddr_l2tpip *lsa = (struct sockaddr_l2tpip *) uaddr;
311         struct inet_sock *inet = inet_sk(sk);
312         struct flowi4 *fl4;
313         struct rtable *rt;
314         __be32 saddr;
315         int oif, rc;
316
317         if (sock_flag(sk, SOCK_ZAPPED)) /* Must bind first - autobinding does not work */
318                 return -EINVAL;
319
320         if (addr_len < sizeof(*lsa))
321                 return -EINVAL;
322
323         if (lsa->l2tp_family != AF_INET)
324                 return -EAFNOSUPPORT;
325
326         lock_sock(sk);
327
328         sk_dst_reset(sk);
329
330         oif = sk->sk_bound_dev_if;
331         saddr = inet->inet_saddr;
332
333         rc = -EINVAL;
334         if (ipv4_is_multicast(lsa->l2tp_addr.s_addr))
335                 goto out;
336
337         fl4 = &inet->cork.fl.u.ip4;
338         rt = ip_route_connect(fl4, lsa->l2tp_addr.s_addr, saddr,
339                               RT_CONN_FLAGS(sk), oif,
340                               IPPROTO_L2TP,
341                               0, 0, sk, true);
342         if (IS_ERR(rt)) {
343                 rc = PTR_ERR(rt);
344                 if (rc == -ENETUNREACH)
345                         IP_INC_STATS_BH(&init_net, IPSTATS_MIB_OUTNOROUTES);
346                 goto out;
347         }
348
349         rc = -ENETUNREACH;
350         if (rt->rt_flags & (RTCF_MULTICAST | RTCF_BROADCAST)) {
351                 ip_rt_put(rt);
352                 goto out;
353         }
354
355         l2tp_ip_sk(sk)->peer_conn_id = lsa->l2tp_conn_id;
356
357         if (!inet->inet_saddr)
358                 inet->inet_saddr = fl4->saddr;
359         if (!inet->inet_rcv_saddr)
360                 inet->inet_rcv_saddr = fl4->saddr;
361         inet->inet_daddr = fl4->daddr;
362         sk->sk_state = TCP_ESTABLISHED;
363         inet->inet_id = jiffies;
364
365         sk_dst_set(sk, &rt->dst);
366
367         write_lock_bh(&l2tp_ip_lock);
368         hlist_del_init(&sk->sk_bind_node);
369         sk_add_bind_node(sk, &l2tp_ip_bind_table);
370         write_unlock_bh(&l2tp_ip_lock);
371
372         rc = 0;
373 out:
374         release_sock(sk);
375         return rc;
376 }
377
378 static int l2tp_ip_disconnect(struct sock *sk, int flags)
379 {
380         if (sock_flag(sk, SOCK_ZAPPED))
381                 return 0;
382
383         return udp_disconnect(sk, flags);
384 }
385
386 static int l2tp_ip_getname(struct socket *sock, struct sockaddr *uaddr,
387                            int *uaddr_len, int peer)
388 {
389         struct sock *sk         = sock->sk;
390         struct inet_sock *inet  = inet_sk(sk);
391         struct l2tp_ip_sock *lsk = l2tp_ip_sk(sk);
392         struct sockaddr_l2tpip *lsa = (struct sockaddr_l2tpip *)uaddr;
393
394         memset(lsa, 0, sizeof(*lsa));
395         lsa->l2tp_family = AF_INET;
396         if (peer) {
397                 if (!inet->inet_dport)
398                         return -ENOTCONN;
399                 lsa->l2tp_conn_id = lsk->peer_conn_id;
400                 lsa->l2tp_addr.s_addr = inet->inet_daddr;
401         } else {
402                 __be32 addr = inet->inet_rcv_saddr;
403                 if (!addr)
404                         addr = inet->inet_saddr;
405                 lsa->l2tp_conn_id = lsk->conn_id;
406                 lsa->l2tp_addr.s_addr = addr;
407         }
408         *uaddr_len = sizeof(*lsa);
409         return 0;
410 }
411
412 static int l2tp_ip_backlog_recv(struct sock *sk, struct sk_buff *skb)
413 {
414         int rc;
415
416         /* Charge it to the socket, dropping if the queue is full. */
417         rc = sock_queue_rcv_skb(sk, skb);
418         if (rc < 0)
419                 goto drop;
420
421         return 0;
422
423 drop:
424         IP_INC_STATS(&init_net, IPSTATS_MIB_INDISCARDS);
425         kfree_skb(skb);
426         return -1;
427 }
428
429 /* Userspace will call sendmsg() on the tunnel socket to send L2TP
430  * control frames.
431  */
432 static int l2tp_ip_sendmsg(struct kiocb *iocb, struct sock *sk, struct msghdr *msg, size_t len)
433 {
434         struct sk_buff *skb;
435         int rc;
436         struct l2tp_ip_sock *lsa = l2tp_ip_sk(sk);
437         struct inet_sock *inet = inet_sk(sk);
438         struct rtable *rt = NULL;
439         struct flowi4 *fl4;
440         int connected = 0;
441         __be32 daddr;
442
443         lock_sock(sk);
444
445         rc = -ENOTCONN;
446         if (sock_flag(sk, SOCK_DEAD))
447                 goto out;
448
449         /* Get and verify the address. */
450         if (msg->msg_name) {
451                 struct sockaddr_l2tpip *lip = (struct sockaddr_l2tpip *) msg->msg_name;
452                 rc = -EINVAL;
453                 if (msg->msg_namelen < sizeof(*lip))
454                         goto out;
455
456                 if (lip->l2tp_family != AF_INET) {
457                         rc = -EAFNOSUPPORT;
458                         if (lip->l2tp_family != AF_UNSPEC)
459                                 goto out;
460                 }
461
462                 daddr = lip->l2tp_addr.s_addr;
463         } else {
464                 rc = -EDESTADDRREQ;
465                 if (sk->sk_state != TCP_ESTABLISHED)
466                         goto out;
467
468                 daddr = inet->inet_daddr;
469                 connected = 1;
470         }
471
472         /* Allocate a socket buffer */
473         rc = -ENOMEM;
474         skb = sock_wmalloc(sk, 2 + NET_SKB_PAD + sizeof(struct iphdr) +
475                            4 + len, 0, GFP_KERNEL);
476         if (!skb)
477                 goto error;
478
479         /* Reserve space for headers, putting IP header on 4-byte boundary. */
480         skb_reserve(skb, 2 + NET_SKB_PAD);
481         skb_reset_network_header(skb);
482         skb_reserve(skb, sizeof(struct iphdr));
483         skb_reset_transport_header(skb);
484
485         /* Insert 0 session_id */
486         *((__be32 *) skb_put(skb, 4)) = 0;
487
488         /* Copy user data into skb */
489         rc = memcpy_fromiovec(skb_put(skb, len), msg->msg_iov, len);
490         if (rc < 0) {
491                 kfree_skb(skb);
492                 goto error;
493         }
494
495         fl4 = &inet->cork.fl.u.ip4;
496         if (connected)
497                 rt = (struct rtable *) __sk_dst_check(sk, 0);
498
499         rcu_read_lock();
500         if (rt == NULL) {
501                 const struct ip_options_rcu *inet_opt;
502
503                 inet_opt = rcu_dereference(inet->inet_opt);
504
505                 /* Use correct destination address if we have options. */
506                 if (inet_opt && inet_opt->opt.srr)
507                         daddr = inet_opt->opt.faddr;
508
509                 /* If this fails, retransmit mechanism of transport layer will
510                  * keep trying until route appears or the connection times
511                  * itself out.
512                  */
513                 rt = ip_route_output_ports(sock_net(sk), fl4, sk,
514                                            daddr, inet->inet_saddr,
515                                            inet->inet_dport, inet->inet_sport,
516                                            sk->sk_protocol, RT_CONN_FLAGS(sk),
517                                            sk->sk_bound_dev_if);
518                 if (IS_ERR(rt))
519                         goto no_route;
520                 if (connected) {
521                         sk_setup_caps(sk, &rt->dst);
522                 } else {
523                         skb_dst_set(skb, &rt->dst);
524                         goto xmit;
525                 }
526         }
527
528         /* We dont need to clone dst here, it is guaranteed to not disappear.
529          *  __dev_xmit_skb() might force a refcount if needed.
530          */
531         skb_dst_set_noref(skb, &rt->dst);
532
533 xmit:
534         /* Queue the packet to IP for output */
535         rc = ip_queue_xmit(skb, &inet->cork.fl);
536         rcu_read_unlock();
537
538 error:
539         /* Update stats */
540         if (rc >= 0) {
541                 lsa->tx_packets++;
542                 lsa->tx_bytes += len;
543                 rc = len;
544         } else {
545                 lsa->tx_errors++;
546         }
547
548 out:
549         release_sock(sk);
550         return rc;
551
552 no_route:
553         rcu_read_unlock();
554         IP_INC_STATS(sock_net(sk), IPSTATS_MIB_OUTNOROUTES);
555         kfree_skb(skb);
556         rc = -EHOSTUNREACH;
557         goto out;
558 }
559
560 static int l2tp_ip_recvmsg(struct kiocb *iocb, struct sock *sk, struct msghdr *msg,
561                            size_t len, int noblock, int flags, int *addr_len)
562 {
563         struct inet_sock *inet = inet_sk(sk);
564         struct l2tp_ip_sock *lsk = l2tp_ip_sk(sk);
565         size_t copied = 0;
566         int err = -EOPNOTSUPP;
567         struct sockaddr_in *sin = (struct sockaddr_in *)msg->msg_name;
568         struct sk_buff *skb;
569
570         if (flags & MSG_OOB)
571                 goto out;
572
573         skb = skb_recv_datagram(sk, flags, noblock, &err);
574         if (!skb)
575                 goto out;
576
577         copied = skb->len;
578         if (len < copied) {
579                 msg->msg_flags |= MSG_TRUNC;
580                 copied = len;
581         }
582
583         err = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, copied);
584         if (err)
585                 goto done;
586
587         sock_recv_timestamp(msg, sk, skb);
588
589         /* Copy the address. */
590         if (sin) {
591                 sin->sin_family = AF_INET;
592                 sin->sin_addr.s_addr = ip_hdr(skb)->saddr;
593                 sin->sin_port = 0;
594                 memset(&sin->sin_zero, 0, sizeof(sin->sin_zero));
595                 *addr_len = sizeof(*sin);
596         }
597         if (inet->cmsg_flags)
598                 ip_cmsg_recv(msg, skb);
599         if (flags & MSG_TRUNC)
600                 copied = skb->len;
601 done:
602         skb_free_datagram(sk, skb);
603 out:
604         if (err) {
605                 lsk->rx_errors++;
606                 return err;
607         }
608
609         lsk->rx_packets++;
610         lsk->rx_bytes += copied;
611
612         return copied;
613 }
614
615 static struct proto l2tp_ip_prot = {
616         .name              = "L2TP/IP",
617         .owner             = THIS_MODULE,
618         .init              = l2tp_ip_open,
619         .close             = l2tp_ip_close,
620         .bind              = l2tp_ip_bind,
621         .connect           = l2tp_ip_connect,
622         .disconnect        = l2tp_ip_disconnect,
623         .ioctl             = udp_ioctl,
624         .destroy           = l2tp_ip_destroy_sock,
625         .setsockopt        = ip_setsockopt,
626         .getsockopt        = ip_getsockopt,
627         .sendmsg           = l2tp_ip_sendmsg,
628         .recvmsg           = l2tp_ip_recvmsg,
629         .backlog_rcv       = l2tp_ip_backlog_recv,
630         .hash              = inet_hash,
631         .unhash            = inet_unhash,
632         .obj_size          = sizeof(struct l2tp_ip_sock),
633 #ifdef CONFIG_COMPAT
634         .compat_setsockopt = compat_ip_setsockopt,
635         .compat_getsockopt = compat_ip_getsockopt,
636 #endif
637 };
638
639 static const struct proto_ops l2tp_ip_ops = {
640         .family            = PF_INET,
641         .owner             = THIS_MODULE,
642         .release           = inet_release,
643         .bind              = inet_bind,
644         .connect           = inet_dgram_connect,
645         .socketpair        = sock_no_socketpair,
646         .accept            = sock_no_accept,
647         .getname           = l2tp_ip_getname,
648         .poll              = datagram_poll,
649         .ioctl             = inet_ioctl,
650         .listen            = sock_no_listen,
651         .shutdown          = inet_shutdown,
652         .setsockopt        = sock_common_setsockopt,
653         .getsockopt        = sock_common_getsockopt,
654         .sendmsg           = inet_sendmsg,
655         .recvmsg           = sock_common_recvmsg,
656         .mmap              = sock_no_mmap,
657         .sendpage          = sock_no_sendpage,
658 #ifdef CONFIG_COMPAT
659         .compat_setsockopt = compat_sock_common_setsockopt,
660         .compat_getsockopt = compat_sock_common_getsockopt,
661 #endif
662 };
663
664 static struct inet_protosw l2tp_ip_protosw = {
665         .type           = SOCK_DGRAM,
666         .protocol       = IPPROTO_L2TP,
667         .prot           = &l2tp_ip_prot,
668         .ops            = &l2tp_ip_ops,
669         .no_check       = 0,
670 };
671
672 static struct net_protocol l2tp_ip_protocol __read_mostly = {
673         .handler        = l2tp_ip_recv,
674 };
675
676 static int __init l2tp_ip_init(void)
677 {
678         int err;
679
680         printk(KERN_INFO "L2TP IP encapsulation support (L2TPv3)\n");
681
682         err = proto_register(&l2tp_ip_prot, 1);
683         if (err != 0)
684                 goto out;
685
686         err = inet_add_protocol(&l2tp_ip_protocol, IPPROTO_L2TP);
687         if (err)
688                 goto out1;
689
690         inet_register_protosw(&l2tp_ip_protosw);
691         return 0;
692
693 out1:
694         proto_unregister(&l2tp_ip_prot);
695 out:
696         return err;
697 }
698
699 static void __exit l2tp_ip_exit(void)
700 {
701         inet_unregister_protosw(&l2tp_ip_protosw);
702         inet_del_protocol(&l2tp_ip_protocol, IPPROTO_L2TP);
703         proto_unregister(&l2tp_ip_prot);
704 }
705
706 module_init(l2tp_ip_init);
707 module_exit(l2tp_ip_exit);
708
709 MODULE_LICENSE("GPL");
710 MODULE_AUTHOR("James Chapman <jchapman@katalix.com>");
711 MODULE_DESCRIPTION("L2TP over IP");
712 MODULE_VERSION("1.0");
713
714 /* Use the value of SOCK_DGRAM (2) directory, because __stringify doesn't like
715  * enums
716  */
717 MODULE_ALIAS_NET_PF_PROTO_TYPE(PF_INET, 2, IPPROTO_L2TP);