tc/f_fw.c

   1 /*
   2  * f_fw.c               FW 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 #include <linux/if.h> /* IFNAMSIZ */
  23 #include "utils.h"
  24 #include "tc_util.h"
  25
  26 static void explain(void)
  27 {
  28         fprintf(stderr, "Usage: ... fw [ classid CLASSID ] [ police POLICE_SPEC ]\n");
  29         fprintf(stderr, "       POLICE_SPEC := ... look at TBF\n");
  30         fprintf(stderr, "       CLASSID := X:Y\n");
  31         fprintf(stderr, "\nNOTE: CLASSID is parsed as hexadecimal input.\n");
  32 }
  33
  34 #define usage() return(-1)
  35
  36 static int fw_parse_opt(struct filter_util *qu, char *handle, int argc, char **argv, struct nlmsghdr *n)
  37 {
  38         struct tc_police tp;
  39         struct tcmsg *t = NLMSG_DATA(n);
  40         struct rtattr *tail;
  41
  42         memset(&tp, 0, sizeof(tp));
  43
  44         tail = NLMSG_TAIL(n);
  45         addattr_l(n, 4096, TCA_OPTIONS, NULL, 0);
  46
  47         if (handle) {
  48                 char *slash;
  49                 __u32 mask = 0;
  50                 if ((slash = strchr(handle, '/')) != NULL)
  51                         *slash = '\0';
  52                 if (get_u32(&t->tcm_handle, handle, 0)) {
  53                         fprintf(stderr, "Illegal \"handle\"\n");
  54                         return -1;
  55                 }
  56                 if (slash) {
  57                         if (get_u32(&mask, slash+1, 0)) {
  58                                 fprintf(stderr, "Illegal \"handle\" mask\n");
  59                                 return -1;
  60                         }
  61                         addattr32(n, MAX_MSG, TCA_FW_MASK, mask);
  62                 }
  63         }
  64
  65         if (argc == 0)
  66                 return 0;
  67
  68         while (argc > 0) {
  69                 if (matches(*argv, "classid") == 0 ||
  70                     matches(*argv, "flowid") == 0) {
  71                         unsigned handle;
  72                         NEXT_ARG();
  73                         if (get_tc_classid(&handle, *argv)) {
  74                                 fprintf(stderr, "Illegal \"classid\"\n");
  75                                 return -1;
  76                         }
  77                         addattr_l(n, 4096, TCA_FW_CLASSID, &handle, 4);
  78                 } else if (matches(*argv, "police") == 0) {
  79                         NEXT_ARG();
  80                         if (parse_police(&argc, &argv, TCA_FW_POLICE, n)) {
  81                                 fprintf(stderr, "Illegal \"police\"\n");
  82                                 return -1;
  83                         }
  84                         continue;
  85                 } else if (matches(*argv, "action") == 0) {
  86                         NEXT_ARG();
  87                         if (parse_action(&argc, &argv, TCA_FW_ACT, n)) {
  88                                 fprintf(stderr, "Illegal fw \"action\"\n");
  89                                 return -1;
  90                         }
  91                         continue;
  92                 } else if (strcmp(*argv, "indev") == 0) {
  93                         char d[IFNAMSIZ+1];
  94                         memset(d, 0, sizeof (d));
  95                         argc--;
  96                         argv++;
  97                         if (argc < 1) {
  98                                 fprintf(stderr, "Illegal indev\n");
  99                                 return -1;
 100                         }
 101                         strncpy(d, *argv, sizeof (d) - 1);
 102                         addattr_l(n, MAX_MSG, TCA_FW_INDEV, d, strlen(d) + 1);
 103                 } else if (strcmp(*argv, "help") == 0) {
 104                         explain();
 105                         return -1;
 106                 } else {
 107                         fprintf(stderr, "What is \"%s\"?\n", *argv);
 108                         explain();
 109                         return -1;
 110                 }
 111                 argc--; argv++;
 112         }
 113         tail->rta_len = (void *) NLMSG_TAIL(n) - (void *) tail;
 114         return 0;
 115 }
 116
 117 static int fw_print_opt(struct filter_util *qu, FILE *f, struct rtattr *opt, __u32 handle)
 118 {
 119         struct rtattr *tb[TCA_FW_MAX+1];
 120
 121         if (opt == NULL)
 122                 return 0;
 123
 124         parse_rtattr_nested(tb, TCA_FW_MAX, opt);
 125
 126         if (handle || tb[TCA_FW_MASK]) {
 127                 __u32 mark = 0, mask = 0;
 128                 if(handle)
 129                         mark = handle;
 130                 if(tb[TCA_FW_MASK] &&
 131                     (mask = *(__u32*)RTA_DATA(tb[TCA_FW_MASK])) != 0xFFFFFFFF)
 132                         fprintf(f, "handle 0x%x/0x%x ", mark, mask);
 133                 else
 134                         fprintf(f, "handle 0x%x ", handle);
 135         }
 136
 137         if (tb[TCA_FW_CLASSID]) {
 138                 SPRINT_BUF(b1);
 139                 fprintf(f, "classid %s ", sprint_tc_classid(*(__u32*)RTA_DATA(tb[TCA_FW_CLASSID]), b1));
 140         }
 141
 142         if (tb[TCA_FW_POLICE])
 143                 tc_print_police(f, tb[TCA_FW_POLICE]);
 144         if (tb[TCA_FW_INDEV]) {
 145                 struct rtattr *idev = tb[TCA_FW_INDEV];
 146                 fprintf(f, "input dev %s ",(char *)RTA_DATA(idev));
 147         }
 148
 149         if (tb[TCA_FW_ACT]) {
 150                 fprintf(f, "\n");
 151                 tc_print_action(f, tb[TCA_FW_ACT]);
 152         }
 153         return 0;
 154 }
 155
 156 struct filter_util fw_filter_util = {
 157         .id = "fw",
 158         .parse_fopt = fw_parse_opt,
 159         .print_fopt = fw_print_opt,
 160 };