openvswitch: Fix GSO with multiple MPLS label.
[cascardo/linux.git] / net / openvswitch / vport.c
1 /*
2  * Copyright (c) 2007-2014 Nicira, Inc.
3  *
4  * This program is free software; you can redistribute it and/or
5  * modify it under the terms of version 2 of the GNU General Public
6  * License as published by the Free Software Foundation.
7  *
8  * This program is distributed in the hope that it will be useful, but
9  * WITHOUT ANY WARRANTY; without even the implied warranty of
10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
11  * General Public License for more details.
12  *
13  * You should have received a copy of the GNU General Public License
14  * along with this program; if not, write to the Free Software
15  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
16  * 02110-1301, USA
17  */
18
19 #include <linux/etherdevice.h>
20 #include <linux/if.h>
21 #include <linux/if_vlan.h>
22 #include <linux/jhash.h>
23 #include <linux/kernel.h>
24 #include <linux/list.h>
25 #include <linux/mutex.h>
26 #include <linux/percpu.h>
27 #include <linux/rcupdate.h>
28 #include <linux/rtnetlink.h>
29 #include <linux/compat.h>
30 #include <net/net_namespace.h>
31 #include <linux/module.h>
32
33 #include "datapath.h"
34 #include "vport.h"
35 #include "vport-internal_dev.h"
36
37 static void ovs_vport_record_error(struct vport *,
38                                    enum vport_err_type err_type);
39
40 static LIST_HEAD(vport_ops_list);
41
42 /* Protected by RCU read lock for reading, ovs_mutex for writing. */
43 static struct hlist_head *dev_table;
44 #define VPORT_HASH_BUCKETS 1024
45
46 /**
47  *      ovs_vport_init - initialize vport subsystem
48  *
49  * Called at module load time to initialize the vport subsystem.
50  */
51 int ovs_vport_init(void)
52 {
53         dev_table = kzalloc(VPORT_HASH_BUCKETS * sizeof(struct hlist_head),
54                             GFP_KERNEL);
55         if (!dev_table)
56                 return -ENOMEM;
57
58         return 0;
59 }
60
61 /**
62  *      ovs_vport_exit - shutdown vport subsystem
63  *
64  * Called at module exit time to shutdown the vport subsystem.
65  */
66 void ovs_vport_exit(void)
67 {
68         kfree(dev_table);
69 }
70
71 static struct hlist_head *hash_bucket(const struct net *net, const char *name)
72 {
73         unsigned int hash = jhash(name, strlen(name), (unsigned long) net);
74         return &dev_table[hash & (VPORT_HASH_BUCKETS - 1)];
75 }
76
77 int ovs_vport_ops_register(struct vport_ops *ops)
78 {
79         int err = -EEXIST;
80         struct vport_ops *o;
81
82         ovs_lock();
83         list_for_each_entry(o, &vport_ops_list, list)
84                 if (ops->type == o->type)
85                         goto errout;
86
87         list_add_tail(&ops->list, &vport_ops_list);
88         err = 0;
89 errout:
90         ovs_unlock();
91         return err;
92 }
93 EXPORT_SYMBOL_GPL(ovs_vport_ops_register);
94
95 void ovs_vport_ops_unregister(struct vport_ops *ops)
96 {
97         ovs_lock();
98         list_del(&ops->list);
99         ovs_unlock();
100 }
101 EXPORT_SYMBOL_GPL(ovs_vport_ops_unregister);
102
103 /**
104  *      ovs_vport_locate - find a port that has already been created
105  *
106  * @name: name of port to find
107  *
108  * Must be called with ovs or RCU read lock.
109  */
110 struct vport *ovs_vport_locate(const struct net *net, const char *name)
111 {
112         struct hlist_head *bucket = hash_bucket(net, name);
113         struct vport *vport;
114
115         hlist_for_each_entry_rcu(vport, bucket, hash_node)
116                 if (!strcmp(name, vport->ops->get_name(vport)) &&
117                     net_eq(ovs_dp_get_net(vport->dp), net))
118                         return vport;
119
120         return NULL;
121 }
122
123 /**
124  *      ovs_vport_alloc - allocate and initialize new vport
125  *
126  * @priv_size: Size of private data area to allocate.
127  * @ops: vport device ops
128  *
129  * Allocate and initialize a new vport defined by @ops.  The vport will contain
130  * a private data area of size @priv_size that can be accessed using
131  * vport_priv().  vports that are no longer needed should be released with
132  * vport_free().
133  */
134 struct vport *ovs_vport_alloc(int priv_size, const struct vport_ops *ops,
135                           const struct vport_parms *parms)
136 {
137         struct vport *vport;
138         size_t alloc_size;
139
140         alloc_size = sizeof(struct vport);
141         if (priv_size) {
142                 alloc_size = ALIGN(alloc_size, VPORT_ALIGN);
143                 alloc_size += priv_size;
144         }
145
146         vport = kzalloc(alloc_size, GFP_KERNEL);
147         if (!vport)
148                 return ERR_PTR(-ENOMEM);
149
150         vport->dp = parms->dp;
151         vport->port_no = parms->port_no;
152         vport->ops = ops;
153         INIT_HLIST_NODE(&vport->dp_hash_node);
154
155         if (ovs_vport_set_upcall_portids(vport, parms->upcall_portids)) {
156                 kfree(vport);
157                 return ERR_PTR(-EINVAL);
158         }
159
160         vport->percpu_stats = netdev_alloc_pcpu_stats(struct pcpu_sw_netstats);
161         if (!vport->percpu_stats) {
162                 kfree(vport);
163                 return ERR_PTR(-ENOMEM);
164         }
165
166         return vport;
167 }
168 EXPORT_SYMBOL_GPL(ovs_vport_alloc);
169
170 /**
171  *      ovs_vport_free - uninitialize and free vport
172  *
173  * @vport: vport to free
174  *
175  * Frees a vport allocated with vport_alloc() when it is no longer needed.
176  *
177  * The caller must ensure that an RCU grace period has passed since the last
178  * time @vport was in a datapath.
179  */
180 void ovs_vport_free(struct vport *vport)
181 {
182         /* vport is freed from RCU callback or error path, Therefore
183          * it is safe to use raw dereference.
184          */
185         kfree(rcu_dereference_raw(vport->upcall_portids));
186         free_percpu(vport->percpu_stats);
187         kfree(vport);
188 }
189 EXPORT_SYMBOL_GPL(ovs_vport_free);
190
191 static struct vport_ops *ovs_vport_lookup(const struct vport_parms *parms)
192 {
193         struct vport_ops *ops;
194
195         list_for_each_entry(ops, &vport_ops_list, list)
196                 if (ops->type == parms->type)
197                         return ops;
198
199         return NULL;
200 }
201
202 /**
203  *      ovs_vport_add - add vport device (for kernel callers)
204  *
205  * @parms: Information about new vport.
206  *
207  * Creates a new vport with the specified configuration (which is dependent on
208  * device type).  ovs_mutex must be held.
209  */
210 struct vport *ovs_vport_add(const struct vport_parms *parms)
211 {
212         struct vport_ops *ops;
213         struct vport *vport;
214
215         ops = ovs_vport_lookup(parms);
216         if (ops) {
217                 struct hlist_head *bucket;
218
219                 if (!try_module_get(ops->owner))
220                         return ERR_PTR(-EAFNOSUPPORT);
221
222                 vport = ops->create(parms);
223                 if (IS_ERR(vport)) {
224                         module_put(ops->owner);
225                         return vport;
226                 }
227
228                 bucket = hash_bucket(ovs_dp_get_net(vport->dp),
229                                      vport->ops->get_name(vport));
230                 hlist_add_head_rcu(&vport->hash_node, bucket);
231                 return vport;
232         }
233
234         /* Unlock to attempt module load and return -EAGAIN if load
235          * was successful as we need to restart the port addition
236          * workflow.
237          */
238         ovs_unlock();
239         request_module("vport-type-%d", parms->type);
240         ovs_lock();
241
242         if (!ovs_vport_lookup(parms))
243                 return ERR_PTR(-EAFNOSUPPORT);
244         else
245                 return ERR_PTR(-EAGAIN);
246 }
247
248 /**
249  *      ovs_vport_set_options - modify existing vport device (for kernel callers)
250  *
251  * @vport: vport to modify.
252  * @options: New configuration.
253  *
254  * Modifies an existing device with the specified configuration (which is
255  * dependent on device type).  ovs_mutex must be held.
256  */
257 int ovs_vport_set_options(struct vport *vport, struct nlattr *options)
258 {
259         if (!vport->ops->set_options)
260                 return -EOPNOTSUPP;
261         return vport->ops->set_options(vport, options);
262 }
263
264 /**
265  *      ovs_vport_del - delete existing vport device
266  *
267  * @vport: vport to delete.
268  *
269  * Detaches @vport from its datapath and destroys it.  It is possible to fail
270  * for reasons such as lack of memory.  ovs_mutex must be held.
271  */
272 void ovs_vport_del(struct vport *vport)
273 {
274         ASSERT_OVSL();
275
276         hlist_del_rcu(&vport->hash_node);
277
278         vport->ops->destroy(vport);
279
280         module_put(vport->ops->owner);
281 }
282
283 /**
284  *      ovs_vport_get_stats - retrieve device stats
285  *
286  * @vport: vport from which to retrieve the stats
287  * @stats: location to store stats
288  *
289  * Retrieves transmit, receive, and error stats for the given device.
290  *
291  * Must be called with ovs_mutex or rcu_read_lock.
292  */
293 void ovs_vport_get_stats(struct vport *vport, struct ovs_vport_stats *stats)
294 {
295         int i;
296
297         memset(stats, 0, sizeof(*stats));
298
299         /* We potentially have 2 sources of stats that need to be combined:
300          * those we have collected (split into err_stats and percpu_stats) from
301          * set_stats() and device error stats from netdev->get_stats() (for
302          * errors that happen  downstream and therefore aren't reported through
303          * our vport_record_error() function).
304          * Stats from first source are reported by ovs (OVS_VPORT_ATTR_STATS).
305          * netdev-stats can be directly read over netlink-ioctl.
306          */
307
308         stats->rx_errors  = atomic_long_read(&vport->err_stats.rx_errors);
309         stats->tx_errors  = atomic_long_read(&vport->err_stats.tx_errors);
310         stats->tx_dropped = atomic_long_read(&vport->err_stats.tx_dropped);
311         stats->rx_dropped = atomic_long_read(&vport->err_stats.rx_dropped);
312
313         for_each_possible_cpu(i) {
314                 const struct pcpu_sw_netstats *percpu_stats;
315                 struct pcpu_sw_netstats local_stats;
316                 unsigned int start;
317
318                 percpu_stats = per_cpu_ptr(vport->percpu_stats, i);
319
320                 do {
321                         start = u64_stats_fetch_begin_irq(&percpu_stats->syncp);
322                         local_stats = *percpu_stats;
323                 } while (u64_stats_fetch_retry_irq(&percpu_stats->syncp, start));
324
325                 stats->rx_bytes         += local_stats.rx_bytes;
326                 stats->rx_packets       += local_stats.rx_packets;
327                 stats->tx_bytes         += local_stats.tx_bytes;
328                 stats->tx_packets       += local_stats.tx_packets;
329         }
330 }
331
332 /**
333  *      ovs_vport_get_options - retrieve device options
334  *
335  * @vport: vport from which to retrieve the options.
336  * @skb: sk_buff where options should be appended.
337  *
338  * Retrieves the configuration of the given device, appending an
339  * %OVS_VPORT_ATTR_OPTIONS attribute that in turn contains nested
340  * vport-specific attributes to @skb.
341  *
342  * Returns 0 if successful, -EMSGSIZE if @skb has insufficient room, or another
343  * negative error code if a real error occurred.  If an error occurs, @skb is
344  * left unmodified.
345  *
346  * Must be called with ovs_mutex or rcu_read_lock.
347  */
348 int ovs_vport_get_options(const struct vport *vport, struct sk_buff *skb)
349 {
350         struct nlattr *nla;
351         int err;
352
353         if (!vport->ops->get_options)
354                 return 0;
355
356         nla = nla_nest_start(skb, OVS_VPORT_ATTR_OPTIONS);
357         if (!nla)
358                 return -EMSGSIZE;
359
360         err = vport->ops->get_options(vport, skb);
361         if (err) {
362                 nla_nest_cancel(skb, nla);
363                 return err;
364         }
365
366         nla_nest_end(skb, nla);
367         return 0;
368 }
369
370 /**
371  *      ovs_vport_set_upcall_portids - set upcall portids of @vport.
372  *
373  * @vport: vport to modify.
374  * @ids: new configuration, an array of port ids.
375  *
376  * Sets the vport's upcall_portids to @ids.
377  *
378  * Returns 0 if successful, -EINVAL if @ids is zero length or cannot be parsed
379  * as an array of U32.
380  *
381  * Must be called with ovs_mutex.
382  */
383 int ovs_vport_set_upcall_portids(struct vport *vport, const struct nlattr *ids)
384 {
385         struct vport_portids *old, *vport_portids;
386
387         if (!nla_len(ids) || nla_len(ids) % sizeof(u32))
388                 return -EINVAL;
389
390         old = ovsl_dereference(vport->upcall_portids);
391
392         vport_portids = kmalloc(sizeof(*vport_portids) + nla_len(ids),
393                                 GFP_KERNEL);
394         if (!vport_portids)
395                 return -ENOMEM;
396
397         vport_portids->n_ids = nla_len(ids) / sizeof(u32);
398         vport_portids->rn_ids = reciprocal_value(vport_portids->n_ids);
399         nla_memcpy(vport_portids->ids, ids, nla_len(ids));
400
401         rcu_assign_pointer(vport->upcall_portids, vport_portids);
402
403         if (old)
404                 kfree_rcu(old, rcu);
405         return 0;
406 }
407
408 /**
409  *      ovs_vport_get_upcall_portids - get the upcall_portids of @vport.
410  *
411  * @vport: vport from which to retrieve the portids.
412  * @skb: sk_buff where portids should be appended.
413  *
414  * Retrieves the configuration of the given vport, appending the
415  * %OVS_VPORT_ATTR_UPCALL_PID attribute which is the array of upcall
416  * portids to @skb.
417  *
418  * Returns 0 if successful, -EMSGSIZE if @skb has insufficient room.
419  * If an error occurs, @skb is left unmodified.  Must be called with
420  * ovs_mutex or rcu_read_lock.
421  */
422 int ovs_vport_get_upcall_portids(const struct vport *vport,
423                                  struct sk_buff *skb)
424 {
425         struct vport_portids *ids;
426
427         ids = rcu_dereference_ovsl(vport->upcall_portids);
428
429         if (vport->dp->user_features & OVS_DP_F_VPORT_PIDS)
430                 return nla_put(skb, OVS_VPORT_ATTR_UPCALL_PID,
431                                ids->n_ids * sizeof(u32), (void *)ids->ids);
432         else
433                 return nla_put_u32(skb, OVS_VPORT_ATTR_UPCALL_PID, ids->ids[0]);
434 }
435
436 /**
437  *      ovs_vport_find_upcall_portid - find the upcall portid to send upcall.
438  *
439  * @vport: vport from which the missed packet is received.
440  * @skb: skb that the missed packet was received.
441  *
442  * Uses the skb_get_hash() to select the upcall portid to send the
443  * upcall.
444  *
445  * Returns the portid of the target socket.  Must be called with rcu_read_lock.
446  */
447 u32 ovs_vport_find_upcall_portid(const struct vport *vport, struct sk_buff *skb)
448 {
449         struct vport_portids *ids;
450         u32 ids_index;
451         u32 hash;
452
453         ids = rcu_dereference(vport->upcall_portids);
454
455         if (ids->n_ids == 1 && ids->ids[0] == 0)
456                 return 0;
457
458         hash = skb_get_hash(skb);
459         ids_index = hash - ids->n_ids * reciprocal_divide(hash, ids->rn_ids);
460         return ids->ids[ids_index];
461 }
462
463 /**
464  *      ovs_vport_receive - pass up received packet to the datapath for processing
465  *
466  * @vport: vport that received the packet
467  * @skb: skb that was received
468  * @tun_key: tunnel (if any) that carried packet
469  *
470  * Must be called with rcu_read_lock.  The packet cannot be shared and
471  * skb->data should point to the Ethernet header.
472  */
473 void ovs_vport_receive(struct vport *vport, struct sk_buff *skb,
474                        const struct ovs_tunnel_info *tun_info)
475 {
476         struct pcpu_sw_netstats *stats;
477         struct sw_flow_key key;
478         int error;
479
480         stats = this_cpu_ptr(vport->percpu_stats);
481         u64_stats_update_begin(&stats->syncp);
482         stats->rx_packets++;
483         stats->rx_bytes += skb->len;
484         u64_stats_update_end(&stats->syncp);
485
486         OVS_CB(skb)->input_vport = vport;
487         OVS_CB(skb)->egress_tun_info = NULL;
488         /* Extract flow from 'skb' into 'key'. */
489         error = ovs_flow_key_extract(tun_info, skb, &key);
490         if (unlikely(error)) {
491                 kfree_skb(skb);
492                 return;
493         }
494         ovs_dp_process_packet(skb, &key);
495 }
496 EXPORT_SYMBOL_GPL(ovs_vport_receive);
497
498 /**
499  *      ovs_vport_send - send a packet on a device
500  *
501  * @vport: vport on which to send the packet
502  * @skb: skb to send
503  *
504  * Sends the given packet and returns the length of data sent.  Either ovs
505  * lock or rcu_read_lock must be held.
506  */
507 int ovs_vport_send(struct vport *vport, struct sk_buff *skb)
508 {
509         int sent = vport->ops->send(vport, skb);
510
511         if (likely(sent > 0)) {
512                 struct pcpu_sw_netstats *stats;
513
514                 stats = this_cpu_ptr(vport->percpu_stats);
515
516                 u64_stats_update_begin(&stats->syncp);
517                 stats->tx_packets++;
518                 stats->tx_bytes += sent;
519                 u64_stats_update_end(&stats->syncp);
520         } else if (sent < 0) {
521                 ovs_vport_record_error(vport, VPORT_E_TX_ERROR);
522                 kfree_skb(skb);
523         } else
524                 ovs_vport_record_error(vport, VPORT_E_TX_DROPPED);
525
526         return sent;
527 }
528
529 /**
530  *      ovs_vport_record_error - indicate device error to generic stats layer
531  *
532  * @vport: vport that encountered the error
533  * @err_type: one of enum vport_err_type types to indicate the error type
534  *
535  * If using the vport generic stats layer indicate that an error of the given
536  * type has occurred.
537  */
538 static void ovs_vport_record_error(struct vport *vport,
539                                    enum vport_err_type err_type)
540 {
541         switch (err_type) {
542         case VPORT_E_RX_DROPPED:
543                 atomic_long_inc(&vport->err_stats.rx_dropped);
544                 break;
545
546         case VPORT_E_RX_ERROR:
547                 atomic_long_inc(&vport->err_stats.rx_errors);
548                 break;
549
550         case VPORT_E_TX_DROPPED:
551                 atomic_long_inc(&vport->err_stats.tx_dropped);
552                 break;
553
554         case VPORT_E_TX_ERROR:
555                 atomic_long_inc(&vport->err_stats.tx_errors);
556                 break;
557         }
558
559 }
560
561 static void free_vport_rcu(struct rcu_head *rcu)
562 {
563         struct vport *vport = container_of(rcu, struct vport, rcu);
564
565         ovs_vport_free(vport);
566 }
567
568 void ovs_vport_deferred_free(struct vport *vport)
569 {
570         if (!vport)
571                 return;
572
573         call_rcu(&vport->rcu, free_vport_rcu);
574 }
575 EXPORT_SYMBOL_GPL(ovs_vport_deferred_free);
576
577 int ovs_tunnel_get_egress_info(struct ovs_tunnel_info *egress_tun_info,
578                                struct net *net,
579                                const struct ovs_tunnel_info *tun_info,
580                                u8 ipproto,
581                                u32 skb_mark,
582                                __be16 tp_src,
583                                __be16 tp_dst)
584 {
585         const struct ovs_key_ipv4_tunnel *tun_key;
586         struct rtable *rt;
587         struct flowi4 fl;
588
589         if (unlikely(!tun_info))
590                 return -EINVAL;
591
592         tun_key = &tun_info->tunnel;
593
594         /* Route lookup to get srouce IP address.
595          * The process may need to be changed if the corresponding process
596          * in vports ops changed.
597          */
598         memset(&fl, 0, sizeof(fl));
599         fl.daddr = tun_key->ipv4_dst;
600         fl.saddr = tun_key->ipv4_src;
601         fl.flowi4_tos = RT_TOS(tun_key->ipv4_tos);
602         fl.flowi4_mark = skb_mark;
603         fl.flowi4_proto = ipproto;
604
605         rt = ip_route_output_key(net, &fl);
606         if (IS_ERR(rt))
607                 return PTR_ERR(rt);
608
609         ip_rt_put(rt);
610
611         /* Generate egress_tun_info based on tun_info,
612          * saddr, tp_src and tp_dst
613          */
614         __ovs_flow_tun_info_init(egress_tun_info,
615                                  fl.saddr, tun_key->ipv4_dst,
616                                  tun_key->ipv4_tos,
617                                  tun_key->ipv4_ttl,
618                                  tp_src, tp_dst,
619                                  tun_key->tun_id,
620                                  tun_key->tun_flags,
621                                  tun_info->options,
622                                  tun_info->options_len);
623
624         return 0;
625 }
626 EXPORT_SYMBOL_GPL(ovs_tunnel_get_egress_info);
627
628 int ovs_vport_get_egress_tun_info(struct vport *vport, struct sk_buff *skb,
629                                   struct ovs_tunnel_info *info)
630 {
631         /* get_egress_tun_info() is only implemented on tunnel ports. */
632         if (unlikely(!vport->ops->get_egress_tun_info))
633                 return -EINVAL;
634
635         return vport->ops->get_egress_tun_info(vport, skb, info);
636 }