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