Prepare Open vSwitch 1.1.2 release.
[sliver-openvswitch.git] / lib / netdev-linux.c
1 /*
2  * Copyright (c) 2009, 2010, 2011 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 <assert.h>
19 #include <errno.h>
20 #include <fcntl.h>
21 #include <arpa/inet.h>
22 #include <inttypes.h>
23 #include <linux/gen_stats.h>
24 #include <linux/if_tun.h>
25 #include <linux/ip.h>
26 #include <linux/types.h>
27 #include <linux/ethtool.h>
28 #include <linux/mii.h>
29 #include <linux/pkt_sched.h>
30 #include <linux/rtnetlink.h>
31 #include <linux/sockios.h>
32 #include <linux/version.h>
33 #include <sys/types.h>
34 #include <sys/ioctl.h>
35 #include <sys/socket.h>
36 #include <netpacket/packet.h>
37 #include <net/ethernet.h>
38 #include <net/if.h>
39 #include <linux/if_tunnel.h>
40 #include <net/if_arp.h>
41 #include <net/if_packet.h>
42 #include <net/route.h>
43 #include <netinet/in.h>
44 #include <poll.h>
45 #include <stdlib.h>
46 #include <string.h>
47 #include <unistd.h>
48
49 #include "coverage.h"
50 #include "dpif-linux.h"
51 #include "dynamic-string.h"
52 #include "fatal-signal.h"
53 #include "hash.h"
54 #include "hmap.h"
55 #include "netdev-provider.h"
56 #include "netdev-vport.h"
57 #include "netlink.h"
58 #include "netlink-socket.h"
59 #include "ofpbuf.h"
60 #include "openflow/openflow.h"
61 #include "packets.h"
62 #include "poll-loop.h"
63 #include "rtnetlink.h"
64 #include "rtnetlink-link.h"
65 #include "socket-util.h"
66 #include "shash.h"
67 #include "sset.h"
68 #include "vlog.h"
69
70 VLOG_DEFINE_THIS_MODULE(netdev_linux);
71
72 COVERAGE_DEFINE(netdev_get_vlan_vid);
73 COVERAGE_DEFINE(netdev_set_policing);
74 COVERAGE_DEFINE(netdev_arp_lookup);
75 COVERAGE_DEFINE(netdev_get_ifindex);
76 COVERAGE_DEFINE(netdev_get_hwaddr);
77 COVERAGE_DEFINE(netdev_set_hwaddr);
78 COVERAGE_DEFINE(netdev_ethtool);
79 \f
80 /* These were introduced in Linux 2.6.14, so they might be missing if we have
81  * old headers. */
82 #ifndef ADVERTISED_Pause
83 #define ADVERTISED_Pause                (1 << 13)
84 #endif
85 #ifndef ADVERTISED_Asym_Pause
86 #define ADVERTISED_Asym_Pause           (1 << 14)
87 #endif
88
89 /* This was introduced in Linux 2.6.25, so it might be missing if we have old
90  * headers. */
91 #ifndef TC_RTAB_SIZE
92 #define TC_RTAB_SIZE 1024
93 #endif
94
95 static struct rtnetlink_notifier netdev_linux_cache_notifier;
96 static int cache_notifier_refcount;
97
98 enum {
99     VALID_IFINDEX           = 1 << 0,
100     VALID_ETHERADDR         = 1 << 1,
101     VALID_IN4               = 1 << 2,
102     VALID_IN6               = 1 << 3,
103     VALID_MTU               = 1 << 4,
104     VALID_CARRIER           = 1 << 5,
105     VALID_IS_PSEUDO         = 1 << 6, /* Represents is_internal and is_tap. */
106     VALID_POLICING          = 1 << 7,
107     VALID_HAVE_VPORT_STATS  = 1 << 8
108 };
109
110 struct tap_state {
111     int fd;
112     bool opened;
113 };
114 \f
115 /* Traffic control. */
116
117 /* An instance of a traffic control class.  Always associated with a particular
118  * network device.
119  *
120  * Each TC implementation subclasses this with whatever additional data it
121  * needs. */
122 struct tc {
123     const struct tc_ops *ops;
124     struct hmap queues;         /* Contains "struct tc_queue"s.
125                                  * Read by generic TC layer.
126                                  * Written only by TC implementation. */
127 };
128
129 /* One traffic control queue.
130  *
131  * Each TC implementation subclasses this with whatever additional data it
132  * needs. */
133 struct tc_queue {
134     struct hmap_node hmap_node; /* In struct tc's "queues" hmap. */
135     unsigned int queue_id;      /* OpenFlow queue ID. */
136 };
137
138 /* A particular kind of traffic control.  Each implementation generally maps to
139  * one particular Linux qdisc class.
140  *
141  * The functions below return 0 if successful or a positive errno value on
142  * failure, except where otherwise noted.  All of them must be provided, except
143  * where otherwise noted. */
144 struct tc_ops {
145     /* Name used by kernel in the TCA_KIND attribute of tcmsg, e.g. "htb".
146      * This is null for tc_ops_default and tc_ops_other, for which there are no
147      * appropriate values. */
148     const char *linux_name;
149
150     /* Name used in OVS database, e.g. "linux-htb".  Must be nonnull. */
151     const char *ovs_name;
152
153     /* Number of supported OpenFlow queues, 0 for qdiscs that have no
154      * queues.  The queues are numbered 0 through n_queues - 1. */
155     unsigned int n_queues;
156
157     /* Called to install this TC class on 'netdev'.  The implementation should
158      * make the Netlink calls required to set up 'netdev' with the right qdisc
159      * and configure it according to 'details'.  The implementation may assume
160      * that the current qdisc is the default; that is, there is no need for it
161      * to delete the current qdisc before installing itself.
162      *
163      * The contents of 'details' should be documented as valid for 'ovs_name'
164      * in the "other_config" column in the "QoS" table in vswitchd/vswitch.xml
165      * (which is built as ovs-vswitchd.conf.db(8)).
166      *
167      * This function must return 0 if and only if it sets 'netdev->tc' to an
168      * initialized 'struct tc'.
169      *
170      * (This function is null for tc_ops_other, which cannot be installed.  For
171      * other TC classes it should always be nonnull.) */
172     int (*tc_install)(struct netdev *netdev, const struct shash *details);
173
174     /* Called when the netdev code determines (through a Netlink query) that
175      * this TC class's qdisc is installed on 'netdev', but we didn't install
176      * it ourselves and so don't know any of the details.
177      *
178      * 'nlmsg' is the kernel reply to a RTM_GETQDISC Netlink message for
179      * 'netdev'.  The TCA_KIND attribute of 'nlmsg' is 'linux_name'.  The
180      * implementation should parse the other attributes of 'nlmsg' as
181      * necessary to determine its configuration.  If necessary it should also
182      * use Netlink queries to determine the configuration of queues on
183      * 'netdev'.
184      *
185      * This function must return 0 if and only if it sets 'netdev->tc' to an
186      * initialized 'struct tc'. */
187     int (*tc_load)(struct netdev *netdev, struct ofpbuf *nlmsg);
188
189     /* Destroys the data structures allocated by the implementation as part of
190      * 'tc'.  (This includes destroying 'tc->queues' by calling
191      * tc_destroy(tc).
192      *
193      * The implementation should not need to perform any Netlink calls.  If
194      * desirable, the caller is responsible for deconfiguring the kernel qdisc.
195      * (But it may not be desirable.)
196      *
197      * This function may be null if 'tc' is trivial. */
198     void (*tc_destroy)(struct tc *tc);
199
200     /* Retrieves details of 'netdev->tc' configuration into 'details'.
201      *
202      * The implementation should not need to perform any Netlink calls, because
203      * the 'tc_install' or 'tc_load' that instantiated 'netdev->tc' should have
204      * cached the configuration.
205      *
206      * The contents of 'details' should be documented as valid for 'ovs_name'
207      * in the "other_config" column in the "QoS" table in vswitchd/vswitch.xml
208      * (which is built as ovs-vswitchd.conf.db(8)).
209      *
210      * This function may be null if 'tc' is not configurable.
211      */
212     int (*qdisc_get)(const struct netdev *netdev, struct shash *details);
213
214     /* Reconfigures 'netdev->tc' according to 'details', performing any
215      * required Netlink calls to complete the reconfiguration.
216      *
217      * The contents of 'details' should be documented as valid for 'ovs_name'
218      * in the "other_config" column in the "QoS" table in vswitchd/vswitch.xml
219      * (which is built as ovs-vswitchd.conf.db(8)).
220      *
221      * This function may be null if 'tc' is not configurable.
222      */
223     int (*qdisc_set)(struct netdev *, const struct shash *details);
224
225     /* Retrieves details of 'queue' on 'netdev->tc' into 'details'.  'queue' is
226      * one of the 'struct tc_queue's within 'netdev->tc->queues'.
227      *
228      * The contents of 'details' should be documented as valid for 'ovs_name'
229      * in the "other_config" column in the "Queue" table in
230      * vswitchd/vswitch.xml (which is built as ovs-vswitchd.conf.db(8)).
231      *
232      * The implementation should not need to perform any Netlink calls, because
233      * the 'tc_install' or 'tc_load' that instantiated 'netdev->tc' should have
234      * cached the queue configuration.
235      *
236      * This function may be null if 'tc' does not have queues ('n_queues' is
237      * 0). */
238     int (*class_get)(const struct netdev *netdev, const struct tc_queue *queue,
239                      struct shash *details);
240
241     /* Configures or reconfigures 'queue_id' on 'netdev->tc' according to
242      * 'details', perfoming any required Netlink calls to complete the
243      * reconfiguration.  The caller ensures that 'queue_id' is less than
244      * 'n_queues'.
245      *
246      * The contents of 'details' should be documented as valid for 'ovs_name'
247      * in the "other_config" column in the "Queue" table in
248      * vswitchd/vswitch.xml (which is built as ovs-vswitchd.conf.db(8)).
249      *
250      * This function may be null if 'tc' does not have queues or its queues are
251      * not configurable. */
252     int (*class_set)(struct netdev *, unsigned int queue_id,
253                      const struct shash *details);
254
255     /* Deletes 'queue' from 'netdev->tc'.  'queue' is one of the 'struct
256      * tc_queue's within 'netdev->tc->queues'.
257      *
258      * This function may be null if 'tc' does not have queues or its queues
259      * cannot be deleted. */
260     int (*class_delete)(struct netdev *, struct tc_queue *queue);
261
262     /* Obtains stats for 'queue' from 'netdev->tc'.  'queue' is one of the
263      * 'struct tc_queue's within 'netdev->tc->queues'.
264      *
265      * On success, initializes '*stats'.
266      *
267      * This function may be null if 'tc' does not have queues or if it cannot
268      * report queue statistics. */
269     int (*class_get_stats)(const struct netdev *netdev,
270                            const struct tc_queue *queue,
271                            struct netdev_queue_stats *stats);
272
273     /* Extracts queue stats from 'nlmsg', which is a response to a
274      * RTM_GETTCLASS message, and passes them to 'cb' along with 'aux'.
275      *
276      * This function may be null if 'tc' does not have queues or if it cannot
277      * report queue statistics. */
278     int (*class_dump_stats)(const struct netdev *netdev,
279                             const struct ofpbuf *nlmsg,
280                             netdev_dump_queue_stats_cb *cb, void *aux);
281 };
282
283 static void
284 tc_init(struct tc *tc, const struct tc_ops *ops)
285 {
286     tc->ops = ops;
287     hmap_init(&tc->queues);
288 }
289
290 static void
291 tc_destroy(struct tc *tc)
292 {
293     hmap_destroy(&tc->queues);
294 }
295
296 static const struct tc_ops tc_ops_htb;
297 static const struct tc_ops tc_ops_hfsc;
298 static const struct tc_ops tc_ops_default;
299 static const struct tc_ops tc_ops_other;
300
301 static const struct tc_ops *tcs[] = {
302     &tc_ops_htb,                /* Hierarchy token bucket (see tc-htb(8)). */
303     &tc_ops_hfsc,               /* Hierarchical fair service curve. */
304     &tc_ops_default,            /* Default qdisc (see tc-pfifo_fast(8)). */
305     &tc_ops_other,              /* Some other qdisc. */
306     NULL
307 };
308
309 static unsigned int tc_make_handle(unsigned int major, unsigned int minor);
310 static unsigned int tc_get_major(unsigned int handle);
311 static unsigned int tc_get_minor(unsigned int handle);
312
313 static unsigned int tc_ticks_to_bytes(unsigned int rate, unsigned int ticks);
314 static unsigned int tc_bytes_to_ticks(unsigned int rate, unsigned int size);
315 static unsigned int tc_buffer_per_jiffy(unsigned int rate);
316
317 static struct tcmsg *tc_make_request(const struct netdev *, int type,
318                                      unsigned int flags, struct ofpbuf *);
319 static int tc_transact(struct ofpbuf *request, struct ofpbuf **replyp);
320
321 static int tc_parse_qdisc(const struct ofpbuf *, const char **kind,
322                           struct nlattr **options);
323 static int tc_parse_class(const struct ofpbuf *, unsigned int *queue_id,
324                           struct nlattr **options,
325                           struct netdev_queue_stats *);
326 static int tc_query_class(const struct netdev *,
327                           unsigned int handle, unsigned int parent,
328                           struct ofpbuf **replyp);
329 static int tc_delete_class(const struct netdev *, unsigned int handle);
330
331 static int tc_del_qdisc(struct netdev *netdev);
332 static int tc_query_qdisc(const struct netdev *netdev);
333
334 static int tc_calc_cell_log(unsigned int mtu);
335 static void tc_fill_rate(struct tc_ratespec *rate, uint64_t bps, int mtu);
336 static void tc_put_rtab(struct ofpbuf *, uint16_t type,
337                         const struct tc_ratespec *rate);
338 static int tc_calc_buffer(unsigned int Bps, int mtu, uint64_t burst_bytes);
339 \f
340 struct netdev_dev_linux {
341     struct netdev_dev netdev_dev;
342
343     struct shash_node *shash_node;
344     unsigned int cache_valid;
345
346     /* The following are figured out "on demand" only.  They are only valid
347      * when the corresponding VALID_* bit in 'cache_valid' is set. */
348     int ifindex;
349     uint8_t etheraddr[ETH_ADDR_LEN];
350     struct in_addr address, netmask;
351     struct in6_addr in6;
352     int mtu;
353     int carrier;
354     bool is_internal;           /* Is this an openvswitch internal device? */
355     bool is_tap;                /* Is this a tuntap device? */
356     uint32_t kbits_rate;        /* Policing data. */
357     uint32_t kbits_burst;
358     bool have_vport_stats;
359     struct tc *tc;
360
361     union {
362         struct tap_state tap;
363     } state;
364 };
365
366 struct netdev_linux {
367     struct netdev netdev;
368     int fd;
369 };
370
371 /* An AF_INET socket (used for ioctl operations). */
372 static int af_inet_sock = -1;
373
374 /* A Netlink routing socket that is not subscribed to any multicast groups. */
375 static struct nl_sock *rtnl_sock;
376
377 struct netdev_linux_notifier {
378     struct netdev_notifier notifier;
379     struct list node;
380 };
381
382 static struct shash netdev_linux_notifiers =
383     SHASH_INITIALIZER(&netdev_linux_notifiers);
384 static struct rtnetlink_notifier netdev_linux_poll_notifier;
385
386 /* This is set pretty low because we probably won't learn anything from the
387  * additional log messages. */
388 static struct vlog_rate_limit rl = VLOG_RATE_LIMIT_INIT(5, 20);
389
390 static int netdev_linux_init(void);
391
392 static int netdev_linux_do_ethtool(const char *name, struct ethtool_cmd *,
393                                    int cmd, const char *cmd_name);
394 static int netdev_linux_do_ioctl(const char *name, struct ifreq *, int cmd,
395                                  const char *cmd_name);
396 static int netdev_linux_get_ipv4(const struct netdev *, struct in_addr *,
397                                  int cmd, const char *cmd_name);
398 static int get_flags(const struct netdev *, int *flagsp);
399 static int set_flags(struct netdev *, int flags);
400 static int do_get_ifindex(const char *netdev_name);
401 static int get_ifindex(const struct netdev *, int *ifindexp);
402 static int do_set_addr(struct netdev *netdev,
403                        int ioctl_nr, const char *ioctl_name,
404                        struct in_addr addr);
405 static int get_etheraddr(const char *netdev_name, uint8_t ea[ETH_ADDR_LEN]);
406 static int set_etheraddr(const char *netdev_name, int hwaddr_family,
407                          const uint8_t[ETH_ADDR_LEN]);
408 static int get_stats_via_netlink(int ifindex, struct netdev_stats *stats);
409 static int get_stats_via_proc(const char *netdev_name, struct netdev_stats *stats);
410
411 static bool
412 is_netdev_linux_class(const struct netdev_class *netdev_class)
413 {
414     return netdev_class->init == netdev_linux_init;
415 }
416
417 static struct netdev_dev_linux *
418 netdev_dev_linux_cast(const struct netdev_dev *netdev_dev)
419 {
420     const struct netdev_class *netdev_class = netdev_dev_get_class(netdev_dev);
421     assert(is_netdev_linux_class(netdev_class));
422
423     return CONTAINER_OF(netdev_dev, struct netdev_dev_linux, netdev_dev);
424 }
425
426 static struct netdev_linux *
427 netdev_linux_cast(const struct netdev *netdev)
428 {
429     struct netdev_dev *netdev_dev = netdev_get_dev(netdev);
430     const struct netdev_class *netdev_class = netdev_dev_get_class(netdev_dev);
431     assert(is_netdev_linux_class(netdev_class));
432
433     return CONTAINER_OF(netdev, struct netdev_linux, netdev);
434 }
435 \f
436 static int
437 netdev_linux_init(void)
438 {
439     static int status = -1;
440     if (status < 0) {
441         /* Create AF_INET socket. */
442         af_inet_sock = socket(AF_INET, SOCK_DGRAM, 0);
443         status = af_inet_sock >= 0 ? 0 : errno;
444         if (status) {
445             VLOG_ERR("failed to create inet socket: %s", strerror(status));
446         }
447
448         /* Create rtnetlink socket. */
449         if (!status) {
450             status = nl_sock_create(NETLINK_ROUTE, &rtnl_sock);
451             if (status) {
452                 VLOG_ERR_RL(&rl, "failed to create rtnetlink socket: %s",
453                             strerror(status));
454             }
455         }
456     }
457     return status;
458 }
459
460 static void
461 netdev_linux_run(void)
462 {
463     rtnetlink_link_notifier_run();
464 }
465
466 static void
467 netdev_linux_wait(void)
468 {
469     rtnetlink_link_notifier_wait();
470 }
471
472 static void
473 netdev_linux_cache_cb(const struct rtnetlink_link_change *change,
474                       void *aux OVS_UNUSED)
475 {
476     struct netdev_dev_linux *dev;
477     if (change) {
478         struct netdev_dev *base_dev = netdev_dev_from_name(change->ifname);
479         if (base_dev) {
480             const struct netdev_class *netdev_class =
481                                                 netdev_dev_get_class(base_dev);
482
483             if (is_netdev_linux_class(netdev_class)) {
484                 dev = netdev_dev_linux_cast(base_dev);
485                 dev->cache_valid = 0;
486             }
487         }
488     } else {
489         struct shash device_shash;
490         struct shash_node *node;
491
492         shash_init(&device_shash);
493         netdev_dev_get_devices(&netdev_linux_class, &device_shash);
494         SHASH_FOR_EACH (node, &device_shash) {
495             dev = node->data;
496             dev->cache_valid = 0;
497         }
498         shash_destroy(&device_shash);
499     }
500 }
501
502 /* Creates system and internal devices. */
503 static int
504 netdev_linux_create(const struct netdev_class *class,
505                            const char *name, const struct shash *args,
506                            struct netdev_dev **netdev_devp)
507 {
508     struct netdev_dev_linux *netdev_dev;
509     int error;
510
511     if (!shash_is_empty(args)) {
512         VLOG_WARN("%s: arguments for %s devices should be empty",
513                   name, class->type);
514     }
515
516     if (!cache_notifier_refcount) {
517         error = rtnetlink_link_notifier_register(&netdev_linux_cache_notifier,
518                                                  netdev_linux_cache_cb, NULL);
519         if (error) {
520             return error;
521         }
522     }
523     cache_notifier_refcount++;
524
525     netdev_dev = xzalloc(sizeof *netdev_dev);
526     netdev_dev_init(&netdev_dev->netdev_dev, name, args, class);
527
528     *netdev_devp = &netdev_dev->netdev_dev;
529     return 0;
530 }
531
532 /* For most types of netdevs we open the device for each call of
533  * netdev_open().  However, this is not the case with tap devices,
534  * since it is only possible to open the device once.  In this
535  * situation we share a single file descriptor, and consequently
536  * buffers, across all readers.  Therefore once data is read it will
537  * be unavailable to other reads for tap devices. */
538 static int
539 netdev_linux_create_tap(const struct netdev_class *class OVS_UNUSED,
540                         const char *name, const struct shash *args,
541                         struct netdev_dev **netdev_devp)
542 {
543     struct netdev_dev_linux *netdev_dev;
544     struct tap_state *state;
545     static const char tap_dev[] = "/dev/net/tun";
546     struct ifreq ifr;
547     int error;
548
549     if (!shash_is_empty(args)) {
550         VLOG_WARN("%s: arguments for TAP devices should be empty", name);
551     }
552
553     netdev_dev = xzalloc(sizeof *netdev_dev);
554     state = &netdev_dev->state.tap;
555
556     /* Open tap device. */
557     state->fd = open(tap_dev, O_RDWR);
558     if (state->fd < 0) {
559         error = errno;
560         VLOG_WARN("opening \"%s\" failed: %s", tap_dev, strerror(error));
561         goto error;
562     }
563
564     /* Create tap device. */
565     ifr.ifr_flags = IFF_TAP | IFF_NO_PI;
566     ovs_strzcpy(ifr.ifr_name, name, sizeof ifr.ifr_name);
567     if (ioctl(state->fd, TUNSETIFF, &ifr) == -1) {
568         VLOG_WARN("%s: creating tap device failed: %s", name,
569                   strerror(errno));
570         error = errno;
571         goto error;
572     }
573
574     /* Make non-blocking. */
575     error = set_nonblocking(state->fd);
576     if (error) {
577         goto error;
578     }
579
580     netdev_dev_init(&netdev_dev->netdev_dev, name, args, &netdev_tap_class);
581     *netdev_devp = &netdev_dev->netdev_dev;
582     return 0;
583
584 error:
585     free(netdev_dev);
586     return error;
587 }
588
589 static void
590 destroy_tap(struct netdev_dev_linux *netdev_dev)
591 {
592     struct tap_state *state = &netdev_dev->state.tap;
593
594     if (state->fd >= 0) {
595         close(state->fd);
596     }
597 }
598
599 /* Destroys the netdev device 'netdev_dev_'. */
600 static void
601 netdev_linux_destroy(struct netdev_dev *netdev_dev_)
602 {
603     struct netdev_dev_linux *netdev_dev = netdev_dev_linux_cast(netdev_dev_);
604     const struct netdev_class *class = netdev_dev_get_class(netdev_dev_);
605
606     if (netdev_dev->tc && netdev_dev->tc->ops->tc_destroy) {
607         netdev_dev->tc->ops->tc_destroy(netdev_dev->tc);
608     }
609
610     if (class == &netdev_linux_class || class == &netdev_internal_class) {
611         cache_notifier_refcount--;
612
613         if (!cache_notifier_refcount) {
614             rtnetlink_link_notifier_unregister(&netdev_linux_cache_notifier);
615         }
616     } else if (class == &netdev_tap_class) {
617         destroy_tap(netdev_dev);
618     } else {
619         NOT_REACHED();
620     }
621
622     free(netdev_dev);
623 }
624
625 static int
626 netdev_linux_open(struct netdev_dev *netdev_dev_, int ethertype,
627                   struct netdev **netdevp)
628 {
629     struct netdev_dev_linux *netdev_dev = netdev_dev_linux_cast(netdev_dev_);
630     struct netdev_linux *netdev;
631     enum netdev_flags flags;
632     int error;
633
634     /* Allocate network device. */
635     netdev = xzalloc(sizeof *netdev);
636     netdev->fd = -1;
637     netdev_init(&netdev->netdev, netdev_dev_);
638
639     /* Verify that the device really exists, by attempting to read its flags.
640      * (The flags might be cached, in which case this won't actually do an
641      * ioctl.)
642      *
643      * Don't do this for "internal" netdevs, though, because those have to be
644      * created as netdev objects before they exist in the kernel, because
645      * creating them in the kernel happens by passing a netdev object to
646      * dpif_port_add(). */
647     if (netdev_dev_get_class(netdev_dev_) != &netdev_internal_class) {
648         error = netdev_get_flags(&netdev->netdev, &flags);
649         if (error == ENODEV) {
650             goto error;
651         }
652     }
653
654     if (!strcmp(netdev_dev_get_type(netdev_dev_), "tap") &&
655         !netdev_dev->state.tap.opened) {
656
657         /* We assume that the first user of the tap device is the primary user
658          * and give them the tap FD.  Subsequent users probably just expect
659          * this to be a system device so open it normally to avoid send/receive
660          * directions appearing to be reversed. */
661         netdev->fd = netdev_dev->state.tap.fd;
662         netdev_dev->state.tap.opened = true;
663     } else if (ethertype != NETDEV_ETH_TYPE_NONE) {
664         struct sockaddr_ll sll;
665         int protocol;
666         int ifindex;
667
668         /* Create file descriptor. */
669         protocol = (ethertype == NETDEV_ETH_TYPE_ANY ? ETH_P_ALL
670                     : ethertype == NETDEV_ETH_TYPE_802_2 ? ETH_P_802_2
671                     : ethertype);
672         netdev->fd = socket(PF_PACKET, SOCK_RAW, htons(protocol));
673         if (netdev->fd < 0) {
674             error = errno;
675             goto error;
676         }
677
678         /* Set non-blocking mode. */
679         error = set_nonblocking(netdev->fd);
680         if (error) {
681             goto error;
682         }
683
684         /* Get ethernet device index. */
685         error = get_ifindex(&netdev->netdev, &ifindex);
686         if (error) {
687             goto error;
688         }
689
690         /* Bind to specific ethernet device. */
691         memset(&sll, 0, sizeof sll);
692         sll.sll_family = AF_PACKET;
693         sll.sll_ifindex = ifindex;
694         if (bind(netdev->fd,
695                  (struct sockaddr *) &sll, sizeof sll) < 0) {
696             error = errno;
697             VLOG_ERR("bind to %s failed: %s", netdev_dev_get_name(netdev_dev_),
698                      strerror(error));
699             goto error;
700         }
701
702         /* Between the socket() and bind() calls above, the socket receives all
703          * packets of the requested type on all system interfaces.  We do not
704          * want to receive that data, but there is no way to avoid it.  So we
705          * must now drain out the receive queue. */
706         error = drain_rcvbuf(netdev->fd);
707         if (error) {
708             goto error;
709         }
710     }
711
712     *netdevp = &netdev->netdev;
713     return 0;
714
715 error:
716     netdev_uninit(&netdev->netdev, true);
717     return error;
718 }
719
720 /* Closes and destroys 'netdev'. */
721 static void
722 netdev_linux_close(struct netdev *netdev_)
723 {
724     struct netdev_linux *netdev = netdev_linux_cast(netdev_);
725
726     if (netdev->fd > 0 && strcmp(netdev_get_type(netdev_), "tap")) {
727         close(netdev->fd);
728     }
729     free(netdev);
730 }
731
732 /* Initializes 'sset' with a list of the names of all known network devices. */
733 static int
734 netdev_linux_enumerate(struct sset *sset)
735 {
736     struct if_nameindex *names;
737
738     names = if_nameindex();
739     if (names) {
740         size_t i;
741
742         for (i = 0; names[i].if_name != NULL; i++) {
743             sset_add(sset, names[i].if_name);
744         }
745         if_freenameindex(names);
746         return 0;
747     } else {
748         VLOG_WARN("could not obtain list of network device names: %s",
749                   strerror(errno));
750         return errno;
751     }
752 }
753
754 static int
755 netdev_linux_recv(struct netdev *netdev_, void *data, size_t size)
756 {
757     struct netdev_linux *netdev = netdev_linux_cast(netdev_);
758
759     if (netdev->fd < 0) {
760         /* Device was opened with NETDEV_ETH_TYPE_NONE. */
761         return -EAGAIN;
762     }
763
764     for (;;) {
765         ssize_t retval = read(netdev->fd, data, size);
766         if (retval >= 0) {
767             return retval;
768         } else if (errno != EINTR) {
769             if (errno != EAGAIN) {
770                 VLOG_WARN_RL(&rl, "error receiving Ethernet packet on %s: %s",
771                              strerror(errno), netdev_get_name(netdev_));
772             }
773             return -errno;
774         }
775     }
776 }
777
778 /* Registers with the poll loop to wake up from the next call to poll_block()
779  * when a packet is ready to be received with netdev_recv() on 'netdev'. */
780 static void
781 netdev_linux_recv_wait(struct netdev *netdev_)
782 {
783     struct netdev_linux *netdev = netdev_linux_cast(netdev_);
784     if (netdev->fd >= 0) {
785         poll_fd_wait(netdev->fd, POLLIN);
786     }
787 }
788
789 /* Discards all packets waiting to be received from 'netdev'. */
790 static int
791 netdev_linux_drain(struct netdev *netdev_)
792 {
793     struct netdev_linux *netdev = netdev_linux_cast(netdev_);
794     if (netdev->fd < 0) {
795         return 0;
796     } else if (!strcmp(netdev_get_type(netdev_), "tap")) {
797         struct ifreq ifr;
798         int error = netdev_linux_do_ioctl(netdev_get_name(netdev_), &ifr,
799                                           SIOCGIFTXQLEN, "SIOCGIFTXQLEN");
800         if (error) {
801             return error;
802         }
803         drain_fd(netdev->fd, ifr.ifr_qlen);
804         return 0;
805     } else {
806         return drain_rcvbuf(netdev->fd);
807     }
808 }
809
810 /* Sends 'buffer' on 'netdev'.  Returns 0 if successful, otherwise a positive
811  * errno value.  Returns EAGAIN without blocking if the packet cannot be queued
812  * immediately.  Returns EMSGSIZE if a partial packet was transmitted or if
813  * the packet is too big or too small to transmit on the device.
814  *
815  * The caller retains ownership of 'buffer' in all cases.
816  *
817  * The kernel maintains a packet transmission queue, so the caller is not
818  * expected to do additional queuing of packets. */
819 static int
820 netdev_linux_send(struct netdev *netdev_, const void *data, size_t size)
821 {
822     struct netdev_linux *netdev = netdev_linux_cast(netdev_);
823
824     /* XXX should support sending even if 'ethertype' was NETDEV_ETH_TYPE_NONE.
825      */
826     if (netdev->fd < 0) {
827         return EPIPE;
828     }
829
830     for (;;) {
831         ssize_t retval = write(netdev->fd, data, size);
832         if (retval < 0) {
833             /* The Linux AF_PACKET implementation never blocks waiting for room
834              * for packets, instead returning ENOBUFS.  Translate this into
835              * EAGAIN for the caller. */
836             if (errno == ENOBUFS) {
837                 return EAGAIN;
838             } else if (errno == EINTR) {
839                 continue;
840             } else if (errno != EAGAIN) {
841                 VLOG_WARN_RL(&rl, "error sending Ethernet packet on %s: %s",
842                              netdev_get_name(netdev_), strerror(errno));
843             }
844             return errno;
845         } else if (retval != size) {
846             VLOG_WARN_RL(&rl, "sent partial Ethernet packet (%zd bytes of "
847                          "%zu) on %s", retval, size, netdev_get_name(netdev_));
848             return EMSGSIZE;
849         } else {
850             return 0;
851         }
852     }
853 }
854
855 /* Registers with the poll loop to wake up from the next call to poll_block()
856  * when the packet transmission queue has sufficient room to transmit a packet
857  * with netdev_send().
858  *
859  * The kernel maintains a packet transmission queue, so the client is not
860  * expected to do additional queuing of packets.  Thus, this function is
861  * unlikely to ever be used.  It is included for completeness. */
862 static void
863 netdev_linux_send_wait(struct netdev *netdev_)
864 {
865     struct netdev_linux *netdev = netdev_linux_cast(netdev_);
866     if (netdev->fd < 0) {
867         /* Nothing to do. */
868     } else if (strcmp(netdev_get_type(netdev_), "tap")) {
869         poll_fd_wait(netdev->fd, POLLOUT);
870     } else {
871         /* TAP device always accepts packets.*/
872         poll_immediate_wake();
873     }
874 }
875
876 /* Attempts to set 'netdev''s MAC address to 'mac'.  Returns 0 if successful,
877  * otherwise a positive errno value. */
878 static int
879 netdev_linux_set_etheraddr(struct netdev *netdev_,
880                            const uint8_t mac[ETH_ADDR_LEN])
881 {
882     struct netdev_dev_linux *netdev_dev =
883                                 netdev_dev_linux_cast(netdev_get_dev(netdev_));
884     int error;
885
886     if (!(netdev_dev->cache_valid & VALID_ETHERADDR)
887         || !eth_addr_equals(netdev_dev->etheraddr, mac)) {
888         error = set_etheraddr(netdev_get_name(netdev_), ARPHRD_ETHER, mac);
889         if (!error) {
890             netdev_dev->cache_valid |= VALID_ETHERADDR;
891             memcpy(netdev_dev->etheraddr, mac, ETH_ADDR_LEN);
892         }
893     } else {
894         error = 0;
895     }
896     return error;
897 }
898
899 /* Returns a pointer to 'netdev''s MAC address.  The caller must not modify or
900  * free the returned buffer. */
901 static int
902 netdev_linux_get_etheraddr(const struct netdev *netdev_,
903                            uint8_t mac[ETH_ADDR_LEN])
904 {
905     struct netdev_dev_linux *netdev_dev =
906                                 netdev_dev_linux_cast(netdev_get_dev(netdev_));
907     if (!(netdev_dev->cache_valid & VALID_ETHERADDR)) {
908         int error = get_etheraddr(netdev_get_name(netdev_),
909                                   netdev_dev->etheraddr);
910         if (error) {
911             return error;
912         }
913         netdev_dev->cache_valid |= VALID_ETHERADDR;
914     }
915     memcpy(mac, netdev_dev->etheraddr, ETH_ADDR_LEN);
916     return 0;
917 }
918
919 /* Returns the maximum size of transmitted (and received) packets on 'netdev',
920  * in bytes, not including the hardware header; thus, this is typically 1500
921  * bytes for Ethernet devices. */
922 static int
923 netdev_linux_get_mtu(const struct netdev *netdev_, int *mtup)
924 {
925     struct netdev_dev_linux *netdev_dev =
926                                 netdev_dev_linux_cast(netdev_get_dev(netdev_));
927     if (!(netdev_dev->cache_valid & VALID_MTU)) {
928         struct ifreq ifr;
929         int error;
930
931         error = netdev_linux_do_ioctl(netdev_get_name(netdev_), &ifr,
932                                       SIOCGIFMTU, "SIOCGIFMTU");
933         if (error) {
934             return error;
935         }
936         netdev_dev->mtu = ifr.ifr_mtu;
937         netdev_dev->cache_valid |= VALID_MTU;
938     }
939     *mtup = netdev_dev->mtu;
940     return 0;
941 }
942
943 /* Returns the ifindex of 'netdev', if successful, as a positive number.
944  * On failure, returns a negative errno value. */
945 static int
946 netdev_linux_get_ifindex(const struct netdev *netdev)
947 {
948     int ifindex, error;
949
950     error = get_ifindex(netdev, &ifindex);
951     return error ? -error : ifindex;
952 }
953
954 static int
955 netdev_linux_get_carrier(const struct netdev *netdev_, bool *carrier)
956 {
957     struct netdev_dev_linux *netdev_dev =
958                                 netdev_dev_linux_cast(netdev_get_dev(netdev_));
959     int error = 0;
960     char *fn = NULL;
961     int fd = -1;
962
963     if (!(netdev_dev->cache_valid & VALID_CARRIER)) {
964         char line[8];
965         int retval;
966
967         fn = xasprintf("/sys/class/net/%s/carrier",
968                        netdev_get_name(netdev_));
969         fd = open(fn, O_RDONLY);
970         if (fd < 0) {
971             error = errno;
972             VLOG_WARN_RL(&rl, "%s: open failed: %s", fn, strerror(error));
973             goto exit;
974         }
975
976         retval = read(fd, line, sizeof line);
977         if (retval < 0) {
978             error = errno;
979             if (error == EINVAL) {
980                 /* This is the normal return value when we try to check carrier
981                  * if the network device is not up. */
982             } else {
983                 VLOG_WARN_RL(&rl, "%s: read failed: %s", fn, strerror(error));
984             }
985             goto exit;
986         } else if (retval == 0) {
987             error = EPROTO;
988             VLOG_WARN_RL(&rl, "%s: unexpected end of file", fn);
989             goto exit;
990         }
991
992         if (line[0] != '0' && line[0] != '1') {
993             error = EPROTO;
994             VLOG_WARN_RL(&rl, "%s: value is %c (expected 0 or 1)",
995                          fn, line[0]);
996             goto exit;
997         }
998         netdev_dev->carrier = line[0] != '0';
999         netdev_dev->cache_valid |= VALID_CARRIER;
1000     }
1001     *carrier = netdev_dev->carrier;
1002     error = 0;
1003
1004 exit:
1005     if (fd >= 0) {
1006         close(fd);
1007     }
1008     free(fn);
1009     return error;
1010 }
1011
1012 static int
1013 netdev_linux_do_miimon(const struct netdev *netdev, int cmd,
1014                        const char *cmd_name, struct mii_ioctl_data *data)
1015 {
1016     struct ifreq ifr;
1017     int error;
1018
1019     memset(&ifr, 0, sizeof ifr);
1020     memcpy(&ifr.ifr_data, data, sizeof *data);
1021     error = netdev_linux_do_ioctl(netdev_get_name(netdev),
1022                                   &ifr, cmd, cmd_name);
1023     memcpy(data, &ifr.ifr_data, sizeof *data);
1024
1025     return error;
1026 }
1027
1028 static int
1029 netdev_linux_get_miimon(const struct netdev *netdev, bool *miimon)
1030 {
1031     const char *name = netdev_get_name(netdev);
1032     struct mii_ioctl_data data;
1033     int error;
1034
1035     *miimon = false;
1036
1037     memset(&data, 0, sizeof data);
1038     error = netdev_linux_do_miimon(netdev, SIOCGMIIPHY, "SIOCGMIIPHY", &data);
1039     if (!error) {
1040         /* data.phy_id is filled out by previous SIOCGMIIPHY miimon call. */
1041         data.reg_num = MII_BMSR;
1042         error = netdev_linux_do_miimon(netdev, SIOCGMIIREG, "SIOCGMIIREG",
1043                                        &data);
1044
1045         if (!error) {
1046             *miimon = !!(data.val_out & BMSR_LSTATUS);
1047         } else {
1048             VLOG_WARN_RL(&rl, "%s: failed to query MII", name);
1049         }
1050     } else {
1051         struct ethtool_cmd ecmd;
1052
1053         VLOG_DBG_RL(&rl, "%s: failed to query MII, falling back to ethtool",
1054                     name);
1055
1056         memset(&ecmd, 0, sizeof ecmd);
1057         error = netdev_linux_do_ethtool(name, &ecmd, ETHTOOL_GLINK,
1058                                         "ETHTOOL_GLINK");
1059         if (!error) {
1060             struct ethtool_value eval;
1061
1062             memcpy(&eval, &ecmd, sizeof eval);
1063             *miimon = !!eval.data;
1064         } else {
1065             VLOG_WARN_RL(&rl, "%s: ethtool link status failed", name);
1066         }
1067     }
1068
1069     return error;
1070 }
1071
1072 /* Check whether we can we use RTM_GETLINK to get network device statistics.
1073  * In pre-2.6.19 kernels, this was only available if wireless extensions were
1074  * enabled. */
1075 static bool
1076 check_for_working_netlink_stats(void)
1077 {
1078     /* Decide on the netdev_get_stats() implementation to use.  Netlink is
1079      * preferable, so if that works, we'll use it. */
1080     int ifindex = do_get_ifindex("lo");
1081     if (ifindex < 0) {
1082         VLOG_WARN("failed to get ifindex for lo, "
1083                   "obtaining netdev stats from proc");
1084         return false;
1085     } else {
1086         struct netdev_stats stats;
1087         int error = get_stats_via_netlink(ifindex, &stats);
1088         if (!error) {
1089             VLOG_DBG("obtaining netdev stats via rtnetlink");
1090             return true;
1091         } else {
1092             VLOG_INFO("RTM_GETLINK failed (%s), obtaining netdev stats "
1093                       "via proc (you are probably running a pre-2.6.19 "
1094                       "kernel)", strerror(error));
1095             return false;
1096         }
1097     }
1098 }
1099
1100 /* Brings the 'is_internal' and 'is_tap' members of 'netdev_dev' up-to-date. */
1101 static void
1102 netdev_linux_update_is_pseudo(struct netdev_dev_linux *netdev_dev)
1103 {
1104     if (!(netdev_dev->cache_valid & VALID_IS_PSEUDO)) {
1105         const char *name = netdev_dev_get_name(&netdev_dev->netdev_dev);
1106         const char *type = netdev_dev_get_type(&netdev_dev->netdev_dev);
1107
1108         netdev_dev->is_tap = !strcmp(type, "tap");
1109         netdev_dev->is_internal = (!netdev_dev->is_tap
1110                                    && dpif_linux_is_internal_device(name));
1111         netdev_dev->cache_valid |= VALID_IS_PSEUDO;
1112     }
1113 }
1114
1115 static void
1116 swap_uint64(uint64_t *a, uint64_t *b)
1117 {
1118     *a ^= *b;
1119     *b ^= *a;
1120     *a ^= *b;
1121 }
1122
1123 /* Retrieves current device stats for 'netdev'. */
1124 static int
1125 netdev_linux_get_stats(const struct netdev *netdev_,
1126                        struct netdev_stats *stats)
1127 {
1128     struct netdev_dev_linux *netdev_dev =
1129                                 netdev_dev_linux_cast(netdev_get_dev(netdev_));
1130     static int use_netlink_stats = -1;
1131     int error;
1132
1133     if (netdev_dev->have_vport_stats ||
1134         !(netdev_dev->cache_valid & VALID_HAVE_VPORT_STATS)) {
1135
1136         error = netdev_vport_get_stats(netdev_, stats);
1137         netdev_dev->have_vport_stats = !error;
1138         netdev_dev->cache_valid |= VALID_HAVE_VPORT_STATS;
1139     }
1140
1141     if (!netdev_dev->have_vport_stats) {
1142         if (use_netlink_stats < 0) {
1143             use_netlink_stats = check_for_working_netlink_stats();
1144         }
1145         if (use_netlink_stats) {
1146             int ifindex;
1147
1148             error = get_ifindex(netdev_, &ifindex);
1149             if (!error) {
1150                 error = get_stats_via_netlink(ifindex, stats);
1151             }
1152         } else {
1153             error = get_stats_via_proc(netdev_get_name(netdev_), stats);
1154         }
1155     }
1156
1157     /* If this port is an internal port then the transmit and receive stats
1158      * will appear to be swapped relative to the other ports since we are the
1159      * one sending the data, not a remote computer.  For consistency, we swap
1160      * them back here. This does not apply if we are getting stats from the
1161      * vport layer because it always tracks stats from the perspective of the
1162      * switch. */
1163     netdev_linux_update_is_pseudo(netdev_dev);
1164     if (!error && !netdev_dev->have_vport_stats &&
1165         (netdev_dev->is_internal || netdev_dev->is_tap)) {
1166         swap_uint64(&stats->rx_packets, &stats->tx_packets);
1167         swap_uint64(&stats->rx_bytes, &stats->tx_bytes);
1168         swap_uint64(&stats->rx_errors, &stats->tx_errors);
1169         swap_uint64(&stats->rx_dropped, &stats->tx_dropped);
1170         stats->rx_length_errors = 0;
1171         stats->rx_over_errors = 0;
1172         stats->rx_crc_errors = 0;
1173         stats->rx_frame_errors = 0;
1174         stats->rx_fifo_errors = 0;
1175         stats->rx_missed_errors = 0;
1176         stats->tx_aborted_errors = 0;
1177         stats->tx_carrier_errors = 0;
1178         stats->tx_fifo_errors = 0;
1179         stats->tx_heartbeat_errors = 0;
1180         stats->tx_window_errors = 0;
1181     }
1182
1183     return error;
1184 }
1185
1186 /* Stores the features supported by 'netdev' into each of '*current',
1187  * '*advertised', '*supported', and '*peer' that are non-null.  Each value is a
1188  * bitmap of "enum ofp_port_features" bits, in host byte order.  Returns 0 if
1189  * successful, otherwise a positive errno value. */
1190 static int
1191 netdev_linux_get_features(const struct netdev *netdev,
1192                           uint32_t *current, uint32_t *advertised,
1193                           uint32_t *supported, uint32_t *peer)
1194 {
1195     struct ethtool_cmd ecmd;
1196     int error;
1197
1198     memset(&ecmd, 0, sizeof ecmd);
1199     error = netdev_linux_do_ethtool(netdev_get_name(netdev), &ecmd,
1200                                     ETHTOOL_GSET, "ETHTOOL_GSET");
1201     if (error) {
1202         return error;
1203     }
1204
1205     /* Supported features. */
1206     *supported = 0;
1207     if (ecmd.supported & SUPPORTED_10baseT_Half) {
1208         *supported |= OFPPF_10MB_HD;
1209     }
1210     if (ecmd.supported & SUPPORTED_10baseT_Full) {
1211         *supported |= OFPPF_10MB_FD;
1212     }
1213     if (ecmd.supported & SUPPORTED_100baseT_Half)  {
1214         *supported |= OFPPF_100MB_HD;
1215     }
1216     if (ecmd.supported & SUPPORTED_100baseT_Full) {
1217         *supported |= OFPPF_100MB_FD;
1218     }
1219     if (ecmd.supported & SUPPORTED_1000baseT_Half) {
1220         *supported |= OFPPF_1GB_HD;
1221     }
1222     if (ecmd.supported & SUPPORTED_1000baseT_Full) {
1223         *supported |= OFPPF_1GB_FD;
1224     }
1225     if (ecmd.supported & SUPPORTED_10000baseT_Full) {
1226         *supported |= OFPPF_10GB_FD;
1227     }
1228     if (ecmd.supported & SUPPORTED_TP) {
1229         *supported |= OFPPF_COPPER;
1230     }
1231     if (ecmd.supported & SUPPORTED_FIBRE) {
1232         *supported |= OFPPF_FIBER;
1233     }
1234     if (ecmd.supported & SUPPORTED_Autoneg) {
1235         *supported |= OFPPF_AUTONEG;
1236     }
1237     if (ecmd.supported & SUPPORTED_Pause) {
1238         *supported |= OFPPF_PAUSE;
1239     }
1240     if (ecmd.supported & SUPPORTED_Asym_Pause) {
1241         *supported |= OFPPF_PAUSE_ASYM;
1242     }
1243
1244     /* Advertised features. */
1245     *advertised = 0;
1246     if (ecmd.advertising & ADVERTISED_10baseT_Half) {
1247         *advertised |= OFPPF_10MB_HD;
1248     }
1249     if (ecmd.advertising & ADVERTISED_10baseT_Full) {
1250         *advertised |= OFPPF_10MB_FD;
1251     }
1252     if (ecmd.advertising & ADVERTISED_100baseT_Half) {
1253         *advertised |= OFPPF_100MB_HD;
1254     }
1255     if (ecmd.advertising & ADVERTISED_100baseT_Full) {
1256         *advertised |= OFPPF_100MB_FD;
1257     }
1258     if (ecmd.advertising & ADVERTISED_1000baseT_Half) {
1259         *advertised |= OFPPF_1GB_HD;
1260     }
1261     if (ecmd.advertising & ADVERTISED_1000baseT_Full) {
1262         *advertised |= OFPPF_1GB_FD;
1263     }
1264     if (ecmd.advertising & ADVERTISED_10000baseT_Full) {
1265         *advertised |= OFPPF_10GB_FD;
1266     }
1267     if (ecmd.advertising & ADVERTISED_TP) {
1268         *advertised |= OFPPF_COPPER;
1269     }
1270     if (ecmd.advertising & ADVERTISED_FIBRE) {
1271         *advertised |= OFPPF_FIBER;
1272     }
1273     if (ecmd.advertising & ADVERTISED_Autoneg) {
1274         *advertised |= OFPPF_AUTONEG;
1275     }
1276     if (ecmd.advertising & ADVERTISED_Pause) {
1277         *advertised |= OFPPF_PAUSE;
1278     }
1279     if (ecmd.advertising & ADVERTISED_Asym_Pause) {
1280         *advertised |= OFPPF_PAUSE_ASYM;
1281     }
1282
1283     /* Current settings. */
1284     if (ecmd.speed == SPEED_10) {
1285         *current = ecmd.duplex ? OFPPF_10MB_FD : OFPPF_10MB_HD;
1286     } else if (ecmd.speed == SPEED_100) {
1287         *current = ecmd.duplex ? OFPPF_100MB_FD : OFPPF_100MB_HD;
1288     } else if (ecmd.speed == SPEED_1000) {
1289         *current = ecmd.duplex ? OFPPF_1GB_FD : OFPPF_1GB_HD;
1290     } else if (ecmd.speed == SPEED_10000) {
1291         *current = OFPPF_10GB_FD;
1292     } else {
1293         *current = 0;
1294     }
1295
1296     if (ecmd.port == PORT_TP) {
1297         *current |= OFPPF_COPPER;
1298     } else if (ecmd.port == PORT_FIBRE) {
1299         *current |= OFPPF_FIBER;
1300     }
1301
1302     if (ecmd.autoneg) {
1303         *current |= OFPPF_AUTONEG;
1304     }
1305
1306     /* Peer advertisements. */
1307     *peer = 0;                  /* XXX */
1308
1309     return 0;
1310 }
1311
1312 /* Set the features advertised by 'netdev' to 'advertise'. */
1313 static int
1314 netdev_linux_set_advertisements(struct netdev *netdev, uint32_t advertise)
1315 {
1316     struct ethtool_cmd ecmd;
1317     int error;
1318
1319     memset(&ecmd, 0, sizeof ecmd);
1320     error = netdev_linux_do_ethtool(netdev_get_name(netdev), &ecmd,
1321                                     ETHTOOL_GSET, "ETHTOOL_GSET");
1322     if (error) {
1323         return error;
1324     }
1325
1326     ecmd.advertising = 0;
1327     if (advertise & OFPPF_10MB_HD) {
1328         ecmd.advertising |= ADVERTISED_10baseT_Half;
1329     }
1330     if (advertise & OFPPF_10MB_FD) {
1331         ecmd.advertising |= ADVERTISED_10baseT_Full;
1332     }
1333     if (advertise & OFPPF_100MB_HD) {
1334         ecmd.advertising |= ADVERTISED_100baseT_Half;
1335     }
1336     if (advertise & OFPPF_100MB_FD) {
1337         ecmd.advertising |= ADVERTISED_100baseT_Full;
1338     }
1339     if (advertise & OFPPF_1GB_HD) {
1340         ecmd.advertising |= ADVERTISED_1000baseT_Half;
1341     }
1342     if (advertise & OFPPF_1GB_FD) {
1343         ecmd.advertising |= ADVERTISED_1000baseT_Full;
1344     }
1345     if (advertise & OFPPF_10GB_FD) {
1346         ecmd.advertising |= ADVERTISED_10000baseT_Full;
1347     }
1348     if (advertise & OFPPF_COPPER) {
1349         ecmd.advertising |= ADVERTISED_TP;
1350     }
1351     if (advertise & OFPPF_FIBER) {
1352         ecmd.advertising |= ADVERTISED_FIBRE;
1353     }
1354     if (advertise & OFPPF_AUTONEG) {
1355         ecmd.advertising |= ADVERTISED_Autoneg;
1356     }
1357     if (advertise & OFPPF_PAUSE) {
1358         ecmd.advertising |= ADVERTISED_Pause;
1359     }
1360     if (advertise & OFPPF_PAUSE_ASYM) {
1361         ecmd.advertising |= ADVERTISED_Asym_Pause;
1362     }
1363     return netdev_linux_do_ethtool(netdev_get_name(netdev), &ecmd,
1364                                    ETHTOOL_SSET, "ETHTOOL_SSET");
1365 }
1366
1367 /* If 'netdev_name' is the name of a VLAN network device (e.g. one created with
1368  * vconfig(8)), sets '*vlan_vid' to the VLAN VID associated with that device
1369  * and returns 0.  Otherwise returns a errno value (specifically ENOENT if
1370  * 'netdev_name' is the name of a network device that is not a VLAN device) and
1371  * sets '*vlan_vid' to -1. */
1372 static int
1373 netdev_linux_get_vlan_vid(const struct netdev *netdev, int *vlan_vid)
1374 {
1375     const char *netdev_name = netdev_get_name(netdev);
1376     struct ds line = DS_EMPTY_INITIALIZER;
1377     FILE *stream = NULL;
1378     int error;
1379     char *fn;
1380
1381     COVERAGE_INC(netdev_get_vlan_vid);
1382     fn = xasprintf("/proc/net/vlan/%s", netdev_name);
1383     stream = fopen(fn, "r");
1384     if (!stream) {
1385         error = errno;
1386         goto done;
1387     }
1388
1389     if (ds_get_line(&line, stream)) {
1390         if (ferror(stream)) {
1391             error = errno;
1392             VLOG_ERR_RL(&rl, "error reading \"%s\": %s", fn, strerror(errno));
1393         } else {
1394             error = EPROTO;
1395             VLOG_ERR_RL(&rl, "unexpected end of file reading \"%s\"", fn);
1396         }
1397         goto done;
1398     }
1399
1400     if (!sscanf(ds_cstr(&line), "%*s VID: %d", vlan_vid)) {
1401         error = EPROTO;
1402         VLOG_ERR_RL(&rl, "parse error reading \"%s\" line 1: \"%s\"",
1403                     fn, ds_cstr(&line));
1404         goto done;
1405     }
1406
1407     error = 0;
1408
1409 done:
1410     free(fn);
1411     if (stream) {
1412         fclose(stream);
1413     }
1414     ds_destroy(&line);
1415     if (error) {
1416         *vlan_vid = -1;
1417     }
1418     return error;
1419 }
1420
1421 #define POLICE_ADD_CMD "/sbin/tc qdisc add dev %s handle ffff: ingress"
1422 #define POLICE_CONFIG_CMD "/sbin/tc filter add dev %s parent ffff: protocol ip prio 50 u32 match ip src 0.0.0.0/0 police rate %dkbit burst %dk mtu 65535 drop flowid :1"
1423
1424 /* Remove ingress policing from 'netdev'.  Returns 0 if successful, otherwise a
1425  * positive errno value.
1426  *
1427  * This function is equivalent to running
1428  *     /sbin/tc qdisc del dev %s handle ffff: ingress
1429  * but it is much, much faster.
1430  */
1431 static int
1432 netdev_linux_remove_policing(struct netdev *netdev)
1433 {
1434     struct netdev_dev_linux *netdev_dev =
1435         netdev_dev_linux_cast(netdev_get_dev(netdev));
1436     const char *netdev_name = netdev_get_name(netdev);
1437
1438     struct ofpbuf request;
1439     struct tcmsg *tcmsg;
1440     int error;
1441
1442     tcmsg = tc_make_request(netdev, RTM_DELQDISC, 0, &request);
1443     if (!tcmsg) {
1444         return ENODEV;
1445     }
1446     tcmsg->tcm_handle = tc_make_handle(0xffff, 0);
1447     tcmsg->tcm_parent = TC_H_INGRESS;
1448     nl_msg_put_string(&request, TCA_KIND, "ingress");
1449     nl_msg_put_unspec(&request, TCA_OPTIONS, NULL, 0);
1450
1451     error = tc_transact(&request, NULL);
1452     if (error && error != ENOENT && error != EINVAL) {
1453         VLOG_WARN_RL(&rl, "%s: removing policing failed: %s",
1454                      netdev_name, strerror(error));
1455         return error;
1456     }
1457
1458     netdev_dev->kbits_rate = 0;
1459     netdev_dev->kbits_burst = 0;
1460     netdev_dev->cache_valid |= VALID_POLICING;
1461     return 0;
1462 }
1463
1464 /* Attempts to set input rate limiting (policing) policy. */
1465 static int
1466 netdev_linux_set_policing(struct netdev *netdev,
1467                           uint32_t kbits_rate, uint32_t kbits_burst)
1468 {
1469     struct netdev_dev_linux *netdev_dev =
1470         netdev_dev_linux_cast(netdev_get_dev(netdev));
1471     const char *netdev_name = netdev_get_name(netdev);
1472     char command[1024];
1473
1474     COVERAGE_INC(netdev_set_policing);
1475
1476     kbits_burst = (!kbits_rate ? 0       /* Force to 0 if no rate specified. */
1477                    : !kbits_burst ? 1000 /* Default to 1000 kbits if 0. */
1478                    : kbits_burst);       /* Stick with user-specified value. */
1479
1480     if (netdev_dev->cache_valid & VALID_POLICING
1481         && netdev_dev->kbits_rate == kbits_rate
1482         && netdev_dev->kbits_burst == kbits_burst) {
1483         /* Assume that settings haven't changed since we last set them. */
1484         return 0;
1485     }
1486
1487     netdev_linux_remove_policing(netdev);
1488     if (kbits_rate) {
1489         snprintf(command, sizeof(command), POLICE_ADD_CMD, netdev_name);
1490         if (system(command) != 0) {
1491             VLOG_WARN_RL(&rl, "%s: problem adding policing", netdev_name);
1492             return -1;
1493         }
1494
1495         snprintf(command, sizeof(command), POLICE_CONFIG_CMD, netdev_name,
1496                 kbits_rate, kbits_burst);
1497         if (system(command) != 0) {
1498             VLOG_WARN_RL(&rl, "%s: problem configuring policing",
1499                     netdev_name);
1500             return -1;
1501         }
1502
1503         netdev_dev->kbits_rate = kbits_rate;
1504         netdev_dev->kbits_burst = kbits_burst;
1505         netdev_dev->cache_valid |= VALID_POLICING;
1506     }
1507
1508     return 0;
1509 }
1510
1511 static int
1512 netdev_linux_get_qos_types(const struct netdev *netdev OVS_UNUSED,
1513                            struct sset *types)
1514 {
1515     const struct tc_ops **opsp;
1516
1517     for (opsp = tcs; *opsp != NULL; opsp++) {
1518         const struct tc_ops *ops = *opsp;
1519         if (ops->tc_install && ops->ovs_name[0] != '\0') {
1520             sset_add(types, ops->ovs_name);
1521         }
1522     }
1523     return 0;
1524 }
1525
1526 static const struct tc_ops *
1527 tc_lookup_ovs_name(const char *name)
1528 {
1529     const struct tc_ops **opsp;
1530
1531     for (opsp = tcs; *opsp != NULL; opsp++) {
1532         const struct tc_ops *ops = *opsp;
1533         if (!strcmp(name, ops->ovs_name)) {
1534             return ops;
1535         }
1536     }
1537     return NULL;
1538 }
1539
1540 static const struct tc_ops *
1541 tc_lookup_linux_name(const char *name)
1542 {
1543     const struct tc_ops **opsp;
1544
1545     for (opsp = tcs; *opsp != NULL; opsp++) {
1546         const struct tc_ops *ops = *opsp;
1547         if (ops->linux_name && !strcmp(name, ops->linux_name)) {
1548             return ops;
1549         }
1550     }
1551     return NULL;
1552 }
1553
1554 static struct tc_queue *
1555 tc_find_queue__(const struct netdev *netdev, unsigned int queue_id,
1556                 size_t hash)
1557 {
1558     struct netdev_dev_linux *netdev_dev =
1559                                 netdev_dev_linux_cast(netdev_get_dev(netdev));
1560     struct tc_queue *queue;
1561
1562     HMAP_FOR_EACH_IN_BUCKET (queue, hmap_node, hash, &netdev_dev->tc->queues) {
1563         if (queue->queue_id == queue_id) {
1564             return queue;
1565         }
1566     }
1567     return NULL;
1568 }
1569
1570 static struct tc_queue *
1571 tc_find_queue(const struct netdev *netdev, unsigned int queue_id)
1572 {
1573     return tc_find_queue__(netdev, queue_id, hash_int(queue_id, 0));
1574 }
1575
1576 static int
1577 netdev_linux_get_qos_capabilities(const struct netdev *netdev OVS_UNUSED,
1578                                   const char *type,
1579                                   struct netdev_qos_capabilities *caps)
1580 {
1581     const struct tc_ops *ops = tc_lookup_ovs_name(type);
1582     if (!ops) {
1583         return EOPNOTSUPP;
1584     }
1585     caps->n_queues = ops->n_queues;
1586     return 0;
1587 }
1588
1589 static int
1590 netdev_linux_get_qos(const struct netdev *netdev,
1591                      const char **typep, struct shash *details)
1592 {
1593     struct netdev_dev_linux *netdev_dev =
1594                                 netdev_dev_linux_cast(netdev_get_dev(netdev));
1595     int error;
1596
1597     error = tc_query_qdisc(netdev);
1598     if (error) {
1599         return error;
1600     }
1601
1602     *typep = netdev_dev->tc->ops->ovs_name;
1603     return (netdev_dev->tc->ops->qdisc_get
1604             ? netdev_dev->tc->ops->qdisc_get(netdev, details)
1605             : 0);
1606 }
1607
1608 static int
1609 netdev_linux_set_qos(struct netdev *netdev,
1610                      const char *type, const struct shash *details)
1611 {
1612     struct netdev_dev_linux *netdev_dev =
1613                                 netdev_dev_linux_cast(netdev_get_dev(netdev));
1614     const struct tc_ops *new_ops;
1615     int error;
1616
1617     new_ops = tc_lookup_ovs_name(type);
1618     if (!new_ops || !new_ops->tc_install) {
1619         return EOPNOTSUPP;
1620     }
1621
1622     error = tc_query_qdisc(netdev);
1623     if (error) {
1624         return error;
1625     }
1626
1627     if (new_ops == netdev_dev->tc->ops) {
1628         return new_ops->qdisc_set ? new_ops->qdisc_set(netdev, details) : 0;
1629     } else {
1630         /* Delete existing qdisc. */
1631         error = tc_del_qdisc(netdev);
1632         if (error) {
1633             return error;
1634         }
1635         assert(netdev_dev->tc == NULL);
1636
1637         /* Install new qdisc. */
1638         error = new_ops->tc_install(netdev, details);
1639         assert((error == 0) == (netdev_dev->tc != NULL));
1640
1641         return error;
1642     }
1643 }
1644
1645 static int
1646 netdev_linux_get_queue(const struct netdev *netdev,
1647                        unsigned int queue_id, struct shash *details)
1648 {
1649     struct netdev_dev_linux *netdev_dev =
1650                                 netdev_dev_linux_cast(netdev_get_dev(netdev));
1651     int error;
1652
1653     error = tc_query_qdisc(netdev);
1654     if (error) {
1655         return error;
1656     } else {
1657         struct tc_queue *queue = tc_find_queue(netdev, queue_id);
1658         return (queue
1659                 ? netdev_dev->tc->ops->class_get(netdev, queue, details)
1660                 : ENOENT);
1661     }
1662 }
1663
1664 static int
1665 netdev_linux_set_queue(struct netdev *netdev,
1666                        unsigned int queue_id, const struct shash *details)
1667 {
1668     struct netdev_dev_linux *netdev_dev =
1669                                 netdev_dev_linux_cast(netdev_get_dev(netdev));
1670     int error;
1671
1672     error = tc_query_qdisc(netdev);
1673     if (error) {
1674         return error;
1675     } else if (queue_id >= netdev_dev->tc->ops->n_queues
1676                || !netdev_dev->tc->ops->class_set) {
1677         return EINVAL;
1678     }
1679
1680     return netdev_dev->tc->ops->class_set(netdev, queue_id, details);
1681 }
1682
1683 static int
1684 netdev_linux_delete_queue(struct netdev *netdev, unsigned int queue_id)
1685 {
1686     struct netdev_dev_linux *netdev_dev =
1687                                 netdev_dev_linux_cast(netdev_get_dev(netdev));
1688     int error;
1689
1690     error = tc_query_qdisc(netdev);
1691     if (error) {
1692         return error;
1693     } else if (!netdev_dev->tc->ops->class_delete) {
1694         return EINVAL;
1695     } else {
1696         struct tc_queue *queue = tc_find_queue(netdev, queue_id);
1697         return (queue
1698                 ? netdev_dev->tc->ops->class_delete(netdev, queue)
1699                 : ENOENT);
1700     }
1701 }
1702
1703 static int
1704 netdev_linux_get_queue_stats(const struct netdev *netdev,
1705                              unsigned int queue_id,
1706                              struct netdev_queue_stats *stats)
1707 {
1708     struct netdev_dev_linux *netdev_dev =
1709                                 netdev_dev_linux_cast(netdev_get_dev(netdev));
1710     int error;
1711
1712     error = tc_query_qdisc(netdev);
1713     if (error) {
1714         return error;
1715     } else if (!netdev_dev->tc->ops->class_get_stats) {
1716         return EOPNOTSUPP;
1717     } else {
1718         const struct tc_queue *queue = tc_find_queue(netdev, queue_id);
1719         return (queue
1720                 ? netdev_dev->tc->ops->class_get_stats(netdev, queue, stats)
1721                 : ENOENT);
1722     }
1723 }
1724
1725 static bool
1726 start_queue_dump(const struct netdev *netdev, struct nl_dump *dump)
1727 {
1728     struct ofpbuf request;
1729     struct tcmsg *tcmsg;
1730
1731     tcmsg = tc_make_request(netdev, RTM_GETTCLASS, 0, &request);
1732     if (!tcmsg) {
1733         return false;
1734     }
1735     tcmsg->tcm_parent = 0;
1736     nl_dump_start(dump, rtnl_sock, &request);
1737     ofpbuf_uninit(&request);
1738     return true;
1739 }
1740
1741 static int
1742 netdev_linux_dump_queues(const struct netdev *netdev,
1743                          netdev_dump_queues_cb *cb, void *aux)
1744 {
1745     struct netdev_dev_linux *netdev_dev =
1746                                 netdev_dev_linux_cast(netdev_get_dev(netdev));
1747     struct tc_queue *queue;
1748     struct shash details;
1749     int last_error;
1750     int error;
1751
1752     error = tc_query_qdisc(netdev);
1753     if (error) {
1754         return error;
1755     } else if (!netdev_dev->tc->ops->class_get) {
1756         return EOPNOTSUPP;
1757     }
1758
1759     last_error = 0;
1760     shash_init(&details);
1761     HMAP_FOR_EACH (queue, hmap_node, &netdev_dev->tc->queues) {
1762         shash_clear(&details);
1763
1764         error = netdev_dev->tc->ops->class_get(netdev, queue, &details);
1765         if (!error) {
1766             (*cb)(queue->queue_id, &details, aux);
1767         } else {
1768             last_error = error;
1769         }
1770     }
1771     shash_destroy(&details);
1772
1773     return last_error;
1774 }
1775
1776 static int
1777 netdev_linux_dump_queue_stats(const struct netdev *netdev,
1778                               netdev_dump_queue_stats_cb *cb, void *aux)
1779 {
1780     struct netdev_dev_linux *netdev_dev =
1781                                 netdev_dev_linux_cast(netdev_get_dev(netdev));
1782     struct nl_dump dump;
1783     struct ofpbuf msg;
1784     int last_error;
1785     int error;
1786
1787     error = tc_query_qdisc(netdev);
1788     if (error) {
1789         return error;
1790     } else if (!netdev_dev->tc->ops->class_dump_stats) {
1791         return EOPNOTSUPP;
1792     }
1793
1794     last_error = 0;
1795     if (!start_queue_dump(netdev, &dump)) {
1796         return ENODEV;
1797     }
1798     while (nl_dump_next(&dump, &msg)) {
1799         error = netdev_dev->tc->ops->class_dump_stats(netdev, &msg, cb, aux);
1800         if (error) {
1801             last_error = error;
1802         }
1803     }
1804
1805     error = nl_dump_done(&dump);
1806     return error ? error : last_error;
1807 }
1808
1809 static int
1810 netdev_linux_get_in4(const struct netdev *netdev_,
1811                      struct in_addr *address, struct in_addr *netmask)
1812 {
1813     struct netdev_dev_linux *netdev_dev =
1814                                 netdev_dev_linux_cast(netdev_get_dev(netdev_));
1815
1816     if (!(netdev_dev->cache_valid & VALID_IN4)) {
1817         int error;
1818
1819         error = netdev_linux_get_ipv4(netdev_, &netdev_dev->address,
1820                                       SIOCGIFADDR, "SIOCGIFADDR");
1821         if (error) {
1822             return error;
1823         }
1824
1825         error = netdev_linux_get_ipv4(netdev_, &netdev_dev->netmask,
1826                                       SIOCGIFNETMASK, "SIOCGIFNETMASK");
1827         if (error) {
1828             return error;
1829         }
1830
1831         netdev_dev->cache_valid |= VALID_IN4;
1832     }
1833     *address = netdev_dev->address;
1834     *netmask = netdev_dev->netmask;
1835     return address->s_addr == INADDR_ANY ? EADDRNOTAVAIL : 0;
1836 }
1837
1838 static int
1839 netdev_linux_set_in4(struct netdev *netdev_, struct in_addr address,
1840                      struct in_addr netmask)
1841 {
1842     struct netdev_dev_linux *netdev_dev =
1843                                 netdev_dev_linux_cast(netdev_get_dev(netdev_));
1844     int error;
1845
1846     error = do_set_addr(netdev_, SIOCSIFADDR, "SIOCSIFADDR", address);
1847     if (!error) {
1848         netdev_dev->cache_valid |= VALID_IN4;
1849         netdev_dev->address = address;
1850         netdev_dev->netmask = netmask;
1851         if (address.s_addr != INADDR_ANY) {
1852             error = do_set_addr(netdev_, SIOCSIFNETMASK,
1853                                 "SIOCSIFNETMASK", netmask);
1854         }
1855     }
1856     return error;
1857 }
1858
1859 static bool
1860 parse_if_inet6_line(const char *line,
1861                     struct in6_addr *in6, char ifname[16 + 1])
1862 {
1863     uint8_t *s6 = in6->s6_addr;
1864 #define X8 "%2"SCNx8
1865     return sscanf(line,
1866                   " "X8 X8 X8 X8 X8 X8 X8 X8 X8 X8 X8 X8 X8 X8 X8 X8
1867                   "%*x %*x %*x %*x %16s\n",
1868                   &s6[0], &s6[1], &s6[2], &s6[3],
1869                   &s6[4], &s6[5], &s6[6], &s6[7],
1870                   &s6[8], &s6[9], &s6[10], &s6[11],
1871                   &s6[12], &s6[13], &s6[14], &s6[15],
1872                   ifname) == 17;
1873 }
1874
1875 /* If 'netdev' has an assigned IPv6 address, sets '*in6' to that address (if
1876  * 'in6' is non-null) and returns true.  Otherwise, returns false. */
1877 static int
1878 netdev_linux_get_in6(const struct netdev *netdev_, struct in6_addr *in6)
1879 {
1880     struct netdev_dev_linux *netdev_dev =
1881                                 netdev_dev_linux_cast(netdev_get_dev(netdev_));
1882     if (!(netdev_dev->cache_valid & VALID_IN6)) {
1883         FILE *file;
1884         char line[128];
1885
1886         netdev_dev->in6 = in6addr_any;
1887
1888         file = fopen("/proc/net/if_inet6", "r");
1889         if (file != NULL) {
1890             const char *name = netdev_get_name(netdev_);
1891             while (fgets(line, sizeof line, file)) {
1892                 struct in6_addr in6_tmp;
1893                 char ifname[16 + 1];
1894                 if (parse_if_inet6_line(line, &in6_tmp, ifname)
1895                     && !strcmp(name, ifname))
1896                 {
1897                     netdev_dev->in6 = in6_tmp;
1898                     break;
1899                 }
1900             }
1901             fclose(file);
1902         }
1903         netdev_dev->cache_valid |= VALID_IN6;
1904     }
1905     *in6 = netdev_dev->in6;
1906     return 0;
1907 }
1908
1909 static void
1910 make_in4_sockaddr(struct sockaddr *sa, struct in_addr addr)
1911 {
1912     struct sockaddr_in sin;
1913     memset(&sin, 0, sizeof sin);
1914     sin.sin_family = AF_INET;
1915     sin.sin_addr = addr;
1916     sin.sin_port = 0;
1917
1918     memset(sa, 0, sizeof *sa);
1919     memcpy(sa, &sin, sizeof sin);
1920 }
1921
1922 static int
1923 do_set_addr(struct netdev *netdev,
1924             int ioctl_nr, const char *ioctl_name, struct in_addr addr)
1925 {
1926     struct ifreq ifr;
1927     ovs_strzcpy(ifr.ifr_name, netdev_get_name(netdev), sizeof ifr.ifr_name);
1928     make_in4_sockaddr(&ifr.ifr_addr, addr);
1929
1930     return netdev_linux_do_ioctl(netdev_get_name(netdev), &ifr, ioctl_nr,
1931                                  ioctl_name);
1932 }
1933
1934 /* Adds 'router' as a default IP gateway. */
1935 static int
1936 netdev_linux_add_router(struct netdev *netdev OVS_UNUSED, struct in_addr router)
1937 {
1938     struct in_addr any = { INADDR_ANY };
1939     struct rtentry rt;
1940     int error;
1941
1942     memset(&rt, 0, sizeof rt);
1943     make_in4_sockaddr(&rt.rt_dst, any);
1944     make_in4_sockaddr(&rt.rt_gateway, router);
1945     make_in4_sockaddr(&rt.rt_genmask, any);
1946     rt.rt_flags = RTF_UP | RTF_GATEWAY;
1947     error = ioctl(af_inet_sock, SIOCADDRT, &rt) < 0 ? errno : 0;
1948     if (error) {
1949         VLOG_WARN("ioctl(SIOCADDRT): %s", strerror(error));
1950     }
1951     return error;
1952 }
1953
1954 static int
1955 netdev_linux_get_next_hop(const struct in_addr *host, struct in_addr *next_hop,
1956                           char **netdev_name)
1957 {
1958     static const char fn[] = "/proc/net/route";
1959     FILE *stream;
1960     char line[256];
1961     int ln;
1962
1963     *netdev_name = NULL;
1964     stream = fopen(fn, "r");
1965     if (stream == NULL) {
1966         VLOG_WARN_RL(&rl, "%s: open failed: %s", fn, strerror(errno));
1967         return errno;
1968     }
1969
1970     ln = 0;
1971     while (fgets(line, sizeof line, stream)) {
1972         if (++ln >= 2) {
1973             char iface[17];
1974             uint32_t dest, gateway, mask;
1975             int refcnt, metric, mtu;
1976             unsigned int flags, use, window, irtt;
1977
1978             if (sscanf(line,
1979                        "%16s %"SCNx32" %"SCNx32" %04X %d %u %d %"SCNx32
1980                        " %d %u %u\n",
1981                        iface, &dest, &gateway, &flags, &refcnt,
1982                        &use, &metric, &mask, &mtu, &window, &irtt) != 11) {
1983
1984                 VLOG_WARN_RL(&rl, "%s: could not parse line %d: %s",
1985                         fn, ln, line);
1986                 continue;
1987             }
1988             if (!(flags & RTF_UP)) {
1989                 /* Skip routes that aren't up. */
1990                 continue;
1991             }
1992
1993             /* The output of 'dest', 'mask', and 'gateway' were given in
1994              * network byte order, so we don't need need any endian
1995              * conversions here. */
1996             if ((dest & mask) == (host->s_addr & mask)) {
1997                 if (!gateway) {
1998                     /* The host is directly reachable. */
1999                     next_hop->s_addr = 0;
2000                 } else {
2001                     /* To reach the host, we must go through a gateway. */
2002                     next_hop->s_addr = gateway;
2003                 }
2004                 *netdev_name = xstrdup(iface);
2005                 fclose(stream);
2006                 return 0;
2007             }
2008         }
2009     }
2010
2011     fclose(stream);
2012     return ENXIO;
2013 }
2014
2015 static int
2016 netdev_linux_get_status(const struct netdev *netdev, struct shash *sh)
2017 {
2018     struct ethtool_drvinfo drvinfo;
2019     int error;
2020
2021     memset(&drvinfo, 0, sizeof drvinfo);
2022     error = netdev_linux_do_ethtool(netdev_get_name(netdev),
2023                                     (struct ethtool_cmd *)&drvinfo,
2024                                     ETHTOOL_GDRVINFO,
2025                                     "ETHTOOL_GDRVINFO");
2026     if (!error) {
2027         shash_add(sh, "driver_name", xstrdup(drvinfo.driver));
2028         shash_add(sh, "driver_version", xstrdup(drvinfo.version));
2029         shash_add(sh, "firmware_version", xstrdup(drvinfo.fw_version));
2030     }
2031
2032     return error;
2033 }
2034
2035 /* Looks up the ARP table entry for 'ip' on 'netdev'.  If one exists and can be
2036  * successfully retrieved, it stores the corresponding MAC address in 'mac' and
2037  * returns 0.  Otherwise, it returns a positive errno value; in particular,
2038  * ENXIO indicates that there is not ARP table entry for 'ip' on 'netdev'. */
2039 static int
2040 netdev_linux_arp_lookup(const struct netdev *netdev,
2041                         uint32_t ip, uint8_t mac[ETH_ADDR_LEN])
2042 {
2043     struct arpreq r;
2044     struct sockaddr_in sin;
2045     int retval;
2046
2047     memset(&r, 0, sizeof r);
2048     memset(&sin, 0, sizeof sin);
2049     sin.sin_family = AF_INET;
2050     sin.sin_addr.s_addr = ip;
2051     sin.sin_port = 0;
2052     memcpy(&r.arp_pa, &sin, sizeof sin);
2053     r.arp_ha.sa_family = ARPHRD_ETHER;
2054     r.arp_flags = 0;
2055     ovs_strzcpy(r.arp_dev, netdev_get_name(netdev), sizeof r.arp_dev);
2056     COVERAGE_INC(netdev_arp_lookup);
2057     retval = ioctl(af_inet_sock, SIOCGARP, &r) < 0 ? errno : 0;
2058     if (!retval) {
2059         memcpy(mac, r.arp_ha.sa_data, ETH_ADDR_LEN);
2060     } else if (retval != ENXIO) {
2061         VLOG_WARN_RL(&rl, "%s: could not look up ARP entry for "IP_FMT": %s",
2062                      netdev_get_name(netdev), IP_ARGS(&ip), strerror(retval));
2063     }
2064     return retval;
2065 }
2066
2067 static int
2068 nd_to_iff_flags(enum netdev_flags nd)
2069 {
2070     int iff = 0;
2071     if (nd & NETDEV_UP) {
2072         iff |= IFF_UP;
2073     }
2074     if (nd & NETDEV_PROMISC) {
2075         iff |= IFF_PROMISC;
2076     }
2077     return iff;
2078 }
2079
2080 static int
2081 iff_to_nd_flags(int iff)
2082 {
2083     enum netdev_flags nd = 0;
2084     if (iff & IFF_UP) {
2085         nd |= NETDEV_UP;
2086     }
2087     if (iff & IFF_PROMISC) {
2088         nd |= NETDEV_PROMISC;
2089     }
2090     return nd;
2091 }
2092
2093 static int
2094 netdev_linux_update_flags(struct netdev *netdev, enum netdev_flags off,
2095                           enum netdev_flags on, enum netdev_flags *old_flagsp)
2096 {
2097     int old_flags, new_flags;
2098     int error;
2099
2100     error = get_flags(netdev, &old_flags);
2101     if (!error) {
2102         *old_flagsp = iff_to_nd_flags(old_flags);
2103         new_flags = (old_flags & ~nd_to_iff_flags(off)) | nd_to_iff_flags(on);
2104         if (new_flags != old_flags) {
2105             error = set_flags(netdev, new_flags);
2106         }
2107     }
2108     return error;
2109 }
2110
2111 static void
2112 poll_notify(struct list *list)
2113 {
2114     struct netdev_linux_notifier *notifier;
2115     LIST_FOR_EACH (notifier, node, list) {
2116         struct netdev_notifier *n = &notifier->notifier;
2117         n->cb(n);
2118     }
2119 }
2120
2121 static void
2122 netdev_linux_poll_cb(const struct rtnetlink_link_change *change,
2123                      void *aux OVS_UNUSED)
2124 {
2125     if (change) {
2126         struct list *list = shash_find_data(&netdev_linux_notifiers,
2127                                             change->ifname);
2128         if (list) {
2129             poll_notify(list);
2130         }
2131     } else {
2132         struct shash_node *node;
2133         SHASH_FOR_EACH (node, &netdev_linux_notifiers) {
2134             poll_notify(node->data);
2135         }
2136     }
2137 }
2138
2139 static int
2140 netdev_linux_poll_add(struct netdev *netdev,
2141                       void (*cb)(struct netdev_notifier *), void *aux,
2142                       struct netdev_notifier **notifierp)
2143 {
2144     const char *netdev_name = netdev_get_name(netdev);
2145     struct netdev_linux_notifier *notifier;
2146     struct list *list;
2147
2148     if (shash_is_empty(&netdev_linux_notifiers)) {
2149         int error;
2150         error = rtnetlink_link_notifier_register(&netdev_linux_poll_notifier,
2151                                                  netdev_linux_poll_cb, NULL);
2152         if (error) {
2153             return error;
2154         }
2155     }
2156
2157     list = shash_find_data(&netdev_linux_notifiers, netdev_name);
2158     if (!list) {
2159         list = xmalloc(sizeof *list);
2160         list_init(list);
2161         shash_add(&netdev_linux_notifiers, netdev_name, list);
2162     }
2163
2164     notifier = xmalloc(sizeof *notifier);
2165     netdev_notifier_init(&notifier->notifier, netdev, cb, aux);
2166     list_push_back(list, &notifier->node);
2167     *notifierp = &notifier->notifier;
2168     return 0;
2169 }
2170
2171 static void
2172 netdev_linux_poll_remove(struct netdev_notifier *notifier_)
2173 {
2174     struct netdev_linux_notifier *notifier =
2175         CONTAINER_OF(notifier_, struct netdev_linux_notifier, notifier);
2176     struct list *list;
2177
2178     /* Remove 'notifier' from its list. */
2179     list = list_remove(&notifier->node);
2180     if (list_is_empty(list)) {
2181         /* The list is now empty.  Remove it from the hash and free it. */
2182         const char *netdev_name = netdev_get_name(notifier->notifier.netdev);
2183         shash_delete(&netdev_linux_notifiers,
2184                      shash_find(&netdev_linux_notifiers, netdev_name));
2185         free(list);
2186     }
2187     free(notifier);
2188
2189     /* If that was the last notifier, unregister. */
2190     if (shash_is_empty(&netdev_linux_notifiers)) {
2191         rtnetlink_link_notifier_unregister(&netdev_linux_poll_notifier);
2192     }
2193 }
2194
2195 #define NETDEV_LINUX_CLASS(NAME, CREATE, ENUMERATE, SET_STATS)  \
2196 {                                                               \
2197     NAME,                                                       \
2198                                                                 \
2199     netdev_linux_init,                                          \
2200     netdev_linux_run,                                           \
2201     netdev_linux_wait,                                          \
2202                                                                 \
2203     CREATE,                                                     \
2204     netdev_linux_destroy,                                       \
2205     NULL,                       /* set_config */                \
2206                                                                 \
2207     netdev_linux_open,                                          \
2208     netdev_linux_close,                                         \
2209                                                                 \
2210     ENUMERATE,                                                  \
2211                                                                 \
2212     netdev_linux_recv,                                          \
2213     netdev_linux_recv_wait,                                     \
2214     netdev_linux_drain,                                         \
2215                                                                 \
2216     netdev_linux_send,                                          \
2217     netdev_linux_send_wait,                                     \
2218                                                                 \
2219     netdev_linux_set_etheraddr,                                 \
2220     netdev_linux_get_etheraddr,                                 \
2221     netdev_linux_get_mtu,                                       \
2222     netdev_linux_get_ifindex,                                   \
2223     netdev_linux_get_carrier,                                   \
2224     netdev_linux_get_miimon,                                    \
2225     netdev_linux_get_stats,                                     \
2226     SET_STATS,                                                  \
2227                                                                 \
2228     netdev_linux_get_features,                                  \
2229     netdev_linux_set_advertisements,                            \
2230     netdev_linux_get_vlan_vid,                                  \
2231                                                                 \
2232     netdev_linux_set_policing,                                  \
2233     netdev_linux_get_qos_types,                                 \
2234     netdev_linux_get_qos_capabilities,                          \
2235     netdev_linux_get_qos,                                       \
2236     netdev_linux_set_qos,                                       \
2237     netdev_linux_get_queue,                                     \
2238     netdev_linux_set_queue,                                     \
2239     netdev_linux_delete_queue,                                  \
2240     netdev_linux_get_queue_stats,                               \
2241     netdev_linux_dump_queues,                                   \
2242     netdev_linux_dump_queue_stats,                              \
2243                                                                 \
2244     netdev_linux_get_in4,                                       \
2245     netdev_linux_set_in4,                                       \
2246     netdev_linux_get_in6,                                       \
2247     netdev_linux_add_router,                                    \
2248     netdev_linux_get_next_hop,                                  \
2249     netdev_linux_get_status,                                    \
2250     netdev_linux_arp_lookup,                                    \
2251                                                                 \
2252     netdev_linux_update_flags,                                  \
2253                                                                 \
2254     netdev_linux_poll_add,                                      \
2255     netdev_linux_poll_remove                                    \
2256 }
2257
2258 const struct netdev_class netdev_linux_class =
2259     NETDEV_LINUX_CLASS(
2260         "system",
2261         netdev_linux_create,
2262         netdev_linux_enumerate,
2263         NULL);                  /* set_stats */
2264
2265 const struct netdev_class netdev_tap_class =
2266     NETDEV_LINUX_CLASS(
2267         "tap",
2268         netdev_linux_create_tap,
2269         NULL,                   /* enumerate */
2270         NULL);                  /* set_stats */
2271
2272 const struct netdev_class netdev_internal_class =
2273     NETDEV_LINUX_CLASS(
2274         "internal",
2275         netdev_linux_create,
2276         NULL,                    /* enumerate */
2277         netdev_vport_set_stats);
2278 \f
2279 /* HTB traffic control class. */
2280
2281 #define HTB_N_QUEUES 0xf000
2282
2283 struct htb {
2284     struct tc tc;
2285     unsigned int max_rate;      /* In bytes/s. */
2286 };
2287
2288 struct htb_class {
2289     struct tc_queue tc_queue;
2290     unsigned int min_rate;      /* In bytes/s. */
2291     unsigned int max_rate;      /* In bytes/s. */
2292     unsigned int burst;         /* In bytes. */
2293     unsigned int priority;      /* Lower values are higher priorities. */
2294 };
2295
2296 static struct htb *
2297 htb_get__(const struct netdev *netdev)
2298 {
2299     struct netdev_dev_linux *netdev_dev =
2300                                 netdev_dev_linux_cast(netdev_get_dev(netdev));
2301     return CONTAINER_OF(netdev_dev->tc, struct htb, tc);
2302 }
2303
2304 static void
2305 htb_install__(struct netdev *netdev, uint64_t max_rate)
2306 {
2307     struct netdev_dev_linux *netdev_dev =
2308                                 netdev_dev_linux_cast(netdev_get_dev(netdev));
2309     struct htb *htb;
2310
2311     htb = xmalloc(sizeof *htb);
2312     tc_init(&htb->tc, &tc_ops_htb);
2313     htb->max_rate = max_rate;
2314
2315     netdev_dev->tc = &htb->tc;
2316 }
2317
2318 /* Create an HTB qdisc.
2319  *
2320  * Equivalent to "tc qdisc add dev <dev> root handle 1: htb default 1". */
2321 static int
2322 htb_setup_qdisc__(struct netdev *netdev)
2323 {
2324     size_t opt_offset;
2325     struct tc_htb_glob opt;
2326     struct ofpbuf request;
2327     struct tcmsg *tcmsg;
2328
2329     tc_del_qdisc(netdev);
2330
2331     tcmsg = tc_make_request(netdev, RTM_NEWQDISC,
2332                             NLM_F_EXCL | NLM_F_CREATE, &request);
2333     if (!tcmsg) {
2334         return ENODEV;
2335     }
2336     tcmsg->tcm_handle = tc_make_handle(1, 0);
2337     tcmsg->tcm_parent = TC_H_ROOT;
2338
2339     nl_msg_put_string(&request, TCA_KIND, "htb");
2340
2341     memset(&opt, 0, sizeof opt);
2342     opt.rate2quantum = 10;
2343     opt.version = 3;
2344     opt.defcls = 1;
2345
2346     opt_offset = nl_msg_start_nested(&request, TCA_OPTIONS);
2347     nl_msg_put_unspec(&request, TCA_HTB_INIT, &opt, sizeof opt);
2348     nl_msg_end_nested(&request, opt_offset);
2349
2350     return tc_transact(&request, NULL);
2351 }
2352
2353 /* Equivalent to "tc class replace <dev> classid <handle> parent <parent> htb
2354  * rate <min_rate>bps ceil <max_rate>bps burst <burst>b prio <priority>". */
2355 static int
2356 htb_setup_class__(struct netdev *netdev, unsigned int handle,
2357                   unsigned int parent, struct htb_class *class)
2358 {
2359     size_t opt_offset;
2360     struct tc_htb_opt opt;
2361     struct ofpbuf request;
2362     struct tcmsg *tcmsg;
2363     int error;
2364     int mtu;
2365
2366     netdev_get_mtu(netdev, &mtu);
2367     if (mtu == INT_MAX) {
2368         VLOG_WARN_RL(&rl, "cannot set up HTB on device %s that lacks MTU",
2369                      netdev_get_name(netdev));
2370         return EINVAL;
2371     }
2372
2373     memset(&opt, 0, sizeof opt);
2374     tc_fill_rate(&opt.rate, class->min_rate, mtu);
2375     tc_fill_rate(&opt.ceil, class->max_rate, mtu);
2376     opt.buffer = tc_calc_buffer(opt.rate.rate, mtu, class->burst);
2377     opt.cbuffer = tc_calc_buffer(opt.ceil.rate, mtu, class->burst);
2378     opt.prio = class->priority;
2379
2380     tcmsg = tc_make_request(netdev, RTM_NEWTCLASS, NLM_F_CREATE, &request);
2381     if (!tcmsg) {
2382         return ENODEV;
2383     }
2384     tcmsg->tcm_handle = handle;
2385     tcmsg->tcm_parent = parent;
2386
2387     nl_msg_put_string(&request, TCA_KIND, "htb");
2388     opt_offset = nl_msg_start_nested(&request, TCA_OPTIONS);
2389     nl_msg_put_unspec(&request, TCA_HTB_PARMS, &opt, sizeof opt);
2390     tc_put_rtab(&request, TCA_HTB_RTAB, &opt.rate);
2391     tc_put_rtab(&request, TCA_HTB_CTAB, &opt.ceil);
2392     nl_msg_end_nested(&request, opt_offset);
2393
2394     error = tc_transact(&request, NULL);
2395     if (error) {
2396         VLOG_WARN_RL(&rl, "failed to replace %s class %u:%u, parent %u:%u, "
2397                      "min_rate=%u max_rate=%u burst=%u prio=%u (%s)",
2398                      netdev_get_name(netdev),
2399                      tc_get_major(handle), tc_get_minor(handle),
2400                      tc_get_major(parent), tc_get_minor(parent),
2401                      class->min_rate, class->max_rate,
2402                      class->burst, class->priority, strerror(error));
2403     }
2404     return error;
2405 }
2406
2407 /* Parses Netlink attributes in 'options' for HTB parameters and stores a
2408  * description of them into 'details'.  The description complies with the
2409  * specification given in the vswitch database documentation for linux-htb
2410  * queue details. */
2411 static int
2412 htb_parse_tca_options__(struct nlattr *nl_options, struct htb_class *class)
2413 {
2414     static const struct nl_policy tca_htb_policy[] = {
2415         [TCA_HTB_PARMS] = { .type = NL_A_UNSPEC, .optional = false,
2416                             .min_len = sizeof(struct tc_htb_opt) },
2417     };
2418
2419     struct nlattr *attrs[ARRAY_SIZE(tca_htb_policy)];
2420     const struct tc_htb_opt *htb;
2421
2422     if (!nl_parse_nested(nl_options, tca_htb_policy,
2423                          attrs, ARRAY_SIZE(tca_htb_policy))) {
2424         VLOG_WARN_RL(&rl, "failed to parse HTB class options");
2425         return EPROTO;
2426     }
2427
2428     htb = nl_attr_get(attrs[TCA_HTB_PARMS]);
2429     class->min_rate = htb->rate.rate;
2430     class->max_rate = htb->ceil.rate;
2431     class->burst = tc_ticks_to_bytes(htb->rate.rate, htb->buffer);
2432     class->priority = htb->prio;
2433     return 0;
2434 }
2435
2436 static int
2437 htb_parse_tcmsg__(struct ofpbuf *tcmsg, unsigned int *queue_id,
2438                   struct htb_class *options,
2439                   struct netdev_queue_stats *stats)
2440 {
2441     struct nlattr *nl_options;
2442     unsigned int handle;
2443     int error;
2444
2445     error = tc_parse_class(tcmsg, &handle, &nl_options, stats);
2446     if (!error && queue_id) {
2447         unsigned int major = tc_get_major(handle);
2448         unsigned int minor = tc_get_minor(handle);
2449         if (major == 1 && minor > 0 && minor <= HTB_N_QUEUES) {
2450             *queue_id = minor - 1;
2451         } else {
2452             error = EPROTO;
2453         }
2454     }
2455     if (!error && options) {
2456         error = htb_parse_tca_options__(nl_options, options);
2457     }
2458     return error;
2459 }
2460
2461 static void
2462 htb_parse_qdisc_details__(struct netdev *netdev,
2463                           const struct shash *details, struct htb_class *hc)
2464 {
2465     const char *max_rate_s;
2466
2467     max_rate_s = shash_find_data(details, "max-rate");
2468     hc->max_rate = max_rate_s ? strtoull(max_rate_s, NULL, 10) / 8 : 0;
2469     if (!hc->max_rate) {
2470         uint32_t current;
2471
2472         netdev_get_features(netdev, &current, NULL, NULL, NULL);
2473         hc->max_rate = netdev_features_to_bps(current) / 8;
2474     }
2475     hc->min_rate = hc->max_rate;
2476     hc->burst = 0;
2477     hc->priority = 0;
2478 }
2479
2480 static int
2481 htb_parse_class_details__(struct netdev *netdev,
2482                           const struct shash *details, struct htb_class *hc)
2483 {
2484     const struct htb *htb = htb_get__(netdev);
2485     const char *min_rate_s = shash_find_data(details, "min-rate");
2486     const char *max_rate_s = shash_find_data(details, "max-rate");
2487     const char *burst_s = shash_find_data(details, "burst");
2488     const char *priority_s = shash_find_data(details, "priority");
2489     int mtu;
2490
2491     netdev_get_mtu(netdev, &mtu);
2492     if (mtu == INT_MAX) {
2493         VLOG_WARN_RL(&rl, "cannot parse HTB class on device %s that lacks MTU",
2494                      netdev_get_name(netdev));
2495         return EINVAL;
2496     }
2497
2498     /* HTB requires at least an mtu sized min-rate to send any traffic even
2499      * on uncongested links. */
2500     hc->min_rate = min_rate_s ? strtoull(min_rate_s, NULL, 10) / 8 : 0;
2501     hc->min_rate = MAX(hc->min_rate, mtu);
2502     hc->min_rate = MIN(hc->min_rate, htb->max_rate);
2503
2504     /* max-rate */
2505     hc->max_rate = (max_rate_s
2506                     ? strtoull(max_rate_s, NULL, 10) / 8
2507                     : htb->max_rate);
2508     hc->max_rate = MAX(hc->max_rate, hc->min_rate);
2509     hc->max_rate = MIN(hc->max_rate, htb->max_rate);
2510
2511     /* burst
2512      *
2513      * According to hints in the documentation that I've read, it is important
2514      * that 'burst' be at least as big as the largest frame that might be
2515      * transmitted.  Also, making 'burst' a bit bigger than necessary is OK,
2516      * but having it a bit too small is a problem.  Since netdev_get_mtu()
2517      * doesn't include the Ethernet header, we need to add at least 14 (18?) to
2518      * the MTU.  We actually add 64, instead of 14, as a guard against
2519      * additional headers get tacked on somewhere that we're not aware of. */
2520     hc->burst = burst_s ? strtoull(burst_s, NULL, 10) / 8 : 0;
2521     hc->burst = MAX(hc->burst, mtu + 64);
2522
2523     /* priority */
2524     hc->priority = priority_s ? strtoul(priority_s, NULL, 10) : 0;
2525
2526     return 0;
2527 }
2528
2529 static int
2530 htb_query_class__(const struct netdev *netdev, unsigned int handle,
2531                   unsigned int parent, struct htb_class *options,
2532                   struct netdev_queue_stats *stats)
2533 {
2534     struct ofpbuf *reply;
2535     int error;
2536
2537     error = tc_query_class(netdev, handle, parent, &reply);
2538     if (!error) {
2539         error = htb_parse_tcmsg__(reply, NULL, options, stats);
2540         ofpbuf_delete(reply);
2541     }
2542     return error;
2543 }
2544
2545 static int
2546 htb_tc_install(struct netdev *netdev, const struct shash *details)
2547 {
2548     int error;
2549
2550     error = htb_setup_qdisc__(netdev);
2551     if (!error) {
2552         struct htb_class hc;
2553
2554         htb_parse_qdisc_details__(netdev, details, &hc);
2555         error = htb_setup_class__(netdev, tc_make_handle(1, 0xfffe),
2556                                   tc_make_handle(1, 0), &hc);
2557         if (!error) {
2558             htb_install__(netdev, hc.max_rate);
2559         }
2560     }
2561     return error;
2562 }
2563
2564 static struct htb_class *
2565 htb_class_cast__(const struct tc_queue *queue)
2566 {
2567     return CONTAINER_OF(queue, struct htb_class, tc_queue);
2568 }
2569
2570 static void
2571 htb_update_queue__(struct netdev *netdev, unsigned int queue_id,
2572                    const struct htb_class *hc)
2573 {
2574     struct htb *htb = htb_get__(netdev);
2575     size_t hash = hash_int(queue_id, 0);
2576     struct tc_queue *queue;
2577     struct htb_class *hcp;
2578
2579     queue = tc_find_queue__(netdev, queue_id, hash);
2580     if (queue) {
2581         hcp = htb_class_cast__(queue);
2582     } else {
2583         hcp = xmalloc(sizeof *hcp);
2584         queue = &hcp->tc_queue;
2585         queue->queue_id = queue_id;
2586         hmap_insert(&htb->tc.queues, &queue->hmap_node, hash);
2587     }
2588
2589     hcp->min_rate = hc->min_rate;
2590     hcp->max_rate = hc->max_rate;
2591     hcp->burst = hc->burst;
2592     hcp->priority = hc->priority;
2593 }
2594
2595 static int
2596 htb_tc_load(struct netdev *netdev, struct ofpbuf *nlmsg OVS_UNUSED)
2597 {
2598     struct ofpbuf msg;
2599     struct nl_dump dump;
2600     struct htb_class hc;
2601
2602     /* Get qdisc options. */
2603     hc.max_rate = 0;
2604     htb_query_class__(netdev, tc_make_handle(1, 0xfffe), 0, &hc, NULL);
2605     htb_install__(netdev, hc.max_rate);
2606
2607     /* Get queues. */
2608     if (!start_queue_dump(netdev, &dump)) {
2609         return ENODEV;
2610     }
2611     while (nl_dump_next(&dump, &msg)) {
2612         unsigned int queue_id;
2613
2614         if (!htb_parse_tcmsg__(&msg, &queue_id, &hc, NULL)) {
2615             htb_update_queue__(netdev, queue_id, &hc);
2616         }
2617     }
2618     nl_dump_done(&dump);
2619
2620     return 0;
2621 }
2622
2623 static void
2624 htb_tc_destroy(struct tc *tc)
2625 {
2626     struct htb *htb = CONTAINER_OF(tc, struct htb, tc);
2627     struct htb_class *hc, *next;
2628
2629     HMAP_FOR_EACH_SAFE (hc, next, tc_queue.hmap_node, &htb->tc.queues) {
2630         hmap_remove(&htb->tc.queues, &hc->tc_queue.hmap_node);
2631         free(hc);
2632     }
2633     tc_destroy(tc);
2634     free(htb);
2635 }
2636
2637 static int
2638 htb_qdisc_get(const struct netdev *netdev, struct shash *details)
2639 {
2640     const struct htb *htb = htb_get__(netdev);
2641     shash_add(details, "max-rate", xasprintf("%llu", 8ULL * htb->max_rate));
2642     return 0;
2643 }
2644
2645 static int
2646 htb_qdisc_set(struct netdev *netdev, const struct shash *details)
2647 {
2648     struct htb_class hc;
2649     int error;
2650
2651     htb_parse_qdisc_details__(netdev, details, &hc);
2652     error = htb_setup_class__(netdev, tc_make_handle(1, 0xfffe),
2653                               tc_make_handle(1, 0), &hc);
2654     if (!error) {
2655         htb_get__(netdev)->max_rate = hc.max_rate;
2656     }
2657     return error;
2658 }
2659
2660 static int
2661 htb_class_get(const struct netdev *netdev OVS_UNUSED,
2662               const struct tc_queue *queue, struct shash *details)
2663 {
2664     const struct htb_class *hc = htb_class_cast__(queue);
2665
2666     shash_add(details, "min-rate", xasprintf("%llu", 8ULL * hc->min_rate));
2667     if (hc->min_rate != hc->max_rate) {
2668         shash_add(details, "max-rate", xasprintf("%llu", 8ULL * hc->max_rate));
2669     }
2670     shash_add(details, "burst", xasprintf("%llu", 8ULL * hc->burst));
2671     if (hc->priority) {
2672         shash_add(details, "priority", xasprintf("%u", hc->priority));
2673     }
2674     return 0;
2675 }
2676
2677 static int
2678 htb_class_set(struct netdev *netdev, unsigned int queue_id,
2679               const struct shash *details)
2680 {
2681     struct htb_class hc;
2682     int error;
2683
2684     error = htb_parse_class_details__(netdev, details, &hc);
2685     if (error) {
2686         return error;
2687     }
2688
2689     error = htb_setup_class__(netdev, tc_make_handle(1, queue_id + 1),
2690                               tc_make_handle(1, 0xfffe), &hc);
2691     if (error) {
2692         return error;
2693     }
2694
2695     htb_update_queue__(netdev, queue_id, &hc);
2696     return 0;
2697 }
2698
2699 static int
2700 htb_class_delete(struct netdev *netdev, struct tc_queue *queue)
2701 {
2702     struct htb_class *hc = htb_class_cast__(queue);
2703     struct htb *htb = htb_get__(netdev);
2704     int error;
2705
2706     error = tc_delete_class(netdev, tc_make_handle(1, queue->queue_id + 1));
2707     if (!error) {
2708         hmap_remove(&htb->tc.queues, &hc->tc_queue.hmap_node);
2709         free(hc);
2710     }
2711     return error;
2712 }
2713
2714 static int
2715 htb_class_get_stats(const struct netdev *netdev, const struct tc_queue *queue,
2716                     struct netdev_queue_stats *stats)
2717 {
2718     return htb_query_class__(netdev, tc_make_handle(1, queue->queue_id + 1),
2719                              tc_make_handle(1, 0xfffe), NULL, stats);
2720 }
2721
2722 static int
2723 htb_class_dump_stats(const struct netdev *netdev OVS_UNUSED,
2724                      const struct ofpbuf *nlmsg,
2725                      netdev_dump_queue_stats_cb *cb, void *aux)
2726 {
2727     struct netdev_queue_stats stats;
2728     unsigned int handle, major, minor;
2729     int error;
2730
2731     error = tc_parse_class(nlmsg, &handle, NULL, &stats);
2732     if (error) {
2733         return error;
2734     }
2735
2736     major = tc_get_major(handle);
2737     minor = tc_get_minor(handle);
2738     if (major == 1 && minor > 0 && minor <= HTB_N_QUEUES) {
2739         (*cb)(minor - 1, &stats, aux);
2740     }
2741     return 0;
2742 }
2743
2744 static const struct tc_ops tc_ops_htb = {
2745     "htb",                      /* linux_name */
2746     "linux-htb",                /* ovs_name */
2747     HTB_N_QUEUES,               /* n_queues */
2748     htb_tc_install,
2749     htb_tc_load,
2750     htb_tc_destroy,
2751     htb_qdisc_get,
2752     htb_qdisc_set,
2753     htb_class_get,
2754     htb_class_set,
2755     htb_class_delete,
2756     htb_class_get_stats,
2757     htb_class_dump_stats
2758 };
2759 \f
2760 /* "linux-hfsc" traffic control class. */
2761
2762 #define HFSC_N_QUEUES 0xf000
2763
2764 struct hfsc {
2765     struct tc tc;
2766     uint32_t max_rate;
2767 };
2768
2769 struct hfsc_class {
2770     struct tc_queue tc_queue;
2771     uint32_t min_rate;
2772     uint32_t max_rate;
2773 };
2774
2775 static struct hfsc *
2776 hfsc_get__(const struct netdev *netdev)
2777 {
2778     struct netdev_dev_linux *netdev_dev;
2779     netdev_dev = netdev_dev_linux_cast(netdev_get_dev(netdev));
2780     return CONTAINER_OF(netdev_dev->tc, struct hfsc, tc);
2781 }
2782
2783 static struct hfsc_class *
2784 hfsc_class_cast__(const struct tc_queue *queue)
2785 {
2786     return CONTAINER_OF(queue, struct hfsc_class, tc_queue);
2787 }
2788
2789 static void
2790 hfsc_install__(struct netdev *netdev, uint32_t max_rate)
2791 {
2792     struct netdev_dev_linux * netdev_dev;
2793     struct hfsc *hfsc;
2794
2795     netdev_dev = netdev_dev_linux_cast(netdev_get_dev(netdev));
2796     hfsc = xmalloc(sizeof *hfsc);
2797     tc_init(&hfsc->tc, &tc_ops_hfsc);
2798     hfsc->max_rate = max_rate;
2799     netdev_dev->tc = &hfsc->tc;
2800 }
2801
2802 static void
2803 hfsc_update_queue__(struct netdev *netdev, unsigned int queue_id,
2804                     const struct hfsc_class *hc)
2805 {
2806     size_t hash;
2807     struct hfsc *hfsc;
2808     struct hfsc_class *hcp;
2809     struct tc_queue *queue;
2810
2811     hfsc = hfsc_get__(netdev);
2812     hash = hash_int(queue_id, 0);
2813
2814     queue = tc_find_queue__(netdev, queue_id, hash);
2815     if (queue) {
2816         hcp = hfsc_class_cast__(queue);
2817     } else {
2818         hcp             = xmalloc(sizeof *hcp);
2819         queue           = &hcp->tc_queue;
2820         queue->queue_id = queue_id;
2821         hmap_insert(&hfsc->tc.queues, &queue->hmap_node, hash);
2822     }
2823
2824     hcp->min_rate = hc->min_rate;
2825     hcp->max_rate = hc->max_rate;
2826 }
2827
2828 static int
2829 hfsc_parse_tca_options__(struct nlattr *nl_options, struct hfsc_class *class)
2830 {
2831     const struct tc_service_curve *rsc, *fsc, *usc;
2832     static const struct nl_policy tca_hfsc_policy[] = {
2833         [TCA_HFSC_RSC] = {
2834             .type      = NL_A_UNSPEC,
2835             .optional  = false,
2836             .min_len   = sizeof(struct tc_service_curve),
2837         },
2838         [TCA_HFSC_FSC] = {
2839             .type      = NL_A_UNSPEC,
2840             .optional  = false,
2841             .min_len   = sizeof(struct tc_service_curve),
2842         },
2843         [TCA_HFSC_USC] = {
2844             .type      = NL_A_UNSPEC,
2845             .optional  = false,
2846             .min_len   = sizeof(struct tc_service_curve),
2847         },
2848     };
2849     struct nlattr *attrs[ARRAY_SIZE(tca_hfsc_policy)];
2850
2851     if (!nl_parse_nested(nl_options, tca_hfsc_policy,
2852                          attrs, ARRAY_SIZE(tca_hfsc_policy))) {
2853         VLOG_WARN_RL(&rl, "failed to parse HFSC class options");
2854         return EPROTO;
2855     }
2856
2857     rsc = nl_attr_get(attrs[TCA_HFSC_RSC]);
2858     fsc = nl_attr_get(attrs[TCA_HFSC_FSC]);
2859     usc = nl_attr_get(attrs[TCA_HFSC_USC]);
2860
2861     if (rsc->m1 != 0 || rsc->d != 0 ||
2862         fsc->m1 != 0 || fsc->d != 0 ||
2863         usc->m1 != 0 || usc->d != 0) {
2864         VLOG_WARN_RL(&rl, "failed to parse HFSC class options. "
2865                      "Non-linear service curves are not supported.");
2866         return EPROTO;
2867     }
2868
2869     if (rsc->m2 != fsc->m2) {
2870         VLOG_WARN_RL(&rl, "failed to parse HFSC class options. "
2871                      "Real-time service curves are not supported ");
2872         return EPROTO;
2873     }
2874
2875     if (rsc->m2 > usc->m2) {
2876         VLOG_WARN_RL(&rl, "failed to parse HFSC class options. "
2877                      "Min-rate service curve is greater than "
2878                      "the max-rate service curve.");
2879         return EPROTO;
2880     }
2881
2882     class->min_rate = fsc->m2;
2883     class->max_rate = usc->m2;
2884     return 0;
2885 }
2886
2887 static int
2888 hfsc_parse_tcmsg__(struct ofpbuf *tcmsg, unsigned int *queue_id,
2889                    struct hfsc_class *options,
2890                    struct netdev_queue_stats *stats)
2891 {
2892     int error;
2893     unsigned int handle;
2894     struct nlattr *nl_options;
2895
2896     error = tc_parse_class(tcmsg, &handle, &nl_options, stats);
2897     if (error) {
2898         return error;
2899     }
2900
2901     if (queue_id) {
2902         unsigned int major, minor;
2903
2904         major = tc_get_major(handle);
2905         minor = tc_get_minor(handle);
2906         if (major == 1 && minor > 0 && minor <= HFSC_N_QUEUES) {
2907             *queue_id = minor - 1;
2908         } else {
2909             return EPROTO;
2910         }
2911     }
2912
2913     if (options) {
2914         error = hfsc_parse_tca_options__(nl_options, options);
2915     }
2916
2917     return error;
2918 }
2919
2920 static int
2921 hfsc_query_class__(const struct netdev *netdev, unsigned int handle,
2922                    unsigned int parent, struct hfsc_class *options,
2923                    struct netdev_queue_stats *stats)
2924 {
2925     int error;
2926     struct ofpbuf *reply;
2927
2928     error = tc_query_class(netdev, handle, parent, &reply);
2929     if (error) {
2930         return error;
2931     }
2932
2933     error = hfsc_parse_tcmsg__(reply, NULL, options, stats);
2934     ofpbuf_delete(reply);
2935     return error;
2936 }
2937
2938 static void
2939 hfsc_parse_qdisc_details__(struct netdev *netdev, const struct shash *details,
2940                            struct hfsc_class *class)
2941 {
2942     uint32_t max_rate;
2943     const char *max_rate_s;
2944
2945     max_rate_s = shash_find_data(details, "max-rate");
2946     max_rate   = max_rate_s ? strtoull(max_rate_s, NULL, 10) / 8 : 0;
2947
2948     if (!max_rate) {
2949         uint32_t current;
2950
2951         netdev_get_features(netdev, &current, NULL, NULL, NULL);
2952         max_rate = netdev_features_to_bps(current) / 8;
2953     }
2954
2955     class->min_rate = max_rate;
2956     class->max_rate = max_rate;
2957 }
2958
2959 static int
2960 hfsc_parse_class_details__(struct netdev *netdev,
2961                            const struct shash *details,
2962                            struct hfsc_class * class)
2963 {
2964     const struct hfsc *hfsc;
2965     uint32_t min_rate, max_rate;
2966     const char *min_rate_s, *max_rate_s;
2967
2968     hfsc       = hfsc_get__(netdev);
2969     min_rate_s = shash_find_data(details, "min-rate");
2970     max_rate_s = shash_find_data(details, "max-rate");
2971
2972     min_rate = min_rate_s ? strtoull(min_rate_s, NULL, 10) / 8 : 0;
2973     min_rate = MAX(min_rate, 1);
2974     min_rate = MIN(min_rate, hfsc->max_rate);
2975
2976     max_rate = (max_rate_s
2977                 ? strtoull(max_rate_s, NULL, 10) / 8
2978                 : hfsc->max_rate);
2979     max_rate = MAX(max_rate, min_rate);
2980     max_rate = MIN(max_rate, hfsc->max_rate);
2981
2982     class->min_rate = min_rate;
2983     class->max_rate = max_rate;
2984
2985     return 0;
2986 }
2987
2988 /* Create an HFSC qdisc.
2989  *
2990  * Equivalent to "tc qdisc add dev <dev> root handle 1: hfsc default 1". */
2991 static int
2992 hfsc_setup_qdisc__(struct netdev * netdev)
2993 {
2994     struct tcmsg *tcmsg;
2995     struct ofpbuf request;
2996     struct tc_hfsc_qopt opt;
2997
2998     tc_del_qdisc(netdev);
2999
3000     tcmsg = tc_make_request(netdev, RTM_NEWQDISC,
3001                             NLM_F_EXCL | NLM_F_CREATE, &request);
3002
3003     if (!tcmsg) {
3004         return ENODEV;
3005     }
3006
3007     tcmsg->tcm_handle = tc_make_handle(1, 0);
3008     tcmsg->tcm_parent = TC_H_ROOT;
3009
3010     memset(&opt, 0, sizeof opt);
3011     opt.defcls = 1;
3012
3013     nl_msg_put_string(&request, TCA_KIND, "hfsc");
3014     nl_msg_put_unspec(&request, TCA_OPTIONS, &opt, sizeof opt);
3015
3016     return tc_transact(&request, NULL);
3017 }
3018
3019 /* Create an HFSC class.
3020  *
3021  * Equivalent to "tc class add <dev> parent <parent> classid <handle> hfsc
3022  * sc rate <min_rate> ul rate <max_rate>" */
3023 static int
3024 hfsc_setup_class__(struct netdev *netdev, unsigned int handle,
3025                    unsigned int parent, struct hfsc_class *class)
3026 {
3027     int error;
3028     size_t opt_offset;
3029     struct tcmsg *tcmsg;
3030     struct ofpbuf request;
3031     struct tc_service_curve min, max;
3032
3033     tcmsg = tc_make_request(netdev, RTM_NEWTCLASS, NLM_F_CREATE, &request);
3034
3035     if (!tcmsg) {
3036         return ENODEV;
3037     }
3038
3039     tcmsg->tcm_handle = handle;
3040     tcmsg->tcm_parent = parent;
3041
3042     min.m1 = 0;
3043     min.d  = 0;
3044     min.m2 = class->min_rate;
3045
3046     max.m1 = 0;
3047     max.d  = 0;
3048     max.m2 = class->max_rate;
3049
3050     nl_msg_put_string(&request, TCA_KIND, "hfsc");
3051     opt_offset = nl_msg_start_nested(&request, TCA_OPTIONS);
3052     nl_msg_put_unspec(&request, TCA_HFSC_RSC, &min, sizeof min);
3053     nl_msg_put_unspec(&request, TCA_HFSC_FSC, &min, sizeof min);
3054     nl_msg_put_unspec(&request, TCA_HFSC_USC, &max, sizeof max);
3055     nl_msg_end_nested(&request, opt_offset);
3056
3057     error = tc_transact(&request, NULL);
3058     if (error) {
3059         VLOG_WARN_RL(&rl, "failed to replace %s class %u:%u, parent %u:%u, "
3060                      "min-rate %ubps, max-rate %ubps (%s)",
3061                      netdev_get_name(netdev),
3062                      tc_get_major(handle), tc_get_minor(handle),
3063                      tc_get_major(parent), tc_get_minor(parent),
3064                      class->min_rate, class->max_rate, strerror(error));
3065     }
3066
3067     return error;
3068 }
3069
3070 static int
3071 hfsc_tc_install(struct netdev *netdev, const struct shash *details)
3072 {
3073     int error;
3074     struct hfsc_class class;
3075
3076     error = hfsc_setup_qdisc__(netdev);
3077
3078     if (error) {
3079         return error;
3080     }
3081
3082     hfsc_parse_qdisc_details__(netdev, details, &class);
3083     error = hfsc_setup_class__(netdev, tc_make_handle(1, 0xfffe),
3084                                tc_make_handle(1, 0), &class);
3085
3086     if (error) {
3087         return error;
3088     }
3089
3090     hfsc_install__(netdev, class.max_rate);
3091     return 0;
3092 }
3093
3094 static int
3095 hfsc_tc_load(struct netdev *netdev, struct ofpbuf *nlmsg OVS_UNUSED)
3096 {
3097     struct ofpbuf msg;
3098     struct nl_dump dump;
3099     struct hfsc_class hc;
3100
3101     hc.max_rate = 0;
3102     hfsc_query_class__(netdev, tc_make_handle(1, 0xfffe), 0, &hc, NULL);
3103     hfsc_install__(netdev, hc.max_rate);
3104
3105     if (!start_queue_dump(netdev, &dump)) {
3106         return ENODEV;
3107     }
3108
3109     while (nl_dump_next(&dump, &msg)) {
3110         unsigned int queue_id;
3111
3112         if (!hfsc_parse_tcmsg__(&msg, &queue_id, &hc, NULL)) {
3113             hfsc_update_queue__(netdev, queue_id, &hc);
3114         }
3115     }
3116
3117     nl_dump_done(&dump);
3118     return 0;
3119 }
3120
3121 static void
3122 hfsc_tc_destroy(struct tc *tc)
3123 {
3124     struct hfsc *hfsc;
3125     struct hfsc_class *hc, *next;
3126
3127     hfsc = CONTAINER_OF(tc, struct hfsc, tc);
3128
3129     HMAP_FOR_EACH_SAFE (hc, next, tc_queue.hmap_node, &hfsc->tc.queues) {
3130         hmap_remove(&hfsc->tc.queues, &hc->tc_queue.hmap_node);
3131         free(hc);
3132     }
3133
3134     tc_destroy(tc);
3135     free(hfsc);
3136 }
3137
3138 static int
3139 hfsc_qdisc_get(const struct netdev *netdev, struct shash *details)
3140 {
3141     const struct hfsc *hfsc;
3142     hfsc = hfsc_get__(netdev);
3143     shash_add(details, "max-rate", xasprintf("%llu", 8ULL * hfsc->max_rate));
3144     return 0;
3145 }
3146
3147 static int
3148 hfsc_qdisc_set(struct netdev *netdev, const struct shash *details)
3149 {
3150     int error;
3151     struct hfsc_class class;
3152
3153     hfsc_parse_qdisc_details__(netdev, details, &class);
3154     error = hfsc_setup_class__(netdev, tc_make_handle(1, 0xfffe),
3155                                tc_make_handle(1, 0), &class);
3156
3157     if (!error) {
3158         hfsc_get__(netdev)->max_rate = class.max_rate;
3159     }
3160
3161     return error;
3162 }
3163
3164 static int
3165 hfsc_class_get(const struct netdev *netdev OVS_UNUSED,
3166               const struct tc_queue *queue, struct shash *details)
3167 {
3168     const struct hfsc_class *hc;
3169
3170     hc = hfsc_class_cast__(queue);
3171     shash_add(details, "min-rate", xasprintf("%llu", 8ULL * hc->min_rate));
3172     if (hc->min_rate != hc->max_rate) {
3173         shash_add(details, "max-rate", xasprintf("%llu", 8ULL * hc->max_rate));
3174     }
3175     return 0;
3176 }
3177
3178 static int
3179 hfsc_class_set(struct netdev *netdev, unsigned int queue_id,
3180                const struct shash *details)
3181 {
3182     int error;
3183     struct hfsc_class class;
3184
3185     error = hfsc_parse_class_details__(netdev, details, &class);
3186     if (error) {
3187         return error;
3188     }
3189
3190     error = hfsc_setup_class__(netdev, tc_make_handle(1, queue_id + 1),
3191                                tc_make_handle(1, 0xfffe), &class);
3192     if (error) {
3193         return error;
3194     }
3195
3196     hfsc_update_queue__(netdev, queue_id, &class);
3197     return 0;
3198 }
3199
3200 static int
3201 hfsc_class_delete(struct netdev *netdev, struct tc_queue *queue)
3202 {
3203     int error;
3204     struct hfsc *hfsc;
3205     struct hfsc_class *hc;
3206
3207     hc   = hfsc_class_cast__(queue);
3208     hfsc = hfsc_get__(netdev);
3209
3210     error = tc_delete_class(netdev, tc_make_handle(1, queue->queue_id + 1));
3211     if (!error) {
3212         hmap_remove(&hfsc->tc.queues, &hc->tc_queue.hmap_node);
3213         free(hc);
3214     }
3215     return error;
3216 }
3217
3218 static int
3219 hfsc_class_get_stats(const struct netdev *netdev, const struct tc_queue *queue,
3220                      struct netdev_queue_stats *stats)
3221 {
3222     return hfsc_query_class__(netdev, tc_make_handle(1, queue->queue_id + 1),
3223                              tc_make_handle(1, 0xfffe), NULL, stats);
3224 }
3225
3226 static int
3227 hfsc_class_dump_stats(const struct netdev *netdev OVS_UNUSED,
3228                       const struct ofpbuf *nlmsg,
3229                       netdev_dump_queue_stats_cb *cb, void *aux)
3230 {
3231     struct netdev_queue_stats stats;
3232     unsigned int handle, major, minor;
3233     int error;
3234
3235     error = tc_parse_class(nlmsg, &handle, NULL, &stats);
3236     if (error) {
3237         return error;
3238     }
3239
3240     major = tc_get_major(handle);
3241     minor = tc_get_minor(handle);
3242     if (major == 1 && minor > 0 && minor <= HFSC_N_QUEUES) {
3243         (*cb)(minor - 1, &stats, aux);
3244     }
3245     return 0;
3246 }
3247
3248 static const struct tc_ops tc_ops_hfsc = {
3249     "hfsc",                     /* linux_name */
3250     "linux-hfsc",               /* ovs_name */
3251     HFSC_N_QUEUES,              /* n_queues */
3252     hfsc_tc_install,            /* tc_install */
3253     hfsc_tc_load,               /* tc_load */
3254     hfsc_tc_destroy,            /* tc_destroy */
3255     hfsc_qdisc_get,             /* qdisc_get */
3256     hfsc_qdisc_set,             /* qdisc_set */
3257     hfsc_class_get,             /* class_get */
3258     hfsc_class_set,             /* class_set */
3259     hfsc_class_delete,          /* class_delete */
3260     hfsc_class_get_stats,       /* class_get_stats */
3261     hfsc_class_dump_stats       /* class_dump_stats */
3262 };
3263 \f
3264 /* "linux-default" traffic control class.
3265  *
3266  * This class represents the default, unnamed Linux qdisc.  It corresponds to
3267  * the "" (empty string) QoS type in the OVS database. */
3268
3269 static void
3270 default_install__(struct netdev *netdev)
3271 {
3272     struct netdev_dev_linux *netdev_dev =
3273                                 netdev_dev_linux_cast(netdev_get_dev(netdev));
3274     static struct tc *tc;
3275
3276     if (!tc) {
3277         tc = xmalloc(sizeof *tc);
3278         tc_init(tc, &tc_ops_default);
3279     }
3280     netdev_dev->tc = tc;
3281 }
3282
3283 static int
3284 default_tc_install(struct netdev *netdev,
3285                    const struct shash *details OVS_UNUSED)
3286 {
3287     default_install__(netdev);
3288     return 0;
3289 }
3290
3291 static int
3292 default_tc_load(struct netdev *netdev, struct ofpbuf *nlmsg OVS_UNUSED)
3293 {
3294     default_install__(netdev);
3295     return 0;
3296 }
3297
3298 static const struct tc_ops tc_ops_default = {
3299     NULL,                       /* linux_name */
3300     "",                         /* ovs_name */
3301     0,                          /* n_queues */
3302     default_tc_install,
3303     default_tc_load,
3304     NULL,                       /* tc_destroy */
3305     NULL,                       /* qdisc_get */
3306     NULL,                       /* qdisc_set */
3307     NULL,                       /* class_get */
3308     NULL,                       /* class_set */
3309     NULL,                       /* class_delete */
3310     NULL,                       /* class_get_stats */
3311     NULL                        /* class_dump_stats */
3312 };
3313 \f
3314 /* "linux-other" traffic control class.
3315  *
3316  * */
3317
3318 static int
3319 other_tc_load(struct netdev *netdev, struct ofpbuf *nlmsg OVS_UNUSED)
3320 {
3321     struct netdev_dev_linux *netdev_dev =
3322                                 netdev_dev_linux_cast(netdev_get_dev(netdev));
3323     static struct tc *tc;
3324
3325     if (!tc) {
3326         tc = xmalloc(sizeof *tc);
3327         tc_init(tc, &tc_ops_other);
3328     }
3329     netdev_dev->tc = tc;
3330     return 0;
3331 }
3332
3333 static const struct tc_ops tc_ops_other = {
3334     NULL,                       /* linux_name */
3335     "linux-other",              /* ovs_name */
3336     0,                          /* n_queues */
3337     NULL,                       /* tc_install */
3338     other_tc_load,
3339     NULL,                       /* tc_destroy */
3340     NULL,                       /* qdisc_get */
3341     NULL,                       /* qdisc_set */
3342     NULL,                       /* class_get */
3343     NULL,                       /* class_set */
3344     NULL,                       /* class_delete */
3345     NULL,                       /* class_get_stats */
3346     NULL                        /* class_dump_stats */
3347 };
3348 \f
3349 /* Traffic control. */
3350
3351 /* Number of kernel "tc" ticks per second. */
3352 static double ticks_per_s;
3353
3354 /* Number of kernel "jiffies" per second.  This is used for the purpose of
3355  * computing buffer sizes.  Generally kernel qdiscs need to be able to buffer
3356  * one jiffy's worth of data.
3357  *
3358  * There are two possibilities here:
3359  *
3360  *    - 'buffer_hz' is the kernel's real timer tick rate, a small number in the
3361  *      approximate range of 100 to 1024.  That means that we really need to
3362  *      make sure that the qdisc can buffer that much data.
3363  *
3364  *    - 'buffer_hz' is an absurdly large number.  That means that the kernel
3365  *      has finely granular timers and there's no need to fudge additional room
3366  *      for buffers.  (There's no extra effort needed to implement that: the
3367  *      large 'buffer_hz' is used as a divisor, so practically any number will
3368  *      come out as 0 in the division.  Small integer results in the case of
3369  *      really high dividends won't have any real effect anyhow.)
3370  */
3371 static unsigned int buffer_hz;
3372
3373 /* Returns tc handle 'major':'minor'. */
3374 static unsigned int
3375 tc_make_handle(unsigned int major, unsigned int minor)
3376 {
3377     return TC_H_MAKE(major << 16, minor);
3378 }
3379
3380 /* Returns the major number from 'handle'. */
3381 static unsigned int
3382 tc_get_major(unsigned int handle)
3383 {
3384     return TC_H_MAJ(handle) >> 16;
3385 }
3386
3387 /* Returns the minor number from 'handle'. */
3388 static unsigned int
3389 tc_get_minor(unsigned int handle)
3390 {
3391     return TC_H_MIN(handle);
3392 }
3393
3394 static struct tcmsg *
3395 tc_make_request(const struct netdev *netdev, int type, unsigned int flags,
3396                 struct ofpbuf *request)
3397 {
3398     struct tcmsg *tcmsg;
3399     int ifindex;
3400     int error;
3401
3402     error = get_ifindex(netdev, &ifindex);
3403     if (error) {
3404         return NULL;
3405     }
3406
3407     ofpbuf_init(request, 512);
3408     nl_msg_put_nlmsghdr(request, sizeof *tcmsg, type, NLM_F_REQUEST | flags);
3409     tcmsg = ofpbuf_put_zeros(request, sizeof *tcmsg);
3410     tcmsg->tcm_family = AF_UNSPEC;
3411     tcmsg->tcm_ifindex = ifindex;
3412     /* Caller should fill in tcmsg->tcm_handle. */
3413     /* Caller should fill in tcmsg->tcm_parent. */
3414
3415     return tcmsg;
3416 }
3417
3418 static int
3419 tc_transact(struct ofpbuf *request, struct ofpbuf **replyp)
3420 {
3421     int error = nl_sock_transact(rtnl_sock, request, replyp);
3422     ofpbuf_uninit(request);
3423     return error;
3424 }
3425
3426 static void
3427 read_psched(void)
3428 {
3429     /* The values in psched are not individually very meaningful, but they are
3430      * important.  The tables below show some values seen in the wild.
3431      *
3432      * Some notes:
3433      *
3434      *   - "c" has always been a constant 1000000 since at least Linux 2.4.14.
3435      *     (Before that, there are hints that it was 1000000000.)
3436      *
3437      *   - "d" can be unrealistically large, see the comment on 'buffer_hz'
3438      *     above.
3439      *
3440      *                        /proc/net/psched
3441      *     -----------------------------------
3442      * [1] 000c8000 000f4240 000f4240 00000064
3443      * [2] 000003e8 00000400 000f4240 3b9aca00
3444      * [3] 000003e8 00000400 000f4240 3b9aca00
3445      * [4] 000003e8 00000400 000f4240 00000064
3446      * [5] 000003e8 00000040 000f4240 3b9aca00
3447      * [6] 000003e8 00000040 000f4240 000000f9
3448      *
3449      *           a         b          c             d ticks_per_s     buffer_hz
3450      *     ------- --------- ---------- ------------- ----------- -------------
3451      * [1] 819,200 1,000,000  1,000,000           100     819,200           100
3452      * [2]   1,000     1,024  1,000,000 1,000,000,000     976,562 1,000,000,000
3453      * [3]   1,000     1,024  1,000,000 1,000,000,000     976,562 1,000,000,000
3454      * [4]   1,000     1,024  1,000,000           100     976,562           100
3455      * [5]   1,000        64  1,000,000 1,000,000,000  15,625,000 1,000,000,000
3456      * [6]   1,000        64  1,000,000           249  15,625,000           249
3457      *
3458      * [1] 2.6.18-128.1.6.el5.xs5.5.0.505.1024xen from XenServer 5.5.0-24648p
3459      * [2] 2.6.26-1-686-bigmem from Debian lenny
3460      * [3] 2.6.26-2-sparc64 from Debian lenny
3461      * [4] 2.6.27.42-0.1.1.xs5.6.810.44.111163xen from XenServer 5.6.810-31078p
3462      * [5] 2.6.32.21.22 (approx.) from Ubuntu 10.04 on VMware Fusion
3463      * [6] 2.6.34 from kernel.org on KVM
3464      */
3465     static const char fn[] = "/proc/net/psched";
3466     unsigned int a, b, c, d;
3467     FILE *stream;
3468
3469     ticks_per_s = 1.0;
3470     buffer_hz = 100;
3471
3472     stream = fopen(fn, "r");
3473     if (!stream) {
3474         VLOG_WARN("%s: open failed: %s", fn, strerror(errno));
3475         return;
3476     }
3477
3478     if (fscanf(stream, "%x %x %x %x", &a, &b, &c, &d) != 4) {
3479         VLOG_WARN("%s: read failed", fn);
3480         fclose(stream);
3481         return;
3482     }
3483     VLOG_DBG("%s: psched parameters are: %u %u %u %u", fn, a, b, c, d);
3484     fclose(stream);
3485
3486     if (!a || !c) {
3487         VLOG_WARN("%s: invalid scheduler parameters", fn);
3488         return;
3489     }
3490
3491     ticks_per_s = (double) a * c / b;
3492     if (c == 1000000) {
3493         buffer_hz = d;
3494     } else {
3495         VLOG_WARN("%s: unexpected psched parameters: %u %u %u %u",
3496                   fn, a, b, c, d);
3497     }
3498     VLOG_DBG("%s: ticks_per_s=%f buffer_hz=%u", fn, ticks_per_s, buffer_hz);
3499 }
3500
3501 /* Returns the number of bytes that can be transmitted in 'ticks' ticks at a
3502  * rate of 'rate' bytes per second. */
3503 static unsigned int
3504 tc_ticks_to_bytes(unsigned int rate, unsigned int ticks)
3505 {
3506     if (!buffer_hz) {
3507         read_psched();
3508     }
3509     return (rate * ticks) / ticks_per_s;
3510 }
3511
3512 /* Returns the number of ticks that it would take to transmit 'size' bytes at a
3513  * rate of 'rate' bytes per second. */
3514 static unsigned int
3515 tc_bytes_to_ticks(unsigned int rate, unsigned int size)
3516 {
3517     if (!buffer_hz) {
3518         read_psched();
3519     }
3520     return rate ? ((unsigned long long int) ticks_per_s * size) / rate : 0;
3521 }
3522
3523 /* Returns the number of bytes that need to be reserved for qdisc buffering at
3524  * a transmission rate of 'rate' bytes per second. */
3525 static unsigned int
3526 tc_buffer_per_jiffy(unsigned int rate)
3527 {
3528     if (!buffer_hz) {
3529         read_psched();
3530     }
3531     return rate / buffer_hz;
3532 }
3533
3534 /* Given Netlink 'msg' that describes a qdisc, extracts the name of the qdisc,
3535  * e.g. "htb", into '*kind' (if it is nonnull).  If 'options' is nonnull,
3536  * extracts 'msg''s TCA_OPTIONS attributes into '*options' if it is present or
3537  * stores NULL into it if it is absent.
3538  *
3539  * '*kind' and '*options' point into 'msg', so they are owned by whoever owns
3540  * 'msg'.
3541  *
3542  * Returns 0 if successful, otherwise a positive errno value. */
3543 static int
3544 tc_parse_qdisc(const struct ofpbuf *msg, const char **kind,
3545                struct nlattr **options)
3546 {
3547     static const struct nl_policy tca_policy[] = {
3548         [TCA_KIND] = { .type = NL_A_STRING, .optional = false },
3549         [TCA_OPTIONS] = { .type = NL_A_NESTED, .optional = true },
3550     };
3551     struct nlattr *ta[ARRAY_SIZE(tca_policy)];
3552
3553     if (!nl_policy_parse(msg, NLMSG_HDRLEN + sizeof(struct tcmsg),
3554                          tca_policy, ta, ARRAY_SIZE(ta))) {
3555         VLOG_WARN_RL(&rl, "failed to parse qdisc message");
3556         goto error;
3557     }
3558
3559     if (kind) {
3560         *kind = nl_attr_get_string(ta[TCA_KIND]);
3561     }
3562
3563     if (options) {
3564         *options = ta[TCA_OPTIONS];
3565     }
3566
3567     return 0;
3568
3569 error:
3570     if (kind) {
3571         *kind = NULL;
3572     }
3573     if (options) {
3574         *options = NULL;
3575     }
3576     return EPROTO;
3577 }
3578
3579 /* Given Netlink 'msg' that describes a class, extracts the queue ID (e.g. the
3580  * minor number of its class ID) into '*queue_id', its TCA_OPTIONS attribute
3581  * into '*options', and its queue statistics into '*stats'.  Any of the output
3582  * arguments may be null.
3583  *
3584  * Returns 0 if successful, otherwise a positive errno value. */
3585 static int
3586 tc_parse_class(const struct ofpbuf *msg, unsigned int *handlep,
3587                struct nlattr **options, struct netdev_queue_stats *stats)
3588 {
3589     static const struct nl_policy tca_policy[] = {
3590         [TCA_OPTIONS] = { .type = NL_A_NESTED, .optional = false },
3591         [TCA_STATS2] = { .type = NL_A_NESTED, .optional = false },
3592     };
3593     struct nlattr *ta[ARRAY_SIZE(tca_policy)];
3594
3595     if (!nl_policy_parse(msg, NLMSG_HDRLEN + sizeof(struct tcmsg),
3596                          tca_policy, ta, ARRAY_SIZE(ta))) {
3597         VLOG_WARN_RL(&rl, "failed to parse class message");
3598         goto error;
3599     }
3600
3601     if (handlep) {
3602         struct tcmsg *tc = ofpbuf_at_assert(msg, NLMSG_HDRLEN, sizeof *tc);
3603         *handlep = tc->tcm_handle;
3604     }
3605
3606     if (options) {
3607         *options = ta[TCA_OPTIONS];
3608     }
3609
3610     if (stats) {
3611         const struct gnet_stats_queue *gsq;
3612         struct gnet_stats_basic gsb;
3613
3614         static const struct nl_policy stats_policy[] = {
3615             [TCA_STATS_BASIC] = { .type = NL_A_UNSPEC, .optional = false,
3616                                   .min_len = sizeof gsb },
3617             [TCA_STATS_QUEUE] = { .type = NL_A_UNSPEC, .optional = false,
3618                                   .min_len = sizeof *gsq },
3619         };
3620         struct nlattr *sa[ARRAY_SIZE(stats_policy)];
3621
3622         if (!nl_parse_nested(ta[TCA_STATS2], stats_policy,
3623                              sa, ARRAY_SIZE(sa))) {
3624             VLOG_WARN_RL(&rl, "failed to parse class stats");
3625             goto error;
3626         }
3627
3628         /* Alignment issues screw up the length of struct gnet_stats_basic on
3629          * some arch/bitsize combinations.  Newer versions of Linux have a
3630          * struct gnet_stats_basic_packed, but we can't depend on that.  The
3631          * easiest thing to do is just to make a copy. */
3632         memset(&gsb, 0, sizeof gsb);
3633         memcpy(&gsb, nl_attr_get(sa[TCA_STATS_BASIC]),
3634                MIN(nl_attr_get_size(sa[TCA_STATS_BASIC]), sizeof gsb));
3635         stats->tx_bytes = gsb.bytes;
3636         stats->tx_packets = gsb.packets;
3637
3638         gsq = nl_attr_get(sa[TCA_STATS_QUEUE]);
3639         stats->tx_errors = gsq->drops;
3640     }
3641
3642     return 0;
3643
3644 error:
3645     if (options) {
3646         *options = NULL;
3647     }
3648     if (stats) {
3649         memset(stats, 0, sizeof *stats);
3650     }
3651     return EPROTO;
3652 }
3653
3654 /* Queries the kernel for class with identifier 'handle' and parent 'parent'
3655  * on 'netdev'. */
3656 static int
3657 tc_query_class(const struct netdev *netdev,
3658                unsigned int handle, unsigned int parent,
3659                struct ofpbuf **replyp)
3660 {
3661     struct ofpbuf request;
3662     struct tcmsg *tcmsg;
3663     int error;
3664
3665     tcmsg = tc_make_request(netdev, RTM_GETTCLASS, NLM_F_ECHO, &request);
3666     if (!tcmsg) {
3667         return ENODEV;
3668     }
3669     tcmsg->tcm_handle = handle;
3670     tcmsg->tcm_parent = parent;
3671
3672     error = tc_transact(&request, replyp);
3673     if (error) {
3674         VLOG_WARN_RL(&rl, "query %s class %u:%u (parent %u:%u) failed (%s)",
3675                      netdev_get_name(netdev),
3676                      tc_get_major(handle), tc_get_minor(handle),
3677                      tc_get_major(parent), tc_get_minor(parent),
3678                      strerror(error));
3679     }
3680     return error;
3681 }
3682
3683 /* Equivalent to "tc class del dev <name> handle <handle>". */
3684 static int
3685 tc_delete_class(const struct netdev *netdev, unsigned int handle)
3686 {
3687     struct ofpbuf request;
3688     struct tcmsg *tcmsg;
3689     int error;
3690
3691     tcmsg = tc_make_request(netdev, RTM_DELTCLASS, 0, &request);
3692     if (!tcmsg) {
3693         return ENODEV;
3694     }
3695     tcmsg->tcm_handle = handle;
3696     tcmsg->tcm_parent = 0;
3697
3698     error = tc_transact(&request, NULL);
3699     if (error) {
3700         VLOG_WARN_RL(&rl, "delete %s class %u:%u failed (%s)",
3701                      netdev_get_name(netdev),
3702                      tc_get_major(handle), tc_get_minor(handle),
3703                      strerror(error));
3704     }
3705     return error;
3706 }
3707
3708 /* Equivalent to "tc qdisc del dev <name> root". */
3709 static int
3710 tc_del_qdisc(struct netdev *netdev)
3711 {
3712     struct netdev_dev_linux *netdev_dev =
3713                                 netdev_dev_linux_cast(netdev_get_dev(netdev));
3714     struct ofpbuf request;
3715     struct tcmsg *tcmsg;
3716     int error;
3717
3718     tcmsg = tc_make_request(netdev, RTM_DELQDISC, 0, &request);
3719     if (!tcmsg) {
3720         return ENODEV;
3721     }
3722     tcmsg->tcm_handle = tc_make_handle(1, 0);
3723     tcmsg->tcm_parent = TC_H_ROOT;
3724
3725     error = tc_transact(&request, NULL);
3726     if (error == EINVAL) {
3727         /* EINVAL probably means that the default qdisc was in use, in which
3728          * case we've accomplished our purpose. */
3729         error = 0;
3730     }
3731     if (!error && netdev_dev->tc) {
3732         if (netdev_dev->tc->ops->tc_destroy) {
3733             netdev_dev->tc->ops->tc_destroy(netdev_dev->tc);
3734         }
3735         netdev_dev->tc = NULL;
3736     }
3737     return error;
3738 }
3739
3740 /* If 'netdev''s qdisc type and parameters are not yet known, queries the
3741  * kernel to determine what they are.  Returns 0 if successful, otherwise a
3742  * positive errno value. */
3743 static int
3744 tc_query_qdisc(const struct netdev *netdev)
3745 {
3746     struct netdev_dev_linux *netdev_dev =
3747                                 netdev_dev_linux_cast(netdev_get_dev(netdev));
3748     struct ofpbuf request, *qdisc;
3749     const struct tc_ops *ops;
3750     struct tcmsg *tcmsg;
3751     int load_error;
3752     int error;
3753
3754     if (netdev_dev->tc) {
3755         return 0;
3756     }
3757
3758     /* This RTM_GETQDISC is crafted to avoid OOPSing kernels that do not have
3759      * commit 53b0f08 "net_sched: Fix qdisc_notify()", which is anything before
3760      * 2.6.35 without that fix backported to it.
3761      *
3762      * To avoid the OOPS, we must not make a request that would attempt to dump
3763      * a "built-in" qdisc, that is, the default pfifo_fast qdisc or one of a
3764      * few others.  There are a few ways that I can see to do this, but most of
3765      * them seem to be racy (and if you lose the race the kernel OOPSes).  The
3766      * technique chosen here is to assume that any non-default qdisc that we
3767      * create will have a class with handle 1:0.  The built-in qdiscs only have
3768      * a class with handle 0:0.
3769      *
3770      * We could check for Linux 2.6.35+ and use a more straightforward method
3771      * there. */
3772     tcmsg = tc_make_request(netdev, RTM_GETQDISC, NLM_F_ECHO, &request);
3773     if (!tcmsg) {
3774         return ENODEV;
3775     }
3776     tcmsg->tcm_handle = tc_make_handle(1, 0);
3777     tcmsg->tcm_parent = 0;
3778
3779     /* Figure out what tc class to instantiate. */
3780     error = tc_transact(&request, &qdisc);
3781     if (!error) {
3782         const char *kind;
3783
3784         error = tc_parse_qdisc(qdisc, &kind, NULL);
3785         if (error) {
3786             ops = &tc_ops_other;
3787         } else {
3788             ops = tc_lookup_linux_name(kind);
3789             if (!ops) {
3790                 static struct vlog_rate_limit rl2 = VLOG_RATE_LIMIT_INIT(1, 1);
3791                 VLOG_INFO_RL(&rl2, "unknown qdisc \"%s\"", kind);
3792
3793                 ops = &tc_ops_other;
3794             }
3795         }
3796     } else if (error == ENOENT) {
3797         /* Either it's a built-in qdisc, or it's a qdisc set up by some
3798          * other entity that doesn't have a handle 1:0.  We will assume
3799          * that it's the system default qdisc. */
3800         ops = &tc_ops_default;
3801         error = 0;
3802     } else {
3803         /* Who knows?  Maybe the device got deleted. */
3804         VLOG_WARN_RL(&rl, "query %s qdisc failed (%s)",
3805                      netdev_get_name(netdev), strerror(error));
3806         ops = &tc_ops_other;
3807     }
3808
3809     /* Instantiate it. */
3810     load_error = ops->tc_load((struct netdev *) netdev, qdisc);
3811     assert((load_error == 0) == (netdev_dev->tc != NULL));
3812     ofpbuf_delete(qdisc);
3813
3814     return error ? error : load_error;
3815 }
3816
3817 /* Linux traffic control uses tables with 256 entries ("rtab" tables) to
3818    approximate the time to transmit packets of various lengths.  For an MTU of
3819    256 or less, each entry is exact; for an MTU of 257 through 512, each entry
3820    represents two possible packet lengths; for a MTU of 513 through 1024, four
3821    possible lengths; and so on.
3822
3823    Returns, for the specified 'mtu', the number of bits that packet lengths
3824    need to be shifted right to fit within such a 256-entry table. */
3825 static int
3826 tc_calc_cell_log(unsigned int mtu)
3827 {
3828     int cell_log;
3829
3830     if (!mtu) {
3831         mtu = ETH_PAYLOAD_MAX;
3832     }
3833     mtu += ETH_HEADER_LEN + VLAN_HEADER_LEN;
3834
3835     for (cell_log = 0; mtu >= 256; cell_log++) {
3836         mtu >>= 1;
3837     }
3838
3839     return cell_log;
3840 }
3841
3842 /* Initializes 'rate' properly for a rate of 'Bps' bytes per second with an MTU
3843  * of 'mtu'. */
3844 static void
3845 tc_fill_rate(struct tc_ratespec *rate, uint64_t Bps, int mtu)
3846 {
3847     memset(rate, 0, sizeof *rate);
3848     rate->cell_log = tc_calc_cell_log(mtu);
3849     /* rate->overhead = 0; */           /* New in 2.6.24, not yet in some */
3850     /* rate->cell_align = 0; */         /* distro headers. */
3851     rate->mpu = ETH_TOTAL_MIN;
3852     rate->rate = Bps;
3853 }
3854
3855 /* Appends to 'msg' an "rtab" table for the specified 'rate' as a Netlink
3856  * attribute of the specified "type".
3857  *
3858  * See tc_calc_cell_log() above for a description of "rtab"s. */
3859 static void
3860 tc_put_rtab(struct ofpbuf *msg, uint16_t type, const struct tc_ratespec *rate)
3861 {
3862     uint32_t *rtab;
3863     unsigned int i;
3864
3865     rtab = nl_msg_put_unspec_uninit(msg, type, TC_RTAB_SIZE);
3866     for (i = 0; i < TC_RTAB_SIZE / sizeof *rtab; i++) {
3867         unsigned packet_size = (i + 1) << rate->cell_log;
3868         if (packet_size < rate->mpu) {
3869             packet_size = rate->mpu;
3870         }
3871         rtab[i] = tc_bytes_to_ticks(rate->rate, packet_size);
3872     }
3873 }
3874
3875 /* Calculates the proper value of 'buffer' or 'cbuffer' in HTB options given a
3876  * rate of 'Bps' bytes per second, the specified 'mtu', and a user-requested
3877  * burst size of 'burst_bytes'.  (If no value was requested, a 'burst_bytes' of
3878  * 0 is fine.) */
3879 static int
3880 tc_calc_buffer(unsigned int Bps, int mtu, uint64_t burst_bytes)
3881 {
3882     unsigned int min_burst = tc_buffer_per_jiffy(Bps) + mtu;
3883     return tc_bytes_to_ticks(Bps, MAX(burst_bytes, min_burst));
3884 }
3885
3886 \f
3887 /* Utility functions. */
3888
3889 static int
3890 get_stats_via_netlink(int ifindex, struct netdev_stats *stats)
3891 {
3892     /* Policy for RTNLGRP_LINK messages.
3893      *
3894      * There are *many* more fields in these messages, but currently we only
3895      * care about these fields. */
3896     static const struct nl_policy rtnlgrp_link_policy[] = {
3897         [IFLA_IFNAME] = { .type = NL_A_STRING, .optional = false },
3898         [IFLA_STATS] = { .type = NL_A_UNSPEC, .optional = true,
3899                          .min_len = sizeof(struct rtnl_link_stats) },
3900     };
3901
3902     struct ofpbuf request;
3903     struct ofpbuf *reply;
3904     struct ifinfomsg *ifi;
3905     const struct rtnl_link_stats *rtnl_stats;
3906     struct nlattr *attrs[ARRAY_SIZE(rtnlgrp_link_policy)];
3907     int error;
3908
3909     ofpbuf_init(&request, 0);
3910     nl_msg_put_nlmsghdr(&request, sizeof *ifi, RTM_GETLINK, NLM_F_REQUEST);
3911     ifi = ofpbuf_put_zeros(&request, sizeof *ifi);
3912     ifi->ifi_family = PF_UNSPEC;
3913     ifi->ifi_index = ifindex;
3914     error = nl_sock_transact(rtnl_sock, &request, &reply);
3915     ofpbuf_uninit(&request);
3916     if (error) {
3917         return error;
3918     }
3919
3920     if (!nl_policy_parse(reply, NLMSG_HDRLEN + sizeof(struct ifinfomsg),
3921                          rtnlgrp_link_policy,
3922                          attrs, ARRAY_SIZE(rtnlgrp_link_policy))) {
3923         ofpbuf_delete(reply);
3924         return EPROTO;
3925     }
3926
3927     if (!attrs[IFLA_STATS]) {
3928         VLOG_WARN_RL(&rl, "RTM_GETLINK reply lacks stats");
3929         ofpbuf_delete(reply);
3930         return EPROTO;
3931     }
3932
3933     rtnl_stats = nl_attr_get(attrs[IFLA_STATS]);
3934     stats->rx_packets = rtnl_stats->rx_packets;
3935     stats->tx_packets = rtnl_stats->tx_packets;
3936     stats->rx_bytes = rtnl_stats->rx_bytes;
3937     stats->tx_bytes = rtnl_stats->tx_bytes;
3938     stats->rx_errors = rtnl_stats->rx_errors;
3939     stats->tx_errors = rtnl_stats->tx_errors;
3940     stats->rx_dropped = rtnl_stats->rx_dropped;
3941     stats->tx_dropped = rtnl_stats->tx_dropped;
3942     stats->multicast = rtnl_stats->multicast;
3943     stats->collisions = rtnl_stats->collisions;
3944     stats->rx_length_errors = rtnl_stats->rx_length_errors;
3945     stats->rx_over_errors = rtnl_stats->rx_over_errors;
3946     stats->rx_crc_errors = rtnl_stats->rx_crc_errors;
3947     stats->rx_frame_errors = rtnl_stats->rx_frame_errors;
3948     stats->rx_fifo_errors = rtnl_stats->rx_fifo_errors;
3949     stats->rx_missed_errors = rtnl_stats->rx_missed_errors;
3950     stats->tx_aborted_errors = rtnl_stats->tx_aborted_errors;
3951     stats->tx_carrier_errors = rtnl_stats->tx_carrier_errors;
3952     stats->tx_fifo_errors = rtnl_stats->tx_fifo_errors;
3953     stats->tx_heartbeat_errors = rtnl_stats->tx_heartbeat_errors;
3954     stats->tx_window_errors = rtnl_stats->tx_window_errors;
3955
3956     ofpbuf_delete(reply);
3957
3958     return 0;
3959 }
3960
3961 static int
3962 get_stats_via_proc(const char *netdev_name, struct netdev_stats *stats)
3963 {
3964     static const char fn[] = "/proc/net/dev";
3965     char line[1024];
3966     FILE *stream;
3967     int ln;
3968
3969     stream = fopen(fn, "r");
3970     if (!stream) {
3971         VLOG_WARN_RL(&rl, "%s: open failed: %s", fn, strerror(errno));
3972         return errno;
3973     }
3974
3975     ln = 0;
3976     while (fgets(line, sizeof line, stream)) {
3977         if (++ln >= 3) {
3978             char devname[16];
3979 #define X64 "%"SCNu64
3980             if (sscanf(line,
3981                        " %15[^:]:"
3982                        X64 X64 X64 X64 X64 X64 X64 "%*u"
3983                        X64 X64 X64 X64 X64 X64 X64 "%*u",
3984                        devname,
3985                        &stats->rx_bytes,
3986                        &stats->rx_packets,
3987                        &stats->rx_errors,
3988                        &stats->rx_dropped,
3989                        &stats->rx_fifo_errors,
3990                        &stats->rx_frame_errors,
3991                        &stats->multicast,
3992                        &stats->tx_bytes,
3993                        &stats->tx_packets,
3994                        &stats->tx_errors,
3995                        &stats->tx_dropped,
3996                        &stats->tx_fifo_errors,
3997                        &stats->collisions,
3998                        &stats->tx_carrier_errors) != 15) {
3999                 VLOG_WARN_RL(&rl, "%s:%d: parse error", fn, ln);
4000             } else if (!strcmp(devname, netdev_name)) {
4001                 stats->rx_length_errors = UINT64_MAX;
4002                 stats->rx_over_errors = UINT64_MAX;
4003                 stats->rx_crc_errors = UINT64_MAX;
4004                 stats->rx_missed_errors = UINT64_MAX;
4005                 stats->tx_aborted_errors = UINT64_MAX;
4006                 stats->tx_heartbeat_errors = UINT64_MAX;
4007                 stats->tx_window_errors = UINT64_MAX;
4008                 fclose(stream);
4009                 return 0;
4010             }
4011         }
4012     }
4013     VLOG_WARN_RL(&rl, "%s: no stats for %s", fn, netdev_name);
4014     fclose(stream);
4015     return ENODEV;
4016 }
4017
4018 static int
4019 get_flags(const struct netdev *netdev, int *flags)
4020 {
4021     struct ifreq ifr;
4022     int error;
4023
4024     error = netdev_linux_do_ioctl(netdev_get_name(netdev), &ifr, SIOCGIFFLAGS,
4025                                   "SIOCGIFFLAGS");
4026     *flags = ifr.ifr_flags;
4027     return error;
4028 }
4029
4030 static int
4031 set_flags(struct netdev *netdev, int flags)
4032 {
4033     struct ifreq ifr;
4034
4035     ifr.ifr_flags = flags;
4036     return netdev_linux_do_ioctl(netdev_get_name(netdev), &ifr, SIOCSIFFLAGS,
4037                                  "SIOCSIFFLAGS");
4038 }
4039
4040 static int
4041 do_get_ifindex(const char *netdev_name)
4042 {
4043     struct ifreq ifr;
4044
4045     ovs_strzcpy(ifr.ifr_name, netdev_name, sizeof ifr.ifr_name);
4046     COVERAGE_INC(netdev_get_ifindex);
4047     if (ioctl(af_inet_sock, SIOCGIFINDEX, &ifr) < 0) {
4048         VLOG_WARN_RL(&rl, "ioctl(SIOCGIFINDEX) on %s device failed: %s",
4049                      netdev_name, strerror(errno));
4050         return -errno;
4051     }
4052     return ifr.ifr_ifindex;
4053 }
4054
4055 static int
4056 get_ifindex(const struct netdev *netdev_, int *ifindexp)
4057 {
4058     struct netdev_dev_linux *netdev_dev =
4059                                 netdev_dev_linux_cast(netdev_get_dev(netdev_));
4060     *ifindexp = 0;
4061     if (!(netdev_dev->cache_valid & VALID_IFINDEX)) {
4062         int ifindex = do_get_ifindex(netdev_get_name(netdev_));
4063         if (ifindex < 0) {
4064             return -ifindex;
4065         }
4066         netdev_dev->cache_valid |= VALID_IFINDEX;
4067         netdev_dev->ifindex = ifindex;
4068     }
4069     *ifindexp = netdev_dev->ifindex;
4070     return 0;
4071 }
4072
4073 static int
4074 get_etheraddr(const char *netdev_name, uint8_t ea[ETH_ADDR_LEN])
4075 {
4076     struct ifreq ifr;
4077     int hwaddr_family;
4078
4079     memset(&ifr, 0, sizeof ifr);
4080     ovs_strzcpy(ifr.ifr_name, netdev_name, sizeof ifr.ifr_name);
4081     COVERAGE_INC(netdev_get_hwaddr);
4082     if (ioctl(af_inet_sock, SIOCGIFHWADDR, &ifr) < 0) {
4083         VLOG_ERR("ioctl(SIOCGIFHWADDR) on %s device failed: %s",
4084                  netdev_name, strerror(errno));
4085         return errno;
4086     }
4087     hwaddr_family = ifr.ifr_hwaddr.sa_family;
4088     if (hwaddr_family != AF_UNSPEC && hwaddr_family != ARPHRD_ETHER) {
4089         VLOG_WARN("%s device has unknown hardware address family %d",
4090                   netdev_name, hwaddr_family);
4091     }
4092     memcpy(ea, ifr.ifr_hwaddr.sa_data, ETH_ADDR_LEN);
4093     return 0;
4094 }
4095
4096 static int
4097 set_etheraddr(const char *netdev_name, int hwaddr_family,
4098               const uint8_t mac[ETH_ADDR_LEN])
4099 {
4100     struct ifreq ifr;
4101
4102     memset(&ifr, 0, sizeof ifr);
4103     ovs_strzcpy(ifr.ifr_name, netdev_name, sizeof ifr.ifr_name);
4104     ifr.ifr_hwaddr.sa_family = hwaddr_family;
4105     memcpy(ifr.ifr_hwaddr.sa_data, mac, ETH_ADDR_LEN);
4106     COVERAGE_INC(netdev_set_hwaddr);
4107     if (ioctl(af_inet_sock, SIOCSIFHWADDR, &ifr) < 0) {
4108         VLOG_ERR("ioctl(SIOCSIFHWADDR) on %s device failed: %s",
4109                  netdev_name, strerror(errno));
4110         return errno;
4111     }
4112     return 0;
4113 }
4114
4115 static int
4116 netdev_linux_do_ethtool(const char *name, struct ethtool_cmd *ecmd,
4117                         int cmd, const char *cmd_name)
4118 {
4119     struct ifreq ifr;
4120
4121     memset(&ifr, 0, sizeof ifr);
4122     ovs_strzcpy(ifr.ifr_name, name, sizeof ifr.ifr_name);
4123     ifr.ifr_data = (caddr_t) ecmd;
4124
4125     ecmd->cmd = cmd;
4126     COVERAGE_INC(netdev_ethtool);
4127     if (ioctl(af_inet_sock, SIOCETHTOOL, &ifr) == 0) {
4128         return 0;
4129     } else {
4130         if (errno != EOPNOTSUPP) {
4131             VLOG_WARN_RL(&rl, "ethtool command %s on network device %s "
4132                          "failed: %s", cmd_name, name, strerror(errno));
4133         } else {
4134             /* The device doesn't support this operation.  That's pretty
4135              * common, so there's no point in logging anything. */
4136         }
4137         return errno;
4138     }
4139 }
4140
4141 static int
4142 netdev_linux_do_ioctl(const char *name, struct ifreq *ifr, int cmd,
4143                       const char *cmd_name)
4144 {
4145     ovs_strzcpy(ifr->ifr_name, name, sizeof ifr->ifr_name);
4146     if (ioctl(af_inet_sock, cmd, ifr) == -1) {
4147         VLOG_DBG_RL(&rl, "%s: ioctl(%s) failed: %s", name, cmd_name,
4148                      strerror(errno));
4149         return errno;
4150     }
4151     return 0;
4152 }
4153
4154 static int
4155 netdev_linux_get_ipv4(const struct netdev *netdev, struct in_addr *ip,
4156                       int cmd, const char *cmd_name)
4157 {
4158     struct ifreq ifr;
4159     int error;
4160
4161     ifr.ifr_addr.sa_family = AF_INET;
4162     error = netdev_linux_do_ioctl(netdev_get_name(netdev), &ifr, cmd, cmd_name);
4163     if (!error) {
4164         const struct sockaddr_in *sin = (struct sockaddr_in *) &ifr.ifr_addr;
4165         *ip = sin->sin_addr;
4166     }
4167     return error;
4168 }