Manousaridis Angelos writes:
[oweals/busybox.git] / networking / vconfig.c
1 /* 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  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License as published by
9  * the Free Software Foundation; either version 2 of the License, or
10  * (at your option) any later version.
11  *
12  * This program is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15  * General Public License for more details.
16  *
17  * You should have received a copy of the GNU General Public License
18  * along with this program; if not, write to the Free Software
19  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
20  *
21  */
22
23 /* BB_AUDIT SUSv3 N/A */
24
25 #include <stdlib.h>
26 #include <unistd.h>
27 #include <fcntl.h>
28 #include <sys/ioctl.h>
29 #include <net/if.h>
30 #include <string.h>
31 #include <limits.h>
32 #include "busybox.h"
33
34 /* Stuff from linux/if_vlan.h, kernel version 2.4.23 */
35 enum vlan_ioctl_cmds {
36         ADD_VLAN_CMD,
37         DEL_VLAN_CMD,
38         SET_VLAN_INGRESS_PRIORITY_CMD,
39         SET_VLAN_EGRESS_PRIORITY_CMD,
40         GET_VLAN_INGRESS_PRIORITY_CMD,
41         GET_VLAN_EGRESS_PRIORITY_CMD,
42         SET_VLAN_NAME_TYPE_CMD,
43         SET_VLAN_FLAG_CMD
44 };
45 enum vlan_name_types {
46         VLAN_NAME_TYPE_PLUS_VID, /* Name will look like:  vlan0005 */
47         VLAN_NAME_TYPE_RAW_PLUS_VID, /* name will look like:  eth1.0005 */
48         VLAN_NAME_TYPE_PLUS_VID_NO_PAD, /* Name will look like:  vlan5 */
49         VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD, /* Name will look like:  eth0.5 */
50         VLAN_NAME_TYPE_HIGHEST
51 };
52
53 struct vlan_ioctl_args {
54         int cmd; /* Should be one of the vlan_ioctl_cmds enum above. */
55         char device1[24];
56
57         union {
58                 char device2[24];
59                 int VID;
60                 unsigned int skb_priority;
61                 unsigned int name_type;
62                 unsigned int bind_type;
63                 unsigned int flag; /* Matches vlan_dev_info flags */
64         } u;
65
66         short vlan_qos;   
67 };
68
69 #define VLAN_GROUP_ARRAY_LEN 4096
70 #define SIOCSIFVLAN     0x8983          /* Set 802.1Q VLAN options      */
71
72 /* On entry, table points to the length of the current string plus
73  * nul terminator plus data length for the subsequent entry.  The
74  * return value is the last data entry for the matching string. */
75 static const char *xfind_str(const char *table, const char *str)
76 {
77         while (strcasecmp(str, table+1) != 0) {
78                 if (!*(table += table[0])) {
79                         bb_show_usage();
80                 }
81         }
82         return table - 1;
83 }
84
85 static const char cmds[] = {
86         4, ADD_VLAN_CMD, 7,
87         'a', 'd', 'd', 0,
88         3, DEL_VLAN_CMD, 7,
89         'r', 'e', 'm', 0,
90         3, SET_VLAN_NAME_TYPE_CMD, 17,
91         's', 'e', 't', '_',
92         'n', 'a', 'm', 'e', '_',
93         't', 'y', 'p', 'e', 0,
94         4, SET_VLAN_FLAG_CMD, 12,
95         's', 'e', 't', '_',
96         'f', 'l', 'a', 'g', 0,
97         5, SET_VLAN_EGRESS_PRIORITY_CMD, 18,
98         's', 'e', 't', '_',
99         'e', 'g', 'r', 'e', 's', 's', '_',
100         'm', 'a', 'p', 0,
101         5, SET_VLAN_INGRESS_PRIORITY_CMD, 16,
102         's', 'e', 't', '_',
103         'i', 'n', 'g', 'r', 'e', 's', 's', '_',
104         'm', 'a', 'p', 0,
105 };
106
107 static const char name_types[] = {
108         VLAN_NAME_TYPE_PLUS_VID, 16,
109         'V', 'L', 'A', 'N',
110         '_', 'P', 'L', 'U', 'S', '_', 'V', 'I', 'D',
111         0,
112         VLAN_NAME_TYPE_PLUS_VID_NO_PAD, 22,
113         'V', 'L', 'A', 'N', 
114         '_', 'P', 'L', 'U', 'S', '_', 'V', 'I', 'D',
115         '_', 'N', 'O', '_', 'P', 'A', 'D', 0,
116         VLAN_NAME_TYPE_RAW_PLUS_VID, 15,
117         'D', 'E', 'V',
118         '_', 'P', 'L', 'U', 'S', '_', 'V', 'I', 'D',
119         0,
120         VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD, 20,
121         'D', 'E', 'V',
122         '_', 'P', 'L', 'U', 'S', '_', 'V', 'I', 'D',
123         '_', 'N', 'O', '_', 'P', 'A', 'D', 0,
124 };
125
126 static const char conf_file_name[] = "/proc/net/vlan/config";
127
128 int vconfig_main(int argc, char **argv)
129 {
130         struct vlan_ioctl_args ifr;
131         const char *p;
132         int fd;
133
134         if (argc < 3) {
135                 bb_show_usage();
136         }
137
138         /* Don't bother closing the filedes.  It will be closed on cleanup. */
139         if (open(conf_file_name, O_RDONLY) < 0) { /* Is 802.1q is present? */
140             bb_perror_msg_and_die("open %s", conf_file_name);
141         }
142
143         memset(&ifr, 0, sizeof(struct vlan_ioctl_args));
144
145         ++argv;
146         p = xfind_str(cmds+2, *argv);
147         ifr.cmd = *p;
148         if (argc != p[-1]) {
149                 bb_show_usage();
150         }
151
152         if (ifr.cmd == SET_VLAN_NAME_TYPE_CMD) { /* set_name_type */
153                 ifr.u.name_type = *xfind_str(name_types+1, argv[1]);
154         } else {
155                 if (strlen(argv[1]) >= IF_NAMESIZE) {
156                         bb_error_msg_and_die("if_name >= %d chars\n", IF_NAMESIZE);
157                 }
158                 strcpy(ifr.device1, argv[1]);
159                 p = argv[2];
160
161                 /* I suppose one could try to combine some of the function calls below,
162                  * since ifr.u.flag, ifr.u.VID, and ifr.u.skb_priority are all same-sized
163                  * (unsigned) int members of a unions.  But because of the range checking,
164                  * doing so wouldn't save that much space and would also make maintainence
165                  * more of a pain. */
166                 if (ifr.cmd == SET_VLAN_FLAG_CMD) { /* set_flag */
167                         ifr.u.flag = bb_xgetularg10_bnd(p, 0, 1);
168                 } else if (ifr.cmd == ADD_VLAN_CMD) { /* add */
169                         ifr.u.VID = bb_xgetularg10_bnd(p, 0, VLAN_GROUP_ARRAY_LEN-1);
170                 } else if (ifr.cmd != DEL_VLAN_CMD) { /* set_{egress|ingress}_map */
171                         ifr.u.skb_priority = bb_xgetularg10_bnd(p, 0, ULONG_MAX);
172                         ifr.vlan_qos = bb_xgetularg10_bnd(argv[3], 0, 7);
173                 }
174         }
175
176         if (((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0)
177                 || (ioctl(fd, SIOCSIFVLAN, &ifr) < 0)
178                 ) {
179                 bb_perror_msg_and_die("socket or ioctl error for %s", *argv);
180         }
181
182         return 0;
183 }
184