lib/dpif-netdev.c

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