1 /*-
2 * SPDX-License-Identifier: BSD-4-Clause
3 *
4 * Copyright (c) 1999 Bill Paul <wpaul@ctr.columbia.edu>
5 * Copyright (c) 2012 ADARA Networks, Inc.
6 * All rights reserved.
7 *
8 * Portions of this software were developed by Robert N. M. Watson under
9 * contract to ADARA Networks, Inc.
10 *
11 * Redistribution and use in source and binary forms, with or without
12 * modification, are permitted provided that the following conditions
13 * are met:
14 * 1. Redistributions of source code must retain the above copyright
15 * notice, this list of conditions and the following disclaimer.
16 * 2. Redistributions in binary form must reproduce the above copyright
17 * notice, this list of conditions and the following disclaimer in the
18 * documentation and/or other materials provided with the distribution.
19 * 3. All advertising materials mentioning features or use of this software
20 * must display the following acknowledgement:
21 * This product includes software developed by Bill Paul.
22 * 4. Neither the name of the author nor the names of any co-contributors
23 * may be used to endorse or promote products derived from this software
24 * without specific prior written permission.
25 *
26 * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND
27 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
28 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
29 * ARE DISCLAIMED. IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD
30 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
36 * THE POSSIBILITY OF SUCH DAMAGE.
37 */
38
39 #include <sys/param.h>
40 #include <sys/ioctl.h>
41 #include <sys/socket.h>
42 #include <sys/sockio.h>
43
44 #include <stdlib.h>
45 #include <unistd.h>
46
47 #include <net/ethernet.h>
48 #include <net/if.h>
49 #include <net/if_vlan_var.h>
50 #include <net/route.h>
51
52 #include <ctype.h>
53 #include <stdio.h>
54 #include <string.h>
55 #include <stdlib.h>
56 #include <unistd.h>
57 #include <err.h>
58 #include <errno.h>
59
60 #include "ifconfig.h"
61
62 #define NOTAG ((u_short) -1)
63 #define NOPROTO ((u_short) -1)
64
65 static const char proto_8021Q[] = "802.1q";
66 static const char proto_8021ad[] = "802.1ad";
67 static const char proto_qinq[] = "qinq";
68
69 static struct vlanreq params = {
70 .vlr_tag = NOTAG,
71 .vlr_proto = NOPROTO,
72 };
73
74 static void
vlan_status(if_ctx * ctx)75 vlan_status(if_ctx *ctx)
76 {
77 struct vlanreq vreq = {};
78 struct ifreq ifr = { .ifr_data = (caddr_t)&vreq };
79
80 if (ioctl_ctx_ifr(ctx, SIOCGETVLAN, &ifr) == -1)
81 return;
82 printf("\tvlan: %d", vreq.vlr_tag);
83 printf(" vlanproto: ");
84 switch (vreq.vlr_proto) {
85 case ETHERTYPE_VLAN:
86 printf(proto_8021Q);
87 break;
88 case ETHERTYPE_QINQ:
89 printf(proto_8021ad);
90 break;
91 default:
92 printf("0x%04x", vreq.vlr_proto);
93 }
94 if (ioctl_ctx_ifr(ctx, SIOCGVLANPCP, &ifr) != -1)
95 printf(" vlanpcp: %u", ifr.ifr_vlan_pcp);
96 printf(" parent interface: %s", vreq.vlr_parent[0] == '\0' ?
97 "<none>" : vreq.vlr_parent);
98 printf("\n");
99 }
100
101 static int
vlan_match_ethervid(const char * name)102 vlan_match_ethervid(const char *name)
103 {
104 return (strchr(name, '.') != NULL);
105 }
106
107 static void
vlan_parse_ethervid(const char * name)108 vlan_parse_ethervid(const char *name)
109 {
110 char ifname[IFNAMSIZ];
111 char *cp;
112 unsigned int vid;
113
114 strlcpy(ifname, name, IFNAMSIZ);
115 if ((cp = strrchr(ifname, '.')) == NULL)
116 return;
117 /*
118 * Derive params from interface name: "parent.vid".
119 */
120 *cp++ = '\0';
121 if ((*cp < '1') || (*cp > '9'))
122 errx(1, "invalid vlan tag");
123
124 vid = *cp++ - '0';
125 while ((*cp >= '0') && (*cp <= '9')) {
126 vid = (vid * 10) + (*cp++ - '0');
127 if (vid >= 0xFFF)
128 errx(1, "invalid vlan tag");
129 }
130 if (*cp != '\0')
131 errx(1, "invalid vlan tag");
132
133 /*
134 * allow "devX.Y vlandev devX vlan Y" syntax
135 */
136 if (params.vlr_tag == NOTAG || params.vlr_tag == vid)
137 params.vlr_tag = vid;
138 else
139 errx(1, "ambiguous vlan specification");
140
141 /* Restrict overriding interface name */
142 if (params.vlr_parent[0] == '\0' || !strcmp(params.vlr_parent, ifname))
143 strlcpy(params.vlr_parent, ifname, IFNAMSIZ);
144 else
145 errx(1, "ambiguous vlan specification");
146 }
147
148 static void
vlan_create(if_ctx * ctx,struct ifreq * ifr)149 vlan_create(if_ctx *ctx, struct ifreq *ifr)
150 {
151 vlan_parse_ethervid(ifr->ifr_name);
152
153 if (params.vlr_tag != NOTAG || params.vlr_parent[0] != '\0') {
154 /*
155 * One or both parameters were specified, make sure both.
156 */
157 if (params.vlr_tag == NOTAG)
158 errx(1, "must specify a tag for vlan create");
159 if (params.vlr_parent[0] == '\0')
160 errx(1, "must specify a parent device for vlan create");
161 if (params.vlr_proto == NOPROTO)
162 params.vlr_proto = ETHERTYPE_VLAN;
163 ifr->ifr_data = (caddr_t) ¶ms;
164 }
165 ifcreate_ioctl(ctx, ifr);
166 }
167
168 static void
vlan_cb(if_ctx * ctx __unused,void * arg __unused)169 vlan_cb(if_ctx *ctx __unused, void *arg __unused)
170 {
171 if ((params.vlr_tag != NOTAG) ^ (params.vlr_parent[0] != '\0'))
172 errx(1, "both vlan and vlandev must be specified");
173 }
174
175 static void
vlan_set(int s,struct ifreq * ifr)176 vlan_set(int s, struct ifreq *ifr)
177 {
178 if (params.vlr_tag != NOTAG && params.vlr_parent[0] != '\0') {
179 if (params.vlr_proto == NOPROTO)
180 params.vlr_proto = ETHERTYPE_VLAN;
181 ifr->ifr_data = (caddr_t) ¶ms;
182 if (ioctl(s, SIOCSETVLAN, (caddr_t)ifr) == -1)
183 err(1, "SIOCSETVLAN");
184 }
185 }
186
187 static void
setvlantag(if_ctx * ctx,const char * val,int dummy __unused)188 setvlantag(if_ctx *ctx, const char *val, int dummy __unused)
189 {
190 struct vlanreq vreq = {};
191 struct ifreq ifr = { .ifr_data = (caddr_t)&vreq };
192 u_long ul;
193 char *endp;
194
195 ul = strtoul(val, &endp, 0);
196 if (*endp != '\0')
197 errx(1, "invalid value for vlan");
198 params.vlr_tag = ul;
199 /* check if the value can be represented in vlr_tag */
200 if (params.vlr_tag != ul)
201 errx(1, "value for vlan out of range");
202
203 if (ioctl_ctx_ifr(ctx, SIOCGETVLAN, &ifr) != -1) {
204 /*
205 * Retrieve the current settings if the interface has already
206 * been configured.
207 */
208 if (vreq.vlr_parent[0] != '\0') {
209 if (params.vlr_parent[0] == '\0')
210 strlcpy(params.vlr_parent, vreq.vlr_parent, IFNAMSIZ);
211 if (params.vlr_proto == NOPROTO)
212 params.vlr_proto = vreq.vlr_proto;
213 }
214 vlan_set(ctx->io_s, &ifr);
215 }
216 }
217
218 static void
setvlandev(if_ctx * ctx,const char * val,int dummy __unused)219 setvlandev(if_ctx *ctx, const char *val, int dummy __unused)
220 {
221 struct vlanreq vreq = {};
222 struct ifreq ifr = { .ifr_data = (caddr_t)&vreq };
223
224 strlcpy(params.vlr_parent, val, sizeof(params.vlr_parent));
225
226 if (ioctl_ctx_ifr(ctx, SIOCGETVLAN, &ifr) != -1)
227 vlan_set(ctx->io_s, &ifr);
228 }
229
230 static void
setvlanproto(if_ctx * ctx,const char * val,int dummy __unused)231 setvlanproto(if_ctx *ctx, const char *val, int dummy __unused)
232 {
233 struct vlanreq vreq = {};
234 struct ifreq ifr = { .ifr_data = (caddr_t)&vreq };
235
236 if (strncasecmp(proto_8021Q, val,
237 strlen(proto_8021Q)) == 0) {
238 params.vlr_proto = ETHERTYPE_VLAN;
239 } else if ((strncasecmp(proto_8021ad, val, strlen(proto_8021ad)) == 0)
240 || (strncasecmp(proto_qinq, val, strlen(proto_qinq)) == 0)) {
241 params.vlr_proto = ETHERTYPE_QINQ;
242 } else
243 errx(1, "invalid value for vlanproto");
244
245 if (ioctl_ctx_ifr(ctx, SIOCGETVLAN, &ifr) != -1) {
246 /*
247 * Retrieve the current settings if the interface has already
248 * been configured.
249 */
250 if (vreq.vlr_parent[0] != '\0') {
251 if (params.vlr_parent[0] == '\0')
252 strlcpy(params.vlr_parent, vreq.vlr_parent, IFNAMSIZ);
253 if (params.vlr_tag == NOTAG)
254 params.vlr_tag = vreq.vlr_tag;
255 }
256 vlan_set(ctx->io_s, &ifr);
257 }
258 }
259
260 static void
setvlanpcp(if_ctx * ctx,const char * val,int dummy __unused)261 setvlanpcp(if_ctx *ctx, const char *val, int dummy __unused)
262 {
263 u_long ul;
264 char *endp;
265 struct ifreq ifr = {};
266
267 ul = strtoul(val, &endp, 0);
268 if (*endp != '\0')
269 errx(1, "invalid value for vlanpcp");
270 if (ul > 7)
271 errx(1, "value for vlanpcp out of range");
272 ifr.ifr_vlan_pcp = ul;
273 if (ioctl_ctx_ifr(ctx, SIOCSVLANPCP, &ifr) == -1)
274 err(1, "SIOCSVLANPCP");
275 }
276
277 static void
unsetvlandev(if_ctx * ctx,const char * val __unused,int dummy __unused)278 unsetvlandev(if_ctx *ctx, const char *val __unused, int dummy __unused)
279 {
280 struct vlanreq vreq = {};
281 struct ifreq ifr = { .ifr_data = (caddr_t)&vreq };
282
283 if (ioctl_ctx_ifr(ctx, SIOCGETVLAN, &ifr) == -1)
284 err(1, "SIOCGETVLAN");
285
286 bzero((char *)&vreq.vlr_parent, sizeof(vreq.vlr_parent));
287 vreq.vlr_tag = 0;
288
289 if (ioctl_ctx(ctx, SIOCSETVLAN, (caddr_t)&ifr) == -1)
290 err(1, "SIOCSETVLAN");
291 }
292
293 static struct cmd vlan_cmds[] = {
294 DEF_CLONE_CMD_ARG("vlan", setvlantag),
295 DEF_CLONE_CMD_ARG("vlandev", setvlandev),
296 DEF_CLONE_CMD_ARG("vlanproto", setvlanproto),
297 DEF_CMD_ARG("vlanpcp", setvlanpcp),
298 /* NB: non-clone cmds */
299 DEF_CMD_ARG("vlan", setvlantag),
300 DEF_CMD_ARG("vlandev", setvlandev),
301 DEF_CMD_ARG("vlanproto", setvlanproto),
302 /* XXX For compatibility. Should become DEF_CMD() some day. */
303 DEF_CMD_OPTARG("-vlandev", unsetvlandev),
304 DEF_CMD("vlanmtu", IFCAP_VLAN_MTU, setifcap),
305 DEF_CMD("-vlanmtu", IFCAP_VLAN_MTU, clearifcap),
306 DEF_CMD("vlanhwtag", IFCAP_VLAN_HWTAGGING, setifcap),
307 DEF_CMD("-vlanhwtag", IFCAP_VLAN_HWTAGGING, clearifcap),
308 DEF_CMD("vlanhwfilter", IFCAP_VLAN_HWFILTER, setifcap),
309 DEF_CMD("-vlanhwfilter", IFCAP_VLAN_HWFILTER, clearifcap),
310 DEF_CMD("vlanhwtso", IFCAP_VLAN_HWTSO, setifcap),
311 DEF_CMD("-vlanhwtso", IFCAP_VLAN_HWTSO, clearifcap),
312 DEF_CMD("vlanhwcsum", IFCAP_VLAN_HWCSUM, setifcap),
313 DEF_CMD("-vlanhwcsum", IFCAP_VLAN_HWCSUM, clearifcap),
314 };
315 static struct afswtch af_vlan = {
316 .af_name = "af_vlan",
317 .af_af = AF_UNSPEC,
318 .af_other_status = vlan_status,
319 };
320
321 static __constructor void
vlan_ctor(void)322 vlan_ctor(void)
323 {
324 size_t i;
325
326 for (i = 0; i < nitems(vlan_cmds); i++)
327 cmd_register(&vlan_cmds[i]);
328 af_register(&af_vlan);
329 callback_register(vlan_cb, NULL);
330 clone_setdefcallback_prefix("vlan", vlan_create);
331 clone_setdefcallback_filter(vlan_match_ethervid, vlan_create);
332 }
333