1 /* $NetBSD: altq_conf.c,v 1.20 2014/03/16 05:20:22 dholland 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.20 2014/03/16 05:20:22 dholland 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 58 altqdev_decl(cbq); 59 #endif 60 #ifdef ALTQ_WFQ 61 altqdev_decl(wfq); 62 #endif 63 #ifdef ALTQ_AFMAP 64 altqdev_decl(afm); 65 #endif 66 #ifdef ALTQ_FIFOQ 67 altqdev_decl(fifoq); 68 #endif 69 #ifdef ALTQ_RED 70 altqdev_decl(red); 71 #endif 72 #ifdef ALTQ_RIO 73 altqdev_decl(rio); 74 #endif 75 #ifdef ALTQ_LOCALQ 76 altqdev_decl(localq); 77 #endif 78 #ifdef ALTQ_HFSC 79 altqdev_decl(hfsc); 80 #endif 81 #ifdef ALTQ_CDNR 82 altqdev_decl(cdnr); 83 #endif 84 #ifdef ALTQ_BLUE 85 altqdev_decl(blue); 86 #endif 87 #ifdef ALTQ_PRIQ 88 altqdev_decl(priq); 89 #endif 90 #ifdef ALTQ_JOBS 91 altqdev_decl(jobs); 92 #endif 93 94 /* 95 * altq minor device (discipline) table 96 */ 97 static 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 */ 164 int naltqsw = sizeof (altqsw) / sizeof (altqsw[0]); 165 166 dev_type_open(altqopen); 167 dev_type_close(altqclose); 168 dev_type_ioctl(altqioctl); 169 170 const 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_flag = D_OTHER, 182 }; 183 184 int 185 altqopen(dev_t dev, int flag, int fmt, struct lwp *l) 186 { 187 int unit = minor(dev); 188 189 if (unit == 0) 190 return (0); 191 if (unit < naltqsw) 192 return (*altqsw[unit].d_open)(dev, flag, fmt, l); 193 194 return ENXIO; 195 } 196 197 int 198 altqclose(dev_t dev, int flag, int fmt, struct lwp *l) 199 { 200 int unit = minor(dev); 201 202 if (unit == 0) 203 return (0); 204 if (unit < naltqsw) 205 return (*altqsw[unit].d_close)(dev, flag, fmt, l); 206 207 return ENXIO; 208 } 209 210 int 211 altqioctl(dev_t dev, ioctlcmd_t cmd, void *addr, int flag, struct lwp *l) 212 { 213 int unit = minor(dev); 214 215 if (unit == 0) { 216 struct ifnet *ifp; 217 struct altqreq *typereq; 218 struct tbrreq *tbrreq; 219 int error; 220 221 switch (cmd) { 222 case ALTQGTYPE: 223 case ALTQTBRGET: 224 break; 225 default: 226 #if (__FreeBSD_version > 400000) 227 if ((error = suser(p)) != 0) 228 return (error); 229 #else 230 if ((error = kauth_authorize_network(l->l_cred, 231 KAUTH_NETWORK_ALTQ, KAUTH_REQ_NETWORK_ALTQ_CONF, 232 NULL, NULL, NULL)) != 0) 233 return (error); 234 #endif 235 break; 236 } 237 238 switch (cmd) { 239 case ALTQGTYPE: 240 typereq = (struct altqreq *)addr; 241 if ((ifp = ifunit(typereq->ifname)) == NULL) 242 return (EINVAL); 243 typereq->arg = (u_long)ifp->if_snd.altq_type; 244 return (0); 245 case ALTQTBRSET: 246 tbrreq = (struct tbrreq *)addr; 247 if ((ifp = ifunit(tbrreq->ifname)) == NULL) 248 return (EINVAL); 249 return tbr_set(&ifp->if_snd, &tbrreq->tb_prof); 250 case ALTQTBRGET: 251 tbrreq = (struct tbrreq *)addr; 252 if ((ifp = ifunit(tbrreq->ifname)) == NULL) 253 return (EINVAL); 254 return tbr_get(&ifp->if_snd, &tbrreq->tb_prof); 255 default: 256 return (EINVAL); 257 } 258 } 259 if (unit < naltqsw) 260 return (*altqsw[unit].d_ioctl)(dev, cmd, addr, flag, l); 261 262 return ENXIO; 263 } 264 265 #ifdef __FreeBSD__ 266 static int altq_devsw_installed = 0; 267 #endif 268 269 #ifdef __FreeBSD__ 270 static void 271 altq_drvinit(void *unused) 272 { 273 int unit; 274 275 #if 0 276 mtx_init(&altq_mtx, "altq global lock", MTX_DEF); 277 #endif 278 altq_devsw_installed = 1; 279 printf("altq: attached. Major number assigned automatically.\n"); 280 281 /* create minor devices */ 282 for (unit = 0; unit < naltqsw; unit++) { 283 if (unit == 0 || altqsw[unit].d_open != NULL) 284 altqsw[unit].dev = make_dev(&altq_cdevsw, unit, 285 UID_ROOT, GID_WHEEL, 0644, "altq/%s", 286 altqsw[unit].d_name); 287 } 288 } 289 290 SYSINIT(altqdev,SI_SUB_DRIVERS,SI_ORDER_MIDDLE+CDEV_MAJOR,altq_drvinit,NULL) 291 292 #endif /* FreeBSD */ 293 294 #ifdef ALTQ_KLD 295 /* 296 * KLD support 297 */ 298 static int altq_module_register(struct altq_module_data *); 299 static int altq_module_deregister(struct altq_module_data *); 300 301 static struct altq_module_data *altq_modules[ALTQT_MAX]; 302 #if __FreeBSD_version < 502103 303 static struct altqsw noqdisc = {"noq", noopen, noclose, noioctl}; 304 #else 305 static struct altqsw noqdisc = {"noq"}; 306 #endif 307 308 void altq_module_incref(int type) 309 { 310 if (type < 0 || type >= ALTQT_MAX || altq_modules[type] == NULL) 311 return; 312 313 altq_modules[type]->ref++; 314 } 315 316 void altq_module_declref(int type) 317 { 318 if (type < 0 || type >= ALTQT_MAX || altq_modules[type] == NULL) 319 return; 320 321 altq_modules[type]->ref--; 322 } 323 324 static int 325 altq_module_register(struct altq_module_data *mdata) 326 { 327 int type = mdata->type; 328 329 if (type < 0 || type >= ALTQT_MAX) 330 return (EINVAL); 331 #if (__FreeBSD_version < 502103) 332 if (altqsw[type].d_open != noopen) 333 #else 334 if (altqsw[type].d_open != NULL) 335 #endif 336 return (EBUSY); 337 altqsw[type] = *mdata->altqsw; /* set discipline functions */ 338 altq_modules[type] = mdata; /* save module data pointer */ 339 #if (__FreeBSD_version < 502103) 340 make_dev(&altq_cdevsw, type, UID_ROOT, GID_WHEEL, 0644, 341 "altq/%s", altqsw[type].d_name); 342 #else 343 altqsw[type].dev = make_dev(&altq_cdevsw, type, UID_ROOT, GID_WHEEL, 344 0644, "altq/%s", altqsw[type].d_name); 345 #endif 346 return (0); 347 } 348 349 static int 350 altq_module_deregister(struct altq_module_data *mdata) 351 { 352 int type = mdata->type; 353 354 if (type < 0 || type >= ALTQT_MAX) 355 return (EINVAL); 356 if (mdata != altq_modules[type]) 357 return (EINVAL); 358 if (altq_modules[type]->ref > 0) 359 return (EBUSY); 360 #if (__FreeBSD_version < 502103) 361 destroy_dev(makedev(CDEV_MAJOR, type)); 362 #else 363 destroy_dev(altqsw[type].dev); 364 #endif 365 altqsw[type] = noqdisc; 366 altq_modules[type] = NULL; 367 return (0); 368 } 369 370 int 371 altq_module_handler(module_t mod, int cmd, void *arg) 372 { 373 struct altq_module_data *data = (struct altq_module_data *)arg; 374 int error = 0; 375 376 switch (cmd) { 377 case MOD_LOAD: 378 error = altq_module_register(data); 379 break; 380 381 case MOD_UNLOAD: 382 error = altq_module_deregister(data); 383 break; 384 385 default: 386 error = EINVAL; 387 break; 388 } 389 390 return (error); 391 } 392 393 #endif /* ALTQ_KLD */ 394 #endif /* ALTQ3_COMPAT */ 395