datapath: Fix build when CONFIG_COMPAT is enabled.
[sliver-openvswitch.git] / datapath / datapath.c
1 /*
2  * Copyright (c) 2007, 2008, 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 /* Functions for managing the dp interface/device. */
10
11 #include <linux/init.h>
12 #include <linux/module.h>
13 #include <linux/fs.h>
14 #include <linux/if_arp.h>
15 #include <linux/if_vlan.h>
16 #include <linux/in.h>
17 #include <linux/ip.h>
18 #include <linux/delay.h>
19 #include <linux/time.h>
20 #include <linux/etherdevice.h>
21 #include <linux/kernel.h>
22 #include <linux/kthread.h>
23 #include <linux/mutex.h>
24 #include <linux/percpu.h>
25 #include <linux/rcupdate.h>
26 #include <linux/tcp.h>
27 #include <linux/udp.h>
28 #include <linux/version.h>
29 #include <linux/ethtool.h>
30 #include <linux/random.h>
31 #include <linux/wait.h>
32 #include <asm/system.h>
33 #include <asm/div64.h>
34 #include <asm/bug.h>
35 #include <linux/netfilter_bridge.h>
36 #include <linux/netfilter_ipv4.h>
37 #include <linux/inetdevice.h>
38 #include <linux/list.h>
39 #include <linux/rculist.h>
40 #include <linux/workqueue.h>
41 #include <linux/dmi.h>
42 #include <net/inet_ecn.h>
43 #include <linux/compat.h>
44
45 #include "openvswitch/xflow.h"
46 #include "datapath.h"
47 #include "actions.h"
48 #include "flow.h"
49 #include "xflow-compat.h"
50 #include "table.h"
51 #include "vport-internal_dev.h"
52
53 #include "compat.h"
54
55
56 int (*dp_ioctl_hook)(struct net_device *dev, struct ifreq *rq, int cmd);
57 EXPORT_SYMBOL(dp_ioctl_hook);
58
59 /* Datapaths.  Protected on the read side by rcu_read_lock, on the write side
60  * by dp_mutex.
61  *
62  * dp_mutex nests inside the RTNL lock: if you need both you must take the RTNL
63  * lock first.
64  *
65  * It is safe to access the datapath and dp_port structures with just
66  * dp_mutex.
67  */
68 static struct datapath *dps[XFLOW_MAX];
69 static DEFINE_MUTEX(dp_mutex);
70
71 /* Number of milliseconds between runs of the maintenance thread. */
72 #define MAINT_SLEEP_MSECS 1000
73
74 static int new_dp_port(struct datapath *, struct xflow_port *, int port_no);
75
76 /* Must be called with rcu_read_lock or dp_mutex. */
77 struct datapath *get_dp(int dp_idx)
78 {
79         if (dp_idx < 0 || dp_idx >= XFLOW_MAX)
80                 return NULL;
81         return rcu_dereference(dps[dp_idx]);
82 }
83 EXPORT_SYMBOL_GPL(get_dp);
84
85 static struct datapath *get_dp_locked(int dp_idx)
86 {
87         struct datapath *dp;
88
89         mutex_lock(&dp_mutex);
90         dp = get_dp(dp_idx);
91         if (dp)
92                 mutex_lock(&dp->mutex);
93         mutex_unlock(&dp_mutex);
94         return dp;
95 }
96
97 /* Must be called with rcu_read_lock or RTNL lock. */
98 const char *dp_name(const struct datapath *dp)
99 {
100         return vport_get_name(dp->ports[XFLOWP_LOCAL]->vport);
101 }
102
103 static inline size_t br_nlmsg_size(void)
104 {
105         return NLMSG_ALIGN(sizeof(struct ifinfomsg))
106                + nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */
107                + nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */
108                + nla_total_size(4) /* IFLA_MASTER */
109                + nla_total_size(4) /* IFLA_MTU */
110                + nla_total_size(4) /* IFLA_LINK */
111                + nla_total_size(1); /* IFLA_OPERSTATE */
112 }
113
114 static int dp_fill_ifinfo(struct sk_buff *skb,
115                           const struct dp_port *port,
116                           int event, unsigned int flags)
117 {
118         const struct datapath *dp = port->dp;
119         int ifindex = vport_get_ifindex(port->vport);
120         int iflink = vport_get_iflink(port->vport);
121         struct ifinfomsg *hdr;
122         struct nlmsghdr *nlh;
123
124         if (ifindex < 0)
125                 return ifindex;
126
127         if (iflink < 0)
128                 return iflink;
129
130         nlh = nlmsg_put(skb, 0, 0, event, sizeof(*hdr), flags);
131         if (nlh == NULL)
132                 return -EMSGSIZE;
133
134         hdr = nlmsg_data(nlh);
135         hdr->ifi_family = AF_BRIDGE;
136         hdr->__ifi_pad = 0;
137         hdr->ifi_type = ARPHRD_ETHER;
138         hdr->ifi_index = ifindex;
139         hdr->ifi_flags = vport_get_flags(port->vport);
140         hdr->ifi_change = 0;
141
142         NLA_PUT_STRING(skb, IFLA_IFNAME, vport_get_name(port->vport));
143         NLA_PUT_U32(skb, IFLA_MASTER, vport_get_ifindex(dp->ports[XFLOWP_LOCAL]->vport));
144         NLA_PUT_U32(skb, IFLA_MTU, vport_get_mtu(port->vport));
145 #ifdef IFLA_OPERSTATE
146         NLA_PUT_U8(skb, IFLA_OPERSTATE,
147                    vport_is_running(port->vport)
148                         ? vport_get_operstate(port->vport)
149                         : IF_OPER_DOWN);
150 #endif
151
152         NLA_PUT(skb, IFLA_ADDRESS, ETH_ALEN,
153                                         vport_get_addr(port->vport));
154
155         if (ifindex != iflink)
156                 NLA_PUT_U32(skb, IFLA_LINK,iflink);
157
158         return nlmsg_end(skb, nlh);
159
160 nla_put_failure:
161         nlmsg_cancel(skb, nlh);
162         return -EMSGSIZE;
163 }
164
165 static void dp_ifinfo_notify(int event, struct dp_port *port)
166 {
167         struct sk_buff *skb;
168         int err = -ENOBUFS;
169
170         skb = nlmsg_new(br_nlmsg_size(), GFP_KERNEL);
171         if (skb == NULL)
172                 goto errout;
173
174         err = dp_fill_ifinfo(skb, port, event, 0);
175         if (err < 0) {
176                 /* -EMSGSIZE implies BUG in br_nlmsg_size() */
177                 WARN_ON(err == -EMSGSIZE);
178                 kfree_skb(skb);
179                 goto errout;
180         }
181         rtnl_notify(skb, &init_net, 0, RTNLGRP_LINK, NULL, GFP_KERNEL);
182         return;
183 errout:
184         if (err < 0)
185                 rtnl_set_sk_err(&init_net, RTNLGRP_LINK, err);
186 }
187
188 static void release_dp(struct kobject *kobj)
189 {
190         struct datapath *dp = container_of(kobj, struct datapath, ifobj);
191         kfree(dp);
192 }
193
194 static struct kobj_type dp_ktype = {
195         .release = release_dp
196 };
197
198 static int create_dp(int dp_idx, const char __user *devnamep)
199 {
200         struct xflow_port internal_dev_port;
201         char devname[IFNAMSIZ];
202         struct datapath *dp;
203         int err;
204         int i;
205
206         if (devnamep) {
207                 int retval = strncpy_from_user(devname, devnamep, IFNAMSIZ);
208                 if (retval < 0) {
209                         err = -EFAULT;
210                         goto err;
211                 } else if (retval >= IFNAMSIZ) {
212                         err = -ENAMETOOLONG;
213                         goto err;
214                 }
215         } else {
216                 snprintf(devname, sizeof devname, "of%d", dp_idx);
217         }
218
219         rtnl_lock();
220         mutex_lock(&dp_mutex);
221         err = -ENODEV;
222         if (!try_module_get(THIS_MODULE))
223                 goto err_unlock;
224
225         /* Exit early if a datapath with that number already exists.
226          * (We don't use -EEXIST because that's ambiguous with 'devname'
227          * conflicting with an existing network device name.) */
228         err = -EBUSY;
229         if (get_dp(dp_idx))
230                 goto err_put_module;
231
232         err = -ENOMEM;
233         dp = kzalloc(sizeof *dp, GFP_KERNEL);
234         if (dp == NULL)
235                 goto err_put_module;
236         INIT_LIST_HEAD(&dp->port_list);
237         mutex_init(&dp->mutex);
238         dp->dp_idx = dp_idx;
239         for (i = 0; i < DP_N_QUEUES; i++)
240                 skb_queue_head_init(&dp->queues[i]);
241         init_waitqueue_head(&dp->waitqueue);
242
243         /* Initialize kobject for bridge.  This will be added as
244          * /sys/class/net/<devname>/brif later, if sysfs is enabled. */
245         dp->ifobj.kset = NULL;
246         kobject_init(&dp->ifobj, &dp_ktype);
247
248         /* Allocate table. */
249         err = -ENOMEM;
250         rcu_assign_pointer(dp->table, tbl_create(0));
251         if (!dp->table)
252                 goto err_free_dp;
253
254         /* Set up our datapath device. */
255         BUILD_BUG_ON(sizeof(internal_dev_port.devname) != sizeof(devname));
256         strcpy(internal_dev_port.devname, devname);
257         internal_dev_port.flags = XFLOW_PORT_INTERNAL;
258         err = new_dp_port(dp, &internal_dev_port, XFLOWP_LOCAL);
259         if (err) {
260                 if (err == -EBUSY)
261                         err = -EEXIST;
262
263                 goto err_destroy_table;
264         }
265
266         dp->drop_frags = 0;
267         dp->stats_percpu = alloc_percpu(struct dp_stats_percpu);
268         if (!dp->stats_percpu)
269                 goto err_destroy_local_port;
270
271         rcu_assign_pointer(dps[dp_idx], dp);
272         mutex_unlock(&dp_mutex);
273         rtnl_unlock();
274
275         dp_sysfs_add_dp(dp);
276
277         return 0;
278
279 err_destroy_local_port:
280         dp_detach_port(dp->ports[XFLOWP_LOCAL], 1);
281 err_destroy_table:
282         tbl_destroy(dp->table, NULL);
283 err_free_dp:
284         kfree(dp);
285 err_put_module:
286         module_put(THIS_MODULE);
287 err_unlock:
288         mutex_unlock(&dp_mutex);
289         rtnl_unlock();
290 err:
291         return err;
292 }
293
294 static void do_destroy_dp(struct datapath *dp)
295 {
296         struct dp_port *p, *n;
297         int i;
298
299         list_for_each_entry_safe (p, n, &dp->port_list, node)
300                 if (p->port_no != XFLOWP_LOCAL)
301                         dp_detach_port(p, 1);
302
303         dp_sysfs_del_dp(dp);
304
305         rcu_assign_pointer(dps[dp->dp_idx], NULL);
306
307         dp_detach_port(dp->ports[XFLOWP_LOCAL], 1);
308
309         tbl_destroy(dp->table, flow_free_tbl);
310
311         for (i = 0; i < DP_N_QUEUES; i++)
312                 skb_queue_purge(&dp->queues[i]);
313         for (i = 0; i < DP_MAX_GROUPS; i++)
314                 kfree(dp->groups[i]);
315         free_percpu(dp->stats_percpu);
316         kobject_put(&dp->ifobj);
317         module_put(THIS_MODULE);
318 }
319
320 static int destroy_dp(int dp_idx)
321 {
322         struct datapath *dp;
323         int err;
324
325         rtnl_lock();
326         mutex_lock(&dp_mutex);
327         dp = get_dp(dp_idx);
328         err = -ENODEV;
329         if (!dp)
330                 goto err_unlock;
331
332         do_destroy_dp(dp);
333         err = 0;
334
335 err_unlock:
336         mutex_unlock(&dp_mutex);
337         rtnl_unlock();
338         return err;
339 }
340
341 static void release_dp_port(struct kobject *kobj)
342 {
343         struct dp_port *p = container_of(kobj, struct dp_port, kobj);
344         kfree(p);
345 }
346
347 static struct kobj_type brport_ktype = {
348 #ifdef CONFIG_SYSFS
349         .sysfs_ops = &brport_sysfs_ops,
350 #endif
351         .release = release_dp_port
352 };
353
354 /* Called with RTNL lock and dp_mutex. */
355 static int new_dp_port(struct datapath *dp, struct xflow_port *xflow_port, int port_no)
356 {
357         struct vport *vport;
358         struct dp_port *p;
359         int err;
360
361         vport = vport_locate(xflow_port->devname);
362         if (!vport) {
363                 vport_lock();
364
365                 if (xflow_port->flags & XFLOW_PORT_INTERNAL)
366                         vport = __vport_add(xflow_port->devname, "internal", NULL);
367                 else
368                         vport = __vport_add(xflow_port->devname, "netdev", NULL);
369
370                 vport_unlock();
371
372                 if (IS_ERR(vport))
373                         return PTR_ERR(vport);
374         }
375
376         p = kzalloc(sizeof(*p), GFP_KERNEL);
377         if (!p)
378                 return -ENOMEM;
379
380         p->port_no = port_no;
381         p->dp = dp;
382         atomic_set(&p->sflow_pool, 0);
383
384         err = vport_attach(vport, p);
385         if (err) {
386                 kfree(p);
387                 return err;
388         }
389
390         rcu_assign_pointer(dp->ports[port_no], p);
391         list_add_rcu(&p->node, &dp->port_list);
392         dp->n_ports++;
393
394         /* Initialize kobject for bridge.  This will be added as
395          * /sys/class/net/<devname>/brport later, if sysfs is enabled. */
396         p->kobj.kset = NULL;
397         kobject_init(&p->kobj, &brport_ktype);
398
399         dp_ifinfo_notify(RTM_NEWLINK, p);
400
401         return 0;
402 }
403
404 static int attach_port(int dp_idx, struct xflow_port __user *portp)
405 {
406         struct datapath *dp;
407         struct xflow_port port;
408         int port_no;
409         int err;
410
411         err = -EFAULT;
412         if (copy_from_user(&port, portp, sizeof port))
413                 goto out;
414         port.devname[IFNAMSIZ - 1] = '\0';
415
416         rtnl_lock();
417         dp = get_dp_locked(dp_idx);
418         err = -ENODEV;
419         if (!dp)
420                 goto out_unlock_rtnl;
421
422         for (port_no = 1; port_no < DP_MAX_PORTS; port_no++)
423                 if (!dp->ports[port_no])
424                         goto got_port_no;
425         err = -EFBIG;
426         goto out_unlock_dp;
427
428 got_port_no:
429         err = new_dp_port(dp, &port, port_no);
430         if (err)
431                 goto out_unlock_dp;
432
433         set_internal_devs_mtu(dp);
434         dp_sysfs_add_if(dp->ports[port_no]);
435
436         err = put_user(port_no, &portp->port);
437
438 out_unlock_dp:
439         mutex_unlock(&dp->mutex);
440 out_unlock_rtnl:
441         rtnl_unlock();
442 out:
443         return err;
444 }
445
446 int dp_detach_port(struct dp_port *p, int may_delete)
447 {
448         struct vport *vport = p->vport;
449         int err;
450
451         ASSERT_RTNL();
452
453         if (p->port_no != XFLOWP_LOCAL)
454                 dp_sysfs_del_if(p);
455         dp_ifinfo_notify(RTM_DELLINK, p);
456
457         /* First drop references to device. */
458         p->dp->n_ports--;
459         list_del_rcu(&p->node);
460         rcu_assign_pointer(p->dp->ports[p->port_no], NULL);
461
462         err = vport_detach(vport);
463         if (err)
464                 return err;
465
466         /* Then wait until no one is still using it, and destroy it. */
467         synchronize_rcu();
468
469         if (may_delete) {
470                 const char *port_type = vport_get_type(vport);
471
472                 if (!strcmp(port_type, "netdev") || !strcmp(port_type, "internal")) {
473                         vport_lock();
474                         __vport_del(vport);
475                         vport_unlock();
476                 }
477         }
478
479         kobject_put(&p->kobj);
480
481         return 0;
482 }
483
484 static int detach_port(int dp_idx, int port_no)
485 {
486         struct dp_port *p;
487         struct datapath *dp;
488         int err;
489
490         err = -EINVAL;
491         if (port_no < 0 || port_no >= DP_MAX_PORTS || port_no == XFLOWP_LOCAL)
492                 goto out;
493
494         rtnl_lock();
495         dp = get_dp_locked(dp_idx);
496         err = -ENODEV;
497         if (!dp)
498                 goto out_unlock_rtnl;
499
500         p = dp->ports[port_no];
501         err = -ENOENT;
502         if (!p)
503                 goto out_unlock_dp;
504
505         err = dp_detach_port(p, 1);
506
507 out_unlock_dp:
508         mutex_unlock(&dp->mutex);
509 out_unlock_rtnl:
510         rtnl_unlock();
511 out:
512         return err;
513 }
514
515 /* Must be called with rcu_read_lock. */
516 void dp_process_received_packet(struct dp_port *p, struct sk_buff *skb)
517 {
518         struct datapath *dp = p->dp;
519         struct dp_stats_percpu *stats;
520         int stats_counter_off;
521         struct xflow_key key;
522         struct tbl_node *flow_node;
523
524         WARN_ON_ONCE(skb_shared(skb));
525         skb_warn_if_lro(skb);
526
527         OVS_CB(skb)->dp_port = p;
528
529         if (flow_extract(skb, p ? p->port_no : XFLOWP_NONE, &key)) {
530                 if (dp->drop_frags) {
531                         kfree_skb(skb);
532                         stats_counter_off = offsetof(struct dp_stats_percpu, n_frags);
533                         goto out;
534                 }
535         }
536
537         flow_node = tbl_lookup(rcu_dereference(dp->table), &key, flow_hash(&key), flow_cmp);
538         if (flow_node) {
539                 struct sw_flow *flow = flow_cast(flow_node);
540                 struct sw_flow_actions *acts = rcu_dereference(flow->sf_acts);
541                 flow_used(flow, skb);
542                 execute_actions(dp, skb, &key, acts->actions, acts->n_actions,
543                                 GFP_ATOMIC);
544                 stats_counter_off = offsetof(struct dp_stats_percpu, n_hit);
545         } else {
546                 stats_counter_off = offsetof(struct dp_stats_percpu, n_missed);
547                 dp_output_control(dp, skb, _XFLOWL_MISS_NR, OVS_CB(skb)->tun_id);
548         }
549
550 out:
551         local_bh_disable();
552         stats = per_cpu_ptr(dp->stats_percpu, smp_processor_id());
553         (*(u64 *)((u8 *)stats + stats_counter_off))++;
554         local_bh_enable();
555 }
556
557 #if defined(CONFIG_XEN) && defined(HAVE_PROTO_DATA_VALID)
558 /* This code is based on skb_checksum_setup() from Xen's net/dev/core.c.  We
559  * can't call this function directly because it isn't exported in all
560  * versions. */
561 int vswitch_skb_checksum_setup(struct sk_buff *skb)
562 {
563         struct iphdr *iph;
564         unsigned char *th;
565         int err = -EPROTO;
566         __u16 csum_start, csum_offset;
567
568         if (!skb->proto_csum_blank)
569                 return 0;
570
571         if (skb->protocol != htons(ETH_P_IP))
572                 goto out;
573
574         if (!pskb_may_pull(skb, skb_network_header(skb) + sizeof(struct iphdr) - skb->data))
575                 goto out;
576
577         iph = ip_hdr(skb);
578         th = skb_network_header(skb) + 4 * iph->ihl;
579
580         csum_start = th - skb->head;
581         switch (iph->protocol) {
582         case IPPROTO_TCP:
583                 csum_offset = offsetof(struct tcphdr, check);
584                 break;
585         case IPPROTO_UDP:
586                 csum_offset = offsetof(struct udphdr, check);
587                 break;
588         default:
589                 if (net_ratelimit())
590                         printk(KERN_ERR "Attempting to checksum a non-"
591                                "TCP/UDP packet, dropping a protocol"
592                                " %d packet", iph->protocol);
593                 goto out;
594         }
595
596         if (!pskb_may_pull(skb, th + csum_offset + 2 - skb->data))
597                 goto out;
598
599         skb->ip_summed = CHECKSUM_PARTIAL;
600         skb->proto_csum_blank = 0;
601
602 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,22)
603         skb->csum_start = csum_start;
604         skb->csum_offset = csum_offset;
605 #else
606         skb_set_transport_header(skb, csum_start - skb_headroom(skb));
607         skb->csum = csum_offset;
608 #endif
609
610         err = 0;
611
612 out:
613         return err;
614 }
615 #endif /* CONFIG_XEN && HAVE_PROTO_DATA_VALID */
616
617  /* Types of checksums that we can receive (these all refer to L4 checksums):
618  * 1. CHECKSUM_NONE: Device that did not compute checksum, contains full
619  *      (though not verified) checksum in packet but not in skb->csum.  Packets
620  *      from the bridge local port will also have this type.
621  * 2. CHECKSUM_COMPLETE (CHECKSUM_HW): Good device that computes checksums,
622  *      also the GRE module.  This is the same as CHECKSUM_NONE, except it has
623  *      a valid skb->csum.  Importantly, both contain a full checksum (not
624  *      verified) in the packet itself.  The only difference is that if the
625  *      packet gets to L4 processing on this machine (not in DomU) we won't
626  *      have to recompute the checksum to verify.  Most hardware devices do not
627  *      produce packets with this type, even if they support receive checksum
628  *      offloading (they produce type #5).
629  * 3. CHECKSUM_PARTIAL (CHECKSUM_HW): Packet without full checksum and needs to
630  *      be computed if it is sent off box.  Unfortunately on earlier kernels,
631  *      this case is impossible to distinguish from #2, despite having opposite
632  *      meanings.  Xen adds an extra field on earlier kernels (see #4) in order
633  *      to distinguish the different states.
634  * 4. CHECKSUM_UNNECESSARY (with proto_csum_blank true): This packet was
635  *      generated locally by a Xen DomU and has a partial checksum.  If it is
636  *      handled on this machine (Dom0 or DomU), then the checksum will not be
637  *      computed.  If it goes off box, the checksum in the packet needs to be
638  *      completed.  Calling skb_checksum_setup converts this to CHECKSUM_HW
639  *      (CHECKSUM_PARTIAL) so that the checksum can be completed.  In later
640  *      kernels, this combination is replaced with CHECKSUM_PARTIAL.
641  * 5. CHECKSUM_UNNECESSARY (with proto_csum_blank false): Packet with a correct
642  *      full checksum or using a protocol without a checksum.  skb->csum is
643  *      undefined.  This is common from devices with receive checksum
644  *      offloading.  This is somewhat similar to CHECKSUM_NONE, except that
645  *      nobody will try to verify the checksum with CHECKSUM_UNNECESSARY.
646  *
647  * Note that on earlier kernels, CHECKSUM_COMPLETE and CHECKSUM_PARTIAL are
648  * both defined as CHECKSUM_HW.  Normally the meaning of CHECKSUM_HW is clear
649  * based on whether it is on the transmit or receive path.  After the datapath
650  * it will be intepreted as CHECKSUM_PARTIAL.  If the packet already has a
651  * checksum, we will panic.  Since we can receive packets with checksums, we
652  * assume that all CHECKSUM_HW packets have checksums and map them to
653  * CHECKSUM_NONE, which has a similar meaning (the it is only different if the
654  * packet is processed by the local IP stack, in which case it will need to
655  * be reverified).  If we receive a packet with CHECKSUM_HW that really means
656  * CHECKSUM_PARTIAL, it will be sent with the wrong checksum.  However, there
657  * shouldn't be any devices that do this with bridging. */
658 void
659 compute_ip_summed(struct sk_buff *skb, bool xmit)
660 {
661         /* For our convenience these defines change repeatedly between kernel
662          * versions, so we can't just copy them over... */
663         switch (skb->ip_summed) {
664         case CHECKSUM_NONE:
665                 OVS_CB(skb)->ip_summed = OVS_CSUM_NONE;
666                 break;
667         case CHECKSUM_UNNECESSARY:
668                 OVS_CB(skb)->ip_summed = OVS_CSUM_UNNECESSARY;
669                 break;
670 #ifdef CHECKSUM_HW
671         /* In theory this could be either CHECKSUM_PARTIAL or CHECKSUM_COMPLETE.
672          * However, on the receive side we should only get CHECKSUM_PARTIAL
673          * packets from Xen, which uses some special fields to represent this
674          * (see below).  Since we can only make one type work, pick the one
675          * that actually happens in practice.
676          *
677          * On the transmit side (basically after skb_checksum_setup()
678          * has been run or on internal dev transmit), packets with
679          * CHECKSUM_COMPLETE aren't generated, so assume CHECKSUM_PARTIAL. */
680         case CHECKSUM_HW:
681                 if (!xmit)
682                         OVS_CB(skb)->ip_summed = OVS_CSUM_COMPLETE;
683                 else
684                         OVS_CB(skb)->ip_summed = OVS_CSUM_PARTIAL;
685
686                 break;
687 #else
688         case CHECKSUM_COMPLETE:
689                 OVS_CB(skb)->ip_summed = OVS_CSUM_COMPLETE;
690                 break;
691         case CHECKSUM_PARTIAL:
692                 OVS_CB(skb)->ip_summed = OVS_CSUM_PARTIAL;
693                 break;
694 #endif
695         default:
696                 printk(KERN_ERR "openvswitch: unknown checksum type %d\n",
697                        skb->ip_summed);
698                 /* None seems the safest... */
699                 OVS_CB(skb)->ip_summed = OVS_CSUM_NONE;
700         }       
701
702 #if defined(CONFIG_XEN) && defined(HAVE_PROTO_DATA_VALID)
703         /* Xen has a special way of representing CHECKSUM_PARTIAL on older
704          * kernels. It should not be set on the transmit path though. */
705         if (skb->proto_csum_blank)
706                 OVS_CB(skb)->ip_summed = OVS_CSUM_PARTIAL;
707
708         WARN_ON_ONCE(skb->proto_csum_blank && xmit);
709 #endif
710 }
711
712 /* This function closely resembles skb_forward_csum() used by the bridge.  It
713  * is slightly different because we are only concerned with bridging and not
714  * other types of forwarding and can get away with slightly more optimal
715  * behavior.*/
716 void
717 forward_ip_summed(struct sk_buff *skb)
718 {
719 #ifdef CHECKSUM_HW
720         if (OVS_CB(skb)->ip_summed == OVS_CSUM_COMPLETE)
721                 skb->ip_summed = CHECKSUM_NONE;
722 #endif
723 }
724
725 /* Append each packet in 'skb' list to 'queue'.  There will be only one packet
726  * unless we broke up a GSO packet. */
727 static int
728 queue_control_packets(struct sk_buff *skb, struct sk_buff_head *queue,
729                       int queue_no, u32 arg)
730 {
731         struct sk_buff *nskb;
732         int port_no;
733         int err;
734
735         if (OVS_CB(skb)->dp_port)
736                 port_no = OVS_CB(skb)->dp_port->port_no;
737         else
738                 port_no = XFLOWP_LOCAL;
739
740         do {
741                 struct xflow_msg *header;
742
743                 nskb = skb->next;
744                 skb->next = NULL;
745
746                 /* If a checksum-deferred packet is forwarded to the
747                  * controller, correct the pointers and checksum.
748                  */
749                 err = vswitch_skb_checksum_setup(skb);
750                 if (err)
751                         goto err_kfree_skbs;
752
753                 if (skb->ip_summed == CHECKSUM_PARTIAL) {
754
755 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,22)
756                         /* Until 2.6.22, the start of the transport header was
757                          * also the start of data to be checksummed.  Linux
758                          * 2.6.22 introduced the csum_start field for this
759                          * purpose, but we should point the transport header to
760                          * it anyway for backward compatibility, as
761                          * dev_queue_xmit() does even in 2.6.28. */
762                         skb_set_transport_header(skb, skb->csum_start -
763                                                  skb_headroom(skb));
764 #endif
765
766                         err = skb_checksum_help(skb);
767                         if (err)
768                                 goto err_kfree_skbs;
769                 }
770
771                 err = skb_cow(skb, sizeof *header);
772                 if (err)
773                         goto err_kfree_skbs;
774
775                 header = (struct xflow_msg*)__skb_push(skb, sizeof *header);
776                 header->type = queue_no;
777                 header->length = skb->len;
778                 header->port = port_no;
779                 header->reserved = 0;
780                 header->arg = arg;
781                 skb_queue_tail(queue, skb);
782
783                 skb = nskb;
784         } while (skb);
785         return 0;
786
787 err_kfree_skbs:
788         kfree_skb(skb);
789         while ((skb = nskb) != NULL) {
790                 nskb = skb->next;
791                 kfree_skb(skb);
792         }
793         return err;
794 }
795
796 int
797 dp_output_control(struct datapath *dp, struct sk_buff *skb, int queue_no,
798                   u32 arg)
799 {
800         struct dp_stats_percpu *stats;
801         struct sk_buff_head *queue;
802         int err;
803
804         WARN_ON_ONCE(skb_shared(skb));
805         BUG_ON(queue_no != _XFLOWL_MISS_NR && queue_no != _XFLOWL_ACTION_NR && queue_no != _XFLOWL_SFLOW_NR);
806         queue = &dp->queues[queue_no];
807         err = -ENOBUFS;
808         if (skb_queue_len(queue) >= DP_MAX_QUEUE_LEN)
809                 goto err_kfree_skb;
810
811         forward_ip_summed(skb);
812
813         /* Break apart GSO packets into their component pieces.  Otherwise
814          * userspace may try to stuff a 64kB packet into a 1500-byte MTU. */
815         if (skb_is_gso(skb)) {
816                 struct sk_buff *nskb = skb_gso_segment(skb, 0);
817                 if (nskb) {
818                         kfree_skb(skb);
819                         skb = nskb;
820                         if (unlikely(IS_ERR(skb))) {
821                                 err = PTR_ERR(skb);
822                                 goto err;
823                         }
824                 } else {
825                         /* XXX This case might not be possible.  It's hard to
826                          * tell from the skb_gso_segment() code and comment. */
827                 }
828         }
829
830         err = queue_control_packets(skb, queue, queue_no, arg);
831         wake_up_interruptible(&dp->waitqueue);
832         return err;
833
834 err_kfree_skb:
835         kfree_skb(skb);
836 err:
837         local_bh_disable();
838         stats = per_cpu_ptr(dp->stats_percpu, smp_processor_id());
839         stats->n_lost++;
840         local_bh_enable();
841
842         return err;
843 }
844
845 static int flush_flows(struct datapath *dp)
846 {
847         struct tbl *old_table = rcu_dereference(dp->table);
848         struct tbl *new_table;
849
850         new_table = tbl_create(0);
851         if (!new_table)
852                 return -ENOMEM;
853
854         rcu_assign_pointer(dp->table, new_table);
855
856         tbl_deferred_destroy(old_table, flow_free_tbl);
857
858         return 0;
859 }
860
861 static int validate_actions(const struct sw_flow_actions *actions)
862 {
863         unsigned int i;
864
865         for (i = 0; i < actions->n_actions; i++) {
866                 const union xflow_action *a = &actions->actions[i];
867                 __be16 mask;
868
869                 switch (a->type) {
870                 case XFLOWAT_OUTPUT:
871                         if (a->output.port >= DP_MAX_PORTS)
872                                 return -EINVAL;
873                         break;
874
875                 case XFLOWAT_OUTPUT_GROUP:
876                         if (a->output_group.group >= DP_MAX_GROUPS)
877                                 return -EINVAL;
878                         break;
879
880                 case XFLOWAT_SET_DL_TCI:
881                         mask = a->dl_tci.mask;
882                         if (mask != htons(VLAN_VID_MASK) &&
883                             mask != htons(VLAN_PCP_MASK) &&
884                             mask != htons(VLAN_VID_MASK | VLAN_PCP_MASK))
885                                 return -EINVAL;
886                         if (a->dl_tci.tci & ~mask)
887                                 return -EINVAL;
888                         break;
889
890                 case XFLOWAT_SET_NW_TOS:
891                         if (a->nw_tos.nw_tos & INET_ECN_MASK)
892                                 return -EINVAL;
893                         break;
894
895                 default:
896                         if (a->type >= XFLOWAT_N_ACTIONS)
897                                 return -EOPNOTSUPP;
898                         break;
899                 }
900         }
901
902         return 0;
903 }
904
905 static struct sw_flow_actions *get_actions(const struct xflow_flow *flow)
906 {
907         struct sw_flow_actions *actions;
908         int error;
909
910         actions = flow_actions_alloc(flow->n_actions);
911         error = PTR_ERR(actions);
912         if (IS_ERR(actions))
913                 goto error;
914
915         error = -EFAULT;
916         if (copy_from_user(actions->actions, flow->actions,
917                            flow->n_actions * sizeof(union xflow_action)))
918                 goto error_free_actions;
919         error = validate_actions(actions);
920         if (error)
921                 goto error_free_actions;
922
923         return actions;
924
925 error_free_actions:
926         kfree(actions);
927 error:
928         return ERR_PTR(error);
929 }
930
931 static void get_stats(struct sw_flow *flow, struct xflow_flow_stats *stats)
932 {
933         if (flow->used.tv_sec) {
934                 stats->used_sec = flow->used.tv_sec;
935                 stats->used_nsec = flow->used.tv_nsec;
936         } else {
937                 stats->used_sec = 0;
938                 stats->used_nsec = 0;
939         }
940         stats->n_packets = flow->packet_count;
941         stats->n_bytes = flow->byte_count;
942         stats->ip_tos = flow->ip_tos;
943         stats->tcp_flags = flow->tcp_flags;
944         stats->error = 0;
945 }
946
947 static void clear_stats(struct sw_flow *flow)
948 {
949         flow->used.tv_sec = flow->used.tv_nsec = 0;
950         flow->tcp_flags = 0;
951         flow->ip_tos = 0;
952         flow->packet_count = 0;
953         flow->byte_count = 0;
954 }
955
956 static int expand_table(struct datapath *dp)
957 {
958         struct tbl *old_table = rcu_dereference(dp->table);
959         struct tbl *new_table;
960
961         new_table = tbl_expand(old_table);
962         if (IS_ERR(new_table))
963                 return PTR_ERR(new_table);
964
965         rcu_assign_pointer(dp->table, new_table);
966         tbl_deferred_destroy(old_table, NULL);
967
968         return 0;
969 }
970
971 static int do_put_flow(struct datapath *dp, struct xflow_flow_put *uf,
972                        struct xflow_flow_stats *stats)
973 {
974         struct tbl_node *flow_node;
975         struct sw_flow *flow;
976         struct tbl *table;
977         int error;
978
979         table = rcu_dereference(dp->table);
980         flow_node = tbl_lookup(table, &uf->flow.key, flow_hash(&uf->flow.key), flow_cmp);
981         if (!flow_node) {
982                 /* No such flow. */
983                 struct sw_flow_actions *acts;
984
985                 error = -ENOENT;
986                 if (!(uf->flags & XFLOWPF_CREATE))
987                         goto error;
988
989                 /* Expand table, if necessary, to make room. */
990                 if (tbl_count(table) >= tbl_n_buckets(table)) {
991                         error = expand_table(dp);
992                         if (error)
993                                 goto error;
994                         table = rcu_dereference(dp->table);
995                 }
996
997                 /* Allocate flow. */
998                 error = -ENOMEM;
999                 flow = kmem_cache_alloc(flow_cache, GFP_KERNEL);
1000                 if (flow == NULL)
1001                         goto error;
1002                 flow->key = uf->flow.key;
1003                 spin_lock_init(&flow->lock);
1004                 clear_stats(flow);
1005
1006                 /* Obtain actions. */
1007                 acts = get_actions(&uf->flow);
1008                 error = PTR_ERR(acts);
1009                 if (IS_ERR(acts))
1010                         goto error_free_flow;
1011                 rcu_assign_pointer(flow->sf_acts, acts);
1012
1013                 /* Put flow in bucket. */
1014                 error = tbl_insert(table, &flow->tbl_node, flow_hash(&flow->key));
1015                 if (error)
1016                         goto error_free_flow_acts;
1017
1018                 memset(stats, 0, sizeof(struct xflow_flow_stats));
1019         } else {
1020                 /* We found a matching flow. */
1021                 struct sw_flow_actions *old_acts, *new_acts;
1022
1023                 flow = flow_cast(flow_node);
1024
1025                 /* Bail out if we're not allowed to modify an existing flow. */
1026                 error = -EEXIST;
1027                 if (!(uf->flags & XFLOWPF_MODIFY))
1028                         goto error;
1029
1030                 /* Swap actions. */
1031                 new_acts = get_actions(&uf->flow);
1032                 error = PTR_ERR(new_acts);
1033                 if (IS_ERR(new_acts))
1034                         goto error;
1035                 old_acts = rcu_dereference(flow->sf_acts);
1036                 if (old_acts->n_actions != new_acts->n_actions ||
1037                     memcmp(old_acts->actions, new_acts->actions,
1038                            sizeof(union xflow_action) * old_acts->n_actions)) {
1039                         rcu_assign_pointer(flow->sf_acts, new_acts);
1040                         flow_deferred_free_acts(old_acts);
1041                 } else {
1042                         kfree(new_acts);
1043                 }
1044
1045                 /* Fetch stats, then clear them if necessary. */
1046                 spin_lock_bh(&flow->lock);
1047                 get_stats(flow, stats);
1048                 if (uf->flags & XFLOWPF_ZERO_STATS)
1049                         clear_stats(flow);
1050                 spin_unlock_bh(&flow->lock);
1051         }
1052
1053         return 0;
1054
1055 error_free_flow_acts:
1056         kfree(flow->sf_acts);
1057 error_free_flow:
1058         kmem_cache_free(flow_cache, flow);
1059 error:
1060         return error;
1061 }
1062
1063 static int put_flow(struct datapath *dp, struct xflow_flow_put __user *ufp)
1064 {
1065         struct xflow_flow_stats stats;
1066         struct xflow_flow_put uf;
1067         int error;
1068
1069         if (copy_from_user(&uf, ufp, sizeof(struct xflow_flow_put)))
1070                 return -EFAULT;
1071
1072         error = do_put_flow(dp, &uf, &stats);
1073         if (error)
1074                 return error;
1075
1076         if (copy_to_user(&ufp->flow.stats, &stats,
1077                          sizeof(struct xflow_flow_stats)))
1078                 return -EFAULT;
1079
1080         return 0;
1081 }
1082
1083 static int do_answer_query(struct sw_flow *flow, u32 query_flags,
1084                            struct xflow_flow_stats __user *ustats,
1085                            union xflow_action __user *actions,
1086                            u32 __user *n_actionsp)
1087 {
1088         struct sw_flow_actions *sf_acts;
1089         struct xflow_flow_stats stats;
1090         u32 n_actions;
1091
1092         spin_lock_bh(&flow->lock);
1093         get_stats(flow, &stats);
1094         if (query_flags & XFLOWFF_ZERO_TCP_FLAGS)
1095                 flow->tcp_flags = 0;
1096
1097         spin_unlock_bh(&flow->lock);
1098
1099         if (copy_to_user(ustats, &stats, sizeof(struct xflow_flow_stats)) ||
1100             get_user(n_actions, n_actionsp))
1101                 return -EFAULT;
1102
1103         if (!n_actions)
1104                 return 0;
1105
1106         sf_acts = rcu_dereference(flow->sf_acts);
1107         if (put_user(sf_acts->n_actions, n_actionsp) ||
1108             (actions && copy_to_user(actions, sf_acts->actions,
1109                                      sizeof(union xflow_action) *
1110                                      min(sf_acts->n_actions, n_actions))))
1111                 return -EFAULT;
1112
1113         return 0;
1114 }
1115
1116 static int answer_query(struct sw_flow *flow, u32 query_flags,
1117                         struct xflow_flow __user *ufp)
1118 {
1119         union xflow_action *actions;
1120
1121         if (get_user(actions, &ufp->actions))
1122                 return -EFAULT;
1123
1124         return do_answer_query(flow, query_flags,
1125                                &ufp->stats, actions, &ufp->n_actions);
1126 }
1127
1128 static struct sw_flow *do_del_flow(struct datapath *dp, struct xflow_key *key)
1129 {
1130         struct tbl *table = rcu_dereference(dp->table);
1131         struct tbl_node *flow_node;
1132         int error;
1133
1134         flow_node = tbl_lookup(table, key, flow_hash(key), flow_cmp);
1135         if (!flow_node)
1136                 return ERR_PTR(-ENOENT);
1137
1138         error = tbl_remove(table, flow_node);
1139         if (error)
1140                 return ERR_PTR(error);
1141
1142         /* XXX Returned flow_node's statistics might lose a few packets, since
1143          * other CPUs can be using this flow.  We used to synchronize_rcu() to
1144          * make sure that we get completely accurate stats, but that blows our
1145          * performance, badly. */
1146         return flow_cast(flow_node);
1147 }
1148
1149 static int del_flow(struct datapath *dp, struct xflow_flow __user *ufp)
1150 {
1151         struct sw_flow *flow;
1152         struct xflow_flow uf;
1153         int error;
1154
1155         if (copy_from_user(&uf, ufp, sizeof uf))
1156                 return -EFAULT;
1157
1158         flow = do_del_flow(dp, &uf.key);
1159         if (IS_ERR(flow))
1160                 return PTR_ERR(flow);
1161
1162         error = answer_query(flow, 0, ufp);
1163         flow_deferred_free(flow);
1164         return error;
1165 }
1166
1167 static int do_query_flows(struct datapath *dp, const struct xflow_flowvec *flowvec)
1168 {
1169         struct tbl *table = rcu_dereference(dp->table);
1170         u32 i;
1171
1172         for (i = 0; i < flowvec->n_flows; i++) {
1173                 struct xflow_flow __user *ufp = &flowvec->flows[i];
1174                 struct xflow_flow uf;
1175                 struct tbl_node *flow_node;
1176                 int error;
1177
1178                 if (copy_from_user(&uf, ufp, sizeof uf))
1179                         return -EFAULT;
1180
1181                 flow_node = tbl_lookup(table, &uf.key, flow_hash(&uf.key), flow_cmp);
1182                 if (!flow_node)
1183                         error = put_user(ENOENT, &ufp->stats.error);
1184                 else
1185                         error = answer_query(flow_cast(flow_node), uf.flags, ufp);
1186                 if (error)
1187                         return -EFAULT;
1188         }
1189         return flowvec->n_flows;
1190 }
1191
1192 struct list_flows_cbdata {
1193         struct xflow_flow __user *uflows;
1194         u32 n_flows;
1195         u32 listed_flows;
1196 };
1197
1198 static int list_flow(struct tbl_node *node, void *cbdata_)
1199 {
1200         struct sw_flow *flow = flow_cast(node);
1201         struct list_flows_cbdata *cbdata = cbdata_;
1202         struct xflow_flow __user *ufp = &cbdata->uflows[cbdata->listed_flows++];
1203         int error;
1204
1205         if (copy_to_user(&ufp->key, &flow->key, sizeof flow->key))
1206                 return -EFAULT;
1207         error = answer_query(flow, 0, ufp);
1208         if (error)
1209                 return error;
1210
1211         if (cbdata->listed_flows >= cbdata->n_flows)
1212                 return cbdata->listed_flows;
1213         return 0;
1214 }
1215
1216 static int do_list_flows(struct datapath *dp, const struct xflow_flowvec *flowvec)
1217 {
1218         struct list_flows_cbdata cbdata;
1219         int error;
1220
1221         if (!flowvec->n_flows)
1222                 return 0;
1223
1224         cbdata.uflows = flowvec->flows;
1225         cbdata.n_flows = flowvec->n_flows;
1226         cbdata.listed_flows = 0;
1227         error = tbl_foreach(rcu_dereference(dp->table), list_flow, &cbdata);
1228         return error ? error : cbdata.listed_flows;
1229 }
1230
1231 static int do_flowvec_ioctl(struct datapath *dp, unsigned long argp,
1232                             int (*function)(struct datapath *,
1233                                             const struct xflow_flowvec *))
1234 {
1235         struct xflow_flowvec __user *uflowvec;
1236         struct xflow_flowvec flowvec;
1237         int retval;
1238
1239         uflowvec = (struct xflow_flowvec __user *)argp;
1240         if (copy_from_user(&flowvec, uflowvec, sizeof flowvec))
1241                 return -EFAULT;
1242
1243         if (flowvec.n_flows > INT_MAX / sizeof(struct xflow_flow))
1244                 return -EINVAL;
1245
1246         retval = function(dp, &flowvec);
1247         return (retval < 0 ? retval
1248                 : retval == flowvec.n_flows ? 0
1249                 : put_user(retval, &uflowvec->n_flows));
1250 }
1251
1252 static int do_execute(struct datapath *dp, const struct xflow_execute *execute)
1253 {
1254         struct xflow_key key;
1255         struct sk_buff *skb;
1256         struct sw_flow_actions *actions;
1257         struct ethhdr *eth;
1258         int err;
1259
1260         err = -EINVAL;
1261         if (execute->length < ETH_HLEN || execute->length > 65535)
1262                 goto error;
1263
1264         err = -ENOMEM;
1265         actions = flow_actions_alloc(execute->n_actions);
1266         if (!actions)
1267                 goto error;
1268
1269         err = -EFAULT;
1270         if (copy_from_user(actions->actions, execute->actions,
1271                            execute->n_actions * sizeof *execute->actions))
1272                 goto error_free_actions;
1273
1274         err = validate_actions(actions);
1275         if (err)
1276                 goto error_free_actions;
1277
1278         err = -ENOMEM;
1279         skb = alloc_skb(execute->length, GFP_KERNEL);
1280         if (!skb)
1281                 goto error_free_actions;
1282
1283         if (execute->in_port < DP_MAX_PORTS)
1284                 OVS_CB(skb)->dp_port = dp->ports[execute->in_port];
1285         else
1286                 OVS_CB(skb)->dp_port = NULL;
1287
1288         err = -EFAULT;
1289         if (copy_from_user(skb_put(skb, execute->length), execute->data,
1290                            execute->length))
1291                 goto error_free_skb;
1292
1293         skb_reset_mac_header(skb);
1294         eth = eth_hdr(skb);
1295
1296         /* Normally, setting the skb 'protocol' field would be handled by a
1297          * call to eth_type_trans(), but it assumes there's a sending
1298          * device, which we may not have. */
1299         if (ntohs(eth->h_proto) >= 1536)
1300                 skb->protocol = eth->h_proto;
1301         else
1302                 skb->protocol = htons(ETH_P_802_2);
1303
1304         flow_extract(skb, execute->in_port, &key);
1305
1306         rcu_read_lock();
1307         err = execute_actions(dp, skb, &key, actions->actions,
1308                               actions->n_actions, GFP_KERNEL);
1309         rcu_read_unlock();
1310
1311         kfree(actions);
1312         return err;
1313
1314 error_free_skb:
1315         kfree_skb(skb);
1316 error_free_actions:
1317         kfree(actions);
1318 error:
1319         return err;
1320 }
1321
1322 static int execute_packet(struct datapath *dp, const struct xflow_execute __user *executep)
1323 {
1324         struct xflow_execute execute;
1325
1326         if (copy_from_user(&execute, executep, sizeof execute))
1327                 return -EFAULT;
1328
1329         return do_execute(dp, &execute);
1330 }
1331
1332 static int get_dp_stats(struct datapath *dp, struct xflow_stats __user *statsp)
1333 {
1334         struct tbl *table = rcu_dereference(dp->table);
1335         struct xflow_stats stats;
1336         int i;
1337
1338         stats.n_flows = tbl_count(table);
1339         stats.cur_capacity = tbl_n_buckets(table);
1340         stats.max_capacity = TBL_MAX_BUCKETS;
1341         stats.n_ports = dp->n_ports;
1342         stats.max_ports = DP_MAX_PORTS;
1343         stats.max_groups = DP_MAX_GROUPS;
1344         stats.n_frags = stats.n_hit = stats.n_missed = stats.n_lost = 0;
1345         for_each_possible_cpu(i) {
1346                 const struct dp_stats_percpu *s;
1347                 s = per_cpu_ptr(dp->stats_percpu, i);
1348                 stats.n_frags += s->n_frags;
1349                 stats.n_hit += s->n_hit;
1350                 stats.n_missed += s->n_missed;
1351                 stats.n_lost += s->n_lost;
1352         }
1353         stats.max_miss_queue = DP_MAX_QUEUE_LEN;
1354         stats.max_action_queue = DP_MAX_QUEUE_LEN;
1355         return copy_to_user(statsp, &stats, sizeof stats) ? -EFAULT : 0;
1356 }
1357
1358 /* MTU of the dp pseudo-device: ETH_DATA_LEN or the minimum of the ports */
1359 int dp_min_mtu(const struct datapath *dp)
1360 {
1361         struct dp_port *p;
1362         int mtu = 0;
1363
1364         ASSERT_RTNL();
1365
1366         list_for_each_entry_rcu (p, &dp->port_list, node) {
1367                 int dev_mtu;
1368
1369                 /* Skip any internal ports, since that's what we're trying to
1370                  * set. */
1371                 if (is_internal_vport(p->vport))
1372                         continue;
1373
1374                 dev_mtu = vport_get_mtu(p->vport);
1375                 if (!mtu || dev_mtu < mtu)
1376                         mtu = dev_mtu;
1377         }
1378
1379         return mtu ? mtu : ETH_DATA_LEN;
1380 }
1381
1382 /* Sets the MTU of all datapath devices to the minimum of the ports.  Must
1383  * be called with RTNL lock. */
1384 void set_internal_devs_mtu(const struct datapath *dp)
1385 {
1386         struct dp_port *p;
1387         int mtu;
1388
1389         ASSERT_RTNL();
1390
1391         mtu = dp_min_mtu(dp);
1392
1393         list_for_each_entry_rcu (p, &dp->port_list, node) {
1394                 if (is_internal_vport(p->vport))
1395                         vport_set_mtu(p->vport, mtu);
1396         }
1397 }
1398
1399 static int
1400 put_port(const struct dp_port *p, struct xflow_port __user *uop)
1401 {
1402         struct xflow_port op;
1403
1404         memset(&op, 0, sizeof op);
1405
1406         rcu_read_lock();
1407         strncpy(op.devname, vport_get_name(p->vport), sizeof op.devname);
1408         rcu_read_unlock();
1409
1410         op.port = p->port_no;
1411         op.flags = is_internal_vport(p->vport) ? XFLOW_PORT_INTERNAL : 0;
1412
1413         return copy_to_user(uop, &op, sizeof op) ? -EFAULT : 0;
1414 }
1415
1416 static int
1417 query_port(struct datapath *dp, struct xflow_port __user *uport)
1418 {
1419         struct xflow_port port;
1420
1421         if (copy_from_user(&port, uport, sizeof port))
1422                 return -EFAULT;
1423
1424         if (port.devname[0]) {
1425                 struct vport *vport;
1426                 struct dp_port *dp_port;
1427                 int err = 0;
1428
1429                 port.devname[IFNAMSIZ - 1] = '\0';
1430
1431                 vport_lock();
1432                 rcu_read_lock();
1433
1434                 vport = vport_locate(port.devname);
1435                 if (!vport) {
1436                         err = -ENODEV;
1437                         goto error_unlock;
1438                 }
1439
1440                 dp_port = vport_get_dp_port(vport);
1441                 if (!dp_port || dp_port->dp != dp) {
1442                         err = -ENOENT;
1443                         goto error_unlock;
1444                 }
1445
1446                 port.port = dp_port->port_no;
1447
1448 error_unlock:
1449                 rcu_read_unlock();
1450                 vport_unlock();
1451
1452                 if (err)
1453                         return err;
1454         } else {
1455                 if (port.port >= DP_MAX_PORTS)
1456                         return -EINVAL;
1457                 if (!dp->ports[port.port])
1458                         return -ENOENT;
1459         }
1460
1461         return put_port(dp->ports[port.port], uport);
1462 }
1463
1464 static int
1465 do_list_ports(struct datapath *dp, struct xflow_port __user *uports, int n_ports)
1466 {
1467         int idx = 0;
1468         if (n_ports) {
1469                 struct dp_port *p;
1470
1471                 list_for_each_entry_rcu (p, &dp->port_list, node) {
1472                         if (put_port(p, &uports[idx]))
1473                                 return -EFAULT;
1474                         if (idx++ >= n_ports)
1475                                 break;
1476                 }
1477         }
1478         return idx;
1479 }
1480
1481 static int
1482 list_ports(struct datapath *dp, struct xflow_portvec __user *upv)
1483 {
1484         struct xflow_portvec pv;
1485         int retval;
1486
1487         if (copy_from_user(&pv, upv, sizeof pv))
1488                 return -EFAULT;
1489
1490         retval = do_list_ports(dp, pv.ports, pv.n_ports);
1491         if (retval < 0)
1492                 return retval;
1493
1494         return put_user(retval, &upv->n_ports);
1495 }
1496
1497 /* RCU callback for freeing a dp_port_group */
1498 static void free_port_group(struct rcu_head *rcu)
1499 {
1500         struct dp_port_group *g = container_of(rcu, struct dp_port_group, rcu);
1501         kfree(g);
1502 }
1503
1504 static int
1505 do_set_port_group(struct datapath *dp, u16 __user *ports, int n_ports, int group)
1506 {
1507         struct dp_port_group *new_group, *old_group;
1508         int error;
1509
1510         error = -EINVAL;
1511         if (n_ports > DP_MAX_PORTS || group >= DP_MAX_GROUPS)
1512                 goto error;
1513
1514         error = -ENOMEM;
1515         new_group = kmalloc(sizeof *new_group + sizeof(u16) * n_ports, GFP_KERNEL);
1516         if (!new_group)
1517                 goto error;
1518
1519         new_group->n_ports = n_ports;
1520         error = -EFAULT;
1521         if (copy_from_user(new_group->ports, ports, sizeof(u16) * n_ports))
1522                 goto error_free;
1523
1524         old_group = rcu_dereference(dp->groups[group]);
1525         rcu_assign_pointer(dp->groups[group], new_group);
1526         if (old_group)
1527                 call_rcu(&old_group->rcu, free_port_group);
1528         return 0;
1529
1530 error_free:
1531         kfree(new_group);
1532 error:
1533         return error;
1534 }
1535
1536 static int
1537 set_port_group(struct datapath *dp, const struct xflow_port_group __user *upg)
1538 {
1539         struct xflow_port_group pg;
1540
1541         if (copy_from_user(&pg, upg, sizeof pg))
1542                 return -EFAULT;
1543
1544         return do_set_port_group(dp, pg.ports, pg.n_ports, pg.group);
1545 }
1546
1547 static int
1548 do_get_port_group(struct datapath *dp,
1549                   u16 __user *ports, int n_ports, int group,
1550                   u16 __user *n_portsp)
1551 {
1552         struct dp_port_group *g;
1553         u16 n_copy;
1554
1555         if (group >= DP_MAX_GROUPS)
1556                 return -EINVAL;
1557
1558         g = dp->groups[group];
1559         n_copy = g ? min_t(int, g->n_ports, n_ports) : 0;
1560         if (n_copy && copy_to_user(ports, g->ports, n_copy * sizeof(u16)))
1561                 return -EFAULT;
1562
1563         if (put_user(g ? g->n_ports : 0, n_portsp))
1564                 return -EFAULT;
1565
1566         return 0;
1567 }
1568
1569 static int get_port_group(struct datapath *dp, struct xflow_port_group __user *upg)
1570 {
1571         struct xflow_port_group pg;
1572
1573         if (copy_from_user(&pg, upg, sizeof pg))
1574                 return -EFAULT;
1575
1576         return do_get_port_group(dp, pg.ports, pg.n_ports, pg.group, &pg.n_ports);
1577 }
1578
1579 static int get_listen_mask(const struct file *f)
1580 {
1581         return (long)f->private_data;
1582 }
1583
1584 static void set_listen_mask(struct file *f, int listen_mask)
1585 {
1586         f->private_data = (void*)(long)listen_mask;
1587 }
1588
1589 static long openvswitch_ioctl(struct file *f, unsigned int cmd,
1590                            unsigned long argp)
1591 {
1592         int dp_idx = iminor(f->f_dentry->d_inode);
1593         struct datapath *dp;
1594         int drop_frags, listeners, port_no;
1595         unsigned int sflow_probability;
1596         int err;
1597
1598         /* Handle commands with special locking requirements up front. */
1599         switch (cmd) {
1600         case XFLOW_DP_CREATE:
1601                 err = create_dp(dp_idx, (char __user *)argp);
1602                 goto exit;
1603
1604         case XFLOW_DP_DESTROY:
1605                 err = destroy_dp(dp_idx);
1606                 goto exit;
1607
1608         case XFLOW_PORT_ATTACH:
1609                 err = attach_port(dp_idx, (struct xflow_port __user *)argp);
1610                 goto exit;
1611
1612         case XFLOW_PORT_DETACH:
1613                 err = get_user(port_no, (int __user *)argp);
1614                 if (!err)
1615                         err = detach_port(dp_idx, port_no);
1616                 goto exit;
1617
1618         case XFLOW_VPORT_ADD:
1619                 err = vport_add((struct xflow_vport_add __user *)argp);
1620                 goto exit;
1621
1622         case XFLOW_VPORT_MOD:
1623                 err = vport_mod((struct xflow_vport_mod __user *)argp);
1624                 goto exit;
1625
1626         case XFLOW_VPORT_DEL:
1627                 err = vport_del((char __user *)argp);
1628                 goto exit;
1629
1630         case XFLOW_VPORT_STATS_GET:
1631                 err = vport_stats_get((struct xflow_vport_stats_req __user *)argp);
1632                 goto exit;
1633
1634         case XFLOW_VPORT_ETHER_GET:
1635                 err = vport_ether_get((struct xflow_vport_ether __user *)argp);
1636                 goto exit;
1637
1638         case XFLOW_VPORT_ETHER_SET:
1639                 err = vport_ether_set((struct xflow_vport_ether __user *)argp);
1640                 goto exit;
1641
1642         case XFLOW_VPORT_MTU_GET:
1643                 err = vport_mtu_get((struct xflow_vport_mtu __user *)argp);
1644                 goto exit;
1645
1646         case XFLOW_VPORT_MTU_SET:
1647                 err = vport_mtu_set((struct xflow_vport_mtu __user *)argp);
1648                 goto exit;
1649         }
1650
1651         dp = get_dp_locked(dp_idx);
1652         err = -ENODEV;
1653         if (!dp)
1654                 goto exit;
1655
1656         switch (cmd) {
1657         case XFLOW_DP_STATS:
1658                 err = get_dp_stats(dp, (struct xflow_stats __user *)argp);
1659                 break;
1660
1661         case XFLOW_GET_DROP_FRAGS:
1662                 err = put_user(dp->drop_frags, (int __user *)argp);
1663                 break;
1664
1665         case XFLOW_SET_DROP_FRAGS:
1666                 err = get_user(drop_frags, (int __user *)argp);
1667                 if (err)
1668                         break;
1669                 err = -EINVAL;
1670                 if (drop_frags != 0 && drop_frags != 1)
1671                         break;
1672                 dp->drop_frags = drop_frags;
1673                 err = 0;
1674                 break;
1675
1676         case XFLOW_GET_LISTEN_MASK:
1677                 err = put_user(get_listen_mask(f), (int __user *)argp);
1678                 break;
1679
1680         case XFLOW_SET_LISTEN_MASK:
1681                 err = get_user(listeners, (int __user *)argp);
1682                 if (err)
1683                         break;
1684                 err = -EINVAL;
1685                 if (listeners & ~XFLOWL_ALL)
1686                         break;
1687                 err = 0;
1688                 set_listen_mask(f, listeners);
1689                 break;
1690
1691         case XFLOW_GET_SFLOW_PROBABILITY:
1692                 err = put_user(dp->sflow_probability, (unsigned int __user *)argp);
1693                 break;
1694
1695         case XFLOW_SET_SFLOW_PROBABILITY:
1696                 err = get_user(sflow_probability, (unsigned int __user *)argp);
1697                 if (!err)
1698                         dp->sflow_probability = sflow_probability;
1699                 break;
1700
1701         case XFLOW_PORT_QUERY:
1702                 err = query_port(dp, (struct xflow_port __user *)argp);
1703                 break;
1704
1705         case XFLOW_PORT_LIST:
1706                 err = list_ports(dp, (struct xflow_portvec __user *)argp);
1707                 break;
1708
1709         case XFLOW_PORT_GROUP_SET:
1710                 err = set_port_group(dp, (struct xflow_port_group __user *)argp);
1711                 break;
1712
1713         case XFLOW_PORT_GROUP_GET:
1714                 err = get_port_group(dp, (struct xflow_port_group __user *)argp);
1715                 break;
1716
1717         case XFLOW_FLOW_FLUSH:
1718                 err = flush_flows(dp);
1719                 break;
1720
1721         case XFLOW_FLOW_PUT:
1722                 err = put_flow(dp, (struct xflow_flow_put __user *)argp);
1723                 break;
1724
1725         case XFLOW_FLOW_DEL:
1726                 err = del_flow(dp, (struct xflow_flow __user *)argp);
1727                 break;
1728
1729         case XFLOW_FLOW_GET:
1730                 err = do_flowvec_ioctl(dp, argp, do_query_flows);
1731                 break;
1732
1733         case XFLOW_FLOW_LIST:
1734                 err = do_flowvec_ioctl(dp, argp, do_list_flows);
1735                 break;
1736
1737         case XFLOW_EXECUTE:
1738                 err = execute_packet(dp, (struct xflow_execute __user *)argp);
1739                 break;
1740
1741         default:
1742                 err = -ENOIOCTLCMD;
1743                 break;
1744         }
1745         mutex_unlock(&dp->mutex);
1746 exit:
1747         return err;
1748 }
1749
1750 static int dp_has_packet_of_interest(struct datapath *dp, int listeners)
1751 {
1752         int i;
1753         for (i = 0; i < DP_N_QUEUES; i++) {
1754                 if (listeners & (1 << i) && !skb_queue_empty(&dp->queues[i]))
1755                         return 1;
1756         }
1757         return 0;
1758 }
1759
1760 #ifdef CONFIG_COMPAT
1761 static int compat_list_ports(struct datapath *dp, struct compat_xflow_portvec __user *upv)
1762 {
1763         struct compat_xflow_portvec pv;
1764         int retval;
1765
1766         if (copy_from_user(&pv, upv, sizeof pv))
1767                 return -EFAULT;
1768
1769         retval = do_list_ports(dp, compat_ptr(pv.ports), pv.n_ports);
1770         if (retval < 0)
1771                 return retval;
1772
1773         return put_user(retval, &upv->n_ports);
1774 }
1775
1776 static int compat_set_port_group(struct datapath *dp, const struct compat_xflow_port_group __user *upg)
1777 {
1778         struct compat_xflow_port_group pg;
1779
1780         if (copy_from_user(&pg, upg, sizeof pg))
1781                 return -EFAULT;
1782
1783         return do_set_port_group(dp, compat_ptr(pg.ports), pg.n_ports, pg.group);
1784 }
1785
1786 static int compat_get_port_group(struct datapath *dp, struct compat_xflow_port_group __user *upg)
1787 {
1788         struct compat_xflow_port_group pg;
1789
1790         if (copy_from_user(&pg, upg, sizeof pg))
1791                 return -EFAULT;
1792
1793         return do_get_port_group(dp, compat_ptr(pg.ports), pg.n_ports,
1794                                  pg.group, &pg.n_ports);
1795 }
1796
1797 static int compat_get_flow(struct xflow_flow *flow, const struct compat_xflow_flow __user *compat)
1798 {
1799         compat_uptr_t actions;
1800
1801         if (!access_ok(VERIFY_READ, compat, sizeof(struct compat_xflow_flow)) ||
1802             __copy_from_user(&flow->stats, &compat->stats, sizeof(struct xflow_flow_stats)) ||
1803             __copy_from_user(&flow->key, &compat->key, sizeof(struct xflow_key)) ||
1804             __get_user(actions, &compat->actions) ||
1805             __get_user(flow->n_actions, &compat->n_actions) ||
1806             __get_user(flow->flags, &compat->flags))
1807                 return -EFAULT;
1808
1809         flow->actions = compat_ptr(actions);
1810         return 0;
1811 }
1812
1813 static int compat_put_flow(struct datapath *dp, struct compat_xflow_flow_put __user *ufp)
1814 {
1815         struct xflow_flow_stats stats;
1816         struct xflow_flow_put fp;
1817         int error;
1818
1819         if (compat_get_flow(&fp.flow, &ufp->flow) ||
1820             get_user(fp.flags, &ufp->flags))
1821                 return -EFAULT;
1822
1823         error = do_put_flow(dp, &fp, &stats);
1824         if (error)
1825                 return error;
1826
1827         if (copy_to_user(&ufp->flow.stats, &stats,
1828                          sizeof(struct xflow_flow_stats)))
1829                 return -EFAULT;
1830
1831         return 0;
1832 }
1833
1834 static int compat_answer_query(struct sw_flow *flow, u32 query_flags,
1835                                struct compat_xflow_flow __user *ufp)
1836 {
1837         compat_uptr_t actions;
1838
1839         if (get_user(actions, &ufp->actions))
1840                 return -EFAULT;
1841
1842         return do_answer_query(flow, query_flags, &ufp->stats,
1843                                compat_ptr(actions), &ufp->n_actions);
1844 }
1845
1846 static int compat_del_flow(struct datapath *dp, struct compat_xflow_flow __user *ufp)
1847 {
1848         struct sw_flow *flow;
1849         struct xflow_flow uf;
1850         int error;
1851
1852         if (compat_get_flow(&uf, ufp))
1853                 return -EFAULT;
1854
1855         flow = do_del_flow(dp, &uf.key);
1856         if (IS_ERR(flow))
1857                 return PTR_ERR(flow);
1858
1859         error = compat_answer_query(flow, 0, ufp);
1860         flow_deferred_free(flow);
1861         return error;
1862 }
1863
1864 static int compat_query_flows(struct datapath *dp, struct compat_xflow_flow *flows, u32 n_flows)
1865 {
1866         struct tbl *table = rcu_dereference(dp->table);
1867         u32 i;
1868
1869         for (i = 0; i < n_flows; i++) {
1870                 struct compat_xflow_flow __user *ufp = &flows[i];
1871                 struct xflow_flow uf;
1872                 struct tbl_node *flow_node;
1873                 int error;
1874
1875                 if (compat_get_flow(&uf, ufp))
1876                         return -EFAULT;
1877
1878                 flow_node = tbl_lookup(table, &uf.key, flow_hash(&uf.key), flow_cmp);
1879                 if (!flow_node)
1880                         error = put_user(ENOENT, &ufp->stats.error);
1881                 else
1882                         error = compat_answer_query(flow_cast(flow_node), uf.flags, ufp);
1883                 if (error)
1884                         return -EFAULT;
1885         }
1886         return n_flows;
1887 }
1888
1889 struct compat_list_flows_cbdata {
1890         struct compat_xflow_flow __user *uflows;
1891         u32 n_flows;
1892         u32 listed_flows;
1893 };
1894
1895 static int compat_list_flow(struct tbl_node *node, void *cbdata_)
1896 {
1897         struct sw_flow *flow = flow_cast(node);
1898         struct compat_list_flows_cbdata *cbdata = cbdata_;
1899         struct compat_xflow_flow __user *ufp = &cbdata->uflows[cbdata->listed_flows++];
1900         int error;
1901
1902         if (copy_to_user(&ufp->key, &flow->key, sizeof flow->key))
1903                 return -EFAULT;
1904         error = compat_answer_query(flow, 0, ufp);
1905         if (error)
1906                 return error;
1907
1908         if (cbdata->listed_flows >= cbdata->n_flows)
1909                 return cbdata->listed_flows;
1910         return 0;
1911 }
1912
1913 static int compat_list_flows(struct datapath *dp, struct compat_xflow_flow *flows, u32 n_flows)
1914 {
1915         struct compat_list_flows_cbdata cbdata;
1916         int error;
1917
1918         if (!n_flows)
1919                 return 0;
1920
1921         cbdata.uflows = flows;
1922         cbdata.n_flows = n_flows;
1923         cbdata.listed_flows = 0;
1924         error = tbl_foreach(rcu_dereference(dp->table), compat_list_flow, &cbdata);
1925         return error ? error : cbdata.listed_flows;
1926 }
1927
1928 static int compat_flowvec_ioctl(struct datapath *dp, unsigned long argp,
1929                                 int (*function)(struct datapath *,
1930                                                 struct compat_xflow_flow *,
1931                                                 u32 n_flows))
1932 {
1933         struct compat_xflow_flowvec __user *uflowvec;
1934         struct compat_xflow_flow __user *flows;
1935         struct compat_xflow_flowvec flowvec;
1936         int retval;
1937
1938         uflowvec = compat_ptr(argp);
1939         if (!access_ok(VERIFY_WRITE, uflowvec, sizeof *uflowvec) ||
1940             copy_from_user(&flowvec, uflowvec, sizeof flowvec))
1941                 return -EFAULT;
1942
1943         if (flowvec.n_flows > INT_MAX / sizeof(struct compat_xflow_flow))
1944                 return -EINVAL;
1945
1946         flows = compat_ptr(flowvec.flows);
1947         if (!access_ok(VERIFY_WRITE, flows,
1948                        flowvec.n_flows * sizeof(struct compat_xflow_flow)))
1949                 return -EFAULT;
1950
1951         retval = function(dp, flows, flowvec.n_flows);
1952         return (retval < 0 ? retval
1953                 : retval == flowvec.n_flows ? 0
1954                 : put_user(retval, &uflowvec->n_flows));
1955 }
1956
1957 static int compat_execute(struct datapath *dp, const struct compat_xflow_execute __user *uexecute)
1958 {
1959         struct xflow_execute execute;
1960         compat_uptr_t actions;
1961         compat_uptr_t data;
1962
1963         if (!access_ok(VERIFY_READ, uexecute, sizeof(struct compat_xflow_execute)) ||
1964             __get_user(execute.in_port, &uexecute->in_port) ||
1965             __get_user(actions, &uexecute->actions) ||
1966             __get_user(execute.n_actions, &uexecute->n_actions) ||
1967             __get_user(data, &uexecute->data) ||
1968             __get_user(execute.length, &uexecute->length))
1969                 return -EFAULT;
1970
1971         execute.actions = compat_ptr(actions);
1972         execute.data = compat_ptr(data);
1973
1974         return do_execute(dp, &execute);
1975 }
1976
1977 static long openvswitch_compat_ioctl(struct file *f, unsigned int cmd, unsigned long argp)
1978 {
1979         int dp_idx = iminor(f->f_dentry->d_inode);
1980         struct datapath *dp;
1981         int err;
1982
1983         switch (cmd) {
1984         case XFLOW_DP_DESTROY:
1985         case XFLOW_FLOW_FLUSH:
1986                 /* Ioctls that don't need any translation at all. */
1987                 return openvswitch_ioctl(f, cmd, argp);
1988
1989         case XFLOW_DP_CREATE:
1990         case XFLOW_PORT_ATTACH:
1991         case XFLOW_PORT_DETACH:
1992         case XFLOW_VPORT_DEL:
1993         case XFLOW_VPORT_MTU_SET:
1994         case XFLOW_VPORT_MTU_GET:
1995         case XFLOW_VPORT_ETHER_SET:
1996         case XFLOW_VPORT_ETHER_GET:
1997         case XFLOW_VPORT_STATS_GET:
1998         case XFLOW_DP_STATS:
1999         case XFLOW_GET_DROP_FRAGS:
2000         case XFLOW_SET_DROP_FRAGS:
2001         case XFLOW_SET_LISTEN_MASK:
2002         case XFLOW_GET_LISTEN_MASK:
2003         case XFLOW_SET_SFLOW_PROBABILITY:
2004         case XFLOW_GET_SFLOW_PROBABILITY:
2005         case XFLOW_PORT_QUERY:
2006                 /* Ioctls that just need their pointer argument extended. */
2007                 return openvswitch_ioctl(f, cmd, (unsigned long)compat_ptr(argp));
2008
2009         case XFLOW_VPORT_ADD32:
2010                 return compat_vport_add(compat_ptr(argp));
2011
2012         case XFLOW_VPORT_MOD32:
2013                 return compat_vport_mod(compat_ptr(argp));
2014         }
2015
2016         dp = get_dp_locked(dp_idx);
2017         err = -ENODEV;
2018         if (!dp)
2019                 goto exit;
2020
2021         switch (cmd) {
2022         case XFLOW_PORT_LIST32:
2023                 err = compat_list_ports(dp, compat_ptr(argp));
2024                 break;
2025
2026         case XFLOW_PORT_GROUP_SET32:
2027                 err = compat_set_port_group(dp, compat_ptr(argp));
2028                 break;
2029
2030         case XFLOW_PORT_GROUP_GET32:
2031                 err = compat_get_port_group(dp, compat_ptr(argp));
2032                 break;
2033
2034         case XFLOW_FLOW_PUT32:
2035                 err = compat_put_flow(dp, compat_ptr(argp));
2036                 break;
2037
2038         case XFLOW_FLOW_DEL32:
2039                 err = compat_del_flow(dp, compat_ptr(argp));
2040                 break;
2041
2042         case XFLOW_FLOW_GET32:
2043                 err = compat_flowvec_ioctl(dp, argp, compat_query_flows);
2044                 break;
2045
2046         case XFLOW_FLOW_LIST32:
2047                 err = compat_flowvec_ioctl(dp, argp, compat_list_flows);
2048                 break;
2049
2050         case XFLOW_EXECUTE32:
2051                 err = compat_execute(dp, compat_ptr(argp));
2052                 break;
2053
2054         default:
2055                 err = -ENOIOCTLCMD;
2056                 break;
2057         }
2058         mutex_unlock(&dp->mutex);
2059 exit:
2060         return err;
2061 }
2062 #endif
2063
2064 ssize_t openvswitch_read(struct file *f, char __user *buf, size_t nbytes,
2065                       loff_t *ppos)
2066 {
2067         /* XXX is there sufficient synchronization here? */
2068         int listeners = get_listen_mask(f);
2069         int dp_idx = iminor(f->f_dentry->d_inode);
2070         struct datapath *dp = get_dp(dp_idx);
2071         struct sk_buff *skb;
2072         struct iovec __user iov;
2073         size_t copy_bytes;
2074         int retval;
2075
2076         if (!dp)
2077                 return -ENODEV;
2078
2079         if (nbytes == 0 || !listeners)
2080                 return 0;
2081
2082         for (;;) {
2083                 int i;
2084
2085                 for (i = 0; i < DP_N_QUEUES; i++) {
2086                         if (listeners & (1 << i)) {
2087                                 skb = skb_dequeue(&dp->queues[i]);
2088                                 if (skb)
2089                                         goto success;
2090                         }
2091                 }
2092
2093                 if (f->f_flags & O_NONBLOCK) {
2094                         retval = -EAGAIN;
2095                         goto error;
2096                 }
2097
2098                 wait_event_interruptible(dp->waitqueue,
2099                                          dp_has_packet_of_interest(dp,
2100                                                                    listeners));
2101
2102                 if (signal_pending(current)) {
2103                         retval = -ERESTARTSYS;
2104                         goto error;
2105                 }
2106         }
2107 success:
2108         copy_bytes = min_t(size_t, skb->len, nbytes);
2109         iov.iov_base = buf;
2110         iov.iov_len = copy_bytes;
2111         retval = skb_copy_datagram_iovec(skb, 0, &iov, iov.iov_len);
2112         if (!retval)
2113                 retval = copy_bytes;
2114         kfree_skb(skb);
2115
2116 error:
2117         return retval;
2118 }
2119
2120 static unsigned int openvswitch_poll(struct file *file, poll_table *wait)
2121 {
2122         /* XXX is there sufficient synchronization here? */
2123         int dp_idx = iminor(file->f_dentry->d_inode);
2124         struct datapath *dp = get_dp(dp_idx);
2125         unsigned int mask;
2126
2127         if (dp) {
2128                 mask = 0;
2129                 poll_wait(file, &dp->waitqueue, wait);
2130                 if (dp_has_packet_of_interest(dp, get_listen_mask(file)))
2131                         mask |= POLLIN | POLLRDNORM;
2132         } else {
2133                 mask = POLLIN | POLLRDNORM | POLLHUP;
2134         }
2135         return mask;
2136 }
2137
2138 struct file_operations openvswitch_fops = {
2139         /* XXX .aio_read = openvswitch_aio_read, */
2140         .read  = openvswitch_read,
2141         .poll  = openvswitch_poll,
2142         .unlocked_ioctl = openvswitch_ioctl,
2143 #ifdef CONFIG_COMPAT
2144         .compat_ioctl = openvswitch_compat_ioctl,
2145 #endif
2146         /* XXX .fasync = openvswitch_fasync, */
2147 };
2148
2149 static int major;
2150
2151 static int __init dp_init(void)
2152 {
2153         struct sk_buff *dummy_skb;
2154         int err;
2155
2156         BUILD_BUG_ON(sizeof(struct ovs_skb_cb) > sizeof(dummy_skb->cb));
2157
2158         printk("Open vSwitch %s, built "__DATE__" "__TIME__"\n", VERSION BUILDNR);
2159
2160         err = flow_init();
2161         if (err)
2162                 goto error;
2163
2164         err = vport_init();
2165         if (err)
2166                 goto error_flow_exit;
2167
2168         err = register_netdevice_notifier(&dp_device_notifier);
2169         if (err)
2170                 goto error_vport_exit;
2171
2172         major = register_chrdev(0, "openvswitch", &openvswitch_fops);
2173         if (err < 0)
2174                 goto error_unreg_notifier;
2175
2176         return 0;
2177
2178 error_unreg_notifier:
2179         unregister_netdevice_notifier(&dp_device_notifier);
2180 error_vport_exit:
2181         vport_exit();
2182 error_flow_exit:
2183         flow_exit();
2184 error:
2185         return err;
2186 }
2187
2188 static void dp_cleanup(void)
2189 {
2190         rcu_barrier();
2191         unregister_chrdev(major, "openvswitch");
2192         unregister_netdevice_notifier(&dp_device_notifier);
2193         vport_exit();
2194         flow_exit();
2195 }
2196
2197 module_init(dp_init);
2198 module_exit(dp_cleanup);
2199
2200 MODULE_DESCRIPTION("Open vSwitch switching datapath");
2201 MODULE_LICENSE("GPL");