datapath/vport-internal_dev.c

   1 /*
   2  * Copyright (c) 2009, 2010 Nicira Networks.
   3  * Distributed under the terms of the GNU GPL version 2.
   4  *
   5  * Significant portions of this file may be copied from parts of the Linux
   6  * kernel, by Linus Torvalds and others.
   7  */
   8
   9 #include <linux/kernel.h>
  10 #include <linux/netdevice.h>
  11 #include <linux/etherdevice.h>
  12 #include <linux/ethtool.h>
  13 #include <linux/percpu.h>
  14 #include <linux/preempt.h>
  15 #include <linux/rcupdate.h>
  16 #include <linux/skbuff.h>
  17 #include <linux/workqueue.h>
  18
  19 #include "datapath.h"
  20 #include "openvswitch/internal_dev.h"
  21 #include "vport-internal_dev.h"
  22 #include "vport-netdev.h"
  23
  24 struct pcpu_lstats {
  25         unsigned long rx_packets;
  26         unsigned long rx_bytes;
  27         unsigned long tx_packets;
  28         unsigned long tx_bytes;
  29 };
  30
  31 struct internal_dev {
  32         struct vport *vport;
  33
  34         struct net_device_stats stats;
  35         struct pcpu_lstats *lstats;
  36
  37         /* This is warty support for XAPI, which does not support summing bond
  38          * device statistics itself.  'extra_stats' can be set by userspace via
  39          * the DP_DEV_SET_STATS ioctl and, if they are, then they are added to
  40          * the real device stats. */
  41         struct pcpu_lstats extra_stats;
  42 };
  43
  44 struct vport_ops internal_vport_ops;
  45
  46 static inline struct internal_dev *internal_dev_priv(struct net_device *netdev)
  47 {
  48         return netdev_priv(netdev);
  49 }
  50
  51 static struct net_device_stats *internal_dev_get_stats(struct net_device *netdev)
  52 {
  53         struct internal_dev *internal_dev = internal_dev_priv(netdev);
  54         struct net_device_stats *stats;
  55         int i;
  56
  57         stats = &internal_dev->stats;
  58         stats->rx_bytes = internal_dev->extra_stats.rx_bytes;
  59         stats->rx_packets = internal_dev->extra_stats.rx_packets;
  60         stats->tx_bytes = internal_dev->extra_stats.tx_bytes;
  61         stats->tx_packets = internal_dev->extra_stats.tx_packets;
  62         for_each_possible_cpu(i) {
  63                 const struct pcpu_lstats *lb_stats;
  64
  65                 lb_stats = per_cpu_ptr(internal_dev->lstats, i);
  66                 stats->rx_bytes   += lb_stats->rx_bytes;
  67                 stats->rx_packets += lb_stats->rx_packets;
  68                 stats->tx_bytes   += lb_stats->tx_bytes;
  69                 stats->tx_packets += lb_stats->tx_packets;
  70         }
  71         return stats;
  72 }
  73
  74 static int internal_dev_mac_addr(struct net_device *dev, void *p)
  75 {
  76         struct sockaddr *addr = p;
  77
  78         if (!is_valid_ether_addr(addr->sa_data))
  79                 return -EADDRNOTAVAIL;
  80         memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
  81         return 0;
  82 }
  83
  84 /* Not reentrant (because it is called with BHs disabled), but may be called
  85  * simultaneously on different CPUs. */
  86 static int internal_dev_xmit(struct sk_buff *skb, struct net_device *netdev)
  87 {
  88         struct internal_dev *internal_dev = internal_dev_priv(netdev);
  89         struct vport *vport = internal_dev_get_vport(netdev);
  90         struct pcpu_lstats *lb_stats;
  91
  92         /* We need our own clone. */
  93         skb = skb_share_check(skb, GFP_ATOMIC);
  94         if (!skb)
  95                 return 0;
  96
  97         lb_stats = per_cpu_ptr(internal_dev->lstats, smp_processor_id());
  98         lb_stats->tx_packets++;
  99         lb_stats->tx_bytes += skb->len;
 100
 101         skb_reset_mac_header(skb);
 102         rcu_read_lock_bh();
 103         vport_receive(vport, skb);
 104         rcu_read_unlock_bh();
 105
 106         return 0;
 107 }
 108
 109 static int internal_dev_open(struct net_device *netdev)
 110 {
 111         netif_start_queue(netdev);
 112         return 0;
 113 }
 114
 115 static int internal_dev_stop(struct net_device *netdev)
 116 {
 117         netif_stop_queue(netdev);
 118         return 0;
 119 }
 120
 121 static void internal_dev_getinfo(struct net_device *netdev,
 122                                  struct ethtool_drvinfo *info)
 123 {
 124         struct dp_port *dp_port = vport_get_dp_port(internal_dev_get_vport(netdev));
 125
 126         strcpy(info->driver, "openvswitch");
 127         if (dp_port)
 128                 sprintf(info->bus_info, "%d.%d", dp_port->dp->dp_idx, dp_port->port_no);
 129 }
 130
 131 static struct ethtool_ops internal_dev_ethtool_ops = {
 132         .get_drvinfo = internal_dev_getinfo,
 133         .get_link = ethtool_op_get_link,
 134         .get_sg = ethtool_op_get_sg,
 135         .get_tx_csum = ethtool_op_get_tx_csum,
 136         .get_tso = ethtool_op_get_tso,
 137 };
 138
 139 static int internal_dev_change_mtu(struct net_device *netdev, int new_mtu)
 140 {
 141         struct dp_port *dp_port = vport_get_dp_port(internal_dev_get_vport(netdev));
 142
 143         if (new_mtu < 68)
 144                 return -EINVAL;
 145
 146         if (dp_port) {
 147                 if (new_mtu > dp_min_mtu(dp_port->dp))
 148                         return -EINVAL;
 149         }
 150
 151         netdev->mtu = new_mtu;
 152         return 0;
 153 }
 154
 155 static int internal_dev_init(struct net_device *netdev)
 156 {
 157         struct internal_dev *internal_dev = internal_dev_priv(netdev);
 158
 159         internal_dev->lstats = alloc_percpu(struct pcpu_lstats);
 160         if (!internal_dev->lstats)
 161                 return -ENOMEM;
 162
 163         return 0;
 164 }
 165
 166 static void internal_dev_free(struct net_device *netdev)
 167 {
 168         struct internal_dev *internal_dev = internal_dev_priv(netdev);
 169
 170         free_percpu(internal_dev->lstats);
 171         free_netdev(netdev);
 172 }
 173
 174 static int internal_dev_do_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
 175 {
 176         struct internal_dev *internal_dev = internal_dev_priv(dev);
 177
 178         if (cmd == INTERNAL_DEV_SET_STATS) {
 179                 struct internal_dev_stats stats;
 180
 181                 if (copy_from_user(&stats, ifr->ifr_data, sizeof(stats)))
 182                         return -EFAULT;
 183
 184                 internal_dev->extra_stats.rx_bytes = stats.rx_bytes;
 185                 internal_dev->extra_stats.rx_packets = stats.rx_packets;
 186                 internal_dev->extra_stats.tx_bytes = stats.tx_bytes;
 187                 internal_dev->extra_stats.tx_packets = stats.tx_packets;
 188
 189                 return 0;
 190         }
 191
 192         if (dp_ioctl_hook)
 193                 return dp_ioctl_hook(dev, ifr, cmd);
 194         return -EOPNOTSUPP;
 195 }
 196
 197 #ifdef HAVE_NET_DEVICE_OPS
 198 static const struct net_device_ops internal_dev_netdev_ops = {
 199         .ndo_init = internal_dev_init,
 200         .ndo_open = internal_dev_open,
 201         .ndo_stop = internal_dev_stop,
 202         .ndo_start_xmit = internal_dev_xmit,
 203         .ndo_set_mac_address = internal_dev_mac_addr,
 204         .ndo_do_ioctl = internal_dev_do_ioctl,
 205         .ndo_change_mtu = internal_dev_change_mtu,
 206         .ndo_get_stats = internal_dev_get_stats,
 207 };
 208 #endif
 209
 210 static void
 211 do_setup(struct net_device *netdev)
 212 {
 213         ether_setup(netdev);
 214
 215 #ifdef HAVE_NET_DEVICE_OPS
 216         netdev->netdev_ops = &internal_dev_netdev_ops;
 217 #else
 218         netdev->do_ioctl = internal_dev_do_ioctl;
 219         netdev->get_stats = internal_dev_get_stats;
 220         netdev->hard_start_xmit = internal_dev_xmit;
 221         netdev->open = internal_dev_open;
 222         netdev->stop = internal_dev_stop;
 223         netdev->set_mac_address = internal_dev_mac_addr;
 224         netdev->change_mtu = internal_dev_change_mtu;
 225         netdev->init = internal_dev_init;
 226 #endif
 227
 228         netdev->destructor = internal_dev_free;
 229         SET_ETHTOOL_OPS(netdev, &internal_dev_ethtool_ops);
 230         netdev->tx_queue_len = 0;
 231
 232         netdev->flags = IFF_BROADCAST | IFF_MULTICAST;
 233         netdev->features = NETIF_F_LLTX; /* XXX other features? */
 234
 235         vport_gen_ether_addr(netdev->dev_addr);
 236 }
 237
 238 static struct vport *
 239 internal_dev_create(const char *name, const void __user *config)
 240 {
 241         struct vport *vport;
 242         struct netdev_vport *netdev_vport;
 243         struct internal_dev *internal_dev;
 244         int err;
 245
 246         vport = vport_alloc(sizeof(struct netdev_vport), &internal_vport_ops);
 247         if (IS_ERR(vport)) {
 248                 err = PTR_ERR(vport);
 249                 goto error;
 250         }
 251
 252         netdev_vport = netdev_vport_priv(vport);
 253
 254         netdev_vport->dev = alloc_netdev(sizeof(struct internal_dev), name, do_setup);
 255         if (!netdev_vport->dev) {
 256                 err = -ENOMEM;
 257                 goto error_free_vport;
 258         }
 259
 260         internal_dev = internal_dev_priv(netdev_vport->dev);
 261         internal_dev->vport = vport;
 262
 263         err = register_netdevice(netdev_vport->dev);
 264         if (err)
 265                 goto error_free_netdev;
 266
 267         return vport;
 268
 269 error_free_netdev:
 270         free_netdev(netdev_vport->dev);
 271 error_free_vport:
 272         vport_free(vport);
 273 error:
 274         return ERR_PTR(err);
 275 }
 276
 277 static int
 278 internal_dev_destroy(struct vport *vport)
 279 {
 280         struct netdev_vport *netdev_vport = netdev_vport_priv(vport);
 281
 282         unregister_netdevice(netdev_vport->dev);
 283         vport_free(vport);
 284
 285         return 0;
 286 }
 287
 288 static int
 289 internal_dev_attach(struct vport *vport)
 290 {
 291         struct netdev_vport *netdev_vport = netdev_vport_priv(vport);
 292
 293         dev_set_promiscuity(netdev_vport->dev, 1);
 294
 295         /* It would make sense to assign dev->br_port here too, but
 296          * that causes packets received on internal ports to get caught
 297          * in netdev_frame_hook().  In turn netdev_frame_hook() can reject them
 298          * back to the network stack, but that's a waste of time. */
 299
 300         return 0;
 301 }
 302
 303 static int
 304 internal_dev_detach(struct vport *vport)
 305 {
 306         struct netdev_vport *netdev_vport = netdev_vport_priv(vport);
 307
 308         dev_set_promiscuity(netdev_vport->dev, -1);
 309
 310         /* Make sure that no packets arrive from now on, since
 311          * internal_dev_xmit() will try to find itself through
 312          * p->dp->ports[], and we're about to set that to null. */
 313         netif_tx_disable(netdev_vport->dev);
 314
 315         return 0;
 316 }
 317
 318 static int
 319 internal_dev_recv(struct vport *vport, struct sk_buff *skb)
 320 {
 321         struct net_device *netdev = netdev_vport_priv(vport)->dev;
 322         struct internal_dev *internal_dev = internal_dev_priv(netdev);
 323         struct pcpu_lstats *lb_stats;
 324         int len;
 325
 326         skb->dev = netdev;
 327         len = skb->len;
 328         skb->pkt_type = PACKET_HOST;
 329         skb->protocol = eth_type_trans(skb, netdev);
 330
 331         if (in_interrupt())
 332                 netif_rx(skb);
 333         else
 334                 netif_rx_ni(skb);
 335         netdev->last_rx = jiffies;
 336
 337         preempt_disable();
 338         lb_stats = per_cpu_ptr(internal_dev->lstats, smp_processor_id());
 339         lb_stats->rx_packets++;
 340         lb_stats->rx_bytes += len;
 341         preempt_enable();
 342
 343         return len;
 344 }
 345
 346 struct vport_ops internal_vport_ops = {
 347         .type           = "internal",
 348         .flags          = VPORT_F_REQUIRED,
 349         .create         = internal_dev_create,
 350         .destroy        = internal_dev_destroy,
 351         .attach         = internal_dev_attach,
 352         .detach         = internal_dev_detach,
 353         .set_mtu        = netdev_set_mtu,
 354         .set_addr       = netdev_set_addr,
 355         .get_name       = netdev_get_name,
 356         .get_addr       = netdev_get_addr,
 357         .get_kobj       = netdev_get_kobj,
 358         .get_stats      = netdev_get_stats,
 359         .get_dev_flags  = netdev_get_dev_flags,
 360         .is_running     = netdev_is_running,
 361         .get_operstate  = netdev_get_operstate,
 362         .get_ifindex    = netdev_get_ifindex,
 363         .get_iflink     = netdev_get_iflink,
 364         .get_mtu        = netdev_get_mtu,
 365         .send           = internal_dev_recv,
 366 };
 367
 368 int is_internal_dev(const struct net_device *netdev)
 369 {
 370 #ifdef HAVE_NET_DEVICE_OPS
 371         return netdev->netdev_ops == &internal_dev_netdev_ops;
 372 #else
 373         return netdev->open == internal_dev_open;
 374 #endif
 375 }
 376
 377 int
 378 is_internal_vport(const struct vport *vport)
 379 {
 380         return vport->ops == &internal_vport_ops;
 381 }
 382
 383 struct vport *
 384 internal_dev_get_vport(struct net_device *netdev)
 385 {
 386         struct internal_dev *internal_dev = internal_dev_priv(netdev);
 387         return rcu_dereference(internal_dev->vport);
 388 }