]> Pileus Git - ~andy/linux/blob - net/openvswitch/datapath.c
genetlink: pass family to functions using groups
[~andy/linux] / net / openvswitch / datapath.c
1 /*
2  * Copyright (c) 2007-2013 Nicira, Inc.
3  *
4  * This program is free software; you can redistribute it and/or
5  * modify it under the terms of version 2 of the GNU General Public
6  * License as published by the Free Software Foundation.
7  *
8  * This program is distributed in the hope that it will be useful, but
9  * WITHOUT ANY WARRANTY; without even the implied warranty of
10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
11  * General Public License for more details.
12  *
13  * You should have received a copy of the GNU General Public License
14  * along with this program; if not, write to the Free Software
15  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
16  * 02110-1301, USA
17  */
18
19 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
20
21 #include <linux/init.h>
22 #include <linux/module.h>
23 #include <linux/if_arp.h>
24 #include <linux/if_vlan.h>
25 #include <linux/in.h>
26 #include <linux/ip.h>
27 #include <linux/jhash.h>
28 #include <linux/delay.h>
29 #include <linux/time.h>
30 #include <linux/etherdevice.h>
31 #include <linux/genetlink.h>
32 #include <linux/kernel.h>
33 #include <linux/kthread.h>
34 #include <linux/mutex.h>
35 #include <linux/percpu.h>
36 #include <linux/rcupdate.h>
37 #include <linux/tcp.h>
38 #include <linux/udp.h>
39 #include <linux/ethtool.h>
40 #include <linux/wait.h>
41 #include <asm/div64.h>
42 #include <linux/highmem.h>
43 #include <linux/netfilter_bridge.h>
44 #include <linux/netfilter_ipv4.h>
45 #include <linux/inetdevice.h>
46 #include <linux/list.h>
47 #include <linux/lockdep.h>
48 #include <linux/openvswitch.h>
49 #include <linux/rculist.h>
50 #include <linux/dmi.h>
51 #include <linux/workqueue.h>
52 #include <net/genetlink.h>
53 #include <net/net_namespace.h>
54 #include <net/netns/generic.h>
55
56 #include "datapath.h"
57 #include "flow.h"
58 #include "flow_netlink.h"
59 #include "vport-internal_dev.h"
60 #include "vport-netdev.h"
61
62 int ovs_net_id __read_mostly;
63
64 static void ovs_notify(struct genl_family *family,
65                        struct sk_buff *skb, struct genl_info *info,
66                        struct genl_multicast_group *grp)
67 {
68         genl_notify(family, skb, genl_info_net(info), info->snd_portid,
69                     grp->id, info->nlhdr, GFP_KERNEL);
70 }
71
72 /**
73  * DOC: Locking:
74  *
75  * All writes e.g. Writes to device state (add/remove datapath, port, set
76  * operations on vports, etc.), Writes to other state (flow table
77  * modifications, set miscellaneous datapath parameters, etc.) are protected
78  * by ovs_lock.
79  *
80  * Reads are protected by RCU.
81  *
82  * There are a few special cases (mostly stats) that have their own
83  * synchronization but they nest under all of above and don't interact with
84  * each other.
85  *
86  * The RTNL lock nests inside ovs_mutex.
87  */
88
89 static DEFINE_MUTEX(ovs_mutex);
90
91 void ovs_lock(void)
92 {
93         mutex_lock(&ovs_mutex);
94 }
95
96 void ovs_unlock(void)
97 {
98         mutex_unlock(&ovs_mutex);
99 }
100
101 #ifdef CONFIG_LOCKDEP
102 int lockdep_ovsl_is_held(void)
103 {
104         if (debug_locks)
105                 return lockdep_is_held(&ovs_mutex);
106         else
107                 return 1;
108 }
109 #endif
110
111 static struct vport *new_vport(const struct vport_parms *);
112 static int queue_gso_packets(struct net *, int dp_ifindex, struct sk_buff *,
113                              const struct dp_upcall_info *);
114 static int queue_userspace_packet(struct net *, int dp_ifindex,
115                                   struct sk_buff *,
116                                   const struct dp_upcall_info *);
117
118 /* Must be called with rcu_read_lock or ovs_mutex. */
119 static struct datapath *get_dp(struct net *net, int dp_ifindex)
120 {
121         struct datapath *dp = NULL;
122         struct net_device *dev;
123
124         rcu_read_lock();
125         dev = dev_get_by_index_rcu(net, dp_ifindex);
126         if (dev) {
127                 struct vport *vport = ovs_internal_dev_get_vport(dev);
128                 if (vport)
129                         dp = vport->dp;
130         }
131         rcu_read_unlock();
132
133         return dp;
134 }
135
136 /* Must be called with rcu_read_lock or ovs_mutex. */
137 const char *ovs_dp_name(const struct datapath *dp)
138 {
139         struct vport *vport = ovs_vport_ovsl_rcu(dp, OVSP_LOCAL);
140         return vport->ops->get_name(vport);
141 }
142
143 static int get_dpifindex(struct datapath *dp)
144 {
145         struct vport *local;
146         int ifindex;
147
148         rcu_read_lock();
149
150         local = ovs_vport_rcu(dp, OVSP_LOCAL);
151         if (local)
152                 ifindex = netdev_vport_priv(local)->dev->ifindex;
153         else
154                 ifindex = 0;
155
156         rcu_read_unlock();
157
158         return ifindex;
159 }
160
161 static void destroy_dp_rcu(struct rcu_head *rcu)
162 {
163         struct datapath *dp = container_of(rcu, struct datapath, rcu);
164
165         ovs_flow_tbl_destroy(&dp->table);
166         free_percpu(dp->stats_percpu);
167         release_net(ovs_dp_get_net(dp));
168         kfree(dp->ports);
169         kfree(dp);
170 }
171
172 static struct hlist_head *vport_hash_bucket(const struct datapath *dp,
173                                             u16 port_no)
174 {
175         return &dp->ports[port_no & (DP_VPORT_HASH_BUCKETS - 1)];
176 }
177
178 struct vport *ovs_lookup_vport(const struct datapath *dp, u16 port_no)
179 {
180         struct vport *vport;
181         struct hlist_head *head;
182
183         head = vport_hash_bucket(dp, port_no);
184         hlist_for_each_entry_rcu(vport, head, dp_hash_node) {
185                 if (vport->port_no == port_no)
186                         return vport;
187         }
188         return NULL;
189 }
190
191 /* Called with ovs_mutex. */
192 static struct vport *new_vport(const struct vport_parms *parms)
193 {
194         struct vport *vport;
195
196         vport = ovs_vport_add(parms);
197         if (!IS_ERR(vport)) {
198                 struct datapath *dp = parms->dp;
199                 struct hlist_head *head = vport_hash_bucket(dp, vport->port_no);
200
201                 hlist_add_head_rcu(&vport->dp_hash_node, head);
202         }
203         return vport;
204 }
205
206 void ovs_dp_detach_port(struct vport *p)
207 {
208         ASSERT_OVSL();
209
210         /* First drop references to device. */
211         hlist_del_rcu(&p->dp_hash_node);
212
213         /* Then destroy it. */
214         ovs_vport_del(p);
215 }
216
217 /* Must be called with rcu_read_lock. */
218 void ovs_dp_process_received_packet(struct vport *p, struct sk_buff *skb)
219 {
220         struct datapath *dp = p->dp;
221         struct sw_flow *flow;
222         struct dp_stats_percpu *stats;
223         struct sw_flow_key key;
224         u64 *stats_counter;
225         u32 n_mask_hit;
226         int error;
227
228         stats = this_cpu_ptr(dp->stats_percpu);
229
230         /* Extract flow from 'skb' into 'key'. */
231         error = ovs_flow_extract(skb, p->port_no, &key);
232         if (unlikely(error)) {
233                 kfree_skb(skb);
234                 return;
235         }
236
237         /* Look up flow. */
238         flow = ovs_flow_tbl_lookup(&dp->table, &key, &n_mask_hit);
239         if (unlikely(!flow)) {
240                 struct dp_upcall_info upcall;
241
242                 upcall.cmd = OVS_PACKET_CMD_MISS;
243                 upcall.key = &key;
244                 upcall.userdata = NULL;
245                 upcall.portid = p->upcall_portid;
246                 ovs_dp_upcall(dp, skb, &upcall);
247                 consume_skb(skb);
248                 stats_counter = &stats->n_missed;
249                 goto out;
250         }
251
252         OVS_CB(skb)->flow = flow;
253         OVS_CB(skb)->pkt_key = &key;
254
255         stats_counter = &stats->n_hit;
256         ovs_flow_used(OVS_CB(skb)->flow, skb);
257         ovs_execute_actions(dp, skb);
258
259 out:
260         /* Update datapath statistics. */
261         u64_stats_update_begin(&stats->sync);
262         (*stats_counter)++;
263         stats->n_mask_hit += n_mask_hit;
264         u64_stats_update_end(&stats->sync);
265 }
266
267 static struct genl_family dp_packet_genl_family = {
268         .id = GENL_ID_GENERATE,
269         .hdrsize = sizeof(struct ovs_header),
270         .name = OVS_PACKET_FAMILY,
271         .version = OVS_PACKET_VERSION,
272         .maxattr = OVS_PACKET_ATTR_MAX,
273         .netnsok = true,
274         .parallel_ops = true,
275 };
276
277 int ovs_dp_upcall(struct datapath *dp, struct sk_buff *skb,
278                   const struct dp_upcall_info *upcall_info)
279 {
280         struct dp_stats_percpu *stats;
281         int dp_ifindex;
282         int err;
283
284         if (upcall_info->portid == 0) {
285                 err = -ENOTCONN;
286                 goto err;
287         }
288
289         dp_ifindex = get_dpifindex(dp);
290         if (!dp_ifindex) {
291                 err = -ENODEV;
292                 goto err;
293         }
294
295         if (!skb_is_gso(skb))
296                 err = queue_userspace_packet(ovs_dp_get_net(dp), dp_ifindex, skb, upcall_info);
297         else
298                 err = queue_gso_packets(ovs_dp_get_net(dp), dp_ifindex, skb, upcall_info);
299         if (err)
300                 goto err;
301
302         return 0;
303
304 err:
305         stats = this_cpu_ptr(dp->stats_percpu);
306
307         u64_stats_update_begin(&stats->sync);
308         stats->n_lost++;
309         u64_stats_update_end(&stats->sync);
310
311         return err;
312 }
313
314 static int queue_gso_packets(struct net *net, int dp_ifindex,
315                              struct sk_buff *skb,
316                              const struct dp_upcall_info *upcall_info)
317 {
318         unsigned short gso_type = skb_shinfo(skb)->gso_type;
319         struct dp_upcall_info later_info;
320         struct sw_flow_key later_key;
321         struct sk_buff *segs, *nskb;
322         int err;
323
324         segs = __skb_gso_segment(skb, NETIF_F_SG | NETIF_F_HW_CSUM, false);
325         if (IS_ERR(segs))
326                 return PTR_ERR(segs);
327
328         /* Queue all of the segments. */
329         skb = segs;
330         do {
331                 err = queue_userspace_packet(net, dp_ifindex, skb, upcall_info);
332                 if (err)
333                         break;
334
335                 if (skb == segs && gso_type & SKB_GSO_UDP) {
336                         /* The initial flow key extracted by ovs_flow_extract()
337                          * in this case is for a first fragment, so we need to
338                          * properly mark later fragments.
339                          */
340                         later_key = *upcall_info->key;
341                         later_key.ip.frag = OVS_FRAG_TYPE_LATER;
342
343                         later_info = *upcall_info;
344                         later_info.key = &later_key;
345                         upcall_info = &later_info;
346                 }
347         } while ((skb = skb->next));
348
349         /* Free all of the segments. */
350         skb = segs;
351         do {
352                 nskb = skb->next;
353                 if (err)
354                         kfree_skb(skb);
355                 else
356                         consume_skb(skb);
357         } while ((skb = nskb));
358         return err;
359 }
360
361 static size_t key_attr_size(void)
362 {
363         return    nla_total_size(4)   /* OVS_KEY_ATTR_PRIORITY */
364                 + nla_total_size(0)   /* OVS_KEY_ATTR_TUNNEL */
365                   + nla_total_size(8)   /* OVS_TUNNEL_KEY_ATTR_ID */
366                   + nla_total_size(4)   /* OVS_TUNNEL_KEY_ATTR_IPV4_SRC */
367                   + nla_total_size(4)   /* OVS_TUNNEL_KEY_ATTR_IPV4_DST */
368                   + nla_total_size(1)   /* OVS_TUNNEL_KEY_ATTR_TOS */
369                   + nla_total_size(1)   /* OVS_TUNNEL_KEY_ATTR_TTL */
370                   + nla_total_size(0)   /* OVS_TUNNEL_KEY_ATTR_DONT_FRAGMENT */
371                   + nla_total_size(0)   /* OVS_TUNNEL_KEY_ATTR_CSUM */
372                 + nla_total_size(4)   /* OVS_KEY_ATTR_IN_PORT */
373                 + nla_total_size(4)   /* OVS_KEY_ATTR_SKB_MARK */
374                 + nla_total_size(12)  /* OVS_KEY_ATTR_ETHERNET */
375                 + nla_total_size(2)   /* OVS_KEY_ATTR_ETHERTYPE */
376                 + nla_total_size(4)   /* OVS_KEY_ATTR_8021Q */
377                 + nla_total_size(0)   /* OVS_KEY_ATTR_ENCAP */
378                 + nla_total_size(2)   /* OVS_KEY_ATTR_ETHERTYPE */
379                 + nla_total_size(40)  /* OVS_KEY_ATTR_IPV6 */
380                 + nla_total_size(2)   /* OVS_KEY_ATTR_ICMPV6 */
381                 + nla_total_size(28); /* OVS_KEY_ATTR_ND */
382 }
383
384 static size_t upcall_msg_size(const struct sk_buff *skb,
385                               const struct nlattr *userdata)
386 {
387         size_t size = NLMSG_ALIGN(sizeof(struct ovs_header))
388                 + nla_total_size(skb->len) /* OVS_PACKET_ATTR_PACKET */
389                 + nla_total_size(key_attr_size()); /* OVS_PACKET_ATTR_KEY */
390
391         /* OVS_PACKET_ATTR_USERDATA */
392         if (userdata)
393                 size += NLA_ALIGN(userdata->nla_len);
394
395         return size;
396 }
397
398 static int queue_userspace_packet(struct net *net, int dp_ifindex,
399                                   struct sk_buff *skb,
400                                   const struct dp_upcall_info *upcall_info)
401 {
402         struct ovs_header *upcall;
403         struct sk_buff *nskb = NULL;
404         struct sk_buff *user_skb; /* to be queued to userspace */
405         struct nlattr *nla;
406         int err;
407
408         if (vlan_tx_tag_present(skb)) {
409                 nskb = skb_clone(skb, GFP_ATOMIC);
410                 if (!nskb)
411                         return -ENOMEM;
412
413                 nskb = __vlan_put_tag(nskb, nskb->vlan_proto, vlan_tx_tag_get(nskb));
414                 if (!nskb)
415                         return -ENOMEM;
416
417                 nskb->vlan_tci = 0;
418                 skb = nskb;
419         }
420
421         if (nla_attr_size(skb->len) > USHRT_MAX) {
422                 err = -EFBIG;
423                 goto out;
424         }
425
426         user_skb = genlmsg_new(upcall_msg_size(skb, upcall_info->userdata), GFP_ATOMIC);
427         if (!user_skb) {
428                 err = -ENOMEM;
429                 goto out;
430         }
431
432         upcall = genlmsg_put(user_skb, 0, 0, &dp_packet_genl_family,
433                              0, upcall_info->cmd);
434         upcall->dp_ifindex = dp_ifindex;
435
436         nla = nla_nest_start(user_skb, OVS_PACKET_ATTR_KEY);
437         ovs_nla_put_flow(upcall_info->key, upcall_info->key, user_skb);
438         nla_nest_end(user_skb, nla);
439
440         if (upcall_info->userdata)
441                 __nla_put(user_skb, OVS_PACKET_ATTR_USERDATA,
442                           nla_len(upcall_info->userdata),
443                           nla_data(upcall_info->userdata));
444
445         nla = __nla_reserve(user_skb, OVS_PACKET_ATTR_PACKET, skb->len);
446
447         skb_copy_and_csum_dev(skb, nla_data(nla));
448
449         genlmsg_end(user_skb, upcall);
450         err = genlmsg_unicast(net, user_skb, upcall_info->portid);
451
452 out:
453         kfree_skb(nskb);
454         return err;
455 }
456
457 static void clear_stats(struct sw_flow *flow)
458 {
459         flow->used = 0;
460         flow->tcp_flags = 0;
461         flow->packet_count = 0;
462         flow->byte_count = 0;
463 }
464
465 static int ovs_packet_cmd_execute(struct sk_buff *skb, struct genl_info *info)
466 {
467         struct ovs_header *ovs_header = info->userhdr;
468         struct nlattr **a = info->attrs;
469         struct sw_flow_actions *acts;
470         struct sk_buff *packet;
471         struct sw_flow *flow;
472         struct datapath *dp;
473         struct ethhdr *eth;
474         int len;
475         int err;
476
477         err = -EINVAL;
478         if (!a[OVS_PACKET_ATTR_PACKET] || !a[OVS_PACKET_ATTR_KEY] ||
479             !a[OVS_PACKET_ATTR_ACTIONS])
480                 goto err;
481
482         len = nla_len(a[OVS_PACKET_ATTR_PACKET]);
483         packet = __dev_alloc_skb(NET_IP_ALIGN + len, GFP_KERNEL);
484         err = -ENOMEM;
485         if (!packet)
486                 goto err;
487         skb_reserve(packet, NET_IP_ALIGN);
488
489         nla_memcpy(__skb_put(packet, len), a[OVS_PACKET_ATTR_PACKET], len);
490
491         skb_reset_mac_header(packet);
492         eth = eth_hdr(packet);
493
494         /* Normally, setting the skb 'protocol' field would be handled by a
495          * call to eth_type_trans(), but it assumes there's a sending
496          * device, which we may not have. */
497         if (ntohs(eth->h_proto) >= ETH_P_802_3_MIN)
498                 packet->protocol = eth->h_proto;
499         else
500                 packet->protocol = htons(ETH_P_802_2);
501
502         /* Build an sw_flow for sending this packet. */
503         flow = ovs_flow_alloc();
504         err = PTR_ERR(flow);
505         if (IS_ERR(flow))
506                 goto err_kfree_skb;
507
508         err = ovs_flow_extract(packet, -1, &flow->key);
509         if (err)
510                 goto err_flow_free;
511
512         err = ovs_nla_get_flow_metadata(flow, a[OVS_PACKET_ATTR_KEY]);
513         if (err)
514                 goto err_flow_free;
515         acts = ovs_nla_alloc_flow_actions(nla_len(a[OVS_PACKET_ATTR_ACTIONS]));
516         err = PTR_ERR(acts);
517         if (IS_ERR(acts))
518                 goto err_flow_free;
519
520         err = ovs_nla_copy_actions(a[OVS_PACKET_ATTR_ACTIONS],
521                                    &flow->key, 0, &acts);
522         rcu_assign_pointer(flow->sf_acts, acts);
523         if (err)
524                 goto err_flow_free;
525
526         OVS_CB(packet)->flow = flow;
527         OVS_CB(packet)->pkt_key = &flow->key;
528         packet->priority = flow->key.phy.priority;
529         packet->mark = flow->key.phy.skb_mark;
530
531         rcu_read_lock();
532         dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
533         err = -ENODEV;
534         if (!dp)
535                 goto err_unlock;
536
537         local_bh_disable();
538         err = ovs_execute_actions(dp, packet);
539         local_bh_enable();
540         rcu_read_unlock();
541
542         ovs_flow_free(flow, false);
543         return err;
544
545 err_unlock:
546         rcu_read_unlock();
547 err_flow_free:
548         ovs_flow_free(flow, false);
549 err_kfree_skb:
550         kfree_skb(packet);
551 err:
552         return err;
553 }
554
555 static const struct nla_policy packet_policy[OVS_PACKET_ATTR_MAX + 1] = {
556         [OVS_PACKET_ATTR_PACKET] = { .len = ETH_HLEN },
557         [OVS_PACKET_ATTR_KEY] = { .type = NLA_NESTED },
558         [OVS_PACKET_ATTR_ACTIONS] = { .type = NLA_NESTED },
559 };
560
561 static const struct genl_ops dp_packet_genl_ops[] = {
562         { .cmd = OVS_PACKET_CMD_EXECUTE,
563           .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
564           .policy = packet_policy,
565           .doit = ovs_packet_cmd_execute
566         }
567 };
568
569 static void get_dp_stats(struct datapath *dp, struct ovs_dp_stats *stats,
570                          struct ovs_dp_megaflow_stats *mega_stats)
571 {
572         int i;
573
574         memset(mega_stats, 0, sizeof(*mega_stats));
575
576         stats->n_flows = ovs_flow_tbl_count(&dp->table);
577         mega_stats->n_masks = ovs_flow_tbl_num_masks(&dp->table);
578
579         stats->n_hit = stats->n_missed = stats->n_lost = 0;
580
581         for_each_possible_cpu(i) {
582                 const struct dp_stats_percpu *percpu_stats;
583                 struct dp_stats_percpu local_stats;
584                 unsigned int start;
585
586                 percpu_stats = per_cpu_ptr(dp->stats_percpu, i);
587
588                 do {
589                         start = u64_stats_fetch_begin_bh(&percpu_stats->sync);
590                         local_stats = *percpu_stats;
591                 } while (u64_stats_fetch_retry_bh(&percpu_stats->sync, start));
592
593                 stats->n_hit += local_stats.n_hit;
594                 stats->n_missed += local_stats.n_missed;
595                 stats->n_lost += local_stats.n_lost;
596                 mega_stats->n_mask_hit += local_stats.n_mask_hit;
597         }
598 }
599
600 static const struct nla_policy flow_policy[OVS_FLOW_ATTR_MAX + 1] = {
601         [OVS_FLOW_ATTR_KEY] = { .type = NLA_NESTED },
602         [OVS_FLOW_ATTR_ACTIONS] = { .type = NLA_NESTED },
603         [OVS_FLOW_ATTR_CLEAR] = { .type = NLA_FLAG },
604 };
605
606 static struct genl_family dp_flow_genl_family = {
607         .id = GENL_ID_GENERATE,
608         .hdrsize = sizeof(struct ovs_header),
609         .name = OVS_FLOW_FAMILY,
610         .version = OVS_FLOW_VERSION,
611         .maxattr = OVS_FLOW_ATTR_MAX,
612         .netnsok = true,
613         .parallel_ops = true,
614 };
615
616 static struct genl_multicast_group ovs_dp_flow_multicast_group = {
617         .name = OVS_FLOW_MCGROUP
618 };
619
620 static size_t ovs_flow_cmd_msg_size(const struct sw_flow_actions *acts)
621 {
622         return NLMSG_ALIGN(sizeof(struct ovs_header))
623                 + nla_total_size(key_attr_size()) /* OVS_FLOW_ATTR_KEY */
624                 + nla_total_size(key_attr_size()) /* OVS_FLOW_ATTR_MASK */
625                 + nla_total_size(sizeof(struct ovs_flow_stats)) /* OVS_FLOW_ATTR_STATS */
626                 + nla_total_size(1) /* OVS_FLOW_ATTR_TCP_FLAGS */
627                 + nla_total_size(8) /* OVS_FLOW_ATTR_USED */
628                 + nla_total_size(acts->actions_len); /* OVS_FLOW_ATTR_ACTIONS */
629 }
630
631 /* Called with ovs_mutex. */
632 static int ovs_flow_cmd_fill_info(struct sw_flow *flow, struct datapath *dp,
633                                   struct sk_buff *skb, u32 portid,
634                                   u32 seq, u32 flags, u8 cmd)
635 {
636         const int skb_orig_len = skb->len;
637         struct nlattr *start;
638         struct ovs_flow_stats stats;
639         struct ovs_header *ovs_header;
640         struct nlattr *nla;
641         unsigned long used;
642         u8 tcp_flags;
643         int err;
644
645         ovs_header = genlmsg_put(skb, portid, seq, &dp_flow_genl_family, flags, cmd);
646         if (!ovs_header)
647                 return -EMSGSIZE;
648
649         ovs_header->dp_ifindex = get_dpifindex(dp);
650
651         /* Fill flow key. */
652         nla = nla_nest_start(skb, OVS_FLOW_ATTR_KEY);
653         if (!nla)
654                 goto nla_put_failure;
655
656         err = ovs_nla_put_flow(&flow->unmasked_key, &flow->unmasked_key, skb);
657         if (err)
658                 goto error;
659         nla_nest_end(skb, nla);
660
661         nla = nla_nest_start(skb, OVS_FLOW_ATTR_MASK);
662         if (!nla)
663                 goto nla_put_failure;
664
665         err = ovs_nla_put_flow(&flow->key, &flow->mask->key, skb);
666         if (err)
667                 goto error;
668
669         nla_nest_end(skb, nla);
670
671         spin_lock_bh(&flow->lock);
672         used = flow->used;
673         stats.n_packets = flow->packet_count;
674         stats.n_bytes = flow->byte_count;
675         tcp_flags = (u8)ntohs(flow->tcp_flags);
676         spin_unlock_bh(&flow->lock);
677
678         if (used &&
679             nla_put_u64(skb, OVS_FLOW_ATTR_USED, ovs_flow_used_time(used)))
680                 goto nla_put_failure;
681
682         if (stats.n_packets &&
683             nla_put(skb, OVS_FLOW_ATTR_STATS,
684                     sizeof(struct ovs_flow_stats), &stats))
685                 goto nla_put_failure;
686
687         if (tcp_flags &&
688             nla_put_u8(skb, OVS_FLOW_ATTR_TCP_FLAGS, tcp_flags))
689                 goto nla_put_failure;
690
691         /* If OVS_FLOW_ATTR_ACTIONS doesn't fit, skip dumping the actions if
692          * this is the first flow to be dumped into 'skb'.  This is unusual for
693          * Netlink but individual action lists can be longer than
694          * NLMSG_GOODSIZE and thus entirely undumpable if we didn't do this.
695          * The userspace caller can always fetch the actions separately if it
696          * really wants them.  (Most userspace callers in fact don't care.)
697          *
698          * This can only fail for dump operations because the skb is always
699          * properly sized for single flows.
700          */
701         start = nla_nest_start(skb, OVS_FLOW_ATTR_ACTIONS);
702         if (start) {
703                 const struct sw_flow_actions *sf_acts;
704
705                 sf_acts = rcu_dereference_check(flow->sf_acts,
706                                                 lockdep_ovsl_is_held());
707
708                 err = ovs_nla_put_actions(sf_acts->actions,
709                                           sf_acts->actions_len, skb);
710                 if (!err)
711                         nla_nest_end(skb, start);
712                 else {
713                         if (skb_orig_len)
714                                 goto error;
715
716                         nla_nest_cancel(skb, start);
717                 }
718         } else if (skb_orig_len)
719                 goto nla_put_failure;
720
721         return genlmsg_end(skb, ovs_header);
722
723 nla_put_failure:
724         err = -EMSGSIZE;
725 error:
726         genlmsg_cancel(skb, ovs_header);
727         return err;
728 }
729
730 static struct sk_buff *ovs_flow_cmd_alloc_info(struct sw_flow *flow)
731 {
732         const struct sw_flow_actions *sf_acts;
733
734         sf_acts = ovsl_dereference(flow->sf_acts);
735
736         return genlmsg_new(ovs_flow_cmd_msg_size(sf_acts), GFP_KERNEL);
737 }
738
739 static struct sk_buff *ovs_flow_cmd_build_info(struct sw_flow *flow,
740                                                struct datapath *dp,
741                                                u32 portid, u32 seq, u8 cmd)
742 {
743         struct sk_buff *skb;
744         int retval;
745
746         skb = ovs_flow_cmd_alloc_info(flow);
747         if (!skb)
748                 return ERR_PTR(-ENOMEM);
749
750         retval = ovs_flow_cmd_fill_info(flow, dp, skb, portid, seq, 0, cmd);
751         BUG_ON(retval < 0);
752         return skb;
753 }
754
755 static struct sw_flow *__ovs_flow_tbl_lookup(struct flow_table *tbl,
756                                               const struct sw_flow_key *key)
757 {
758         u32 __always_unused n_mask_hit;
759
760         return ovs_flow_tbl_lookup(tbl, key, &n_mask_hit);
761 }
762
763 static int ovs_flow_cmd_new_or_set(struct sk_buff *skb, struct genl_info *info)
764 {
765         struct nlattr **a = info->attrs;
766         struct ovs_header *ovs_header = info->userhdr;
767         struct sw_flow_key key, masked_key;
768         struct sw_flow *flow = NULL;
769         struct sw_flow_mask mask;
770         struct sk_buff *reply;
771         struct datapath *dp;
772         struct sw_flow_actions *acts = NULL;
773         struct sw_flow_match match;
774         int error;
775
776         /* Extract key. */
777         error = -EINVAL;
778         if (!a[OVS_FLOW_ATTR_KEY])
779                 goto error;
780
781         ovs_match_init(&match, &key, &mask);
782         error = ovs_nla_get_match(&match,
783                                   a[OVS_FLOW_ATTR_KEY], a[OVS_FLOW_ATTR_MASK]);
784         if (error)
785                 goto error;
786
787         /* Validate actions. */
788         if (a[OVS_FLOW_ATTR_ACTIONS]) {
789                 acts = ovs_nla_alloc_flow_actions(nla_len(a[OVS_FLOW_ATTR_ACTIONS]));
790                 error = PTR_ERR(acts);
791                 if (IS_ERR(acts))
792                         goto error;
793
794                 ovs_flow_mask_key(&masked_key, &key, &mask);
795                 error = ovs_nla_copy_actions(a[OVS_FLOW_ATTR_ACTIONS],
796                                              &masked_key, 0, &acts);
797                 if (error) {
798                         OVS_NLERR("Flow actions may not be safe on all matching packets.\n");
799                         goto err_kfree;
800                 }
801         } else if (info->genlhdr->cmd == OVS_FLOW_CMD_NEW) {
802                 error = -EINVAL;
803                 goto error;
804         }
805
806         ovs_lock();
807         dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
808         error = -ENODEV;
809         if (!dp)
810                 goto err_unlock_ovs;
811
812         /* Check if this is a duplicate flow */
813         flow = __ovs_flow_tbl_lookup(&dp->table, &key);
814         if (!flow) {
815                 /* Bail out if we're not allowed to create a new flow. */
816                 error = -ENOENT;
817                 if (info->genlhdr->cmd == OVS_FLOW_CMD_SET)
818                         goto err_unlock_ovs;
819
820                 /* Allocate flow. */
821                 flow = ovs_flow_alloc();
822                 if (IS_ERR(flow)) {
823                         error = PTR_ERR(flow);
824                         goto err_unlock_ovs;
825                 }
826                 clear_stats(flow);
827
828                 flow->key = masked_key;
829                 flow->unmasked_key = key;
830                 rcu_assign_pointer(flow->sf_acts, acts);
831
832                 /* Put flow in bucket. */
833                 error = ovs_flow_tbl_insert(&dp->table, flow, &mask);
834                 if (error) {
835                         acts = NULL;
836                         goto err_flow_free;
837                 }
838
839                 reply = ovs_flow_cmd_build_info(flow, dp, info->snd_portid,
840                                                 info->snd_seq, OVS_FLOW_CMD_NEW);
841         } else {
842                 /* We found a matching flow. */
843                 struct sw_flow_actions *old_acts;
844
845                 /* Bail out if we're not allowed to modify an existing flow.
846                  * We accept NLM_F_CREATE in place of the intended NLM_F_EXCL
847                  * because Generic Netlink treats the latter as a dump
848                  * request.  We also accept NLM_F_EXCL in case that bug ever
849                  * gets fixed.
850                  */
851                 error = -EEXIST;
852                 if (info->genlhdr->cmd == OVS_FLOW_CMD_NEW &&
853                     info->nlhdr->nlmsg_flags & (NLM_F_CREATE | NLM_F_EXCL))
854                         goto err_unlock_ovs;
855
856                 /* The unmasked key has to be the same for flow updates. */
857                 error = -EINVAL;
858                 if (!ovs_flow_cmp_unmasked_key(flow, &match)) {
859                         OVS_NLERR("Flow modification message rejected, unmasked key does not match.\n");
860                         goto err_unlock_ovs;
861                 }
862
863                 /* Update actions. */
864                 old_acts = ovsl_dereference(flow->sf_acts);
865                 rcu_assign_pointer(flow->sf_acts, acts);
866                 ovs_nla_free_flow_actions(old_acts);
867
868                 reply = ovs_flow_cmd_build_info(flow, dp, info->snd_portid,
869                                                info->snd_seq, OVS_FLOW_CMD_NEW);
870
871                 /* Clear stats. */
872                 if (a[OVS_FLOW_ATTR_CLEAR]) {
873                         spin_lock_bh(&flow->lock);
874                         clear_stats(flow);
875                         spin_unlock_bh(&flow->lock);
876                 }
877         }
878         ovs_unlock();
879
880         if (!IS_ERR(reply))
881                 ovs_notify(&dp_flow_genl_family, reply, info,
882                            &ovs_dp_flow_multicast_group);
883         else
884                 genl_set_err(&dp_flow_genl_family, sock_net(skb->sk), 0,
885                              ovs_dp_flow_multicast_group.id, PTR_ERR(reply));
886         return 0;
887
888 err_flow_free:
889         ovs_flow_free(flow, false);
890 err_unlock_ovs:
891         ovs_unlock();
892 err_kfree:
893         kfree(acts);
894 error:
895         return error;
896 }
897
898 static int ovs_flow_cmd_get(struct sk_buff *skb, struct genl_info *info)
899 {
900         struct nlattr **a = info->attrs;
901         struct ovs_header *ovs_header = info->userhdr;
902         struct sw_flow_key key;
903         struct sk_buff *reply;
904         struct sw_flow *flow;
905         struct datapath *dp;
906         struct sw_flow_match match;
907         int err;
908
909         if (!a[OVS_FLOW_ATTR_KEY]) {
910                 OVS_NLERR("Flow get message rejected, Key attribute missing.\n");
911                 return -EINVAL;
912         }
913
914         ovs_match_init(&match, &key, NULL);
915         err = ovs_nla_get_match(&match, a[OVS_FLOW_ATTR_KEY], NULL);
916         if (err)
917                 return err;
918
919         ovs_lock();
920         dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
921         if (!dp) {
922                 err = -ENODEV;
923                 goto unlock;
924         }
925
926         flow = __ovs_flow_tbl_lookup(&dp->table, &key);
927         if (!flow || !ovs_flow_cmp_unmasked_key(flow, &match)) {
928                 err = -ENOENT;
929                 goto unlock;
930         }
931
932         reply = ovs_flow_cmd_build_info(flow, dp, info->snd_portid,
933                                         info->snd_seq, OVS_FLOW_CMD_NEW);
934         if (IS_ERR(reply)) {
935                 err = PTR_ERR(reply);
936                 goto unlock;
937         }
938
939         ovs_unlock();
940         return genlmsg_reply(reply, info);
941 unlock:
942         ovs_unlock();
943         return err;
944 }
945
946 static int ovs_flow_cmd_del(struct sk_buff *skb, struct genl_info *info)
947 {
948         struct nlattr **a = info->attrs;
949         struct ovs_header *ovs_header = info->userhdr;
950         struct sw_flow_key key;
951         struct sk_buff *reply;
952         struct sw_flow *flow;
953         struct datapath *dp;
954         struct sw_flow_match match;
955         int err;
956
957         ovs_lock();
958         dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
959         if (!dp) {
960                 err = -ENODEV;
961                 goto unlock;
962         }
963
964         if (!a[OVS_FLOW_ATTR_KEY]) {
965                 err = ovs_flow_tbl_flush(&dp->table);
966                 goto unlock;
967         }
968
969         ovs_match_init(&match, &key, NULL);
970         err = ovs_nla_get_match(&match, a[OVS_FLOW_ATTR_KEY], NULL);
971         if (err)
972                 goto unlock;
973
974         flow = __ovs_flow_tbl_lookup(&dp->table, &key);
975         if (!flow || !ovs_flow_cmp_unmasked_key(flow, &match)) {
976                 err = -ENOENT;
977                 goto unlock;
978         }
979
980         reply = ovs_flow_cmd_alloc_info(flow);
981         if (!reply) {
982                 err = -ENOMEM;
983                 goto unlock;
984         }
985
986         ovs_flow_tbl_remove(&dp->table, flow);
987
988         err = ovs_flow_cmd_fill_info(flow, dp, reply, info->snd_portid,
989                                      info->snd_seq, 0, OVS_FLOW_CMD_DEL);
990         BUG_ON(err < 0);
991
992         ovs_flow_free(flow, true);
993         ovs_unlock();
994
995         ovs_notify(&dp_flow_genl_family, reply, info,
996                    &ovs_dp_flow_multicast_group);
997         return 0;
998 unlock:
999         ovs_unlock();
1000         return err;
1001 }
1002
1003 static int ovs_flow_cmd_dump(struct sk_buff *skb, struct netlink_callback *cb)
1004 {
1005         struct ovs_header *ovs_header = genlmsg_data(nlmsg_data(cb->nlh));
1006         struct table_instance *ti;
1007         struct datapath *dp;
1008
1009         rcu_read_lock();
1010         dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
1011         if (!dp) {
1012                 rcu_read_unlock();
1013                 return -ENODEV;
1014         }
1015
1016         ti = rcu_dereference(dp->table.ti);
1017         for (;;) {
1018                 struct sw_flow *flow;
1019                 u32 bucket, obj;
1020
1021                 bucket = cb->args[0];
1022                 obj = cb->args[1];
1023                 flow = ovs_flow_tbl_dump_next(ti, &bucket, &obj);
1024                 if (!flow)
1025                         break;
1026
1027                 if (ovs_flow_cmd_fill_info(flow, dp, skb,
1028                                            NETLINK_CB(cb->skb).portid,
1029                                            cb->nlh->nlmsg_seq, NLM_F_MULTI,
1030                                            OVS_FLOW_CMD_NEW) < 0)
1031                         break;
1032
1033                 cb->args[0] = bucket;
1034                 cb->args[1] = obj;
1035         }
1036         rcu_read_unlock();
1037         return skb->len;
1038 }
1039
1040 static const struct genl_ops dp_flow_genl_ops[] = {
1041         { .cmd = OVS_FLOW_CMD_NEW,
1042           .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1043           .policy = flow_policy,
1044           .doit = ovs_flow_cmd_new_or_set
1045         },
1046         { .cmd = OVS_FLOW_CMD_DEL,
1047           .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1048           .policy = flow_policy,
1049           .doit = ovs_flow_cmd_del
1050         },
1051         { .cmd = OVS_FLOW_CMD_GET,
1052           .flags = 0,               /* OK for unprivileged users. */
1053           .policy = flow_policy,
1054           .doit = ovs_flow_cmd_get,
1055           .dumpit = ovs_flow_cmd_dump
1056         },
1057         { .cmd = OVS_FLOW_CMD_SET,
1058           .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1059           .policy = flow_policy,
1060           .doit = ovs_flow_cmd_new_or_set,
1061         },
1062 };
1063
1064 static const struct nla_policy datapath_policy[OVS_DP_ATTR_MAX + 1] = {
1065         [OVS_DP_ATTR_NAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ - 1 },
1066         [OVS_DP_ATTR_UPCALL_PID] = { .type = NLA_U32 },
1067 };
1068
1069 static struct genl_family dp_datapath_genl_family = {
1070         .id = GENL_ID_GENERATE,
1071         .hdrsize = sizeof(struct ovs_header),
1072         .name = OVS_DATAPATH_FAMILY,
1073         .version = OVS_DATAPATH_VERSION,
1074         .maxattr = OVS_DP_ATTR_MAX,
1075         .netnsok = true,
1076         .parallel_ops = true,
1077 };
1078
1079 static struct genl_multicast_group ovs_dp_datapath_multicast_group = {
1080         .name = OVS_DATAPATH_MCGROUP
1081 };
1082
1083 static size_t ovs_dp_cmd_msg_size(void)
1084 {
1085         size_t msgsize = NLMSG_ALIGN(sizeof(struct ovs_header));
1086
1087         msgsize += nla_total_size(IFNAMSIZ);
1088         msgsize += nla_total_size(sizeof(struct ovs_dp_stats));
1089         msgsize += nla_total_size(sizeof(struct ovs_dp_megaflow_stats));
1090
1091         return msgsize;
1092 }
1093
1094 static int ovs_dp_cmd_fill_info(struct datapath *dp, struct sk_buff *skb,
1095                                 u32 portid, u32 seq, u32 flags, u8 cmd)
1096 {
1097         struct ovs_header *ovs_header;
1098         struct ovs_dp_stats dp_stats;
1099         struct ovs_dp_megaflow_stats dp_megaflow_stats;
1100         int err;
1101
1102         ovs_header = genlmsg_put(skb, portid, seq, &dp_datapath_genl_family,
1103                                    flags, cmd);
1104         if (!ovs_header)
1105                 goto error;
1106
1107         ovs_header->dp_ifindex = get_dpifindex(dp);
1108
1109         rcu_read_lock();
1110         err = nla_put_string(skb, OVS_DP_ATTR_NAME, ovs_dp_name(dp));
1111         rcu_read_unlock();
1112         if (err)
1113                 goto nla_put_failure;
1114
1115         get_dp_stats(dp, &dp_stats, &dp_megaflow_stats);
1116         if (nla_put(skb, OVS_DP_ATTR_STATS, sizeof(struct ovs_dp_stats),
1117                         &dp_stats))
1118                 goto nla_put_failure;
1119
1120         if (nla_put(skb, OVS_DP_ATTR_MEGAFLOW_STATS,
1121                         sizeof(struct ovs_dp_megaflow_stats),
1122                         &dp_megaflow_stats))
1123                 goto nla_put_failure;
1124
1125         return genlmsg_end(skb, ovs_header);
1126
1127 nla_put_failure:
1128         genlmsg_cancel(skb, ovs_header);
1129 error:
1130         return -EMSGSIZE;
1131 }
1132
1133 static struct sk_buff *ovs_dp_cmd_build_info(struct datapath *dp, u32 portid,
1134                                              u32 seq, u8 cmd)
1135 {
1136         struct sk_buff *skb;
1137         int retval;
1138
1139         skb = genlmsg_new(ovs_dp_cmd_msg_size(), GFP_KERNEL);
1140         if (!skb)
1141                 return ERR_PTR(-ENOMEM);
1142
1143         retval = ovs_dp_cmd_fill_info(dp, skb, portid, seq, 0, cmd);
1144         if (retval < 0) {
1145                 kfree_skb(skb);
1146                 return ERR_PTR(retval);
1147         }
1148         return skb;
1149 }
1150
1151 /* Called with ovs_mutex. */
1152 static struct datapath *lookup_datapath(struct net *net,
1153                                         struct ovs_header *ovs_header,
1154                                         struct nlattr *a[OVS_DP_ATTR_MAX + 1])
1155 {
1156         struct datapath *dp;
1157
1158         if (!a[OVS_DP_ATTR_NAME])
1159                 dp = get_dp(net, ovs_header->dp_ifindex);
1160         else {
1161                 struct vport *vport;
1162
1163                 rcu_read_lock();
1164                 vport = ovs_vport_locate(net, nla_data(a[OVS_DP_ATTR_NAME]));
1165                 dp = vport && vport->port_no == OVSP_LOCAL ? vport->dp : NULL;
1166                 rcu_read_unlock();
1167         }
1168         return dp ? dp : ERR_PTR(-ENODEV);
1169 }
1170
1171 static int ovs_dp_cmd_new(struct sk_buff *skb, struct genl_info *info)
1172 {
1173         struct nlattr **a = info->attrs;
1174         struct vport_parms parms;
1175         struct sk_buff *reply;
1176         struct datapath *dp;
1177         struct vport *vport;
1178         struct ovs_net *ovs_net;
1179         int err, i;
1180
1181         err = -EINVAL;
1182         if (!a[OVS_DP_ATTR_NAME] || !a[OVS_DP_ATTR_UPCALL_PID])
1183                 goto err;
1184
1185         ovs_lock();
1186
1187         err = -ENOMEM;
1188         dp = kzalloc(sizeof(*dp), GFP_KERNEL);
1189         if (dp == NULL)
1190                 goto err_unlock_ovs;
1191
1192         ovs_dp_set_net(dp, hold_net(sock_net(skb->sk)));
1193
1194         /* Allocate table. */
1195         err = ovs_flow_tbl_init(&dp->table);
1196         if (err)
1197                 goto err_free_dp;
1198
1199         dp->stats_percpu = alloc_percpu(struct dp_stats_percpu);
1200         if (!dp->stats_percpu) {
1201                 err = -ENOMEM;
1202                 goto err_destroy_table;
1203         }
1204
1205         dp->ports = kmalloc(DP_VPORT_HASH_BUCKETS * sizeof(struct hlist_head),
1206                             GFP_KERNEL);
1207         if (!dp->ports) {
1208                 err = -ENOMEM;
1209                 goto err_destroy_percpu;
1210         }
1211
1212         for (i = 0; i < DP_VPORT_HASH_BUCKETS; i++)
1213                 INIT_HLIST_HEAD(&dp->ports[i]);
1214
1215         /* Set up our datapath device. */
1216         parms.name = nla_data(a[OVS_DP_ATTR_NAME]);
1217         parms.type = OVS_VPORT_TYPE_INTERNAL;
1218         parms.options = NULL;
1219         parms.dp = dp;
1220         parms.port_no = OVSP_LOCAL;
1221         parms.upcall_portid = nla_get_u32(a[OVS_DP_ATTR_UPCALL_PID]);
1222
1223         vport = new_vport(&parms);
1224         if (IS_ERR(vport)) {
1225                 err = PTR_ERR(vport);
1226                 if (err == -EBUSY)
1227                         err = -EEXIST;
1228
1229                 goto err_destroy_ports_array;
1230         }
1231
1232         reply = ovs_dp_cmd_build_info(dp, info->snd_portid,
1233                                       info->snd_seq, OVS_DP_CMD_NEW);
1234         err = PTR_ERR(reply);
1235         if (IS_ERR(reply))
1236                 goto err_destroy_local_port;
1237
1238         ovs_net = net_generic(ovs_dp_get_net(dp), ovs_net_id);
1239         list_add_tail_rcu(&dp->list_node, &ovs_net->dps);
1240
1241         ovs_unlock();
1242
1243         ovs_notify(&dp_datapath_genl_family, reply, info,
1244                    &ovs_dp_datapath_multicast_group);
1245         return 0;
1246
1247 err_destroy_local_port:
1248         ovs_dp_detach_port(ovs_vport_ovsl(dp, OVSP_LOCAL));
1249 err_destroy_ports_array:
1250         kfree(dp->ports);
1251 err_destroy_percpu:
1252         free_percpu(dp->stats_percpu);
1253 err_destroy_table:
1254         ovs_flow_tbl_destroy(&dp->table);
1255 err_free_dp:
1256         release_net(ovs_dp_get_net(dp));
1257         kfree(dp);
1258 err_unlock_ovs:
1259         ovs_unlock();
1260 err:
1261         return err;
1262 }
1263
1264 /* Called with ovs_mutex. */
1265 static void __dp_destroy(struct datapath *dp)
1266 {
1267         int i;
1268
1269         for (i = 0; i < DP_VPORT_HASH_BUCKETS; i++) {
1270                 struct vport *vport;
1271                 struct hlist_node *n;
1272
1273                 hlist_for_each_entry_safe(vport, n, &dp->ports[i], dp_hash_node)
1274                         if (vport->port_no != OVSP_LOCAL)
1275                                 ovs_dp_detach_port(vport);
1276         }
1277
1278         list_del_rcu(&dp->list_node);
1279
1280         /* OVSP_LOCAL is datapath internal port. We need to make sure that
1281          * all port in datapath are destroyed first before freeing datapath.
1282          */
1283         ovs_dp_detach_port(ovs_vport_ovsl(dp, OVSP_LOCAL));
1284
1285         call_rcu(&dp->rcu, destroy_dp_rcu);
1286 }
1287
1288 static int ovs_dp_cmd_del(struct sk_buff *skb, struct genl_info *info)
1289 {
1290         struct sk_buff *reply;
1291         struct datapath *dp;
1292         int err;
1293
1294         ovs_lock();
1295         dp = lookup_datapath(sock_net(skb->sk), info->userhdr, info->attrs);
1296         err = PTR_ERR(dp);
1297         if (IS_ERR(dp))
1298                 goto unlock;
1299
1300         reply = ovs_dp_cmd_build_info(dp, info->snd_portid,
1301                                       info->snd_seq, OVS_DP_CMD_DEL);
1302         err = PTR_ERR(reply);
1303         if (IS_ERR(reply))
1304                 goto unlock;
1305
1306         __dp_destroy(dp);
1307         ovs_unlock();
1308
1309         ovs_notify(&dp_datapath_genl_family, reply, info,
1310                    &ovs_dp_datapath_multicast_group);
1311
1312         return 0;
1313 unlock:
1314         ovs_unlock();
1315         return err;
1316 }
1317
1318 static int ovs_dp_cmd_set(struct sk_buff *skb, struct genl_info *info)
1319 {
1320         struct sk_buff *reply;
1321         struct datapath *dp;
1322         int err;
1323
1324         ovs_lock();
1325         dp = lookup_datapath(sock_net(skb->sk), info->userhdr, info->attrs);
1326         err = PTR_ERR(dp);
1327         if (IS_ERR(dp))
1328                 goto unlock;
1329
1330         reply = ovs_dp_cmd_build_info(dp, info->snd_portid,
1331                                       info->snd_seq, OVS_DP_CMD_NEW);
1332         if (IS_ERR(reply)) {
1333                 err = PTR_ERR(reply);
1334                 genl_set_err(&dp_datapath_genl_family, sock_net(skb->sk), 0,
1335                              ovs_dp_datapath_multicast_group.id, err);
1336                 err = 0;
1337                 goto unlock;
1338         }
1339
1340         ovs_unlock();
1341         ovs_notify(&dp_datapath_genl_family, reply, info,
1342                    &ovs_dp_datapath_multicast_group);
1343
1344         return 0;
1345 unlock:
1346         ovs_unlock();
1347         return err;
1348 }
1349
1350 static int ovs_dp_cmd_get(struct sk_buff *skb, struct genl_info *info)
1351 {
1352         struct sk_buff *reply;
1353         struct datapath *dp;
1354         int err;
1355
1356         ovs_lock();
1357         dp = lookup_datapath(sock_net(skb->sk), info->userhdr, info->attrs);
1358         if (IS_ERR(dp)) {
1359                 err = PTR_ERR(dp);
1360                 goto unlock;
1361         }
1362
1363         reply = ovs_dp_cmd_build_info(dp, info->snd_portid,
1364                                       info->snd_seq, OVS_DP_CMD_NEW);
1365         if (IS_ERR(reply)) {
1366                 err = PTR_ERR(reply);
1367                 goto unlock;
1368         }
1369
1370         ovs_unlock();
1371         return genlmsg_reply(reply, info);
1372
1373 unlock:
1374         ovs_unlock();
1375         return err;
1376 }
1377
1378 static int ovs_dp_cmd_dump(struct sk_buff *skb, struct netlink_callback *cb)
1379 {
1380         struct ovs_net *ovs_net = net_generic(sock_net(skb->sk), ovs_net_id);
1381         struct datapath *dp;
1382         int skip = cb->args[0];
1383         int i = 0;
1384
1385         rcu_read_lock();
1386         list_for_each_entry_rcu(dp, &ovs_net->dps, list_node) {
1387                 if (i >= skip &&
1388                     ovs_dp_cmd_fill_info(dp, skb, NETLINK_CB(cb->skb).portid,
1389                                          cb->nlh->nlmsg_seq, NLM_F_MULTI,
1390                                          OVS_DP_CMD_NEW) < 0)
1391                         break;
1392                 i++;
1393         }
1394         rcu_read_unlock();
1395
1396         cb->args[0] = i;
1397
1398         return skb->len;
1399 }
1400
1401 static const struct genl_ops dp_datapath_genl_ops[] = {
1402         { .cmd = OVS_DP_CMD_NEW,
1403           .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1404           .policy = datapath_policy,
1405           .doit = ovs_dp_cmd_new
1406         },
1407         { .cmd = OVS_DP_CMD_DEL,
1408           .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1409           .policy = datapath_policy,
1410           .doit = ovs_dp_cmd_del
1411         },
1412         { .cmd = OVS_DP_CMD_GET,
1413           .flags = 0,               /* OK for unprivileged users. */
1414           .policy = datapath_policy,
1415           .doit = ovs_dp_cmd_get,
1416           .dumpit = ovs_dp_cmd_dump
1417         },
1418         { .cmd = OVS_DP_CMD_SET,
1419           .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1420           .policy = datapath_policy,
1421           .doit = ovs_dp_cmd_set,
1422         },
1423 };
1424
1425 static const struct nla_policy vport_policy[OVS_VPORT_ATTR_MAX + 1] = {
1426         [OVS_VPORT_ATTR_NAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ - 1 },
1427         [OVS_VPORT_ATTR_STATS] = { .len = sizeof(struct ovs_vport_stats) },
1428         [OVS_VPORT_ATTR_PORT_NO] = { .type = NLA_U32 },
1429         [OVS_VPORT_ATTR_TYPE] = { .type = NLA_U32 },
1430         [OVS_VPORT_ATTR_UPCALL_PID] = { .type = NLA_U32 },
1431         [OVS_VPORT_ATTR_OPTIONS] = { .type = NLA_NESTED },
1432 };
1433
1434 struct genl_family dp_vport_genl_family = {
1435         .id = GENL_ID_GENERATE,
1436         .hdrsize = sizeof(struct ovs_header),
1437         .name = OVS_VPORT_FAMILY,
1438         .version = OVS_VPORT_VERSION,
1439         .maxattr = OVS_VPORT_ATTR_MAX,
1440         .netnsok = true,
1441         .parallel_ops = true,
1442 };
1443
1444 struct genl_multicast_group ovs_dp_vport_multicast_group = {
1445         .name = OVS_VPORT_MCGROUP
1446 };
1447
1448 /* Called with ovs_mutex or RCU read lock. */
1449 static int ovs_vport_cmd_fill_info(struct vport *vport, struct sk_buff *skb,
1450                                    u32 portid, u32 seq, u32 flags, u8 cmd)
1451 {
1452         struct ovs_header *ovs_header;
1453         struct ovs_vport_stats vport_stats;
1454         int err;
1455
1456         ovs_header = genlmsg_put(skb, portid, seq, &dp_vport_genl_family,
1457                                  flags, cmd);
1458         if (!ovs_header)
1459                 return -EMSGSIZE;
1460
1461         ovs_header->dp_ifindex = get_dpifindex(vport->dp);
1462
1463         if (nla_put_u32(skb, OVS_VPORT_ATTR_PORT_NO, vport->port_no) ||
1464             nla_put_u32(skb, OVS_VPORT_ATTR_TYPE, vport->ops->type) ||
1465             nla_put_string(skb, OVS_VPORT_ATTR_NAME, vport->ops->get_name(vport)) ||
1466             nla_put_u32(skb, OVS_VPORT_ATTR_UPCALL_PID, vport->upcall_portid))
1467                 goto nla_put_failure;
1468
1469         ovs_vport_get_stats(vport, &vport_stats);
1470         if (nla_put(skb, OVS_VPORT_ATTR_STATS, sizeof(struct ovs_vport_stats),
1471                     &vport_stats))
1472                 goto nla_put_failure;
1473
1474         err = ovs_vport_get_options(vport, skb);
1475         if (err == -EMSGSIZE)
1476                 goto error;
1477
1478         return genlmsg_end(skb, ovs_header);
1479
1480 nla_put_failure:
1481         err = -EMSGSIZE;
1482 error:
1483         genlmsg_cancel(skb, ovs_header);
1484         return err;
1485 }
1486
1487 /* Called with ovs_mutex or RCU read lock. */
1488 struct sk_buff *ovs_vport_cmd_build_info(struct vport *vport, u32 portid,
1489                                          u32 seq, u8 cmd)
1490 {
1491         struct sk_buff *skb;
1492         int retval;
1493
1494         skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
1495         if (!skb)
1496                 return ERR_PTR(-ENOMEM);
1497
1498         retval = ovs_vport_cmd_fill_info(vport, skb, portid, seq, 0, cmd);
1499         BUG_ON(retval < 0);
1500
1501         return skb;
1502 }
1503
1504 /* Called with ovs_mutex or RCU read lock. */
1505 static struct vport *lookup_vport(struct net *net,
1506                                   struct ovs_header *ovs_header,
1507                                   struct nlattr *a[OVS_VPORT_ATTR_MAX + 1])
1508 {
1509         struct datapath *dp;
1510         struct vport *vport;
1511
1512         if (a[OVS_VPORT_ATTR_NAME]) {
1513                 vport = ovs_vport_locate(net, nla_data(a[OVS_VPORT_ATTR_NAME]));
1514                 if (!vport)
1515                         return ERR_PTR(-ENODEV);
1516                 if (ovs_header->dp_ifindex &&
1517                     ovs_header->dp_ifindex != get_dpifindex(vport->dp))
1518                         return ERR_PTR(-ENODEV);
1519                 return vport;
1520         } else if (a[OVS_VPORT_ATTR_PORT_NO]) {
1521                 u32 port_no = nla_get_u32(a[OVS_VPORT_ATTR_PORT_NO]);
1522
1523                 if (port_no >= DP_MAX_PORTS)
1524                         return ERR_PTR(-EFBIG);
1525
1526                 dp = get_dp(net, ovs_header->dp_ifindex);
1527                 if (!dp)
1528                         return ERR_PTR(-ENODEV);
1529
1530                 vport = ovs_vport_ovsl_rcu(dp, port_no);
1531                 if (!vport)
1532                         return ERR_PTR(-ENODEV);
1533                 return vport;
1534         } else
1535                 return ERR_PTR(-EINVAL);
1536 }
1537
1538 static int ovs_vport_cmd_new(struct sk_buff *skb, struct genl_info *info)
1539 {
1540         struct nlattr **a = info->attrs;
1541         struct ovs_header *ovs_header = info->userhdr;
1542         struct vport_parms parms;
1543         struct sk_buff *reply;
1544         struct vport *vport;
1545         struct datapath *dp;
1546         u32 port_no;
1547         int err;
1548
1549         err = -EINVAL;
1550         if (!a[OVS_VPORT_ATTR_NAME] || !a[OVS_VPORT_ATTR_TYPE] ||
1551             !a[OVS_VPORT_ATTR_UPCALL_PID])
1552                 goto exit;
1553
1554         ovs_lock();
1555         dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
1556         err = -ENODEV;
1557         if (!dp)
1558                 goto exit_unlock;
1559
1560         if (a[OVS_VPORT_ATTR_PORT_NO]) {
1561                 port_no = nla_get_u32(a[OVS_VPORT_ATTR_PORT_NO]);
1562
1563                 err = -EFBIG;
1564                 if (port_no >= DP_MAX_PORTS)
1565                         goto exit_unlock;
1566
1567                 vport = ovs_vport_ovsl(dp, port_no);
1568                 err = -EBUSY;
1569                 if (vport)
1570                         goto exit_unlock;
1571         } else {
1572                 for (port_no = 1; ; port_no++) {
1573                         if (port_no >= DP_MAX_PORTS) {
1574                                 err = -EFBIG;
1575                                 goto exit_unlock;
1576                         }
1577                         vport = ovs_vport_ovsl(dp, port_no);
1578                         if (!vport)
1579                                 break;
1580                 }
1581         }
1582
1583         parms.name = nla_data(a[OVS_VPORT_ATTR_NAME]);
1584         parms.type = nla_get_u32(a[OVS_VPORT_ATTR_TYPE]);
1585         parms.options = a[OVS_VPORT_ATTR_OPTIONS];
1586         parms.dp = dp;
1587         parms.port_no = port_no;
1588         parms.upcall_portid = nla_get_u32(a[OVS_VPORT_ATTR_UPCALL_PID]);
1589
1590         vport = new_vport(&parms);
1591         err = PTR_ERR(vport);
1592         if (IS_ERR(vport))
1593                 goto exit_unlock;
1594
1595         err = 0;
1596         reply = ovs_vport_cmd_build_info(vport, info->snd_portid, info->snd_seq,
1597                                          OVS_VPORT_CMD_NEW);
1598         if (IS_ERR(reply)) {
1599                 err = PTR_ERR(reply);
1600                 ovs_dp_detach_port(vport);
1601                 goto exit_unlock;
1602         }
1603
1604         ovs_notify(&dp_vport_genl_family, reply, info,
1605                    &ovs_dp_vport_multicast_group);
1606
1607 exit_unlock:
1608         ovs_unlock();
1609 exit:
1610         return err;
1611 }
1612
1613 static int ovs_vport_cmd_set(struct sk_buff *skb, struct genl_info *info)
1614 {
1615         struct nlattr **a = info->attrs;
1616         struct sk_buff *reply;
1617         struct vport *vport;
1618         int err;
1619
1620         ovs_lock();
1621         vport = lookup_vport(sock_net(skb->sk), info->userhdr, a);
1622         err = PTR_ERR(vport);
1623         if (IS_ERR(vport))
1624                 goto exit_unlock;
1625
1626         if (a[OVS_VPORT_ATTR_TYPE] &&
1627             nla_get_u32(a[OVS_VPORT_ATTR_TYPE]) != vport->ops->type) {
1628                 err = -EINVAL;
1629                 goto exit_unlock;
1630         }
1631
1632         reply = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1633         if (!reply) {
1634                 err = -ENOMEM;
1635                 goto exit_unlock;
1636         }
1637
1638         if (a[OVS_VPORT_ATTR_OPTIONS]) {
1639                 err = ovs_vport_set_options(vport, a[OVS_VPORT_ATTR_OPTIONS]);
1640                 if (err)
1641                         goto exit_free;
1642         }
1643
1644         if (a[OVS_VPORT_ATTR_UPCALL_PID])
1645                 vport->upcall_portid = nla_get_u32(a[OVS_VPORT_ATTR_UPCALL_PID]);
1646
1647         err = ovs_vport_cmd_fill_info(vport, reply, info->snd_portid,
1648                                       info->snd_seq, 0, OVS_VPORT_CMD_NEW);
1649         BUG_ON(err < 0);
1650
1651         ovs_unlock();
1652         ovs_notify(&dp_vport_genl_family, reply, info,
1653                    &ovs_dp_vport_multicast_group);
1654         return 0;
1655
1656 exit_free:
1657         kfree_skb(reply);
1658 exit_unlock:
1659         ovs_unlock();
1660         return err;
1661 }
1662
1663 static int ovs_vport_cmd_del(struct sk_buff *skb, struct genl_info *info)
1664 {
1665         struct nlattr **a = info->attrs;
1666         struct sk_buff *reply;
1667         struct vport *vport;
1668         int err;
1669
1670         ovs_lock();
1671         vport = lookup_vport(sock_net(skb->sk), info->userhdr, a);
1672         err = PTR_ERR(vport);
1673         if (IS_ERR(vport))
1674                 goto exit_unlock;
1675
1676         if (vport->port_no == OVSP_LOCAL) {
1677                 err = -EINVAL;
1678                 goto exit_unlock;
1679         }
1680
1681         reply = ovs_vport_cmd_build_info(vport, info->snd_portid,
1682                                          info->snd_seq, OVS_VPORT_CMD_DEL);
1683         err = PTR_ERR(reply);
1684         if (IS_ERR(reply))
1685                 goto exit_unlock;
1686
1687         err = 0;
1688         ovs_dp_detach_port(vport);
1689
1690         ovs_notify(&dp_vport_genl_family, reply, info,
1691                    &ovs_dp_vport_multicast_group);
1692
1693 exit_unlock:
1694         ovs_unlock();
1695         return err;
1696 }
1697
1698 static int ovs_vport_cmd_get(struct sk_buff *skb, struct genl_info *info)
1699 {
1700         struct nlattr **a = info->attrs;
1701         struct ovs_header *ovs_header = info->userhdr;
1702         struct sk_buff *reply;
1703         struct vport *vport;
1704         int err;
1705
1706         rcu_read_lock();
1707         vport = lookup_vport(sock_net(skb->sk), ovs_header, a);
1708         err = PTR_ERR(vport);
1709         if (IS_ERR(vport))
1710                 goto exit_unlock;
1711
1712         reply = ovs_vport_cmd_build_info(vport, info->snd_portid,
1713                                          info->snd_seq, OVS_VPORT_CMD_NEW);
1714         err = PTR_ERR(reply);
1715         if (IS_ERR(reply))
1716                 goto exit_unlock;
1717
1718         rcu_read_unlock();
1719
1720         return genlmsg_reply(reply, info);
1721
1722 exit_unlock:
1723         rcu_read_unlock();
1724         return err;
1725 }
1726
1727 static int ovs_vport_cmd_dump(struct sk_buff *skb, struct netlink_callback *cb)
1728 {
1729         struct ovs_header *ovs_header = genlmsg_data(nlmsg_data(cb->nlh));
1730         struct datapath *dp;
1731         int bucket = cb->args[0], skip = cb->args[1];
1732         int i, j = 0;
1733
1734         dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
1735         if (!dp)
1736                 return -ENODEV;
1737
1738         rcu_read_lock();
1739         for (i = bucket; i < DP_VPORT_HASH_BUCKETS; i++) {
1740                 struct vport *vport;
1741
1742                 j = 0;
1743                 hlist_for_each_entry_rcu(vport, &dp->ports[i], dp_hash_node) {
1744                         if (j >= skip &&
1745                             ovs_vport_cmd_fill_info(vport, skb,
1746                                                     NETLINK_CB(cb->skb).portid,
1747                                                     cb->nlh->nlmsg_seq,
1748                                                     NLM_F_MULTI,
1749                                                     OVS_VPORT_CMD_NEW) < 0)
1750                                 goto out;
1751
1752                         j++;
1753                 }
1754                 skip = 0;
1755         }
1756 out:
1757         rcu_read_unlock();
1758
1759         cb->args[0] = i;
1760         cb->args[1] = j;
1761
1762         return skb->len;
1763 }
1764
1765 static const struct genl_ops dp_vport_genl_ops[] = {
1766         { .cmd = OVS_VPORT_CMD_NEW,
1767           .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1768           .policy = vport_policy,
1769           .doit = ovs_vport_cmd_new
1770         },
1771         { .cmd = OVS_VPORT_CMD_DEL,
1772           .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1773           .policy = vport_policy,
1774           .doit = ovs_vport_cmd_del
1775         },
1776         { .cmd = OVS_VPORT_CMD_GET,
1777           .flags = 0,               /* OK for unprivileged users. */
1778           .policy = vport_policy,
1779           .doit = ovs_vport_cmd_get,
1780           .dumpit = ovs_vport_cmd_dump
1781         },
1782         { .cmd = OVS_VPORT_CMD_SET,
1783           .flags = GENL_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1784           .policy = vport_policy,
1785           .doit = ovs_vport_cmd_set,
1786         },
1787 };
1788
1789 struct genl_family_and_ops {
1790         struct genl_family *family;
1791         const struct genl_ops *ops;
1792         int n_ops;
1793         struct genl_multicast_group *group;
1794 };
1795
1796 static const struct genl_family_and_ops dp_genl_families[] = {
1797         { &dp_datapath_genl_family,
1798           dp_datapath_genl_ops, ARRAY_SIZE(dp_datapath_genl_ops),
1799           &ovs_dp_datapath_multicast_group },
1800         { &dp_vport_genl_family,
1801           dp_vport_genl_ops, ARRAY_SIZE(dp_vport_genl_ops),
1802           &ovs_dp_vport_multicast_group },
1803         { &dp_flow_genl_family,
1804           dp_flow_genl_ops, ARRAY_SIZE(dp_flow_genl_ops),
1805           &ovs_dp_flow_multicast_group },
1806         { &dp_packet_genl_family,
1807           dp_packet_genl_ops, ARRAY_SIZE(dp_packet_genl_ops),
1808           NULL },
1809 };
1810
1811 static void dp_unregister_genl(int n_families)
1812 {
1813         int i;
1814
1815         for (i = 0; i < n_families; i++)
1816                 genl_unregister_family(dp_genl_families[i].family);
1817 }
1818
1819 static int dp_register_genl(void)
1820 {
1821         int n_registered;
1822         int err;
1823         int i;
1824
1825         n_registered = 0;
1826         for (i = 0; i < ARRAY_SIZE(dp_genl_families); i++) {
1827                 const struct genl_family_and_ops *f = &dp_genl_families[i];
1828
1829                 f->family->ops = f->ops;
1830                 f->family->n_ops = f->n_ops;
1831                 err = genl_register_family(f->family);
1832                 if (err)
1833                         goto error;
1834                 n_registered++;
1835
1836                 if (f->group) {
1837                         err = genl_register_mc_group(f->family, f->group);
1838                         if (err)
1839                                 goto error;
1840                 }
1841         }
1842
1843         return 0;
1844
1845 error:
1846         dp_unregister_genl(n_registered);
1847         return err;
1848 }
1849
1850 static int __net_init ovs_init_net(struct net *net)
1851 {
1852         struct ovs_net *ovs_net = net_generic(net, ovs_net_id);
1853
1854         INIT_LIST_HEAD(&ovs_net->dps);
1855         INIT_WORK(&ovs_net->dp_notify_work, ovs_dp_notify_wq);
1856         return 0;
1857 }
1858
1859 static void __net_exit ovs_exit_net(struct net *net)
1860 {
1861         struct datapath *dp, *dp_next;
1862         struct ovs_net *ovs_net = net_generic(net, ovs_net_id);
1863
1864         ovs_lock();
1865         list_for_each_entry_safe(dp, dp_next, &ovs_net->dps, list_node)
1866                 __dp_destroy(dp);
1867         ovs_unlock();
1868
1869         cancel_work_sync(&ovs_net->dp_notify_work);
1870 }
1871
1872 static struct pernet_operations ovs_net_ops = {
1873         .init = ovs_init_net,
1874         .exit = ovs_exit_net,
1875         .id   = &ovs_net_id,
1876         .size = sizeof(struct ovs_net),
1877 };
1878
1879 static int __init dp_init(void)
1880 {
1881         int err;
1882
1883         BUILD_BUG_ON(sizeof(struct ovs_skb_cb) > FIELD_SIZEOF(struct sk_buff, cb));
1884
1885         pr_info("Open vSwitch switching datapath\n");
1886
1887         err = ovs_flow_init();
1888         if (err)
1889                 goto error;
1890
1891         err = ovs_vport_init();
1892         if (err)
1893                 goto error_flow_exit;
1894
1895         err = register_pernet_device(&ovs_net_ops);
1896         if (err)
1897                 goto error_vport_exit;
1898
1899         err = register_netdevice_notifier(&ovs_dp_device_notifier);
1900         if (err)
1901                 goto error_netns_exit;
1902
1903         err = dp_register_genl();
1904         if (err < 0)
1905                 goto error_unreg_notifier;
1906
1907         return 0;
1908
1909 error_unreg_notifier:
1910         unregister_netdevice_notifier(&ovs_dp_device_notifier);
1911 error_netns_exit:
1912         unregister_pernet_device(&ovs_net_ops);
1913 error_vport_exit:
1914         ovs_vport_exit();
1915 error_flow_exit:
1916         ovs_flow_exit();
1917 error:
1918         return err;
1919 }
1920
1921 static void dp_cleanup(void)
1922 {
1923         dp_unregister_genl(ARRAY_SIZE(dp_genl_families));
1924         unregister_netdevice_notifier(&ovs_dp_device_notifier);
1925         unregister_pernet_device(&ovs_net_ops);
1926         rcu_barrier();
1927         ovs_vport_exit();
1928         ovs_flow_exit();
1929 }
1930
1931 module_init(dp_init);
1932 module_exit(dp_cleanup);
1933
1934 MODULE_DESCRIPTION("Open vSwitch switching datapath");
1935 MODULE_LICENSE("GPL");