Merge tag 'dmaengine-5.15-rc1' of git://git.kernel.org/pub/scm/linux/kernel/git/vkoul...
[platform/kernel/linux-rpi.git] / net / openvswitch / vport-internal_dev.c
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         /* store len value because skb can be freed inside ovs_vport_receive() */
39         len = skb->len;
40
41         rcu_read_lock();
42         err = ovs_vport_receive(internal_dev_priv(netdev)->vport, skb, NULL);
43         rcu_read_unlock();
44
45         if (likely(!err))
46                 dev_sw_netstats_tx_add(netdev, 1, len);
47         else
48                 netdev->stats.tx_errors++;
49
50         return NETDEV_TX_OK;
51 }
52
53 static int internal_dev_open(struct net_device *netdev)
54 {
55         netif_start_queue(netdev);
56         return 0;
57 }
58
59 static int internal_dev_stop(struct net_device *netdev)
60 {
61         netif_stop_queue(netdev);
62         return 0;
63 }
64
65 static void internal_dev_getinfo(struct net_device *netdev,
66                                  struct ethtool_drvinfo *info)
67 {
68         strlcpy(info->driver, "openvswitch", sizeof(info->driver));
69 }
70
71 static const struct ethtool_ops internal_dev_ethtool_ops = {
72         .get_drvinfo    = internal_dev_getinfo,
73         .get_link       = ethtool_op_get_link,
74 };
75
76 static void internal_dev_destructor(struct net_device *dev)
77 {
78         struct vport *vport = ovs_internal_dev_get_vport(dev);
79
80         ovs_vport_free(vport);
81 }
82
83 static const struct net_device_ops internal_dev_netdev_ops = {
84         .ndo_open = internal_dev_open,
85         .ndo_stop = internal_dev_stop,
86         .ndo_start_xmit = internal_dev_xmit,
87         .ndo_set_mac_address = eth_mac_addr,
88         .ndo_get_stats64 = dev_get_tstats64,
89 };
90
91 static struct rtnl_link_ops internal_dev_link_ops __read_mostly = {
92         .kind = "openvswitch",
93 };
94
95 static void do_setup(struct net_device *netdev)
96 {
97         ether_setup(netdev);
98
99         netdev->max_mtu = ETH_MAX_MTU;
100
101         netdev->netdev_ops = &internal_dev_netdev_ops;
102
103         netdev->priv_flags &= ~IFF_TX_SKB_SHARING;
104         netdev->priv_flags |= IFF_LIVE_ADDR_CHANGE | IFF_OPENVSWITCH |
105                               IFF_NO_QUEUE;
106         netdev->needs_free_netdev = true;
107         netdev->priv_destructor = NULL;
108         netdev->ethtool_ops = &internal_dev_ethtool_ops;
109         netdev->rtnl_link_ops = &internal_dev_link_ops;
110
111         netdev->features = NETIF_F_LLTX | NETIF_F_SG | NETIF_F_FRAGLIST |
112                            NETIF_F_HIGHDMA | NETIF_F_HW_CSUM |
113                            NETIF_F_GSO_SOFTWARE | NETIF_F_GSO_ENCAP_ALL;
114
115         netdev->vlan_features = netdev->features;
116         netdev->hw_enc_features = netdev->features;
117         netdev->features |= NETIF_F_HW_VLAN_CTAG_TX | NETIF_F_HW_VLAN_STAG_TX;
118         netdev->hw_features = netdev->features & ~NETIF_F_LLTX;
119
120         eth_hw_addr_random(netdev);
121 }
122
123 static struct vport *internal_dev_create(const struct vport_parms *parms)
124 {
125         struct vport *vport;
126         struct internal_dev *internal_dev;
127         struct net_device *dev;
128         int err;
129
130         vport = ovs_vport_alloc(0, &ovs_internal_vport_ops, parms);
131         if (IS_ERR(vport)) {
132                 err = PTR_ERR(vport);
133                 goto error;
134         }
135
136         dev = alloc_netdev(sizeof(struct internal_dev),
137                            parms->name, NET_NAME_USER, do_setup);
138         vport->dev = dev;
139         if (!vport->dev) {
140                 err = -ENOMEM;
141                 goto error_free_vport;
142         }
143         vport->dev->tstats = netdev_alloc_pcpu_stats(struct pcpu_sw_netstats);
144         if (!vport->dev->tstats) {
145                 err = -ENOMEM;
146                 goto error_free_netdev;
147         }
148
149         dev_net_set(vport->dev, ovs_dp_get_net(vport->dp));
150         internal_dev = internal_dev_priv(vport->dev);
151         internal_dev->vport = vport;
152
153         /* Restrict bridge port to current netns. */
154         if (vport->port_no == OVSP_LOCAL)
155                 vport->dev->features |= NETIF_F_NETNS_LOCAL;
156
157         rtnl_lock();
158         err = register_netdevice(vport->dev);
159         if (err)
160                 goto error_unlock;
161         vport->dev->priv_destructor = internal_dev_destructor;
162
163         dev_set_promiscuity(vport->dev, 1);
164         rtnl_unlock();
165         netif_start_queue(vport->dev);
166
167         return vport;
168
169 error_unlock:
170         rtnl_unlock();
171         free_percpu(dev->tstats);
172 error_free_netdev:
173         free_netdev(dev);
174 error_free_vport:
175         ovs_vport_free(vport);
176 error:
177         return ERR_PTR(err);
178 }
179
180 static void internal_dev_destroy(struct vport *vport)
181 {
182         netif_stop_queue(vport->dev);
183         rtnl_lock();
184         dev_set_promiscuity(vport->dev, -1);
185
186         /* unregister_netdevice() waits for an RCU grace period. */
187         unregister_netdevice(vport->dev);
188         free_percpu(vport->dev->tstats);
189         rtnl_unlock();
190 }
191
192 static netdev_tx_t internal_dev_recv(struct sk_buff *skb)
193 {
194         struct net_device *netdev = skb->dev;
195
196         if (unlikely(!(netdev->flags & IFF_UP))) {
197                 kfree_skb(skb);
198                 netdev->stats.rx_dropped++;
199                 return NETDEV_TX_OK;
200         }
201
202         skb_dst_drop(skb);
203         nf_reset_ct(skb);
204         secpath_reset(skb);
205
206         skb->pkt_type = PACKET_HOST;
207         skb->protocol = eth_type_trans(skb, netdev);
208         skb_postpull_rcsum(skb, eth_hdr(skb), ETH_HLEN);
209         dev_sw_netstats_rx_add(netdev, skb->len);
210
211         netif_rx(skb);
212         return NETDEV_TX_OK;
213 }
214
215 static struct vport_ops ovs_internal_vport_ops = {
216         .type           = OVS_VPORT_TYPE_INTERNAL,
217         .create         = internal_dev_create,
218         .destroy        = internal_dev_destroy,
219         .send           = internal_dev_recv,
220 };
221
222 int ovs_is_internal_dev(const struct net_device *netdev)
223 {
224         return netdev->netdev_ops == &internal_dev_netdev_ops;
225 }
226
227 struct vport *ovs_internal_dev_get_vport(struct net_device *netdev)
228 {
229         if (!ovs_is_internal_dev(netdev))
230                 return NULL;
231
232         return internal_dev_priv(netdev)->vport;
233 }
234
235 int ovs_internal_dev_rtnl_link_register(void)
236 {
237         int err;
238
239         err = rtnl_link_register(&internal_dev_link_ops);
240         if (err < 0)
241                 return err;
242
243         err = ovs_vport_ops_register(&ovs_internal_vport_ops);
244         if (err < 0)
245                 rtnl_link_unregister(&internal_dev_link_ops);
246
247         return err;
248 }
249
250 void ovs_internal_dev_rtnl_link_unregister(void)
251 {
252         ovs_vport_ops_unregister(&ovs_internal_vport_ops);
253         rtnl_link_unregister(&internal_dev_link_ops);
254 }