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_util.h" 26 27static void explain(void) 28{ 29 fprintf(stderr, "Usage: ... route [ from REALM | fromif TAG ] [ to REALM ]\n"); 30 fprintf(stderr, " [ flowid CLASSID ] [ police POLICE_SPEC ]\n"); 31 fprintf(stderr, " POLICE_SPEC := ... look at TBF\n"); 32 fprintf(stderr, " CLASSID := X:Y\n"); 33} 34 35#define usage() return(-1) 36 37static 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 = (struct rtattr*)(((void*)n)+NLMSG_ALIGN(n->nlmsg_len)); 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 struct rtnl_handle rth; 83 __u32 id; 84 NEXT_ARG(); 85 if (rtnl_open(&rth, 0) == 0) { 86 ll_init_map(&rth); 87 rtnl_close(&rth); 88 } 89 if ((id=ll_name_to_index(*argv)) <= 0) { 90 fprintf(stderr, "Illegal \"fromif\"\n"); 91 return -1; 92 } 93 addattr_l(n, 4096, TCA_ROUTE4_IIF, &id, 4); 94 fh &= 0xFFFF; 95 fh |= (0x8000|id)<<16; 96 } else if (matches(*argv, "classid") == 0 || 97 strcmp(*argv, "flowid") == 0) { 98 unsigned handle; 99 NEXT_ARG(); 100 if (get_tc_classid(&handle, *argv)) { 101 fprintf(stderr, "Illegal \"classid\"\n"); 102 return -1; 103 } 104 addattr_l(n, 4096, TCA_ROUTE4_CLASSID, &handle, 4); 105 } else if (matches(*argv, "police") == 0) { 106 NEXT_ARG(); 107 if (parse_police(&argc, &argv, TCA_ROUTE4_POLICE, n)) { 108 fprintf(stderr, "Illegal \"police\"\n"); 109 return -1; 110 } 111 continue; 112 } else if (matches(*argv, "order") == 0) { 113 NEXT_ARG(); 114 if (get_u32(&order, *argv, 0)) { 115 fprintf(stderr, "Illegal \"order\"\n"); 116 return -1; 117 } 118 } else if (strcmp(*argv, "help") == 0) { 119 explain(); 120 return -1; 121 } else { 122 fprintf(stderr, "What is \"%s\"?\n", *argv); 123 explain(); 124 return -1; 125 } 126 argc--; argv++; 127 } 128 tail->rta_len = (((void*)n)+n->nlmsg_len) - (void*)tail; 129 if (order) { 130 fh &= ~0x7F00; 131 fh |= (order<<8)&0x7F00; 132 } 133 if (!t->tcm_handle) 134 t->tcm_handle = fh; 135 return 0; 136} 137 138static int route_print_opt(struct filter_util *qu, FILE *f, struct rtattr *opt, __u32 handle) 139{ 140 struct rtattr *tb[TCA_ROUTE4_MAX+1]; 141 SPRINT_BUF(b1); 142 143 if (opt == NULL) 144 return 0; 145 146 memset(tb, 0, sizeof(tb)); 147 if (opt) 148 parse_rtattr(tb, TCA_ROUTE4_MAX, RTA_DATA(opt), RTA_PAYLOAD(opt)); 149 150 if (handle) 151 fprintf(f, "fh 0x%08x ", handle); 152 if (handle&0x7F00) 153 fprintf(f, "order %d ", (handle>>8)&0x7F); 154 155 if (tb[TCA_ROUTE4_CLASSID]) { 156 SPRINT_BUF(b1); 157 fprintf(f, "flowid %s ", sprint_tc_classid(*(__u32*)RTA_DATA(tb[TCA_ROUTE4_CLASSID]), b1)); 158 } 159 if (tb[TCA_ROUTE4_TO]) 160 fprintf(f, "to %s ", rtnl_rtrealm_n2a(*(__u32*)RTA_DATA(tb[TCA_ROUTE4_TO]), b1, sizeof(b1))); 161 if (tb[TCA_ROUTE4_FROM]) 162 fprintf(f, "from %s ", rtnl_rtrealm_n2a(*(__u32*)RTA_DATA(tb[TCA_ROUTE4_FROM]), b1, sizeof(b1))); 163 if (tb[TCA_ROUTE4_IIF]) 164 fprintf(f, "fromif %s", ll_index_to_name(*(int*)RTA_DATA(tb[TCA_ROUTE4_IIF]))); 165 if (tb[TCA_ROUTE4_POLICE]) 166 tc_print_police(f, tb[TCA_ROUTE4_POLICE]); 167 return 0; 168} 169 170struct filter_util route_util = { 171 NULL, 172 "route", 173 route_parse_opt, 174 route_print_opt, 175}; 176