1/*
2 * Copyright (c) 1999
3 *	Bill Paul <wpaul@ctr.columbia.edu>.  All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 *    notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 *    notice, this list of conditions and the following disclaimer in the
12 *    documentation and/or other materials provided with the distribution.
13 * 3. All advertising materials mentioning features or use of this software
14 *    must display the following acknowledgement:
15 *	This product includes software developed by Bill Paul.
16 * 4. Neither the name of the author nor the names of any co-contributors
17 *    may be used to endorse or promote products derived from this software
18 *    without specific prior written permission.
19 *
20 * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND
21 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
22 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
23 * ARE DISCLAIMED.  IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD
24 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
25 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
26 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
27 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
28 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
29 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
30 * THE POSSIBILITY OF SUCH DAMAGE.
31 */
32
33#include <sys/param.h>
34#include <sys/ioctl.h>
35#include <sys/socket.h>
36#include <sys/sockio.h>
37
38#include <stdlib.h>
39#include <unistd.h>
40
41#include <net/ethernet.h>
42#include <net/if.h>
43#include <net/if_var.h>
44#include <net/if_vlan_var.h>
45#include <net/route.h>
46
47#include <ctype.h>
48#include <stdio.h>
49#include <string.h>
50#include <stdlib.h>
51#include <unistd.h>
52#include <err.h>
53#include <errno.h>
54
55#include "ifconfig.h"
56
57#ifndef lint
58static const char rcsid[] =
59  "$FreeBSD$";
60#endif
61
62#define	NOTAG	((u_short) -1)
63
64static 	struct vlanreq params = {
65	.vlr_tag	= NOTAG,
66};
67
68static int
69getvlan(int s, struct ifreq *ifr, struct vlanreq *vreq)
70{
71	bzero((char *)vreq, sizeof(*vreq));
72	ifr->ifr_data = (caddr_t)vreq;
73
74	return ioctl(s, SIOCGETVLAN, (caddr_t)ifr);
75}
76
77static void
78vlan_status(int s)
79{
80	struct vlanreq		vreq;
81
82	if (getvlan(s, &ifr, &vreq) != -1)
83		printf("\tvlan: %d parent interface: %s\n",
84		    vreq.vlr_tag, vreq.vlr_parent[0] == '\0' ?
85		    "<none>" : vreq.vlr_parent);
86}
87
88static void
89vlan_create(int s, struct ifreq *ifr)
90{
91	if (params.vlr_tag != NOTAG || params.vlr_parent[0] != '\0') {
92		/*
93		 * One or both parameters were specified, make sure both.
94		 */
95		if (params.vlr_tag == NOTAG)
96			errx(1, "must specify a tag for vlan create");
97		if (params.vlr_parent[0] == '\0')
98			errx(1, "must specify a parent device for vlan create");
99		ifr->ifr_data = (caddr_t) &params;
100	}
101	if (ioctl(s, SIOCIFCREATE2, ifr) < 0)
102		err(1, "SIOCIFCREATE2");
103}
104
105static void
106vlan_cb(int s, void *arg)
107{
108	if ((params.vlr_tag != NOTAG) ^ (params.vlr_parent[0] != '\0'))
109		errx(1, "both vlan and vlandev must be specified");
110}
111
112static void
113vlan_set(int s, struct ifreq *ifr)
114{
115	if (params.vlr_tag != NOTAG && params.vlr_parent[0] != '\0') {
116		ifr->ifr_data = (caddr_t) &params;
117		if (ioctl(s, SIOCSETVLAN, (caddr_t)ifr) == -1)
118			err(1, "SIOCSETVLAN");
119	}
120}
121
122static
123DECL_CMD_FUNC(setvlantag, val, d)
124{
125	struct vlanreq vreq;
126	u_long ul;
127	char *endp;
128
129	ul = strtoul(val, &endp, 0);
130	if (*endp != '\0')
131		errx(1, "invalid value for vlan");
132	params.vlr_tag = ul;
133	/* check if the value can be represented in vlr_tag */
134	if (params.vlr_tag != ul)
135		errx(1, "value for vlan out of range");
136
137	if (getvlan(s, &ifr, &vreq) != -1)
138		vlan_set(s, &ifr);
139}
140
141static
142DECL_CMD_FUNC(setvlandev, val, d)
143{
144	struct vlanreq vreq;
145
146	strlcpy(params.vlr_parent, val, sizeof(params.vlr_parent));
147
148	if (getvlan(s, &ifr, &vreq) != -1)
149		vlan_set(s, &ifr);
150}
151
152static
153DECL_CMD_FUNC(unsetvlandev, val, d)
154{
155	struct vlanreq		vreq;
156
157	bzero((char *)&vreq, sizeof(struct vlanreq));
158	ifr.ifr_data = (caddr_t)&vreq;
159
160	if (ioctl(s, SIOCGETVLAN, (caddr_t)&ifr) == -1)
161		err(1, "SIOCGETVLAN");
162
163	bzero((char *)&vreq.vlr_parent, sizeof(vreq.vlr_parent));
164	vreq.vlr_tag = 0;
165
166	if (ioctl(s, SIOCSETVLAN, (caddr_t)&ifr) == -1)
167		err(1, "SIOCSETVLAN");
168}
169
170static struct cmd vlan_cmds[] = {
171	DEF_CLONE_CMD_ARG("vlan",			setvlantag),
172	DEF_CLONE_CMD_ARG("vlandev",			setvlandev),
173	/* NB: non-clone cmds */
174	DEF_CMD_ARG("vlan",				setvlantag),
175	DEF_CMD_ARG("vlandev",				setvlandev),
176	/* XXX For compatibility.  Should become DEF_CMD() some day. */
177	DEF_CMD_OPTARG("-vlandev",			unsetvlandev),
178	DEF_CMD("vlanmtu",	IFCAP_VLAN_MTU,		setifcap),
179	DEF_CMD("-vlanmtu",	-IFCAP_VLAN_MTU,	setifcap),
180	DEF_CMD("vlanhwtag",	IFCAP_VLAN_HWTAGGING,	setifcap),
181	DEF_CMD("-vlanhwtag",	-IFCAP_VLAN_HWTAGGING,	setifcap),
182	DEF_CMD("vlanhwfilter",	IFCAP_VLAN_HWFILTER,	setifcap),
183	DEF_CMD("-vlanhwfilter", -IFCAP_VLAN_HWFILTER,	setifcap),
184	DEF_CMD("-vlanhwtso",	-IFCAP_VLAN_HWTSO,	setifcap),
185	DEF_CMD("vlanhwtso",	IFCAP_VLAN_HWTSO,	setifcap),
186	DEF_CMD("vlanhwcsum",	IFCAP_VLAN_HWCSUM,	setifcap),
187	DEF_CMD("-vlanhwcsum",	-IFCAP_VLAN_HWCSUM,	setifcap),
188};
189static struct afswtch af_vlan = {
190	.af_name	= "af_vlan",
191	.af_af		= AF_UNSPEC,
192	.af_other_status = vlan_status,
193};
194
195static __constructor void
196vlan_ctor(void)
197{
198#define	N(a)	(sizeof(a) / sizeof(a[0]))
199	size_t i;
200
201	for (i = 0; i < N(vlan_cmds);  i++)
202		cmd_register(&vlan_cmds[i]);
203	af_register(&af_vlan);
204	callback_register(vlan_cb, NULL);
205	clone_setdefcallback("vlan", vlan_create);
206#undef N
207}
208