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