datapath/dp_dev.c

   1 #include <linux/kernel.h>
   2 #include <linux/netdevice.h>
   3 #include <linux/etherdevice.h>
   4 #include <linux/rcupdate.h>
   5 #include <linux/skbuff.h>
   6 #include <linux/workqueue.h>
   7
   8 #include "datapath.h"
   9 #include "forward.h"
  10
  11 struct dp_dev {
  12         struct net_device_stats stats;
  13         struct datapath *dp;
  14         struct sk_buff_head xmit_queue;
  15         struct work_struct xmit_work;
  16 };
  17
  18
  19 static struct dp_dev *dp_dev_priv(struct net_device *netdev)
  20 {
  21         return netdev_priv(netdev);
  22 }
  23
  24 static struct net_device_stats *dp_dev_get_stats(struct net_device *netdev)
  25 {
  26         struct dp_dev *dp_dev = dp_dev_priv(netdev);
  27         return &dp_dev->stats;
  28 }
  29
  30 int dp_dev_recv(struct net_device *netdev, struct sk_buff *skb)
  31 {
  32         int len = skb->len;
  33         struct dp_dev *dp_dev = dp_dev_priv(netdev);
  34         skb->dev = netdev;
  35         skb->pkt_type = PACKET_HOST;
  36         skb->protocol = eth_type_trans(skb, netdev);
  37         if (in_interrupt())
  38                 netif_rx(skb);
  39         else
  40                 netif_rx_ni(skb);
  41         netdev->last_rx = jiffies;
  42         dp_dev->stats.rx_packets++;
  43         dp_dev->stats.rx_bytes += len;
  44         return len;
  45 }
  46
  47 static int dp_dev_mac_addr(struct net_device *dev, void *p)
  48 {
  49         struct sockaddr *addr = p;
  50
  51         if (netif_running(dev))
  52                 return -EBUSY;
  53         if (!is_valid_ether_addr(addr->sa_data))
  54                 return -EADDRNOTAVAIL;
  55         memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
  56         return 0;
  57 }
  58
  59 static int dp_dev_xmit(struct sk_buff *skb, struct net_device *netdev)
  60 {
  61         struct dp_dev *dp_dev = dp_dev_priv(netdev);
  62         struct datapath *dp = dp_dev->dp;
  63
  64         dp_dev->stats.tx_packets++;
  65         dp_dev->stats.tx_bytes += skb->len;
  66
  67         if (skb_queue_len(&dp_dev->xmit_queue) >= dp->netdev->tx_queue_len) {
  68                 /* Queue overflow.  Stop transmitter. */
  69                 netif_stop_queue(dp->netdev);
  70
  71                 /* We won't see all dropped packets individually, so overrun
  72                  * error is appropriate. */
  73                 dp_dev->stats.tx_fifo_errors++;
  74         }
  75         skb_queue_tail(&dp_dev->xmit_queue, skb);
  76         dp->netdev->trans_start = jiffies;
  77
  78         schedule_work(&dp_dev->xmit_work);
  79
  80         return 0;
  81 }
  82
  83 static void dp_dev_do_xmit(struct work_struct *work)
  84 {
  85         struct dp_dev *dp_dev = container_of(work, struct dp_dev, xmit_work);
  86         struct datapath *dp = dp_dev->dp;
  87         struct sk_buff *skb;
  88
  89         while ((skb = skb_dequeue(&dp_dev->xmit_queue)) != NULL) {
  90                 skb_reset_mac_header(skb);
  91                 rcu_read_lock();
  92                 fwd_port_input(dp->chain, skb, dp->local_port);
  93                 rcu_read_unlock();
  94         }
  95         netif_wake_queue(dp->netdev);
  96 }
  97
  98 static int dp_dev_open(struct net_device *netdev)
  99 {
 100         netif_start_queue(netdev);
 101         return 0;
 102 }
 103
 104 static int dp_dev_stop(struct net_device *netdev)
 105 {
 106         netif_stop_queue(netdev);
 107         return 0;
 108 }
 109
 110 static void
 111 do_setup(struct net_device *netdev)
 112 {
 113         ether_setup(netdev);
 114
 115         netdev->get_stats = dp_dev_get_stats;
 116         netdev->hard_start_xmit = dp_dev_xmit;
 117         netdev->open = dp_dev_open;
 118         netdev->stop = dp_dev_stop;
 119         netdev->tx_queue_len = 100;
 120         netdev->set_mac_address = dp_dev_mac_addr;
 121
 122         netdev->flags = IFF_BROADCAST | IFF_MULTICAST;
 123
 124         random_ether_addr(netdev->dev_addr);
 125         netdev->dev_addr[0] = 0x00;
 126         netdev->dev_addr[1] = 0x23;
 127         netdev->dev_addr[2] = 0x20;
 128 }
 129
 130
 131 int dp_dev_setup(struct datapath *dp)
 132 {
 133         struct dp_dev *dp_dev;
 134         struct net_device *netdev;
 135         char of_name[8];
 136         int err;
 137
 138         snprintf(of_name, sizeof of_name, "of%d", dp->dp_idx);
 139         netdev = alloc_netdev(sizeof(struct dp_dev), of_name, do_setup);
 140         if (!netdev)
 141                 return -ENOMEM;
 142
 143         err = register_netdev(netdev);
 144         if (err) {
 145                 free_netdev(netdev);
 146                 return err;
 147         }
 148
 149         dp_dev = dp_dev_priv(netdev);
 150         dp_dev->dp = dp;
 151         skb_queue_head_init(&dp_dev->xmit_queue);
 152         INIT_WORK(&dp_dev->xmit_work, dp_dev_do_xmit);
 153         dp->netdev = netdev;
 154         return 0;
 155 }
 156
 157 void dp_dev_destroy(struct datapath *dp)
 158 {
 159         struct dp_dev *dp_dev = dp_dev_priv(dp->netdev);
 160
 161         netif_tx_disable(dp->netdev);
 162         synchronize_net();
 163         skb_queue_purge(&dp_dev->xmit_queue);
 164         unregister_netdev(dp->netdev);
 165         free_netdev(dp->netdev);
 166 }
 167
 168 int is_dp_dev(struct net_device *netdev)
 169 {
 170         return netdev->open == dp_dev_open;
 171 }