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