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