1/*	$NetBSD: altq_conf.c,v 1.22 2021/09/21 14:30:15 christos Exp $	*/
2/*	$KAME: altq_conf.c,v 1.24 2005/04/13 03:44:24 suz Exp $	*/
3
4/*
5 * Copyright (C) 1997-2003
6 *	Sony Computer Science Laboratories Inc.  All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
10 * are met:
11 * 1. Redistributions of source code must retain the above copyright
12 *    notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 *    notice, this list of conditions and the following disclaimer in the
15 *    documentation and/or other materials provided with the distribution.
16 *
17 * THIS SOFTWARE IS PROVIDED BY SONY CSL AND CONTRIBUTORS ``AS IS'' AND
18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20 * ARE DISCLAIMED.  IN NO EVENT SHALL SONY CSL OR CONTRIBUTORS BE LIABLE
21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27 * SUCH DAMAGE.
28 */
29
30#include <sys/cdefs.h>
31__KERNEL_RCSID(0, "$NetBSD: altq_conf.c,v 1.22 2021/09/21 14:30:15 christos Exp $");
32
33#ifdef _KERNEL_OPT
34#include "opt_altq.h"
35#include "opt_inet.h"
36#endif
37
38/*
39 * altq device interface.
40 */
41#include <sys/param.h>
42#include <sys/systm.h>
43#include <sys/socket.h>
44#include <sys/kernel.h>
45#include <sys/proc.h>
46#include <sys/errno.h>
47#include <sys/kauth.h>
48
49#include <net/if.h>
50
51#include <altq/altq.h>
52#include <altq/altqconf.h>
53#include <altq/altq_conf.h>
54
55#ifdef ALTQ3_COMPAT
56
57#ifdef ALTQ_CBQ
58altqdev_decl(cbq);
59#endif
60#ifdef ALTQ_WFQ
61altqdev_decl(wfq);
62#endif
63#ifdef ALTQ_AFMAP
64altqdev_decl(afm);
65#endif
66#ifdef ALTQ_FIFOQ
67altqdev_decl(fifoq);
68#endif
69#ifdef ALTQ_RED
70altqdev_decl(red);
71#endif
72#ifdef ALTQ_RIO
73altqdev_decl(rio);
74#endif
75#ifdef ALTQ_LOCALQ
76altqdev_decl(localq);
77#endif
78#ifdef ALTQ_HFSC
79altqdev_decl(hfsc);
80#endif
81#ifdef ALTQ_CDNR
82altqdev_decl(cdnr);
83#endif
84#ifdef ALTQ_BLUE
85altqdev_decl(blue);
86#endif
87#ifdef ALTQ_PRIQ
88altqdev_decl(priq);
89#endif
90#ifdef ALTQ_JOBS
91altqdev_decl(jobs);
92#endif
93
94/*
95 * altq minor device (discipline) table
96 */
97static struct altqsw altqsw[] = {				/* minor */
98	{"altq", noopen,	noclose,	noioctl},  /* 0 (reserved) */
99#ifdef ALTQ_CBQ
100	{"cbq",	cbqopen,	cbqclose,	cbqioctl},	/* 1 */
101#else
102	{"noq",	noopen,		noclose,	noioctl},	/* 1 */
103#endif
104#ifdef ALTQ_WFQ
105	{"wfq",	wfqopen,	wfqclose,	wfqioctl},	/* 2 */
106#else
107	{"noq",	noopen,		noclose,	noioctl},	/* 2 */
108#endif
109#ifdef ALTQ_AFMAP
110	{"afm",	afmopen,	afmclose,	afmioctl},	/* 3 */
111#else
112	{"noq",	noopen,		noclose,	noioctl},	/* 3 */
113#endif
114#ifdef ALTQ_FIFOQ
115	{"fifoq", fifoqopen,	fifoqclose,	fifoqioctl},	/* 4 */
116#else
117	{"noq",	noopen,		noclose,	noioctl},	/* 4 */
118#endif
119#ifdef ALTQ_RED
120	{"red", redopen,	redclose,	redioctl},	/* 5 */
121#else
122	{"noq",	noopen,		noclose,	noioctl},	/* 5 */
123#endif
124#ifdef ALTQ_RIO
125	{"rio", rioopen,	rioclose,	rioioctl},	/* 6 */
126#else
127	{"noq",	noopen,		noclose,	noioctl},	/* 6 */
128#endif
129#ifdef ALTQ_LOCALQ
130	{"localq",localqopen,	localqclose,	localqioctl}, /* 7 (local use) */
131#else
132	{"noq",	noopen,		noclose,	noioctl},  /* 7 (local use) */
133#endif
134#ifdef ALTQ_HFSC
135	{"hfsc",hfscopen,	hfscclose,	hfscioctl},	/* 8 */
136#else
137	{"noq",	noopen,		noclose,	noioctl},	/* 8 */
138#endif
139#ifdef ALTQ_CDNR
140	{"cdnr",cdnropen,	cdnrclose,	cdnrioctl},	/* 9 */
141#else
142	{"noq",	noopen,		noclose,	noioctl},	/* 9 */
143#endif
144#ifdef ALTQ_BLUE
145	{"blue",blueopen,	blueclose,	blueioctl},	/* 10 */
146#else
147	{"noq",	noopen,		noclose,	noioctl},	/* 10 */
148#endif
149#ifdef ALTQ_PRIQ
150	{"priq",priqopen,	priqclose,	priqioctl},	/* 11 */
151#else
152	{"noq",	noopen,		noclose,	noioctl},	/* 11 */
153#endif
154#ifdef ALTQ_JOBS
155	{"jobs",jobsopen,	jobsclose,	jobsioctl},	/* 12 */
156#else
157	{"noq", noopen,		noclose,	noioctl},	/* 12 */
158#endif
159};
160
161/*
162 * altq major device support
163 */
164int	naltqsw = sizeof (altqsw) / sizeof (altqsw[0]);
165
166dev_type_open(altqopen);
167dev_type_close(altqclose);
168dev_type_ioctl(altqioctl);
169
170const struct cdevsw altq_cdevsw = {
171	.d_open = altqopen,
172	.d_close = altqclose,
173	.d_read = noread,
174	.d_write = nowrite,
175	.d_ioctl = altqioctl,
176	.d_stop = nostop,
177	.d_tty = notty,
178	.d_poll = nopoll,
179	.d_mmap = nommap,
180	.d_kqfilter = nokqfilter,
181	.d_discard = nodiscard,
182	.d_flag = D_OTHER,
183};
184
185int
186altqopen(dev_t dev, int flag, int fmt, struct lwp *l)
187{
188	int unit = minor(dev);
189
190	if (unit == 0)
191		return (0);
192	if (unit < naltqsw)
193		return (*altqsw[unit].d_open)(dev, flag, fmt, l);
194
195	return ENXIO;
196}
197
198int
199altqclose(dev_t dev, int flag, int fmt, struct lwp *l)
200{
201	int unit = minor(dev);
202
203	if (unit == 0)
204		return (0);
205	if (unit < naltqsw)
206		return (*altqsw[unit].d_close)(dev, flag, fmt, l);
207
208	return ENXIO;
209}
210
211int
212altqioctl(dev_t dev, ioctlcmd_t cmd, void *addr, int flag, struct lwp *l)
213{
214	int unit = minor(dev);
215
216	if (unit == 0) {
217		struct ifnet *ifp;
218		struct altqreq *typereq;
219		struct tbrreq *tbrreq;
220		int error;
221
222		switch (cmd) {
223		case ALTQGTYPE:
224		case ALTQTBRGET:
225			break;
226		default:
227			if ((error = kauth_authorize_network(
228			    l->l_cred, KAUTH_NETWORK_ALTQ,
229			    KAUTH_REQ_NETWORK_ALTQ_CONF, NULL, NULL,
230			    NULL)) != 0)
231				return (error);
232			break;
233		}
234
235		switch (cmd) {
236		case ALTQGTYPE:
237			typereq = (struct altqreq *)addr;
238			if ((ifp = ifunit(typereq->ifname)) == NULL)
239				return (EINVAL);
240			typereq->arg = (u_long)ifp->if_snd.altq_type;
241			return (0);
242		case ALTQTBRSET:
243			tbrreq = (struct tbrreq *)addr;
244			if ((ifp = ifunit(tbrreq->ifname)) == NULL)
245				return (EINVAL);
246			return tbr_set(&ifp->if_snd, &tbrreq->tb_prof);
247		case ALTQTBRGET:
248			tbrreq = (struct tbrreq *)addr;
249			if ((ifp = ifunit(tbrreq->ifname)) == NULL)
250				return (EINVAL);
251			return tbr_get(&ifp->if_snd, &tbrreq->tb_prof);
252		default:
253			return (EINVAL);
254		}
255	}
256	if (unit < naltqsw)
257		return (*altqsw[unit].d_ioctl)(dev, cmd, addr, flag, l);
258
259	return ENXIO;
260}
261
262#ifdef __FreeBSD__
263static int altq_devsw_installed = 0;
264#endif
265
266#ifdef __FreeBSD__
267static void
268altq_drvinit(void *unused)
269{
270	int unit;
271
272#if 0
273	mtx_init(&altq_mtx, "altq global lock", MTX_DEF);
274#endif
275	altq_devsw_installed = 1;
276	printf("altq: attached. Major number assigned automatically.\n");
277
278	/* create minor devices */
279	for (unit = 0; unit < naltqsw; unit++) {
280		if (unit == 0 || altqsw[unit].d_open != NULL)
281			altqsw[unit].dev = make_dev(&altq_cdevsw, unit,
282			    UID_ROOT, GID_WHEEL, 0644, "altq/%s",
283			    altqsw[unit].d_name);
284	}
285}
286
287SYSINIT(altqdev,SI_SUB_DRIVERS,SI_ORDER_MIDDLE+CDEV_MAJOR,altq_drvinit,NULL)
288
289#endif /* FreeBSD */
290
291#ifdef ALTQ_KLD
292/*
293 * KLD support
294 */
295static int altq_module_register(struct altq_module_data *);
296static int altq_module_deregister(struct altq_module_data *);
297
298static struct altq_module_data *altq_modules[ALTQT_MAX];
299#if __FreeBSD_version < 502103
300static struct altqsw noqdisc = {"noq", noopen, noclose, noioctl};
301#else
302static struct altqsw noqdisc = {"noq"};
303#endif
304
305void altq_module_incref(int type)
306{
307	if (type < 0 || type >= ALTQT_MAX || altq_modules[type] == NULL)
308		return;
309
310	altq_modules[type]->ref++;
311}
312
313void altq_module_declref(int type)
314{
315	if (type < 0 || type >= ALTQT_MAX || altq_modules[type] == NULL)
316		return;
317
318	altq_modules[type]->ref--;
319}
320
321static int
322altq_module_register(struct altq_module_data *mdata)
323{
324	int type = mdata->type;
325
326	if (type < 0 || type >= ALTQT_MAX)
327		return (EINVAL);
328#if (__FreeBSD_version < 502103)
329	if (altqsw[type].d_open != noopen)
330#else
331	if (altqsw[type].d_open != NULL)
332#endif
333		return (EBUSY);
334	altqsw[type] = *mdata->altqsw;	/* set discipline functions */
335	altq_modules[type] = mdata;	/* save module data pointer */
336#if (__FreeBSD_version < 502103)
337	make_dev(&altq_cdevsw, type, UID_ROOT, GID_WHEEL, 0644,
338		 "altq/%s", altqsw[type].d_name);
339#else
340	altqsw[type].dev = make_dev(&altq_cdevsw, type, UID_ROOT, GID_WHEEL,
341	    0644, "altq/%s", altqsw[type].d_name);
342#endif
343	return (0);
344}
345
346static int
347altq_module_deregister(struct altq_module_data *mdata)
348{
349	int type = mdata->type;
350
351	if (type < 0 || type >= ALTQT_MAX)
352		return (EINVAL);
353	if (mdata != altq_modules[type])
354		return (EINVAL);
355	if (altq_modules[type]->ref > 0)
356		return (EBUSY);
357#if (__FreeBSD_version < 502103)
358	destroy_dev(makedev(CDEV_MAJOR, type));
359#else
360	destroy_dev(altqsw[type].dev);
361#endif
362	altqsw[type] = noqdisc;
363	altq_modules[type] = NULL;
364	return (0);
365}
366
367int
368altq_module_handler(module_t mod, int cmd, void *arg)
369{
370	struct altq_module_data *data = (struct altq_module_data *)arg;
371	int	error = 0;
372
373	switch (cmd) {
374	case MOD_LOAD:
375		error = altq_module_register(data);
376		break;
377
378	case MOD_UNLOAD:
379		error = altq_module_deregister(data);
380		break;
381
382	default:
383		error = EINVAL;
384		break;
385	}
386
387	return (error);
388}
389
390#endif  /* ALTQ_KLD */
391#endif /* ALTQ3_COMPAT */
392