f_route.c revision c1027a759bb9e08ea5711ea8bc7f86ec49062951
1aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger/* 2aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger * f_route.c ROUTE filter. 3aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger * 4aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger * This program is free software; you can redistribute it and/or 5aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger * modify it under the terms of the GNU General Public License 6aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger * as published by the Free Software Foundation; either version 7aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger * 2 of the License, or (at your option) any later version. 8aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger * 9aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger * Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru> 10aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger * 11aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger */ 12aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 13aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <stdio.h> 14aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <stdlib.h> 15aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <unistd.h> 16aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <syslog.h> 17aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <fcntl.h> 18aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <sys/socket.h> 19aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <netinet/in.h> 20aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <arpa/inet.h> 21aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include <string.h> 22aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 23aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include "utils.h" 24aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include "rt_names.h" 25c1027a759bb9e08ea5711ea8bc7f86ec49062951site!shemminger#include "tc_common.h" 26aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#include "tc_util.h" 27aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 28aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemmingerstatic void explain(void) 29aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 30aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Usage: ... route [ from REALM | fromif TAG ] [ to REALM ]\n"); 31aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, " [ flowid CLASSID ] [ police POLICE_SPEC ]\n"); 32aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, " POLICE_SPEC := ... look at TBF\n"); 33aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, " CLASSID := X:Y\n"); 34aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 35aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 36aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger#define usage() return(-1) 37aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 38aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemmingerstatic int route_parse_opt(struct filter_util *qu, char *handle, int argc, char **argv, struct nlmsghdr *n) 39aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 40aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger struct tc_police tp; 41aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger struct tcmsg *t = NLMSG_DATA(n); 42aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger struct rtattr *tail; 43aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger __u32 fh = 0xFFFF8000; 44aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger __u32 order = 0; 45aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 46aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger memset(&tp, 0, sizeof(tp)); 47aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 48aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (handle) { 49aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (get_u32(&t->tcm_handle, handle, 0)) { 50aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Illegal \"handle\"\n"); 51aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 52aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 53aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 54aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 55aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (argc == 0) 56aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 57aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 58228569c3ff79468f4c7580fd88b0d6a34ebdc311n); tail = NLMSG_TAIL(n); 59aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addattr_l(n, 4096, TCA_OPTIONS, NULL, 0); 60aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 61aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger while (argc > 0) { 62aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (matches(*argv, "to") == 0) { 63aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger __u32 id; 64aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger NEXT_ARG(); 65aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (rtnl_rtrealm_a2n(&id, *argv)) { 66aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Illegal \"to\"\n"); 67aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 68aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 69aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addattr_l(n, 4096, TCA_ROUTE4_TO, &id, 4); 70aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fh &= ~0x80FF; 71aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fh |= id&0xFF; 72aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else if (matches(*argv, "from") == 0) { 73aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger __u32 id; 74aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger NEXT_ARG(); 75aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (rtnl_rtrealm_a2n(&id, *argv)) { 76aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Illegal \"from\"\n"); 77aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 78aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 79aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addattr_l(n, 4096, TCA_ROUTE4_FROM, &id, 4); 80aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fh &= 0xFFFF; 81aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fh |= id<<16; 82aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else if (matches(*argv, "fromif") == 0) { 83aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger __u32 id; 84aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger NEXT_ARG(); 85c1027a759bb9e08ea5711ea8bc7f86ec49062951site!shemminger ll_init_map(&rth); 86aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if ((id=ll_name_to_index(*argv)) <= 0) { 87aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Illegal \"fromif\"\n"); 88aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 89aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 90aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addattr_l(n, 4096, TCA_ROUTE4_IIF, &id, 4); 91aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fh &= 0xFFFF; 92aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fh |= (0x8000|id)<<16; 93aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else if (matches(*argv, "classid") == 0 || 94aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger strcmp(*argv, "flowid") == 0) { 95aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger unsigned handle; 96aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger NEXT_ARG(); 97aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (get_tc_classid(&handle, *argv)) { 98aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Illegal \"classid\"\n"); 99aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 100aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 101aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addattr_l(n, 4096, TCA_ROUTE4_CLASSID, &handle, 4); 102aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else if (matches(*argv, "police") == 0) { 103aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger NEXT_ARG(); 104aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (parse_police(&argc, &argv, TCA_ROUTE4_POLICE, n)) { 105aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Illegal \"police\"\n"); 106aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 107aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 108aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger continue; 109aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else if (matches(*argv, "order") == 0) { 110aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger NEXT_ARG(); 111aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (get_u32(&order, *argv, 0)) { 112aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Illegal \"order\"\n"); 113aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 114aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 115aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else if (strcmp(*argv, "help") == 0) { 116aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger explain(); 117aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 118aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else { 119aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "What is \"%s\"?\n", *argv); 120aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger explain(); 121aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 122aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 123aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger argc--; argv++; 124aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 125228569c3ff79468f4c7580fd88b0d6a34ebdc311void *) NLMSG_TAIL(n) - (void *) tail; tail->rta_len = (void *) NLMSG_TAIL(n) - (void *) tail; 126aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (order) { 127aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fh &= ~0x7F00; 128aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fh |= (order<<8)&0x7F00; 129aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 130aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (!t->tcm_handle) 131aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger t->tcm_handle = fh; 132aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 133aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 134aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 135aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemmingerstatic int route_print_opt(struct filter_util *qu, FILE *f, struct rtattr *opt, __u32 handle) 136aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 137aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger struct rtattr *tb[TCA_ROUTE4_MAX+1]; 138aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger SPRINT_BUF(b1); 139aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 140aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (opt == NULL) 141aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 142aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 1433b3ecd31c1e513f029ebbb83f2e808553de0a741tb, TCA_ROUTE parse_rtattr_nested(tb, TCA_ROUTE4_MAX, opt); 144aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 145aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (handle) 146aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(f, "fh 0x%08x ", handle); 147aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (handle&0x7F00) 148aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(f, "order %d ", (handle>>8)&0x7F); 149aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 150aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (tb[TCA_ROUTE4_CLASSID]) { 151aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger SPRINT_BUF(b1); 152aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(f, "flowid %s ", sprint_tc_classid(*(__u32*)RTA_DATA(tb[TCA_ROUTE4_CLASSID]), b1)); 153aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 154aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (tb[TCA_ROUTE4_TO]) 155aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(f, "to %s ", rtnl_rtrealm_n2a(*(__u32*)RTA_DATA(tb[TCA_ROUTE4_TO]), b1, sizeof(b1))); 156aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (tb[TCA_ROUTE4_FROM]) 157aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(f, "from %s ", rtnl_rtrealm_n2a(*(__u32*)RTA_DATA(tb[TCA_ROUTE4_FROM]), b1, sizeof(b1))); 158aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (tb[TCA_ROUTE4_IIF]) 159aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(f, "fromif %s", ll_index_to_name(*(int*)RTA_DATA(tb[TCA_ROUTE4_IIF]))); 160aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (tb[TCA_ROUTE4_POLICE]) 161aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger tc_print_police(f, tb[TCA_ROUTE4_POLICE]); 162aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 163aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 164aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 1656b7dff17f6f97ce80cd260920267aee68f15582bosdl.net!shemmingerstruct filter_util route_filter_util = { 1666b7dff17f6f97ce80cd260920267aee68f15582bosdl.net!shemminger .id = "route", 1676b7dff17f6f97ce80cd260920267aee68f15582bosdl.net!shemminger .parse_fopt = route_parse_opt, 1686b7dff17f6f97ce80cd260920267aee68f15582bosdl.net!shemminger .print_fopt = route_print_opt, 169aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger}; 170