GNU Linux-libre 4.14.254-gnu1
[releases.git] / net / openvswitch / vport-internal_dev.c
1 /*
2  * Copyright (c) 2007-2012 Nicira, Inc.
3  *
4  * This program is free software; you can redistribute it and/or
5  * modify it under the terms of version 2 of the GNU General Public
6  * License as published by the Free Software Foundation.
7  *
8  * This program is distributed in the hope that it will be useful, but
9  * WITHOUT ANY WARRANTY; without even the implied warranty of
10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
11  * General Public License for more details.
12  *
13  * You should have received a copy of the GNU General Public License
14  * along with this program; if not, write to the Free Software
15  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
16  * 02110-1301, USA
17  */
18
19 #include <linux/hardirq.h>
20 #include <linux/if_vlan.h>
21 #include <linux/kernel.h>
22 #include <linux/netdevice.h>
23 #include <linux/etherdevice.h>
24 #include <linux/ethtool.h>
25 #include <linux/skbuff.h>
26
27 #include <net/dst.h>
28 #include <net/xfrm.h>
29 #include <net/rtnetlink.h>
30
31 #include "datapath.h"
32 #include "vport-internal_dev.h"
33 #include "vport-netdev.h"
34
35 struct internal_dev {
36         struct vport *vport;
37 };
38
39 static struct vport_ops ovs_internal_vport_ops;
40
41 static struct internal_dev *internal_dev_priv(struct net_device *netdev)
42 {
43         return netdev_priv(netdev);
44 }
45
46 /* Called with rcu_read_lock_bh. */
47 static netdev_tx_t
48 internal_dev_xmit(struct sk_buff *skb, struct net_device *netdev)
49 {
50         int len, err;
51
52         len = skb->len;
53         rcu_read_lock();
54         err = ovs_vport_receive(internal_dev_priv(netdev)->vport, skb, NULL);
55         rcu_read_unlock();
56
57         if (likely(!err)) {
58                 struct pcpu_sw_netstats *tstats = this_cpu_ptr(netdev->tstats);
59
60                 u64_stats_update_begin(&tstats->syncp);
61                 tstats->tx_bytes += len;
62                 tstats->tx_packets++;
63                 u64_stats_update_end(&tstats->syncp);
64         } else {
65                 netdev->stats.tx_errors++;
66         }
67         return NETDEV_TX_OK;
68 }
69
70 static int internal_dev_open(struct net_device *netdev)
71 {
72         netif_start_queue(netdev);
73         return 0;
74 }
75
76 static int internal_dev_stop(struct net_device *netdev)
77 {
78         netif_stop_queue(netdev);
79         return 0;
80 }
81
82 static void internal_dev_getinfo(struct net_device *netdev,
83                                  struct ethtool_drvinfo *info)
84 {
85         strlcpy(info->driver, "openvswitch", sizeof(info->driver));
86 }
87
88 static const struct ethtool_ops internal_dev_ethtool_ops = {
89         .get_drvinfo    = internal_dev_getinfo,
90         .get_link       = ethtool_op_get_link,
91 };
92
93 static void internal_dev_destructor(struct net_device *dev)
94 {
95         struct vport *vport = ovs_internal_dev_get_vport(dev);
96
97         ovs_vport_free(vport);
98 }
99
100 static void
101 internal_get_stats(struct net_device *dev, struct rtnl_link_stats64 *stats)
102 {
103         int i;
104
105         memset(stats, 0, sizeof(*stats));
106         stats->rx_errors  = dev->stats.rx_errors;
107         stats->tx_errors  = dev->stats.tx_errors;
108         stats->tx_dropped = dev->stats.tx_dropped;
109         stats->rx_dropped = dev->stats.rx_dropped;
110
111         for_each_possible_cpu(i) {
112                 const struct pcpu_sw_netstats *percpu_stats;
113                 struct pcpu_sw_netstats local_stats;
114                 unsigned int start;
115
116                 percpu_stats = per_cpu_ptr(dev->tstats, i);
117
118                 do {
119                         start = u64_stats_fetch_begin_irq(&percpu_stats->syncp);
120                         local_stats = *percpu_stats;
121                 } while (u64_stats_fetch_retry_irq(&percpu_stats->syncp, start));
122
123                 stats->rx_bytes         += local_stats.rx_bytes;
124                 stats->rx_packets       += local_stats.rx_packets;
125                 stats->tx_bytes         += local_stats.tx_bytes;
126                 stats->tx_packets       += local_stats.tx_packets;
127         }
128 }
129
130 static void internal_set_rx_headroom(struct net_device *dev, int new_hr)
131 {
132         dev->needed_headroom = new_hr < 0 ? 0 : new_hr;
133 }
134
135 static const struct net_device_ops internal_dev_netdev_ops = {
136         .ndo_open = internal_dev_open,
137         .ndo_stop = internal_dev_stop,
138         .ndo_start_xmit = internal_dev_xmit,
139         .ndo_set_mac_address = eth_mac_addr,
140         .ndo_get_stats64 = internal_get_stats,
141         .ndo_set_rx_headroom = internal_set_rx_headroom,
142 };
143
144 static struct rtnl_link_ops internal_dev_link_ops __read_mostly = {
145         .kind = "openvswitch",
146 };
147
148 static void do_setup(struct net_device *netdev)
149 {
150         ether_setup(netdev);
151
152         netdev->max_mtu = ETH_MAX_MTU;
153
154         netdev->netdev_ops = &internal_dev_netdev_ops;
155
156         netdev->priv_flags &= ~IFF_TX_SKB_SHARING;
157         netdev->priv_flags |= IFF_LIVE_ADDR_CHANGE | IFF_OPENVSWITCH |
158                               IFF_PHONY_HEADROOM | IFF_NO_QUEUE;
159         netdev->needs_free_netdev = true;
160         netdev->priv_destructor = NULL;
161         netdev->ethtool_ops = &internal_dev_ethtool_ops;
162         netdev->rtnl_link_ops = &internal_dev_link_ops;
163
164         netdev->features = NETIF_F_LLTX | NETIF_F_SG | NETIF_F_FRAGLIST |
165                            NETIF_F_HIGHDMA | NETIF_F_HW_CSUM |
166                            NETIF_F_GSO_SOFTWARE | NETIF_F_GSO_ENCAP_ALL;
167
168         netdev->vlan_features = netdev->features;
169         netdev->hw_enc_features = netdev->features;
170         netdev->features |= NETIF_F_HW_VLAN_CTAG_TX | NETIF_F_HW_VLAN_STAG_TX;
171         netdev->hw_features = netdev->features & ~NETIF_F_LLTX;
172
173         eth_hw_addr_random(netdev);
174 }
175
176 static struct vport *internal_dev_create(const struct vport_parms *parms)
177 {
178         struct vport *vport;
179         struct internal_dev *internal_dev;
180         struct net_device *dev;
181         int err;
182
183         vport = ovs_vport_alloc(0, &ovs_internal_vport_ops, parms);
184         if (IS_ERR(vport)) {
185                 err = PTR_ERR(vport);
186                 goto error;
187         }
188
189         dev = alloc_netdev(sizeof(struct internal_dev),
190                            parms->name, NET_NAME_USER, do_setup);
191         vport->dev = dev;
192         if (!vport->dev) {
193                 err = -ENOMEM;
194                 goto error_free_vport;
195         }
196         vport->dev->tstats = netdev_alloc_pcpu_stats(struct pcpu_sw_netstats);
197         if (!vport->dev->tstats) {
198                 err = -ENOMEM;
199                 goto error_free_netdev;
200         }
201         vport->dev->needed_headroom = vport->dp->max_headroom;
202
203         dev_net_set(vport->dev, ovs_dp_get_net(vport->dp));
204         internal_dev = internal_dev_priv(vport->dev);
205         internal_dev->vport = vport;
206
207         /* Restrict bridge port to current netns. */
208         if (vport->port_no == OVSP_LOCAL)
209                 vport->dev->features |= NETIF_F_NETNS_LOCAL;
210
211         rtnl_lock();
212         err = register_netdevice(vport->dev);
213         if (err)
214                 goto error_unlock;
215         vport->dev->priv_destructor = internal_dev_destructor;
216
217         dev_set_promiscuity(vport->dev, 1);
218         rtnl_unlock();
219         netif_start_queue(vport->dev);
220
221         return vport;
222
223 error_unlock:
224         rtnl_unlock();
225         free_percpu(dev->tstats);
226 error_free_netdev:
227         free_netdev(dev);
228 error_free_vport:
229         ovs_vport_free(vport);
230 error:
231         return ERR_PTR(err);
232 }
233
234 static void internal_dev_destroy(struct vport *vport)
235 {
236         netif_stop_queue(vport->dev);
237         rtnl_lock();
238         dev_set_promiscuity(vport->dev, -1);
239
240         /* unregister_netdevice() waits for an RCU grace period. */
241         unregister_netdevice(vport->dev);
242         free_percpu(vport->dev->tstats);
243         rtnl_unlock();
244 }
245
246 static netdev_tx_t internal_dev_recv(struct sk_buff *skb)
247 {
248         struct net_device *netdev = skb->dev;
249         struct pcpu_sw_netstats *stats;
250
251         if (unlikely(!(netdev->flags & IFF_UP))) {
252                 kfree_skb(skb);
253                 netdev->stats.rx_dropped++;
254                 return NETDEV_TX_OK;
255         }
256
257         skb_dst_drop(skb);
258         nf_reset(skb);
259         secpath_reset(skb);
260
261         skb->pkt_type = PACKET_HOST;
262         skb->protocol = eth_type_trans(skb, netdev);
263         skb_postpull_rcsum(skb, eth_hdr(skb), ETH_HLEN);
264
265         stats = this_cpu_ptr(netdev->tstats);
266         u64_stats_update_begin(&stats->syncp);
267         stats->rx_packets++;
268         stats->rx_bytes += skb->len;
269         u64_stats_update_end(&stats->syncp);
270
271         netif_rx(skb);
272         return NETDEV_TX_OK;
273 }
274
275 static struct vport_ops ovs_internal_vport_ops = {
276         .type           = OVS_VPORT_TYPE_INTERNAL,
277         .create         = internal_dev_create,
278         .destroy        = internal_dev_destroy,
279         .send           = internal_dev_recv,
280 };
281
282 int ovs_is_internal_dev(const struct net_device *netdev)
283 {
284         return netdev->netdev_ops == &internal_dev_netdev_ops;
285 }
286
287 struct vport *ovs_internal_dev_get_vport(struct net_device *netdev)
288 {
289         if (!ovs_is_internal_dev(netdev))
290                 return NULL;
291
292         return internal_dev_priv(netdev)->vport;
293 }
294
295 int ovs_internal_dev_rtnl_link_register(void)
296 {
297         int err;
298
299         err = rtnl_link_register(&internal_dev_link_ops);
300         if (err < 0)
301                 return err;
302
303         err = ovs_vport_ops_register(&ovs_internal_vport_ops);
304         if (err < 0)
305                 rtnl_link_unregister(&internal_dev_link_ops);
306
307         return err;
308 }
309
310 void ovs_internal_dev_rtnl_link_unregister(void)
311 {
312         ovs_vport_ops_unregister(&ovs_internal_vport_ops);
313         rtnl_link_unregister(&internal_dev_link_ops);
314 }