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