busybox/networking/vconfig.c

/* vi: set sw=4 ts=4: */
/*
 * vconfig implementation for busybox
 *
 * Copyright (C) 2001  Manuel Novoa III  <mjn3@codepoet.org>
 *
 * Licensed under GPLv2 or later, see file LICENSE in this tarball for details.
 */

/* BB_AUDIT SUSv3 N/A */

#include "libbb.h"
#include <net/if.h>

/* Stuff from linux/if_vlan.h, kernel version 2.4.23 */
enum vlan_ioctl_cmds {
	ADD_VLAN_CMD,
	DEL_VLAN_CMD,
	SET_VLAN_INGRESS_PRIORITY_CMD,
	SET_VLAN_EGRESS_PRIORITY_CMD,
	GET_VLAN_INGRESS_PRIORITY_CMD,
	GET_VLAN_EGRESS_PRIORITY_CMD,
	SET_VLAN_NAME_TYPE_CMD,
	SET_VLAN_FLAG_CMD
};
enum vlan_name_types {
	VLAN_NAME_TYPE_PLUS_VID, /* Name will look like:  vlan0005 */
	VLAN_NAME_TYPE_RAW_PLUS_VID, /* name will look like:  eth1.0005 */
	VLAN_NAME_TYPE_PLUS_VID_NO_PAD, /* Name will look like:  vlan5 */
	VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD, /* Name will look like:  eth0.5 */
	VLAN_NAME_TYPE_HIGHEST
};

struct vlan_ioctl_args {
	int cmd; /* Should be one of the vlan_ioctl_cmds enum above. */
	char device1[24];

	union {
		char device2[24];
		int VID;
		unsigned int skb_priority;
		unsigned int name_type;
		unsigned int bind_type;
		unsigned int flag; /* Matches vlan_dev_info flags */
	} u;

	short vlan_qos;
};

#define VLAN_GROUP_ARRAY_LEN 4096
#define SIOCSIFVLAN	0x8983		/* Set 802.1Q VLAN options */

/* On entry, table points to the length of the current string
 * plus NUL terminator plus data length for the subsequent entry.
 * The return value is the last data entry for the matching string. */
static const char *xfind_str(const char *table, const char *str)
{
	while (strcasecmp(str, table+1) != 0) {
		table += table[0];
		if (!*table) {
			bb_show_usage();
		}
	}
	return table - 1;
}

static const char cmds[] ALIGN1 = {
	4, ADD_VLAN_CMD, 7,
	'a', 'd', 'd', 0,
	3, DEL_VLAN_CMD, 7,
	'r', 'e', 'm', 0,
	3, SET_VLAN_NAME_TYPE_CMD, 17,
	's', 'e', 't', '_',
	'n', 'a', 'm', 'e', '_',
	't', 'y', 'p', 'e', 0,
	5, SET_VLAN_FLAG_CMD, 12,
	's', 'e', 't', '_',
	'f', 'l', 'a', 'g', 0,
	5, SET_VLAN_EGRESS_PRIORITY_CMD, 18,
	's', 'e', 't', '_',
	'e', 'g', 'r', 'e', 's', 's', '_',
	'm', 'a', 'p', 0,
	5, SET_VLAN_INGRESS_PRIORITY_CMD, 16,
	's', 'e', 't', '_',
	'i', 'n', 'g', 'r', 'e', 's', 's', '_',
	'm', 'a', 'p', 0,
};

static const char name_types[] ALIGN1 = {
	VLAN_NAME_TYPE_PLUS_VID, 16,
	'V', 'L', 'A', 'N',
	'_', 'P', 'L', 'U', 'S', '_', 'V', 'I', 'D',
	0,
	VLAN_NAME_TYPE_PLUS_VID_NO_PAD, 22,
	'V', 'L', 'A', 'N',
	'_', 'P', 'L', 'U', 'S', '_', 'V', 'I', 'D',
	'_', 'N', 'O', '_', 'P', 'A', 'D', 0,
	VLAN_NAME_TYPE_RAW_PLUS_VID, 15,
	'D', 'E', 'V',
	'_', 'P', 'L', 'U', 'S', '_', 'V', 'I', 'D',
	0,
	VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD, 20,
	'D', 'E', 'V',
	'_', 'P', 'L', 'U', 'S', '_', 'V', 'I', 'D',
	'_', 'N', 'O', '_', 'P', 'A', 'D', 0,
};

static const char conf_file_name[] ALIGN1 = "/proc/net/vlan/config";

int vconfig_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE;
int vconfig_main(int argc, char **argv)
{
	struct vlan_ioctl_args ifr;
	const char *p;
	int fd;

	if (argc < 3) {
		bb_show_usage();
	}

	/* Don't bother closing the filedes.  It will be closed on cleanup. */
	/* Will die if 802.1q is not present */
	xopen(conf_file_name, O_RDONLY);

	memset(&ifr, 0, sizeof(ifr));

	++argv;
	p = xfind_str(cmds+2, *argv);
	ifr.cmd = *p;
	if (argc != p[-1]) {
		bb_show_usage();
	}

	if (ifr.cmd == SET_VLAN_NAME_TYPE_CMD) { /* set_name_type */
		ifr.u.name_type = *xfind_str(name_types+1, argv[1]);
	} else {
		strncpy_IFNAMSIZ(ifr.device1, argv[1]);
		p = argv[2];

		/* I suppose one could try to combine some of the function calls below,
		 * since ifr.u.flag, ifr.u.VID, and ifr.u.skb_priority are all same-sized
		 * (unsigned) int members of a unions.  But because of the range checking,
		 * doing so wouldn't save that much space and would also make maintainence
		 * more of a pain. */
		if (ifr.cmd == SET_VLAN_FLAG_CMD) { /* set_flag */
			ifr.u.flag = xatoul_range(p, 0, 1);
			/* DM: in order to set reorder header, qos must be set */
			ifr.vlan_qos = xatoul_range(argv[3], 0, 7);
		} else if (ifr.cmd == ADD_VLAN_CMD) { /* add */
			ifr.u.VID = xatoul_range(p, 0, VLAN_GROUP_ARRAY_LEN-1);
		} else if (ifr.cmd != DEL_VLAN_CMD) { /* set_{egress|ingress}_map */
			ifr.u.skb_priority = xatou(p);
			ifr.vlan_qos = xatoul_range(argv[3], 0, 7);
		}
	}

	fd = xsocket(AF_INET, SOCK_STREAM, 0);
	ioctl_or_perror_and_die(fd, SIOCSIFVLAN, &ifr,
						"ioctl error for %s", *argv);

	return 0;
}
1	niro	532	/* vi: set sw=4 ts=4: */
2			/*
3			* vconfig implementation for busybox
4			*
5			* Copyright (C) 2001 Manuel Novoa III <mjn3@codepoet.org>
6			*
7			* Licensed under GPLv2 or later, see file LICENSE in this tarball for details.
8			*/
9
10			/* BB_AUDIT SUSv3 N/A */
11
12	niro	816	#include "libbb.h"
13	niro	532	#include <net/if.h>
14
15			/* Stuff from linux/if_vlan.h, kernel version 2.4.23 */
16			enum vlan_ioctl_cmds {
17			ADD_VLAN_CMD,
18			DEL_VLAN_CMD,
19			SET_VLAN_INGRESS_PRIORITY_CMD,
20			SET_VLAN_EGRESS_PRIORITY_CMD,
21			GET_VLAN_INGRESS_PRIORITY_CMD,
22			GET_VLAN_EGRESS_PRIORITY_CMD,
23			SET_VLAN_NAME_TYPE_CMD,
24			SET_VLAN_FLAG_CMD
25			};
26			enum vlan_name_types {
27			VLAN_NAME_TYPE_PLUS_VID, /* Name will look like: vlan0005 */
28			VLAN_NAME_TYPE_RAW_PLUS_VID, /* name will look like: eth1.0005 */
29			VLAN_NAME_TYPE_PLUS_VID_NO_PAD, /* Name will look like: vlan5 */
30			VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD, /* Name will look like: eth0.5 */
31			VLAN_NAME_TYPE_HIGHEST
32			};
33
34			struct vlan_ioctl_args {
35			int cmd; /* Should be one of the vlan_ioctl_cmds enum above. */
36			char device1[24];
37
38			union {
39			char device2[24];
40			int VID;
41			unsigned int skb_priority;
42			unsigned int name_type;
43			unsigned int bind_type;
44			unsigned int flag; /* Matches vlan_dev_info flags */
45			} u;
46
47			short vlan_qos;
48			};
49
50			#define VLAN_GROUP_ARRAY_LEN 4096
51			#define SIOCSIFVLAN 0x8983 /* Set 802.1Q VLAN options */
52
53	niro	984	/* On entry, table points to the length of the current string
54			* plus NUL terminator plus data length for the subsequent entry.
55			* The return value is the last data entry for the matching string. */
56	niro	532	static const char xfind_str(const char table, const char *str)
57			{
58			while (strcasecmp(str, table+1) != 0) {
59	niro	984	table += table[0];
60			if (!*table) {
61	niro	532	bb_show_usage();
62			}
63			}
64			return table - 1;
65			}
66
67	niro	816	static const char cmds[] ALIGN1 = {
68	niro	532	4, ADD_VLAN_CMD, 7,
69			'a', 'd', 'd', 0,
70			3, DEL_VLAN_CMD, 7,
71			'r', 'e', 'm', 0,
72			3, SET_VLAN_NAME_TYPE_CMD, 17,
73			's', 'e', 't', '_',
74			'n', 'a', 'm', 'e', '_',
75			't', 'y', 'p', 'e', 0,
76			5, SET_VLAN_FLAG_CMD, 12,
77			's', 'e', 't', '_',
78			'f', 'l', 'a', 'g', 0,
79			5, SET_VLAN_EGRESS_PRIORITY_CMD, 18,
80			's', 'e', 't', '_',
81			'e', 'g', 'r', 'e', 's', 's', '_',
82			'm', 'a', 'p', 0,
83			5, SET_VLAN_INGRESS_PRIORITY_CMD, 16,
84			's', 'e', 't', '_',
85			'i', 'n', 'g', 'r', 'e', 's', 's', '_',
86			'm', 'a', 'p', 0,
87			};
88
89	niro	816	static const char name_types[] ALIGN1 = {
90	niro	532	VLAN_NAME_TYPE_PLUS_VID, 16,
91			'V', 'L', 'A', 'N',
92			'_', 'P', 'L', 'U', 'S', '_', 'V', 'I', 'D',
93			0,
94			VLAN_NAME_TYPE_PLUS_VID_NO_PAD, 22,
95			'V', 'L', 'A', 'N',
96			'_', 'P', 'L', 'U', 'S', '_', 'V', 'I', 'D',
97			'_', 'N', 'O', '_', 'P', 'A', 'D', 0,
98			VLAN_NAME_TYPE_RAW_PLUS_VID, 15,
99			'D', 'E', 'V',
100			'_', 'P', 'L', 'U', 'S', '_', 'V', 'I', 'D',
101			0,
102			VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD, 20,
103			'D', 'E', 'V',
104			'_', 'P', 'L', 'U', 'S', '_', 'V', 'I', 'D',
105			'_', 'N', 'O', '_', 'P', 'A', 'D', 0,
106			};
107
108	niro	816	static const char conf_file_name[] ALIGN1 = "/proc/net/vlan/config";
109	niro	532
110	niro	816	int vconfig_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE;
111	niro	532	int vconfig_main(int argc, char **argv)
112			{
113			struct vlan_ioctl_args ifr;
114			const char *p;
115			int fd;
116
117			if (argc < 3) {
118			bb_show_usage();
119			}
120
121			/* Don't bother closing the filedes. It will be closed on cleanup. */
122			/* Will die if 802.1q is not present */
123			xopen(conf_file_name, O_RDONLY);
124
125	niro	984	memset(&ifr, 0, sizeof(ifr));
126	niro	532
127			++argv;
128			p = xfind_str(cmds+2, *argv);
129			ifr.cmd = *p;
130			if (argc != p[-1]) {
131			bb_show_usage();
132			}
133
134			if (ifr.cmd == SET_VLAN_NAME_TYPE_CMD) { /* set_name_type */
135			ifr.u.name_type = *xfind_str(name_types+1, argv[1]);
136			} else {
137	niro	984	strncpy_IFNAMSIZ(ifr.device1, argv[1]);
138	niro	532	p = argv[2];
139
140			/* I suppose one could try to combine some of the function calls below,
141			* since ifr.u.flag, ifr.u.VID, and ifr.u.skb_priority are all same-sized
142			* (unsigned) int members of a unions. But because of the range checking,
143			* doing so wouldn't save that much space and would also make maintainence
144			* more of a pain. */
145			if (ifr.cmd == SET_VLAN_FLAG_CMD) { /* set_flag */
146			ifr.u.flag = xatoul_range(p, 0, 1);
147			/* DM: in order to set reorder header, qos must be set */
148			ifr.vlan_qos = xatoul_range(argv[3], 0, 7);
149			} else if (ifr.cmd == ADD_VLAN_CMD) { /* add */
150			ifr.u.VID = xatoul_range(p, 0, VLAN_GROUP_ARRAY_LEN-1);
151			} else if (ifr.cmd != DEL_VLAN_CMD) { /* set_{egress\|ingress}_map */
152			ifr.u.skb_priority = xatou(p);
153			ifr.vlan_qos = xatoul_range(argv[3], 0, 7);
154			}
155			}
156
157			fd = xsocket(AF_INET, SOCK_STREAM, 0);
158	niro	816	ioctl_or_perror_and_die(fd, SIOCSIFVLAN, &ifr,
159			"ioctl error for %s", *argv);
160	niro	532
161			return 0;
162			}