]>
Commit | Line | Data |
---|---|---|
72865317 | 1 | /* |
149f577a | 2 | * Copyright (c) 2009, 2010 Nicira Networks. |
72865317 BP |
3 | * |
4 | * Licensed under the Apache License, Version 2.0 (the "License"); | |
5 | * you may not use this file except in compliance with the License. | |
6 | * You may obtain a copy of the License at: | |
7 | * | |
8 | * http://www.apache.org/licenses/LICENSE-2.0 | |
9 | * | |
10 | * Unless required by applicable law or agreed to in writing, software | |
11 | * distributed under the License is distributed on an "AS IS" BASIS, | |
12 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. | |
13 | * See the License for the specific language governing permissions and | |
14 | * limitations under the License. | |
15 | */ | |
16 | ||
17 | #include <config.h> | |
18 | #include "dpif.h" | |
19 | ||
20 | #include <assert.h> | |
21 | #include <ctype.h> | |
22 | #include <errno.h> | |
23 | #include <fcntl.h> | |
24 | #include <inttypes.h> | |
72865317 | 25 | #include <netinet/in.h> |
9d82ec47 | 26 | #include <sys/socket.h> |
7f3adc00 | 27 | #include <net/if.h> |
72865317 BP |
28 | #include <stdlib.h> |
29 | #include <string.h> | |
30 | #include <sys/ioctl.h> | |
31 | #include <sys/stat.h> | |
72865317 BP |
32 | #include <unistd.h> |
33 | ||
34 | #include "csum.h" | |
614c4892 | 35 | #include "dpif.h" |
72865317 | 36 | #include "dpif-provider.h" |
614c4892 | 37 | #include "dummy.h" |
72865317 BP |
38 | #include "flow.h" |
39 | #include "hmap.h" | |
40 | #include "list.h" | |
41 | #include "netdev.h" | |
42 | #include "odp-util.h" | |
43 | #include "ofp-print.h" | |
44 | #include "ofpbuf.h" | |
45 | #include "packets.h" | |
46 | #include "poll-loop.h" | |
462278db | 47 | #include "shash.h" |
72865317 BP |
48 | #include "timeval.h" |
49 | #include "util.h" | |
72865317 | 50 | #include "vlog.h" |
5136ce49 | 51 | |
d98e6007 | 52 | VLOG_DEFINE_THIS_MODULE(dpif_netdev); |
72865317 BP |
53 | |
54 | /* Configuration parameters. */ | |
55 | enum { N_QUEUES = 2 }; /* Number of queues for dpif_recv(). */ | |
56 | enum { MAX_QUEUE_LEN = 100 }; /* Maximum number of packets per queue. */ | |
72865317 BP |
57 | enum { MAX_PORTS = 256 }; /* Maximum number of ports. */ |
58 | enum { MAX_FLOWS = 65536 }; /* Maximum number of flows in flow table. */ | |
59 | ||
60 | /* Enough headroom to add a vlan tag, plus an extra 2 bytes to allow IP | |
61 | * headers to be aligned on a 4-byte boundary. */ | |
62 | enum { DP_NETDEV_HEADROOM = 2 + VLAN_HEADER_LEN }; | |
63 | ||
64 | /* Datapath based on the network device interface from netdev.h. */ | |
65 | struct dp_netdev { | |
614c4892 | 66 | const struct dpif_class *class; |
462278db | 67 | char *name; |
72865317 | 68 | int open_cnt; |
7dab847a | 69 | bool destroyed; |
72865317 BP |
70 | |
71 | bool drop_frags; /* Drop all IP fragments, if true. */ | |
b3907fbc BP |
72 | struct list queues[N_QUEUES]; /* Contain ofpbufs queued for dpif_recv(). */ |
73 | size_t queue_len[N_QUEUES]; /* Number of packets in each queue. */ | |
72865317 | 74 | struct hmap flow_table; /* Flow table. */ |
72865317 BP |
75 | |
76 | /* Statistics. */ | |
77 | long long int n_frags; /* Number of dropped IP fragments. */ | |
78 | long long int n_hit; /* Number of flow table matches. */ | |
79 | long long int n_missed; /* Number of flow table misses. */ | |
80 | long long int n_lost; /* Number of misses not passed to client. */ | |
81 | ||
82 | /* Ports. */ | |
83 | int n_ports; | |
84 | struct dp_netdev_port *ports[MAX_PORTS]; | |
85 | struct list port_list; | |
86 | unsigned int serial; | |
87 | }; | |
88 | ||
89 | /* A port in a netdev-based datapath. */ | |
90 | struct dp_netdev_port { | |
91 | int port_no; /* Index into dp_netdev's 'ports'. */ | |
92 | struct list node; /* Element in dp_netdev's 'port_list'. */ | |
93 | struct netdev *netdev; | |
c3827f61 | 94 | bool internal; /* Internal port? */ |
72865317 BP |
95 | }; |
96 | ||
97 | /* A flow in dp_netdev's 'flow_table'. */ | |
98 | struct dp_netdev_flow { | |
99 | struct hmap_node node; /* Element in dp_netdev's 'flow_table'. */ | |
14608a15 | 100 | struct flow key; |
72865317 BP |
101 | |
102 | /* Statistics. */ | |
2105ccc8 BP |
103 | struct timespec used; /* Last used time. */ |
104 | long long int packet_count; /* Number of packets matched. */ | |
105 | long long int byte_count; /* Number of bytes matched. */ | |
106 | uint16_t tcp_ctl; /* Bitwise-OR of seen tcp_ctl values. */ | |
72865317 BP |
107 | |
108 | /* Actions. */ | |
109 | union odp_action *actions; | |
110 | unsigned int n_actions; | |
111 | }; | |
112 | ||
113 | /* Interface to netdev-based datapath. */ | |
114 | struct dpif_netdev { | |
115 | struct dpif dpif; | |
116 | struct dp_netdev *dp; | |
117 | int listen_mask; | |
118 | unsigned int dp_serial; | |
119 | }; | |
120 | ||
121 | /* All netdev-based datapaths. */ | |
462278db | 122 | static struct shash dp_netdevs = SHASH_INITIALIZER(&dp_netdevs); |
72865317 BP |
123 | |
124 | /* Maximum port MTU seen so far. */ | |
125 | static int max_mtu = ETH_PAYLOAD_MAX; | |
126 | ||
127 | static int get_port_by_number(struct dp_netdev *, uint16_t port_no, | |
128 | struct dp_netdev_port **portp); | |
129 | static int get_port_by_name(struct dp_netdev *, const char *devname, | |
130 | struct dp_netdev_port **portp); | |
131 | static void dp_netdev_free(struct dp_netdev *); | |
132 | static void dp_netdev_flow_flush(struct dp_netdev *); | |
c3827f61 BP |
133 | static int do_add_port(struct dp_netdev *, const char *devname, |
134 | const char *type, uint16_t port_no); | |
72865317 | 135 | static int do_del_port(struct dp_netdev *, uint16_t port_no); |
614c4892 BP |
136 | static int dpif_netdev_open(const struct dpif_class *, const char *name, |
137 | bool create, struct dpif **); | |
72865317 BP |
138 | static int dp_netdev_output_control(struct dp_netdev *, const struct ofpbuf *, |
139 | int queue_no, int port_no, uint32_t arg); | |
140 | static int dp_netdev_execute_actions(struct dp_netdev *, | |
14608a15 | 141 | struct ofpbuf *, struct flow *, |
72865317 BP |
142 | const union odp_action *, int n); |
143 | ||
614c4892 BP |
144 | static struct dpif_class dpif_dummy_class; |
145 | ||
72865317 BP |
146 | static struct dpif_netdev * |
147 | dpif_netdev_cast(const struct dpif *dpif) | |
148 | { | |
614c4892 | 149 | assert(dpif->dpif_class->open == dpif_netdev_open); |
72865317 BP |
150 | return CONTAINER_OF(dpif, struct dpif_netdev, dpif); |
151 | } | |
152 | ||
153 | static struct dp_netdev * | |
154 | get_dp_netdev(const struct dpif *dpif) | |
155 | { | |
156 | return dpif_netdev_cast(dpif)->dp; | |
157 | } | |
158 | ||
72865317 BP |
159 | static struct dpif * |
160 | create_dpif_netdev(struct dp_netdev *dp) | |
161 | { | |
462278db | 162 | uint16_t netflow_id = hash_string(dp->name, 0); |
72865317 | 163 | struct dpif_netdev *dpif; |
72865317 BP |
164 | |
165 | dp->open_cnt++; | |
166 | ||
72865317 | 167 | dpif = xmalloc(sizeof *dpif); |
614c4892 | 168 | dpif_init(&dpif->dpif, dp->class, dp->name, netflow_id >> 8, netflow_id); |
72865317 BP |
169 | dpif->dp = dp; |
170 | dpif->listen_mask = 0; | |
171 | dpif->dp_serial = dp->serial; | |
72865317 BP |
172 | |
173 | return &dpif->dpif; | |
174 | } | |
175 | ||
176 | static int | |
614c4892 BP |
177 | create_dp_netdev(const char *name, const struct dpif_class *class, |
178 | struct dp_netdev **dpp) | |
72865317 BP |
179 | { |
180 | struct dp_netdev *dp; | |
181 | int error; | |
182 | int i; | |
183 | ||
462278db | 184 | dp = xzalloc(sizeof *dp); |
614c4892 | 185 | dp->class = class; |
462278db | 186 | dp->name = xstrdup(name); |
72865317 BP |
187 | dp->open_cnt = 0; |
188 | dp->drop_frags = false; | |
189 | for (i = 0; i < N_QUEUES; i++) { | |
b3907fbc | 190 | list_init(&dp->queues[i]); |
72865317 BP |
191 | } |
192 | hmap_init(&dp->flow_table); | |
72865317 | 193 | list_init(&dp->port_list); |
c3827f61 | 194 | error = do_add_port(dp, name, "internal", ODPP_LOCAL); |
72865317 BP |
195 | if (error) { |
196 | dp_netdev_free(dp); | |
462278db | 197 | return error; |
72865317 BP |
198 | } |
199 | ||
462278db BP |
200 | shash_add(&dp_netdevs, name, dp); |
201 | ||
202 | *dpp = dp; | |
72865317 BP |
203 | return 0; |
204 | } | |
205 | ||
206 | static int | |
614c4892 | 207 | dpif_netdev_open(const struct dpif_class *class, const char *name, |
4a387741 | 208 | bool create, struct dpif **dpifp) |
72865317 | 209 | { |
462278db BP |
210 | struct dp_netdev *dp; |
211 | ||
212 | dp = shash_find_data(&dp_netdevs, name); | |
213 | if (!dp) { | |
214 | if (!create) { | |
215 | return ENODEV; | |
72865317 | 216 | } else { |
614c4892 | 217 | int error = create_dp_netdev(name, class, &dp); |
462278db BP |
218 | if (error) { |
219 | return error; | |
72865317 | 220 | } |
462278db | 221 | assert(dp != NULL); |
72865317 BP |
222 | } |
223 | } else { | |
614c4892 BP |
224 | if (dp->class != class) { |
225 | return EINVAL; | |
226 | } else if (create) { | |
462278db | 227 | return EEXIST; |
72865317 BP |
228 | } |
229 | } | |
462278db BP |
230 | |
231 | *dpifp = create_dpif_netdev(dp); | |
232 | return 0; | |
72865317 BP |
233 | } |
234 | ||
235 | static void | |
236 | dp_netdev_free(struct dp_netdev *dp) | |
237 | { | |
238 | int i; | |
239 | ||
240 | dp_netdev_flow_flush(dp); | |
241 | while (dp->n_ports > 0) { | |
242 | struct dp_netdev_port *port = CONTAINER_OF( | |
243 | dp->port_list.next, struct dp_netdev_port, node); | |
244 | do_del_port(dp, port->port_no); | |
245 | } | |
246 | for (i = 0; i < N_QUEUES; i++) { | |
b3907fbc | 247 | ofpbuf_list_delete(&dp->queues[i]); |
72865317 BP |
248 | } |
249 | hmap_destroy(&dp->flow_table); | |
462278db | 250 | free(dp->name); |
72865317 BP |
251 | free(dp); |
252 | } | |
253 | ||
254 | static void | |
255 | dpif_netdev_close(struct dpif *dpif) | |
256 | { | |
257 | struct dp_netdev *dp = get_dp_netdev(dpif); | |
258 | assert(dp->open_cnt > 0); | |
7dab847a | 259 | if (--dp->open_cnt == 0 && dp->destroyed) { |
462278db | 260 | shash_find_and_delete(&dp_netdevs, dp->name); |
72865317 BP |
261 | dp_netdev_free(dp); |
262 | } | |
263 | free(dpif); | |
264 | } | |
265 | ||
266 | static int | |
7dab847a | 267 | dpif_netdev_destroy(struct dpif *dpif) |
72865317 BP |
268 | { |
269 | struct dp_netdev *dp = get_dp_netdev(dpif); | |
7dab847a | 270 | dp->destroyed = true; |
72865317 BP |
271 | return 0; |
272 | } | |
273 | ||
274 | static int | |
275 | dpif_netdev_get_stats(const struct dpif *dpif, struct odp_stats *stats) | |
276 | { | |
277 | struct dp_netdev *dp = get_dp_netdev(dpif); | |
278 | memset(stats, 0, sizeof *stats); | |
279 | stats->n_flows = hmap_count(&dp->flow_table); | |
280 | stats->cur_capacity = hmap_capacity(&dp->flow_table); | |
281 | stats->max_capacity = MAX_FLOWS; | |
282 | stats->n_ports = dp->n_ports; | |
283 | stats->max_ports = MAX_PORTS; | |
72865317 BP |
284 | stats->n_frags = dp->n_frags; |
285 | stats->n_hit = dp->n_hit; | |
286 | stats->n_missed = dp->n_missed; | |
287 | stats->n_lost = dp->n_lost; | |
288 | stats->max_miss_queue = MAX_QUEUE_LEN; | |
289 | stats->max_action_queue = MAX_QUEUE_LEN; | |
290 | return 0; | |
291 | } | |
292 | ||
293 | static int | |
294 | dpif_netdev_get_drop_frags(const struct dpif *dpif, bool *drop_fragsp) | |
295 | { | |
296 | struct dp_netdev *dp = get_dp_netdev(dpif); | |
297 | *drop_fragsp = dp->drop_frags; | |
298 | return 0; | |
299 | } | |
300 | ||
301 | static int | |
302 | dpif_netdev_set_drop_frags(struct dpif *dpif, bool drop_frags) | |
303 | { | |
304 | struct dp_netdev *dp = get_dp_netdev(dpif); | |
305 | dp->drop_frags = drop_frags; | |
306 | return 0; | |
307 | } | |
308 | ||
309 | static int | |
c3827f61 | 310 | do_add_port(struct dp_netdev *dp, const char *devname, const char *type, |
72865317 BP |
311 | uint16_t port_no) |
312 | { | |
72865317 | 313 | struct dp_netdev_port *port; |
149f577a | 314 | struct netdev_options netdev_options; |
72865317 | 315 | struct netdev *netdev; |
c3827f61 | 316 | bool internal; |
72865317 BP |
317 | int mtu; |
318 | int error; | |
319 | ||
320 | /* XXX reject devices already in some dp_netdev. */ | |
c3827f61 BP |
321 | if (type[0] == '\0' || !strcmp(type, "system")) { |
322 | internal = false; | |
323 | } else if (!strcmp(type, "internal")) { | |
324 | internal = true; | |
325 | } else { | |
326 | VLOG_WARN("%s: unsupported port type %s", devname, type); | |
327 | return EINVAL; | |
328 | } | |
72865317 BP |
329 | |
330 | /* Open and validate network device. */ | |
149f577a JG |
331 | memset(&netdev_options, 0, sizeof netdev_options); |
332 | netdev_options.name = devname; | |
333 | netdev_options.ethertype = NETDEV_ETH_TYPE_ANY; | |
614c4892 BP |
334 | if (dp->class == &dpif_dummy_class) { |
335 | netdev_options.type = "dummy"; | |
336 | } else if (internal) { | |
149f577a | 337 | netdev_options.type = "tap"; |
72865317 | 338 | } |
149f577a JG |
339 | |
340 | error = netdev_open(&netdev_options, &netdev); | |
72865317 BP |
341 | if (error) { |
342 | return error; | |
343 | } | |
344 | /* XXX reject loopback devices */ | |
345 | /* XXX reject non-Ethernet devices */ | |
346 | ||
347 | error = netdev_turn_flags_on(netdev, NETDEV_PROMISC, false); | |
348 | if (error) { | |
349 | netdev_close(netdev); | |
350 | return error; | |
351 | } | |
352 | ||
353 | port = xmalloc(sizeof *port); | |
354 | port->port_no = port_no; | |
355 | port->netdev = netdev; | |
356 | port->internal = internal; | |
357 | ||
3d222126 | 358 | netdev_get_mtu(netdev, &mtu); |
72865317 BP |
359 | if (mtu > max_mtu) { |
360 | max_mtu = mtu; | |
361 | } | |
362 | ||
363 | list_push_back(&dp->port_list, &port->node); | |
364 | dp->ports[port_no] = port; | |
365 | dp->n_ports++; | |
366 | dp->serial++; | |
367 | ||
368 | return 0; | |
369 | } | |
370 | ||
371 | static int | |
c3827f61 | 372 | dpif_netdev_port_add(struct dpif *dpif, struct netdev *netdev, |
72865317 BP |
373 | uint16_t *port_nop) |
374 | { | |
375 | struct dp_netdev *dp = get_dp_netdev(dpif); | |
376 | int port_no; | |
377 | ||
378 | for (port_no = 0; port_no < MAX_PORTS; port_no++) { | |
379 | if (!dp->ports[port_no]) { | |
380 | *port_nop = port_no; | |
c3827f61 BP |
381 | return do_add_port(dp, netdev_get_name(netdev), |
382 | netdev_get_type(netdev), port_no); | |
72865317 BP |
383 | } |
384 | } | |
3c71830a | 385 | return EFBIG; |
72865317 BP |
386 | } |
387 | ||
388 | static int | |
389 | dpif_netdev_port_del(struct dpif *dpif, uint16_t port_no) | |
390 | { | |
391 | struct dp_netdev *dp = get_dp_netdev(dpif); | |
392 | return port_no == ODPP_LOCAL ? EINVAL : do_del_port(dp, port_no); | |
393 | } | |
394 | ||
395 | static bool | |
396 | is_valid_port_number(uint16_t port_no) | |
397 | { | |
398 | return port_no < MAX_PORTS; | |
399 | } | |
400 | ||
401 | static int | |
402 | get_port_by_number(struct dp_netdev *dp, | |
403 | uint16_t port_no, struct dp_netdev_port **portp) | |
404 | { | |
405 | if (!is_valid_port_number(port_no)) { | |
406 | *portp = NULL; | |
407 | return EINVAL; | |
408 | } else { | |
409 | *portp = dp->ports[port_no]; | |
410 | return *portp ? 0 : ENOENT; | |
411 | } | |
412 | } | |
413 | ||
414 | static int | |
415 | get_port_by_name(struct dp_netdev *dp, | |
416 | const char *devname, struct dp_netdev_port **portp) | |
417 | { | |
418 | struct dp_netdev_port *port; | |
419 | ||
4e8e4213 | 420 | LIST_FOR_EACH (port, node, &dp->port_list) { |
72865317 BP |
421 | if (!strcmp(netdev_get_name(port->netdev), devname)) { |
422 | *portp = port; | |
423 | return 0; | |
424 | } | |
425 | } | |
426 | return ENOENT; | |
427 | } | |
428 | ||
429 | static int | |
430 | do_del_port(struct dp_netdev *dp, uint16_t port_no) | |
431 | { | |
432 | struct dp_netdev_port *port; | |
6c88d577 | 433 | char *name; |
72865317 BP |
434 | int error; |
435 | ||
436 | error = get_port_by_number(dp, port_no, &port); | |
437 | if (error) { | |
438 | return error; | |
439 | } | |
440 | ||
441 | list_remove(&port->node); | |
442 | dp->ports[port->port_no] = NULL; | |
443 | dp->n_ports--; | |
444 | dp->serial++; | |
445 | ||
6c88d577 | 446 | name = xstrdup(netdev_get_name(port->netdev)); |
72865317 | 447 | netdev_close(port->netdev); |
149f577a | 448 | |
6c88d577 | 449 | free(name); |
72865317 BP |
450 | free(port); |
451 | ||
452 | return 0; | |
453 | } | |
454 | ||
455 | static void | |
456 | answer_port_query(const struct dp_netdev_port *port, struct odp_port *odp_port) | |
457 | { | |
458 | memset(odp_port, 0, sizeof *odp_port); | |
459 | ovs_strlcpy(odp_port->devname, netdev_get_name(port->netdev), | |
460 | sizeof odp_port->devname); | |
461 | odp_port->port = port->port_no; | |
c3827f61 | 462 | strcpy(odp_port->type, port->internal ? "internal" : "system"); |
72865317 BP |
463 | } |
464 | ||
465 | static int | |
466 | dpif_netdev_port_query_by_number(const struct dpif *dpif, uint16_t port_no, | |
467 | struct odp_port *odp_port) | |
468 | { | |
469 | struct dp_netdev *dp = get_dp_netdev(dpif); | |
470 | struct dp_netdev_port *port; | |
471 | int error; | |
472 | ||
473 | error = get_port_by_number(dp, port_no, &port); | |
474 | if (!error) { | |
475 | answer_port_query(port, odp_port); | |
476 | } | |
477 | return error; | |
478 | } | |
479 | ||
480 | static int | |
481 | dpif_netdev_port_query_by_name(const struct dpif *dpif, const char *devname, | |
482 | struct odp_port *odp_port) | |
483 | { | |
484 | struct dp_netdev *dp = get_dp_netdev(dpif); | |
485 | struct dp_netdev_port *port; | |
486 | int error; | |
487 | ||
488 | error = get_port_by_name(dp, devname, &port); | |
489 | if (!error) { | |
490 | answer_port_query(port, odp_port); | |
491 | } | |
492 | return error; | |
493 | } | |
494 | ||
495 | static void | |
496 | dp_netdev_free_flow(struct dp_netdev *dp, struct dp_netdev_flow *flow) | |
497 | { | |
498 | hmap_remove(&dp->flow_table, &flow->node); | |
499 | free(flow->actions); | |
500 | free(flow); | |
501 | } | |
502 | ||
503 | static void | |
504 | dp_netdev_flow_flush(struct dp_netdev *dp) | |
505 | { | |
506 | struct dp_netdev_flow *flow, *next; | |
507 | ||
4e8e4213 | 508 | HMAP_FOR_EACH_SAFE (flow, next, node, &dp->flow_table) { |
72865317 BP |
509 | dp_netdev_free_flow(dp, flow); |
510 | } | |
511 | } | |
512 | ||
513 | static int | |
514 | dpif_netdev_flow_flush(struct dpif *dpif) | |
515 | { | |
516 | struct dp_netdev *dp = get_dp_netdev(dpif); | |
517 | dp_netdev_flow_flush(dp); | |
518 | return 0; | |
519 | } | |
520 | ||
521 | static int | |
522 | dpif_netdev_port_list(const struct dpif *dpif, struct odp_port *ports, int n) | |
523 | { | |
524 | struct dp_netdev *dp = get_dp_netdev(dpif); | |
525 | struct dp_netdev_port *port; | |
526 | int i; | |
527 | ||
528 | i = 0; | |
4e8e4213 | 529 | LIST_FOR_EACH (port, node, &dp->port_list) { |
72865317 BP |
530 | struct odp_port *odp_port = &ports[i]; |
531 | if (i >= n) { | |
532 | break; | |
533 | } | |
534 | answer_port_query(port, odp_port); | |
535 | i++; | |
536 | } | |
537 | return dp->n_ports; | |
538 | } | |
539 | ||
540 | static int | |
67a4917b | 541 | dpif_netdev_port_poll(const struct dpif *dpif_, char **devnamep OVS_UNUSED) |
72865317 BP |
542 | { |
543 | struct dpif_netdev *dpif = dpif_netdev_cast(dpif_); | |
544 | if (dpif->dp_serial != dpif->dp->serial) { | |
545 | dpif->dp_serial = dpif->dp->serial; | |
546 | return ENOBUFS; | |
547 | } else { | |
548 | return EAGAIN; | |
549 | } | |
550 | } | |
551 | ||
552 | static void | |
553 | dpif_netdev_port_poll_wait(const struct dpif *dpif_) | |
554 | { | |
555 | struct dpif_netdev *dpif = dpif_netdev_cast(dpif_); | |
556 | if (dpif->dp_serial != dpif->dp->serial) { | |
557 | poll_immediate_wake(); | |
558 | } | |
559 | } | |
560 | ||
72865317 | 561 | static struct dp_netdev_flow * |
14608a15 | 562 | dp_netdev_lookup_flow(const struct dp_netdev *dp, const struct flow *key) |
72865317 BP |
563 | { |
564 | struct dp_netdev_flow *flow; | |
565 | ||
4e8e4213 | 566 | HMAP_FOR_EACH_WITH_HASH (flow, node, flow_hash(key, 0), &dp->flow_table) { |
72865317 BP |
567 | if (flow_equal(&flow->key, key)) { |
568 | return flow; | |
569 | } | |
570 | } | |
571 | return NULL; | |
572 | } | |
573 | ||
14608a15 | 574 | /* The caller must fill in odp_flow->key itself. */ |
72865317 | 575 | static void |
fde05ade | 576 | answer_flow_query(struct dp_netdev_flow *flow, uint32_t query_flags, |
72865317 BP |
577 | struct odp_flow *odp_flow) |
578 | { | |
579 | if (flow) { | |
72865317 BP |
580 | odp_flow->stats.n_packets = flow->packet_count; |
581 | odp_flow->stats.n_bytes = flow->byte_count; | |
582 | odp_flow->stats.used_sec = flow->used.tv_sec; | |
c73814a3 | 583 | odp_flow->stats.used_nsec = flow->used.tv_nsec; |
72865317 | 584 | odp_flow->stats.tcp_flags = TCP_FLAGS(flow->tcp_ctl); |
abfec865 | 585 | odp_flow->stats.reserved = 0; |
72865317 BP |
586 | odp_flow->stats.error = 0; |
587 | if (odp_flow->n_actions > 0) { | |
588 | unsigned int n = MIN(odp_flow->n_actions, flow->n_actions); | |
589 | memcpy(odp_flow->actions, flow->actions, | |
590 | n * sizeof *odp_flow->actions); | |
591 | odp_flow->n_actions = flow->n_actions; | |
592 | } | |
fde05ade JG |
593 | |
594 | if (query_flags & ODPFF_ZERO_TCP_FLAGS) { | |
595 | flow->tcp_ctl = 0; | |
596 | } | |
597 | ||
72865317 BP |
598 | } else { |
599 | odp_flow->stats.error = ENOENT; | |
600 | } | |
601 | } | |
602 | ||
603 | static int | |
604 | dpif_netdev_flow_get(const struct dpif *dpif, struct odp_flow flows[], int n) | |
605 | { | |
606 | struct dp_netdev *dp = get_dp_netdev(dpif); | |
607 | int i; | |
608 | ||
609 | for (i = 0; i < n; i++) { | |
610 | struct odp_flow *odp_flow = &flows[i]; | |
14608a15 BP |
611 | struct flow key; |
612 | ||
613 | odp_flow_key_to_flow(&odp_flow->key, &key); | |
614 | answer_flow_query(dp_netdev_lookup_flow(dp, &key), | |
fde05ade | 615 | odp_flow->flags, odp_flow); |
72865317 BP |
616 | } |
617 | return 0; | |
618 | } | |
619 | ||
620 | static int | |
621 | dpif_netdev_validate_actions(const union odp_action *actions, int n_actions, | |
622 | bool *mutates) | |
623 | { | |
3c5f6de3 | 624 | unsigned int i; |
72865317 BP |
625 | |
626 | *mutates = false; | |
3c5f6de3 JG |
627 | for (i = 0; i < n_actions; i++) { |
628 | const union odp_action *a = &actions[i]; | |
629 | switch (a->type) { | |
630 | case ODPAT_OUTPUT: | |
631 | if (a->output.port >= MAX_PORTS) { | |
632 | return EINVAL; | |
72865317 | 633 | } |
3c5f6de3 | 634 | break; |
72865317 | 635 | |
72865317 BP |
636 | case ODPAT_CONTROLLER: |
637 | break; | |
638 | ||
26233bb4 | 639 | case ODPAT_SET_DL_TCI: |
72865317 | 640 | *mutates = true; |
27bcf966 | 641 | if (a->dl_tci.tci & htons(VLAN_CFI)) { |
3c5f6de3 | 642 | return EINVAL; |
72865317 | 643 | } |
3c5f6de3 JG |
644 | break; |
645 | ||
646 | case ODPAT_SET_NW_TOS: | |
647 | *mutates = true; | |
648 | if (a->nw_tos.nw_tos & IP_ECN_MASK) { | |
649 | return EINVAL; | |
650 | } | |
651 | break; | |
72865317 BP |
652 | |
653 | case ODPAT_STRIP_VLAN: | |
654 | case ODPAT_SET_DL_SRC: | |
655 | case ODPAT_SET_DL_DST: | |
656 | case ODPAT_SET_NW_SRC: | |
657 | case ODPAT_SET_NW_DST: | |
658 | case ODPAT_SET_TP_SRC: | |
659 | case ODPAT_SET_TP_DST: | |
660 | *mutates = true; | |
661 | break; | |
662 | ||
3c5f6de3 | 663 | default: |
72865317 | 664 | return EOPNOTSUPP; |
3c5f6de3 JG |
665 | } |
666 | } | |
667 | return 0; | |
72865317 BP |
668 | } |
669 | ||
670 | static int | |
671 | set_flow_actions(struct dp_netdev_flow *flow, struct odp_flow *odp_flow) | |
672 | { | |
673 | size_t n_bytes; | |
674 | bool mutates; | |
675 | int error; | |
676 | ||
677 | if (odp_flow->n_actions >= 4096 / sizeof *odp_flow->actions) { | |
678 | return EINVAL; | |
679 | } | |
680 | error = dpif_netdev_validate_actions(odp_flow->actions, | |
681 | odp_flow->n_actions, &mutates); | |
682 | if (error) { | |
683 | return error; | |
684 | } | |
685 | ||
686 | n_bytes = odp_flow->n_actions * sizeof *flow->actions; | |
687 | flow->actions = xrealloc(flow->actions, n_bytes); | |
688 | flow->n_actions = odp_flow->n_actions; | |
689 | memcpy(flow->actions, odp_flow->actions, n_bytes); | |
690 | return 0; | |
691 | } | |
692 | ||
693 | static int | |
694 | add_flow(struct dpif *dpif, struct odp_flow *odp_flow) | |
695 | { | |
696 | struct dp_netdev *dp = get_dp_netdev(dpif); | |
697 | struct dp_netdev_flow *flow; | |
698 | int error; | |
699 | ||
ec6fde61 | 700 | flow = xzalloc(sizeof *flow); |
14608a15 | 701 | odp_flow_key_to_flow(&odp_flow->key, &flow->key); |
72865317 BP |
702 | |
703 | error = set_flow_actions(flow, odp_flow); | |
704 | if (error) { | |
705 | free(flow); | |
706 | return error; | |
707 | } | |
708 | ||
709 | hmap_insert(&dp->flow_table, &flow->node, flow_hash(&flow->key, 0)); | |
710 | return 0; | |
711 | } | |
712 | ||
713 | static void | |
714 | clear_stats(struct dp_netdev_flow *flow) | |
715 | { | |
716 | flow->used.tv_sec = 0; | |
c73814a3 | 717 | flow->used.tv_nsec = 0; |
72865317 BP |
718 | flow->packet_count = 0; |
719 | flow->byte_count = 0; | |
72865317 BP |
720 | flow->tcp_ctl = 0; |
721 | } | |
722 | ||
723 | static int | |
724 | dpif_netdev_flow_put(struct dpif *dpif, struct odp_flow_put *put) | |
725 | { | |
726 | struct dp_netdev *dp = get_dp_netdev(dpif); | |
727 | struct dp_netdev_flow *flow; | |
14608a15 | 728 | struct flow key; |
72865317 | 729 | |
14608a15 BP |
730 | odp_flow_key_to_flow(&put->flow.key, &key); |
731 | flow = dp_netdev_lookup_flow(dp, &key); | |
72865317 BP |
732 | if (!flow) { |
733 | if (put->flags & ODPPF_CREATE) { | |
734 | if (hmap_count(&dp->flow_table) < MAX_FLOWS) { | |
735 | return add_flow(dpif, &put->flow); | |
736 | } else { | |
3c71830a | 737 | return EFBIG; |
72865317 BP |
738 | } |
739 | } else { | |
740 | return ENOENT; | |
741 | } | |
742 | } else { | |
743 | if (put->flags & ODPPF_MODIFY) { | |
744 | int error = set_flow_actions(flow, &put->flow); | |
745 | if (!error && put->flags & ODPPF_ZERO_STATS) { | |
746 | clear_stats(flow); | |
747 | } | |
748 | return error; | |
749 | } else { | |
750 | return EEXIST; | |
751 | } | |
752 | } | |
753 | } | |
754 | ||
755 | ||
756 | static int | |
757 | dpif_netdev_flow_del(struct dpif *dpif, struct odp_flow *odp_flow) | |
758 | { | |
759 | struct dp_netdev *dp = get_dp_netdev(dpif); | |
760 | struct dp_netdev_flow *flow; | |
14608a15 | 761 | struct flow key; |
72865317 | 762 | |
14608a15 BP |
763 | odp_flow_key_to_flow(&odp_flow->key, &key); |
764 | flow = dp_netdev_lookup_flow(dp, &key); | |
72865317 | 765 | if (flow) { |
fde05ade | 766 | answer_flow_query(flow, 0, odp_flow); |
72865317 BP |
767 | dp_netdev_free_flow(dp, flow); |
768 | return 0; | |
769 | } else { | |
770 | return ENOENT; | |
771 | } | |
772 | } | |
773 | ||
774 | static int | |
775 | dpif_netdev_flow_list(const struct dpif *dpif, struct odp_flow flows[], int n) | |
776 | { | |
777 | struct dp_netdev *dp = get_dp_netdev(dpif); | |
778 | struct dp_netdev_flow *flow; | |
779 | int i; | |
780 | ||
781 | i = 0; | |
4e8e4213 | 782 | HMAP_FOR_EACH (flow, node, &dp->flow_table) { |
72865317 BP |
783 | if (i >= n) { |
784 | break; | |
785 | } | |
14608a15 BP |
786 | |
787 | odp_flow_key_from_flow(&flows[i].key, &flow->key); | |
788 | answer_flow_query(flow, 0, &flows[i]); | |
789 | i++; | |
72865317 BP |
790 | } |
791 | return hmap_count(&dp->flow_table); | |
792 | } | |
793 | ||
794 | static int | |
f1588b1f | 795 | dpif_netdev_execute(struct dpif *dpif, |
72865317 BP |
796 | const union odp_action actions[], int n_actions, |
797 | const struct ofpbuf *packet) | |
798 | { | |
799 | struct dp_netdev *dp = get_dp_netdev(dpif); | |
800 | struct ofpbuf copy; | |
801 | bool mutates; | |
ae412e7d | 802 | struct flow key; |
72865317 BP |
803 | int error; |
804 | ||
3c71830a | 805 | if (packet->size < ETH_HEADER_LEN || packet->size > UINT16_MAX) { |
72865317 BP |
806 | return EINVAL; |
807 | } | |
808 | ||
809 | error = dpif_netdev_validate_actions(actions, n_actions, &mutates); | |
810 | if (error) { | |
811 | return error; | |
812 | } | |
813 | ||
814 | if (mutates) { | |
815 | /* We need a deep copy of 'packet' since we're going to modify its | |
816 | * data. */ | |
817 | ofpbuf_init(©, DP_NETDEV_HEADROOM + packet->size); | |
4b87bea6 | 818 | ofpbuf_reserve(©, DP_NETDEV_HEADROOM); |
72865317 BP |
819 | ofpbuf_put(©, packet->data, packet->size); |
820 | } else { | |
821 | /* We still need a shallow copy of 'packet', even though we won't | |
822 | * modify its data, because flow_extract() modifies packet->l2, etc. | |
823 | * We could probably get away with modifying those but it's more polite | |
824 | * if we don't. */ | |
825 | copy = *packet; | |
826 | } | |
14608a15 BP |
827 | flow_extract(©, 0, -1, &key); |
828 | error = dp_netdev_execute_actions(dp, ©, &key, actions, n_actions); | |
72865317 BP |
829 | if (mutates) { |
830 | ofpbuf_uninit(©); | |
831 | } | |
832 | return error; | |
833 | } | |
834 | ||
835 | static int | |
836 | dpif_netdev_recv_get_mask(const struct dpif *dpif, int *listen_mask) | |
837 | { | |
838 | struct dpif_netdev *dpif_netdev = dpif_netdev_cast(dpif); | |
839 | *listen_mask = dpif_netdev->listen_mask; | |
840 | return 0; | |
841 | } | |
842 | ||
843 | static int | |
844 | dpif_netdev_recv_set_mask(struct dpif *dpif, int listen_mask) | |
845 | { | |
846 | struct dpif_netdev *dpif_netdev = dpif_netdev_cast(dpif); | |
847 | if (!(listen_mask & ~ODPL_ALL)) { | |
848 | dpif_netdev->listen_mask = listen_mask; | |
849 | return 0; | |
850 | } else { | |
851 | return EINVAL; | |
852 | } | |
853 | } | |
854 | ||
b3907fbc | 855 | static int |
72865317 BP |
856 | find_nonempty_queue(struct dpif *dpif) |
857 | { | |
858 | struct dpif_netdev *dpif_netdev = dpif_netdev_cast(dpif); | |
859 | struct dp_netdev *dp = get_dp_netdev(dpif); | |
860 | int mask = dpif_netdev->listen_mask; | |
861 | int i; | |
862 | ||
863 | for (i = 0; i < N_QUEUES; i++) { | |
b3907fbc BP |
864 | struct list *queue = &dp->queues[i]; |
865 | if (!list_is_empty(queue) && mask & (1u << i)) { | |
866 | return i; | |
72865317 BP |
867 | } |
868 | } | |
b3907fbc | 869 | return -1; |
72865317 BP |
870 | } |
871 | ||
872 | static int | |
873 | dpif_netdev_recv(struct dpif *dpif, struct ofpbuf **bufp) | |
874 | { | |
b3907fbc BP |
875 | int queue_idx = find_nonempty_queue(dpif); |
876 | if (queue_idx >= 0) { | |
877 | struct dp_netdev *dp = get_dp_netdev(dpif); | |
878 | ||
879 | *bufp = ofpbuf_from_list(list_pop_front(&dp->queues[queue_idx])); | |
880 | dp->queue_len[queue_idx]--; | |
881 | ||
72865317 BP |
882 | return 0; |
883 | } else { | |
884 | return EAGAIN; | |
885 | } | |
886 | } | |
887 | ||
888 | static void | |
889 | dpif_netdev_recv_wait(struct dpif *dpif) | |
890 | { | |
b3907fbc | 891 | if (find_nonempty_queue(dpif) >= 0) { |
72865317 BP |
892 | poll_immediate_wake(); |
893 | } else { | |
894 | /* No messages ready to be received, and dp_wait() will ensure that we | |
895 | * wake up to queue new messages, so there is nothing to do. */ | |
896 | } | |
897 | } | |
898 | \f | |
899 | static void | |
14608a15 | 900 | dp_netdev_flow_used(struct dp_netdev_flow *flow, struct flow *key, |
72865317 BP |
901 | const struct ofpbuf *packet) |
902 | { | |
c73814a3 | 903 | time_timespec(&flow->used); |
72865317 BP |
904 | flow->packet_count++; |
905 | flow->byte_count += packet->size; | |
abfec865 BP |
906 | if (key->dl_type == htons(ETH_TYPE_IP) && key->nw_proto == IPPROTO_TCP) { |
907 | struct tcp_header *th = packet->l4; | |
908 | flow->tcp_ctl |= th->tcp_ctl; | |
72865317 BP |
909 | } |
910 | } | |
911 | ||
912 | static void | |
913 | dp_netdev_port_input(struct dp_netdev *dp, struct dp_netdev_port *port, | |
914 | struct ofpbuf *packet) | |
915 | { | |
916 | struct dp_netdev_flow *flow; | |
14608a15 | 917 | struct flow key; |
72865317 | 918 | |
1805876e BP |
919 | if (packet->size < ETH_HEADER_LEN) { |
920 | return; | |
921 | } | |
659586ef | 922 | if (flow_extract(packet, 0, port->port_no, &key) && dp->drop_frags) { |
72865317 BP |
923 | dp->n_frags++; |
924 | return; | |
925 | } | |
926 | ||
927 | flow = dp_netdev_lookup_flow(dp, &key); | |
928 | if (flow) { | |
929 | dp_netdev_flow_used(flow, &key, packet); | |
930 | dp_netdev_execute_actions(dp, packet, &key, | |
931 | flow->actions, flow->n_actions); | |
932 | dp->n_hit++; | |
933 | } else { | |
934 | dp->n_missed++; | |
935 | dp_netdev_output_control(dp, packet, _ODPL_MISS_NR, port->port_no, 0); | |
936 | } | |
937 | } | |
938 | ||
939 | static void | |
940 | dp_netdev_run(void) | |
941 | { | |
462278db | 942 | struct shash_node *node; |
72865317 | 943 | struct ofpbuf packet; |
72865317 BP |
944 | |
945 | ofpbuf_init(&packet, DP_NETDEV_HEADROOM + max_mtu); | |
462278db BP |
946 | SHASH_FOR_EACH (node, &dp_netdevs) { |
947 | struct dp_netdev *dp = node->data; | |
72865317 BP |
948 | struct dp_netdev_port *port; |
949 | ||
4e8e4213 | 950 | LIST_FOR_EACH (port, node, &dp->port_list) { |
72865317 BP |
951 | int error; |
952 | ||
953 | /* Reset packet contents. */ | |
4b87bea6 BP |
954 | ofpbuf_clear(&packet); |
955 | ofpbuf_reserve(&packet, DP_NETDEV_HEADROOM); | |
72865317 BP |
956 | |
957 | error = netdev_recv(port->netdev, &packet); | |
958 | if (!error) { | |
959 | dp_netdev_port_input(dp, port, &packet); | |
7fa710e4 | 960 | } else if (error != EAGAIN && error != EOPNOTSUPP) { |
72865317 BP |
961 | struct vlog_rate_limit rl = VLOG_RATE_LIMIT_INIT(1, 5); |
962 | VLOG_ERR_RL(&rl, "error receiving data from %s: %s", | |
963 | netdev_get_name(port->netdev), strerror(error)); | |
964 | } | |
965 | } | |
966 | } | |
967 | ofpbuf_uninit(&packet); | |
968 | } | |
969 | ||
970 | static void | |
971 | dp_netdev_wait(void) | |
972 | { | |
462278db | 973 | struct shash_node *node; |
72865317 | 974 | |
462278db BP |
975 | SHASH_FOR_EACH (node, &dp_netdevs) { |
976 | struct dp_netdev *dp = node->data; | |
72865317 | 977 | struct dp_netdev_port *port; |
462278db | 978 | |
4e8e4213 | 979 | LIST_FOR_EACH (port, node, &dp->port_list) { |
72865317 BP |
980 | netdev_recv_wait(port->netdev); |
981 | } | |
982 | } | |
983 | } | |
984 | ||
2a910c50 | 985 | |
27bcf966 BP |
986 | /* Modify the TCI field of 'packet'. If a VLAN tag is present, its TCI field |
987 | * is replaced by 'tci'. If a VLAN tag is not present, one is added with the | |
988 | * TCI field set to 'tci'. | |
2a910c50 | 989 | */ |
72865317 | 990 | static void |
27bcf966 | 991 | dp_netdev_set_dl_tci(struct ofpbuf *packet, uint16_t tci) |
72865317 BP |
992 | { |
993 | struct vlan_eth_header *veh; | |
142181fc | 994 | struct eth_header *eh; |
72865317 | 995 | |
142181fc BP |
996 | eh = packet->l2; |
997 | if (packet->size >= sizeof(struct vlan_eth_header) | |
998 | && eh->eth_type == htons(ETH_TYPE_VLAN)) { | |
72865317 | 999 | veh = packet->l2; |
27bcf966 | 1000 | veh->veth_tci = tci; |
72865317 BP |
1001 | } else { |
1002 | /* Insert new 802.1Q header. */ | |
72865317 BP |
1003 | struct vlan_eth_header tmp; |
1004 | memcpy(tmp.veth_dst, eh->eth_dst, ETH_ADDR_LEN); | |
1005 | memcpy(tmp.veth_src, eh->eth_src, ETH_ADDR_LEN); | |
1006 | tmp.veth_type = htons(ETH_TYPE_VLAN); | |
27bcf966 | 1007 | tmp.veth_tci = tci; |
72865317 BP |
1008 | tmp.veth_next_type = eh->eth_type; |
1009 | ||
1010 | veh = ofpbuf_push_uninit(packet, VLAN_HEADER_LEN); | |
1011 | memcpy(veh, &tmp, sizeof tmp); | |
1012 | packet->l2 = (char*)packet->l2 - VLAN_HEADER_LEN; | |
1013 | } | |
72865317 BP |
1014 | } |
1015 | ||
1016 | static void | |
aebdcb93 | 1017 | dp_netdev_strip_vlan(struct ofpbuf *packet) |
72865317 BP |
1018 | { |
1019 | struct vlan_eth_header *veh = packet->l2; | |
1805876e BP |
1020 | if (packet->size >= sizeof *veh |
1021 | && veh->veth_type == htons(ETH_TYPE_VLAN)) { | |
72865317 BP |
1022 | struct eth_header tmp; |
1023 | ||
1024 | memcpy(tmp.eth_dst, veh->veth_dst, ETH_ADDR_LEN); | |
1025 | memcpy(tmp.eth_src, veh->veth_src, ETH_ADDR_LEN); | |
1026 | tmp.eth_type = veh->veth_next_type; | |
1027 | ||
4b87bea6 | 1028 | ofpbuf_pull(packet, VLAN_HEADER_LEN); |
72865317 BP |
1029 | packet->l2 = (char*)packet->l2 + VLAN_HEADER_LEN; |
1030 | memcpy(packet->data, &tmp, sizeof tmp); | |
72865317 BP |
1031 | } |
1032 | } | |
1033 | ||
1034 | static void | |
aebdcb93 | 1035 | dp_netdev_set_dl_src(struct ofpbuf *packet, const uint8_t dl_addr[ETH_ADDR_LEN]) |
72865317 BP |
1036 | { |
1037 | struct eth_header *eh = packet->l2; | |
1038 | memcpy(eh->eth_src, dl_addr, sizeof eh->eth_src); | |
1039 | } | |
1040 | ||
1041 | static void | |
aebdcb93 | 1042 | dp_netdev_set_dl_dst(struct ofpbuf *packet, const uint8_t dl_addr[ETH_ADDR_LEN]) |
72865317 BP |
1043 | { |
1044 | struct eth_header *eh = packet->l2; | |
1045 | memcpy(eh->eth_dst, dl_addr, sizeof eh->eth_dst); | |
1046 | } | |
1047 | ||
ca78c6b6 | 1048 | static bool |
14608a15 | 1049 | is_ip(const struct ofpbuf *packet, const struct flow *key) |
ca78c6b6 BP |
1050 | { |
1051 | return key->dl_type == htons(ETH_TYPE_IP) && packet->l4; | |
1052 | } | |
1053 | ||
72865317 | 1054 | static void |
14608a15 | 1055 | dp_netdev_set_nw_addr(struct ofpbuf *packet, struct flow *key, |
72865317 BP |
1056 | const struct odp_action_nw_addr *a) |
1057 | { | |
ca78c6b6 | 1058 | if (is_ip(packet, key)) { |
72865317 BP |
1059 | struct ip_header *nh = packet->l3; |
1060 | uint32_t *field; | |
1061 | ||
1062 | field = a->type == ODPAT_SET_NW_SRC ? &nh->ip_src : &nh->ip_dst; | |
ca78c6b6 | 1063 | if (key->nw_proto == IP_TYPE_TCP && packet->l7) { |
72865317 BP |
1064 | struct tcp_header *th = packet->l4; |
1065 | th->tcp_csum = recalc_csum32(th->tcp_csum, *field, a->nw_addr); | |
ca78c6b6 | 1066 | } else if (key->nw_proto == IP_TYPE_UDP && packet->l7) { |
72865317 BP |
1067 | struct udp_header *uh = packet->l4; |
1068 | if (uh->udp_csum) { | |
1069 | uh->udp_csum = recalc_csum32(uh->udp_csum, *field, a->nw_addr); | |
1070 | if (!uh->udp_csum) { | |
1071 | uh->udp_csum = 0xffff; | |
1072 | } | |
1073 | } | |
1074 | } | |
1075 | nh->ip_csum = recalc_csum32(nh->ip_csum, *field, a->nw_addr); | |
1076 | *field = a->nw_addr; | |
1077 | } | |
1078 | } | |
1079 | ||
959a2ecd | 1080 | static void |
14608a15 | 1081 | dp_netdev_set_nw_tos(struct ofpbuf *packet, struct flow *key, |
959a2ecd JP |
1082 | const struct odp_action_nw_tos *a) |
1083 | { | |
ca78c6b6 | 1084 | if (is_ip(packet, key)) { |
959a2ecd JP |
1085 | struct ip_header *nh = packet->l3; |
1086 | uint8_t *field = &nh->ip_tos; | |
1087 | ||
f1193301 | 1088 | /* Set the DSCP bits and preserve the ECN bits. */ |
3c5f6de3 | 1089 | uint8_t new = a->nw_tos | (nh->ip_tos & IP_ECN_MASK); |
959a2ecd JP |
1090 | |
1091 | nh->ip_csum = recalc_csum16(nh->ip_csum, htons((uint16_t)*field), | |
3d785a24 | 1092 | htons((uint16_t) new)); |
959a2ecd JP |
1093 | *field = new; |
1094 | } | |
1095 | } | |
1096 | ||
72865317 | 1097 | static void |
14608a15 | 1098 | dp_netdev_set_tp_port(struct ofpbuf *packet, struct flow *key, |
72865317 BP |
1099 | const struct odp_action_tp_port *a) |
1100 | { | |
ca78c6b6 | 1101 | if (is_ip(packet, key)) { |
72865317 | 1102 | uint16_t *field; |
ca78c6b6 | 1103 | if (key->nw_proto == IPPROTO_TCP && packet->l7) { |
72865317 BP |
1104 | struct tcp_header *th = packet->l4; |
1105 | field = a->type == ODPAT_SET_TP_SRC ? &th->tcp_src : &th->tcp_dst; | |
1106 | th->tcp_csum = recalc_csum16(th->tcp_csum, *field, a->tp_port); | |
1107 | *field = a->tp_port; | |
ca78c6b6 | 1108 | } else if (key->nw_proto == IPPROTO_UDP && packet->l7) { |
72865317 BP |
1109 | struct udp_header *uh = packet->l4; |
1110 | field = a->type == ODPAT_SET_TP_SRC ? &uh->udp_src : &uh->udp_dst; | |
1111 | uh->udp_csum = recalc_csum16(uh->udp_csum, *field, a->tp_port); | |
1112 | *field = a->tp_port; | |
11cdf5e6 JG |
1113 | } else { |
1114 | return; | |
1115 | } | |
72865317 BP |
1116 | } |
1117 | } | |
1118 | ||
1119 | static void | |
1120 | dp_netdev_output_port(struct dp_netdev *dp, struct ofpbuf *packet, | |
1121 | uint16_t out_port) | |
1122 | { | |
2105ccc8 | 1123 | struct dp_netdev_port *p = dp->ports[out_port]; |
72865317 BP |
1124 | if (p) { |
1125 | netdev_send(p->netdev, packet); | |
1126 | } | |
1127 | } | |
1128 | ||
72865317 BP |
1129 | static int |
1130 | dp_netdev_output_control(struct dp_netdev *dp, const struct ofpbuf *packet, | |
1131 | int queue_no, int port_no, uint32_t arg) | |
1132 | { | |
72865317 BP |
1133 | struct odp_msg *header; |
1134 | struct ofpbuf *msg; | |
1135 | size_t msg_size; | |
1136 | ||
b3907fbc | 1137 | if (dp->queue_len[queue_no] >= MAX_QUEUE_LEN) { |
72865317 BP |
1138 | dp->n_lost++; |
1139 | return ENOBUFS; | |
1140 | } | |
1141 | ||
1142 | msg_size = sizeof *header + packet->size; | |
68efcbec | 1143 | msg = ofpbuf_new_with_headroom(msg_size, DPIF_RECV_MSG_PADDING); |
72865317 BP |
1144 | header = ofpbuf_put_uninit(msg, sizeof *header); |
1145 | header->type = queue_no; | |
1146 | header->length = msg_size; | |
1147 | header->port = port_no; | |
1148 | header->arg = arg; | |
1149 | ofpbuf_put(msg, packet->data, packet->size); | |
b3907fbc BP |
1150 | list_push_back(&dp->queues[queue_no], &msg->list_node); |
1151 | dp->queue_len[queue_no]++; | |
72865317 BP |
1152 | |
1153 | return 0; | |
1154 | } | |
1155 | ||
401eeb92 BP |
1156 | /* Returns true if 'packet' is an invalid Ethernet+IPv4 ARP packet: one with |
1157 | * screwy or truncated header fields or one whose inner and outer Ethernet | |
1158 | * address differ. */ | |
1159 | static bool | |
14608a15 | 1160 | dp_netdev_is_spoofed_arp(struct ofpbuf *packet, const struct flow *key) |
401eeb92 BP |
1161 | { |
1162 | struct arp_eth_header *arp; | |
1163 | struct eth_header *eth; | |
1164 | ptrdiff_t l3_size; | |
1165 | ||
1166 | if (key->dl_type != htons(ETH_TYPE_ARP)) { | |
1167 | return false; | |
1168 | } | |
1169 | ||
1170 | l3_size = (char *) ofpbuf_end(packet) - (char *) packet->l3; | |
1171 | if (l3_size < sizeof(struct arp_eth_header)) { | |
1172 | return true; | |
1173 | } | |
1174 | ||
1175 | eth = packet->l2; | |
1176 | arp = packet->l3; | |
1177 | return (arp->ar_hrd != htons(ARP_HRD_ETHERNET) | |
1178 | || arp->ar_pro != htons(ARP_PRO_IP) | |
1179 | || arp->ar_hln != ETH_HEADER_LEN | |
1180 | || arp->ar_pln != 4 | |
1181 | || !eth_addr_equals(arp->ar_sha, eth->eth_src)); | |
1182 | } | |
1183 | ||
72865317 BP |
1184 | static int |
1185 | dp_netdev_execute_actions(struct dp_netdev *dp, | |
14608a15 | 1186 | struct ofpbuf *packet, struct flow *key, |
72865317 BP |
1187 | const union odp_action *actions, int n_actions) |
1188 | { | |
1189 | int i; | |
1190 | for (i = 0; i < n_actions; i++) { | |
1191 | const union odp_action *a = &actions[i]; | |
1192 | ||
2105ccc8 BP |
1193 | switch (a->type) { |
1194 | case ODPAT_OUTPUT: | |
72865317 | 1195 | dp_netdev_output_port(dp, packet, a->output.port); |
2105ccc8 | 1196 | break; |
72865317 | 1197 | |
2105ccc8 | 1198 | case ODPAT_CONTROLLER: |
72865317 BP |
1199 | dp_netdev_output_control(dp, packet, _ODPL_ACTION_NR, |
1200 | key->in_port, a->controller.arg); | |
2105ccc8 | 1201 | break; |
72865317 | 1202 | |
26233bb4 | 1203 | case ODPAT_SET_DL_TCI: |
27bcf966 | 1204 | dp_netdev_set_dl_tci(packet, a->dl_tci.tci); |
72865317 BP |
1205 | break; |
1206 | ||
2105ccc8 BP |
1207 | case ODPAT_STRIP_VLAN: |
1208 | dp_netdev_strip_vlan(packet); | |
1209 | break; | |
72865317 | 1210 | |
2105ccc8 | 1211 | case ODPAT_SET_DL_SRC: |
aebdcb93 | 1212 | dp_netdev_set_dl_src(packet, a->dl_addr.dl_addr); |
2105ccc8 | 1213 | break; |
72865317 | 1214 | |
2105ccc8 | 1215 | case ODPAT_SET_DL_DST: |
aebdcb93 | 1216 | dp_netdev_set_dl_dst(packet, a->dl_addr.dl_addr); |
2105ccc8 | 1217 | break; |
72865317 | 1218 | |
2105ccc8 BP |
1219 | case ODPAT_SET_NW_SRC: |
1220 | case ODPAT_SET_NW_DST: | |
1221 | dp_netdev_set_nw_addr(packet, key, &a->nw_addr); | |
1222 | break; | |
72865317 | 1223 | |
2105ccc8 BP |
1224 | case ODPAT_SET_NW_TOS: |
1225 | dp_netdev_set_nw_tos(packet, key, &a->nw_tos); | |
1226 | break; | |
959a2ecd | 1227 | |
2105ccc8 BP |
1228 | case ODPAT_SET_TP_SRC: |
1229 | case ODPAT_SET_TP_DST: | |
1230 | dp_netdev_set_tp_port(packet, key, &a->tp_port); | |
1231 | break; | |
401eeb92 BP |
1232 | |
1233 | case ODPAT_DROP_SPOOFED_ARP: | |
1234 | if (dp_netdev_is_spoofed_arp(packet, key)) { | |
1235 | return 0; | |
1236 | } | |
2105ccc8 BP |
1237 | } |
1238 | } | |
72865317 BP |
1239 | return 0; |
1240 | } | |
1241 | ||
1242 | const struct dpif_class dpif_netdev_class = { | |
72865317 BP |
1243 | "netdev", |
1244 | dp_netdev_run, | |
1245 | dp_netdev_wait, | |
d3d22744 | 1246 | NULL, /* enumerate */ |
72865317 BP |
1247 | dpif_netdev_open, |
1248 | dpif_netdev_close, | |
d3d22744 | 1249 | NULL, /* get_all_names */ |
7dab847a | 1250 | dpif_netdev_destroy, |
72865317 BP |
1251 | dpif_netdev_get_stats, |
1252 | dpif_netdev_get_drop_frags, | |
1253 | dpif_netdev_set_drop_frags, | |
1254 | dpif_netdev_port_add, | |
1255 | dpif_netdev_port_del, | |
1256 | dpif_netdev_port_query_by_number, | |
1257 | dpif_netdev_port_query_by_name, | |
1258 | dpif_netdev_port_list, | |
1259 | dpif_netdev_port_poll, | |
1260 | dpif_netdev_port_poll_wait, | |
72865317 BP |
1261 | dpif_netdev_flow_get, |
1262 | dpif_netdev_flow_put, | |
1263 | dpif_netdev_flow_del, | |
1264 | dpif_netdev_flow_flush, | |
1265 | dpif_netdev_flow_list, | |
1266 | dpif_netdev_execute, | |
1267 | dpif_netdev_recv_get_mask, | |
1268 | dpif_netdev_recv_set_mask, | |
72b06300 BP |
1269 | NULL, /* get_sflow_probability */ |
1270 | NULL, /* set_sflow_probability */ | |
aae51f53 | 1271 | NULL, /* queue_to_priority */ |
72865317 BP |
1272 | dpif_netdev_recv, |
1273 | dpif_netdev_recv_wait, | |
1274 | }; | |
614c4892 BP |
1275 | |
1276 | void | |
1277 | dpif_dummy_register(void) | |
1278 | { | |
1279 | if (!dpif_dummy_class.type) { | |
1280 | dpif_dummy_class = dpif_netdev_class; | |
1281 | dpif_dummy_class.type = "dummy"; | |
1282 | dp_register_provider(&dpif_dummy_class); | |
1283 | } | |
1284 | } |