tc/tc.c

   1 /*
   2  * tc.c         "tc" utility frontend.
   3  *
   4  *              This program is free software; you can redistribute it and/or
   5  *              modify it under the terms of the GNU General Public License
   6  *              as published by the Free Software Foundation; either version
   7  *              2 of the License, or (at your option) any later version.
   8  *
   9  * Authors:     Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
  10  *
  11  * Fixes:
  12  *
  13  * Petri Mattila <petri@prihateam.fi> 990308: wrong memset's resulted in faults
  14  */
  15
  16 #include <stdio.h>
  17 #include <stdlib.h>
  18 #include <unistd.h>
  19 #include <fcntl.h>
  20 #include <dlfcn.h>
  21 #include <sys/socket.h>
  22 #include <netinet/in.h>
  23 #include <arpa/inet.h>
  24 #include <string.h>
  25 #include <errno.h>
  26
  27 #include "SNAPSHOT.h"
  28 #include "utils.h"
  29 #include "tc_util.h"
  30 #include "tc_common.h"
  31 #include "namespace.h"
  32
  33 int show_stats;
  34 int show_details;
  35 int show_raw;
  36 int show_graph;
  37 int timestamp;
  38
  39 int batch_mode;
  40 int use_iec;
  41 int force;
  42 bool use_names;
  43 int json;
  44 int color;
  45 int oneline;
  46 const char *_SL_;
  47
  48 static char *conf_file;
  49
  50 struct rtnl_handle rth;
  51
  52 static void *BODY;      /* cached handle dlopen(NULL) */
  53 static struct qdisc_util *qdisc_list;
  54 static struct filter_util *filter_list;
  55
  56 static int print_noqopt(struct qdisc_util *qu, FILE *f,
  57                         struct rtattr *opt)
  58 {
  59         if (opt && RTA_PAYLOAD(opt))
  60                 fprintf(f, "[Unknown qdisc, optlen=%u] ",
  61                         (unsigned int) RTA_PAYLOAD(opt));
  62         return 0;
  63 }
  64
  65 static int parse_noqopt(struct qdisc_util *qu, int argc, char **argv,
  66                         struct nlmsghdr *n, const char *dev)
  67 {
  68         if (argc) {
  69                 fprintf(stderr,
  70                         "Unknown qdisc \"%s\", hence option \"%s\" is unparsable\n",
  71                         qu->id, *argv);
  72                 return -1;
  73         }
  74         return 0;
  75 }
  76
  77 static int print_nofopt(struct filter_util *qu, FILE *f, struct rtattr *opt, __u32 fhandle)
  78 {
  79         if (opt && RTA_PAYLOAD(opt))
  80                 fprintf(f, "fh %08x [Unknown filter, optlen=%u] ",
  81                         fhandle, (unsigned int) RTA_PAYLOAD(opt));
  82         else if (fhandle)
  83                 fprintf(f, "fh %08x ", fhandle);
  84         return 0;
  85 }
  86
  87 static int parse_nofopt(struct filter_util *qu, char *fhandle,
  88                         int argc, char **argv, struct nlmsghdr *n)
  89 {
  90         __u32 handle;
  91
  92         if (argc) {
  93                 fprintf(stderr,
  94                         "Unknown filter \"%s\", hence option \"%s\" is unparsable\n",
  95                         qu->id, *argv);
  96                 return -1;
  97         }
  98         if (fhandle) {
  99                 struct tcmsg *t = NLMSG_DATA(n);
 100
 101                 if (get_u32(&handle, fhandle, 16)) {
 102                         fprintf(stderr, "Unparsable filter ID \"%s\"\n", fhandle);
 103                         return -1;
 104                 }
 105                 t->tcm_handle = handle;
 106         }
 107         return 0;
 108 }
 109
 110 struct qdisc_util *get_qdisc_kind(const char *str)
 111 {
 112         void *dlh;
 113         char buf[256];
 114         struct qdisc_util *q;
 115
 116         for (q = qdisc_list; q; q = q->next)
 117                 if (strcmp(q->id, str) == 0)
 118                         return q;
 119
 120         snprintf(buf, sizeof(buf), "%s/q_%s.so", get_tc_lib(), str);
 121         dlh = dlopen(buf, RTLD_LAZY);
 122         if (!dlh) {
 123                 /* look in current binary, only open once */
 124                 dlh = BODY;
 125                 if (dlh == NULL) {
 126                         dlh = BODY = dlopen(NULL, RTLD_LAZY);
 127                         if (dlh == NULL)
 128                                 goto noexist;
 129                 }
 130         }
 131
 132         snprintf(buf, sizeof(buf), "%s_qdisc_util", str);
 133         q = dlsym(dlh, buf);
 134         if (q == NULL)
 135                 goto noexist;
 136
 137 reg:
 138         q->next = qdisc_list;
 139         qdisc_list = q;
 140         return q;
 141
 142 noexist:
 143         q = calloc(1, sizeof(*q));
 144         if (q) {
 145                 q->id = strdup(str);
 146                 q->parse_qopt = parse_noqopt;
 147                 q->print_qopt = print_noqopt;
 148                 goto reg;
 149         }
 150         return q;
 151 }
 152
 153
 154 struct filter_util *get_filter_kind(const char *str)
 155 {
 156         void *dlh;
 157         char buf[256];
 158         struct filter_util *q;
 159
 160         for (q = filter_list; q; q = q->next)
 161                 if (strcmp(q->id, str) == 0)
 162                         return q;
 163
 164         snprintf(buf, sizeof(buf), "%s/f_%s.so", get_tc_lib(), str);
 165         dlh = dlopen(buf, RTLD_LAZY);
 166         if (dlh == NULL) {
 167                 dlh = BODY;
 168                 if (dlh == NULL) {
 169                         dlh = BODY = dlopen(NULL, RTLD_LAZY);
 170                         if (dlh == NULL)
 171                                 goto noexist;
 172                 }
 173         }
 174
 175         snprintf(buf, sizeof(buf), "%s_filter_util", str);
 176         q = dlsym(dlh, buf);
 177         if (q == NULL)
 178                 goto noexist;
 179
 180 reg:
 181         q->next = filter_list;
 182         filter_list = q;
 183         return q;
 184 noexist:
 185         q = calloc(1, sizeof(*q));
 186         if (q) {
 187                 strncpy(q->id, str, 15);
 188                 q->parse_fopt = parse_nofopt;
 189                 q->print_fopt = print_nofopt;
 190                 goto reg;
 191         }
 192         return q;
 193 }
 194
 195 static void usage(void)
 196 {
 197         fprintf(stderr,
 198                 "Usage: tc [ OPTIONS ] OBJECT { COMMAND | help }\n"
 199                 "       tc [-force] -batch filename\n"
 200                 "where  OBJECT := { qdisc | class | filter | action | monitor | exec }\n"
 201                 "       OPTIONS := { -V[ersion] | -s[tatistics] | -d[etails] | -r[aw] |\n"
 202                 "                    -o[neline] | -j[son] | -p[retty] | -c[olor]\n"
 203                 "                    -b[atch] [filename] | -n[etns] name |\n"
 204                 "                    -nm | -nam[es] | { -cf | -conf } path }\n");
 205 }
 206
 207 static int do_cmd(int argc, char **argv, void *buf, size_t buflen)
 208 {
 209         if (matches(*argv, "qdisc") == 0)
 210                 return do_qdisc(argc-1, argv+1);
 211         if (matches(*argv, "class") == 0)
 212                 return do_class(argc-1, argv+1);
 213         if (matches(*argv, "filter") == 0)
 214                 return do_filter(argc-1, argv+1, buf, buflen);
 215         if (matches(*argv, "actions") == 0)
 216                 return do_action(argc-1, argv+1, buf, buflen);
 217         if (matches(*argv, "monitor") == 0)
 218                 return do_tcmonitor(argc-1, argv+1);
 219         if (matches(*argv, "exec") == 0)
 220                 return do_exec(argc-1, argv+1);
 221         if (matches(*argv, "help") == 0) {
 222                 usage();
 223                 return 0;
 224         }
 225
 226         fprintf(stderr, "Object \"%s\" is unknown, try \"tc help\".\n",
 227                 *argv);
 228         return -1;
 229 }
 230
 231 #define TC_MAX_SUBC     10
 232 static bool batchsize_enabled(int argc, char *argv[])
 233 {
 234         struct {
 235                 char *c;
 236                 char *subc[TC_MAX_SUBC];
 237         } table[] = {
 238                 { "filter", { "add", "delete", "change", "replace", NULL} },
 239                 { "actions", { "add", "change", "replace", NULL} },
 240                 { NULL },
 241         }, *iter;
 242         char *s;
 243         int i;
 244
 245         if (argc < 2)
 246                 return false;
 247
 248         for (iter = table; iter->c; iter++) {
 249                 if (matches(argv[0], iter->c))
 250                         continue;
 251                 for (i = 0; i < TC_MAX_SUBC; i++) {
 252                         s = iter->subc[i];
 253                         if (s && matches(argv[1], s) == 0)
 254                                 return true;
 255                 }
 256         }
 257
 258         return false;
 259 }
 260
 261 struct batch_buf {
 262         struct batch_buf        *next;
 263         char                    buf[16420];     /* sizeof (struct nlmsghdr) +
 264                                                    max(sizeof (struct tcmsg) +
 265                                                    sizeof (struct tcamsg)) +
 266                                                    MAX_MSG */
 267 };
 268
 269 static struct batch_buf *get_batch_buf(struct batch_buf **pool,
 270                                        struct batch_buf **head,
 271                                        struct batch_buf **tail)
 272 {
 273         struct batch_buf *buf;
 274
 275         if (*pool == NULL)
 276                 buf = calloc(1, sizeof(struct batch_buf));
 277         else {
 278                 buf = *pool;
 279                 *pool = (*pool)->next;
 280                 memset(buf, 0, sizeof(struct batch_buf));
 281         }
 282
 283         if (*head == NULL)
 284                 *head = *tail = buf;
 285         else {
 286                 (*tail)->next = buf;
 287                 (*tail) = buf;
 288         }
 289
 290         return buf;
 291 }
 292
 293 static void put_batch_bufs(struct batch_buf **pool,
 294                            struct batch_buf **head,
 295                            struct batch_buf **tail)
 296 {
 297         if (*head == NULL || *tail == NULL)
 298                 return;
 299
 300         if (*pool == NULL)
 301                 *pool = *head;
 302         else {
 303                 (*tail)->next = *pool;
 304                 *pool = *head;
 305         }
 306         *head = NULL;
 307         *tail = NULL;
 308 }
 309
 310 static void free_batch_bufs(struct batch_buf **pool)
 311 {
 312         struct batch_buf *buf;
 313
 314         for (buf = *pool; buf != NULL; buf = *pool) {
 315                 *pool = buf->next;
 316                 free(buf);
 317         }
 318         *pool = NULL;
 319 }
 320
 321 static int batch(const char *name)
 322 {
 323         struct batch_buf *head = NULL, *tail = NULL, *buf_pool = NULL;
 324         char *largv[100], *largv_next[100];
 325         char *line, *line_next = NULL;
 326         bool bs_enabled_next = false;
 327         bool bs_enabled = false;
 328         bool lastline = false;
 329         int largc, largc_next;
 330         bool bs_enabled_saved;
 331         int batchsize = 0;
 332         size_t len = 0;
 333         int ret = 0;
 334         int err;
 335         bool send;
 336
 337         batch_mode = 1;
 338         if (name && strcmp(name, "-") != 0) {
 339                 if (freopen(name, "r", stdin) == NULL) {
 340                         fprintf(stderr,
 341                                 "Cannot open file \"%s\" for reading: %s\n",
 342                                 name, strerror(errno));
 343                         return -1;
 344                 }
 345         }
 346
 347         tc_core_init();
 348
 349         if (rtnl_open(&rth, 0) < 0) {
 350                 fprintf(stderr, "Cannot open rtnetlink\n");
 351                 return -1;
 352         }
 353
 354         cmdlineno = 0;
 355         if (getcmdline(&line, &len, stdin) == -1)
 356                 goto Exit;
 357         largc = makeargs(line, largv, 100);
 358         bs_enabled = batchsize_enabled(largc, largv);
 359         bs_enabled_saved = bs_enabled;
 360         do {
 361                 if (getcmdline(&line_next, &len, stdin) == -1)
 362                         lastline = true;
 363
 364                 largc_next = makeargs(line_next, largv_next, 100);
 365                 bs_enabled_next = batchsize_enabled(largc_next, largv_next);
 366                 if (bs_enabled) {
 367                         struct batch_buf *buf;
 368
 369                         buf = get_batch_buf(&buf_pool, &head, &tail);
 370                         if (!buf) {
 371                                 fprintf(stderr,
 372                                         "failed to allocate batch_buf\n");
 373                                 return -1;
 374                         }
 375                         ++batchsize;
 376                 }
 377
 378                 /*
 379                  * In batch mode, if we haven't accumulated enough commands
 380                  * and this is not the last command and this command & next
 381                  * command both support the batchsize feature, don't send the
 382                  * message immediately.
 383                  */
 384                 if (!lastline && bs_enabled && bs_enabled_next
 385                     && batchsize != MSG_IOV_MAX)
 386                         send = false;
 387                 else
 388                         send = true;
 389
 390                 line = line_next;
 391                 line_next = NULL;
 392                 len = 0;
 393                 bs_enabled_saved = bs_enabled;
 394                 bs_enabled = bs_enabled_next;
 395                 bs_enabled_next = false;
 396
 397                 if (largc == 0) {
 398                         largc = largc_next;
 399                         memcpy(largv, largv_next, largc * sizeof(char *));
 400                         continue;       /* blank line */
 401                 }
 402
 403                 err = do_cmd(largc, largv, tail == NULL ? NULL : tail->buf,
 404                              tail == NULL ? 0 : sizeof(tail->buf));
 405                 fflush(stdout);
 406                 if (err != 0) {
 407                         fprintf(stderr, "Command failed %s:%d\n", name,
 408                                 cmdlineno - 1);
 409                         ret = 1;
 410                         if (!force)
 411                                 break;
 412                 }
 413                 largc = largc_next;
 414                 memcpy(largv, largv_next, largc * sizeof(char *));
 415
 416                 if (send && bs_enabled_saved) {
 417                         struct iovec *iov, *iovs;
 418                         struct batch_buf *buf;
 419                         struct nlmsghdr *n;
 420
 421                         iov = iovs = malloc(batchsize * sizeof(struct iovec));
 422                         for (buf = head; buf != NULL; buf = buf->next, ++iov) {
 423                                 n = (struct nlmsghdr *)&buf->buf;
 424                                 iov->iov_base = n;
 425                                 iov->iov_len = n->nlmsg_len;
 426                         }
 427
 428                         err = rtnl_talk_iov(&rth, iovs, batchsize, NULL);
 429                         put_batch_bufs(&buf_pool, &head, &tail);
 430                         free(iovs);
 431                         if (err < 0) {
 432                                 fprintf(stderr, "Command failed %s:%d\n", name,
 433                                         cmdlineno - (batchsize + err) - 1);
 434                                 ret = 1;
 435                                 if (!force)
 436                                         break;
 437                         }
 438                         batchsize = 0;
 439                 }
 440         } while (!lastline);
 441
 442         free_batch_bufs(&buf_pool);
 443 Exit:
 444         free(line);
 445         rtnl_close(&rth);
 446
 447         return ret;
 448 }
 449
 450
 451 int main(int argc, char **argv)
 452 {
 453         int ret;
 454         char *batch_file = NULL;
 455
 456         while (argc > 1) {
 457                 if (argv[1][0] != '-')
 458                         break;
 459                 if (matches(argv[1], "-stats") == 0 ||
 460                          matches(argv[1], "-statistics") == 0) {
 461                         ++show_stats;
 462                 } else if (matches(argv[1], "-details") == 0) {
 463                         ++show_details;
 464                 } else if (matches(argv[1], "-raw") == 0) {
 465                         ++show_raw;
 466                 } else if (matches(argv[1], "-pretty") == 0) {
 467                         ++pretty;
 468                 } else if (matches(argv[1], "-graph") == 0) {
 469                         show_graph = 1;
 470                 } else if (matches(argv[1], "-Version") == 0) {
 471                         printf("tc utility, iproute2-ss%s\n", SNAPSHOT);
 472                         return 0;
 473                 } else if (matches(argv[1], "-iec") == 0) {
 474                         ++use_iec;
 475                 } else if (matches(argv[1], "-help") == 0) {
 476                         usage();
 477                         return 0;
 478                 } else if (matches(argv[1], "-force") == 0) {
 479                         ++force;
 480                 } else if (matches(argv[1], "-batch") == 0) {
 481                         argc--; argv++;
 482                         if (argc <= 1)
 483                                 usage();
 484                         batch_file = argv[1];
 485                 } else if (matches(argv[1], "-netns") == 0) {
 486                         NEXT_ARG();
 487                         if (netns_switch(argv[1]))
 488                                 return -1;
 489                 } else if (matches(argv[1], "-names") == 0 ||
 490                                 matches(argv[1], "-nm") == 0) {
 491                         use_names = true;
 492                 } else if (matches(argv[1], "-cf") == 0 ||
 493                                 matches(argv[1], "-conf") == 0) {
 494                         NEXT_ARG();
 495                         conf_file = argv[1];
 496                 } else if (matches(argv[1], "-color") == 0) {
 497                         ++color;
 498                 } else if (matches(argv[1], "-timestamp") == 0) {
 499                         timestamp++;
 500                 } else if (matches(argv[1], "-tshort") == 0) {
 501                         ++timestamp;
 502                         ++timestamp_short;
 503                 } else if (matches(argv[1], "-json") == 0) {
 504                         ++json;
 505                 } else if (matches(argv[1], "-oneline") == 0) {
 506                         ++oneline;
 507                 } else {
 508                         fprintf(stderr,
 509                                 "Option \"%s\" is unknown, try \"tc -help\".\n",
 510                                 argv[1]);
 511                         return -1;
 512                 }
 513                 argc--; argv++;
 514         }
 515
 516         _SL_ = oneline ? "\\" : "\n";
 517
 518         if (color & !json)
 519                 enable_color();
 520
 521         if (batch_file)
 522                 return batch(batch_file);
 523
 524         if (argc <= 1) {
 525                 usage();
 526                 return 0;
 527         }
 528
 529         tc_core_init();
 530         if (rtnl_open(&rth, 0) < 0) {
 531                 fprintf(stderr, "Cannot open rtnetlink\n");
 532                 exit(1);
 533         }
 534
 535         if (use_names && cls_names_init(conf_file)) {
 536                 ret = -1;
 537                 goto Exit;
 538         }
 539
 540         ret = do_cmd(argc-1, argv+1, NULL, 0);
 541 Exit:
 542         rtnl_close(&rth);
 543
 544         if (use_names)
 545                 cls_names_uninit();
 546
 547         return ret;
 548 }