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"); 34e9acc2420c561a6f875d188de1028facbd09c5a8PJ Waskiewicz fprintf(stderr, "\nNOTE: CLASSID is parsed as hexadecimal input.\n"); 35aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 36aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 37aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemmingerstatic int route_parse_opt(struct filter_util *qu, char *handle, int argc, char **argv, struct nlmsghdr *n) 38aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 39aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger struct tc_police tp; 40aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger struct tcmsg *t = NLMSG_DATA(n); 41aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger struct rtattr *tail; 42aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger __u32 fh = 0xFFFF8000; 43aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger __u32 order = 0; 44aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 45aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger memset(&tp, 0, sizeof(tp)); 46aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 47aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (handle) { 48aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (get_u32(&t->tcm_handle, handle, 0)) { 49aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Illegal \"handle\"\n"); 50aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 51aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 52aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 53aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 54aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (argc == 0) 55aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 56aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 57228569c3ff79468f4c7580fd88b0d6a34ebdc311n); tail = NLMSG_TAIL(n); 58aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addattr_l(n, 4096, TCA_OPTIONS, NULL, 0); 59aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 60aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger while (argc > 0) { 61aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (matches(*argv, "to") == 0) { 62aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger __u32 id; 63aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger NEXT_ARG(); 64aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (rtnl_rtrealm_a2n(&id, *argv)) { 65aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Illegal \"to\"\n"); 66aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 67aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 68aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addattr_l(n, 4096, TCA_ROUTE4_TO, &id, 4); 69aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fh &= ~0x80FF; 70aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fh |= id&0xFF; 71aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else if (matches(*argv, "from") == 0) { 72aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger __u32 id; 73aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger NEXT_ARG(); 74aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (rtnl_rtrealm_a2n(&id, *argv)) { 75aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Illegal \"from\"\n"); 76aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 77aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 78aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addattr_l(n, 4096, TCA_ROUTE4_FROM, &id, 4); 79aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fh &= 0xFFFF; 80aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fh |= id<<16; 81aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else if (matches(*argv, "fromif") == 0) { 82aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger __u32 id; 83aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger NEXT_ARG(); 84c1027a759bb9e08ea5711ea8bc7f86ec49062951site!shemminger ll_init_map(&rth); 85aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if ((id=ll_name_to_index(*argv)) <= 0) { 86aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Illegal \"fromif\"\n"); 87aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 88aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 89aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addattr_l(n, 4096, TCA_ROUTE4_IIF, &id, 4); 90aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fh &= 0xFFFF; 91aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fh |= (0x8000|id)<<16; 92aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else if (matches(*argv, "classid") == 0 || 93aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger strcmp(*argv, "flowid") == 0) { 94aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger unsigned handle; 95aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger NEXT_ARG(); 96aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (get_tc_classid(&handle, *argv)) { 97aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Illegal \"classid\"\n"); 98aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 99aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 100aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger addattr_l(n, 4096, TCA_ROUTE4_CLASSID, &handle, 4); 101aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else if (matches(*argv, "police") == 0) { 102aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger NEXT_ARG(); 103aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (parse_police(&argc, &argv, TCA_ROUTE4_POLICE, n)) { 104aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Illegal \"police\"\n"); 105aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 106aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 107aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger continue; 108aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else if (matches(*argv, "order") == 0) { 109aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger NEXT_ARG(); 110aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (get_u32(&order, *argv, 0)) { 111aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "Illegal \"order\"\n"); 112aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 113aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 114aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else if (strcmp(*argv, "help") == 0) { 115aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger explain(); 116aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 117aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } else { 118aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(stderr, "What is \"%s\"?\n", *argv); 119aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger explain(); 120aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return -1; 121aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 122aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger argc--; argv++; 123aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 124228569c3ff79468f4c7580fd88b0d6a34ebdc311void *) NLMSG_TAIL(n) - (void *) tail; tail->rta_len = (void *) NLMSG_TAIL(n) - (void *) tail; 125aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (order) { 126aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fh &= ~0x7F00; 127aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fh |= (order<<8)&0x7F00; 128aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 129aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (!t->tcm_handle) 130aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger t->tcm_handle = fh; 131aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 132aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 133aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 134aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemmingerstatic int route_print_opt(struct filter_util *qu, FILE *f, struct rtattr *opt, __u32 handle) 135aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger{ 136aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger struct rtattr *tb[TCA_ROUTE4_MAX+1]; 137aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger SPRINT_BUF(b1); 138aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 139aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (opt == NULL) 140aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 141aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 1423b3ecd31c1e513f029ebbb83f2e808553de0a741tb, TCA_ROUTE parse_rtattr_nested(tb, TCA_ROUTE4_MAX, opt); 143aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 144aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (handle) 145aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(f, "fh 0x%08x ", handle); 146aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (handle&0x7F00) 147aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(f, "order %d ", (handle>>8)&0x7F); 148aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 149aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (tb[TCA_ROUTE4_CLASSID]) { 150aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger SPRINT_BUF(b1); 151ff24746cca1ef0c92d46614158e6672acd6b63d3Stephen Hemminger fprintf(f, "flowid %s ", sprint_tc_classid(rta_getattr_u32(tb[TCA_ROUTE4_CLASSID]), b1)); 152aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger } 153aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (tb[TCA_ROUTE4_TO]) 154ff24746cca1ef0c92d46614158e6672acd6b63d3Stephen Hemminger fprintf(f, "to %s ", rtnl_rtrealm_n2a(rta_getattr_u32(tb[TCA_ROUTE4_TO]), b1, sizeof(b1))); 155aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (tb[TCA_ROUTE4_FROM]) 156ff24746cca1ef0c92d46614158e6672acd6b63d3Stephen Hemminger fprintf(f, "from %s ", rtnl_rtrealm_n2a(rta_getattr_u32(tb[TCA_ROUTE4_FROM]), b1, sizeof(b1))); 157aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (tb[TCA_ROUTE4_IIF]) 158aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger fprintf(f, "fromif %s", ll_index_to_name(*(int*)RTA_DATA(tb[TCA_ROUTE4_IIF]))); 159aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger if (tb[TCA_ROUTE4_POLICE]) 160aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger tc_print_police(f, tb[TCA_ROUTE4_POLICE]); 161aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger return 0; 162aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger} 163aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger 1646b7dff17f6f97ce80cd260920267aee68f15582bosdl.net!shemmingerstruct filter_util route_filter_util = { 1656b7dff17f6f97ce80cd260920267aee68f15582bosdl.net!shemminger .id = "route", 1666b7dff17f6f97ce80cd260920267aee68f15582bosdl.net!shemminger .parse_fopt = route_parse_opt, 1676b7dff17f6f97ce80cd260920267aee68f15582bosdl.net!shemminger .print_fopt = route_print_opt, 168aba5acdfdb347d2c21fc67d613d83d4430ca3937osdl.org!shemminger}; 169