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