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