odp-execute: Fix possible segfault.
[sliver-openvswitch.git] / lib / odp-execute.c
1 /*
2  * Copyright (c) 2009, 2010, 2011, 2012, 2013 Nicira, Inc.
3  * Copyright (c) 2013 Simon Horman
4  *
5  * Licensed under the Apache License, Version 2.0 (the "License");
6  * you may not use this file except in compliance with the License.
7  * You may obtain a copy of the License at:
8  *
9  *     http://www.apache.org/licenses/LICENSE-2.0
10  *
11  * Unless required by applicable law or agreed to in writing, software
12  * distributed under the License is distributed on an "AS IS" BASIS,
13  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14  * See the License for the specific language governing permissions and
15  * limitations under the License.
16  */
17
18 #include <config.h>
19 #include "odp-execute.h"
20 #include <linux/openvswitch.h>
21 #include <stdlib.h>
22 #include <string.h>
23
24 #include "netlink.h"
25 #include "ofpbuf.h"
26 #include "odp-util.h"
27 #include "packets.h"
28 #include "unaligned.h"
29 #include "util.h"
30
31 static void
32 odp_eth_set_addrs(struct ofpbuf *packet, const struct ovs_key_ethernet *eth_key)
33 {
34     struct eth_header *eh = packet->l2;
35
36     memcpy(eh->eth_src, eth_key->eth_src, sizeof eh->eth_src);
37     memcpy(eh->eth_dst, eth_key->eth_dst, sizeof eh->eth_dst);
38 }
39
40 static void
41 odp_set_tunnel_action(const struct nlattr *a, struct flow_tnl *tun_key)
42 {
43     enum odp_key_fitness fitness;
44
45     fitness = odp_tun_key_from_attr(a, tun_key);
46     ovs_assert(fitness != ODP_FIT_ERROR);
47 }
48
49 static void
50 set_arp(struct ofpbuf *packet, const struct ovs_key_arp *arp_key)
51 {
52     struct arp_eth_header *arp = packet->l3;
53
54     arp->ar_op = arp_key->arp_op;
55     memcpy(arp->ar_sha, arp_key->arp_sha, ETH_ADDR_LEN);
56     put_16aligned_be32(&arp->ar_spa, arp_key->arp_sip);
57     memcpy(arp->ar_tha, arp_key->arp_tha, ETH_ADDR_LEN);
58     put_16aligned_be32(&arp->ar_tpa, arp_key->arp_tip);
59 }
60
61 static void
62 odp_execute_set_action(struct ofpbuf *packet, const struct nlattr *a,
63                        struct flow *flow)
64 {
65     enum ovs_key_attr type = nl_attr_type(a);
66     const struct ovs_key_ipv4 *ipv4_key;
67     const struct ovs_key_ipv6 *ipv6_key;
68     const struct ovs_key_tcp *tcp_key;
69     const struct ovs_key_udp *udp_key;
70     const struct ovs_key_sctp *sctp_key;
71
72     switch (type) {
73     case OVS_KEY_ATTR_PRIORITY:
74         flow->skb_priority = nl_attr_get_u32(a);
75         break;
76
77     case OVS_KEY_ATTR_TUNNEL:
78         odp_set_tunnel_action(a, &flow->tunnel);
79         break;
80
81     case OVS_KEY_ATTR_SKB_MARK:
82         flow->pkt_mark = nl_attr_get_u32(a);
83         break;
84
85     case OVS_KEY_ATTR_ETHERNET:
86         odp_eth_set_addrs(packet,
87                           nl_attr_get_unspec(a, sizeof(struct ovs_key_ethernet)));
88         break;
89
90     case OVS_KEY_ATTR_IPV4:
91         ipv4_key = nl_attr_get_unspec(a, sizeof(struct ovs_key_ipv4));
92         packet_set_ipv4(packet, ipv4_key->ipv4_src, ipv4_key->ipv4_dst,
93                         ipv4_key->ipv4_tos, ipv4_key->ipv4_ttl);
94         break;
95
96     case OVS_KEY_ATTR_IPV6:
97         ipv6_key = nl_attr_get_unspec(a, sizeof(struct ovs_key_ipv6));
98         packet_set_ipv6(packet, ipv6_key->ipv6_proto, ipv6_key->ipv6_src,
99                         ipv6_key->ipv6_dst, ipv6_key->ipv6_tclass,
100                         ipv6_key->ipv6_label, ipv6_key->ipv6_hlimit);
101         break;
102
103     case OVS_KEY_ATTR_TCP:
104         tcp_key = nl_attr_get_unspec(a, sizeof(struct ovs_key_tcp));
105         packet_set_tcp_port(packet, tcp_key->tcp_src, tcp_key->tcp_dst);
106         break;
107
108     case OVS_KEY_ATTR_UDP:
109         udp_key = nl_attr_get_unspec(a, sizeof(struct ovs_key_udp));
110         packet_set_udp_port(packet, udp_key->udp_src, udp_key->udp_dst);
111         break;
112
113     case OVS_KEY_ATTR_SCTP:
114         sctp_key = nl_attr_get_unspec(a, sizeof(struct ovs_key_sctp));
115         packet_set_sctp_port(packet, sctp_key->sctp_src, sctp_key->sctp_dst);
116         break;
117
118     case OVS_KEY_ATTR_MPLS:
119          set_mpls_lse(packet, nl_attr_get_be32(a));
120          break;
121
122     case OVS_KEY_ATTR_ARP:
123         set_arp(packet, nl_attr_get_unspec(a, sizeof(struct ovs_key_arp)));
124         break;
125
126     case OVS_KEY_ATTR_UNSPEC:
127     case OVS_KEY_ATTR_ENCAP:
128     case OVS_KEY_ATTR_ETHERTYPE:
129     case OVS_KEY_ATTR_IN_PORT:
130     case OVS_KEY_ATTR_VLAN:
131     case OVS_KEY_ATTR_ICMP:
132     case OVS_KEY_ATTR_ICMPV6:
133     case OVS_KEY_ATTR_ND:
134     case __OVS_KEY_ATTR_MAX:
135     default:
136         NOT_REACHED();
137     }
138 }
139
140 static void
141 odp_execute_sample(void *dp, struct ofpbuf *packet, struct flow *key,
142                    const struct nlattr *action,
143                    void (*output)(void *dp, struct ofpbuf *packet,
144                                   const struct flow *key,
145                                   odp_port_t out_port),
146                    void (*userspace)(void *dp, struct ofpbuf *packet,
147                                      const struct flow *key,
148                                      const struct nlattr *action))
149 {
150     const struct nlattr *subactions = NULL;
151     const struct nlattr *a;
152     size_t left;
153
154     NL_NESTED_FOR_EACH_UNSAFE (a, left, action) {
155         int type = nl_attr_type(a);
156
157         switch ((enum ovs_sample_attr) type) {
158         case OVS_SAMPLE_ATTR_PROBABILITY:
159             if (random_uint32() >= nl_attr_get_u32(a)) {
160                 return;
161             }
162             break;
163
164         case OVS_SAMPLE_ATTR_ACTIONS:
165             subactions = a;
166             break;
167
168         case OVS_SAMPLE_ATTR_UNSPEC:
169         case __OVS_SAMPLE_ATTR_MAX:
170         default:
171             NOT_REACHED();
172         }
173     }
174
175     odp_execute_actions(dp, packet, key, nl_attr_get(subactions),
176                         nl_attr_get_size(subactions), output, userspace);
177 }
178
179 void
180 odp_execute_actions(void *dp, struct ofpbuf *packet, struct flow *key,
181                     const struct nlattr *actions, size_t actions_len,
182                     void (*output)(void *dp, struct ofpbuf *packet,
183                                    const struct flow *key,
184                                    odp_port_t out_port),
185                     void (*userspace)(void *dp, struct ofpbuf *packet,
186                                       const struct flow *key,
187                                       const struct nlattr *action))
188 {
189     const struct nlattr *a;
190     unsigned int left;
191
192     NL_ATTR_FOR_EACH_UNSAFE (a, left, actions, actions_len) {
193         int type = nl_attr_type(a);
194
195         switch ((enum ovs_action_attr) type) {
196         case OVS_ACTION_ATTR_OUTPUT:
197             if (output) {
198                 output(dp, packet, key, u32_to_odp(nl_attr_get_u32(a)));
199             }
200             break;
201
202         case OVS_ACTION_ATTR_USERSPACE: {
203             if (userspace) {
204                 userspace(dp, packet, key, a);
205             }
206             break;
207         }
208
209         case OVS_ACTION_ATTR_PUSH_VLAN: {
210             const struct ovs_action_push_vlan *vlan = nl_attr_get(a);
211             eth_push_vlan(packet, vlan->vlan_tci);
212             break;
213         }
214
215         case OVS_ACTION_ATTR_POP_VLAN:
216             eth_pop_vlan(packet);
217             break;
218
219         case OVS_ACTION_ATTR_PUSH_MPLS: {
220             const struct ovs_action_push_mpls *mpls = nl_attr_get(a);
221             push_mpls(packet, mpls->mpls_ethertype, mpls->mpls_lse);
222             break;
223          }
224
225         case OVS_ACTION_ATTR_POP_MPLS:
226             pop_mpls(packet, nl_attr_get_be16(a));
227             break;
228
229         case OVS_ACTION_ATTR_SET:
230             odp_execute_set_action(packet, nl_attr_get(a), key);
231             break;
232
233         case OVS_ACTION_ATTR_SAMPLE:
234             odp_execute_sample(dp, packet, key, a, output, userspace);
235             break;
236
237         case OVS_ACTION_ATTR_UNSPEC:
238         case __OVS_ACTION_ATTR_MAX:
239             NOT_REACHED();
240         }
241     }
242 }