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