busybox/networking/brctl.c

/* vi: set sw=4 ts=4: */
/*
 * Small implementation of brctl for busybox.
 *
 * Copyright (C) 2008 by Bernhard Reutner-Fischer
 *
 * Some helper functions from bridge-utils are
 * Copyright (C) 2000 Lennert Buytenhek
 *
 * Licensed under GPLv2 or later, see file LICENSE in this tarball for details.
 */
/* This applet currently uses only the ioctl interface and no sysfs at all.
 * At the time of this writing this was considered a feature.
 */
#include "libbb.h"
#include <linux/sockios.h>
#include <net/if.h>

#ifndef SIOCBRADDBR
# define SIOCBRADDBR BRCTL_ADD_BRIDGE
#endif
#ifndef SIOCBRDELBR
# define SIOCBRDELBR BRCTL_DEL_BRIDGE
#endif
#ifndef SIOCBRADDIF
# define SIOCBRADDIF BRCTL_ADD_IF
#endif
#ifndef SIOCBRDELIF
# define SIOCBRDELIF BRCTL_DEL_IF
#endif


/* Maximum number of ports supported per bridge interface.  */
#ifndef MAX_PORTS
#define MAX_PORTS 32
#endif

/* Use internal number parsing and not the "exact" conversion.  */
/* #define BRCTL_USE_INTERNAL 0 */ /* use exact conversion */
#define BRCTL_USE_INTERNAL 1

#if ENABLE_FEATURE_BRCTL_FANCY
#include <linux/if_bridge.h>

/* FIXME: These 4 funcs are not really clean and could be improved */
static ALWAYS_INLINE void strtotimeval(struct timeval *tv,
		const char *time_str)
{
	double secs;
#if BRCTL_USE_INTERNAL
	secs = /*bb_*/strtod(time_str, NULL);
	if (!secs)
#else
	if (sscanf(time_str, "%lf", &secs) != 1)
#endif
		bb_error_msg_and_die (bb_msg_invalid_arg, time_str, "timespec");
	tv->tv_sec = secs;
	tv->tv_usec = 1000000 * (secs - tv->tv_sec);
}

static ALWAYS_INLINE unsigned long __tv_to_jiffies(const struct timeval *tv)
{
	unsigned long long jif;

	jif = 1000000ULL * tv->tv_sec + tv->tv_usec;

	return jif/10000;
}
# if 0
static void __jiffies_to_tv(struct timeval *tv, unsigned long jiffies)
{
	unsigned long long tvusec;

	tvusec = 10000ULL*jiffies;
	tv->tv_sec = tvusec/1000000;
	tv->tv_usec = tvusec - 1000000 * tv->tv_sec;
}
# endif
static unsigned long str_to_jiffies(const char *time_str)
{
	struct timeval tv;
	strtotimeval(&tv, time_str);
	return __tv_to_jiffies(&tv);
}

static void arm_ioctl(unsigned long *args,
		unsigned long arg0, unsigned long arg1, unsigned long arg2)
{
	args[0] = arg0;
	args[1] = arg1;
	args[2] = arg2;
	args[3] = 0;
}
#endif


int brctl_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE;
int brctl_main(int argc UNUSED_PARAM, char **argv)
{
	static const char keywords[] ALIGN1 =
		"addbr\0" "delbr\0" "addif\0" "delif\0"
	IF_FEATURE_BRCTL_FANCY(
		"stp\0"
		"setageing\0" "setfd\0" "sethello\0" "setmaxage\0"
		"setpathcost\0" "setportprio\0" "setbridgeprio\0"
	)
	IF_FEATURE_BRCTL_SHOW("showmacs\0" "show\0");

	enum { ARG_addbr = 0, ARG_delbr, ARG_addif, ARG_delif
		IF_FEATURE_BRCTL_FANCY(,
		   ARG_stp,
		   ARG_setageing, ARG_setfd, ARG_sethello, ARG_setmaxage,
		   ARG_setpathcost, ARG_setportprio, ARG_setbridgeprio
		)
		IF_FEATURE_BRCTL_SHOW(, ARG_showmacs, ARG_show)
	};

	int fd;
	smallint key;
	struct ifreq ifr;
	char *br, *brif;

	argv++;
	while (*argv) {
#if ENABLE_FEATURE_BRCTL_FANCY
		int ifidx[MAX_PORTS];
		unsigned long args[4];
		ifr.ifr_data = (char *) &args;
#endif

		key = index_in_strings(keywords, *argv);
		if (key == -1) /* no match found in keywords array, bail out. */
			bb_error_msg_and_die(bb_msg_invalid_arg, *argv, applet_name);
		argv++;
		fd = xsocket(AF_INET, SOCK_STREAM, 0);

#if ENABLE_FEATURE_BRCTL_SHOW
		if (key == ARG_show) { /* show */
			char brname[IFNAMSIZ];
			int bridx[MAX_PORTS];
			int i, num;
			arm_ioctl(args, BRCTL_GET_BRIDGES,
						(unsigned long) bridx, MAX_PORTS);
			num = xioctl(fd, SIOCGIFBR, args);
			printf("bridge name\tbridge id\t\tSTP enabled\tinterfaces\n");
			for (i = 0; i < num; i++) {
				char ifname[IFNAMSIZ];
				int j, tabs;
				struct __bridge_info bi;
				unsigned char *x;

				if (!if_indextoname(bridx[i], brname))
					bb_perror_msg_and_die("can't get bridge name for index %d", i);
				strncpy_IFNAMSIZ(ifr.ifr_name, brname);

				arm_ioctl(args, BRCTL_GET_BRIDGE_INFO,
							(unsigned long) &bi, 0);
				xioctl(fd, SIOCDEVPRIVATE, &ifr);
				printf("%s\t\t", brname);

				/* print bridge id */
				x = (unsigned char *) &bi.bridge_id;
				for (j = 0; j < 8; j++) {
					printf("%.2x", x[j]);
					if (j == 1)
						bb_putchar('.');
				}
				printf(bi.stp_enabled ? "\tyes" : "\tno");

				/* print interface list */
				arm_ioctl(args, BRCTL_GET_PORT_LIST,
							(unsigned long) ifidx, MAX_PORTS);
				xioctl(fd, SIOCDEVPRIVATE, &ifr);
				tabs = 0;
				for (j = 0; j < MAX_PORTS; j++) {
					if (!ifidx[j])
						continue;
					if (!if_indextoname(ifidx[j], ifname))
						bb_perror_msg_and_die("can't get interface name for index %d", j);
					if (tabs)
						printf("\t\t\t\t\t");
					else
						tabs = 1;
					printf("\t\t%s\n", ifname);
				}
				if (!tabs)	/* bridge has no interfaces */
					bb_putchar('\n');
			}
			goto done;
		}
#endif

		if (!*argv) /* all but 'show' need at least one argument */
			bb_show_usage();

		br = *argv++;

		if (key == ARG_addbr || key == ARG_delbr) { /* addbr or delbr */
			ioctl_or_perror_and_die(fd,
					key == ARG_addbr ? SIOCBRADDBR : SIOCBRDELBR,
					br, "bridge %s", br);
			goto done;
		}

		if (!*argv) /* all but 'addif/delif' need at least two arguments */
			bb_show_usage();

		strncpy_IFNAMSIZ(ifr.ifr_name, br);
		if (key == ARG_addif || key == ARG_delif) { /* addif or delif */
			brif = *argv;
			ifr.ifr_ifindex = if_nametoindex(brif);
			if (!ifr.ifr_ifindex) {
				bb_perror_msg_and_die("iface %s", brif);
			}
			ioctl_or_perror_and_die(fd,
					key == ARG_addif ? SIOCBRADDIF : SIOCBRDELIF,
					&ifr, "bridge %s", br);
			goto done_next_argv;
		}
#if ENABLE_FEATURE_BRCTL_FANCY
		if (key == ARG_stp) { /* stp */
			/* FIXME: parsing yes/y/on/1 versus no/n/off/0 is too involved */
			arm_ioctl(args, BRCTL_SET_BRIDGE_STP_STATE,
					  (unsigned)(**argv - '0'), 0);
			goto fire;
		}
		if ((unsigned)(key - ARG_setageing) < 4) { /* time related ops */
			static const uint8_t ops[] ALIGN1 = {
				BRCTL_SET_AGEING_TIME,          /* ARG_setageing */
				BRCTL_SET_BRIDGE_FORWARD_DELAY, /* ARG_setfd     */
				BRCTL_SET_BRIDGE_HELLO_TIME,    /* ARG_sethello  */
				BRCTL_SET_BRIDGE_MAX_AGE        /* ARG_setmaxage */
			};
			arm_ioctl(args, ops[key - ARG_setageing], str_to_jiffies(*argv), 0);
			goto fire;
		}
		if (key == ARG_setpathcost
		 || key == ARG_setportprio
		 || key == ARG_setbridgeprio
		) {
			static const uint8_t ops[] ALIGN1 = {
				BRCTL_SET_PATH_COST,      /* ARG_setpathcost   */
				BRCTL_SET_PORT_PRIORITY,  /* ARG_setportprio   */
				BRCTL_SET_BRIDGE_PRIORITY /* ARG_setbridgeprio */
			};
			int port = -1;
			unsigned arg1, arg2;

			if (key != ARG_setbridgeprio) {
				/* get portnum */
				unsigned i;

				port = if_nametoindex(*argv++);
				if (!port)
					bb_error_msg_and_die(bb_msg_invalid_arg, *argv, "port");
				memset(ifidx, 0, sizeof ifidx);
				arm_ioctl(args, BRCTL_GET_PORT_LIST, (unsigned long)ifidx,
						  MAX_PORTS);
				xioctl(fd, SIOCDEVPRIVATE, &ifr);
				for (i = 0; i < MAX_PORTS; i++) {
					if (ifidx[i] == port) {
						port = i;
						break;
					}
				}
			}
			arg1 = port;
			arg2 = xatoi_u(*argv);
			if (key == ARG_setbridgeprio) {
				arg1 = arg2;
				arg2 = 0;
			}
			arm_ioctl(args, ops[key - ARG_setpathcost], arg1, arg2);
		}
 fire:
		/* Execute the previously set command */
		xioctl(fd, SIOCDEVPRIVATE, &ifr);
#endif
 done_next_argv:
		argv++;
 done:
		close(fd);
	}

	return EXIT_SUCCESS;
}
1	/* vi: set sw=4 ts=4: */
2	/*
3	* Small implementation of brctl for busybox.
4	*
5	* Copyright (C) 2008 by Bernhard Reutner-Fischer
6	*
7	* Some helper functions from bridge-utils are
8	* Copyright (C) 2000 Lennert Buytenhek
9	*
10	* Licensed under GPLv2 or later, see file LICENSE in this tarball for details.
11	*/
12	/* This applet currently uses only the ioctl interface and no sysfs at all.
13	* At the time of this writing this was considered a feature.
14	*/
15	#include "libbb.h"
16	#include <linux/sockios.h>
17	#include <net/if.h>
18
19	#ifndef SIOCBRADDBR
20	# define SIOCBRADDBR BRCTL_ADD_BRIDGE
21	#endif
22	#ifndef SIOCBRDELBR
23	# define SIOCBRDELBR BRCTL_DEL_BRIDGE
24	#endif
25	#ifndef SIOCBRADDIF
26	# define SIOCBRADDIF BRCTL_ADD_IF
27	#endif
28	#ifndef SIOCBRDELIF
29	# define SIOCBRDELIF BRCTL_DEL_IF
30	#endif
31
32
33	/* Maximum number of ports supported per bridge interface. */
34	#ifndef MAX_PORTS
35	#define MAX_PORTS 32
36	#endif
37
38	/* Use internal number parsing and not the "exact" conversion. */
39	/* #define BRCTL_USE_INTERNAL 0 / / use exact conversion */
40	#define BRCTL_USE_INTERNAL 1
41
42	#if ENABLE_FEATURE_BRCTL_FANCY
43	#include <linux/if_bridge.h>
44
45	/* FIXME: These 4 funcs are not really clean and could be improved */
46	static ALWAYS_INLINE void strtotimeval(struct timeval *tv,
47	const char *time_str)
48	{
49	double secs;
50	#if BRCTL_USE_INTERNAL
51	secs = /bb_/strtod(time_str, NULL);
52	if (!secs)
53	#else
54	if (sscanf(time_str, "%lf", &secs) != 1)
55	#endif
56	bb_error_msg_and_die (bb_msg_invalid_arg, time_str, "timespec");
57	tv->tv_sec = secs;
58	tv->tv_usec = 1000000 * (secs - tv->tv_sec);
59	}
60
61	static ALWAYS_INLINE unsigned long __tv_to_jiffies(const struct timeval *tv)
62	{
63	unsigned long long jif;
64
65	jif = 1000000ULL * tv->tv_sec + tv->tv_usec;
66
67	return jif/10000;
68	}
69	# if 0
70	static void __jiffies_to_tv(struct timeval *tv, unsigned long jiffies)
71	{
72	unsigned long long tvusec;
73
74	tvusec = 10000ULL*jiffies;
75	tv->tv_sec = tvusec/1000000;
76	tv->tv_usec = tvusec - 1000000 * tv->tv_sec;
77	}
78	# endif
79	static unsigned long str_to_jiffies(const char *time_str)
80	{
81	struct timeval tv;
82	strtotimeval(&tv, time_str);
83	return __tv_to_jiffies(&tv);
84	}
85
86	static void arm_ioctl(unsigned long *args,
87	unsigned long arg0, unsigned long arg1, unsigned long arg2)
88	{
89	args[0] = arg0;
90	args[1] = arg1;
91	args[2] = arg2;
92	args[3] = 0;
93	}
94	#endif
95
96
97	int brctl_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE;
98	int brctl_main(int argc UNUSED_PARAM, char **argv)
99	{
100	static const char keywords[] ALIGN1 =
101	"addbr\0" "delbr\0" "addif\0" "delif\0"
102	IF_FEATURE_BRCTL_FANCY(
103	"stp\0"
104	"setageing\0" "setfd\0" "sethello\0" "setmaxage\0"
105	"setpathcost\0" "setportprio\0" "setbridgeprio\0"
106	)
107	IF_FEATURE_BRCTL_SHOW("showmacs\0" "show\0");
108
109	enum { ARG_addbr = 0, ARG_delbr, ARG_addif, ARG_delif
110	IF_FEATURE_BRCTL_FANCY(,
111	ARG_stp,
112	ARG_setageing, ARG_setfd, ARG_sethello, ARG_setmaxage,
113	ARG_setpathcost, ARG_setportprio, ARG_setbridgeprio
114	)
115	IF_FEATURE_BRCTL_SHOW(, ARG_showmacs, ARG_show)
116	};
117
118	int fd;
119	smallint key;
120	struct ifreq ifr;
121	char br, brif;
122
123	argv++;
124	while (*argv) {
125	#if ENABLE_FEATURE_BRCTL_FANCY
126	int ifidx[MAX_PORTS];
127	unsigned long args[4];
128	ifr.ifr_data = (char *) &args;
129	#endif
130
131	key = index_in_strings(keywords, *argv);
132	if (key == -1) /* no match found in keywords array, bail out. */
133	bb_error_msg_and_die(bb_msg_invalid_arg, *argv, applet_name);
134	argv++;
135	fd = xsocket(AF_INET, SOCK_STREAM, 0);
136
137	#if ENABLE_FEATURE_BRCTL_SHOW
138	if (key == ARG_show) { /* show */
139	char brname[IFNAMSIZ];
140	int bridx[MAX_PORTS];
141	int i, num;
142	arm_ioctl(args, BRCTL_GET_BRIDGES,
143	(unsigned long) bridx, MAX_PORTS);
144	num = xioctl(fd, SIOCGIFBR, args);
145	printf("bridge name\tbridge id\t\tSTP enabled\tinterfaces\n");
146	for (i = 0; i < num; i++) {
147	char ifname[IFNAMSIZ];
148	int j, tabs;
149	struct __bridge_info bi;
150	unsigned char *x;
151
152	if (!if_indextoname(bridx[i], brname))
153	bb_perror_msg_and_die("can't get bridge name for index %d", i);
154	strncpy_IFNAMSIZ(ifr.ifr_name, brname);
155
156	arm_ioctl(args, BRCTL_GET_BRIDGE_INFO,
157	(unsigned long) &bi, 0);
158	xioctl(fd, SIOCDEVPRIVATE, &ifr);
159	printf("%s\t\t", brname);
160
161	/* print bridge id */
162	x = (unsigned char *) &bi.bridge_id;
163	for (j = 0; j < 8; j++) {
164	printf("%.2x", x[j]);
165	if (j == 1)
166	bb_putchar('.');
167	}
168	printf(bi.stp_enabled ? "\tyes" : "\tno");
169
170	/* print interface list */
171	arm_ioctl(args, BRCTL_GET_PORT_LIST,
172	(unsigned long) ifidx, MAX_PORTS);
173	xioctl(fd, SIOCDEVPRIVATE, &ifr);
174	tabs = 0;
175	for (j = 0; j < MAX_PORTS; j++) {
176	if (!ifidx[j])
177	continue;
178	if (!if_indextoname(ifidx[j], ifname))
179	bb_perror_msg_and_die("can't get interface name for index %d", j);
180	if (tabs)
181	printf("\t\t\t\t\t");
182	else
183	tabs = 1;
184	printf("\t\t%s\n", ifname);
185	}
186	if (!tabs) /* bridge has no interfaces */
187	bb_putchar('\n');
188	}
189	goto done;
190	}
191	#endif
192
193	if (!argv) / all but 'show' need at least one argument */
194	bb_show_usage();
195
196	br = *argv++;
197
198	if (key == ARG_addbr \|\| key == ARG_delbr) { /* addbr or delbr */
199	ioctl_or_perror_and_die(fd,
200	key == ARG_addbr ? SIOCBRADDBR : SIOCBRDELBR,
201	br, "bridge %s", br);
202	goto done;
203	}
204
205	if (!argv) / all but 'addif/delif' need at least two arguments */
206	bb_show_usage();
207
208	strncpy_IFNAMSIZ(ifr.ifr_name, br);
209	if (key == ARG_addif \|\| key == ARG_delif) { /* addif or delif */
210	brif = *argv;
211	ifr.ifr_ifindex = if_nametoindex(brif);
212	if (!ifr.ifr_ifindex) {
213	bb_perror_msg_and_die("iface %s", brif);
214	}
215	ioctl_or_perror_and_die(fd,
216	key == ARG_addif ? SIOCBRADDIF : SIOCBRDELIF,
217	&ifr, "bridge %s", br);
218	goto done_next_argv;
219	}
220	#if ENABLE_FEATURE_BRCTL_FANCY
221	if (key == ARG_stp) { /* stp */
222	/* FIXME: parsing yes/y/on/1 versus no/n/off/0 is too involved */
223	arm_ioctl(args, BRCTL_SET_BRIDGE_STP_STATE,
224	(unsigned)(**argv - '0'), 0);
225	goto fire;
226	}
227	if ((unsigned)(key - ARG_setageing) < 4) { /* time related ops */
228	static const uint8_t ops[] ALIGN1 = {
229	BRCTL_SET_AGEING_TIME, /* ARG_setageing */
230	BRCTL_SET_BRIDGE_FORWARD_DELAY, /* ARG_setfd */
231	BRCTL_SET_BRIDGE_HELLO_TIME, /* ARG_sethello */
232	BRCTL_SET_BRIDGE_MAX_AGE /* ARG_setmaxage */
233	};
234	arm_ioctl(args, ops[key - ARG_setageing], str_to_jiffies(*argv), 0);
235	goto fire;
236	}
237	if (key == ARG_setpathcost
238	\|\| key == ARG_setportprio
239	\|\| key == ARG_setbridgeprio
240	) {
241	static const uint8_t ops[] ALIGN1 = {
242	BRCTL_SET_PATH_COST, /* ARG_setpathcost */
243	BRCTL_SET_PORT_PRIORITY, /* ARG_setportprio */
244	BRCTL_SET_BRIDGE_PRIORITY /* ARG_setbridgeprio */
245	};
246	int port = -1;
247	unsigned arg1, arg2;
248
249	if (key != ARG_setbridgeprio) {
250	/* get portnum */
251	unsigned i;
252
253	port = if_nametoindex(*argv++);
254	if (!port)
255	bb_error_msg_and_die(bb_msg_invalid_arg, *argv, "port");
256	memset(ifidx, 0, sizeof ifidx);
257	arm_ioctl(args, BRCTL_GET_PORT_LIST, (unsigned long)ifidx,
258	MAX_PORTS);
259	xioctl(fd, SIOCDEVPRIVATE, &ifr);
260	for (i = 0; i < MAX_PORTS; i++) {
261	if (ifidx[i] == port) {
262	port = i;
263	break;
264	}
265	}
266	}
267	arg1 = port;
268	arg2 = xatoi_u(*argv);
269	if (key == ARG_setbridgeprio) {
270	arg1 = arg2;
271	arg2 = 0;
272	}
273	arm_ioctl(args, ops[key - ARG_setpathcost], arg1, arg2);
274	}
275	fire:
276	/* Execute the previously set command */
277	xioctl(fd, SIOCDEVPRIVATE, &ifr);
278	#endif
279	done_next_argv:
280	argv++;
281	done:
282	close(fd);
283	}
284
285	return EXIT_SUCCESS;
286	}