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