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>
12 struct net_device_stats stats;
14 struct sk_buff_head xmit_queue;
15 struct work_struct xmit_work;
19 static struct dp_dev *dp_dev_priv(struct net_device *netdev)
21 return netdev_priv(netdev);
24 static struct net_device_stats *dp_dev_get_stats(struct net_device *netdev)
26 struct dp_dev *dp_dev = dp_dev_priv(netdev);
27 return &dp_dev->stats;
30 int dp_dev_recv(struct net_device *netdev, struct sk_buff *skb)
33 struct dp_dev *dp_dev = dp_dev_priv(netdev);
35 skb->pkt_type = PACKET_HOST;
36 skb->protocol = eth_type_trans(skb, netdev);
41 netdev->last_rx = jiffies;
42 dp_dev->stats.rx_packets++;
43 dp_dev->stats.rx_bytes += len;
47 static int dp_dev_mac_addr(struct net_device *dev, void *p)
49 struct sockaddr *addr = p;
51 if (netif_running(dev))
53 if (!is_valid_ether_addr(addr->sa_data))
54 return -EADDRNOTAVAIL;
55 memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
59 static int dp_dev_xmit(struct sk_buff *skb, struct net_device *netdev)
61 struct dp_dev *dp_dev = dp_dev_priv(netdev);
62 struct datapath *dp = dp_dev->dp;
64 dp_dev->stats.tx_packets++;
65 dp_dev->stats.tx_bytes += skb->len;
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);
71 /* We won't see all dropped packets individually, so overrun
72 * error is appropriate. */
73 dp_dev->stats.tx_fifo_errors++;
75 skb_queue_tail(&dp_dev->xmit_queue, skb);
76 dp->netdev->trans_start = jiffies;
78 schedule_work(&dp_dev->xmit_work);
83 static void dp_dev_do_xmit(struct work_struct *work)
85 struct dp_dev *dp_dev = container_of(work, struct dp_dev, xmit_work);
86 struct datapath *dp = dp_dev->dp;
89 while ((skb = skb_dequeue(&dp_dev->xmit_queue)) != NULL) {
90 skb_reset_mac_header(skb);
92 fwd_port_input(dp->chain, skb, dp->local_port);
95 netif_wake_queue(dp->netdev);
98 static int dp_dev_open(struct net_device *netdev)
100 netif_start_queue(netdev);
104 static int dp_dev_stop(struct net_device *netdev)
106 netif_stop_queue(netdev);
111 do_setup(struct net_device *netdev)
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;
122 netdev->flags = IFF_BROADCAST | IFF_MULTICAST;
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;
131 int dp_dev_setup(struct datapath *dp)
133 struct dp_dev *dp_dev;
134 struct net_device *netdev;
138 snprintf(of_name, sizeof of_name, "of%d", dp->dp_idx);
139 netdev = alloc_netdev(sizeof(struct dp_dev), of_name, do_setup);
143 err = register_netdev(netdev);
149 dp_dev = dp_dev_priv(netdev);
151 skb_queue_head_init(&dp_dev->xmit_queue);
152 INIT_WORK(&dp_dev->xmit_work, dp_dev_do_xmit);
157 void dp_dev_destroy(struct datapath *dp)
159 struct dp_dev *dp_dev = dp_dev_priv(dp->netdev);
161 netif_tx_disable(dp->netdev);
163 skb_queue_purge(&dp_dev->xmit_queue);
164 unregister_netdev(dp->netdev);
165 free_netdev(dp->netdev);
168 int is_dp_dev(struct net_device *netdev)
170 return netdev->open == dp_dev_open;