1 /*
2  * Copyright (c) 2007-2011 Nicira Networks.
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 "datapath.h"
28 #include "vport-internal_dev.h"
29 #include "vport-netdev.h"
30 
31 struct internal_dev {
32 	struct vport *vport;
33 };
34 
35 static struct internal_dev *internal_dev_priv(struct net_device *netdev)
36 {
37 	return netdev_priv(netdev);
38 }
39 
40 /* This function is only called by the kernel network layer.*/
41 static struct rtnl_link_stats64 *internal_dev_get_stats(struct net_device *netdev,
42 							struct rtnl_link_stats64 *stats)
43 {
44 	struct vport *vport = ovs_internal_dev_get_vport(netdev);
45 	struct ovs_vport_stats vport_stats;
46 
47 	ovs_vport_get_stats(vport, &vport_stats);
48 
49 	/* The tx and rx stats need to be swapped because the
50 	 * switch and host OS have opposite perspectives. */
51 	stats->rx_packets	= vport_stats.tx_packets;
52 	stats->tx_packets	= vport_stats.rx_packets;
53 	stats->rx_bytes		= vport_stats.tx_bytes;
54 	stats->tx_bytes		= vport_stats.rx_bytes;
55 	stats->rx_errors	= vport_stats.tx_errors;
56 	stats->tx_errors	= vport_stats.rx_errors;
57 	stats->rx_dropped	= vport_stats.tx_dropped;
58 	stats->tx_dropped	= vport_stats.rx_dropped;
59 
60 	return stats;
61 }
62 
63 static int internal_dev_mac_addr(struct net_device *dev, void *p)
64 {
65 	struct sockaddr *addr = p;
66 
67 	if (!is_valid_ether_addr(addr->sa_data))
68 		return -EADDRNOTAVAIL;
69 	dev->addr_assign_type &= ~NET_ADDR_RANDOM;
70 	memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
71 	return 0;
72 }
73 
74 /* Called with rcu_read_lock_bh. */
75 static int internal_dev_xmit(struct sk_buff *skb, struct net_device *netdev)
76 {
77 	rcu_read_lock();
78 	ovs_vport_receive(internal_dev_priv(netdev)->vport, skb);
79 	rcu_read_unlock();
80 	return 0;
81 }
82 
83 static int internal_dev_open(struct net_device *netdev)
84 {
85 	netif_start_queue(netdev);
86 	return 0;
87 }
88 
89 static int internal_dev_stop(struct net_device *netdev)
90 {
91 	netif_stop_queue(netdev);
92 	return 0;
93 }
94 
95 static void internal_dev_getinfo(struct net_device *netdev,
96 				 struct ethtool_drvinfo *info)
97 {
98 	strcpy(info->driver, "openvswitch");
99 }
100 
101 static const struct ethtool_ops internal_dev_ethtool_ops = {
102 	.get_drvinfo	= internal_dev_getinfo,
103 	.get_link	= ethtool_op_get_link,
104 };
105 
106 static int internal_dev_change_mtu(struct net_device *netdev, int new_mtu)
107 {
108 	if (new_mtu < 68)
109 		return -EINVAL;
110 
111 	netdev->mtu = new_mtu;
112 	return 0;
113 }
114 
115 static void internal_dev_destructor(struct net_device *dev)
116 {
117 	struct vport *vport = ovs_internal_dev_get_vport(dev);
118 
119 	ovs_vport_free(vport);
120 	free_netdev(dev);
121 }
122 
123 static const struct net_device_ops internal_dev_netdev_ops = {
124 	.ndo_open = internal_dev_open,
125 	.ndo_stop = internal_dev_stop,
126 	.ndo_start_xmit = internal_dev_xmit,
127 	.ndo_set_mac_address = internal_dev_mac_addr,
128 	.ndo_change_mtu = internal_dev_change_mtu,
129 	.ndo_get_stats64 = internal_dev_get_stats,
130 };
131 
132 static void do_setup(struct net_device *netdev)
133 {
134 	ether_setup(netdev);
135 
136 	netdev->netdev_ops = &internal_dev_netdev_ops;
137 
138 	netdev->priv_flags &= ~IFF_TX_SKB_SHARING;
139 	netdev->destructor = internal_dev_destructor;
140 	SET_ETHTOOL_OPS(netdev, &internal_dev_ethtool_ops);
141 	netdev->tx_queue_len = 0;
142 
143 	netdev->features = NETIF_F_LLTX | NETIF_F_SG | NETIF_F_FRAGLIST |
144 				NETIF_F_HIGHDMA | NETIF_F_HW_CSUM | NETIF_F_TSO;
145 
146 	netdev->vlan_features = netdev->features;
147 	netdev->features |= NETIF_F_HW_VLAN_TX;
148 	netdev->hw_features = netdev->features & ~NETIF_F_LLTX;
149 	eth_hw_addr_random(netdev);
150 }
151 
152 static struct vport *internal_dev_create(const struct vport_parms *parms)
153 {
154 	struct vport *vport;
155 	struct netdev_vport *netdev_vport;
156 	struct internal_dev *internal_dev;
157 	int err;
158 
159 	vport = ovs_vport_alloc(sizeof(struct netdev_vport),
160 				&ovs_internal_vport_ops, parms);
161 	if (IS_ERR(vport)) {
162 		err = PTR_ERR(vport);
163 		goto error;
164 	}
165 
166 	netdev_vport = netdev_vport_priv(vport);
167 
168 	netdev_vport->dev = alloc_netdev(sizeof(struct internal_dev),
169 					 parms->name, do_setup);
170 	if (!netdev_vport->dev) {
171 		err = -ENOMEM;
172 		goto error_free_vport;
173 	}
174 
175 	internal_dev = internal_dev_priv(netdev_vport->dev);
176 	internal_dev->vport = vport;
177 
178 	err = register_netdevice(netdev_vport->dev);
179 	if (err)
180 		goto error_free_netdev;
181 
182 	dev_set_promiscuity(netdev_vport->dev, 1);
183 	netif_start_queue(netdev_vport->dev);
184 
185 	return vport;
186 
187 error_free_netdev:
188 	free_netdev(netdev_vport->dev);
189 error_free_vport:
190 	ovs_vport_free(vport);
191 error:
192 	return ERR_PTR(err);
193 }
194 
195 static void internal_dev_destroy(struct vport *vport)
196 {
197 	struct netdev_vport *netdev_vport = netdev_vport_priv(vport);
198 
199 	netif_stop_queue(netdev_vport->dev);
200 	dev_set_promiscuity(netdev_vport->dev, -1);
201 
202 	/* unregister_netdevice() waits for an RCU grace period. */
203 	unregister_netdevice(netdev_vport->dev);
204 }
205 
206 static int internal_dev_recv(struct vport *vport, struct sk_buff *skb)
207 {
208 	struct net_device *netdev = netdev_vport_priv(vport)->dev;
209 	int len;
210 
211 	len = skb->len;
212 	skb->dev = netdev;
213 	skb->pkt_type = PACKET_HOST;
214 	skb->protocol = eth_type_trans(skb, netdev);
215 
216 	netif_rx(skb);
217 
218 	return len;
219 }
220 
221 const struct vport_ops ovs_internal_vport_ops = {
222 	.type		= OVS_VPORT_TYPE_INTERNAL,
223 	.create		= internal_dev_create,
224 	.destroy	= internal_dev_destroy,
225 	.get_name	= ovs_netdev_get_name,
226 	.get_ifindex	= ovs_netdev_get_ifindex,
227 	.send		= internal_dev_recv,
228 };
229 
230 int ovs_is_internal_dev(const struct net_device *netdev)
231 {
232 	return netdev->netdev_ops == &internal_dev_netdev_ops;
233 }
234 
235 struct vport *ovs_internal_dev_get_vport(struct net_device *netdev)
236 {
237 	if (!ovs_is_internal_dev(netdev))
238 		return NULL;
239 
240 	return internal_dev_priv(netdev)->vport;
241 }
242