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