1 /* 2 * Copyright (c) 1994-1995 S�ren Schmidt 3 * 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 * in this position and unchanged. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 3. The name of the author may not be used to endorse or promote products 15 * derived from this software without specific prior written permission 16 * 17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 27 * 28 * $FreeBSD$ 29 */ 30 31 #include <sys/param.h> 32 #include <sys/systm.h> 33 #include <sys/sysproto.h> 34 #include <sys/cdio.h> 35 #include <sys/dvdio.h> 36 #include <sys/conf.h> 37 #include <sys/disk.h> 38 #include <sys/consio.h> 39 #include <sys/ctype.h> 40 #include <sys/disklabel.h> 41 #include <sys/fcntl.h> 42 #include <sys/file.h> 43 #include <sys/filedesc.h> 44 #include <sys/filio.h> 45 #include <sys/kbio.h> 46 #include <sys/linker_set.h> 47 #include <sys/malloc.h> 48 #include <sys/proc.h> 49 #include <sys/socket.h> 50 #include <sys/sockio.h> 51 #include <sys/soundcard.h> 52 #include <sys/tty.h> 53 #include <sys/uio.h> 54 #include <net/if.h> 55 #include <net/if_dl.h> 56 #include <net/if_types.h> 57 58 #include <machine/../linux/linux.h> 59 #include <machine/../linux/linux_proto.h> 60 61 #include <compat/linux/linux_ioctl.h> 62 #include <compat/linux/linux_mib.h> 63 #include <compat/linux/linux_util.h> 64 65 static linux_ioctl_function_t linux_ioctl_cdrom; 66 static linux_ioctl_function_t linux_ioctl_vfat; 67 static linux_ioctl_function_t linux_ioctl_console; 68 static linux_ioctl_function_t linux_ioctl_disk; 69 static linux_ioctl_function_t linux_ioctl_socket; 70 static linux_ioctl_function_t linux_ioctl_sound; 71 static linux_ioctl_function_t linux_ioctl_termio; 72 static linux_ioctl_function_t linux_ioctl_private; 73 static linux_ioctl_function_t linux_ioctl_special; 74 75 static struct linux_ioctl_handler cdrom_handler = 76 { linux_ioctl_cdrom, LINUX_IOCTL_CDROM_MIN, LINUX_IOCTL_CDROM_MAX }; 77 static struct linux_ioctl_handler vfat_handler = 78 { linux_ioctl_vfat, LINUX_IOCTL_VFAT_MIN, LINUX_IOCTL_VFAT_MAX }; 79 static struct linux_ioctl_handler console_handler = 80 { linux_ioctl_console, LINUX_IOCTL_CONSOLE_MIN, LINUX_IOCTL_CONSOLE_MAX }; 81 static struct linux_ioctl_handler disk_handler = 82 { linux_ioctl_disk, LINUX_IOCTL_DISK_MIN, LINUX_IOCTL_DISK_MAX }; 83 static struct linux_ioctl_handler socket_handler = 84 { linux_ioctl_socket, LINUX_IOCTL_SOCKET_MIN, LINUX_IOCTL_SOCKET_MAX }; 85 static struct linux_ioctl_handler sound_handler = 86 { linux_ioctl_sound, LINUX_IOCTL_SOUND_MIN, LINUX_IOCTL_SOUND_MAX }; 87 static struct linux_ioctl_handler termio_handler = 88 { linux_ioctl_termio, LINUX_IOCTL_TERMIO_MIN, LINUX_IOCTL_TERMIO_MAX }; 89 static struct linux_ioctl_handler private_handler = 90 { linux_ioctl_private, LINUX_IOCTL_PRIVATE_MIN, LINUX_IOCTL_PRIVATE_MAX }; 91 92 DATA_SET(linux_ioctl_handler_set, cdrom_handler); 93 DATA_SET(linux_ioctl_handler_set, vfat_handler); 94 DATA_SET(linux_ioctl_handler_set, console_handler); 95 DATA_SET(linux_ioctl_handler_set, disk_handler); 96 DATA_SET(linux_ioctl_handler_set, socket_handler); 97 DATA_SET(linux_ioctl_handler_set, sound_handler); 98 DATA_SET(linux_ioctl_handler_set, termio_handler); 99 DATA_SET(linux_ioctl_handler_set, private_handler); 100 101 struct handler_element 102 { 103 TAILQ_ENTRY(handler_element) list; 104 int (*func)(struct thread *, struct linux_ioctl_args *); 105 int low, high, span; 106 }; 107 108 static TAILQ_HEAD(, handler_element) handlers = 109 TAILQ_HEAD_INITIALIZER(handlers); 110 111 static int 112 linux_ioctl_disk(struct thread *td, struct linux_ioctl_args *args) 113 { 114 struct file *fp; 115 int error; 116 u_int sectorsize; 117 off_t mediasize; 118 119 if ((error = fget(td, args->fd, &fp)) != 0) 120 return (error); 121 switch (args->cmd & 0xffff) { 122 case LINUX_BLKGETSIZE: 123 error = fo_ioctl(fp, DIOCGSECTORSIZE, 124 (caddr_t)§orsize, td->td_ucred, td); 125 if (!error) 126 error = fo_ioctl(fp, DIOCGMEDIASIZE, 127 (caddr_t)&mediasize, td->td_ucred, td); 128 fdrop(fp, td); 129 if (error) 130 return (error); 131 sectorsize = mediasize / sectorsize; 132 /* 133 * XXX: How do we know we return the right size of integer ? 134 */ 135 return (copyout(§orsize, (void *)args->arg, 136 sizeof(sectorsize))); 137 } 138 fdrop(fp, td); 139 return (ENOIOCTL); 140 } 141 142 /* 143 * termio related ioctls 144 */ 145 146 struct linux_termio { 147 unsigned short c_iflag; 148 unsigned short c_oflag; 149 unsigned short c_cflag; 150 unsigned short c_lflag; 151 unsigned char c_line; 152 unsigned char c_cc[LINUX_NCC]; 153 }; 154 155 struct linux_termios { 156 unsigned int c_iflag; 157 unsigned int c_oflag; 158 unsigned int c_cflag; 159 unsigned int c_lflag; 160 #ifdef __alpha__ 161 unsigned char c_cc[LINUX_NCCS]; 162 unsigned char c_line; 163 unsigned int c_ispeed; 164 unsigned int c_ospeed; 165 #else 166 unsigned char c_line; 167 unsigned char c_cc[LINUX_NCCS]; 168 #endif 169 }; 170 171 struct linux_winsize { 172 unsigned short ws_row, ws_col; 173 unsigned short ws_xpixel, ws_ypixel; 174 }; 175 176 static struct speedtab sptab[] = { 177 { B0, LINUX_B0 }, { B50, LINUX_B50 }, 178 { B75, LINUX_B75 }, { B110, LINUX_B110 }, 179 { B134, LINUX_B134 }, { B150, LINUX_B150 }, 180 { B200, LINUX_B200 }, { B300, LINUX_B300 }, 181 { B600, LINUX_B600 }, { B1200, LINUX_B1200 }, 182 { B1800, LINUX_B1800 }, { B2400, LINUX_B2400 }, 183 { B4800, LINUX_B4800 }, { B9600, LINUX_B9600 }, 184 { B19200, LINUX_B19200 }, { B38400, LINUX_B38400 }, 185 { B57600, LINUX_B57600 }, { B115200, LINUX_B115200 }, 186 {-1, -1 } 187 }; 188 189 struct linux_serial_struct { 190 int type; 191 int line; 192 int port; 193 int irq; 194 int flags; 195 int xmit_fifo_size; 196 int custom_divisor; 197 int baud_base; 198 unsigned short close_delay; 199 char reserved_char[2]; 200 int hub6; 201 unsigned short closing_wait; 202 unsigned short closing_wait2; 203 int reserved[4]; 204 }; 205 206 static int 207 linux_to_bsd_speed(int code, struct speedtab *table) 208 { 209 for ( ; table->sp_code != -1; table++) 210 if (table->sp_code == code) 211 return (table->sp_speed); 212 return -1; 213 } 214 215 static int 216 bsd_to_linux_speed(int speed, struct speedtab *table) 217 { 218 for ( ; table->sp_speed != -1; table++) 219 if (table->sp_speed == speed) 220 return (table->sp_code); 221 return -1; 222 } 223 224 static void 225 bsd_to_linux_termios(struct termios *bios, struct linux_termios *lios) 226 { 227 int i; 228 229 #ifdef DEBUG 230 if (ldebug(ioctl)) { 231 printf("LINUX: BSD termios structure (input):\n"); 232 printf("i=%08x o=%08x c=%08x l=%08x ispeed=%d ospeed=%d\n", 233 bios->c_iflag, bios->c_oflag, bios->c_cflag, bios->c_lflag, 234 bios->c_ispeed, bios->c_ospeed); 235 printf("c_cc "); 236 for (i=0; i<NCCS; i++) 237 printf("%02x ", bios->c_cc[i]); 238 printf("\n"); 239 } 240 #endif 241 242 lios->c_iflag = 0; 243 if (bios->c_iflag & IGNBRK) 244 lios->c_iflag |= LINUX_IGNBRK; 245 if (bios->c_iflag & BRKINT) 246 lios->c_iflag |= LINUX_BRKINT; 247 if (bios->c_iflag & IGNPAR) 248 lios->c_iflag |= LINUX_IGNPAR; 249 if (bios->c_iflag & PARMRK) 250 lios->c_iflag |= LINUX_PARMRK; 251 if (bios->c_iflag & INPCK) 252 lios->c_iflag |= LINUX_INPCK; 253 if (bios->c_iflag & ISTRIP) 254 lios->c_iflag |= LINUX_ISTRIP; 255 if (bios->c_iflag & INLCR) 256 lios->c_iflag |= LINUX_INLCR; 257 if (bios->c_iflag & IGNCR) 258 lios->c_iflag |= LINUX_IGNCR; 259 if (bios->c_iflag & ICRNL) 260 lios->c_iflag |= LINUX_ICRNL; 261 if (bios->c_iflag & IXON) 262 lios->c_iflag |= LINUX_IXON; 263 if (bios->c_iflag & IXANY) 264 lios->c_iflag |= LINUX_IXANY; 265 if (bios->c_iflag & IXOFF) 266 lios->c_iflag |= LINUX_IXOFF; 267 if (bios->c_iflag & IMAXBEL) 268 lios->c_iflag |= LINUX_IMAXBEL; 269 270 lios->c_oflag = 0; 271 if (bios->c_oflag & OPOST) 272 lios->c_oflag |= LINUX_OPOST; 273 if (bios->c_oflag & ONLCR) 274 lios->c_oflag |= LINUX_ONLCR; 275 if (bios->c_oflag & OXTABS) 276 lios->c_oflag |= LINUX_XTABS; 277 278 lios->c_cflag = bsd_to_linux_speed(bios->c_ispeed, sptab); 279 lios->c_cflag |= (bios->c_cflag & CSIZE) >> 4; 280 if (bios->c_cflag & CSTOPB) 281 lios->c_cflag |= LINUX_CSTOPB; 282 if (bios->c_cflag & CREAD) 283 lios->c_cflag |= LINUX_CREAD; 284 if (bios->c_cflag & PARENB) 285 lios->c_cflag |= LINUX_PARENB; 286 if (bios->c_cflag & PARODD) 287 lios->c_cflag |= LINUX_PARODD; 288 if (bios->c_cflag & HUPCL) 289 lios->c_cflag |= LINUX_HUPCL; 290 if (bios->c_cflag & CLOCAL) 291 lios->c_cflag |= LINUX_CLOCAL; 292 if (bios->c_cflag & CRTSCTS) 293 lios->c_cflag |= LINUX_CRTSCTS; 294 295 lios->c_lflag = 0; 296 if (bios->c_lflag & ISIG) 297 lios->c_lflag |= LINUX_ISIG; 298 if (bios->c_lflag & ICANON) 299 lios->c_lflag |= LINUX_ICANON; 300 if (bios->c_lflag & ECHO) 301 lios->c_lflag |= LINUX_ECHO; 302 if (bios->c_lflag & ECHOE) 303 lios->c_lflag |= LINUX_ECHOE; 304 if (bios->c_lflag & ECHOK) 305 lios->c_lflag |= LINUX_ECHOK; 306 if (bios->c_lflag & ECHONL) 307 lios->c_lflag |= LINUX_ECHONL; 308 if (bios->c_lflag & NOFLSH) 309 lios->c_lflag |= LINUX_NOFLSH; 310 if (bios->c_lflag & TOSTOP) 311 lios->c_lflag |= LINUX_TOSTOP; 312 if (bios->c_lflag & ECHOCTL) 313 lios->c_lflag |= LINUX_ECHOCTL; 314 if (bios->c_lflag & ECHOPRT) 315 lios->c_lflag |= LINUX_ECHOPRT; 316 if (bios->c_lflag & ECHOKE) 317 lios->c_lflag |= LINUX_ECHOKE; 318 if (bios->c_lflag & FLUSHO) 319 lios->c_lflag |= LINUX_FLUSHO; 320 if (bios->c_lflag & PENDIN) 321 lios->c_lflag |= LINUX_PENDIN; 322 if (bios->c_lflag & IEXTEN) 323 lios->c_lflag |= LINUX_IEXTEN; 324 325 for (i=0; i<LINUX_NCCS; i++) 326 lios->c_cc[i] = LINUX_POSIX_VDISABLE; 327 lios->c_cc[LINUX_VINTR] = bios->c_cc[VINTR]; 328 lios->c_cc[LINUX_VQUIT] = bios->c_cc[VQUIT]; 329 lios->c_cc[LINUX_VERASE] = bios->c_cc[VERASE]; 330 lios->c_cc[LINUX_VKILL] = bios->c_cc[VKILL]; 331 lios->c_cc[LINUX_VEOF] = bios->c_cc[VEOF]; 332 lios->c_cc[LINUX_VEOL] = bios->c_cc[VEOL]; 333 lios->c_cc[LINUX_VMIN] = bios->c_cc[VMIN]; 334 lios->c_cc[LINUX_VTIME] = bios->c_cc[VTIME]; 335 lios->c_cc[LINUX_VEOL2] = bios->c_cc[VEOL2]; 336 lios->c_cc[LINUX_VSUSP] = bios->c_cc[VSUSP]; 337 lios->c_cc[LINUX_VSTART] = bios->c_cc[VSTART]; 338 lios->c_cc[LINUX_VSTOP] = bios->c_cc[VSTOP]; 339 lios->c_cc[LINUX_VREPRINT] = bios->c_cc[VREPRINT]; 340 lios->c_cc[LINUX_VDISCARD] = bios->c_cc[VDISCARD]; 341 lios->c_cc[LINUX_VWERASE] = bios->c_cc[VWERASE]; 342 lios->c_cc[LINUX_VLNEXT] = bios->c_cc[VLNEXT]; 343 344 for (i=0; i<LINUX_NCCS; i++) { 345 if (lios->c_cc[i] == _POSIX_VDISABLE) 346 lios->c_cc[i] = LINUX_POSIX_VDISABLE; 347 } 348 lios->c_line = 0; 349 350 #ifdef DEBUG 351 if (ldebug(ioctl)) { 352 printf("LINUX: LINUX termios structure (output):\n"); 353 printf("i=%08x o=%08x c=%08x l=%08x line=%d\n", 354 lios->c_iflag, lios->c_oflag, lios->c_cflag, 355 lios->c_lflag, (int)lios->c_line); 356 printf("c_cc "); 357 for (i=0; i<LINUX_NCCS; i++) 358 printf("%02x ", lios->c_cc[i]); 359 printf("\n"); 360 } 361 #endif 362 } 363 364 static void 365 linux_to_bsd_termios(struct linux_termios *lios, struct termios *bios) 366 { 367 int i; 368 369 #ifdef DEBUG 370 if (ldebug(ioctl)) { 371 printf("LINUX: LINUX termios structure (input):\n"); 372 printf("i=%08x o=%08x c=%08x l=%08x line=%d\n", 373 lios->c_iflag, lios->c_oflag, lios->c_cflag, 374 lios->c_lflag, (int)lios->c_line); 375 printf("c_cc "); 376 for (i=0; i<LINUX_NCCS; i++) 377 printf("%02x ", lios->c_cc[i]); 378 printf("\n"); 379 } 380 #endif 381 382 bios->c_iflag = 0; 383 if (lios->c_iflag & LINUX_IGNBRK) 384 bios->c_iflag |= IGNBRK; 385 if (lios->c_iflag & LINUX_BRKINT) 386 bios->c_iflag |= BRKINT; 387 if (lios->c_iflag & LINUX_IGNPAR) 388 bios->c_iflag |= IGNPAR; 389 if (lios->c_iflag & LINUX_PARMRK) 390 bios->c_iflag |= PARMRK; 391 if (lios->c_iflag & LINUX_INPCK) 392 bios->c_iflag |= INPCK; 393 if (lios->c_iflag & LINUX_ISTRIP) 394 bios->c_iflag |= ISTRIP; 395 if (lios->c_iflag & LINUX_INLCR) 396 bios->c_iflag |= INLCR; 397 if (lios->c_iflag & LINUX_IGNCR) 398 bios->c_iflag |= IGNCR; 399 if (lios->c_iflag & LINUX_ICRNL) 400 bios->c_iflag |= ICRNL; 401 if (lios->c_iflag & LINUX_IXON) 402 bios->c_iflag |= IXON; 403 if (lios->c_iflag & LINUX_IXANY) 404 bios->c_iflag |= IXANY; 405 if (lios->c_iflag & LINUX_IXOFF) 406 bios->c_iflag |= IXOFF; 407 if (lios->c_iflag & LINUX_IMAXBEL) 408 bios->c_iflag |= IMAXBEL; 409 410 bios->c_oflag = 0; 411 if (lios->c_oflag & LINUX_OPOST) 412 bios->c_oflag |= OPOST; 413 if (lios->c_oflag & LINUX_ONLCR) 414 bios->c_oflag |= ONLCR; 415 if (lios->c_oflag & LINUX_XTABS) 416 bios->c_oflag |= OXTABS; 417 418 bios->c_cflag = (lios->c_cflag & LINUX_CSIZE) << 4; 419 if (lios->c_cflag & LINUX_CSTOPB) 420 bios->c_cflag |= CSTOPB; 421 if (lios->c_cflag & LINUX_CREAD) 422 bios->c_cflag |= CREAD; 423 if (lios->c_cflag & LINUX_PARENB) 424 bios->c_cflag |= PARENB; 425 if (lios->c_cflag & LINUX_PARODD) 426 bios->c_cflag |= PARODD; 427 if (lios->c_cflag & LINUX_HUPCL) 428 bios->c_cflag |= HUPCL; 429 if (lios->c_cflag & LINUX_CLOCAL) 430 bios->c_cflag |= CLOCAL; 431 if (lios->c_cflag & LINUX_CRTSCTS) 432 bios->c_cflag |= CRTSCTS; 433 434 bios->c_lflag = 0; 435 if (lios->c_lflag & LINUX_ISIG) 436 bios->c_lflag |= ISIG; 437 if (lios->c_lflag & LINUX_ICANON) 438 bios->c_lflag |= ICANON; 439 if (lios->c_lflag & LINUX_ECHO) 440 bios->c_lflag |= ECHO; 441 if (lios->c_lflag & LINUX_ECHOE) 442 bios->c_lflag |= ECHOE; 443 if (lios->c_lflag & LINUX_ECHOK) 444 bios->c_lflag |= ECHOK; 445 if (lios->c_lflag & LINUX_ECHONL) 446 bios->c_lflag |= ECHONL; 447 if (lios->c_lflag & LINUX_NOFLSH) 448 bios->c_lflag |= NOFLSH; 449 if (lios->c_lflag & LINUX_TOSTOP) 450 bios->c_lflag |= TOSTOP; 451 if (lios->c_lflag & LINUX_ECHOCTL) 452 bios->c_lflag |= ECHOCTL; 453 if (lios->c_lflag & LINUX_ECHOPRT) 454 bios->c_lflag |= ECHOPRT; 455 if (lios->c_lflag & LINUX_ECHOKE) 456 bios->c_lflag |= ECHOKE; 457 if (lios->c_lflag & LINUX_FLUSHO) 458 bios->c_lflag |= FLUSHO; 459 if (lios->c_lflag & LINUX_PENDIN) 460 bios->c_lflag |= PENDIN; 461 if (lios->c_lflag & LINUX_IEXTEN) 462 bios->c_lflag |= IEXTEN; 463 464 for (i=0; i<NCCS; i++) 465 bios->c_cc[i] = _POSIX_VDISABLE; 466 bios->c_cc[VINTR] = lios->c_cc[LINUX_VINTR]; 467 bios->c_cc[VQUIT] = lios->c_cc[LINUX_VQUIT]; 468 bios->c_cc[VERASE] = lios->c_cc[LINUX_VERASE]; 469 bios->c_cc[VKILL] = lios->c_cc[LINUX_VKILL]; 470 bios->c_cc[VEOF] = lios->c_cc[LINUX_VEOF]; 471 bios->c_cc[VEOL] = lios->c_cc[LINUX_VEOL]; 472 bios->c_cc[VMIN] = lios->c_cc[LINUX_VMIN]; 473 bios->c_cc[VTIME] = lios->c_cc[LINUX_VTIME]; 474 bios->c_cc[VEOL2] = lios->c_cc[LINUX_VEOL2]; 475 bios->c_cc[VSUSP] = lios->c_cc[LINUX_VSUSP]; 476 bios->c_cc[VSTART] = lios->c_cc[LINUX_VSTART]; 477 bios->c_cc[VSTOP] = lios->c_cc[LINUX_VSTOP]; 478 bios->c_cc[VREPRINT] = lios->c_cc[LINUX_VREPRINT]; 479 bios->c_cc[VDISCARD] = lios->c_cc[LINUX_VDISCARD]; 480 bios->c_cc[VWERASE] = lios->c_cc[LINUX_VWERASE]; 481 bios->c_cc[VLNEXT] = lios->c_cc[LINUX_VLNEXT]; 482 483 for (i=0; i<NCCS; i++) { 484 if (bios->c_cc[i] == LINUX_POSIX_VDISABLE) 485 bios->c_cc[i] = _POSIX_VDISABLE; 486 } 487 488 bios->c_ispeed = bios->c_ospeed = 489 linux_to_bsd_speed(lios->c_cflag & LINUX_CBAUD, sptab); 490 491 #ifdef DEBUG 492 if (ldebug(ioctl)) { 493 printf("LINUX: BSD termios structure (output):\n"); 494 printf("i=%08x o=%08x c=%08x l=%08x ispeed=%d ospeed=%d\n", 495 bios->c_iflag, bios->c_oflag, bios->c_cflag, bios->c_lflag, 496 bios->c_ispeed, bios->c_ospeed); 497 printf("c_cc "); 498 for (i=0; i<NCCS; i++) 499 printf("%02x ", bios->c_cc[i]); 500 printf("\n"); 501 } 502 #endif 503 } 504 505 static void 506 bsd_to_linux_termio(struct termios *bios, struct linux_termio *lio) 507 { 508 struct linux_termios lios; 509 510 bsd_to_linux_termios(bios, &lios); 511 lio->c_iflag = lios.c_iflag; 512 lio->c_oflag = lios.c_oflag; 513 lio->c_cflag = lios.c_cflag; 514 lio->c_lflag = lios.c_lflag; 515 lio->c_line = lios.c_line; 516 #ifdef __alpha__ 517 lio->c_cc[LINUX__VINTR] = lios.c_cc[LINUX_VINTR]; 518 lio->c_cc[LINUX__VQUIT] = lios.c_cc[LINUX_VQUIT]; 519 lio->c_cc[LINUX__VERASE] = lios.c_cc[LINUX_VERASE]; 520 lio->c_cc[LINUX__VKILL] = lios.c_cc[LINUX_VKILL]; 521 lio->c_cc[LINUX__VEOF] = 522 lios.c_cc[(lios.c_lflag & ICANON) ? LINUX_VEOF : LINUX_VMIN]; 523 lio->c_cc[LINUX__VEOL] = 524 lios.c_cc[(lios.c_lflag & ICANON) ? LINUX_VEOL : LINUX_VTIME]; 525 lio->c_cc[LINUX__VEOL2] = lios.c_cc[LINUX_VEOL2]; 526 lio->c_cc[LINUX__VSWTC] = lios.c_cc[LINUX_VSWTC]; 527 #else 528 memcpy(lio->c_cc, lios.c_cc, LINUX_NCC); 529 #endif 530 } 531 532 static void 533 linux_to_bsd_termio(struct linux_termio *lio, struct termios *bios) 534 { 535 struct linux_termios lios; 536 int i; 537 538 lios.c_iflag = lio->c_iflag; 539 lios.c_oflag = lio->c_oflag; 540 lios.c_cflag = lio->c_cflag; 541 lios.c_lflag = lio->c_lflag; 542 #ifdef __alpha__ 543 for (i=0; i<LINUX_NCCS; i++) 544 lios.c_cc[i] = LINUX_POSIX_VDISABLE; 545 lios.c_cc[LINUX_VINTR] = lio->c_cc[LINUX__VINTR]; 546 lios.c_cc[LINUX_VQUIT] = lio->c_cc[LINUX__VQUIT]; 547 lios.c_cc[LINUX_VERASE] = lio->c_cc[LINUX__VERASE]; 548 lios.c_cc[LINUX_VKILL] = lio->c_cc[LINUX__VKILL]; 549 lios.c_cc[LINUX_VEOL2] = lio->c_cc[LINUX__VEOL2]; 550 lios.c_cc[LINUX_VSWTC] = lio->c_cc[LINUX__VSWTC]; 551 lios.c_cc[(lio->c_lflag & ICANON) ? LINUX_VEOF : LINUX_VMIN] = 552 lio->c_cc[LINUX__VEOF]; 553 lios.c_cc[(lio->c_lflag & ICANON) ? LINUX_VEOL : LINUX_VTIME] = 554 lio->c_cc[LINUX__VEOL]; 555 #else 556 for (i=LINUX_NCC; i<LINUX_NCCS; i++) 557 lios.c_cc[i] = LINUX_POSIX_VDISABLE; 558 memcpy(lios.c_cc, lio->c_cc, LINUX_NCC); 559 #endif 560 linux_to_bsd_termios(&lios, bios); 561 } 562 563 static int 564 linux_ioctl_termio(struct thread *td, struct linux_ioctl_args *args) 565 { 566 struct termios bios; 567 struct linux_termios lios; 568 struct linux_termio lio; 569 struct file *fp; 570 int error; 571 572 if ((error = fget(td, args->fd, &fp)) != 0) 573 return (error); 574 575 switch (args->cmd & 0xffff) { 576 577 case LINUX_TCGETS: 578 error = fo_ioctl(fp, TIOCGETA, (caddr_t)&bios, td->td_ucred, 579 td); 580 if (error) 581 break; 582 bsd_to_linux_termios(&bios, &lios); 583 error = copyout(&lios, (void *)args->arg, sizeof(lios)); 584 break; 585 586 case LINUX_TCSETS: 587 error = copyin((void *)args->arg, &lios, sizeof(lios)); 588 if (error) 589 break; 590 linux_to_bsd_termios(&lios, &bios); 591 error = (fo_ioctl(fp, TIOCSETA, (caddr_t)&bios, td->td_ucred, 592 td)); 593 break; 594 595 case LINUX_TCSETSW: 596 error = copyin((void *)args->arg, &lios, sizeof(lios)); 597 if (error) 598 break; 599 linux_to_bsd_termios(&lios, &bios); 600 error = (fo_ioctl(fp, TIOCSETAW, (caddr_t)&bios, td->td_ucred, 601 td)); 602 break; 603 604 case LINUX_TCSETSF: 605 error = copyin((void *)args->arg, &lios, sizeof(lios)); 606 if (error) 607 break; 608 linux_to_bsd_termios(&lios, &bios); 609 error = (fo_ioctl(fp, TIOCSETAF, (caddr_t)&bios, td->td_ucred, 610 td)); 611 break; 612 613 case LINUX_TCGETA: 614 error = fo_ioctl(fp, TIOCGETA, (caddr_t)&bios, td->td_ucred, 615 td); 616 if (error) 617 break; 618 bsd_to_linux_termio(&bios, &lio); 619 error = (copyout(&lio, (void *)args->arg, sizeof(lio))); 620 break; 621 622 case LINUX_TCSETA: 623 error = copyin((void *)args->arg, &lio, sizeof(lio)); 624 if (error) 625 break; 626 linux_to_bsd_termio(&lio, &bios); 627 error = (fo_ioctl(fp, TIOCSETA, (caddr_t)&bios, td->td_ucred, 628 td)); 629 break; 630 631 case LINUX_TCSETAW: 632 error = copyin((void *)args->arg, &lio, sizeof(lio)); 633 if (error) 634 break; 635 linux_to_bsd_termio(&lio, &bios); 636 error = (fo_ioctl(fp, TIOCSETAW, (caddr_t)&bios, td->td_ucred, 637 td)); 638 break; 639 640 case LINUX_TCSETAF: 641 error = copyin((void *)args->arg, &lio, sizeof(lio)); 642 if (error) 643 break; 644 linux_to_bsd_termio(&lio, &bios); 645 error = (fo_ioctl(fp, TIOCSETAF, (caddr_t)&bios, td->td_ucred, 646 td)); 647 break; 648 649 /* LINUX_TCSBRK */ 650 651 case LINUX_TCXONC: { 652 switch (args->arg) { 653 case LINUX_TCOOFF: 654 args->cmd = TIOCSTOP; 655 break; 656 case LINUX_TCOON: 657 args->cmd = TIOCSTART; 658 break; 659 case LINUX_TCIOFF: 660 case LINUX_TCION: { 661 int c; 662 struct write_args wr; 663 error = fo_ioctl(fp, TIOCGETA, (caddr_t)&bios, 664 td->td_ucred, td); 665 if (error) 666 break; 667 fdrop(fp, td); 668 c = (args->arg == LINUX_TCIOFF) ? VSTOP : VSTART; 669 c = bios.c_cc[c]; 670 if (c != _POSIX_VDISABLE) { 671 wr.fd = args->fd; 672 wr.buf = &c; 673 wr.nbyte = sizeof(c); 674 return (write(td, &wr)); 675 } else 676 return (0); 677 } 678 default: 679 fdrop(fp, td); 680 return (EINVAL); 681 } 682 args->arg = 0; 683 error = (ioctl(td, (struct ioctl_args *)args)); 684 break; 685 } 686 687 case LINUX_TCFLSH: { 688 args->cmd = TIOCFLUSH; 689 switch (args->arg) { 690 case LINUX_TCIFLUSH: 691 args->arg = FREAD; 692 break; 693 case LINUX_TCOFLUSH: 694 args->arg = FWRITE; 695 break; 696 case LINUX_TCIOFLUSH: 697 args->arg = FREAD | FWRITE; 698 break; 699 default: 700 fdrop(fp, td); 701 return (EINVAL); 702 } 703 error = (ioctl(td, (struct ioctl_args *)args)); 704 break; 705 } 706 707 case LINUX_TIOCEXCL: 708 args->cmd = TIOCEXCL; 709 error = (ioctl(td, (struct ioctl_args *)args)); 710 break; 711 712 case LINUX_TIOCNXCL: 713 args->cmd = TIOCNXCL; 714 error = (ioctl(td, (struct ioctl_args *)args)); 715 break; 716 717 case LINUX_TIOCSCTTY: 718 args->cmd = TIOCSCTTY; 719 error = (ioctl(td, (struct ioctl_args *)args)); 720 break; 721 722 case LINUX_TIOCGPGRP: 723 args->cmd = TIOCGPGRP; 724 error = (ioctl(td, (struct ioctl_args *)args)); 725 break; 726 727 case LINUX_TIOCSPGRP: 728 args->cmd = TIOCSPGRP; 729 error = (ioctl(td, (struct ioctl_args *)args)); 730 break; 731 732 /* LINUX_TIOCOUTQ */ 733 /* LINUX_TIOCSTI */ 734 735 case LINUX_TIOCGWINSZ: 736 args->cmd = TIOCGWINSZ; 737 error = (ioctl(td, (struct ioctl_args *)args)); 738 break; 739 740 case LINUX_TIOCSWINSZ: 741 args->cmd = TIOCSWINSZ; 742 error = (ioctl(td, (struct ioctl_args *)args)); 743 break; 744 745 case LINUX_TIOCMGET: 746 args->cmd = TIOCMGET; 747 error = (ioctl(td, (struct ioctl_args *)args)); 748 break; 749 750 case LINUX_TIOCMBIS: 751 args->cmd = TIOCMBIS; 752 error = (ioctl(td, (struct ioctl_args *)args)); 753 break; 754 755 case LINUX_TIOCMBIC: 756 args->cmd = TIOCMBIC; 757 error = (ioctl(td, (struct ioctl_args *)args)); 758 break; 759 760 case LINUX_TIOCMSET: 761 args->cmd = TIOCMSET; 762 error = (ioctl(td, (struct ioctl_args *)args)); 763 break; 764 765 /* TIOCGSOFTCAR */ 766 /* TIOCSSOFTCAR */ 767 768 case LINUX_FIONREAD: /* LINUX_TIOCINQ */ 769 args->cmd = FIONREAD; 770 error = (ioctl(td, (struct ioctl_args *)args)); 771 break; 772 773 /* LINUX_TIOCLINUX */ 774 775 case LINUX_TIOCCONS: 776 args->cmd = TIOCCONS; 777 error = (ioctl(td, (struct ioctl_args *)args)); 778 break; 779 780 case LINUX_TIOCGSERIAL: { 781 struct linux_serial_struct lss; 782 lss.type = LINUX_PORT_16550A; 783 lss.flags = 0; 784 lss.close_delay = 0; 785 error = copyout(&lss, (void *)args->arg, sizeof(lss)); 786 break; 787 } 788 789 case LINUX_TIOCSSERIAL: { 790 struct linux_serial_struct lss; 791 error = copyin((void *)args->arg, &lss, sizeof(lss)); 792 if (error) 793 break; 794 /* XXX - It really helps to have an implementation that 795 * does nothing. NOT! 796 */ 797 error = 0; 798 break; 799 } 800 801 /* LINUX_TIOCPKT */ 802 803 case LINUX_FIONBIO: 804 args->cmd = FIONBIO; 805 error = (ioctl(td, (struct ioctl_args *)args)); 806 break; 807 808 case LINUX_TIOCNOTTY: 809 args->cmd = TIOCNOTTY; 810 error = (ioctl(td, (struct ioctl_args *)args)); 811 break; 812 813 case LINUX_TIOCSETD: { 814 int line; 815 switch (args->arg) { 816 case LINUX_N_TTY: 817 line = TTYDISC; 818 break; 819 case LINUX_N_SLIP: 820 line = SLIPDISC; 821 break; 822 case LINUX_N_PPP: 823 line = PPPDISC; 824 break; 825 default: 826 fdrop(fp, td); 827 return (EINVAL); 828 } 829 error = (fo_ioctl(fp, TIOCSETD, (caddr_t)&line, td->td_ucred, 830 td)); 831 break; 832 } 833 834 case LINUX_TIOCGETD: { 835 int linux_line; 836 int bsd_line = TTYDISC; 837 error = fo_ioctl(fp, TIOCGETD, (caddr_t)&bsd_line, 838 td->td_ucred, td); 839 if (error) 840 return (error); 841 switch (bsd_line) { 842 case TTYDISC: 843 linux_line = LINUX_N_TTY; 844 break; 845 case SLIPDISC: 846 linux_line = LINUX_N_SLIP; 847 break; 848 case PPPDISC: 849 linux_line = LINUX_N_PPP; 850 break; 851 default: 852 fdrop(fp, td); 853 return (EINVAL); 854 } 855 error = (copyout(&linux_line, (void *)args->arg, sizeof(int))); 856 break; 857 } 858 859 /* LINUX_TCSBRKP */ 860 /* LINUX_TIOCTTYGSTRUCT */ 861 862 case LINUX_FIONCLEX: 863 args->cmd = FIONCLEX; 864 error = (ioctl(td, (struct ioctl_args *)args)); 865 break; 866 867 case LINUX_FIOCLEX: 868 args->cmd = FIOCLEX; 869 error = (ioctl(td, (struct ioctl_args *)args)); 870 break; 871 872 case LINUX_FIOASYNC: 873 args->cmd = FIOASYNC; 874 error = (ioctl(td, (struct ioctl_args *)args)); 875 break; 876 877 /* LINUX_TIOCSERCONFIG */ 878 /* LINUX_TIOCSERGWILD */ 879 /* LINUX_TIOCSERSWILD */ 880 /* LINUX_TIOCGLCKTRMIOS */ 881 /* LINUX_TIOCSLCKTRMIOS */ 882 883 default: 884 error = ENOIOCTL; 885 break; 886 } 887 888 fdrop(fp, td); 889 return (error); 890 } 891 892 /* 893 * CDROM related ioctls 894 */ 895 896 struct linux_cdrom_msf 897 { 898 u_char cdmsf_min0; 899 u_char cdmsf_sec0; 900 u_char cdmsf_frame0; 901 u_char cdmsf_min1; 902 u_char cdmsf_sec1; 903 u_char cdmsf_frame1; 904 }; 905 906 struct linux_cdrom_tochdr 907 { 908 u_char cdth_trk0; 909 u_char cdth_trk1; 910 }; 911 912 union linux_cdrom_addr 913 { 914 struct { 915 u_char minute; 916 u_char second; 917 u_char frame; 918 } msf; 919 int lba; 920 }; 921 922 struct linux_cdrom_tocentry 923 { 924 u_char cdte_track; 925 u_char cdte_adr:4; 926 u_char cdte_ctrl:4; 927 u_char cdte_format; 928 union linux_cdrom_addr cdte_addr; 929 u_char cdte_datamode; 930 }; 931 932 struct linux_cdrom_subchnl 933 { 934 u_char cdsc_format; 935 u_char cdsc_audiostatus; 936 u_char cdsc_adr:4; 937 u_char cdsc_ctrl:4; 938 u_char cdsc_trk; 939 u_char cdsc_ind; 940 union linux_cdrom_addr cdsc_absaddr; 941 union linux_cdrom_addr cdsc_reladdr; 942 }; 943 944 struct l_cdrom_read_audio { 945 union linux_cdrom_addr addr; 946 u_char addr_format; 947 l_int nframes; 948 u_char *buf; 949 }; 950 951 struct l_dvd_layer { 952 u_char book_version:4; 953 u_char book_type:4; 954 u_char min_rate:4; 955 u_char disc_size:4; 956 u_char layer_type:4; 957 u_char track_path:1; 958 u_char nlayers:2; 959 u_char track_density:4; 960 u_char linear_density:4; 961 u_char bca:1; 962 u_int32_t start_sector; 963 u_int32_t end_sector; 964 u_int32_t end_sector_l0; 965 }; 966 967 struct l_dvd_physical { 968 u_char type; 969 u_char layer_num; 970 struct l_dvd_layer layer[4]; 971 }; 972 973 struct l_dvd_copyright { 974 u_char type; 975 u_char layer_num; 976 u_char cpst; 977 u_char rmi; 978 }; 979 980 struct l_dvd_disckey { 981 u_char type; 982 l_uint agid:2; 983 u_char value[2048]; 984 }; 985 986 struct l_dvd_bca { 987 u_char type; 988 l_int len; 989 u_char value[188]; 990 }; 991 992 struct l_dvd_manufact { 993 u_char type; 994 u_char layer_num; 995 l_int len; 996 u_char value[2048]; 997 }; 998 999 typedef union { 1000 u_char type; 1001 struct l_dvd_physical physical; 1002 struct l_dvd_copyright copyright; 1003 struct l_dvd_disckey disckey; 1004 struct l_dvd_bca bca; 1005 struct l_dvd_manufact manufact; 1006 } l_dvd_struct; 1007 1008 typedef u_char l_dvd_key[5]; 1009 typedef u_char l_dvd_challenge[10]; 1010 1011 struct l_dvd_lu_send_agid { 1012 u_char type; 1013 l_uint agid:2; 1014 }; 1015 1016 struct l_dvd_host_send_challenge { 1017 u_char type; 1018 l_uint agid:2; 1019 l_dvd_challenge chal; 1020 }; 1021 1022 struct l_dvd_send_key { 1023 u_char type; 1024 l_uint agid:2; 1025 l_dvd_key key; 1026 }; 1027 1028 struct l_dvd_lu_send_challenge { 1029 u_char type; 1030 l_uint agid:2; 1031 l_dvd_challenge chal; 1032 }; 1033 1034 struct l_dvd_lu_send_title_key { 1035 u_char type; 1036 l_uint agid:2; 1037 l_dvd_key title_key; 1038 l_int lba; 1039 l_uint cpm:1; 1040 l_uint cp_sec:1; 1041 l_uint cgms:2; 1042 }; 1043 1044 struct l_dvd_lu_send_asf { 1045 u_char type; 1046 l_uint agid:2; 1047 l_uint asf:1; 1048 }; 1049 1050 struct l_dvd_host_send_rpcstate { 1051 u_char type; 1052 u_char pdrc; 1053 }; 1054 1055 struct l_dvd_lu_send_rpcstate { 1056 u_char type:2; 1057 u_char vra:3; 1058 u_char ucca:3; 1059 u_char region_mask; 1060 u_char rpc_scheme; 1061 }; 1062 1063 typedef union { 1064 u_char type; 1065 struct l_dvd_lu_send_agid lsa; 1066 struct l_dvd_host_send_challenge hsc; 1067 struct l_dvd_send_key lsk; 1068 struct l_dvd_lu_send_challenge lsc; 1069 struct l_dvd_send_key hsk; 1070 struct l_dvd_lu_send_title_key lstk; 1071 struct l_dvd_lu_send_asf lsasf; 1072 struct l_dvd_host_send_rpcstate hrpcs; 1073 struct l_dvd_lu_send_rpcstate lrpcs; 1074 } l_dvd_authinfo; 1075 1076 static void 1077 bsd_to_linux_msf_lba(u_char af, union msf_lba *bp, union linux_cdrom_addr *lp) 1078 { 1079 if (af == CD_LBA_FORMAT) 1080 lp->lba = bp->lba; 1081 else { 1082 lp->msf.minute = bp->msf.minute; 1083 lp->msf.second = bp->msf.second; 1084 lp->msf.frame = bp->msf.frame; 1085 } 1086 } 1087 1088 static void 1089 linux_to_bsd_msf_lba(u_char af, union linux_cdrom_addr *lp, union msf_lba *bp) 1090 { 1091 if (af == CD_LBA_FORMAT) 1092 bp->lba = lp->lba; 1093 else { 1094 bp->msf.minute = lp->msf.minute; 1095 bp->msf.second = lp->msf.second; 1096 bp->msf.frame = lp->msf.frame; 1097 } 1098 } 1099 1100 static void 1101 set_linux_cdrom_addr(union linux_cdrom_addr *addr, int format, int lba) 1102 { 1103 if (format == LINUX_CDROM_MSF) { 1104 addr->msf.frame = lba % 75; 1105 lba /= 75; 1106 lba += 2; 1107 addr->msf.second = lba % 60; 1108 addr->msf.minute = lba / 60; 1109 } else 1110 addr->lba = lba; 1111 } 1112 1113 static int 1114 linux_to_bsd_dvd_struct(l_dvd_struct *lp, struct dvd_struct *bp) 1115 { 1116 bp->format = lp->type; 1117 switch (bp->format) { 1118 case DVD_STRUCT_PHYSICAL: 1119 if (bp->layer_num >= 4) 1120 return (EINVAL); 1121 bp->layer_num = lp->physical.layer_num; 1122 break; 1123 case DVD_STRUCT_COPYRIGHT: 1124 bp->layer_num = lp->copyright.layer_num; 1125 break; 1126 case DVD_STRUCT_DISCKEY: 1127 bp->agid = lp->disckey.agid; 1128 break; 1129 case DVD_STRUCT_BCA: 1130 case DVD_STRUCT_MANUFACT: 1131 break; 1132 default: 1133 return (EINVAL); 1134 } 1135 return (0); 1136 } 1137 1138 static int 1139 bsd_to_linux_dvd_struct(struct dvd_struct *bp, l_dvd_struct *lp) 1140 { 1141 switch (bp->format) { 1142 case DVD_STRUCT_PHYSICAL: { 1143 struct dvd_layer *blp = (struct dvd_layer *)bp->data; 1144 struct l_dvd_layer *llp = &lp->physical.layer[bp->layer_num]; 1145 memset(llp, 0, sizeof(*llp)); 1146 llp->book_version = blp->book_version; 1147 llp->book_type = blp->book_type; 1148 llp->min_rate = blp->max_rate; 1149 llp->disc_size = blp->disc_size; 1150 llp->layer_type = blp->layer_type; 1151 llp->track_path = blp->track_path; 1152 llp->nlayers = blp->nlayers; 1153 llp->track_density = blp->track_density; 1154 llp->linear_density = blp->linear_density; 1155 llp->bca = blp->bca; 1156 llp->start_sector = blp->start_sector; 1157 llp->end_sector = blp->end_sector; 1158 llp->end_sector_l0 = blp->end_sector_l0; 1159 break; 1160 } 1161 case DVD_STRUCT_COPYRIGHT: 1162 lp->copyright.cpst = bp->cpst; 1163 lp->copyright.rmi = bp->rmi; 1164 break; 1165 case DVD_STRUCT_DISCKEY: 1166 memcpy(lp->disckey.value, bp->data, sizeof(lp->disckey.value)); 1167 break; 1168 case DVD_STRUCT_BCA: 1169 lp->bca.len = bp->length; 1170 memcpy(lp->bca.value, bp->data, sizeof(lp->bca.value)); 1171 break; 1172 case DVD_STRUCT_MANUFACT: 1173 lp->manufact.len = bp->length; 1174 memcpy(lp->manufact.value, bp->data, 1175 sizeof(lp->manufact.value)); 1176 /* lp->manufact.layer_num is unused in linux (redhat 7.0) */ 1177 break; 1178 default: 1179 return (EINVAL); 1180 } 1181 return (0); 1182 } 1183 1184 static int 1185 linux_to_bsd_dvd_authinfo(l_dvd_authinfo *lp, int *bcode, 1186 struct dvd_authinfo *bp) 1187 { 1188 switch (lp->type) { 1189 case LINUX_DVD_LU_SEND_AGID: 1190 *bcode = DVDIOCREPORTKEY; 1191 bp->format = DVD_REPORT_AGID; 1192 bp->agid = lp->lsa.agid; 1193 break; 1194 case LINUX_DVD_HOST_SEND_CHALLENGE: 1195 *bcode = DVDIOCSENDKEY; 1196 bp->format = DVD_SEND_CHALLENGE; 1197 bp->agid = lp->hsc.agid; 1198 memcpy(bp->keychal, lp->hsc.chal, 10); 1199 break; 1200 case LINUX_DVD_LU_SEND_KEY1: 1201 *bcode = DVDIOCREPORTKEY; 1202 bp->format = DVD_REPORT_KEY1; 1203 bp->agid = lp->lsk.agid; 1204 break; 1205 case LINUX_DVD_LU_SEND_CHALLENGE: 1206 *bcode = DVDIOCREPORTKEY; 1207 bp->format = DVD_REPORT_CHALLENGE; 1208 bp->agid = lp->lsc.agid; 1209 break; 1210 case LINUX_DVD_HOST_SEND_KEY2: 1211 *bcode = DVDIOCSENDKEY; 1212 bp->format = DVD_SEND_KEY2; 1213 bp->agid = lp->hsk.agid; 1214 memcpy(bp->keychal, lp->hsk.key, 5); 1215 break; 1216 case LINUX_DVD_LU_SEND_TITLE_KEY: 1217 *bcode = DVDIOCREPORTKEY; 1218 bp->format = DVD_REPORT_TITLE_KEY; 1219 bp->agid = lp->lstk.agid; 1220 bp->lba = lp->lstk.lba; 1221 break; 1222 case LINUX_DVD_LU_SEND_ASF: 1223 *bcode = DVDIOCREPORTKEY; 1224 bp->format = DVD_REPORT_ASF; 1225 bp->agid = lp->lsasf.agid; 1226 break; 1227 case LINUX_DVD_INVALIDATE_AGID: 1228 *bcode = DVDIOCREPORTKEY; 1229 bp->format = DVD_INVALIDATE_AGID; 1230 bp->agid = lp->lsa.agid; 1231 break; 1232 case LINUX_DVD_LU_SEND_RPC_STATE: 1233 *bcode = DVDIOCREPORTKEY; 1234 bp->format = DVD_REPORT_RPC; 1235 break; 1236 case LINUX_DVD_HOST_SEND_RPC_STATE: 1237 *bcode = DVDIOCSENDKEY; 1238 bp->format = DVD_SEND_RPC; 1239 bp->region = lp->hrpcs.pdrc; 1240 break; 1241 default: 1242 return (EINVAL); 1243 } 1244 return (0); 1245 } 1246 1247 static int 1248 bsd_to_linux_dvd_authinfo(struct dvd_authinfo *bp, l_dvd_authinfo *lp) 1249 { 1250 switch (lp->type) { 1251 case LINUX_DVD_LU_SEND_AGID: 1252 lp->lsa.agid = bp->agid; 1253 break; 1254 case LINUX_DVD_HOST_SEND_CHALLENGE: 1255 lp->type = LINUX_DVD_LU_SEND_KEY1; 1256 break; 1257 case LINUX_DVD_LU_SEND_KEY1: 1258 memcpy(lp->lsk.key, bp->keychal, sizeof(lp->lsk.key)); 1259 break; 1260 case LINUX_DVD_LU_SEND_CHALLENGE: 1261 memcpy(lp->lsc.chal, bp->keychal, sizeof(lp->lsc.chal)); 1262 break; 1263 case LINUX_DVD_HOST_SEND_KEY2: 1264 lp->type = LINUX_DVD_AUTH_ESTABLISHED; 1265 break; 1266 case LINUX_DVD_LU_SEND_TITLE_KEY: 1267 memcpy(lp->lstk.title_key, bp->keychal, 1268 sizeof(lp->lstk.title_key)); 1269 lp->lstk.cpm = bp->cpm; 1270 lp->lstk.cp_sec = bp->cp_sec; 1271 lp->lstk.cgms = bp->cgms; 1272 break; 1273 case LINUX_DVD_LU_SEND_ASF: 1274 lp->lsasf.asf = bp->asf; 1275 break; 1276 case LINUX_DVD_INVALIDATE_AGID: 1277 break; 1278 case LINUX_DVD_LU_SEND_RPC_STATE: 1279 lp->lrpcs.type = bp->reg_type; 1280 lp->lrpcs.vra = bp->vend_rsts; 1281 lp->lrpcs.ucca = bp->user_rsts; 1282 lp->lrpcs.region_mask = bp->region; 1283 lp->lrpcs.rpc_scheme = bp->rpc_scheme; 1284 break; 1285 case LINUX_DVD_HOST_SEND_RPC_STATE: 1286 break; 1287 default: 1288 return (EINVAL); 1289 } 1290 return (0); 1291 } 1292 1293 static int 1294 linux_ioctl_cdrom(struct thread *td, struct linux_ioctl_args *args) 1295 { 1296 struct file *fp; 1297 int error; 1298 1299 if ((error = fget(td, args->fd, &fp)) != 0) 1300 return (error); 1301 switch (args->cmd & 0xffff) { 1302 1303 case LINUX_CDROMPAUSE: 1304 args->cmd = CDIOCPAUSE; 1305 error = (ioctl(td, (struct ioctl_args *)args)); 1306 break; 1307 1308 case LINUX_CDROMRESUME: 1309 args->cmd = CDIOCRESUME; 1310 error = (ioctl(td, (struct ioctl_args *)args)); 1311 break; 1312 1313 case LINUX_CDROMPLAYMSF: 1314 args->cmd = CDIOCPLAYMSF; 1315 error = (ioctl(td, (struct ioctl_args *)args)); 1316 break; 1317 1318 case LINUX_CDROMPLAYTRKIND: 1319 args->cmd = CDIOCPLAYTRACKS; 1320 error = (ioctl(td, (struct ioctl_args *)args)); 1321 break; 1322 1323 case LINUX_CDROMREADTOCHDR: { 1324 struct ioc_toc_header th; 1325 struct linux_cdrom_tochdr lth; 1326 error = fo_ioctl(fp, CDIOREADTOCHEADER, (caddr_t)&th, 1327 td->td_ucred, td); 1328 if (!error) { 1329 lth.cdth_trk0 = th.starting_track; 1330 lth.cdth_trk1 = th.ending_track; 1331 copyout(<h, (void *)args->arg, sizeof(lth)); 1332 } 1333 break; 1334 } 1335 1336 case LINUX_CDROMREADTOCENTRY: { 1337 struct linux_cdrom_tocentry lte, *ltep = 1338 (struct linux_cdrom_tocentry *)args->arg; 1339 struct ioc_read_toc_single_entry irtse; 1340 irtse.address_format = ltep->cdte_format; 1341 irtse.track = ltep->cdte_track; 1342 error = fo_ioctl(fp, CDIOREADTOCENTRY, (caddr_t)&irtse, 1343 td->td_ucred, td); 1344 if (!error) { 1345 lte = *ltep; 1346 lte.cdte_ctrl = irtse.entry.control; 1347 lte.cdte_adr = irtse.entry.addr_type; 1348 bsd_to_linux_msf_lba(irtse.address_format, 1349 &irtse.entry.addr, <e.cdte_addr); 1350 copyout(<e, (void *)args->arg, sizeof(lte)); 1351 } 1352 break; 1353 } 1354 1355 case LINUX_CDROMSTOP: 1356 args->cmd = CDIOCSTOP; 1357 error = (ioctl(td, (struct ioctl_args *)args)); 1358 break; 1359 1360 case LINUX_CDROMSTART: 1361 args->cmd = CDIOCSTART; 1362 error = (ioctl(td, (struct ioctl_args *)args)); 1363 break; 1364 1365 case LINUX_CDROMEJECT: 1366 args->cmd = CDIOCEJECT; 1367 error = (ioctl(td, (struct ioctl_args *)args)); 1368 break; 1369 1370 /* LINUX_CDROMVOLCTRL */ 1371 1372 case LINUX_CDROMSUBCHNL: { 1373 struct linux_cdrom_subchnl sc; 1374 struct ioc_read_subchannel bsdsc; 1375 struct cd_sub_channel_info *bsdinfo; 1376 caddr_t sg = stackgap_init(); 1377 bsdinfo = stackgap_alloc(&sg, sizeof(*bsdinfo)); 1378 bsdsc.address_format = CD_LBA_FORMAT; 1379 bsdsc.data_format = CD_CURRENT_POSITION; 1380 bsdsc.track = 0; 1381 bsdsc.data_len = sizeof(*bsdinfo); 1382 bsdsc.data = bsdinfo; 1383 error = fo_ioctl(fp, CDIOCREADSUBCHANNEL, (caddr_t)&bsdsc, 1384 td->td_ucred, td); 1385 if (error) 1386 break; 1387 error = copyin((void *)args->arg, &sc, sizeof(sc)); 1388 if (error) 1389 break; 1390 sc.cdsc_audiostatus = bsdinfo->header.audio_status; 1391 sc.cdsc_adr = bsdinfo->what.position.addr_type; 1392 sc.cdsc_ctrl = bsdinfo->what.position.control; 1393 sc.cdsc_trk = bsdinfo->what.position.track_number; 1394 sc.cdsc_ind = bsdinfo->what.position.index_number; 1395 set_linux_cdrom_addr(&sc.cdsc_absaddr, sc.cdsc_format, 1396 bsdinfo->what.position.absaddr.lba); 1397 set_linux_cdrom_addr(&sc.cdsc_reladdr, sc.cdsc_format, 1398 bsdinfo->what.position.reladdr.lba); 1399 error = copyout(&sc, (void *)args->arg, sizeof(sc)); 1400 break; 1401 } 1402 1403 /* LINUX_CDROMREADMODE2 */ 1404 /* LINUX_CDROMREADMODE1 */ 1405 1406 case LINUX_CDROMREADAUDIO: { 1407 struct l_cdrom_read_audio lra; 1408 struct ioc_read_audio bra; 1409 1410 error = copyin((void *)args->arg, &lra, sizeof(lra)); 1411 if (error) 1412 break; 1413 bra.address_format = lra.addr_format; 1414 linux_to_bsd_msf_lba(bra.address_format, &lra.addr, 1415 &bra.address); 1416 bra.nframes = lra.nframes; 1417 bra.buffer = lra.buf; 1418 error = fo_ioctl(fp, CDIOCREADAUDIO, (caddr_t)&bra, 1419 td->td_ucred, td); 1420 break; 1421 } 1422 1423 /* LINUX_CDROMEJECT_SW */ 1424 /* LINUX_CDROMMULTISESSION */ 1425 /* LINUX_CDROM_GET_UPC */ 1426 1427 case LINUX_CDROMRESET: 1428 args->cmd = CDIOCRESET; 1429 error = (ioctl(td, (struct ioctl_args *)args)); 1430 break; 1431 1432 /* LINUX_CDROMVOLREAD */ 1433 /* LINUX_CDROMREADRAW */ 1434 /* LINUX_CDROMREADCOOKED */ 1435 /* LINUX_CDROMSEEK */ 1436 /* LINUX_CDROMPLAYBLK */ 1437 /* LINUX_CDROMREADALL */ 1438 /* LINUX_CDROMCLOSETRAY */ 1439 /* LINUX_CDROMLOADFROMSLOT */ 1440 /* LINUX_CDROMGETSPINDOWN */ 1441 /* LINUX_CDROMSETSPINDOWN */ 1442 /* LINUX_CDROM_SET_OPTIONS */ 1443 /* LINUX_CDROM_CLEAR_OPTIONS */ 1444 /* LINUX_CDROM_SELECT_SPEED */ 1445 /* LINUX_CDROM_SELECT_DISC */ 1446 /* LINUX_CDROM_MEDIA_CHANGED */ 1447 /* LINUX_CDROM_DRIVE_STATUS */ 1448 /* LINUX_CDROM_DISC_STATUS */ 1449 /* LINUX_CDROM_CHANGER_NSLOTS */ 1450 /* LINUX_CDROM_LOCKDOOR */ 1451 /* LINUX_CDROM_DEBUG */ 1452 /* LINUX_CDROM_GET_CAPABILITY */ 1453 /* LINUX_CDROMAUDIOBUFSIZ */ 1454 1455 case LINUX_DVD_READ_STRUCT: { 1456 l_dvd_struct lds; 1457 struct dvd_struct bds; 1458 1459 error = copyin((void *)args->arg, &lds, sizeof(lds)); 1460 if (error) 1461 break; 1462 error = linux_to_bsd_dvd_struct(&lds, &bds); 1463 if (error) 1464 break; 1465 error = fo_ioctl(fp, DVDIOCREADSTRUCTURE, (caddr_t)&bds, 1466 td->td_ucred, td); 1467 if (error) 1468 break; 1469 error = bsd_to_linux_dvd_struct(&bds, &lds); 1470 if (error) 1471 break; 1472 error = copyout(&lds, (void *)args->arg, sizeof(lds)); 1473 break; 1474 } 1475 1476 /* LINUX_DVD_WRITE_STRUCT */ 1477 1478 case LINUX_DVD_AUTH: { 1479 l_dvd_authinfo lda; 1480 struct dvd_authinfo bda; 1481 int bcode; 1482 1483 error = copyin((void *)args->arg, &lda, sizeof(lda)); 1484 if (error) 1485 break; 1486 error = linux_to_bsd_dvd_authinfo(&lda, &bcode, &bda); 1487 if (error) 1488 break; 1489 error = fo_ioctl(fp, bcode, (caddr_t)&bda, td->td_ucred, 1490 td); 1491 if (error) { 1492 if (lda.type == LINUX_DVD_HOST_SEND_KEY2) { 1493 lda.type = LINUX_DVD_AUTH_FAILURE; 1494 copyout(&lda, (void *)args->arg, sizeof(lda)); 1495 } 1496 break; 1497 } 1498 error = bsd_to_linux_dvd_authinfo(&bda, &lda); 1499 if (error) 1500 break; 1501 error = copyout(&lda, (void *)args->arg, sizeof(lda)); 1502 break; 1503 } 1504 1505 /* LINUX_CDROM_SEND_PACKET */ 1506 /* LINUX_CDROM_NEXT_WRITABLE */ 1507 /* LINUX_CDROM_LAST_WRITTEN */ 1508 1509 default: 1510 error = ENOIOCTL; 1511 break; 1512 } 1513 1514 fdrop(fp, td); 1515 return (error); 1516 } 1517 1518 static int 1519 linux_ioctl_vfat(struct thread *td, struct linux_ioctl_args *args) 1520 { 1521 1522 return (ENOTTY); 1523 } 1524 1525 /* 1526 * Sound related ioctls 1527 */ 1528 1529 static u_int32_t dirbits[4] = { IOC_VOID, IOC_IN, IOC_OUT, IOC_INOUT }; 1530 1531 #define SETDIR(c) (((c) & ~IOC_DIRMASK) | dirbits[args->cmd >> 30]) 1532 1533 static int 1534 linux_ioctl_sound(struct thread *td, struct linux_ioctl_args *args) 1535 { 1536 1537 switch (args->cmd & 0xffff) { 1538 1539 case LINUX_SOUND_MIXER_WRITE_VOLUME: 1540 args->cmd = SETDIR(SOUND_MIXER_WRITE_VOLUME); 1541 return (ioctl(td, (struct ioctl_args *)args)); 1542 1543 case LINUX_SOUND_MIXER_WRITE_BASS: 1544 args->cmd = SETDIR(SOUND_MIXER_WRITE_BASS); 1545 return (ioctl(td, (struct ioctl_args *)args)); 1546 1547 case LINUX_SOUND_MIXER_WRITE_TREBLE: 1548 args->cmd = SETDIR(SOUND_MIXER_WRITE_TREBLE); 1549 return (ioctl(td, (struct ioctl_args *)args)); 1550 1551 case LINUX_SOUND_MIXER_WRITE_SYNTH: 1552 args->cmd = SETDIR(SOUND_MIXER_WRITE_SYNTH); 1553 return (ioctl(td, (struct ioctl_args *)args)); 1554 1555 case LINUX_SOUND_MIXER_WRITE_PCM: 1556 args->cmd = SETDIR(SOUND_MIXER_WRITE_PCM); 1557 return (ioctl(td, (struct ioctl_args *)args)); 1558 1559 case LINUX_SOUND_MIXER_WRITE_SPEAKER: 1560 args->cmd = SETDIR(SOUND_MIXER_WRITE_SPEAKER); 1561 return (ioctl(td, (struct ioctl_args *)args)); 1562 1563 case LINUX_SOUND_MIXER_WRITE_LINE: 1564 args->cmd = SETDIR(SOUND_MIXER_WRITE_LINE); 1565 return (ioctl(td, (struct ioctl_args *)args)); 1566 1567 case LINUX_SOUND_MIXER_WRITE_MIC: 1568 args->cmd = SETDIR(SOUND_MIXER_WRITE_MIC); 1569 return (ioctl(td, (struct ioctl_args *)args)); 1570 1571 case LINUX_SOUND_MIXER_WRITE_CD: 1572 args->cmd = SETDIR(SOUND_MIXER_WRITE_CD); 1573 return (ioctl(td, (struct ioctl_args *)args)); 1574 1575 case LINUX_SOUND_MIXER_WRITE_IMIX: 1576 args->cmd = SETDIR(SOUND_MIXER_WRITE_IMIX); 1577 return (ioctl(td, (struct ioctl_args *)args)); 1578 1579 case LINUX_SOUND_MIXER_WRITE_ALTPCM: 1580 args->cmd = SETDIR(SOUND_MIXER_WRITE_ALTPCM); 1581 return (ioctl(td, (struct ioctl_args *)args)); 1582 1583 case LINUX_SOUND_MIXER_WRITE_RECLEV: 1584 args->cmd = SETDIR(SOUND_MIXER_WRITE_RECLEV); 1585 return (ioctl(td, (struct ioctl_args *)args)); 1586 1587 case LINUX_SOUND_MIXER_WRITE_IGAIN: 1588 args->cmd = SETDIR(SOUND_MIXER_WRITE_IGAIN); 1589 return (ioctl(td, (struct ioctl_args *)args)); 1590 1591 case LINUX_SOUND_MIXER_WRITE_OGAIN: 1592 args->cmd = SETDIR(SOUND_MIXER_WRITE_OGAIN); 1593 return (ioctl(td, (struct ioctl_args *)args)); 1594 1595 case LINUX_SOUND_MIXER_WRITE_LINE1: 1596 args->cmd = SETDIR(SOUND_MIXER_WRITE_LINE1); 1597 return (ioctl(td, (struct ioctl_args *)args)); 1598 1599 case LINUX_SOUND_MIXER_WRITE_LINE2: 1600 args->cmd = SETDIR(SOUND_MIXER_WRITE_LINE2); 1601 return (ioctl(td, (struct ioctl_args *)args)); 1602 1603 case LINUX_SOUND_MIXER_WRITE_LINE3: 1604 args->cmd = SETDIR(SOUND_MIXER_WRITE_LINE3); 1605 return (ioctl(td, (struct ioctl_args *)args)); 1606 1607 case LINUX_OSS_GETVERSION: { 1608 int version = linux_get_oss_version(td); 1609 return (copyout(&version, (void *)args->arg, sizeof(int))); 1610 } 1611 1612 case LINUX_SOUND_MIXER_READ_STEREODEVS: 1613 args->cmd = SOUND_MIXER_READ_STEREODEVS; 1614 return (ioctl(td, (struct ioctl_args *)args)); 1615 1616 case LINUX_SOUND_MIXER_READ_DEVMASK: 1617 args->cmd = SOUND_MIXER_READ_DEVMASK; 1618 return (ioctl(td, (struct ioctl_args *)args)); 1619 1620 case LINUX_SOUND_MIXER_WRITE_RECSRC: 1621 args->cmd = SETDIR(SOUND_MIXER_WRITE_RECSRC); 1622 return (ioctl(td, (struct ioctl_args *)args)); 1623 1624 case LINUX_SNDCTL_DSP_RESET: 1625 args->cmd = SNDCTL_DSP_RESET; 1626 return (ioctl(td, (struct ioctl_args *)args)); 1627 1628 case LINUX_SNDCTL_DSP_SYNC: 1629 args->cmd = SNDCTL_DSP_SYNC; 1630 return (ioctl(td, (struct ioctl_args *)args)); 1631 1632 case LINUX_SNDCTL_DSP_SPEED: 1633 args->cmd = SNDCTL_DSP_SPEED; 1634 return (ioctl(td, (struct ioctl_args *)args)); 1635 1636 case LINUX_SNDCTL_DSP_STEREO: 1637 args->cmd = SNDCTL_DSP_STEREO; 1638 return (ioctl(td, (struct ioctl_args *)args)); 1639 1640 case LINUX_SNDCTL_DSP_GETBLKSIZE: /* LINUX_SNDCTL_DSP_SETBLKSIZE */ 1641 args->cmd = SNDCTL_DSP_GETBLKSIZE; 1642 return (ioctl(td, (struct ioctl_args *)args)); 1643 1644 case LINUX_SNDCTL_DSP_SETFMT: 1645 args->cmd = SNDCTL_DSP_SETFMT; 1646 return (ioctl(td, (struct ioctl_args *)args)); 1647 1648 case LINUX_SOUND_PCM_WRITE_CHANNELS: 1649 args->cmd = SOUND_PCM_WRITE_CHANNELS; 1650 return (ioctl(td, (struct ioctl_args *)args)); 1651 1652 case LINUX_SOUND_PCM_WRITE_FILTER: 1653 args->cmd = SOUND_PCM_WRITE_FILTER; 1654 return (ioctl(td, (struct ioctl_args *)args)); 1655 1656 case LINUX_SNDCTL_DSP_POST: 1657 args->cmd = SNDCTL_DSP_POST; 1658 return (ioctl(td, (struct ioctl_args *)args)); 1659 1660 case LINUX_SNDCTL_DSP_SUBDIVIDE: 1661 args->cmd = SNDCTL_DSP_SUBDIVIDE; 1662 return (ioctl(td, (struct ioctl_args *)args)); 1663 1664 case LINUX_SNDCTL_DSP_SETFRAGMENT: 1665 args->cmd = SNDCTL_DSP_SETFRAGMENT; 1666 return (ioctl(td, (struct ioctl_args *)args)); 1667 1668 case LINUX_SNDCTL_DSP_GETFMTS: 1669 args->cmd = SNDCTL_DSP_GETFMTS; 1670 return (ioctl(td, (struct ioctl_args *)args)); 1671 1672 case LINUX_SNDCTL_DSP_GETOSPACE: 1673 args->cmd = SNDCTL_DSP_GETOSPACE; 1674 return (ioctl(td, (struct ioctl_args *)args)); 1675 1676 case LINUX_SNDCTL_DSP_GETISPACE: 1677 args->cmd = SNDCTL_DSP_GETISPACE; 1678 return (ioctl(td, (struct ioctl_args *)args)); 1679 1680 case LINUX_SNDCTL_DSP_NONBLOCK: 1681 args->cmd = SNDCTL_DSP_NONBLOCK; 1682 return (ioctl(td, (struct ioctl_args *)args)); 1683 1684 case LINUX_SNDCTL_DSP_GETCAPS: 1685 args->cmd = SNDCTL_DSP_GETCAPS; 1686 return (ioctl(td, (struct ioctl_args *)args)); 1687 1688 case LINUX_SNDCTL_DSP_SETTRIGGER: /* LINUX_SNDCTL_GETTRIGGER */ 1689 args->cmd = SNDCTL_DSP_SETTRIGGER; 1690 return (ioctl(td, (struct ioctl_args *)args)); 1691 1692 case LINUX_SNDCTL_DSP_GETIPTR: 1693 args->cmd = SNDCTL_DSP_GETIPTR; 1694 return (ioctl(td, (struct ioctl_args *)args)); 1695 1696 case LINUX_SNDCTL_DSP_GETOPTR: 1697 args->cmd = SNDCTL_DSP_GETOPTR; 1698 return (ioctl(td, (struct ioctl_args *)args)); 1699 1700 case LINUX_SNDCTL_DSP_GETODELAY: 1701 args->cmd = SNDCTL_DSP_GETODELAY; 1702 return (ioctl(td, (struct ioctl_args *)args)); 1703 1704 case LINUX_SNDCTL_SEQ_RESET: 1705 args->cmd = SNDCTL_SEQ_RESET; 1706 return (ioctl(td, (struct ioctl_args *)args)); 1707 1708 case LINUX_SNDCTL_SEQ_SYNC: 1709 args->cmd = SNDCTL_SEQ_SYNC; 1710 return (ioctl(td, (struct ioctl_args *)args)); 1711 1712 case LINUX_SNDCTL_SYNTH_INFO: 1713 args->cmd = SNDCTL_SYNTH_INFO; 1714 return (ioctl(td, (struct ioctl_args *)args)); 1715 1716 case LINUX_SNDCTL_SEQ_CTRLRATE: 1717 args->cmd = SNDCTL_SEQ_CTRLRATE; 1718 return (ioctl(td, (struct ioctl_args *)args)); 1719 1720 case LINUX_SNDCTL_SEQ_GETOUTCOUNT: 1721 args->cmd = SNDCTL_SEQ_GETOUTCOUNT; 1722 return (ioctl(td, (struct ioctl_args *)args)); 1723 1724 case LINUX_SNDCTL_SEQ_GETINCOUNT: 1725 args->cmd = SNDCTL_SEQ_GETINCOUNT; 1726 return (ioctl(td, (struct ioctl_args *)args)); 1727 1728 case LINUX_SNDCTL_SEQ_PERCMODE: 1729 args->cmd = SNDCTL_SEQ_PERCMODE; 1730 return (ioctl(td, (struct ioctl_args *)args)); 1731 1732 case LINUX_SNDCTL_FM_LOAD_INSTR: 1733 args->cmd = SNDCTL_FM_LOAD_INSTR; 1734 return (ioctl(td, (struct ioctl_args *)args)); 1735 1736 case LINUX_SNDCTL_SEQ_TESTMIDI: 1737 args->cmd = SNDCTL_SEQ_TESTMIDI; 1738 return (ioctl(td, (struct ioctl_args *)args)); 1739 1740 case LINUX_SNDCTL_SEQ_RESETSAMPLES: 1741 args->cmd = SNDCTL_SEQ_RESETSAMPLES; 1742 return (ioctl(td, (struct ioctl_args *)args)); 1743 1744 case LINUX_SNDCTL_SEQ_NRSYNTHS: 1745 args->cmd = SNDCTL_SEQ_NRSYNTHS; 1746 return (ioctl(td, (struct ioctl_args *)args)); 1747 1748 case LINUX_SNDCTL_SEQ_NRMIDIS: 1749 args->cmd = SNDCTL_SEQ_NRMIDIS; 1750 return (ioctl(td, (struct ioctl_args *)args)); 1751 1752 case LINUX_SNDCTL_MIDI_INFO: 1753 args->cmd = SNDCTL_MIDI_INFO; 1754 return (ioctl(td, (struct ioctl_args *)args)); 1755 1756 case LINUX_SNDCTL_SEQ_TRESHOLD: 1757 args->cmd = SNDCTL_SEQ_TRESHOLD; 1758 return (ioctl(td, (struct ioctl_args *)args)); 1759 1760 case LINUX_SNDCTL_SYNTH_MEMAVL: 1761 args->cmd = SNDCTL_SYNTH_MEMAVL; 1762 return (ioctl(td, (struct ioctl_args *)args)); 1763 1764 } 1765 1766 return (ENOIOCTL); 1767 } 1768 1769 /* 1770 * Console related ioctls 1771 */ 1772 1773 #define ISSIGVALID(sig) ((sig) > 0 && (sig) < NSIG) 1774 1775 static int 1776 linux_ioctl_console(struct thread *td, struct linux_ioctl_args *args) 1777 { 1778 struct file *fp; 1779 int error; 1780 1781 if ((error = fget(td, args->fd, &fp)) != 0) 1782 return (error); 1783 switch (args->cmd & 0xffff) { 1784 1785 case LINUX_KIOCSOUND: 1786 args->cmd = KIOCSOUND; 1787 error = (ioctl(td, (struct ioctl_args *)args)); 1788 break; 1789 1790 case LINUX_KDMKTONE: 1791 args->cmd = KDMKTONE; 1792 error = (ioctl(td, (struct ioctl_args *)args)); 1793 break; 1794 1795 case LINUX_KDGETLED: 1796 args->cmd = KDGETLED; 1797 error = (ioctl(td, (struct ioctl_args *)args)); 1798 break; 1799 1800 case LINUX_KDSETLED: 1801 args->cmd = KDSETLED; 1802 error = (ioctl(td, (struct ioctl_args *)args)); 1803 break; 1804 1805 case LINUX_KDSETMODE: 1806 args->cmd = KDSETMODE; 1807 error = (ioctl(td, (struct ioctl_args *)args)); 1808 break; 1809 1810 case LINUX_KDGETMODE: 1811 args->cmd = KDGETMODE; 1812 error = (ioctl(td, (struct ioctl_args *)args)); 1813 break; 1814 1815 case LINUX_KDGKBMODE: 1816 args->cmd = KDGKBMODE; 1817 error = (ioctl(td, (struct ioctl_args *)args)); 1818 break; 1819 1820 case LINUX_KDSKBMODE: { 1821 int kbdmode; 1822 switch (args->arg) { 1823 case LINUX_KBD_RAW: 1824 kbdmode = K_RAW; 1825 break; 1826 case LINUX_KBD_XLATE: 1827 kbdmode = K_XLATE; 1828 break; 1829 case LINUX_KBD_MEDIUMRAW: 1830 kbdmode = K_RAW; 1831 break; 1832 default: 1833 fdrop(fp, td); 1834 return (EINVAL); 1835 } 1836 error = (fo_ioctl(fp, KDSKBMODE, (caddr_t)&kbdmode, 1837 td->td_ucred, td)); 1838 break; 1839 } 1840 1841 case LINUX_VT_OPENQRY: 1842 args->cmd = VT_OPENQRY; 1843 error = (ioctl(td, (struct ioctl_args *)args)); 1844 break; 1845 1846 case LINUX_VT_GETMODE: 1847 args->cmd = VT_GETMODE; 1848 error = (ioctl(td, (struct ioctl_args *)args)); 1849 break; 1850 1851 case LINUX_VT_SETMODE: { 1852 struct vt_mode *mode; 1853 args->cmd = VT_SETMODE; 1854 mode = (struct vt_mode *)args->arg; 1855 if (!ISSIGVALID(mode->frsig) && ISSIGVALID(mode->acqsig)) 1856 mode->frsig = mode->acqsig; 1857 error = (ioctl(td, (struct ioctl_args *)args)); 1858 break; 1859 } 1860 1861 case LINUX_VT_GETSTATE: 1862 args->cmd = VT_GETACTIVE; 1863 error = (ioctl(td, (struct ioctl_args *)args)); 1864 break; 1865 1866 case LINUX_VT_RELDISP: 1867 args->cmd = VT_RELDISP; 1868 error = (ioctl(td, (struct ioctl_args *)args)); 1869 break; 1870 1871 case LINUX_VT_ACTIVATE: 1872 args->cmd = VT_ACTIVATE; 1873 error = (ioctl(td, (struct ioctl_args *)args)); 1874 break; 1875 1876 case LINUX_VT_WAITACTIVE: 1877 args->cmd = VT_WAITACTIVE; 1878 error = (ioctl(td, (struct ioctl_args *)args)); 1879 break; 1880 1881 default: 1882 error = ENOIOCTL; 1883 break; 1884 } 1885 1886 fdrop(fp, td); 1887 return (error); 1888 } 1889 1890 /* 1891 * Criteria for interface name translation 1892 */ 1893 #define IFP_IS_ETH(ifp) (ifp->if_type == IFT_ETHER) 1894 1895 /* 1896 * Interface function used by linprocfs (at the time of writing). It's not 1897 * used by the Linuxulator itself. 1898 */ 1899 int 1900 linux_ifname(struct ifnet *ifp, char *buffer, size_t buflen) 1901 { 1902 struct ifnet *ifscan; 1903 int ethno; 1904 1905 /* Short-circuit non ethernet interfaces */ 1906 if (!IFP_IS_ETH(ifp)) 1907 return (snprintf(buffer, buflen, "%s%d", ifp->if_name, 1908 ifp->if_unit)); 1909 1910 /* Determine the (relative) unit number for ethernet interfaces */ 1911 ethno = 0; 1912 IFNET_RLOCK(); 1913 TAILQ_FOREACH(ifscan, &ifnet, if_link) { 1914 if (ifscan == ifp) { 1915 IFNET_RUNLOCK(); 1916 return (snprintf(buffer, buflen, "eth%d", ethno)); 1917 } 1918 if (IFP_IS_ETH(ifscan)) 1919 ethno++; 1920 } 1921 IFNET_RUNLOCK(); 1922 1923 return (0); 1924 } 1925 1926 /* 1927 * Translate a Linux interface name to a FreeBSD interface name, 1928 * and return the associated ifnet structure 1929 * bsdname and lxname need to be least IFNAMSIZ bytes long, but 1930 * can point to the same buffer. 1931 */ 1932 1933 static struct ifnet * 1934 ifname_linux_to_bsd(const char *lxname, char *bsdname) 1935 { 1936 struct ifnet *ifp; 1937 int len, unit; 1938 char *ep; 1939 int is_eth, index; 1940 1941 for (len = 0; len < LINUX_IFNAMSIZ; ++len) 1942 if (!isalpha(lxname[len])) 1943 break; 1944 if (len == 0 || len == LINUX_IFNAMSIZ) 1945 return (NULL); 1946 unit = (int)strtoul(lxname + len, &ep, 10); 1947 if (ep == NULL || ep == lxname + len || ep >= lxname + LINUX_IFNAMSIZ) 1948 return (NULL); 1949 index = 0; 1950 is_eth = (len == 3 && !strncmp(lxname, "eth", len)) ? 1 : 0; 1951 IFNET_RLOCK(); 1952 TAILQ_FOREACH(ifp, &ifnet, if_link) { 1953 /* 1954 * Allow Linux programs to use FreeBSD names. Don't presume 1955 * we never have an interface named "eth", so don't make 1956 * the test optional based on is_eth. 1957 */ 1958 if (ifp->if_unit == unit && ifp->if_name[len] == '\0' && 1959 strncmp(ifp->if_name, lxname, len) == 0) 1960 break; 1961 if (is_eth && IFP_IS_ETH(ifp) && unit == index++) 1962 break; 1963 } 1964 IFNET_RUNLOCK(); 1965 if (ifp != NULL) 1966 snprintf(bsdname, IFNAMSIZ, "%s%d", ifp->if_name, ifp->if_unit); 1967 return (ifp); 1968 } 1969 1970 /* 1971 * Implement the SIOCGIFCONF ioctl 1972 */ 1973 1974 static int 1975 linux_ifconf(struct thread *td, struct ifconf *uifc) 1976 { 1977 struct ifconf ifc; 1978 struct l_ifreq ifr; 1979 struct ifnet *ifp; 1980 struct ifaddr *ifa; 1981 struct iovec iov; 1982 struct uio uio; 1983 int error, ethno; 1984 1985 error = copyin(uifc, &ifc, sizeof(ifc)); 1986 if (error != 0) 1987 return (error); 1988 1989 /* much easier to use uiomove than keep track ourselves */ 1990 iov.iov_base = ifc.ifc_buf; 1991 iov.iov_len = ifc.ifc_len; 1992 uio.uio_iov = &iov; 1993 uio.uio_iovcnt = 1; 1994 uio.uio_offset = 0; 1995 uio.uio_resid = ifc.ifc_len; 1996 uio.uio_segflg = UIO_USERSPACE; 1997 uio.uio_rw = UIO_READ; 1998 uio.uio_td = td; 1999 2000 /* Keep track of eth interfaces */ 2001 ethno = 0; 2002 2003 /* Return all AF_INET addresses of all interfaces */ 2004 IFNET_RLOCK(); /* could sleep XXX */ 2005 TAILQ_FOREACH(ifp, &ifnet, if_link) { 2006 if (uio.uio_resid <= 0) 2007 break; 2008 2009 bzero(&ifr, sizeof(ifr)); 2010 if (IFP_IS_ETH(ifp)) 2011 snprintf(ifr.ifr_name, LINUX_IFNAMSIZ, "eth%d", 2012 ethno++); 2013 else 2014 snprintf(ifr.ifr_name, LINUX_IFNAMSIZ, "%s%d", 2015 ifp->if_name, ifp->if_unit); 2016 2017 /* Walk the address list */ 2018 TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) { 2019 struct sockaddr *sa = ifa->ifa_addr; 2020 2021 if (uio.uio_resid <= 0) 2022 break; 2023 2024 if (sa->sa_family == AF_INET) { 2025 ifr.ifr_addr.sa_family = LINUX_AF_INET; 2026 memcpy(ifr.ifr_addr.sa_data, sa->sa_data, 2027 sizeof(ifr.ifr_addr.sa_data)); 2028 2029 error = uiomove(&ifr, sizeof(ifr), &uio); 2030 if (error != 0) { 2031 IFNET_RUNLOCK(); 2032 return (error); 2033 } 2034 } 2035 } 2036 } 2037 IFNET_RUNLOCK(); 2038 2039 ifc.ifc_len -= uio.uio_resid; 2040 error = copyout(&ifc, uifc, sizeof(ifc)); 2041 2042 return (error); 2043 } 2044 2045 static int 2046 linux_gifflags(struct thread *td, struct ifnet *ifp, struct l_ifreq *ifr) 2047 { 2048 l_short flags; 2049 2050 flags = ifp->if_flags & 0xffff; 2051 /* these flags have no Linux equivalent */ 2052 flags &= ~(IFF_SMART|IFF_OACTIVE|IFF_SIMPLEX| 2053 IFF_LINK0|IFF_LINK1|IFF_LINK2); 2054 /* Linux' multicast flag is in a different bit */ 2055 if (flags & IFF_MULTICAST) { 2056 flags &= ~IFF_MULTICAST; 2057 flags |= 0x1000; 2058 } 2059 2060 return (copyout(&flags, &ifr->ifr_flags, sizeof(flags))); 2061 } 2062 2063 #define ARPHRD_ETHER 1 2064 #define ARPHRD_LOOPBACK 772 2065 2066 static int 2067 linux_gifhwaddr(struct ifnet *ifp, struct l_ifreq *ifr) 2068 { 2069 struct ifaddr *ifa; 2070 struct sockaddr_dl *sdl; 2071 struct l_sockaddr lsa; 2072 2073 if (ifp->if_type == IFT_LOOP) { 2074 bzero(&lsa, sizeof(lsa)); 2075 lsa.sa_family = ARPHRD_LOOPBACK; 2076 return (copyout(&lsa, &ifr->ifr_hwaddr, sizeof(lsa))); 2077 } 2078 2079 if (ifp->if_type != IFT_ETHER) 2080 return (ENOENT); 2081 2082 TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) { 2083 sdl = (struct sockaddr_dl*)ifa->ifa_addr; 2084 if (sdl != NULL && (sdl->sdl_family == AF_LINK) && 2085 (sdl->sdl_type == IFT_ETHER)) { 2086 bzero(&lsa, sizeof(lsa)); 2087 lsa.sa_family = ARPHRD_ETHER; 2088 bcopy(LLADDR(sdl), lsa.sa_data, LINUX_IFHWADDRLEN); 2089 return (copyout(&lsa, &ifr->ifr_hwaddr, sizeof(lsa))); 2090 } 2091 } 2092 2093 return (ENOENT); 2094 } 2095 2096 /* 2097 * Socket related ioctls 2098 */ 2099 2100 static int 2101 linux_ioctl_socket(struct thread *td, struct linux_ioctl_args *args) 2102 { 2103 char lifname[LINUX_IFNAMSIZ], ifname[IFNAMSIZ]; 2104 struct ifnet *ifp; 2105 struct file *fp; 2106 int error, type; 2107 2108 KASSERT(LINUX_IFNAMSIZ == IFNAMSIZ, 2109 ("%s(): LINUX_IFNAMSIZ != IFNAMSIZ", __func__)); 2110 2111 ifp = NULL; 2112 error = 0; 2113 2114 if ((error = fget(td, args->fd, &fp)) != 0) 2115 return (error); 2116 type = fp->f_type; 2117 fdrop(fp, td); 2118 if (type != DTYPE_SOCKET) { 2119 /* not a socket - probably a tap / vmnet device */ 2120 switch (args->cmd) { 2121 case LINUX_SIOCGIFADDR: 2122 case LINUX_SIOCSIFADDR: 2123 case LINUX_SIOCGIFFLAGS: 2124 return (linux_ioctl_special(td, args)); 2125 default: 2126 return (ENOIOCTL); 2127 } 2128 } 2129 2130 switch (args->cmd & 0xffff) { 2131 2132 case LINUX_FIOGETOWN: 2133 case LINUX_FIOSETOWN: 2134 case LINUX_SIOCADDMULTI: 2135 case LINUX_SIOCATMARK: 2136 case LINUX_SIOCDELMULTI: 2137 case LINUX_SIOCGIFCONF: 2138 case LINUX_SIOCGPGRP: 2139 case LINUX_SIOCSPGRP: 2140 /* these ioctls don't take an interface name */ 2141 #ifdef DEBUG 2142 printf("%s(): ioctl %d\n", __func__, 2143 args->cmd & 0xffff); 2144 #endif 2145 break; 2146 2147 case LINUX_SIOCGIFFLAGS: 2148 case LINUX_SIOCGIFADDR: 2149 case LINUX_SIOCSIFADDR: 2150 case LINUX_SIOCGIFDSTADDR: 2151 case LINUX_SIOCGIFBRDADDR: 2152 case LINUX_SIOCGIFNETMASK: 2153 case LINUX_SIOCSIFNETMASK: 2154 case LINUX_SIOCGIFMTU: 2155 case LINUX_SIOCSIFMTU: 2156 case LINUX_SIOCSIFNAME: 2157 case LINUX_SIOCGIFHWADDR: 2158 case LINUX_SIOCSIFHWADDR: 2159 case LINUX_SIOCDEVPRIVATE: 2160 case LINUX_SIOCDEVPRIVATE+1: 2161 /* copy in the interface name and translate it. */ 2162 error = copyin((void *)args->arg, lifname, LINUX_IFNAMSIZ); 2163 if (error != 0) 2164 return (error); 2165 #ifdef DEBUG 2166 printf("%s(): ioctl %d on %.*s\n", __func__, 2167 args->cmd & 0xffff, LINUX_IFNAMSIZ, lifname); 2168 #endif 2169 ifp = ifname_linux_to_bsd(lifname, ifname); 2170 if (ifp == NULL) 2171 return (EINVAL); 2172 /* 2173 * We need to copy it back out in case we pass the 2174 * request on to our native ioctl(), which will expect 2175 * the ifreq to be in user space and have the correct 2176 * interface name. 2177 */ 2178 error = copyout(ifname, (void *)args->arg, IFNAMSIZ); 2179 if (error != 0) 2180 return (error); 2181 #ifdef DEBUG 2182 printf("%s(): %s translated to %s\n", __func__, 2183 lifname, ifname); 2184 #endif 2185 break; 2186 2187 default: 2188 return (ENOIOCTL); 2189 } 2190 2191 switch (args->cmd & 0xffff) { 2192 2193 case LINUX_FIOSETOWN: 2194 args->cmd = FIOSETOWN; 2195 error = ioctl(td, (struct ioctl_args *)args); 2196 break; 2197 2198 case LINUX_SIOCSPGRP: 2199 args->cmd = SIOCSPGRP; 2200 error = ioctl(td, (struct ioctl_args *)args); 2201 break; 2202 2203 case LINUX_FIOGETOWN: 2204 args->cmd = FIOGETOWN; 2205 error = ioctl(td, (struct ioctl_args *)args); 2206 break; 2207 2208 case LINUX_SIOCGPGRP: 2209 args->cmd = SIOCGPGRP; 2210 error = ioctl(td, (struct ioctl_args *)args); 2211 break; 2212 2213 case LINUX_SIOCATMARK: 2214 args->cmd = SIOCATMARK; 2215 error = ioctl(td, (struct ioctl_args *)args); 2216 break; 2217 2218 /* LINUX_SIOCGSTAMP */ 2219 2220 case LINUX_SIOCGIFCONF: 2221 error = linux_ifconf(td, (struct ifconf *)args->arg); 2222 break; 2223 2224 case LINUX_SIOCGIFFLAGS: 2225 args->cmd = SIOCGIFFLAGS; 2226 error = linux_gifflags(td, ifp, (struct l_ifreq *)args->arg); 2227 break; 2228 2229 case LINUX_SIOCGIFADDR: 2230 args->cmd = OSIOCGIFADDR; 2231 error = ioctl(td, (struct ioctl_args *)args); 2232 break; 2233 2234 case LINUX_SIOCSIFADDR: 2235 /* XXX probably doesn't work, included for completeness */ 2236 args->cmd = SIOCSIFADDR; 2237 error = ioctl(td, (struct ioctl_args *)args); 2238 break; 2239 2240 case LINUX_SIOCGIFDSTADDR: 2241 args->cmd = OSIOCGIFDSTADDR; 2242 error = ioctl(td, (struct ioctl_args *)args); 2243 break; 2244 2245 case LINUX_SIOCGIFBRDADDR: 2246 args->cmd = OSIOCGIFBRDADDR; 2247 error = ioctl(td, (struct ioctl_args *)args); 2248 break; 2249 2250 case LINUX_SIOCGIFNETMASK: 2251 args->cmd = OSIOCGIFNETMASK; 2252 error = ioctl(td, (struct ioctl_args *)args); 2253 break; 2254 2255 case LINUX_SIOCSIFNETMASK: 2256 error = ENOIOCTL; 2257 break; 2258 2259 case LINUX_SIOCGIFMTU: 2260 args->cmd = SIOCGIFMTU; 2261 error = ioctl(td, (struct ioctl_args *)args); 2262 break; 2263 2264 case LINUX_SIOCSIFMTU: 2265 args->cmd = SIOCSIFMTU; 2266 error = ioctl(td, (struct ioctl_args *)args); 2267 break; 2268 2269 case LINUX_SIOCSIFNAME: 2270 error = ENOIOCTL; 2271 break; 2272 2273 case LINUX_SIOCGIFHWADDR: 2274 error = linux_gifhwaddr(ifp, (struct l_ifreq *)args->arg); 2275 break; 2276 2277 case LINUX_SIOCSIFHWADDR: 2278 error = ENOIOCTL; 2279 break; 2280 2281 case LINUX_SIOCADDMULTI: 2282 args->cmd = SIOCADDMULTI; 2283 error = ioctl(td, (struct ioctl_args *)args); 2284 break; 2285 2286 case LINUX_SIOCDELMULTI: 2287 args->cmd = SIOCDELMULTI; 2288 error = ioctl(td, (struct ioctl_args *)args); 2289 break; 2290 2291 /* 2292 * XXX This is slightly bogus, but these ioctls are currently 2293 * XXX only used by the aironet (if_an) network driver. 2294 */ 2295 case LINUX_SIOCDEVPRIVATE: 2296 args->cmd = SIOCGPRIVATE_0; 2297 error = ioctl(td, (struct ioctl_args *)args); 2298 break; 2299 2300 case LINUX_SIOCDEVPRIVATE+1: 2301 args->cmd = SIOCGPRIVATE_1; 2302 error = ioctl(td, (struct ioctl_args *)args); 2303 break; 2304 } 2305 2306 if (ifp != NULL) 2307 /* restore the original interface name */ 2308 copyout(lifname, (void *)args->arg, LINUX_IFNAMSIZ); 2309 2310 #ifdef DEBUG 2311 printf("%s(): returning %d\n", __func__, error); 2312 #endif 2313 return (error); 2314 } 2315 2316 /* 2317 * Device private ioctl handler 2318 */ 2319 static int 2320 linux_ioctl_private(struct thread *td, struct linux_ioctl_args *args) 2321 { 2322 struct file *fp; 2323 int error, type; 2324 2325 if ((error = fget(td, args->fd, &fp)) != 0) 2326 return (error); 2327 type = fp->f_type; 2328 fdrop(fp, td); 2329 if (type == DTYPE_SOCKET) 2330 return (linux_ioctl_socket(td, args)); 2331 return (ENOIOCTL); 2332 } 2333 2334 /* 2335 * Special ioctl handler 2336 */ 2337 static int 2338 linux_ioctl_special(struct thread *td, struct linux_ioctl_args *args) 2339 { 2340 int error; 2341 2342 switch (args->cmd) { 2343 case LINUX_SIOCGIFADDR: 2344 args->cmd = SIOCGIFADDR; 2345 error = ioctl(td, (struct ioctl_args *)args); 2346 break; 2347 case LINUX_SIOCSIFADDR: 2348 args->cmd = SIOCSIFADDR; 2349 error = ioctl(td, (struct ioctl_args *)args); 2350 break; 2351 case LINUX_SIOCGIFFLAGS: 2352 args->cmd = SIOCGIFFLAGS; 2353 error = ioctl(td, (struct ioctl_args *)args); 2354 break; 2355 default: 2356 error = ENOIOCTL; 2357 } 2358 2359 return (error); 2360 } 2361 2362 /* 2363 * main ioctl syscall function 2364 */ 2365 2366 int 2367 linux_ioctl(struct thread *td, struct linux_ioctl_args *args) 2368 { 2369 struct file *fp; 2370 struct handler_element *he; 2371 int error, cmd; 2372 2373 #ifdef DEBUG 2374 if (ldebug(ioctl)) 2375 printf(ARGS(ioctl, "%d, %04lx, *"), args->fd, 2376 (unsigned long)args->cmd); 2377 #endif 2378 2379 if ((error = fget(td, args->fd, &fp)) != 0) 2380 return (error); 2381 if ((fp->f_flag & (FREAD|FWRITE)) == 0) { 2382 fdrop(fp, td); 2383 return (EBADF); 2384 } 2385 2386 /* Iterate over the ioctl handlers */ 2387 cmd = args->cmd & 0xffff; 2388 TAILQ_FOREACH(he, &handlers, list) { 2389 if (cmd >= he->low && cmd <= he->high) { 2390 error = (*he->func)(td, args); 2391 if (error != ENOIOCTL) { 2392 fdrop(fp, td); 2393 return (error); 2394 } 2395 } 2396 } 2397 fdrop(fp, td); 2398 2399 linux_msg(td, "ioctl fd=%d, cmd=0x%x ('%c',%d) is not implemented", 2400 args->fd, (int)(args->cmd & 0xffff), 2401 (int)(args->cmd & 0xff00) >> 8, (int)(args->cmd & 0xff)); 2402 2403 return (EINVAL); 2404 } 2405 2406 int 2407 linux_ioctl_register_handler(struct linux_ioctl_handler *h) 2408 { 2409 struct handler_element *he, *cur; 2410 2411 if (h == NULL || h->func == NULL) 2412 return (EINVAL); 2413 2414 /* 2415 * Reuse the element if the handler is already on the list, otherwise 2416 * create a new element. 2417 */ 2418 TAILQ_FOREACH(he, &handlers, list) { 2419 if (he->func == h->func) 2420 break; 2421 } 2422 if (he == NULL) { 2423 MALLOC(he, struct handler_element *, sizeof(*he), 2424 M_LINUX, M_WAITOK); 2425 he->func = h->func; 2426 } else 2427 TAILQ_REMOVE(&handlers, he, list); 2428 2429 /* Initialize range information. */ 2430 he->low = h->low; 2431 he->high = h->high; 2432 he->span = h->high - h->low + 1; 2433 2434 /* Add the element to the list, sorted on span. */ 2435 TAILQ_FOREACH(cur, &handlers, list) { 2436 if (cur->span > he->span) { 2437 TAILQ_INSERT_BEFORE(cur, he, list); 2438 return (0); 2439 } 2440 } 2441 TAILQ_INSERT_TAIL(&handlers, he, list); 2442 2443 return (0); 2444 } 2445 2446 int 2447 linux_ioctl_unregister_handler(struct linux_ioctl_handler *h) 2448 { 2449 struct handler_element *he; 2450 2451 if (h == NULL || h->func == NULL) 2452 return (EINVAL); 2453 2454 TAILQ_FOREACH(he, &handlers, list) { 2455 if (he->func == h->func) { 2456 TAILQ_REMOVE(&handlers, he, list); 2457 FREE(he, M_LINUX); 2458 return (0); 2459 } 2460 } 2461 2462 return (EINVAL); 2463 } 2464