2 * L2TPv3 ethernet pseudowire driver
4 * Copyright (c) 2008,2009,2010 Katalix Systems Ltd
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.
12 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
14 #include <linux/module.h>
15 #include <linux/skbuff.h>
16 #include <linux/socket.h>
17 #include <linux/hash.h>
18 #include <linux/l2tp.h>
20 #include <linux/etherdevice.h>
21 #include <linux/spinlock.h>
26 #include <net/inet_common.h>
27 #include <net/inet_hashtables.h>
28 #include <net/tcp_states.h>
29 #include <net/protocol.h>
31 #include <net/net_namespace.h>
32 #include <net/netns/generic.h>
34 #include "l2tp_core.h"
36 /* Default device name. May be overridden by name specified by user */
37 #define L2TP_ETH_DEV_NAME "l2tpeth%d"
39 /* via netdev_priv() */
41 struct net_device
*dev
;
42 struct sock
*tunnel_sock
;
43 struct l2tp_session
*session
;
44 struct list_head list
;
45 atomic_long_t tx_bytes
;
46 atomic_long_t tx_packets
;
47 atomic_long_t tx_dropped
;
48 atomic_long_t rx_bytes
;
49 atomic_long_t rx_packets
;
50 atomic_long_t rx_errors
;
53 /* via l2tp_session_priv() */
54 struct l2tp_eth_sess
{
55 struct net_device
*dev
;
58 /* per-net private data for this module */
59 static unsigned int l2tp_eth_net_id
;
61 struct list_head l2tp_eth_dev_list
;
62 spinlock_t l2tp_eth_lock
;
65 static inline struct l2tp_eth_net
*l2tp_eth_pernet(struct net
*net
)
67 return net_generic(net
, l2tp_eth_net_id
);
70 static struct lock_class_key l2tp_eth_tx_busylock
;
71 static int l2tp_eth_dev_init(struct net_device
*dev
)
73 struct l2tp_eth
*priv
= netdev_priv(dev
);
76 eth_hw_addr_random(dev
);
77 memset(&dev
->broadcast
[0], 0xff, 6);
78 dev
->qdisc_tx_busylock
= &l2tp_eth_tx_busylock
;
82 static void l2tp_eth_dev_uninit(struct net_device
*dev
)
84 struct l2tp_eth
*priv
= netdev_priv(dev
);
85 struct l2tp_eth_net
*pn
= l2tp_eth_pernet(dev_net(dev
));
87 spin_lock(&pn
->l2tp_eth_lock
);
88 list_del_init(&priv
->list
);
89 spin_unlock(&pn
->l2tp_eth_lock
);
93 static int l2tp_eth_dev_xmit(struct sk_buff
*skb
, struct net_device
*dev
)
95 struct l2tp_eth
*priv
= netdev_priv(dev
);
96 struct l2tp_session
*session
= priv
->session
;
97 unsigned int len
= skb
->len
;
98 int ret
= l2tp_xmit_skb(session
, skb
, session
->hdr_len
);
100 if (likely(ret
== NET_XMIT_SUCCESS
)) {
101 atomic_long_add(len
, &priv
->tx_bytes
);
102 atomic_long_inc(&priv
->tx_packets
);
104 atomic_long_inc(&priv
->tx_dropped
);
109 static struct rtnl_link_stats64
*l2tp_eth_get_stats64(struct net_device
*dev
,
110 struct rtnl_link_stats64
*stats
)
112 struct l2tp_eth
*priv
= netdev_priv(dev
);
114 stats
->tx_bytes
= atomic_long_read(&priv
->tx_bytes
);
115 stats
->tx_packets
= atomic_long_read(&priv
->tx_packets
);
116 stats
->tx_dropped
= atomic_long_read(&priv
->tx_dropped
);
117 stats
->rx_bytes
= atomic_long_read(&priv
->rx_bytes
);
118 stats
->rx_packets
= atomic_long_read(&priv
->rx_packets
);
119 stats
->rx_errors
= atomic_long_read(&priv
->rx_errors
);
124 static struct net_device_ops l2tp_eth_netdev_ops
= {
125 .ndo_init
= l2tp_eth_dev_init
,
126 .ndo_uninit
= l2tp_eth_dev_uninit
,
127 .ndo_start_xmit
= l2tp_eth_dev_xmit
,
128 .ndo_get_stats64
= l2tp_eth_get_stats64
,
131 static void l2tp_eth_dev_setup(struct net_device
*dev
)
134 dev
->priv_flags
&= ~IFF_TX_SKB_SHARING
;
135 dev
->features
|= NETIF_F_LLTX
;
136 dev
->netdev_ops
= &l2tp_eth_netdev_ops
;
137 dev
->destructor
= free_netdev
;
140 static void l2tp_eth_dev_recv(struct l2tp_session
*session
, struct sk_buff
*skb
, int data_len
)
142 struct l2tp_eth_sess
*spriv
= l2tp_session_priv(session
);
143 struct net_device
*dev
= spriv
->dev
;
144 struct l2tp_eth
*priv
= netdev_priv(dev
);
146 if (session
->debug
& L2TP_MSG_DATA
) {
149 length
= min(32u, skb
->len
);
150 if (!pskb_may_pull(skb
, length
))
153 pr_debug("%s: eth recv\n", session
->name
);
154 print_hex_dump_bytes("", DUMP_PREFIX_OFFSET
, skb
->data
, length
);
157 if (!pskb_may_pull(skb
, ETH_HLEN
))
162 /* checksums verified by L2TP */
163 skb
->ip_summed
= CHECKSUM_NONE
;
168 if (dev_forward_skb(dev
, skb
) == NET_RX_SUCCESS
) {
169 atomic_long_inc(&priv
->rx_packets
);
170 atomic_long_add(data_len
, &priv
->rx_bytes
);
172 atomic_long_inc(&priv
->rx_errors
);
177 atomic_long_inc(&priv
->rx_errors
);
181 static void l2tp_eth_delete(struct l2tp_session
*session
)
183 struct l2tp_eth_sess
*spriv
;
184 struct net_device
*dev
;
187 spriv
= l2tp_session_priv(session
);
190 unregister_netdev(dev
);
192 module_put(THIS_MODULE
);
197 #if defined(CONFIG_L2TP_DEBUGFS) || defined(CONFIG_L2TP_DEBUGFS_MODULE)
198 static void l2tp_eth_show(struct seq_file
*m
, void *arg
)
200 struct l2tp_session
*session
= arg
;
201 struct l2tp_eth_sess
*spriv
= l2tp_session_priv(session
);
202 struct net_device
*dev
= spriv
->dev
;
204 seq_printf(m
, " interface %s\n", dev
->name
);
208 static int l2tp_eth_create(struct net
*net
, u32 tunnel_id
, u32 session_id
, u32 peer_session_id
, struct l2tp_session_cfg
*cfg
)
210 struct net_device
*dev
;
212 struct l2tp_tunnel
*tunnel
;
213 struct l2tp_session
*session
;
214 struct l2tp_eth
*priv
;
215 struct l2tp_eth_sess
*spriv
;
217 struct l2tp_eth_net
*pn
;
219 tunnel
= l2tp_tunnel_find(net
, tunnel_id
);
225 session
= l2tp_session_find(net
, tunnel
, session_id
);
232 dev
= dev_get_by_name(net
, cfg
->ifname
);
238 strlcpy(name
, cfg
->ifname
, IFNAMSIZ
);
240 strcpy(name
, L2TP_ETH_DEV_NAME
);
242 session
= l2tp_session_create(sizeof(*spriv
), tunnel
, session_id
,
243 peer_session_id
, cfg
);
249 dev
= alloc_netdev(sizeof(*priv
), name
, l2tp_eth_dev_setup
);
252 goto out_del_session
;
255 dev_net_set(dev
, net
);
256 if (session
->mtu
== 0)
257 session
->mtu
= dev
->mtu
- session
->hdr_len
;
258 dev
->mtu
= session
->mtu
;
259 dev
->needed_headroom
+= session
->hdr_len
;
261 priv
= netdev_priv(dev
);
263 priv
->session
= session
;
264 INIT_LIST_HEAD(&priv
->list
);
266 priv
->tunnel_sock
= tunnel
->sock
;
267 session
->recv_skb
= l2tp_eth_dev_recv
;
268 session
->session_close
= l2tp_eth_delete
;
269 #if defined(CONFIG_L2TP_DEBUGFS) || defined(CONFIG_L2TP_DEBUGFS_MODULE)
270 session
->show
= l2tp_eth_show
;
273 spriv
= l2tp_session_priv(session
);
276 rc
= register_netdev(dev
);
280 __module_get(THIS_MODULE
);
281 /* Must be done after register_netdev() */
282 strlcpy(session
->ifname
, dev
->name
, IFNAMSIZ
);
285 pn
= l2tp_eth_pernet(dev_net(dev
));
286 spin_lock(&pn
->l2tp_eth_lock
);
287 list_add(&priv
->list
, &pn
->l2tp_eth_dev_list
);
288 spin_unlock(&pn
->l2tp_eth_lock
);
296 l2tp_session_delete(session
);
301 static __net_init
int l2tp_eth_init_net(struct net
*net
)
303 struct l2tp_eth_net
*pn
= net_generic(net
, l2tp_eth_net_id
);
305 INIT_LIST_HEAD(&pn
->l2tp_eth_dev_list
);
306 spin_lock_init(&pn
->l2tp_eth_lock
);
311 static struct pernet_operations l2tp_eth_net_ops
= {
312 .init
= l2tp_eth_init_net
,
313 .id
= &l2tp_eth_net_id
,
314 .size
= sizeof(struct l2tp_eth_net
),
318 static const struct l2tp_nl_cmd_ops l2tp_eth_nl_cmd_ops
= {
319 .session_create
= l2tp_eth_create
,
320 .session_delete
= l2tp_session_delete
,
324 static int __init
l2tp_eth_init(void)
328 err
= l2tp_nl_register_ops(L2TP_PWTYPE_ETH
, &l2tp_eth_nl_cmd_ops
);
332 err
= register_pernet_device(&l2tp_eth_net_ops
);
336 pr_info("L2TP ethernet pseudowire support (L2TPv3)\n");
341 l2tp_nl_unregister_ops(L2TP_PWTYPE_ETH
);
346 static void __exit
l2tp_eth_exit(void)
348 unregister_pernet_device(&l2tp_eth_net_ops
);
349 l2tp_nl_unregister_ops(L2TP_PWTYPE_ETH
);
352 module_init(l2tp_eth_init
);
353 module_exit(l2tp_eth_exit
);
355 MODULE_LICENSE("GPL");
356 MODULE_AUTHOR("James Chapman <jchapman@katalix.com>");
357 MODULE_DESCRIPTION("L2TP ethernet pseudowire driver");
358 MODULE_VERSION("1.0");