]> git.proxmox.com Git - ovs.git/blame - datapath/actions.c
datapath: move make_writable helper into common code
[ovs.git] / datapath / actions.c
CommitLineData
064af421 1/*
a6059080 2 * Copyright (c) 2007-2014 Nicira, Inc.
a14bc59f 3 *
a9a29d22
JG
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
064af421
BP
17 */
18
e9141eec
PS
19#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
20
064af421
BP
21#include <linux/skbuff.h>
22#include <linux/in.h>
23#include <linux/ip.h>
077257b8 24#include <linux/openvswitch.h>
10f72e3d 25#include <linux/sctp.h>
064af421
BP
26#include <linux/tcp.h>
27#include <linux/udp.h>
28#include <linux/in6.h>
401eeb92 29#include <linux/if_arp.h>
064af421
BP
30#include <linux/if_vlan.h>
31#include <net/ip.h>
bc7a5acd 32#include <net/ipv6.h>
064af421 33#include <net/checksum.h>
530180fd 34#include <net/dsfield.h>
2baf0e0c 35#include <net/mpls.h>
10f72e3d 36#include <net/sctp/checksum.h>
f2459fe7 37
f2459fe7 38#include "datapath.h"
ccf43786 39#include "gso.h"
6ce39213 40#include "vlan.h"
f2459fe7 41#include "vport.h"
064af421 42
e74d4817
PS
43static int do_execute_actions(struct datapath *dp, struct sk_buff *skb,
44 struct sw_flow_key *key,
45 const struct nlattr *attr, int len);
46
2c8c4fb7
AZ
47struct deferred_action {
48 struct sk_buff *skb;
49 const struct nlattr *actions;
50
51 /* Store pkt_key clone when creating deferred action. */
52 struct sw_flow_key pkt_key;
53};
54
55#define DEFERRED_ACTION_FIFO_SIZE 10
56struct action_fifo {
57 int head;
58 int tail;
59 /* Deferred action fifo queue storage. */
60 struct deferred_action fifo[DEFERRED_ACTION_FIFO_SIZE];
61};
62
63static struct action_fifo __percpu *action_fifos;
64#define EXEC_ACTIONS_LEVEL_LIMIT 4 /* limit used to detect packet
af465b67
PS
65 * looping by the network stack
66 */
2c8c4fb7
AZ
67static DEFINE_PER_CPU(int, exec_actions_level);
68
69static void action_fifo_init(struct action_fifo *fifo)
70{
71 fifo->head = 0;
72 fifo->tail = 0;
73}
74
f1f60b85 75static bool action_fifo_is_empty(const struct action_fifo *fifo)
2c8c4fb7
AZ
76{
77 return (fifo->head == fifo->tail);
78}
79
e74d4817 80static struct deferred_action *action_fifo_get(struct action_fifo *fifo)
2c8c4fb7
AZ
81{
82 if (action_fifo_is_empty(fifo))
83 return NULL;
84
85 return &fifo->fifo[fifo->tail++];
86}
87
e74d4817 88static struct deferred_action *action_fifo_put(struct action_fifo *fifo)
2c8c4fb7
AZ
89{
90 if (fifo->head >= DEFERRED_ACTION_FIFO_SIZE - 1)
91 return NULL;
92
93 return &fifo->fifo[fifo->head++];
94}
95
e74d4817
PS
96/* Return queue entry if fifo is not full */
97static struct deferred_action *add_deferred_actions(struct sk_buff *skb,
f1f60b85 98 const struct sw_flow_key *key,
e74d4817 99 const struct nlattr *attr)
2c8c4fb7
AZ
100{
101 struct action_fifo *fifo;
102 struct deferred_action *da;
103
104 fifo = this_cpu_ptr(action_fifos);
105 da = action_fifo_put(fifo);
106 if (da) {
107 da->skb = skb;
108 da->actions = attr;
e74d4817 109 da->pkt_key = *key;
2c8c4fb7
AZ
110 }
111
e74d4817 112 return da;
e16138e2
PS
113}
114
e74d4817 115static void invalidate_flow_key(struct sw_flow_key *key)
e16138e2 116{
e74d4817 117 key->eth.type = htons(0);
e16138e2
PS
118}
119
f1f60b85 120static bool is_flow_key_valid(const struct sw_flow_key *key)
e16138e2 121{
e74d4817 122 return !!key->eth.type;
e16138e2
PS
123}
124
e74d4817 125static int push_mpls(struct sk_buff *skb, struct sw_flow_key *key,
ccf43786
SH
126 const struct ovs_action_push_mpls *mpls)
127{
128 __be32 *new_mpls_lse;
129 struct ethhdr *hdr;
130
2baf0e0c
PS
131 /* Networking stack do not allow simultaneous Tunnel and MPLS GSO. */
132 if (skb_encapsulation(skb))
133 return -ENOTSUPP;
134
ccf43786
SH
135 if (skb_cow_head(skb, MPLS_HLEN) < 0)
136 return -ENOMEM;
137
138 skb_push(skb, MPLS_HLEN);
139 memmove(skb_mac_header(skb) - MPLS_HLEN, skb_mac_header(skb),
140 skb->mac_len);
141 skb_reset_mac_header(skb);
142
2baf0e0c 143 new_mpls_lse = (__be32 *)skb_mpls_header(skb);
ccf43786
SH
144 *new_mpls_lse = mpls->mpls_lse;
145
146 if (skb->ip_summed == CHECKSUM_COMPLETE)
147 skb->csum = csum_add(skb->csum, csum_partial(new_mpls_lse,
148 MPLS_HLEN, 0));
149
150 hdr = eth_hdr(skb);
151 hdr->h_proto = mpls->mpls_ethertype;
152 if (!ovs_skb_get_inner_protocol(skb))
153 ovs_skb_set_inner_protocol(skb, skb->protocol);
154 skb->protocol = mpls->mpls_ethertype;
2baf0e0c 155
e74d4817 156 invalidate_flow_key(key);
ccf43786
SH
157 return 0;
158}
159
e74d4817
PS
160static int pop_mpls(struct sk_buff *skb, struct sw_flow_key *key,
161 const __be16 ethertype)
ccf43786
SH
162{
163 struct ethhdr *hdr;
164 int err;
165
5cce04b6 166 err = skb_ensure_writable(skb, skb->mac_len + MPLS_HLEN);
ccf43786
SH
167 if (unlikely(err))
168 return err;
169
170 if (skb->ip_summed == CHECKSUM_COMPLETE)
171 skb->csum = csum_sub(skb->csum,
2baf0e0c 172 csum_partial(skb_mpls_header(skb),
ccf43786
SH
173 MPLS_HLEN, 0));
174
175 memmove(skb_mac_header(skb) + MPLS_HLEN, skb_mac_header(skb),
176 skb->mac_len);
177
178 __skb_pull(skb, MPLS_HLEN);
179 skb_reset_mac_header(skb);
180
2baf0e0c 181 /* skb_mpls_header() is used to locate the ethertype
ccf43786
SH
182 * field correctly in the presence of VLAN tags.
183 */
2baf0e0c 184 hdr = (struct ethhdr *)(skb_mpls_header(skb) - ETH_HLEN);
ccf43786
SH
185 hdr->h_proto = ethertype;
186 if (eth_p_mpls(skb->protocol))
187 skb->protocol = ethertype;
2baf0e0c 188
e74d4817 189 invalidate_flow_key(key);
ccf43786
SH
190 return 0;
191}
192
e74d4817
PS
193static int set_mpls(struct sk_buff *skb, struct sw_flow_key *key,
194 const __be32 *mpls_lse)
ccf43786 195{
2baf0e0c 196 __be32 *stack;
ccf43786
SH
197 int err;
198
5cce04b6 199 err = skb_ensure_writable(skb, skb->mac_len + MPLS_HLEN);
ccf43786
SH
200 if (unlikely(err))
201 return err;
202
2baf0e0c 203 stack = (__be32 *)skb_mpls_header(skb);
ccf43786
SH
204 if (skb->ip_summed == CHECKSUM_COMPLETE) {
205 __be32 diff[] = { ~(*stack), *mpls_lse };
206 skb->csum = ~csum_partial((char *)diff, sizeof(diff),
207 ~skb->csum);
208 }
209
210 *stack = *mpls_lse;
e74d4817 211 key->mpls.top_lse = *mpls_lse;
ccf43786
SH
212 return 0;
213}
214
b2492cb7 215/* remove VLAN header from packet and update csum accordingly. */
d9065a90 216static int __pop_vlan_tci(struct sk_buff *skb, __be16 *current_tci)
064af421 217{
ceb176fd 218 struct vlan_hdr *vhdr;
10db8b20 219 int err;
064af421 220
5cce04b6 221 err = skb_ensure_writable(skb, VLAN_ETH_HLEN);
10db8b20
JG
222 if (unlikely(err))
223 return err;
6ce39213 224
237c4f2a 225 if (skb->ip_summed == CHECKSUM_COMPLETE)
635c9298 226 skb->csum = csum_sub(skb->csum, csum_partial(skb->data
af9d14a8 227 + (2 * ETH_ALEN), VLAN_HLEN, 0));
635c9298 228
ceb176fd
PS
229 vhdr = (struct vlan_hdr *)(skb->data + ETH_HLEN);
230 *current_tci = vhdr->h_vlan_TCI;
d9065a90 231
6ce39213 232 memmove(skb->data + VLAN_HLEN, skb->data, 2 * ETH_ALEN);
ceb176fd 233 __skb_pull(skb, VLAN_HLEN);
064af421 234
ceb176fd 235 vlan_set_encap_proto(skb, vhdr);
064af421 236 skb->mac_header += VLAN_HLEN;
ccf43786
SH
237 /* Update mac_len for subsequent MPLS actions */
238 skb->mac_len -= VLAN_HLEN;
064af421 239
10db8b20 240 return 0;
064af421
BP
241}
242
e74d4817 243static int pop_vlan(struct sk_buff *skb, struct sw_flow_key *key)
064af421 244{
d9065a90
PS
245 __be16 tci;
246 int err;
10db8b20 247
d9065a90
PS
248 if (likely(vlan_tx_tag_present(skb))) {
249 vlan_set_tci(skb, 0);
250 } else {
251 if (unlikely(skb->protocol != htons(ETH_P_8021Q) ||
fb516ed8 252 skb->len < VLAN_ETH_HLEN))
10db8b20 253 return 0;
064af421 254
d9065a90
PS
255 err = __pop_vlan_tci(skb, &tci);
256 if (err)
10db8b20 257 return err;
064af421 258 }
d9065a90
PS
259 /* move next vlan tag to hw accel tag */
260 if (likely(skb->protocol != htons(ETH_P_8021Q) ||
e16138e2 261 skb->len < VLAN_ETH_HLEN)) {
e74d4817 262 key->eth.tci = 0;
d9065a90 263 return 0;
e16138e2 264 }
d9065a90 265
e74d4817 266 invalidate_flow_key(key);
d9065a90
PS
267 err = __pop_vlan_tci(skb, &tci);
268 if (unlikely(err))
269 return err;
064af421 270
9b764edf 271 __vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), ntohs(tci));
d9065a90
PS
272 return 0;
273}
274
e74d4817
PS
275static int push_vlan(struct sk_buff *skb, struct sw_flow_key *key,
276 const struct ovs_action_push_vlan *vlan)
d9065a90
PS
277{
278 if (unlikely(vlan_tx_tag_present(skb))) {
279 u16 current_tag;
280
281 /* push down current VLAN tag */
282 current_tag = vlan_tx_tag_get(skb);
283
1f649f1c 284 if (!vlan_insert_tag_set_proto(skb, skb->vlan_proto, current_tag))
d9065a90 285 return -ENOMEM;
ccf43786
SH
286 /* Update mac_len for subsequent MPLS actions */
287 skb->mac_len += VLAN_HLEN;
288
237c4f2a 289 if (skb->ip_summed == CHECKSUM_COMPLETE)
d9065a90 290 skb->csum = csum_add(skb->csum, csum_partial(skb->data
af9d14a8 291 + (2 * ETH_ALEN), VLAN_HLEN, 0));
d9065a90 292
e74d4817 293 invalidate_flow_key(key);
e16138e2 294 } else {
e74d4817 295 key->eth.tci = vlan->vlan_tci;
d9065a90 296 }
9b764edf 297 __vlan_hwaccel_put_tag(skb, vlan->vlan_tpid, ntohs(vlan->vlan_tci) & ~VLAN_TAG_PRESENT);
10db8b20 298 return 0;
064af421
BP
299}
300
e74d4817 301static int set_eth_addr(struct sk_buff *skb, struct sw_flow_key *key,
4edb9ae9 302 const struct ovs_key_ethernet *eth_key)
ca78c6b6 303{
4edb9ae9 304 int err;
5cce04b6 305 err = skb_ensure_writable(skb, ETH_HLEN);
4edb9ae9
PS
306 if (unlikely(err))
307 return err;
308
237c4f2a 309 skb_postpull_rcsum(skb, eth_hdr(skb), ETH_ALEN * 2);
3cfede14 310
982a47ec
JP
311 ether_addr_copy(eth_hdr(skb)->h_source, eth_key->eth_src);
312 ether_addr_copy(eth_hdr(skb)->h_dest, eth_key->eth_dst);
4edb9ae9 313
237c4f2a 314 ovs_skb_postpush_rcsum(skb, eth_hdr(skb), ETH_ALEN * 2);
3cfede14 315
e74d4817
PS
316 ether_addr_copy(key->eth.src, eth_key->eth_src);
317 ether_addr_copy(key->eth.dst, eth_key->eth_dst);
4edb9ae9 318 return 0;
ca78c6b6
BP
319}
320
4edb9ae9 321static void set_ip_addr(struct sk_buff *skb, struct iphdr *nh,
e16138e2 322 __be32 *addr, __be32 new_addr)
ca78c6b6
BP
323{
324 int transport_len = skb->len - skb_transport_offset(skb);
4edb9ae9
PS
325
326 if (nh->protocol == IPPROTO_TCP) {
ca78c6b6 327 if (likely(transport_len >= sizeof(struct tcphdr)))
4edb9ae9
PS
328 inet_proto_csum_replace4(&tcp_hdr(skb)->check, skb,
329 *addr, new_addr, 1);
330 } else if (nh->protocol == IPPROTO_UDP) {
55ce87bc
JG
331 if (likely(transport_len >= sizeof(struct udphdr))) {
332 struct udphdr *uh = udp_hdr(skb);
333
237c4f2a 334 if (uh->check || skb->ip_summed == CHECKSUM_PARTIAL) {
55ce87bc
JG
335 inet_proto_csum_replace4(&uh->check, skb,
336 *addr, new_addr, 1);
337 if (!uh->check)
338 uh->check = CSUM_MANGLED_0;
339 }
340 }
ca78c6b6 341 }
4edb9ae9
PS
342
343 csum_replace4(&nh->check, *addr, new_addr);
e2f3178f 344 skb_clear_hash(skb);
4edb9ae9 345 *addr = new_addr;
ca78c6b6
BP
346}
347
bc7a5acd
AA
348static void update_ipv6_checksum(struct sk_buff *skb, u8 l4_proto,
349 __be32 addr[4], const __be32 new_addr[4])
350{
351 int transport_len = skb->len - skb_transport_offset(skb);
352
00894212 353 if (l4_proto == NEXTHDR_TCP) {
bc7a5acd
AA
354 if (likely(transport_len >= sizeof(struct tcphdr)))
355 inet_proto_csum_replace16(&tcp_hdr(skb)->check, skb,
356 addr, new_addr, 1);
00894212 357 } else if (l4_proto == NEXTHDR_UDP) {
bc7a5acd
AA
358 if (likely(transport_len >= sizeof(struct udphdr))) {
359 struct udphdr *uh = udp_hdr(skb);
360
237c4f2a 361 if (uh->check || skb->ip_summed == CHECKSUM_PARTIAL) {
bc7a5acd
AA
362 inet_proto_csum_replace16(&uh->check, skb,
363 addr, new_addr, 1);
364 if (!uh->check)
365 uh->check = CSUM_MANGLED_0;
366 }
367 }
00894212
JG
368 } else if (l4_proto == NEXTHDR_ICMP) {
369 if (likely(transport_len >= sizeof(struct icmp6hdr)))
370 inet_proto_csum_replace16(&icmp6_hdr(skb)->icmp6_cksum,
371 skb, addr, new_addr, 1);
bc7a5acd
AA
372 }
373}
374
375static void set_ipv6_addr(struct sk_buff *skb, u8 l4_proto,
376 __be32 addr[4], const __be32 new_addr[4],
377 bool recalculate_csum)
378{
51cf5e71 379 if (likely(recalculate_csum))
bc7a5acd
AA
380 update_ipv6_checksum(skb, l4_proto, addr, new_addr);
381
e2f3178f 382 skb_clear_hash(skb);
bc7a5acd
AA
383 memcpy(addr, new_addr, sizeof(__be32[4]));
384}
385
386static void set_ipv6_tc(struct ipv6hdr *nh, u8 tc)
387{
388 nh->priority = tc >> 4;
389 nh->flow_lbl[0] = (nh->flow_lbl[0] & 0x0F) | ((tc & 0x0F) << 4);
390}
391
392static void set_ipv6_fl(struct ipv6hdr *nh, u32 fl)
393{
394 nh->flow_lbl[0] = (nh->flow_lbl[0] & 0xF0) | (fl & 0x000F0000) >> 16;
395 nh->flow_lbl[1] = (fl & 0x0000FF00) >> 8;
396 nh->flow_lbl[2] = fl & 0x000000FF;
397}
398
a61680c6
JP
399static void set_ip_ttl(struct sk_buff *skb, struct iphdr *nh, u8 new_ttl)
400{
401 csum_replace2(&nh->check, htons(nh->ttl << 8), htons(new_ttl << 8));
402 nh->ttl = new_ttl;
403}
404
e74d4817
PS
405static int set_ipv4(struct sk_buff *skb, struct sw_flow_key *key,
406 const struct ovs_key_ipv4 *ipv4_key)
064af421 407{
ca78c6b6 408 struct iphdr *nh;
10db8b20 409 int err;
ca78c6b6 410
5cce04b6
TG
411 err = skb_ensure_writable(skb, skb_network_offset(skb) +
412 sizeof(struct iphdr));
10db8b20
JG
413 if (unlikely(err))
414 return err;
ca78c6b6
BP
415
416 nh = ip_hdr(skb);
ca78c6b6 417
e16138e2 418 if (ipv4_key->ipv4_src != nh->saddr) {
4edb9ae9 419 set_ip_addr(skb, nh, &nh->saddr, ipv4_key->ipv4_src);
e74d4817 420 key->ipv4.addr.src = ipv4_key->ipv4_src;
e16138e2 421 }
ca78c6b6 422
e16138e2 423 if (ipv4_key->ipv4_dst != nh->daddr) {
4edb9ae9 424 set_ip_addr(skb, nh, &nh->daddr, ipv4_key->ipv4_dst);
e74d4817 425 key->ipv4.addr.dst = ipv4_key->ipv4_dst;
e16138e2 426 }
a4a26436 427
e16138e2 428 if (ipv4_key->ipv4_tos != nh->tos) {
530180fd 429 ipv4_change_dsfield(nh, 0, ipv4_key->ipv4_tos);
e74d4817 430 key->ip.tos = nh->tos;
e16138e2 431 }
ca78c6b6 432
e16138e2 433 if (ipv4_key->ipv4_ttl != nh->ttl) {
a61680c6 434 set_ip_ttl(skb, nh, ipv4_key->ipv4_ttl);
e74d4817 435 key->ip.ttl = ipv4_key->ipv4_ttl;
e16138e2 436 }
a61680c6 437
10db8b20 438 return 0;
064af421
BP
439}
440
e74d4817
PS
441static int set_ipv6(struct sk_buff *skb, struct sw_flow_key *key,
442 const struct ovs_key_ipv6 *ipv6_key)
bc7a5acd
AA
443{
444 struct ipv6hdr *nh;
445 int err;
446 __be32 *saddr;
447 __be32 *daddr;
448
5cce04b6
TG
449 err = skb_ensure_writable(skb, skb_network_offset(skb) +
450 sizeof(struct ipv6hdr));
bc7a5acd
AA
451 if (unlikely(err))
452 return err;
453
454 nh = ipv6_hdr(skb);
455 saddr = (__be32 *)&nh->saddr;
456 daddr = (__be32 *)&nh->daddr;
457
e16138e2 458 if (memcmp(ipv6_key->ipv6_src, saddr, sizeof(ipv6_key->ipv6_src))) {
bc7a5acd
AA
459 set_ipv6_addr(skb, ipv6_key->ipv6_proto, saddr,
460 ipv6_key->ipv6_src, true);
e74d4817
PS
461 memcpy(&key->ipv6.addr.src, ipv6_key->ipv6_src,
462 sizeof(ipv6_key->ipv6_src));
e16138e2 463 }
bc7a5acd
AA
464
465 if (memcmp(ipv6_key->ipv6_dst, daddr, sizeof(ipv6_key->ipv6_dst))) {
466 unsigned int offset = 0;
8abaa53c 467 int flags = IP6_FH_F_SKIP_RH;
bc7a5acd
AA
468 bool recalc_csum = true;
469
470 if (ipv6_ext_hdr(nh->nexthdr))
471 recalc_csum = ipv6_find_hdr(skb, &offset,
472 NEXTHDR_ROUTING, NULL,
473 &flags) != NEXTHDR_ROUTING;
474
475 set_ipv6_addr(skb, ipv6_key->ipv6_proto, daddr,
476 ipv6_key->ipv6_dst, recalc_csum);
e74d4817
PS
477 memcpy(&key->ipv6.addr.dst, ipv6_key->ipv6_dst,
478 sizeof(ipv6_key->ipv6_dst));
bc7a5acd
AA
479 }
480
481 set_ipv6_tc(nh, ipv6_key->ipv6_tclass);
e74d4817 482 key->ip.tos = ipv6_get_dsfield(nh);
e16138e2 483
bc7a5acd 484 set_ipv6_fl(nh, ntohl(ipv6_key->ipv6_label));
e74d4817 485 key->ipv6.label = *(__be32 *)nh & htonl(IPV6_FLOWINFO_FLOWLABEL);
bc7a5acd 486
e16138e2 487 nh->hop_limit = ipv6_key->ipv6_hlimit;
e74d4817 488 key->ip.ttl = ipv6_key->ipv6_hlimit;
bc7a5acd
AA
489 return 0;
490}
491
5cce04b6 492/* Must follow skb_ensure_writable() since that can move the skb data. */
4edb9ae9
PS
493static void set_tp_port(struct sk_buff *skb, __be16 *port,
494 __be16 new_port, __sum16 *check)
959a2ecd 495{
4edb9ae9
PS
496 inet_proto_csum_replace2(check, skb, *port, new_port, 0);
497 *port = new_port;
e2f3178f 498 skb_clear_hash(skb);
4edb9ae9 499}
10db8b20 500
55ce87bc
JG
501static void set_udp_port(struct sk_buff *skb, __be16 *port, __be16 new_port)
502{
503 struct udphdr *uh = udp_hdr(skb);
504
237c4f2a 505 if (uh->check && skb->ip_summed != CHECKSUM_PARTIAL) {
55ce87bc
JG
506 set_tp_port(skb, port, new_port, &uh->check);
507
508 if (!uh->check)
509 uh->check = CSUM_MANGLED_0;
510 } else {
511 *port = new_port;
e2f3178f 512 skb_clear_hash(skb);
55ce87bc
JG
513 }
514}
515
e74d4817
PS
516static int set_udp(struct sk_buff *skb, struct sw_flow_key *key,
517 const struct ovs_key_udp *udp_port_key)
4edb9ae9
PS
518{
519 struct udphdr *uh;
520 int err;
10db8b20 521
5cce04b6
TG
522 err = skb_ensure_writable(skb, skb_transport_offset(skb) +
523 sizeof(struct udphdr));
10db8b20
JG
524 if (unlikely(err))
525 return err;
526
4edb9ae9 527 uh = udp_hdr(skb);
e16138e2 528 if (udp_port_key->udp_src != uh->source) {
55ce87bc 529 set_udp_port(skb, &uh->source, udp_port_key->udp_src);
e74d4817 530 key->tp.src = udp_port_key->udp_src;
e16138e2 531 }
4edb9ae9 532
e16138e2 533 if (udp_port_key->udp_dst != uh->dest) {
55ce87bc 534 set_udp_port(skb, &uh->dest, udp_port_key->udp_dst);
e74d4817 535 key->tp.dst = udp_port_key->udp_dst;
e16138e2 536 }
10db8b20
JG
537
538 return 0;
959a2ecd
JP
539}
540
e74d4817
PS
541static int set_tcp(struct sk_buff *skb, struct sw_flow_key *key,
542 const struct ovs_key_tcp *tcp_port_key)
064af421 543{
4edb9ae9 544 struct tcphdr *th;
10db8b20 545 int err;
064af421 546
5cce04b6
TG
547 err = skb_ensure_writable(skb, skb_transport_offset(skb) +
548 sizeof(struct tcphdr));
10db8b20
JG
549 if (unlikely(err))
550 return err;
ca78c6b6 551
4edb9ae9 552 th = tcp_hdr(skb);
e16138e2 553 if (tcp_port_key->tcp_src != th->source) {
4edb9ae9 554 set_tp_port(skb, &th->source, tcp_port_key->tcp_src, &th->check);
e74d4817 555 key->tp.src = tcp_port_key->tcp_src;
e16138e2 556 }
064af421 557
e16138e2 558 if (tcp_port_key->tcp_dst != th->dest) {
4edb9ae9 559 set_tp_port(skb, &th->dest, tcp_port_key->tcp_dst, &th->check);
e74d4817 560 key->tp.dst = tcp_port_key->tcp_dst;
e16138e2 561 }
ca78c6b6 562
10db8b20 563 return 0;
064af421
BP
564}
565
e74d4817 566static int set_sctp(struct sk_buff *skb, struct sw_flow_key *key,
e16138e2 567 const struct ovs_key_sctp *sctp_port_key)
10f72e3d
JS
568{
569 struct sctphdr *sh;
570 int err;
571 unsigned int sctphoff = skb_transport_offset(skb);
572
5cce04b6 573 err = skb_ensure_writable(skb, sctphoff + sizeof(struct sctphdr));
10f72e3d
JS
574 if (unlikely(err))
575 return err;
576
577 sh = sctp_hdr(skb);
578 if (sctp_port_key->sctp_src != sh->source ||
579 sctp_port_key->sctp_dst != sh->dest) {
580 __le32 old_correct_csum, new_csum, old_csum;
581
582 old_csum = sh->checksum;
583 old_correct_csum = sctp_compute_cksum(skb, sctphoff);
584
585 sh->source = sctp_port_key->sctp_src;
586 sh->dest = sctp_port_key->sctp_dst;
587
588 new_csum = sctp_compute_cksum(skb, sctphoff);
589
590 /* Carry any checksum errors through. */
591 sh->checksum = old_csum ^ old_correct_csum ^ new_csum;
592
e2f3178f 593 skb_clear_hash(skb);
e74d4817
PS
594 key->tp.src = sctp_port_key->sctp_src;
595 key->tp.dst = sctp_port_key->sctp_dst;
10f72e3d
JS
596 }
597
598 return 0;
599}
600
fe90efd9 601static void do_output(struct datapath *dp, struct sk_buff *skb, int out_port)
064af421 602{
fe90efd9 603 struct vport *vport = ovs_vport_rcu(dp, out_port);
064af421 604
fe90efd9
AZ
605 if (likely(vport))
606 ovs_vport_send(vport, skb);
607 else
f15c8639 608 kfree_skb(skb);
064af421
BP
609}
610
98403001 611static int output_userspace(struct datapath *dp, struct sk_buff *skb,
e74d4817 612 struct sw_flow_key *key, const struct nlattr *attr)
064af421 613{
2baf0e0c 614 struct ovs_tunnel_info info;
856081f6 615 struct dp_upcall_info upcall;
98403001
BP
616 const struct nlattr *a;
617 int rem;
856081f6 618
df2c07f4 619 upcall.cmd = OVS_PACKET_CMD_ACTION;
98403001 620 upcall.userdata = NULL;
28aea917 621 upcall.portid = 0;
8b7ea2d4 622 upcall.egress_tun_info = NULL;
98403001
BP
623
624 for (a = nla_data(attr), rem = nla_len(attr); rem > 0;
625 a = nla_next(a, &rem)) {
626 switch (nla_type(a)) {
627 case OVS_USERSPACE_ATTR_USERDATA:
628 upcall.userdata = a;
629 break;
630
631 case OVS_USERSPACE_ATTR_PID:
28aea917 632 upcall.portid = nla_get_u32(a);
98403001 633 break;
8b7ea2d4
WZ
634
635 case OVS_USERSPACE_ATTR_EGRESS_TUN_PORT: {
636 /* Get out tunnel info. */
637 struct vport *vport;
638
639 vport = ovs_vport_rcu(dp, nla_get_u32(a));
640 if (vport) {
641 int err;
642
643 err = ovs_vport_get_egress_tun_info(vport, skb,
644 &info);
645 if (!err)
646 upcall.egress_tun_info = &info;
647 }
648 break;
98403001 649 }
8b7ea2d4
WZ
650
651 } /* End of switch. */
98403001
BP
652 }
653
e74d4817 654 return ovs_dp_upcall(dp, skb, key, &upcall);
064af421
BP
655}
656
6ff686f2 657static int sample(struct datapath *dp, struct sk_buff *skb,
e74d4817 658 struct sw_flow_key *key, const struct nlattr *attr)
6ff686f2
PS
659{
660 const struct nlattr *acts_list = NULL;
661 const struct nlattr *a;
662 int rem;
663
664 for (a = nla_data(attr), rem = nla_len(attr); rem > 0;
665 a = nla_next(a, &rem)) {
666 switch (nla_type(a)) {
667 case OVS_SAMPLE_ATTR_PROBABILITY:
e2f3178f 668 if (prandom_u32() >= nla_get_u32(a))
6ff686f2
PS
669 return 0;
670 break;
671
672 case OVS_SAMPLE_ATTR_ACTIONS:
673 acts_list = a;
674 break;
675 }
676 }
677
fbf4f74d
SH
678 rem = nla_len(acts_list);
679 a = nla_data(acts_list);
680
d7ff93d7
AZ
681 /* Actions list is empty, do nothing */
682 if (unlikely(!rem))
683 return 0;
e16138e2 684
d7ff93d7
AZ
685 /* The only known usage of sample action is having a single user-space
686 * action. Treat this usage as a special case.
687 * The output_userspace() should clone the skb to be sent to the
e74d4817
PS
688 * user space. This skb will be consumed by its caller.
689 */
d7ff93d7 690 if (likely(nla_type(a) == OVS_ACTION_ATTR_USERSPACE &&
684b5f5d 691 nla_is_last(a, rem)))
e74d4817 692 return output_userspace(dp, skb, key, a);
d7ff93d7
AZ
693
694 skb = skb_clone(skb, GFP_ATOMIC);
695 if (!skb)
696 /* Skip the sample action when out of memory. */
697 return 0;
698
e74d4817 699 if (!add_deferred_actions(skb, key, a)) {
2c8c4fb7
AZ
700 if (net_ratelimit())
701 pr_warn("%s: deferred actions limit reached, dropping sample action\n",
702 ovs_dp_name(dp));
fbf4f74d 703
2c8c4fb7
AZ
704 kfree_skb(skb);
705 }
2c8c4fb7 706 return 0;
6ff686f2
PS
707}
708
e74d4817
PS
709static void execute_hash(struct sk_buff *skb, struct sw_flow_key *key,
710 const struct nlattr *attr)
7804df20 711{
7804df20
AZ
712 struct ovs_action_hash *hash_act = nla_data(attr);
713 u32 hash = 0;
714
715 /* OVS_HASH_ALG_L4 is the only possible hash algorithm. */
e2f3178f 716 hash = skb_get_hash(skb);
7804df20
AZ
717 hash = jhash_1word(hash, hash_act->hash_basis);
718 if (!hash)
719 hash = 0x1;
720
721 key->ovs_flow_hash = hash;
722}
723
e74d4817 724static int execute_set_action(struct sk_buff *skb, struct sw_flow_key *key,
2c8c4fb7 725 const struct nlattr *nested_attr)
4edb9ae9 726{
15c39847 727 int err = 0;
4edb9ae9
PS
728
729 switch (nla_type(nested_attr)) {
abff858b
PS
730 case OVS_KEY_ATTR_PRIORITY:
731 skb->priority = nla_get_u32(nested_attr);
e74d4817 732 key->phy.priority = skb->priority;
abff858b
PS
733 break;
734
72e8bf28 735 case OVS_KEY_ATTR_SKB_MARK:
3025a772 736 skb->mark = nla_get_u32(nested_attr);
e74d4817 737 key->phy.skb_mark = skb->mark;
72e8bf28
AA
738 break;
739
f0cd669f 740 case OVS_KEY_ATTR_TUNNEL_INFO:
fb66fbd1 741 OVS_CB(skb)->egress_tun_info = nla_data(nested_attr);
4edb9ae9
PS
742 break;
743
744 case OVS_KEY_ATTR_ETHERNET:
e74d4817 745 err = set_eth_addr(skb, key, nla_data(nested_attr));
4edb9ae9
PS
746 break;
747
748 case OVS_KEY_ATTR_IPV4:
e74d4817 749 err = set_ipv4(skb, key, nla_data(nested_attr));
4edb9ae9
PS
750 break;
751
bc7a5acd 752 case OVS_KEY_ATTR_IPV6:
e74d4817 753 err = set_ipv6(skb, key, nla_data(nested_attr));
bc7a5acd
AA
754 break;
755
4edb9ae9 756 case OVS_KEY_ATTR_TCP:
e74d4817 757 err = set_tcp(skb, key, nla_data(nested_attr));
4edb9ae9
PS
758 break;
759
760 case OVS_KEY_ATTR_UDP:
e74d4817 761 err = set_udp(skb, key, nla_data(nested_attr));
4edb9ae9 762 break;
10f72e3d
JS
763
764 case OVS_KEY_ATTR_SCTP:
e74d4817 765 err = set_sctp(skb, key, nla_data(nested_attr));
10f72e3d 766 break;
ccf43786
SH
767
768 case OVS_KEY_ATTR_MPLS:
e74d4817 769 err = set_mpls(skb, key, nla_data(nested_attr));
ccf43786 770 break;
4edb9ae9 771 }
15c39847 772
4edb9ae9
PS
773 return err;
774}
775
a6059080 776static int execute_recirc(struct datapath *dp, struct sk_buff *skb,
7d16c847
PS
777 struct sw_flow_key *key,
778 const struct nlattr *a, int rem)
a6059080 779{
e74d4817
PS
780 struct deferred_action *da;
781
782 if (!is_flow_key_valid(key)) {
867e37ba
AZ
783 int err;
784
e74d4817 785 err = ovs_flow_key_update(skb, key);
867e37ba
AZ
786 if (err)
787 return err;
867e37ba 788 }
e74d4817 789 BUG_ON(!is_flow_key_valid(key));
a6059080 790
684b5f5d 791 if (!nla_is_last(a, rem)) {
e16138e2 792 /* Recirc action is the not the last action
e74d4817
PS
793 * of the action list, need to clone the skb.
794 */
e16138e2
PS
795 skb = skb_clone(skb, GFP_ATOMIC);
796
797 /* Skip the recirc action when out of memory, but
e74d4817
PS
798 * continue on with the rest of the action list.
799 */
e16138e2
PS
800 if (!skb)
801 return 0;
2c8c4fb7 802 }
a6059080 803
e74d4817
PS
804 da = add_deferred_actions(skb, key, NULL);
805 if (da) {
806 da->pkt_key.recirc_id = nla_get_u32(a);
2c8c4fb7
AZ
807 } else {
808 kfree_skb(skb);
809
810 if (net_ratelimit())
811 pr_warn("%s: deferred action limit reached, drop recirc action\n",
812 ovs_dp_name(dp));
867e37ba 813 }
a6059080
AZ
814
815 return 0;
816}
817
064af421 818/* Execute a list of actions against 'skb'. */
871dfe07 819static int do_execute_actions(struct datapath *dp, struct sk_buff *skb,
e74d4817
PS
820 struct sw_flow_key *key,
821 const struct nlattr *attr, int len)
064af421
BP
822{
823 /* Every output action needs a separate clone of 'skb', but the common
824 * case is just a single output action, so that doing a clone and
825 * then freeing the original skbuff is wasteful. So the following code
e74d4817
PS
826 * is slightly obscure just to avoid that.
827 */
064af421 828 int prev_port = -1;
cdee00fd 829 const struct nlattr *a;
10db8b20 830 int rem;
72b06300 831
6ff686f2 832 for (a = attr, rem = len; rem > 0;
a4af2475 833 a = nla_next(a, &rem)) {
10db8b20
JG
834 int err = 0;
835
fe90efd9
AZ
836 if (unlikely(prev_port != -1)) {
837 struct sk_buff *out_skb = skb_clone(skb, GFP_ATOMIC);
838
839 if (out_skb)
840 do_output(dp, out_skb, prev_port);
841
064af421
BP
842 prev_port = -1;
843 }
844
cdee00fd 845 switch (nla_type(a)) {
df2c07f4 846 case OVS_ACTION_ATTR_OUTPUT:
cdee00fd 847 prev_port = nla_get_u32(a);
064af421
BP
848 break;
849
df2c07f4 850 case OVS_ACTION_ATTR_USERSPACE:
e74d4817 851 output_userspace(dp, skb, key, a);
064af421 852 break;
7804df20
AZ
853
854 case OVS_ACTION_ATTR_HASH:
e74d4817 855 execute_hash(skb, key, a);
7804df20 856 break;
064af421 857
ccf43786 858 case OVS_ACTION_ATTR_PUSH_MPLS:
e74d4817 859 err = push_mpls(skb, key, nla_data(a));
ccf43786
SH
860 break;
861
862 case OVS_ACTION_ATTR_POP_MPLS:
e74d4817 863 err = pop_mpls(skb, key, nla_get_be16(a));
ccf43786
SH
864 break;
865
fea393b1 866 case OVS_ACTION_ATTR_PUSH_VLAN:
e74d4817 867 err = push_vlan(skb, key, nla_data(a));
4edb9ae9 868 if (unlikely(err)) /* skb already freed. */
d9065a90 869 return err;
064af421
BP
870 break;
871
fea393b1 872 case OVS_ACTION_ATTR_POP_VLAN:
e74d4817 873 err = pop_vlan(skb, key);
064af421
BP
874 break;
875
e16138e2 876 case OVS_ACTION_ATTR_RECIRC:
e74d4817 877 err = execute_recirc(dp, skb, key, a, rem);
684b5f5d 878 if (nla_is_last(a, rem)) {
867e37ba
AZ
879 /* If this is the last action, the skb has
880 * been consumed or freed.
e74d4817
PS
881 * Return immediately.
882 */
867e37ba
AZ
883 return err;
884 }
a6059080 885 break;
a6059080 886
4edb9ae9 887 case OVS_ACTION_ATTR_SET:
e74d4817 888 err = execute_set_action(skb, key, nla_data(a));
064af421 889 break;
c1c9c9c4 890
6ff686f2 891 case OVS_ACTION_ATTR_SAMPLE:
e74d4817 892 err = sample(dp, skb, key, a);
6ff686f2 893 break;
6ff686f2 894 }
15c39847 895
10db8b20
JG
896 if (unlikely(err)) {
897 kfree_skb(skb);
898 return err;
899 }
064af421 900 }
6c222e55 901
fbf4f74d 902 if (prev_port != -1)
064af421 903 do_output(dp, skb, prev_port);
fbf4f74d 904 else
5b95ab0e 905 consume_skb(skb);
10db8b20 906
a5225dd6 907 return 0;
064af421 908}
871dfe07 909
2c8c4fb7
AZ
910static void process_deferred_actions(struct datapath *dp)
911{
912 struct action_fifo *fifo = this_cpu_ptr(action_fifos);
913
914 /* Do not touch the FIFO in case there is no deferred actions. */
915 if (action_fifo_is_empty(fifo))
916 return;
917
918 /* Finishing executing all deferred actions. */
919 do {
920 struct deferred_action *da = action_fifo_get(fifo);
921 struct sk_buff *skb = da->skb;
7d16c847 922 struct sw_flow_key *key = &da->pkt_key;
2c8c4fb7
AZ
923 const struct nlattr *actions = da->actions;
924
925 if (actions)
7d16c847 926 do_execute_actions(dp, skb, key, actions,
2c8c4fb7
AZ
927 nla_len(actions));
928 else
7d16c847 929 ovs_dp_process_packet(skb, key);
2c8c4fb7
AZ
930 } while (!action_fifo_is_empty(fifo));
931
932 /* Reset FIFO for the next packet. */
933 action_fifo_init(fifo);
934}
935
871dfe07 936/* Execute a list of actions against 'skb'. */
2c8c4fb7 937int ovs_execute_actions(struct datapath *dp, struct sk_buff *skb,
7d16c847
PS
938 const struct sw_flow_actions *acts,
939 struct sw_flow_key *key)
2c8c4fb7
AZ
940{
941 int level = this_cpu_read(exec_actions_level);
942 int err;
943
944 if (unlikely(level >= EXEC_ACTIONS_LEVEL_LIMIT)) {
945 if (net_ratelimit())
946 pr_warn("%s: packet loop detected, dropping.\n",
947 ovs_dp_name(dp));
948
949 kfree_skb(skb);
950 return -ELOOP;
951 }
952
953 this_cpu_inc(exec_actions_level);
7d16c847
PS
954 err = do_execute_actions(dp, skb, key,
955 acts->actions, acts->actions_len);
2c8c4fb7
AZ
956
957 if (!level)
958 process_deferred_actions(dp);
959
960 this_cpu_dec(exec_actions_level);
961
962 /* This return status currently does not reflect the errors
963 * encounted during deferred actions execution. Probably needs to
e74d4817
PS
964 * be fixed in the future.
965 */
2c8c4fb7
AZ
966 return err;
967}
968
969int action_fifos_init(void)
970{
971 action_fifos = alloc_percpu(struct action_fifo);
972 if (!action_fifos)
973 return -ENOMEM;
974
975 return 0;
976}
977
978void action_fifos_exit(void)
60759b2b 979{
2c8c4fb7 980 free_percpu(action_fifos);
871dfe07 981}