tc/f_route.c

   1 /*
   2  * f_route.c            ROUTE filter.
   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  */
  12
  13 #include <stdio.h>
  14 #include <stdlib.h>
  15 #include <unistd.h>
  16 #include <syslog.h>
  17 #include <fcntl.h>
  18 #include <sys/socket.h>
  19 #include <netinet/in.h>
  20 #include <arpa/inet.h>
  21 #include <string.h>
  22
  23 #include "utils.h"
  24 #include "rt_names.h"
  25 #include "tc_common.h"
  26 #include "tc_util.h"
  27
  28 static void explain(void)
  29 {
  30         fprintf(stderr, "Usage: ... route [ from REALM | fromif TAG ] [ to REALM ]\n");
  31         fprintf(stderr, "                [ classid CLASSID ] [ action ACTION_SPEC ]\n");
  32         fprintf(stderr, "       ACTION_SPEC := ... look at individual actions\n");
  33         fprintf(stderr, "       CLASSID := X:Y\n");
  34         fprintf(stderr, "\nNOTE: CLASSID is parsed as hexadecimal input.\n");
  35 }
  36
  37 static int route_parse_opt(struct filter_util *qu, char *handle, int argc, char **argv, struct nlmsghdr *n)
  38 {
  39         struct tc_police tp;
  40         struct tcmsg *t = NLMSG_DATA(n);
  41         struct rtattr *tail;
  42         __u32 fh = 0xFFFF8000;
  43         __u32 order = 0;
  44
  45         memset(&tp, 0, sizeof(tp));
  46
  47         if (handle) {
  48                 if (get_u32(&t->tcm_handle, handle, 0)) {
  49                         fprintf(stderr, "Illegal \"handle\"\n");
  50                         return -1;
  51                 }
  52         }
  53
  54         if (argc == 0)
  55                 return 0;
  56
  57         tail = NLMSG_TAIL(n);
  58         addattr_l(n, 4096, TCA_OPTIONS, NULL, 0);
  59
  60         while (argc > 0) {
  61                 if (matches(*argv, "to") == 0) {
  62                         __u32 id;
  63                         NEXT_ARG();
  64                         if (rtnl_rtrealm_a2n(&id, *argv)) {
  65                                 fprintf(stderr, "Illegal \"to\"\n");
  66                                 return -1;
  67                         }
  68                         addattr_l(n, 4096, TCA_ROUTE4_TO, &id, 4);
  69                         fh &= ~0x80FF;
  70                         fh |= id&0xFF;
  71                 } else if (matches(*argv, "from") == 0) {
  72                         __u32 id;
  73                         NEXT_ARG();
  74                         if (rtnl_rtrealm_a2n(&id, *argv)) {
  75                                 fprintf(stderr, "Illegal \"from\"\n");
  76                                 return -1;
  77                         }
  78                         addattr_l(n, 4096, TCA_ROUTE4_FROM, &id, 4);
  79                         fh &= 0xFFFF;
  80                         fh |= id<<16;
  81                 } else if (matches(*argv, "fromif") == 0) {
  82                         __u32 id;
  83                         NEXT_ARG();
  84                         ll_init_map(&rth);
  85                         if ((id=ll_name_to_index(*argv)) <= 0) {
  86                                 fprintf(stderr, "Illegal \"fromif\"\n");
  87                                 return -1;
  88                         }
  89                         addattr_l(n, 4096, TCA_ROUTE4_IIF, &id, 4);
  90                         fh &= 0xFFFF;
  91                         fh |= (0x8000|id)<<16;
  92                 } else if (matches(*argv, "classid") == 0 ||
  93                            strcmp(*argv, "flowid") == 0) {
  94                         unsigned handle;
  95                         NEXT_ARG();
  96                         if (get_tc_classid(&handle, *argv)) {
  97                                 fprintf(stderr, "Illegal \"classid\"\n");
  98                                 return -1;
  99                         }
 100                         addattr_l(n, 4096, TCA_ROUTE4_CLASSID, &handle, 4);
 101                 } else if (matches(*argv, "police") == 0) {
 102                         NEXT_ARG();
 103                         if (parse_police(&argc, &argv, TCA_ROUTE4_POLICE, n)) {
 104                                 fprintf(stderr, "Illegal \"police\"\n");
 105                                 return -1;
 106                         }
 107                         continue;
 108                 } else if (matches(*argv, "action") == 0) {
 109                         NEXT_ARG();
 110                         if (parse_action(&argc, &argv, TCA_ROUTE4_ACT, n)) {
 111                                 fprintf(stderr, "Illegal \"action\"\n");
 112                                 return -1;
 113                         }
 114                         continue;
 115                 } else if (matches(*argv, "order") == 0) {
 116                         NEXT_ARG();
 117                         if (get_u32(&order, *argv, 0)) {
 118                                 fprintf(stderr, "Illegal \"order\"\n");
 119                                 return -1;
 120                         }
 121                 } else if (strcmp(*argv, "help") == 0) {
 122                         explain();
 123                         return -1;
 124                 } else {
 125                         fprintf(stderr, "What is \"%s\"?\n", *argv);
 126                         explain();
 127                         return -1;
 128                 }
 129                 argc--; argv++;
 130         }
 131         tail->rta_len = (void *) NLMSG_TAIL(n) - (void *) tail;
 132         if (order) {
 133                 fh &= ~0x7F00;
 134                 fh |= (order<<8)&0x7F00;
 135         }
 136         if (!t->tcm_handle)
 137                 t->tcm_handle = fh;
 138         return 0;
 139 }
 140
 141 static int route_print_opt(struct filter_util *qu, FILE *f, struct rtattr *opt, __u32 handle)
 142 {
 143         struct rtattr *tb[TCA_ROUTE4_MAX+1];
 144         SPRINT_BUF(b1);
 145
 146         if (opt == NULL)
 147                 return 0;
 148
 149         parse_rtattr_nested(tb, TCA_ROUTE4_MAX, opt);
 150
 151         if (handle)
 152                 fprintf(f, "fh 0x%08x ", handle);
 153         if (handle&0x7F00)
 154                 fprintf(f, "order %d ", (handle>>8)&0x7F);
 155
 156         if (tb[TCA_ROUTE4_CLASSID]) {
 157                 SPRINT_BUF(b1);
 158                 fprintf(f, "flowid %s ", sprint_tc_classid(rta_getattr_u32(tb[TCA_ROUTE4_CLASSID]), b1));
 159         }
 160         if (tb[TCA_ROUTE4_TO])
 161                 fprintf(f, "to %s ", rtnl_rtrealm_n2a(rta_getattr_u32(tb[TCA_ROUTE4_TO]), b1, sizeof(b1)));
 162         if (tb[TCA_ROUTE4_FROM])
 163                 fprintf(f, "from %s ", rtnl_rtrealm_n2a(rta_getattr_u32(tb[TCA_ROUTE4_FROM]), b1, sizeof(b1)));
 164         if (tb[TCA_ROUTE4_IIF])
 165                 fprintf(f, "fromif %s", ll_index_to_name(*(int*)RTA_DATA(tb[TCA_ROUTE4_IIF])));
 166         if (tb[TCA_ROUTE4_POLICE])
 167                 tc_print_police(f, tb[TCA_ROUTE4_POLICE]);
 168         if (tb[TCA_ROUTE4_ACT])
 169                 tc_print_action(f, tb[TCA_ROUTE4_ACT]);
 170         return 0;
 171 }
 172
 173 struct filter_util route_filter_util = {
 174         .id = "route",
 175         .parse_fopt = route_parse_opt,
 176         .print_fopt = route_print_opt,
 177 };