1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31#include <linux/module.h>
32#include <linux/kernel.h>
33#include <linux/netdevice.h>
34#include <linux/etherdevice.h>
35#include <linux/init.h>
36#include <linux/moduleparam.h>
37#include <linux/rtnetlink.h>
38#include <net/rtnetlink.h>
39#include <linux/u64_stats_sync.h>
40
41static int numdummies = 1;
42
43static int dummy_set_address(struct net_device *dev, void *p)
44{
45 struct sockaddr *sa = p;
46
47 if (!is_valid_ether_addr(sa->sa_data))
48 return -EADDRNOTAVAIL;
49
50 memcpy(dev->dev_addr, sa->sa_data, ETH_ALEN);
51 return 0;
52}
53
54
55static void set_multicast_list(struct net_device *dev)
56{
57}
58
59struct pcpu_dstats {
60 u64 tx_packets;
61 u64 tx_bytes;
62 struct u64_stats_sync syncp;
63};
64
65static struct rtnl_link_stats64 *dummy_get_stats64(struct net_device *dev,
66 struct rtnl_link_stats64 *stats)
67{
68 int i;
69
70 for_each_possible_cpu(i) {
71 const struct pcpu_dstats *dstats;
72 u64 tbytes, tpackets;
73 unsigned int start;
74
75 dstats = per_cpu_ptr(dev->dstats, i);
76 do {
77 start = u64_stats_fetch_begin(&dstats->syncp);
78 tbytes = dstats->tx_bytes;
79 tpackets = dstats->tx_packets;
80 } while (u64_stats_fetch_retry(&dstats->syncp, start));
81 stats->tx_bytes += tbytes;
82 stats->tx_packets += tpackets;
83 }
84 return stats;
85}
86
87static netdev_tx_t dummy_xmit(struct sk_buff *skb, struct net_device *dev)
88{
89 struct pcpu_dstats *dstats = this_cpu_ptr(dev->dstats);
90
91 u64_stats_update_begin(&dstats->syncp);
92 dstats->tx_packets++;
93 dstats->tx_bytes += skb->len;
94 u64_stats_update_end(&dstats->syncp);
95
96 dev_kfree_skb(skb);
97 return NETDEV_TX_OK;
98}
99
100static int dummy_dev_init(struct net_device *dev)
101{
102 dev->dstats = alloc_percpu(struct pcpu_dstats);
103 if (!dev->dstats)
104 return -ENOMEM;
105
106 return 0;
107}
108
109static void dummy_dev_free(struct net_device *dev)
110{
111 free_percpu(dev->dstats);
112 free_netdev(dev);
113}
114
115static const struct net_device_ops dummy_netdev_ops = {
116 .ndo_init = dummy_dev_init,
117 .ndo_start_xmit = dummy_xmit,
118 .ndo_validate_addr = eth_validate_addr,
119 .ndo_set_rx_mode = set_multicast_list,
120 .ndo_set_mac_address = dummy_set_address,
121 .ndo_get_stats64 = dummy_get_stats64,
122};
123
124static void dummy_setup(struct net_device *dev)
125{
126 ether_setup(dev);
127
128
129 dev->netdev_ops = &dummy_netdev_ops;
130 dev->destructor = dummy_dev_free;
131
132
133 dev->tx_queue_len = 0;
134 dev->flags |= IFF_NOARP;
135 dev->flags &= ~IFF_MULTICAST;
136 dev->features |= NETIF_F_SG | NETIF_F_FRAGLIST | NETIF_F_TSO;
137 dev->features |= NETIF_F_HW_CSUM | NETIF_F_HIGHDMA | NETIF_F_LLTX;
138 random_ether_addr(dev->dev_addr);
139}
140
141static int dummy_validate(struct nlattr *tb[], struct nlattr *data[])
142{
143 if (tb[IFLA_ADDRESS]) {
144 if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN)
145 return -EINVAL;
146 if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS])))
147 return -EADDRNOTAVAIL;
148 }
149 return 0;
150}
151
152static struct rtnl_link_ops dummy_link_ops __read_mostly = {
153 .kind = "dummy",
154 .setup = dummy_setup,
155 .validate = dummy_validate,
156};
157
158
159module_param(numdummies, int, 0);
160MODULE_PARM_DESC(numdummies, "Number of dummy pseudo devices");
161
162static int __init dummy_init_one(void)
163{
164 struct net_device *dev_dummy;
165 int err;
166
167 dev_dummy = alloc_netdev(0, "dummy%d", dummy_setup);
168 if (!dev_dummy)
169 return -ENOMEM;
170
171 dev_dummy->rtnl_link_ops = &dummy_link_ops;
172 err = register_netdevice(dev_dummy);
173 if (err < 0)
174 goto err;
175 return 0;
176
177err:
178 free_netdev(dev_dummy);
179 return err;
180}
181
182static int __init dummy_init_module(void)
183{
184 int i, err = 0;
185
186 rtnl_lock();
187 err = __rtnl_link_register(&dummy_link_ops);
188
189 for (i = 0; i < numdummies && !err; i++)
190 err = dummy_init_one();
191 if (err < 0)
192 __rtnl_link_unregister(&dummy_link_ops);
193 rtnl_unlock();
194
195 return err;
196}
197
198static void __exit dummy_cleanup_module(void)
199{
200 rtnl_link_unregister(&dummy_link_ops);
201}
202
203module_init(dummy_init_module);
204module_exit(dummy_cleanup_module);
205MODULE_LICENSE("GPL");
206MODULE_ALIAS_RTNL_LINK("dummy");
207