ARM: dts: vf610-zii-scu4-aib: Configure IRQ line for GPIO expander
[sfrench/cifs-2.6.git] / net / openvswitch / datapath.c
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright (c) 2007-2014 Nicira, Inc.
4  */
5
6 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
7
8 #include <linux/init.h>
9 #include <linux/module.h>
10 #include <linux/if_arp.h>
11 #include <linux/if_vlan.h>
12 #include <linux/in.h>
13 #include <linux/ip.h>
14 #include <linux/jhash.h>
15 #include <linux/delay.h>
16 #include <linux/time.h>
17 #include <linux/etherdevice.h>
18 #include <linux/genetlink.h>
19 #include <linux/kernel.h>
20 #include <linux/kthread.h>
21 #include <linux/mutex.h>
22 #include <linux/percpu.h>
23 #include <linux/rcupdate.h>
24 #include <linux/tcp.h>
25 #include <linux/udp.h>
26 #include <linux/ethtool.h>
27 #include <linux/wait.h>
28 #include <asm/div64.h>
29 #include <linux/highmem.h>
30 #include <linux/netfilter_bridge.h>
31 #include <linux/netfilter_ipv4.h>
32 #include <linux/inetdevice.h>
33 #include <linux/list.h>
34 #include <linux/openvswitch.h>
35 #include <linux/rculist.h>
36 #include <linux/dmi.h>
37 #include <net/genetlink.h>
38 #include <net/net_namespace.h>
39 #include <net/netns/generic.h>
40
41 #include "datapath.h"
42 #include "flow.h"
43 #include "flow_table.h"
44 #include "flow_netlink.h"
45 #include "meter.h"
46 #include "vport-internal_dev.h"
47 #include "vport-netdev.h"
48
49 unsigned int ovs_net_id __read_mostly;
50
51 static struct genl_family dp_packet_genl_family;
52 static struct genl_family dp_flow_genl_family;
53 static struct genl_family dp_datapath_genl_family;
54
55 static const struct nla_policy flow_policy[];
56
57 static const struct genl_multicast_group ovs_dp_flow_multicast_group = {
58         .name = OVS_FLOW_MCGROUP,
59 };
60
61 static const struct genl_multicast_group ovs_dp_datapath_multicast_group = {
62         .name = OVS_DATAPATH_MCGROUP,
63 };
64
65 static const struct genl_multicast_group ovs_dp_vport_multicast_group = {
66         .name = OVS_VPORT_MCGROUP,
67 };
68
69 /* Check if need to build a reply message.
70  * OVS userspace sets the NLM_F_ECHO flag if it needs the reply. */
71 static bool ovs_must_notify(struct genl_family *family, struct genl_info *info,
72                             unsigned int group)
73 {
74         return info->nlhdr->nlmsg_flags & NLM_F_ECHO ||
75                genl_has_listeners(family, genl_info_net(info), group);
76 }
77
78 static void ovs_notify(struct genl_family *family,
79                        struct sk_buff *skb, struct genl_info *info)
80 {
81         genl_notify(family, skb, info, 0, GFP_KERNEL);
82 }
83
84 /**
85  * DOC: Locking:
86  *
87  * All writes e.g. Writes to device state (add/remove datapath, port, set
88  * operations on vports, etc.), Writes to other state (flow table
89  * modifications, set miscellaneous datapath parameters, etc.) are protected
90  * by ovs_lock.
91  *
92  * Reads are protected by RCU.
93  *
94  * There are a few special cases (mostly stats) that have their own
95  * synchronization but they nest under all of above and don't interact with
96  * each other.
97  *
98  * The RTNL lock nests inside ovs_mutex.
99  */
100
101 static DEFINE_MUTEX(ovs_mutex);
102
103 void ovs_lock(void)
104 {
105         mutex_lock(&ovs_mutex);
106 }
107
108 void ovs_unlock(void)
109 {
110         mutex_unlock(&ovs_mutex);
111 }
112
113 #ifdef CONFIG_LOCKDEP
114 int lockdep_ovsl_is_held(void)
115 {
116         if (debug_locks)
117                 return lockdep_is_held(&ovs_mutex);
118         else
119                 return 1;
120 }
121 #endif
122
123 static struct vport *new_vport(const struct vport_parms *);
124 static int queue_gso_packets(struct datapath *dp, struct sk_buff *,
125                              const struct sw_flow_key *,
126                              const struct dp_upcall_info *,
127                              uint32_t cutlen);
128 static int queue_userspace_packet(struct datapath *dp, struct sk_buff *,
129                                   const struct sw_flow_key *,
130                                   const struct dp_upcall_info *,
131                                   uint32_t cutlen);
132
133 /* Must be called with rcu_read_lock or ovs_mutex. */
134 const char *ovs_dp_name(const struct datapath *dp)
135 {
136         struct vport *vport = ovs_vport_ovsl_rcu(dp, OVSP_LOCAL);
137         return ovs_vport_name(vport);
138 }
139
140 static int get_dpifindex(const struct datapath *dp)
141 {
142         struct vport *local;
143         int ifindex;
144
145         rcu_read_lock();
146
147         local = ovs_vport_rcu(dp, OVSP_LOCAL);
148         if (local)
149                 ifindex = local->dev->ifindex;
150         else
151                 ifindex = 0;
152
153         rcu_read_unlock();
154
155         return ifindex;
156 }
157
158 static void destroy_dp_rcu(struct rcu_head *rcu)
159 {
160         struct datapath *dp = container_of(rcu, struct datapath, rcu);
161
162         ovs_flow_tbl_destroy(&dp->table);
163         free_percpu(dp->stats_percpu);
164         kfree(dp->ports);
165         ovs_meters_exit(dp);
166         kfree(dp);
167 }
168
169 static struct hlist_head *vport_hash_bucket(const struct datapath *dp,
170                                             u16 port_no)
171 {
172         return &dp->ports[port_no & (DP_VPORT_HASH_BUCKETS - 1)];
173 }
174
175 /* Called with ovs_mutex or RCU read lock. */
176 struct vport *ovs_lookup_vport(const struct datapath *dp, u16 port_no)
177 {
178         struct vport *vport;
179         struct hlist_head *head;
180
181         head = vport_hash_bucket(dp, port_no);
182         hlist_for_each_entry_rcu(vport, head, dp_hash_node) {
183                 if (vport->port_no == port_no)
184                         return vport;
185         }
186         return NULL;
187 }
188
189 /* Called with ovs_mutex. */
190 static struct vport *new_vport(const struct vport_parms *parms)
191 {
192         struct vport *vport;
193
194         vport = ovs_vport_add(parms);
195         if (!IS_ERR(vport)) {
196                 struct datapath *dp = parms->dp;
197                 struct hlist_head *head = vport_hash_bucket(dp, vport->port_no);
198
199                 hlist_add_head_rcu(&vport->dp_hash_node, head);
200         }
201         return vport;
202 }
203
204 void ovs_dp_detach_port(struct vport *p)
205 {
206         ASSERT_OVSL();
207
208         /* First drop references to device. */
209         hlist_del_rcu(&p->dp_hash_node);
210
211         /* Then destroy it. */
212         ovs_vport_del(p);
213 }
214
215 /* Must be called with rcu_read_lock. */
216 void ovs_dp_process_packet(struct sk_buff *skb, struct sw_flow_key *key)
217 {
218         const struct vport *p = OVS_CB(skb)->input_vport;
219         struct datapath *dp = p->dp;
220         struct sw_flow *flow;
221         struct sw_flow_actions *sf_acts;
222         struct dp_stats_percpu *stats;
223         u64 *stats_counter;
224         u32 n_mask_hit;
225
226         stats = this_cpu_ptr(dp->stats_percpu);
227
228         /* Look up flow. */
229         flow = ovs_flow_tbl_lookup_stats(&dp->table, key, &n_mask_hit);
230         if (unlikely(!flow)) {
231                 struct dp_upcall_info upcall;
232                 int error;
233
234                 memset(&upcall, 0, sizeof(upcall));
235                 upcall.cmd = OVS_PACKET_CMD_MISS;
236                 upcall.portid = ovs_vport_find_upcall_portid(p, skb);
237                 upcall.mru = OVS_CB(skb)->mru;
238                 error = ovs_dp_upcall(dp, skb, key, &upcall, 0);
239                 if (unlikely(error))
240                         kfree_skb(skb);
241                 else
242                         consume_skb(skb);
243                 stats_counter = &stats->n_missed;
244                 goto out;
245         }
246
247         ovs_flow_stats_update(flow, key->tp.flags, skb);
248         sf_acts = rcu_dereference(flow->sf_acts);
249         ovs_execute_actions(dp, skb, sf_acts, key);
250
251         stats_counter = &stats->n_hit;
252
253 out:
254         /* Update datapath statistics. */
255         u64_stats_update_begin(&stats->syncp);
256         (*stats_counter)++;
257         stats->n_mask_hit += n_mask_hit;
258         u64_stats_update_end(&stats->syncp);
259 }
260
261 int ovs_dp_upcall(struct datapath *dp, struct sk_buff *skb,
262                   const struct sw_flow_key *key,
263                   const struct dp_upcall_info *upcall_info,
264                   uint32_t cutlen)
265 {
266         struct dp_stats_percpu *stats;
267         int err;
268
269         if (upcall_info->portid == 0) {
270                 err = -ENOTCONN;
271                 goto err;
272         }
273
274         if (!skb_is_gso(skb))
275                 err = queue_userspace_packet(dp, skb, key, upcall_info, cutlen);
276         else
277                 err = queue_gso_packets(dp, skb, key, upcall_info, cutlen);
278         if (err)
279                 goto err;
280
281         return 0;
282
283 err:
284         stats = this_cpu_ptr(dp->stats_percpu);
285
286         u64_stats_update_begin(&stats->syncp);
287         stats->n_lost++;
288         u64_stats_update_end(&stats->syncp);
289
290         return err;
291 }
292
293 static int queue_gso_packets(struct datapath *dp, struct sk_buff *skb,
294                              const struct sw_flow_key *key,
295                              const struct dp_upcall_info *upcall_info,
296                                  uint32_t cutlen)
297 {
298         unsigned int gso_type = skb_shinfo(skb)->gso_type;
299         struct sw_flow_key later_key;
300         struct sk_buff *segs, *nskb;
301         int err;
302
303         BUILD_BUG_ON(sizeof(*OVS_CB(skb)) > SKB_SGO_CB_OFFSET);
304         segs = __skb_gso_segment(skb, NETIF_F_SG, false);
305         if (IS_ERR(segs))
306                 return PTR_ERR(segs);
307         if (segs == NULL)
308                 return -EINVAL;
309
310         if (gso_type & SKB_GSO_UDP) {
311                 /* The initial flow key extracted by ovs_flow_key_extract()
312                  * in this case is for a first fragment, so we need to
313                  * properly mark later fragments.
314                  */
315                 later_key = *key;
316                 later_key.ip.frag = OVS_FRAG_TYPE_LATER;
317         }
318
319         /* Queue all of the segments. */
320         skb = segs;
321         do {
322                 if (gso_type & SKB_GSO_UDP && skb != segs)
323                         key = &later_key;
324
325                 err = queue_userspace_packet(dp, skb, key, upcall_info, cutlen);
326                 if (err)
327                         break;
328
329         } while ((skb = skb->next));
330
331         /* Free all of the segments. */
332         skb = segs;
333         do {
334                 nskb = skb->next;
335                 if (err)
336                         kfree_skb(skb);
337                 else
338                         consume_skb(skb);
339         } while ((skb = nskb));
340         return err;
341 }
342
343 static size_t upcall_msg_size(const struct dp_upcall_info *upcall_info,
344                               unsigned int hdrlen, int actions_attrlen)
345 {
346         size_t size = NLMSG_ALIGN(sizeof(struct ovs_header))
347                 + nla_total_size(hdrlen) /* OVS_PACKET_ATTR_PACKET */
348                 + nla_total_size(ovs_key_attr_size()) /* OVS_PACKET_ATTR_KEY */
349                 + nla_total_size(sizeof(unsigned int)); /* OVS_PACKET_ATTR_LEN */
350
351         /* OVS_PACKET_ATTR_USERDATA */
352         if (upcall_info->userdata)
353                 size += NLA_ALIGN(upcall_info->userdata->nla_len);
354
355         /* OVS_PACKET_ATTR_EGRESS_TUN_KEY */
356         if (upcall_info->egress_tun_info)
357                 size += nla_total_size(ovs_tun_key_attr_size());
358
359         /* OVS_PACKET_ATTR_ACTIONS */
360         if (upcall_info->actions_len)
361                 size += nla_total_size(actions_attrlen);
362
363         /* OVS_PACKET_ATTR_MRU */
364         if (upcall_info->mru)
365                 size += nla_total_size(sizeof(upcall_info->mru));
366
367         return size;
368 }
369
370 static void pad_packet(struct datapath *dp, struct sk_buff *skb)
371 {
372         if (!(dp->user_features & OVS_DP_F_UNALIGNED)) {
373                 size_t plen = NLA_ALIGN(skb->len) - skb->len;
374
375                 if (plen > 0)
376                         skb_put_zero(skb, plen);
377         }
378 }
379
380 static int queue_userspace_packet(struct datapath *dp, struct sk_buff *skb,
381                                   const struct sw_flow_key *key,
382                                   const struct dp_upcall_info *upcall_info,
383                                   uint32_t cutlen)
384 {
385         struct ovs_header *upcall;
386         struct sk_buff *nskb = NULL;
387         struct sk_buff *user_skb = NULL; /* to be queued to userspace */
388         struct nlattr *nla;
389         size_t len;
390         unsigned int hlen;
391         int err, dp_ifindex;
392
393         dp_ifindex = get_dpifindex(dp);
394         if (!dp_ifindex)
395                 return -ENODEV;
396
397         if (skb_vlan_tag_present(skb)) {
398                 nskb = skb_clone(skb, GFP_ATOMIC);
399                 if (!nskb)
400                         return -ENOMEM;
401
402                 nskb = __vlan_hwaccel_push_inside(nskb);
403                 if (!nskb)
404                         return -ENOMEM;
405
406                 skb = nskb;
407         }
408
409         if (nla_attr_size(skb->len) > USHRT_MAX) {
410                 err = -EFBIG;
411                 goto out;
412         }
413
414         /* Complete checksum if needed */
415         if (skb->ip_summed == CHECKSUM_PARTIAL &&
416             (err = skb_csum_hwoffload_help(skb, 0)))
417                 goto out;
418
419         /* Older versions of OVS user space enforce alignment of the last
420          * Netlink attribute to NLA_ALIGNTO which would require extensive
421          * padding logic. Only perform zerocopy if padding is not required.
422          */
423         if (dp->user_features & OVS_DP_F_UNALIGNED)
424                 hlen = skb_zerocopy_headlen(skb);
425         else
426                 hlen = skb->len;
427
428         len = upcall_msg_size(upcall_info, hlen - cutlen,
429                               OVS_CB(skb)->acts_origlen);
430         user_skb = genlmsg_new(len, GFP_ATOMIC);
431         if (!user_skb) {
432                 err = -ENOMEM;
433                 goto out;
434         }
435
436         upcall = genlmsg_put(user_skb, 0, 0, &dp_packet_genl_family,
437                              0, upcall_info->cmd);
438         if (!upcall) {
439                 err = -EINVAL;
440                 goto out;
441         }
442         upcall->dp_ifindex = dp_ifindex;
443
444         err = ovs_nla_put_key(key, key, OVS_PACKET_ATTR_KEY, false, user_skb);
445         if (err)
446                 goto out;
447
448         if (upcall_info->userdata)
449                 __nla_put(user_skb, OVS_PACKET_ATTR_USERDATA,
450                           nla_len(upcall_info->userdata),
451                           nla_data(upcall_info->userdata));
452
453         if (upcall_info->egress_tun_info) {
454                 nla = nla_nest_start_noflag(user_skb,
455                                             OVS_PACKET_ATTR_EGRESS_TUN_KEY);
456                 if (!nla) {
457                         err = -EMSGSIZE;
458                         goto out;
459                 }
460                 err = ovs_nla_put_tunnel_info(user_skb,
461                                               upcall_info->egress_tun_info);
462                 if (err)
463                         goto out;
464
465                 nla_nest_end(user_skb, nla);
466         }
467
468         if (upcall_info->actions_len) {
469                 nla = nla_nest_start_noflag(user_skb, OVS_PACKET_ATTR_ACTIONS);
470                 if (!nla) {
471                         err = -EMSGSIZE;
472                         goto out;
473                 }
474                 err = ovs_nla_put_actions(upcall_info->actions,
475                                           upcall_info->actions_len,
476                                           user_skb);
477                 if (!err)
478                         nla_nest_end(user_skb, nla);
479                 else
480                         nla_nest_cancel(user_skb, nla);
481         }
482
483         /* Add OVS_PACKET_ATTR_MRU */
484         if (upcall_info->mru) {
485                 if (nla_put_u16(user_skb, OVS_PACKET_ATTR_MRU,
486                                 upcall_info->mru)) {
487                         err = -ENOBUFS;
488                         goto out;
489                 }
490                 pad_packet(dp, user_skb);
491         }
492
493         /* Add OVS_PACKET_ATTR_LEN when packet is truncated */
494         if (cutlen > 0) {
495                 if (nla_put_u32(user_skb, OVS_PACKET_ATTR_LEN,
496                                 skb->len)) {
497                         err = -ENOBUFS;
498                         goto out;
499                 }
500                 pad_packet(dp, user_skb);
501         }
502
503         /* Only reserve room for attribute header, packet data is added
504          * in skb_zerocopy() */
505         if (!(nla = nla_reserve(user_skb, OVS_PACKET_ATTR_PACKET, 0))) {
506                 err = -ENOBUFS;
507                 goto out;
508         }
509         nla->nla_len = nla_attr_size(skb->len - cutlen);
510
511         err = skb_zerocopy(user_skb, skb, skb->len - cutlen, hlen);
512         if (err)
513                 goto out;
514
515         /* Pad OVS_PACKET_ATTR_PACKET if linear copy was performed */
516         pad_packet(dp, user_skb);
517
518         ((struct nlmsghdr *) user_skb->data)->nlmsg_len = user_skb->len;
519
520         err = genlmsg_unicast(ovs_dp_get_net(dp), user_skb, upcall_info->portid);
521         user_skb = NULL;
522 out:
523         if (err)
524                 skb_tx_error(skb);
525         kfree_skb(user_skb);
526         kfree_skb(nskb);
527         return err;
528 }
529
530 static int ovs_packet_cmd_execute(struct sk_buff *skb, struct genl_info *info)
531 {
532         struct ovs_header *ovs_header = info->userhdr;
533         struct net *net = sock_net(skb->sk);
534         struct nlattr **a = info->attrs;
535         struct sw_flow_actions *acts;
536         struct sk_buff *packet;
537         struct sw_flow *flow;
538         struct sw_flow_actions *sf_acts;
539         struct datapath *dp;
540         struct vport *input_vport;
541         u16 mru = 0;
542         int len;
543         int err;
544         bool log = !a[OVS_PACKET_ATTR_PROBE];
545
546         err = -EINVAL;
547         if (!a[OVS_PACKET_ATTR_PACKET] || !a[OVS_PACKET_ATTR_KEY] ||
548             !a[OVS_PACKET_ATTR_ACTIONS])
549                 goto err;
550
551         len = nla_len(a[OVS_PACKET_ATTR_PACKET]);
552         packet = __dev_alloc_skb(NET_IP_ALIGN + len, GFP_KERNEL);
553         err = -ENOMEM;
554         if (!packet)
555                 goto err;
556         skb_reserve(packet, NET_IP_ALIGN);
557
558         nla_memcpy(__skb_put(packet, len), a[OVS_PACKET_ATTR_PACKET], len);
559
560         /* Set packet's mru */
561         if (a[OVS_PACKET_ATTR_MRU]) {
562                 mru = nla_get_u16(a[OVS_PACKET_ATTR_MRU]);
563                 packet->ignore_df = 1;
564         }
565         OVS_CB(packet)->mru = mru;
566
567         /* Build an sw_flow for sending this packet. */
568         flow = ovs_flow_alloc();
569         err = PTR_ERR(flow);
570         if (IS_ERR(flow))
571                 goto err_kfree_skb;
572
573         err = ovs_flow_key_extract_userspace(net, a[OVS_PACKET_ATTR_KEY],
574                                              packet, &flow->key, log);
575         if (err)
576                 goto err_flow_free;
577
578         err = ovs_nla_copy_actions(net, a[OVS_PACKET_ATTR_ACTIONS],
579                                    &flow->key, &acts, log);
580         if (err)
581                 goto err_flow_free;
582
583         rcu_assign_pointer(flow->sf_acts, acts);
584         packet->priority = flow->key.phy.priority;
585         packet->mark = flow->key.phy.skb_mark;
586
587         rcu_read_lock();
588         dp = get_dp_rcu(net, ovs_header->dp_ifindex);
589         err = -ENODEV;
590         if (!dp)
591                 goto err_unlock;
592
593         input_vport = ovs_vport_rcu(dp, flow->key.phy.in_port);
594         if (!input_vport)
595                 input_vport = ovs_vport_rcu(dp, OVSP_LOCAL);
596
597         if (!input_vport)
598                 goto err_unlock;
599
600         packet->dev = input_vport->dev;
601         OVS_CB(packet)->input_vport = input_vport;
602         sf_acts = rcu_dereference(flow->sf_acts);
603
604         local_bh_disable();
605         err = ovs_execute_actions(dp, packet, sf_acts, &flow->key);
606         local_bh_enable();
607         rcu_read_unlock();
608
609         ovs_flow_free(flow, false);
610         return err;
611
612 err_unlock:
613         rcu_read_unlock();
614 err_flow_free:
615         ovs_flow_free(flow, false);
616 err_kfree_skb:
617         kfree_skb(packet);
618 err:
619         return err;
620 }
621
622 static const struct nla_policy packet_policy[OVS_PACKET_ATTR_MAX + 1] = {
623         [OVS_PACKET_ATTR_PACKET] = { .len = ETH_HLEN },
624         [OVS_PACKET_ATTR_KEY] = { .type = NLA_NESTED },
625         [OVS_PACKET_ATTR_ACTIONS] = { .type = NLA_NESTED },
626         [OVS_PACKET_ATTR_PROBE] = { .type = NLA_FLAG },
627         [OVS_PACKET_ATTR_MRU] = { .type = NLA_U16 },
628 };
629
630 static const struct genl_ops dp_packet_genl_ops[] = {
631         { .cmd = OVS_PACKET_CMD_EXECUTE,
632           .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
633           .flags = GENL_UNS_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
634           .doit = ovs_packet_cmd_execute
635         }
636 };
637
638 static struct genl_family dp_packet_genl_family __ro_after_init = {
639         .hdrsize = sizeof(struct ovs_header),
640         .name = OVS_PACKET_FAMILY,
641         .version = OVS_PACKET_VERSION,
642         .maxattr = OVS_PACKET_ATTR_MAX,
643         .policy = packet_policy,
644         .netnsok = true,
645         .parallel_ops = true,
646         .ops = dp_packet_genl_ops,
647         .n_ops = ARRAY_SIZE(dp_packet_genl_ops),
648         .module = THIS_MODULE,
649 };
650
651 static void get_dp_stats(const struct datapath *dp, struct ovs_dp_stats *stats,
652                          struct ovs_dp_megaflow_stats *mega_stats)
653 {
654         int i;
655
656         memset(mega_stats, 0, sizeof(*mega_stats));
657
658         stats->n_flows = ovs_flow_tbl_count(&dp->table);
659         mega_stats->n_masks = ovs_flow_tbl_num_masks(&dp->table);
660
661         stats->n_hit = stats->n_missed = stats->n_lost = 0;
662
663         for_each_possible_cpu(i) {
664                 const struct dp_stats_percpu *percpu_stats;
665                 struct dp_stats_percpu local_stats;
666                 unsigned int start;
667
668                 percpu_stats = per_cpu_ptr(dp->stats_percpu, i);
669
670                 do {
671                         start = u64_stats_fetch_begin_irq(&percpu_stats->syncp);
672                         local_stats = *percpu_stats;
673                 } while (u64_stats_fetch_retry_irq(&percpu_stats->syncp, start));
674
675                 stats->n_hit += local_stats.n_hit;
676                 stats->n_missed += local_stats.n_missed;
677                 stats->n_lost += local_stats.n_lost;
678                 mega_stats->n_mask_hit += local_stats.n_mask_hit;
679         }
680 }
681
682 static bool should_fill_key(const struct sw_flow_id *sfid, uint32_t ufid_flags)
683 {
684         return ovs_identifier_is_ufid(sfid) &&
685                !(ufid_flags & OVS_UFID_F_OMIT_KEY);
686 }
687
688 static bool should_fill_mask(uint32_t ufid_flags)
689 {
690         return !(ufid_flags & OVS_UFID_F_OMIT_MASK);
691 }
692
693 static bool should_fill_actions(uint32_t ufid_flags)
694 {
695         return !(ufid_flags & OVS_UFID_F_OMIT_ACTIONS);
696 }
697
698 static size_t ovs_flow_cmd_msg_size(const struct sw_flow_actions *acts,
699                                     const struct sw_flow_id *sfid,
700                                     uint32_t ufid_flags)
701 {
702         size_t len = NLMSG_ALIGN(sizeof(struct ovs_header));
703
704         /* OVS_FLOW_ATTR_UFID */
705         if (sfid && ovs_identifier_is_ufid(sfid))
706                 len += nla_total_size(sfid->ufid_len);
707
708         /* OVS_FLOW_ATTR_KEY */
709         if (!sfid || should_fill_key(sfid, ufid_flags))
710                 len += nla_total_size(ovs_key_attr_size());
711
712         /* OVS_FLOW_ATTR_MASK */
713         if (should_fill_mask(ufid_flags))
714                 len += nla_total_size(ovs_key_attr_size());
715
716         /* OVS_FLOW_ATTR_ACTIONS */
717         if (should_fill_actions(ufid_flags))
718                 len += nla_total_size(acts->orig_len);
719
720         return len
721                 + nla_total_size_64bit(sizeof(struct ovs_flow_stats)) /* OVS_FLOW_ATTR_STATS */
722                 + nla_total_size(1) /* OVS_FLOW_ATTR_TCP_FLAGS */
723                 + nla_total_size_64bit(8); /* OVS_FLOW_ATTR_USED */
724 }
725
726 /* Called with ovs_mutex or RCU read lock. */
727 static int ovs_flow_cmd_fill_stats(const struct sw_flow *flow,
728                                    struct sk_buff *skb)
729 {
730         struct ovs_flow_stats stats;
731         __be16 tcp_flags;
732         unsigned long used;
733
734         ovs_flow_stats_get(flow, &stats, &used, &tcp_flags);
735
736         if (used &&
737             nla_put_u64_64bit(skb, OVS_FLOW_ATTR_USED, ovs_flow_used_time(used),
738                               OVS_FLOW_ATTR_PAD))
739                 return -EMSGSIZE;
740
741         if (stats.n_packets &&
742             nla_put_64bit(skb, OVS_FLOW_ATTR_STATS,
743                           sizeof(struct ovs_flow_stats), &stats,
744                           OVS_FLOW_ATTR_PAD))
745                 return -EMSGSIZE;
746
747         if ((u8)ntohs(tcp_flags) &&
748              nla_put_u8(skb, OVS_FLOW_ATTR_TCP_FLAGS, (u8)ntohs(tcp_flags)))
749                 return -EMSGSIZE;
750
751         return 0;
752 }
753
754 /* Called with ovs_mutex or RCU read lock. */
755 static int ovs_flow_cmd_fill_actions(const struct sw_flow *flow,
756                                      struct sk_buff *skb, int skb_orig_len)
757 {
758         struct nlattr *start;
759         int err;
760
761         /* If OVS_FLOW_ATTR_ACTIONS doesn't fit, skip dumping the actions if
762          * this is the first flow to be dumped into 'skb'.  This is unusual for
763          * Netlink but individual action lists can be longer than
764          * NLMSG_GOODSIZE and thus entirely undumpable if we didn't do this.
765          * The userspace caller can always fetch the actions separately if it
766          * really wants them.  (Most userspace callers in fact don't care.)
767          *
768          * This can only fail for dump operations because the skb is always
769          * properly sized for single flows.
770          */
771         start = nla_nest_start_noflag(skb, OVS_FLOW_ATTR_ACTIONS);
772         if (start) {
773                 const struct sw_flow_actions *sf_acts;
774
775                 sf_acts = rcu_dereference_ovsl(flow->sf_acts);
776                 err = ovs_nla_put_actions(sf_acts->actions,
777                                           sf_acts->actions_len, skb);
778
779                 if (!err)
780                         nla_nest_end(skb, start);
781                 else {
782                         if (skb_orig_len)
783                                 return err;
784
785                         nla_nest_cancel(skb, start);
786                 }
787         } else if (skb_orig_len) {
788                 return -EMSGSIZE;
789         }
790
791         return 0;
792 }
793
794 /* Called with ovs_mutex or RCU read lock. */
795 static int ovs_flow_cmd_fill_info(const struct sw_flow *flow, int dp_ifindex,
796                                   struct sk_buff *skb, u32 portid,
797                                   u32 seq, u32 flags, u8 cmd, u32 ufid_flags)
798 {
799         const int skb_orig_len = skb->len;
800         struct ovs_header *ovs_header;
801         int err;
802
803         ovs_header = genlmsg_put(skb, portid, seq, &dp_flow_genl_family,
804                                  flags, cmd);
805         if (!ovs_header)
806                 return -EMSGSIZE;
807
808         ovs_header->dp_ifindex = dp_ifindex;
809
810         err = ovs_nla_put_identifier(flow, skb);
811         if (err)
812                 goto error;
813
814         if (should_fill_key(&flow->id, ufid_flags)) {
815                 err = ovs_nla_put_masked_key(flow, skb);
816                 if (err)
817                         goto error;
818         }
819
820         if (should_fill_mask(ufid_flags)) {
821                 err = ovs_nla_put_mask(flow, skb);
822                 if (err)
823                         goto error;
824         }
825
826         err = ovs_flow_cmd_fill_stats(flow, skb);
827         if (err)
828                 goto error;
829
830         if (should_fill_actions(ufid_flags)) {
831                 err = ovs_flow_cmd_fill_actions(flow, skb, skb_orig_len);
832                 if (err)
833                         goto error;
834         }
835
836         genlmsg_end(skb, ovs_header);
837         return 0;
838
839 error:
840         genlmsg_cancel(skb, ovs_header);
841         return err;
842 }
843
844 /* May not be called with RCU read lock. */
845 static struct sk_buff *ovs_flow_cmd_alloc_info(const struct sw_flow_actions *acts,
846                                                const struct sw_flow_id *sfid,
847                                                struct genl_info *info,
848                                                bool always,
849                                                uint32_t ufid_flags)
850 {
851         struct sk_buff *skb;
852         size_t len;
853
854         if (!always && !ovs_must_notify(&dp_flow_genl_family, info, 0))
855                 return NULL;
856
857         len = ovs_flow_cmd_msg_size(acts, sfid, ufid_flags);
858         skb = genlmsg_new(len, GFP_KERNEL);
859         if (!skb)
860                 return ERR_PTR(-ENOMEM);
861
862         return skb;
863 }
864
865 /* Called with ovs_mutex. */
866 static struct sk_buff *ovs_flow_cmd_build_info(const struct sw_flow *flow,
867                                                int dp_ifindex,
868                                                struct genl_info *info, u8 cmd,
869                                                bool always, u32 ufid_flags)
870 {
871         struct sk_buff *skb;
872         int retval;
873
874         skb = ovs_flow_cmd_alloc_info(ovsl_dereference(flow->sf_acts),
875                                       &flow->id, info, always, ufid_flags);
876         if (IS_ERR_OR_NULL(skb))
877                 return skb;
878
879         retval = ovs_flow_cmd_fill_info(flow, dp_ifindex, skb,
880                                         info->snd_portid, info->snd_seq, 0,
881                                         cmd, ufid_flags);
882         BUG_ON(retval < 0);
883         return skb;
884 }
885
886 static int ovs_flow_cmd_new(struct sk_buff *skb, struct genl_info *info)
887 {
888         struct net *net = sock_net(skb->sk);
889         struct nlattr **a = info->attrs;
890         struct ovs_header *ovs_header = info->userhdr;
891         struct sw_flow *flow = NULL, *new_flow;
892         struct sw_flow_mask mask;
893         struct sk_buff *reply;
894         struct datapath *dp;
895         struct sw_flow_actions *acts;
896         struct sw_flow_match match;
897         u32 ufid_flags = ovs_nla_get_ufid_flags(a[OVS_FLOW_ATTR_UFID_FLAGS]);
898         int error;
899         bool log = !a[OVS_FLOW_ATTR_PROBE];
900
901         /* Must have key and actions. */
902         error = -EINVAL;
903         if (!a[OVS_FLOW_ATTR_KEY]) {
904                 OVS_NLERR(log, "Flow key attr not present in new flow.");
905                 goto error;
906         }
907         if (!a[OVS_FLOW_ATTR_ACTIONS]) {
908                 OVS_NLERR(log, "Flow actions attr not present in new flow.");
909                 goto error;
910         }
911
912         /* Most of the time we need to allocate a new flow, do it before
913          * locking.
914          */
915         new_flow = ovs_flow_alloc();
916         if (IS_ERR(new_flow)) {
917                 error = PTR_ERR(new_flow);
918                 goto error;
919         }
920
921         /* Extract key. */
922         ovs_match_init(&match, &new_flow->key, false, &mask);
923         error = ovs_nla_get_match(net, &match, a[OVS_FLOW_ATTR_KEY],
924                                   a[OVS_FLOW_ATTR_MASK], log);
925         if (error)
926                 goto err_kfree_flow;
927
928         /* Extract flow identifier. */
929         error = ovs_nla_get_identifier(&new_flow->id, a[OVS_FLOW_ATTR_UFID],
930                                        &new_flow->key, log);
931         if (error)
932                 goto err_kfree_flow;
933
934         /* unmasked key is needed to match when ufid is not used. */
935         if (ovs_identifier_is_key(&new_flow->id))
936                 match.key = new_flow->id.unmasked_key;
937
938         ovs_flow_mask_key(&new_flow->key, &new_flow->key, true, &mask);
939
940         /* Validate actions. */
941         error = ovs_nla_copy_actions(net, a[OVS_FLOW_ATTR_ACTIONS],
942                                      &new_flow->key, &acts, log);
943         if (error) {
944                 OVS_NLERR(log, "Flow actions may not be safe on all matching packets.");
945                 goto err_kfree_flow;
946         }
947
948         reply = ovs_flow_cmd_alloc_info(acts, &new_flow->id, info, false,
949                                         ufid_flags);
950         if (IS_ERR(reply)) {
951                 error = PTR_ERR(reply);
952                 goto err_kfree_acts;
953         }
954
955         ovs_lock();
956         dp = get_dp(net, ovs_header->dp_ifindex);
957         if (unlikely(!dp)) {
958                 error = -ENODEV;
959                 goto err_unlock_ovs;
960         }
961
962         /* Check if this is a duplicate flow */
963         if (ovs_identifier_is_ufid(&new_flow->id))
964                 flow = ovs_flow_tbl_lookup_ufid(&dp->table, &new_flow->id);
965         if (!flow)
966                 flow = ovs_flow_tbl_lookup(&dp->table, &new_flow->key);
967         if (likely(!flow)) {
968                 rcu_assign_pointer(new_flow->sf_acts, acts);
969
970                 /* Put flow in bucket. */
971                 error = ovs_flow_tbl_insert(&dp->table, new_flow, &mask);
972                 if (unlikely(error)) {
973                         acts = NULL;
974                         goto err_unlock_ovs;
975                 }
976
977                 if (unlikely(reply)) {
978                         error = ovs_flow_cmd_fill_info(new_flow,
979                                                        ovs_header->dp_ifindex,
980                                                        reply, info->snd_portid,
981                                                        info->snd_seq, 0,
982                                                        OVS_FLOW_CMD_NEW,
983                                                        ufid_flags);
984                         BUG_ON(error < 0);
985                 }
986                 ovs_unlock();
987         } else {
988                 struct sw_flow_actions *old_acts;
989
990                 /* Bail out if we're not allowed to modify an existing flow.
991                  * We accept NLM_F_CREATE in place of the intended NLM_F_EXCL
992                  * because Generic Netlink treats the latter as a dump
993                  * request.  We also accept NLM_F_EXCL in case that bug ever
994                  * gets fixed.
995                  */
996                 if (unlikely(info->nlhdr->nlmsg_flags & (NLM_F_CREATE
997                                                          | NLM_F_EXCL))) {
998                         error = -EEXIST;
999                         goto err_unlock_ovs;
1000                 }
1001                 /* The flow identifier has to be the same for flow updates.
1002                  * Look for any overlapping flow.
1003                  */
1004                 if (unlikely(!ovs_flow_cmp(flow, &match))) {
1005                         if (ovs_identifier_is_key(&flow->id))
1006                                 flow = ovs_flow_tbl_lookup_exact(&dp->table,
1007                                                                  &match);
1008                         else /* UFID matches but key is different */
1009                                 flow = NULL;
1010                         if (!flow) {
1011                                 error = -ENOENT;
1012                                 goto err_unlock_ovs;
1013                         }
1014                 }
1015                 /* Update actions. */
1016                 old_acts = ovsl_dereference(flow->sf_acts);
1017                 rcu_assign_pointer(flow->sf_acts, acts);
1018
1019                 if (unlikely(reply)) {
1020                         error = ovs_flow_cmd_fill_info(flow,
1021                                                        ovs_header->dp_ifindex,
1022                                                        reply, info->snd_portid,
1023                                                        info->snd_seq, 0,
1024                                                        OVS_FLOW_CMD_NEW,
1025                                                        ufid_flags);
1026                         BUG_ON(error < 0);
1027                 }
1028                 ovs_unlock();
1029
1030                 ovs_nla_free_flow_actions_rcu(old_acts);
1031                 ovs_flow_free(new_flow, false);
1032         }
1033
1034         if (reply)
1035                 ovs_notify(&dp_flow_genl_family, reply, info);
1036         return 0;
1037
1038 err_unlock_ovs:
1039         ovs_unlock();
1040         kfree_skb(reply);
1041 err_kfree_acts:
1042         ovs_nla_free_flow_actions(acts);
1043 err_kfree_flow:
1044         ovs_flow_free(new_flow, false);
1045 error:
1046         return error;
1047 }
1048
1049 /* Factor out action copy to avoid "Wframe-larger-than=1024" warning. */
1050 static struct sw_flow_actions *get_flow_actions(struct net *net,
1051                                                 const struct nlattr *a,
1052                                                 const struct sw_flow_key *key,
1053                                                 const struct sw_flow_mask *mask,
1054                                                 bool log)
1055 {
1056         struct sw_flow_actions *acts;
1057         struct sw_flow_key masked_key;
1058         int error;
1059
1060         ovs_flow_mask_key(&masked_key, key, true, mask);
1061         error = ovs_nla_copy_actions(net, a, &masked_key, &acts, log);
1062         if (error) {
1063                 OVS_NLERR(log,
1064                           "Actions may not be safe on all matching packets");
1065                 return ERR_PTR(error);
1066         }
1067
1068         return acts;
1069 }
1070
1071 /* Factor out match-init and action-copy to avoid
1072  * "Wframe-larger-than=1024" warning. Because mask is only
1073  * used to get actions, we new a function to save some
1074  * stack space.
1075  *
1076  * If there are not key and action attrs, we return 0
1077  * directly. In the case, the caller will also not use the
1078  * match as before. If there is action attr, we try to get
1079  * actions and save them to *acts. Before returning from
1080  * the function, we reset the match->mask pointer. Because
1081  * we should not to return match object with dangling reference
1082  * to mask.
1083  * */
1084 static int ovs_nla_init_match_and_action(struct net *net,
1085                                          struct sw_flow_match *match,
1086                                          struct sw_flow_key *key,
1087                                          struct nlattr **a,
1088                                          struct sw_flow_actions **acts,
1089                                          bool log)
1090 {
1091         struct sw_flow_mask mask;
1092         int error = 0;
1093
1094         if (a[OVS_FLOW_ATTR_KEY]) {
1095                 ovs_match_init(match, key, true, &mask);
1096                 error = ovs_nla_get_match(net, match, a[OVS_FLOW_ATTR_KEY],
1097                                           a[OVS_FLOW_ATTR_MASK], log);
1098                 if (error)
1099                         goto error;
1100         }
1101
1102         if (a[OVS_FLOW_ATTR_ACTIONS]) {
1103                 if (!a[OVS_FLOW_ATTR_KEY]) {
1104                         OVS_NLERR(log,
1105                                   "Flow key attribute not present in set flow.");
1106                         error = -EINVAL;
1107                         goto error;
1108                 }
1109
1110                 *acts = get_flow_actions(net, a[OVS_FLOW_ATTR_ACTIONS], key,
1111                                          &mask, log);
1112                 if (IS_ERR(*acts)) {
1113                         error = PTR_ERR(*acts);
1114                         goto error;
1115                 }
1116         }
1117
1118         /* On success, error is 0. */
1119 error:
1120         match->mask = NULL;
1121         return error;
1122 }
1123
1124 static int ovs_flow_cmd_set(struct sk_buff *skb, struct genl_info *info)
1125 {
1126         struct net *net = sock_net(skb->sk);
1127         struct nlattr **a = info->attrs;
1128         struct ovs_header *ovs_header = info->userhdr;
1129         struct sw_flow_key key;
1130         struct sw_flow *flow;
1131         struct sk_buff *reply = NULL;
1132         struct datapath *dp;
1133         struct sw_flow_actions *old_acts = NULL, *acts = NULL;
1134         struct sw_flow_match match;
1135         struct sw_flow_id sfid;
1136         u32 ufid_flags = ovs_nla_get_ufid_flags(a[OVS_FLOW_ATTR_UFID_FLAGS]);
1137         int error = 0;
1138         bool log = !a[OVS_FLOW_ATTR_PROBE];
1139         bool ufid_present;
1140
1141         ufid_present = ovs_nla_get_ufid(&sfid, a[OVS_FLOW_ATTR_UFID], log);
1142         if (!a[OVS_FLOW_ATTR_KEY] && !ufid_present) {
1143                 OVS_NLERR(log,
1144                           "Flow set message rejected, Key attribute missing.");
1145                 return -EINVAL;
1146         }
1147
1148         error = ovs_nla_init_match_and_action(net, &match, &key, a,
1149                                               &acts, log);
1150         if (error)
1151                 goto error;
1152
1153         if (acts) {
1154                 /* Can allocate before locking if have acts. */
1155                 reply = ovs_flow_cmd_alloc_info(acts, &sfid, info, false,
1156                                                 ufid_flags);
1157                 if (IS_ERR(reply)) {
1158                         error = PTR_ERR(reply);
1159                         goto err_kfree_acts;
1160                 }
1161         }
1162
1163         ovs_lock();
1164         dp = get_dp(net, ovs_header->dp_ifindex);
1165         if (unlikely(!dp)) {
1166                 error = -ENODEV;
1167                 goto err_unlock_ovs;
1168         }
1169         /* Check that the flow exists. */
1170         if (ufid_present)
1171                 flow = ovs_flow_tbl_lookup_ufid(&dp->table, &sfid);
1172         else
1173                 flow = ovs_flow_tbl_lookup_exact(&dp->table, &match);
1174         if (unlikely(!flow)) {
1175                 error = -ENOENT;
1176                 goto err_unlock_ovs;
1177         }
1178
1179         /* Update actions, if present. */
1180         if (likely(acts)) {
1181                 old_acts = ovsl_dereference(flow->sf_acts);
1182                 rcu_assign_pointer(flow->sf_acts, acts);
1183
1184                 if (unlikely(reply)) {
1185                         error = ovs_flow_cmd_fill_info(flow,
1186                                                        ovs_header->dp_ifindex,
1187                                                        reply, info->snd_portid,
1188                                                        info->snd_seq, 0,
1189                                                        OVS_FLOW_CMD_SET,
1190                                                        ufid_flags);
1191                         BUG_ON(error < 0);
1192                 }
1193         } else {
1194                 /* Could not alloc without acts before locking. */
1195                 reply = ovs_flow_cmd_build_info(flow, ovs_header->dp_ifindex,
1196                                                 info, OVS_FLOW_CMD_SET, false,
1197                                                 ufid_flags);
1198
1199                 if (IS_ERR(reply)) {
1200                         error = PTR_ERR(reply);
1201                         goto err_unlock_ovs;
1202                 }
1203         }
1204
1205         /* Clear stats. */
1206         if (a[OVS_FLOW_ATTR_CLEAR])
1207                 ovs_flow_stats_clear(flow);
1208         ovs_unlock();
1209
1210         if (reply)
1211                 ovs_notify(&dp_flow_genl_family, reply, info);
1212         if (old_acts)
1213                 ovs_nla_free_flow_actions_rcu(old_acts);
1214
1215         return 0;
1216
1217 err_unlock_ovs:
1218         ovs_unlock();
1219         kfree_skb(reply);
1220 err_kfree_acts:
1221         ovs_nla_free_flow_actions(acts);
1222 error:
1223         return error;
1224 }
1225
1226 static int ovs_flow_cmd_get(struct sk_buff *skb, struct genl_info *info)
1227 {
1228         struct nlattr **a = info->attrs;
1229         struct ovs_header *ovs_header = info->userhdr;
1230         struct net *net = sock_net(skb->sk);
1231         struct sw_flow_key key;
1232         struct sk_buff *reply;
1233         struct sw_flow *flow;
1234         struct datapath *dp;
1235         struct sw_flow_match match;
1236         struct sw_flow_id ufid;
1237         u32 ufid_flags = ovs_nla_get_ufid_flags(a[OVS_FLOW_ATTR_UFID_FLAGS]);
1238         int err = 0;
1239         bool log = !a[OVS_FLOW_ATTR_PROBE];
1240         bool ufid_present;
1241
1242         ufid_present = ovs_nla_get_ufid(&ufid, a[OVS_FLOW_ATTR_UFID], log);
1243         if (a[OVS_FLOW_ATTR_KEY]) {
1244                 ovs_match_init(&match, &key, true, NULL);
1245                 err = ovs_nla_get_match(net, &match, a[OVS_FLOW_ATTR_KEY], NULL,
1246                                         log);
1247         } else if (!ufid_present) {
1248                 OVS_NLERR(log,
1249                           "Flow get message rejected, Key attribute missing.");
1250                 err = -EINVAL;
1251         }
1252         if (err)
1253                 return err;
1254
1255         ovs_lock();
1256         dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
1257         if (!dp) {
1258                 err = -ENODEV;
1259                 goto unlock;
1260         }
1261
1262         if (ufid_present)
1263                 flow = ovs_flow_tbl_lookup_ufid(&dp->table, &ufid);
1264         else
1265                 flow = ovs_flow_tbl_lookup_exact(&dp->table, &match);
1266         if (!flow) {
1267                 err = -ENOENT;
1268                 goto unlock;
1269         }
1270
1271         reply = ovs_flow_cmd_build_info(flow, ovs_header->dp_ifindex, info,
1272                                         OVS_FLOW_CMD_GET, true, ufid_flags);
1273         if (IS_ERR(reply)) {
1274                 err = PTR_ERR(reply);
1275                 goto unlock;
1276         }
1277
1278         ovs_unlock();
1279         return genlmsg_reply(reply, info);
1280 unlock:
1281         ovs_unlock();
1282         return err;
1283 }
1284
1285 static int ovs_flow_cmd_del(struct sk_buff *skb, struct genl_info *info)
1286 {
1287         struct nlattr **a = info->attrs;
1288         struct ovs_header *ovs_header = info->userhdr;
1289         struct net *net = sock_net(skb->sk);
1290         struct sw_flow_key key;
1291         struct sk_buff *reply;
1292         struct sw_flow *flow = NULL;
1293         struct datapath *dp;
1294         struct sw_flow_match match;
1295         struct sw_flow_id ufid;
1296         u32 ufid_flags = ovs_nla_get_ufid_flags(a[OVS_FLOW_ATTR_UFID_FLAGS]);
1297         int err;
1298         bool log = !a[OVS_FLOW_ATTR_PROBE];
1299         bool ufid_present;
1300
1301         ufid_present = ovs_nla_get_ufid(&ufid, a[OVS_FLOW_ATTR_UFID], log);
1302         if (a[OVS_FLOW_ATTR_KEY]) {
1303                 ovs_match_init(&match, &key, true, NULL);
1304                 err = ovs_nla_get_match(net, &match, a[OVS_FLOW_ATTR_KEY],
1305                                         NULL, log);
1306                 if (unlikely(err))
1307                         return err;
1308         }
1309
1310         ovs_lock();
1311         dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
1312         if (unlikely(!dp)) {
1313                 err = -ENODEV;
1314                 goto unlock;
1315         }
1316
1317         if (unlikely(!a[OVS_FLOW_ATTR_KEY] && !ufid_present)) {
1318                 err = ovs_flow_tbl_flush(&dp->table);
1319                 goto unlock;
1320         }
1321
1322         if (ufid_present)
1323                 flow = ovs_flow_tbl_lookup_ufid(&dp->table, &ufid);
1324         else
1325                 flow = ovs_flow_tbl_lookup_exact(&dp->table, &match);
1326         if (unlikely(!flow)) {
1327                 err = -ENOENT;
1328                 goto unlock;
1329         }
1330
1331         ovs_flow_tbl_remove(&dp->table, flow);
1332         ovs_unlock();
1333
1334         reply = ovs_flow_cmd_alloc_info((const struct sw_flow_actions __force *) flow->sf_acts,
1335                                         &flow->id, info, false, ufid_flags);
1336         if (likely(reply)) {
1337                 if (!IS_ERR(reply)) {
1338                         rcu_read_lock();        /*To keep RCU checker happy. */
1339                         err = ovs_flow_cmd_fill_info(flow, ovs_header->dp_ifindex,
1340                                                      reply, info->snd_portid,
1341                                                      info->snd_seq, 0,
1342                                                      OVS_FLOW_CMD_DEL,
1343                                                      ufid_flags);
1344                         rcu_read_unlock();
1345                         BUG_ON(err < 0);
1346
1347                         ovs_notify(&dp_flow_genl_family, reply, info);
1348                 } else {
1349                         netlink_set_err(sock_net(skb->sk)->genl_sock, 0, 0, PTR_ERR(reply));
1350                 }
1351         }
1352
1353         ovs_flow_free(flow, true);
1354         return 0;
1355 unlock:
1356         ovs_unlock();
1357         return err;
1358 }
1359
1360 static int ovs_flow_cmd_dump(struct sk_buff *skb, struct netlink_callback *cb)
1361 {
1362         struct nlattr *a[__OVS_FLOW_ATTR_MAX];
1363         struct ovs_header *ovs_header = genlmsg_data(nlmsg_data(cb->nlh));
1364         struct table_instance *ti;
1365         struct datapath *dp;
1366         u32 ufid_flags;
1367         int err;
1368
1369         err = genlmsg_parse_deprecated(cb->nlh, &dp_flow_genl_family, a,
1370                                        OVS_FLOW_ATTR_MAX, flow_policy, NULL);
1371         if (err)
1372                 return err;
1373         ufid_flags = ovs_nla_get_ufid_flags(a[OVS_FLOW_ATTR_UFID_FLAGS]);
1374
1375         rcu_read_lock();
1376         dp = get_dp_rcu(sock_net(skb->sk), ovs_header->dp_ifindex);
1377         if (!dp) {
1378                 rcu_read_unlock();
1379                 return -ENODEV;
1380         }
1381
1382         ti = rcu_dereference(dp->table.ti);
1383         for (;;) {
1384                 struct sw_flow *flow;
1385                 u32 bucket, obj;
1386
1387                 bucket = cb->args[0];
1388                 obj = cb->args[1];
1389                 flow = ovs_flow_tbl_dump_next(ti, &bucket, &obj);
1390                 if (!flow)
1391                         break;
1392
1393                 if (ovs_flow_cmd_fill_info(flow, ovs_header->dp_ifindex, skb,
1394                                            NETLINK_CB(cb->skb).portid,
1395                                            cb->nlh->nlmsg_seq, NLM_F_MULTI,
1396                                            OVS_FLOW_CMD_GET, ufid_flags) < 0)
1397                         break;
1398
1399                 cb->args[0] = bucket;
1400                 cb->args[1] = obj;
1401         }
1402         rcu_read_unlock();
1403         return skb->len;
1404 }
1405
1406 static const struct nla_policy flow_policy[OVS_FLOW_ATTR_MAX + 1] = {
1407         [OVS_FLOW_ATTR_KEY] = { .type = NLA_NESTED },
1408         [OVS_FLOW_ATTR_MASK] = { .type = NLA_NESTED },
1409         [OVS_FLOW_ATTR_ACTIONS] = { .type = NLA_NESTED },
1410         [OVS_FLOW_ATTR_CLEAR] = { .type = NLA_FLAG },
1411         [OVS_FLOW_ATTR_PROBE] = { .type = NLA_FLAG },
1412         [OVS_FLOW_ATTR_UFID] = { .type = NLA_UNSPEC, .len = 1 },
1413         [OVS_FLOW_ATTR_UFID_FLAGS] = { .type = NLA_U32 },
1414 };
1415
1416 static const struct genl_ops dp_flow_genl_ops[] = {
1417         { .cmd = OVS_FLOW_CMD_NEW,
1418           .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1419           .flags = GENL_UNS_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1420           .doit = ovs_flow_cmd_new
1421         },
1422         { .cmd = OVS_FLOW_CMD_DEL,
1423           .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1424           .flags = GENL_UNS_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1425           .doit = ovs_flow_cmd_del
1426         },
1427         { .cmd = OVS_FLOW_CMD_GET,
1428           .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1429           .flags = 0,               /* OK for unprivileged users. */
1430           .doit = ovs_flow_cmd_get,
1431           .dumpit = ovs_flow_cmd_dump
1432         },
1433         { .cmd = OVS_FLOW_CMD_SET,
1434           .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1435           .flags = GENL_UNS_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1436           .doit = ovs_flow_cmd_set,
1437         },
1438 };
1439
1440 static struct genl_family dp_flow_genl_family __ro_after_init = {
1441         .hdrsize = sizeof(struct ovs_header),
1442         .name = OVS_FLOW_FAMILY,
1443         .version = OVS_FLOW_VERSION,
1444         .maxattr = OVS_FLOW_ATTR_MAX,
1445         .policy = flow_policy,
1446         .netnsok = true,
1447         .parallel_ops = true,
1448         .ops = dp_flow_genl_ops,
1449         .n_ops = ARRAY_SIZE(dp_flow_genl_ops),
1450         .mcgrps = &ovs_dp_flow_multicast_group,
1451         .n_mcgrps = 1,
1452         .module = THIS_MODULE,
1453 };
1454
1455 static size_t ovs_dp_cmd_msg_size(void)
1456 {
1457         size_t msgsize = NLMSG_ALIGN(sizeof(struct ovs_header));
1458
1459         msgsize += nla_total_size(IFNAMSIZ);
1460         msgsize += nla_total_size_64bit(sizeof(struct ovs_dp_stats));
1461         msgsize += nla_total_size_64bit(sizeof(struct ovs_dp_megaflow_stats));
1462         msgsize += nla_total_size(sizeof(u32)); /* OVS_DP_ATTR_USER_FEATURES */
1463
1464         return msgsize;
1465 }
1466
1467 /* Called with ovs_mutex. */
1468 static int ovs_dp_cmd_fill_info(struct datapath *dp, struct sk_buff *skb,
1469                                 u32 portid, u32 seq, u32 flags, u8 cmd)
1470 {
1471         struct ovs_header *ovs_header;
1472         struct ovs_dp_stats dp_stats;
1473         struct ovs_dp_megaflow_stats dp_megaflow_stats;
1474         int err;
1475
1476         ovs_header = genlmsg_put(skb, portid, seq, &dp_datapath_genl_family,
1477                                    flags, cmd);
1478         if (!ovs_header)
1479                 goto error;
1480
1481         ovs_header->dp_ifindex = get_dpifindex(dp);
1482
1483         err = nla_put_string(skb, OVS_DP_ATTR_NAME, ovs_dp_name(dp));
1484         if (err)
1485                 goto nla_put_failure;
1486
1487         get_dp_stats(dp, &dp_stats, &dp_megaflow_stats);
1488         if (nla_put_64bit(skb, OVS_DP_ATTR_STATS, sizeof(struct ovs_dp_stats),
1489                           &dp_stats, OVS_DP_ATTR_PAD))
1490                 goto nla_put_failure;
1491
1492         if (nla_put_64bit(skb, OVS_DP_ATTR_MEGAFLOW_STATS,
1493                           sizeof(struct ovs_dp_megaflow_stats),
1494                           &dp_megaflow_stats, OVS_DP_ATTR_PAD))
1495                 goto nla_put_failure;
1496
1497         if (nla_put_u32(skb, OVS_DP_ATTR_USER_FEATURES, dp->user_features))
1498                 goto nla_put_failure;
1499
1500         genlmsg_end(skb, ovs_header);
1501         return 0;
1502
1503 nla_put_failure:
1504         genlmsg_cancel(skb, ovs_header);
1505 error:
1506         return -EMSGSIZE;
1507 }
1508
1509 static struct sk_buff *ovs_dp_cmd_alloc_info(void)
1510 {
1511         return genlmsg_new(ovs_dp_cmd_msg_size(), GFP_KERNEL);
1512 }
1513
1514 /* Called with rcu_read_lock or ovs_mutex. */
1515 static struct datapath *lookup_datapath(struct net *net,
1516                                         const struct ovs_header *ovs_header,
1517                                         struct nlattr *a[OVS_DP_ATTR_MAX + 1])
1518 {
1519         struct datapath *dp;
1520
1521         if (!a[OVS_DP_ATTR_NAME])
1522                 dp = get_dp(net, ovs_header->dp_ifindex);
1523         else {
1524                 struct vport *vport;
1525
1526                 vport = ovs_vport_locate(net, nla_data(a[OVS_DP_ATTR_NAME]));
1527                 dp = vport && vport->port_no == OVSP_LOCAL ? vport->dp : NULL;
1528         }
1529         return dp ? dp : ERR_PTR(-ENODEV);
1530 }
1531
1532 static void ovs_dp_reset_user_features(struct sk_buff *skb, struct genl_info *info)
1533 {
1534         struct datapath *dp;
1535
1536         dp = lookup_datapath(sock_net(skb->sk), info->userhdr, info->attrs);
1537         if (IS_ERR(dp))
1538                 return;
1539
1540         WARN(dp->user_features, "Dropping previously announced user features\n");
1541         dp->user_features = 0;
1542 }
1543
1544 static void ovs_dp_change(struct datapath *dp, struct nlattr *a[])
1545 {
1546         if (a[OVS_DP_ATTR_USER_FEATURES])
1547                 dp->user_features = nla_get_u32(a[OVS_DP_ATTR_USER_FEATURES]);
1548 }
1549
1550 static int ovs_dp_cmd_new(struct sk_buff *skb, struct genl_info *info)
1551 {
1552         struct nlattr **a = info->attrs;
1553         struct vport_parms parms;
1554         struct sk_buff *reply;
1555         struct datapath *dp;
1556         struct vport *vport;
1557         struct ovs_net *ovs_net;
1558         int err, i;
1559
1560         err = -EINVAL;
1561         if (!a[OVS_DP_ATTR_NAME] || !a[OVS_DP_ATTR_UPCALL_PID])
1562                 goto err;
1563
1564         reply = ovs_dp_cmd_alloc_info();
1565         if (!reply)
1566                 return -ENOMEM;
1567
1568         err = -ENOMEM;
1569         dp = kzalloc(sizeof(*dp), GFP_KERNEL);
1570         if (dp == NULL)
1571                 goto err_free_reply;
1572
1573         ovs_dp_set_net(dp, sock_net(skb->sk));
1574
1575         /* Allocate table. */
1576         err = ovs_flow_tbl_init(&dp->table);
1577         if (err)
1578                 goto err_free_dp;
1579
1580         dp->stats_percpu = netdev_alloc_pcpu_stats(struct dp_stats_percpu);
1581         if (!dp->stats_percpu) {
1582                 err = -ENOMEM;
1583                 goto err_destroy_table;
1584         }
1585
1586         dp->ports = kmalloc_array(DP_VPORT_HASH_BUCKETS,
1587                                   sizeof(struct hlist_head),
1588                                   GFP_KERNEL);
1589         if (!dp->ports) {
1590                 err = -ENOMEM;
1591                 goto err_destroy_percpu;
1592         }
1593
1594         for (i = 0; i < DP_VPORT_HASH_BUCKETS; i++)
1595                 INIT_HLIST_HEAD(&dp->ports[i]);
1596
1597         err = ovs_meters_init(dp);
1598         if (err)
1599                 goto err_destroy_ports_array;
1600
1601         /* Set up our datapath device. */
1602         parms.name = nla_data(a[OVS_DP_ATTR_NAME]);
1603         parms.type = OVS_VPORT_TYPE_INTERNAL;
1604         parms.options = NULL;
1605         parms.dp = dp;
1606         parms.port_no = OVSP_LOCAL;
1607         parms.upcall_portids = a[OVS_DP_ATTR_UPCALL_PID];
1608
1609         ovs_dp_change(dp, a);
1610
1611         /* So far only local changes have been made, now need the lock. */
1612         ovs_lock();
1613
1614         vport = new_vport(&parms);
1615         if (IS_ERR(vport)) {
1616                 err = PTR_ERR(vport);
1617                 if (err == -EBUSY)
1618                         err = -EEXIST;
1619
1620                 if (err == -EEXIST) {
1621                         /* An outdated user space instance that does not understand
1622                          * the concept of user_features has attempted to create a new
1623                          * datapath and is likely to reuse it. Drop all user features.
1624                          */
1625                         if (info->genlhdr->version < OVS_DP_VER_FEATURES)
1626                                 ovs_dp_reset_user_features(skb, info);
1627                 }
1628
1629                 goto err_destroy_meters;
1630         }
1631
1632         err = ovs_dp_cmd_fill_info(dp, reply, info->snd_portid,
1633                                    info->snd_seq, 0, OVS_DP_CMD_NEW);
1634         BUG_ON(err < 0);
1635
1636         ovs_net = net_generic(ovs_dp_get_net(dp), ovs_net_id);
1637         list_add_tail_rcu(&dp->list_node, &ovs_net->dps);
1638
1639         ovs_unlock();
1640
1641         ovs_notify(&dp_datapath_genl_family, reply, info);
1642         return 0;
1643
1644 err_destroy_meters:
1645         ovs_unlock();
1646         ovs_meters_exit(dp);
1647 err_destroy_ports_array:
1648         kfree(dp->ports);
1649 err_destroy_percpu:
1650         free_percpu(dp->stats_percpu);
1651 err_destroy_table:
1652         ovs_flow_tbl_destroy(&dp->table);
1653 err_free_dp:
1654         kfree(dp);
1655 err_free_reply:
1656         kfree_skb(reply);
1657 err:
1658         return err;
1659 }
1660
1661 /* Called with ovs_mutex. */
1662 static void __dp_destroy(struct datapath *dp)
1663 {
1664         int i;
1665
1666         for (i = 0; i < DP_VPORT_HASH_BUCKETS; i++) {
1667                 struct vport *vport;
1668                 struct hlist_node *n;
1669
1670                 hlist_for_each_entry_safe(vport, n, &dp->ports[i], dp_hash_node)
1671                         if (vport->port_no != OVSP_LOCAL)
1672                                 ovs_dp_detach_port(vport);
1673         }
1674
1675         list_del_rcu(&dp->list_node);
1676
1677         /* OVSP_LOCAL is datapath internal port. We need to make sure that
1678          * all ports in datapath are destroyed first before freeing datapath.
1679          */
1680         ovs_dp_detach_port(ovs_vport_ovsl(dp, OVSP_LOCAL));
1681
1682         /* RCU destroy the flow table */
1683         call_rcu(&dp->rcu, destroy_dp_rcu);
1684 }
1685
1686 static int ovs_dp_cmd_del(struct sk_buff *skb, struct genl_info *info)
1687 {
1688         struct sk_buff *reply;
1689         struct datapath *dp;
1690         int err;
1691
1692         reply = ovs_dp_cmd_alloc_info();
1693         if (!reply)
1694                 return -ENOMEM;
1695
1696         ovs_lock();
1697         dp = lookup_datapath(sock_net(skb->sk), info->userhdr, info->attrs);
1698         err = PTR_ERR(dp);
1699         if (IS_ERR(dp))
1700                 goto err_unlock_free;
1701
1702         err = ovs_dp_cmd_fill_info(dp, reply, info->snd_portid,
1703                                    info->snd_seq, 0, OVS_DP_CMD_DEL);
1704         BUG_ON(err < 0);
1705
1706         __dp_destroy(dp);
1707         ovs_unlock();
1708
1709         ovs_notify(&dp_datapath_genl_family, reply, info);
1710
1711         return 0;
1712
1713 err_unlock_free:
1714         ovs_unlock();
1715         kfree_skb(reply);
1716         return err;
1717 }
1718
1719 static int ovs_dp_cmd_set(struct sk_buff *skb, struct genl_info *info)
1720 {
1721         struct sk_buff *reply;
1722         struct datapath *dp;
1723         int err;
1724
1725         reply = ovs_dp_cmd_alloc_info();
1726         if (!reply)
1727                 return -ENOMEM;
1728
1729         ovs_lock();
1730         dp = lookup_datapath(sock_net(skb->sk), info->userhdr, info->attrs);
1731         err = PTR_ERR(dp);
1732         if (IS_ERR(dp))
1733                 goto err_unlock_free;
1734
1735         ovs_dp_change(dp, info->attrs);
1736
1737         err = ovs_dp_cmd_fill_info(dp, reply, info->snd_portid,
1738                                    info->snd_seq, 0, OVS_DP_CMD_SET);
1739         BUG_ON(err < 0);
1740
1741         ovs_unlock();
1742         ovs_notify(&dp_datapath_genl_family, reply, info);
1743
1744         return 0;
1745
1746 err_unlock_free:
1747         ovs_unlock();
1748         kfree_skb(reply);
1749         return err;
1750 }
1751
1752 static int ovs_dp_cmd_get(struct sk_buff *skb, struct genl_info *info)
1753 {
1754         struct sk_buff *reply;
1755         struct datapath *dp;
1756         int err;
1757
1758         reply = ovs_dp_cmd_alloc_info();
1759         if (!reply)
1760                 return -ENOMEM;
1761
1762         ovs_lock();
1763         dp = lookup_datapath(sock_net(skb->sk), info->userhdr, info->attrs);
1764         if (IS_ERR(dp)) {
1765                 err = PTR_ERR(dp);
1766                 goto err_unlock_free;
1767         }
1768         err = ovs_dp_cmd_fill_info(dp, reply, info->snd_portid,
1769                                    info->snd_seq, 0, OVS_DP_CMD_GET);
1770         BUG_ON(err < 0);
1771         ovs_unlock();
1772
1773         return genlmsg_reply(reply, info);
1774
1775 err_unlock_free:
1776         ovs_unlock();
1777         kfree_skb(reply);
1778         return err;
1779 }
1780
1781 static int ovs_dp_cmd_dump(struct sk_buff *skb, struct netlink_callback *cb)
1782 {
1783         struct ovs_net *ovs_net = net_generic(sock_net(skb->sk), ovs_net_id);
1784         struct datapath *dp;
1785         int skip = cb->args[0];
1786         int i = 0;
1787
1788         ovs_lock();
1789         list_for_each_entry(dp, &ovs_net->dps, list_node) {
1790                 if (i >= skip &&
1791                     ovs_dp_cmd_fill_info(dp, skb, NETLINK_CB(cb->skb).portid,
1792                                          cb->nlh->nlmsg_seq, NLM_F_MULTI,
1793                                          OVS_DP_CMD_GET) < 0)
1794                         break;
1795                 i++;
1796         }
1797         ovs_unlock();
1798
1799         cb->args[0] = i;
1800
1801         return skb->len;
1802 }
1803
1804 static const struct nla_policy datapath_policy[OVS_DP_ATTR_MAX + 1] = {
1805         [OVS_DP_ATTR_NAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ - 1 },
1806         [OVS_DP_ATTR_UPCALL_PID] = { .type = NLA_U32 },
1807         [OVS_DP_ATTR_USER_FEATURES] = { .type = NLA_U32 },
1808 };
1809
1810 static const struct genl_ops dp_datapath_genl_ops[] = {
1811         { .cmd = OVS_DP_CMD_NEW,
1812           .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1813           .flags = GENL_UNS_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1814           .doit = ovs_dp_cmd_new
1815         },
1816         { .cmd = OVS_DP_CMD_DEL,
1817           .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1818           .flags = GENL_UNS_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1819           .doit = ovs_dp_cmd_del
1820         },
1821         { .cmd = OVS_DP_CMD_GET,
1822           .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1823           .flags = 0,               /* OK for unprivileged users. */
1824           .doit = ovs_dp_cmd_get,
1825           .dumpit = ovs_dp_cmd_dump
1826         },
1827         { .cmd = OVS_DP_CMD_SET,
1828           .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
1829           .flags = GENL_UNS_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
1830           .doit = ovs_dp_cmd_set,
1831         },
1832 };
1833
1834 static struct genl_family dp_datapath_genl_family __ro_after_init = {
1835         .hdrsize = sizeof(struct ovs_header),
1836         .name = OVS_DATAPATH_FAMILY,
1837         .version = OVS_DATAPATH_VERSION,
1838         .maxattr = OVS_DP_ATTR_MAX,
1839         .policy = datapath_policy,
1840         .netnsok = true,
1841         .parallel_ops = true,
1842         .ops = dp_datapath_genl_ops,
1843         .n_ops = ARRAY_SIZE(dp_datapath_genl_ops),
1844         .mcgrps = &ovs_dp_datapath_multicast_group,
1845         .n_mcgrps = 1,
1846         .module = THIS_MODULE,
1847 };
1848
1849 /* Called with ovs_mutex or RCU read lock. */
1850 static int ovs_vport_cmd_fill_info(struct vport *vport, struct sk_buff *skb,
1851                                    struct net *net, u32 portid, u32 seq,
1852                                    u32 flags, u8 cmd)
1853 {
1854         struct ovs_header *ovs_header;
1855         struct ovs_vport_stats vport_stats;
1856         int err;
1857
1858         ovs_header = genlmsg_put(skb, portid, seq, &dp_vport_genl_family,
1859                                  flags, cmd);
1860         if (!ovs_header)
1861                 return -EMSGSIZE;
1862
1863         ovs_header->dp_ifindex = get_dpifindex(vport->dp);
1864
1865         if (nla_put_u32(skb, OVS_VPORT_ATTR_PORT_NO, vport->port_no) ||
1866             nla_put_u32(skb, OVS_VPORT_ATTR_TYPE, vport->ops->type) ||
1867             nla_put_string(skb, OVS_VPORT_ATTR_NAME,
1868                            ovs_vport_name(vport)) ||
1869             nla_put_u32(skb, OVS_VPORT_ATTR_IFINDEX, vport->dev->ifindex))
1870                 goto nla_put_failure;
1871
1872         if (!net_eq(net, dev_net(vport->dev))) {
1873                 int id = peernet2id_alloc(net, dev_net(vport->dev));
1874
1875                 if (nla_put_s32(skb, OVS_VPORT_ATTR_NETNSID, id))
1876                         goto nla_put_failure;
1877         }
1878
1879         ovs_vport_get_stats(vport, &vport_stats);
1880         if (nla_put_64bit(skb, OVS_VPORT_ATTR_STATS,
1881                           sizeof(struct ovs_vport_stats), &vport_stats,
1882                           OVS_VPORT_ATTR_PAD))
1883                 goto nla_put_failure;
1884
1885         if (ovs_vport_get_upcall_portids(vport, skb))
1886                 goto nla_put_failure;
1887
1888         err = ovs_vport_get_options(vport, skb);
1889         if (err == -EMSGSIZE)
1890                 goto error;
1891
1892         genlmsg_end(skb, ovs_header);
1893         return 0;
1894
1895 nla_put_failure:
1896         err = -EMSGSIZE;
1897 error:
1898         genlmsg_cancel(skb, ovs_header);
1899         return err;
1900 }
1901
1902 static struct sk_buff *ovs_vport_cmd_alloc_info(void)
1903 {
1904         return nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1905 }
1906
1907 /* Called with ovs_mutex, only via ovs_dp_notify_wq(). */
1908 struct sk_buff *ovs_vport_cmd_build_info(struct vport *vport, struct net *net,
1909                                          u32 portid, u32 seq, u8 cmd)
1910 {
1911         struct sk_buff *skb;
1912         int retval;
1913
1914         skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
1915         if (!skb)
1916                 return ERR_PTR(-ENOMEM);
1917
1918         retval = ovs_vport_cmd_fill_info(vport, skb, net, portid, seq, 0, cmd);
1919         BUG_ON(retval < 0);
1920
1921         return skb;
1922 }
1923
1924 /* Called with ovs_mutex or RCU read lock. */
1925 static struct vport *lookup_vport(struct net *net,
1926                                   const struct ovs_header *ovs_header,
1927                                   struct nlattr *a[OVS_VPORT_ATTR_MAX + 1])
1928 {
1929         struct datapath *dp;
1930         struct vport *vport;
1931
1932         if (a[OVS_VPORT_ATTR_IFINDEX])
1933                 return ERR_PTR(-EOPNOTSUPP);
1934         if (a[OVS_VPORT_ATTR_NAME]) {
1935                 vport = ovs_vport_locate(net, nla_data(a[OVS_VPORT_ATTR_NAME]));
1936                 if (!vport)
1937                         return ERR_PTR(-ENODEV);
1938                 if (ovs_header->dp_ifindex &&
1939                     ovs_header->dp_ifindex != get_dpifindex(vport->dp))
1940                         return ERR_PTR(-ENODEV);
1941                 return vport;
1942         } else if (a[OVS_VPORT_ATTR_PORT_NO]) {
1943                 u32 port_no = nla_get_u32(a[OVS_VPORT_ATTR_PORT_NO]);
1944
1945                 if (port_no >= DP_MAX_PORTS)
1946                         return ERR_PTR(-EFBIG);
1947
1948                 dp = get_dp(net, ovs_header->dp_ifindex);
1949                 if (!dp)
1950                         return ERR_PTR(-ENODEV);
1951
1952                 vport = ovs_vport_ovsl_rcu(dp, port_no);
1953                 if (!vport)
1954                         return ERR_PTR(-ENODEV);
1955                 return vport;
1956         } else
1957                 return ERR_PTR(-EINVAL);
1958
1959 }
1960
1961 static unsigned int ovs_get_max_headroom(struct datapath *dp)
1962 {
1963         unsigned int dev_headroom, max_headroom = 0;
1964         struct net_device *dev;
1965         struct vport *vport;
1966         int i;
1967
1968         for (i = 0; i < DP_VPORT_HASH_BUCKETS; i++) {
1969                 hlist_for_each_entry_rcu(vport, &dp->ports[i], dp_hash_node) {
1970                         dev = vport->dev;
1971                         dev_headroom = netdev_get_fwd_headroom(dev);
1972                         if (dev_headroom > max_headroom)
1973                                 max_headroom = dev_headroom;
1974                 }
1975         }
1976
1977         return max_headroom;
1978 }
1979
1980 /* Called with ovs_mutex */
1981 static void ovs_update_headroom(struct datapath *dp, unsigned int new_headroom)
1982 {
1983         struct vport *vport;
1984         int i;
1985
1986         dp->max_headroom = new_headroom;
1987         for (i = 0; i < DP_VPORT_HASH_BUCKETS; i++)
1988                 hlist_for_each_entry_rcu(vport, &dp->ports[i], dp_hash_node)
1989                         netdev_set_rx_headroom(vport->dev, new_headroom);
1990 }
1991
1992 static int ovs_vport_cmd_new(struct sk_buff *skb, struct genl_info *info)
1993 {
1994         struct nlattr **a = info->attrs;
1995         struct ovs_header *ovs_header = info->userhdr;
1996         struct vport_parms parms;
1997         struct sk_buff *reply;
1998         struct vport *vport;
1999         struct datapath *dp;
2000         unsigned int new_headroom;
2001         u32 port_no;
2002         int err;
2003
2004         if (!a[OVS_VPORT_ATTR_NAME] || !a[OVS_VPORT_ATTR_TYPE] ||
2005             !a[OVS_VPORT_ATTR_UPCALL_PID])
2006                 return -EINVAL;
2007         if (a[OVS_VPORT_ATTR_IFINDEX])
2008                 return -EOPNOTSUPP;
2009
2010         port_no = a[OVS_VPORT_ATTR_PORT_NO]
2011                 ? nla_get_u32(a[OVS_VPORT_ATTR_PORT_NO]) : 0;
2012         if (port_no >= DP_MAX_PORTS)
2013                 return -EFBIG;
2014
2015         reply = ovs_vport_cmd_alloc_info();
2016         if (!reply)
2017                 return -ENOMEM;
2018
2019         ovs_lock();
2020 restart:
2021         dp = get_dp(sock_net(skb->sk), ovs_header->dp_ifindex);
2022         err = -ENODEV;
2023         if (!dp)
2024                 goto exit_unlock_free;
2025
2026         if (port_no) {
2027                 vport = ovs_vport_ovsl(dp, port_no);
2028                 err = -EBUSY;
2029                 if (vport)
2030                         goto exit_unlock_free;
2031         } else {
2032                 for (port_no = 1; ; port_no++) {
2033                         if (port_no >= DP_MAX_PORTS) {
2034                                 err = -EFBIG;
2035                                 goto exit_unlock_free;
2036                         }
2037                         vport = ovs_vport_ovsl(dp, port_no);
2038                         if (!vport)
2039                                 break;
2040                 }
2041         }
2042
2043         parms.name = nla_data(a[OVS_VPORT_ATTR_NAME]);
2044         parms.type = nla_get_u32(a[OVS_VPORT_ATTR_TYPE]);
2045         parms.options = a[OVS_VPORT_ATTR_OPTIONS];
2046         parms.dp = dp;
2047         parms.port_no = port_no;
2048         parms.upcall_portids = a[OVS_VPORT_ATTR_UPCALL_PID];
2049
2050         vport = new_vport(&parms);
2051         err = PTR_ERR(vport);
2052         if (IS_ERR(vport)) {
2053                 if (err == -EAGAIN)
2054                         goto restart;
2055                 goto exit_unlock_free;
2056         }
2057
2058         err = ovs_vport_cmd_fill_info(vport, reply, genl_info_net(info),
2059                                       info->snd_portid, info->snd_seq, 0,
2060                                       OVS_VPORT_CMD_NEW);
2061
2062         new_headroom = netdev_get_fwd_headroom(vport->dev);
2063
2064         if (new_headroom > dp->max_headroom)
2065                 ovs_update_headroom(dp, new_headroom);
2066         else
2067                 netdev_set_rx_headroom(vport->dev, dp->max_headroom);
2068
2069         BUG_ON(err < 0);
2070         ovs_unlock();
2071
2072         ovs_notify(&dp_vport_genl_family, reply, info);
2073         return 0;
2074
2075 exit_unlock_free:
2076         ovs_unlock();
2077         kfree_skb(reply);
2078         return err;
2079 }
2080
2081 static int ovs_vport_cmd_set(struct sk_buff *skb, struct genl_info *info)
2082 {
2083         struct nlattr **a = info->attrs;
2084         struct sk_buff *reply;
2085         struct vport *vport;
2086         int err;
2087
2088         reply = ovs_vport_cmd_alloc_info();
2089         if (!reply)
2090                 return -ENOMEM;
2091
2092         ovs_lock();
2093         vport = lookup_vport(sock_net(skb->sk), info->userhdr, a);
2094         err = PTR_ERR(vport);
2095         if (IS_ERR(vport))
2096                 goto exit_unlock_free;
2097
2098         if (a[OVS_VPORT_ATTR_TYPE] &&
2099             nla_get_u32(a[OVS_VPORT_ATTR_TYPE]) != vport->ops->type) {
2100                 err = -EINVAL;
2101                 goto exit_unlock_free;
2102         }
2103
2104         if (a[OVS_VPORT_ATTR_OPTIONS]) {
2105                 err = ovs_vport_set_options(vport, a[OVS_VPORT_ATTR_OPTIONS]);
2106                 if (err)
2107                         goto exit_unlock_free;
2108         }
2109
2110
2111         if (a[OVS_VPORT_ATTR_UPCALL_PID]) {
2112                 struct nlattr *ids = a[OVS_VPORT_ATTR_UPCALL_PID];
2113
2114                 err = ovs_vport_set_upcall_portids(vport, ids);
2115                 if (err)
2116                         goto exit_unlock_free;
2117         }
2118
2119         err = ovs_vport_cmd_fill_info(vport, reply, genl_info_net(info),
2120                                       info->snd_portid, info->snd_seq, 0,
2121                                       OVS_VPORT_CMD_SET);
2122         BUG_ON(err < 0);
2123
2124         ovs_unlock();
2125         ovs_notify(&dp_vport_genl_family, reply, info);
2126         return 0;
2127
2128 exit_unlock_free:
2129         ovs_unlock();
2130         kfree_skb(reply);
2131         return err;
2132 }
2133
2134 static int ovs_vport_cmd_del(struct sk_buff *skb, struct genl_info *info)
2135 {
2136         bool update_headroom = false;
2137         struct nlattr **a = info->attrs;
2138         struct sk_buff *reply;
2139         struct datapath *dp;
2140         struct vport *vport;
2141         unsigned int new_headroom;
2142         int err;
2143
2144         reply = ovs_vport_cmd_alloc_info();
2145         if (!reply)
2146                 return -ENOMEM;
2147
2148         ovs_lock();
2149         vport = lookup_vport(sock_net(skb->sk), info->userhdr, a);
2150         err = PTR_ERR(vport);
2151         if (IS_ERR(vport))
2152                 goto exit_unlock_free;
2153
2154         if (vport->port_no == OVSP_LOCAL) {
2155                 err = -EINVAL;
2156                 goto exit_unlock_free;
2157         }
2158
2159         err = ovs_vport_cmd_fill_info(vport, reply, genl_info_net(info),
2160                                       info->snd_portid, info->snd_seq, 0,
2161                                       OVS_VPORT_CMD_DEL);
2162         BUG_ON(err < 0);
2163
2164         /* the vport deletion may trigger dp headroom update */
2165         dp = vport->dp;
2166         if (netdev_get_fwd_headroom(vport->dev) == dp->max_headroom)
2167                 update_headroom = true;
2168
2169         netdev_reset_rx_headroom(vport->dev);
2170         ovs_dp_detach_port(vport);
2171
2172         if (update_headroom) {
2173                 new_headroom = ovs_get_max_headroom(dp);
2174
2175                 if (new_headroom < dp->max_headroom)
2176                         ovs_update_headroom(dp, new_headroom);
2177         }
2178         ovs_unlock();
2179
2180         ovs_notify(&dp_vport_genl_family, reply, info);
2181         return 0;
2182
2183 exit_unlock_free:
2184         ovs_unlock();
2185         kfree_skb(reply);
2186         return err;
2187 }
2188
2189 static int ovs_vport_cmd_get(struct sk_buff *skb, struct genl_info *info)
2190 {
2191         struct nlattr **a = info->attrs;
2192         struct ovs_header *ovs_header = info->userhdr;
2193         struct sk_buff *reply;
2194         struct vport *vport;
2195         int err;
2196
2197         reply = ovs_vport_cmd_alloc_info();
2198         if (!reply)
2199                 return -ENOMEM;
2200
2201         rcu_read_lock();
2202         vport = lookup_vport(sock_net(skb->sk), ovs_header, a);
2203         err = PTR_ERR(vport);
2204         if (IS_ERR(vport))
2205                 goto exit_unlock_free;
2206         err = ovs_vport_cmd_fill_info(vport, reply, genl_info_net(info),
2207                                       info->snd_portid, info->snd_seq, 0,
2208                                       OVS_VPORT_CMD_GET);
2209         BUG_ON(err < 0);
2210         rcu_read_unlock();
2211
2212         return genlmsg_reply(reply, info);
2213
2214 exit_unlock_free:
2215         rcu_read_unlock();
2216         kfree_skb(reply);
2217         return err;
2218 }
2219
2220 static int ovs_vport_cmd_dump(struct sk_buff *skb, struct netlink_callback *cb)
2221 {
2222         struct ovs_header *ovs_header = genlmsg_data(nlmsg_data(cb->nlh));
2223         struct datapath *dp;
2224         int bucket = cb->args[0], skip = cb->args[1];
2225         int i, j = 0;
2226
2227         rcu_read_lock();
2228         dp = get_dp_rcu(sock_net(skb->sk), ovs_header->dp_ifindex);
2229         if (!dp) {
2230                 rcu_read_unlock();
2231                 return -ENODEV;
2232         }
2233         for (i = bucket; i < DP_VPORT_HASH_BUCKETS; i++) {
2234                 struct vport *vport;
2235
2236                 j = 0;
2237                 hlist_for_each_entry_rcu(vport, &dp->ports[i], dp_hash_node) {
2238                         if (j >= skip &&
2239                             ovs_vport_cmd_fill_info(vport, skb,
2240                                                     sock_net(skb->sk),
2241                                                     NETLINK_CB(cb->skb).portid,
2242                                                     cb->nlh->nlmsg_seq,
2243                                                     NLM_F_MULTI,
2244                                                     OVS_VPORT_CMD_GET) < 0)
2245                                 goto out;
2246
2247                         j++;
2248                 }
2249                 skip = 0;
2250         }
2251 out:
2252         rcu_read_unlock();
2253
2254         cb->args[0] = i;
2255         cb->args[1] = j;
2256
2257         return skb->len;
2258 }
2259
2260 static const struct nla_policy vport_policy[OVS_VPORT_ATTR_MAX + 1] = {
2261         [OVS_VPORT_ATTR_NAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ - 1 },
2262         [OVS_VPORT_ATTR_STATS] = { .len = sizeof(struct ovs_vport_stats) },
2263         [OVS_VPORT_ATTR_PORT_NO] = { .type = NLA_U32 },
2264         [OVS_VPORT_ATTR_TYPE] = { .type = NLA_U32 },
2265         [OVS_VPORT_ATTR_UPCALL_PID] = { .type = NLA_U32 },
2266         [OVS_VPORT_ATTR_OPTIONS] = { .type = NLA_NESTED },
2267         [OVS_VPORT_ATTR_IFINDEX] = { .type = NLA_U32 },
2268         [OVS_VPORT_ATTR_NETNSID] = { .type = NLA_S32 },
2269 };
2270
2271 static const struct genl_ops dp_vport_genl_ops[] = {
2272         { .cmd = OVS_VPORT_CMD_NEW,
2273           .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
2274           .flags = GENL_UNS_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
2275           .doit = ovs_vport_cmd_new
2276         },
2277         { .cmd = OVS_VPORT_CMD_DEL,
2278           .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
2279           .flags = GENL_UNS_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
2280           .doit = ovs_vport_cmd_del
2281         },
2282         { .cmd = OVS_VPORT_CMD_GET,
2283           .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
2284           .flags = 0,               /* OK for unprivileged users. */
2285           .doit = ovs_vport_cmd_get,
2286           .dumpit = ovs_vport_cmd_dump
2287         },
2288         { .cmd = OVS_VPORT_CMD_SET,
2289           .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
2290           .flags = GENL_UNS_ADMIN_PERM, /* Requires CAP_NET_ADMIN privilege. */
2291           .doit = ovs_vport_cmd_set,
2292         },
2293 };
2294
2295 struct genl_family dp_vport_genl_family __ro_after_init = {
2296         .hdrsize = sizeof(struct ovs_header),
2297         .name = OVS_VPORT_FAMILY,
2298         .version = OVS_VPORT_VERSION,
2299         .maxattr = OVS_VPORT_ATTR_MAX,
2300         .policy = vport_policy,
2301         .netnsok = true,
2302         .parallel_ops = true,
2303         .ops = dp_vport_genl_ops,
2304         .n_ops = ARRAY_SIZE(dp_vport_genl_ops),
2305         .mcgrps = &ovs_dp_vport_multicast_group,
2306         .n_mcgrps = 1,
2307         .module = THIS_MODULE,
2308 };
2309
2310 static struct genl_family * const dp_genl_families[] = {
2311         &dp_datapath_genl_family,
2312         &dp_vport_genl_family,
2313         &dp_flow_genl_family,
2314         &dp_packet_genl_family,
2315         &dp_meter_genl_family,
2316 #if     IS_ENABLED(CONFIG_NETFILTER_CONNCOUNT)
2317         &dp_ct_limit_genl_family,
2318 #endif
2319 };
2320
2321 static void dp_unregister_genl(int n_families)
2322 {
2323         int i;
2324
2325         for (i = 0; i < n_families; i++)
2326                 genl_unregister_family(dp_genl_families[i]);
2327 }
2328
2329 static int __init dp_register_genl(void)
2330 {
2331         int err;
2332         int i;
2333
2334         for (i = 0; i < ARRAY_SIZE(dp_genl_families); i++) {
2335
2336                 err = genl_register_family(dp_genl_families[i]);
2337                 if (err)
2338                         goto error;
2339         }
2340
2341         return 0;
2342
2343 error:
2344         dp_unregister_genl(i);
2345         return err;
2346 }
2347
2348 static int __net_init ovs_init_net(struct net *net)
2349 {
2350         struct ovs_net *ovs_net = net_generic(net, ovs_net_id);
2351
2352         INIT_LIST_HEAD(&ovs_net->dps);
2353         INIT_WORK(&ovs_net->dp_notify_work, ovs_dp_notify_wq);
2354         return ovs_ct_init(net);
2355 }
2356
2357 static void __net_exit list_vports_from_net(struct net *net, struct net *dnet,
2358                                             struct list_head *head)
2359 {
2360         struct ovs_net *ovs_net = net_generic(net, ovs_net_id);
2361         struct datapath *dp;
2362
2363         list_for_each_entry(dp, &ovs_net->dps, list_node) {
2364                 int i;
2365
2366                 for (i = 0; i < DP_VPORT_HASH_BUCKETS; i++) {
2367                         struct vport *vport;
2368
2369                         hlist_for_each_entry(vport, &dp->ports[i], dp_hash_node) {
2370                                 if (vport->ops->type != OVS_VPORT_TYPE_INTERNAL)
2371                                         continue;
2372
2373                                 if (dev_net(vport->dev) == dnet)
2374                                         list_add(&vport->detach_list, head);
2375                         }
2376                 }
2377         }
2378 }
2379
2380 static void __net_exit ovs_exit_net(struct net *dnet)
2381 {
2382         struct datapath *dp, *dp_next;
2383         struct ovs_net *ovs_net = net_generic(dnet, ovs_net_id);
2384         struct vport *vport, *vport_next;
2385         struct net *net;
2386         LIST_HEAD(head);
2387
2388         ovs_ct_exit(dnet);
2389         ovs_lock();
2390         list_for_each_entry_safe(dp, dp_next, &ovs_net->dps, list_node)
2391                 __dp_destroy(dp);
2392
2393         down_read(&net_rwsem);
2394         for_each_net(net)
2395                 list_vports_from_net(net, dnet, &head);
2396         up_read(&net_rwsem);
2397
2398         /* Detach all vports from given namespace. */
2399         list_for_each_entry_safe(vport, vport_next, &head, detach_list) {
2400                 list_del(&vport->detach_list);
2401                 ovs_dp_detach_port(vport);
2402         }
2403
2404         ovs_unlock();
2405
2406         cancel_work_sync(&ovs_net->dp_notify_work);
2407 }
2408
2409 static struct pernet_operations ovs_net_ops = {
2410         .init = ovs_init_net,
2411         .exit = ovs_exit_net,
2412         .id   = &ovs_net_id,
2413         .size = sizeof(struct ovs_net),
2414 };
2415
2416 static int __init dp_init(void)
2417 {
2418         int err;
2419
2420         BUILD_BUG_ON(sizeof(struct ovs_skb_cb) > FIELD_SIZEOF(struct sk_buff, cb));
2421
2422         pr_info("Open vSwitch switching datapath\n");
2423
2424         err = action_fifos_init();
2425         if (err)
2426                 goto error;
2427
2428         err = ovs_internal_dev_rtnl_link_register();
2429         if (err)
2430                 goto error_action_fifos_exit;
2431
2432         err = ovs_flow_init();
2433         if (err)
2434                 goto error_unreg_rtnl_link;
2435
2436         err = ovs_vport_init();
2437         if (err)
2438                 goto error_flow_exit;
2439
2440         err = register_pernet_device(&ovs_net_ops);
2441         if (err)
2442                 goto error_vport_exit;
2443
2444         err = register_netdevice_notifier(&ovs_dp_device_notifier);
2445         if (err)
2446                 goto error_netns_exit;
2447
2448         err = ovs_netdev_init();
2449         if (err)
2450                 goto error_unreg_notifier;
2451
2452         err = dp_register_genl();
2453         if (err < 0)
2454                 goto error_unreg_netdev;
2455
2456         return 0;
2457
2458 error_unreg_netdev:
2459         ovs_netdev_exit();
2460 error_unreg_notifier:
2461         unregister_netdevice_notifier(&ovs_dp_device_notifier);
2462 error_netns_exit:
2463         unregister_pernet_device(&ovs_net_ops);
2464 error_vport_exit:
2465         ovs_vport_exit();
2466 error_flow_exit:
2467         ovs_flow_exit();
2468 error_unreg_rtnl_link:
2469         ovs_internal_dev_rtnl_link_unregister();
2470 error_action_fifos_exit:
2471         action_fifos_exit();
2472 error:
2473         return err;
2474 }
2475
2476 static void dp_cleanup(void)
2477 {
2478         dp_unregister_genl(ARRAY_SIZE(dp_genl_families));
2479         ovs_netdev_exit();
2480         unregister_netdevice_notifier(&ovs_dp_device_notifier);
2481         unregister_pernet_device(&ovs_net_ops);
2482         rcu_barrier();
2483         ovs_vport_exit();
2484         ovs_flow_exit();
2485         ovs_internal_dev_rtnl_link_unregister();
2486         action_fifos_exit();
2487 }
2488
2489 module_init(dp_init);
2490 module_exit(dp_cleanup);
2491
2492 MODULE_DESCRIPTION("Open vSwitch switching datapath");
2493 MODULE_LICENSE("GPL");
2494 MODULE_ALIAS_GENL_FAMILY(OVS_DATAPATH_FAMILY);
2495 MODULE_ALIAS_GENL_FAMILY(OVS_VPORT_FAMILY);
2496 MODULE_ALIAS_GENL_FAMILY(OVS_FLOW_FAMILY);
2497 MODULE_ALIAS_GENL_FAMILY(OVS_PACKET_FAMILY);
2498 MODULE_ALIAS_GENL_FAMILY(OVS_METER_FAMILY);
2499 MODULE_ALIAS_GENL_FAMILY(OVS_CT_LIMIT_FAMILY);