sys/compat/linux/linux_ioctl.c

   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 "opt_compat.h"
  30
  31 #include <sys/cdefs.h>
  32 __FBSDID("$FreeBSD$");
  33
  34 #include <sys/param.h>
  35 #include <sys/systm.h>
  36 #include <sys/sysproto.h>
  37 #include <sys/capability.h>
  38 #include <sys/cdio.h>
  39 #include <sys/dvdio.h>
  40 #include <sys/conf.h>
  41 #include <sys/disk.h>
  42 #include <sys/consio.h>
  43 #include <sys/ctype.h>
  44 #include <sys/fcntl.h>
  45 #include <sys/file.h>
  46 #include <sys/filedesc.h>
  47 #include <sys/filio.h>
  48 #include <sys/jail.h>
  49 #include <sys/kbio.h>
  50 #include <sys/kernel.h>
  51 #include <sys/linker_set.h>
  52 #include <sys/lock.h>
  53 #include <sys/malloc.h>
  54 #include <sys/proc.h>
  55 #include <sys/sbuf.h>
  56 #include <sys/socket.h>
  57 #include <sys/sockio.h>
  58 #include <sys/soundcard.h>
  59 #include <sys/stdint.h>
  60 #include <sys/sx.h>
  61 #include <sys/sysctl.h>
  62 #include <sys/tty.h>
  63 #include <sys/uio.h>
  64 #include <sys/types.h>
  65 #include <sys/mman.h>
  66 #include <sys/resourcevar.h>
  67
  68 #include <net/if.h>
  69 #include <net/if_dl.h>
  70 #include <net/if_types.h>
  71 #include <net/vnet.h>
  72
  73 #include <dev/usb/usb_ioctl.h>
  74
  75 #ifdef COMPAT_LINUX32
  76 #include <machine/../linux32/linux.h>
  77 #include <machine/../linux32/linux32_proto.h>
  78 #else
  79 #include <machine/../linux/linux.h>
  80 #include <machine/../linux/linux_proto.h>
  81 #endif
  82
  83 #include <compat/linux/linux_ioctl.h>
  84 #include <compat/linux/linux_mib.h>
  85 #include <compat/linux/linux_socket.h>
  86 #include <compat/linux/linux_util.h>
  87
  88 #include <contrib/v4l/videodev.h>
  89 #include <compat/linux/linux_videodev_compat.h>
  90
  91 #include <contrib/v4l/videodev2.h>
  92 #include <compat/linux/linux_videodev2_compat.h>
  93
  94 CTASSERT(LINUX_IFNAMSIZ == IFNAMSIZ);
  95
  96 FEATURE(linuxulator_v4l, "V4L ioctl wrapper support in the linuxulator");
  97 FEATURE(linuxulator_v4l2, "V4L2 ioctl wrapper support in the linuxulator");
  98
  99 static linux_ioctl_function_t linux_ioctl_cdrom;
 100 static linux_ioctl_function_t linux_ioctl_vfat;
 101 static linux_ioctl_function_t linux_ioctl_console;
 102 static linux_ioctl_function_t linux_ioctl_hdio;
 103 static linux_ioctl_function_t linux_ioctl_disk;
 104 static linux_ioctl_function_t linux_ioctl_socket;
 105 static linux_ioctl_function_t linux_ioctl_sound;
 106 static linux_ioctl_function_t linux_ioctl_termio;
 107 static linux_ioctl_function_t linux_ioctl_private;
 108 static linux_ioctl_function_t linux_ioctl_drm;
 109 static linux_ioctl_function_t linux_ioctl_sg;
 110 static linux_ioctl_function_t linux_ioctl_v4l;
 111 static linux_ioctl_function_t linux_ioctl_v4l2;
 112 static linux_ioctl_function_t linux_ioctl_special;
 113 static linux_ioctl_function_t linux_ioctl_fbsd_usb;
 114
 115 static struct linux_ioctl_handler cdrom_handler =
 116 { linux_ioctl_cdrom, LINUX_IOCTL_CDROM_MIN, LINUX_IOCTL_CDROM_MAX };
 117 static struct linux_ioctl_handler vfat_handler =
 118 { linux_ioctl_vfat, LINUX_IOCTL_VFAT_MIN, LINUX_IOCTL_VFAT_MAX };
 119 static struct linux_ioctl_handler console_handler =
 120 { linux_ioctl_console, LINUX_IOCTL_CONSOLE_MIN, LINUX_IOCTL_CONSOLE_MAX };
 121 static struct linux_ioctl_handler hdio_handler =
 122 { linux_ioctl_hdio, LINUX_IOCTL_HDIO_MIN, LINUX_IOCTL_HDIO_MAX };
 123 static struct linux_ioctl_handler disk_handler =
 124 { linux_ioctl_disk, LINUX_IOCTL_DISK_MIN, LINUX_IOCTL_DISK_MAX };
 125 static struct linux_ioctl_handler socket_handler =
 126 { linux_ioctl_socket, LINUX_IOCTL_SOCKET_MIN, LINUX_IOCTL_SOCKET_MAX };
 127 static struct linux_ioctl_handler sound_handler =
 128 { linux_ioctl_sound, LINUX_IOCTL_SOUND_MIN, LINUX_IOCTL_SOUND_MAX };
 129 static struct linux_ioctl_handler termio_handler =
 130 { linux_ioctl_termio, LINUX_IOCTL_TERMIO_MIN, LINUX_IOCTL_TERMIO_MAX };
 131 static struct linux_ioctl_handler private_handler =
 132 { linux_ioctl_private, LINUX_IOCTL_PRIVATE_MIN, LINUX_IOCTL_PRIVATE_MAX };
 133 static struct linux_ioctl_handler drm_handler =
 134 { linux_ioctl_drm, LINUX_IOCTL_DRM_MIN, LINUX_IOCTL_DRM_MAX };
 135 static struct linux_ioctl_handler sg_handler =
 136 { linux_ioctl_sg, LINUX_IOCTL_SG_MIN, LINUX_IOCTL_SG_MAX };
 137 static struct linux_ioctl_handler video_handler =
 138 { linux_ioctl_v4l, LINUX_IOCTL_VIDEO_MIN, LINUX_IOCTL_VIDEO_MAX };
 139 static struct linux_ioctl_handler video2_handler =
 140 { linux_ioctl_v4l2, LINUX_IOCTL_VIDEO2_MIN, LINUX_IOCTL_VIDEO2_MAX };
 141 static struct linux_ioctl_handler fbsd_usb =
 142 { linux_ioctl_fbsd_usb, FBSD_LUSB_MIN, FBSD_LUSB_MAX };
 143
 144 DATA_SET(linux_ioctl_handler_set, cdrom_handler);
 145 DATA_SET(linux_ioctl_handler_set, vfat_handler);
 146 DATA_SET(linux_ioctl_handler_set, console_handler);
 147 DATA_SET(linux_ioctl_handler_set, hdio_handler);
 148 DATA_SET(linux_ioctl_handler_set, disk_handler);
 149 DATA_SET(linux_ioctl_handler_set, socket_handler);
 150 DATA_SET(linux_ioctl_handler_set, sound_handler);
 151 DATA_SET(linux_ioctl_handler_set, termio_handler);
 152 DATA_SET(linux_ioctl_handler_set, private_handler);
 153 DATA_SET(linux_ioctl_handler_set, drm_handler);
 154 DATA_SET(linux_ioctl_handler_set, sg_handler);
 155 DATA_SET(linux_ioctl_handler_set, video_handler);
 156 DATA_SET(linux_ioctl_handler_set, video2_handler);
 157 DATA_SET(linux_ioctl_handler_set, fbsd_usb);
 158
 159 struct handler_element
 160 {
 161         TAILQ_ENTRY(handler_element) list;
 162         int     (*func)(struct thread *, struct linux_ioctl_args *);
 163         int     low, high, span;
 164 };
 165
 166 static TAILQ_HEAD(, handler_element) handlers =
 167     TAILQ_HEAD_INITIALIZER(handlers);
 168 static struct sx linux_ioctl_sx;
 169 SX_SYSINIT(linux_ioctl, &linux_ioctl_sx, "linux ioctl handlers");
 170
 171 /*
 172  * hdio related ioctls for VMWare support
 173  */
 174
 175 struct linux_hd_geometry {
 176         u_int8_t        heads;
 177         u_int8_t        sectors;
 178         u_int16_t       cylinders;
 179         u_int32_t       start;
 180 };
 181
 182 struct linux_hd_big_geometry {
 183         u_int8_t        heads;
 184         u_int8_t        sectors;
 185         u_int32_t       cylinders;
 186         u_int32_t       start;
 187 };
 188
 189 static int
 190 linux_ioctl_hdio(struct thread *td, struct linux_ioctl_args *args)
 191 {
 192         cap_rights_t rights;
 193         struct file *fp;
 194         int error;
 195         u_int sectorsize, fwcylinders, fwheads, fwsectors;
 196         off_t mediasize, bytespercyl;
 197
 198         error = fget(td, args->fd, cap_rights_init(&rights, CAP_IOCTL), &fp);
 199         if (error != 0)
 200                 return (error);
 201         switch (args->cmd & 0xffff) {
 202         case LINUX_HDIO_GET_GEO:
 203         case LINUX_HDIO_GET_GEO_BIG:
 204                 error = fo_ioctl(fp, DIOCGMEDIASIZE,
 205                         (caddr_t)&mediasize, td->td_ucred, td);
 206                 if (!error)
 207                         error = fo_ioctl(fp, DIOCGSECTORSIZE,
 208                                 (caddr_t)&sectorsize, td->td_ucred, td);
 209                 if (!error)
 210                         error = fo_ioctl(fp, DIOCGFWHEADS,
 211                                 (caddr_t)&fwheads, td->td_ucred, td);
 212                 if (!error)
 213                         error = fo_ioctl(fp, DIOCGFWSECTORS,
 214                                 (caddr_t)&fwsectors, td->td_ucred, td);
 215                 /*
 216                  * XXX: DIOCGFIRSTOFFSET is not yet implemented, so
 217                  * so pretend that GEOM always says 0. This is NOT VALID
 218                  * for slices or partitions, only the per-disk raw devices.
 219                  */
 220
 221                 fdrop(fp, td);
 222                 if (error)
 223                         return (error);
 224                 /*
 225                  * 1. Calculate the number of bytes in a cylinder,
 226                  *    given the firmware's notion of heads and sectors
 227                  *    per cylinder.
 228                  * 2. Calculate the number of cylinders, given the total
 229                  *    size of the media.
 230                  * All internal calculations should have 64-bit precision.
 231                  */
 232                 bytespercyl = (off_t) sectorsize * fwheads * fwsectors;
 233                 fwcylinders = mediasize / bytespercyl;
 234 #if defined(DEBUG)
 235                 linux_msg(td, "HDIO_GET_GEO: mediasize %jd, c/h/s %d/%d/%d, "
 236                           "bpc %jd",
 237                           (intmax_t)mediasize, fwcylinders, fwheads, fwsectors,
 238                           (intmax_t)bytespercyl);
 239 #endif
 240                 if ((args->cmd & 0xffff) == LINUX_HDIO_GET_GEO) {
 241                         struct linux_hd_geometry hdg;
 242
 243                         hdg.cylinders = fwcylinders;
 244                         hdg.heads = fwheads;
 245                         hdg.sectors = fwsectors;
 246                         hdg.start = 0;
 247                         error = copyout(&hdg, (void *)args->arg, sizeof(hdg));
 248                 } else if ((args->cmd & 0xffff) == LINUX_HDIO_GET_GEO_BIG) {
 249                         struct linux_hd_big_geometry hdbg;
 250
 251                         hdbg.cylinders = fwcylinders;
 252                         hdbg.heads = fwheads;
 253                         hdbg.sectors = fwsectors;
 254                         hdbg.start = 0;
 255                         error = copyout(&hdbg, (void *)args->arg, sizeof(hdbg));
 256                 }
 257                 return (error);
 258                 break;
 259         default:
 260                 /* XXX */
 261                 linux_msg(td,
 262                         "ioctl fd=%d, cmd=0x%x ('%c',%d) is not implemented",
 263                         args->fd, (int)(args->cmd & 0xffff),
 264                         (int)(args->cmd & 0xff00) >> 8,
 265                         (int)(args->cmd & 0xff));
 266                 break;
 267         }
 268         fdrop(fp, td);
 269         return (ENOIOCTL);
 270 }
 271
 272 static int
 273 linux_ioctl_disk(struct thread *td, struct linux_ioctl_args *args)
 274 {
 275         cap_rights_t rights;
 276         struct file *fp;
 277         int error;
 278         u_int sectorsize;
 279         off_t mediasize;
 280
 281         error = fget(td, args->fd, cap_rights_init(&rights, CAP_IOCTL), &fp);
 282         if (error != 0)
 283                 return (error);
 284         switch (args->cmd & 0xffff) {
 285         case LINUX_BLKGETSIZE:
 286                 error = fo_ioctl(fp, DIOCGSECTORSIZE,
 287                     (caddr_t)&sectorsize, td->td_ucred, td);
 288                 if (!error)
 289                         error = fo_ioctl(fp, DIOCGMEDIASIZE,
 290                             (caddr_t)&mediasize, td->td_ucred, td);
 291                 fdrop(fp, td);
 292                 if (error)
 293                         return (error);
 294                 sectorsize = mediasize / sectorsize;
 295                 /*
 296                  * XXX: How do we know we return the right size of integer ?
 297                  */
 298                 return (copyout(&sectorsize, (void *)args->arg,
 299                     sizeof(sectorsize)));
 300                 break;
 301         }
 302         fdrop(fp, td);
 303         return (ENOIOCTL);
 304 }
 305
 306 /*
 307  * termio related ioctls
 308  */
 309
 310 struct linux_termio {
 311         unsigned short c_iflag;
 312         unsigned short c_oflag;
 313         unsigned short c_cflag;
 314         unsigned short c_lflag;
 315         unsigned char c_line;
 316         unsigned char c_cc[LINUX_NCC];
 317 };
 318
 319 struct linux_termios {
 320         unsigned int c_iflag;
 321         unsigned int c_oflag;
 322         unsigned int c_cflag;
 323         unsigned int c_lflag;
 324         unsigned char c_line;
 325         unsigned char c_cc[LINUX_NCCS];
 326 };
 327
 328 struct linux_winsize {
 329         unsigned short ws_row, ws_col;
 330         unsigned short ws_xpixel, ws_ypixel;
 331 };
 332
 333 struct speedtab {
 334         int sp_speed;                   /* Speed. */
 335         int sp_code;                    /* Code. */
 336 };
 337
 338 static struct speedtab sptab[] = {
 339         { B0, LINUX_B0 }, { B50, LINUX_B50 },
 340         { B75, LINUX_B75 }, { B110, LINUX_B110 },
 341         { B134, LINUX_B134 }, { B150, LINUX_B150 },
 342         { B200, LINUX_B200 }, { B300, LINUX_B300 },
 343         { B600, LINUX_B600 }, { B1200, LINUX_B1200 },
 344         { B1800, LINUX_B1800 }, { B2400, LINUX_B2400 },
 345         { B4800, LINUX_B4800 }, { B9600, LINUX_B9600 },
 346         { B19200, LINUX_B19200 }, { B38400, LINUX_B38400 },
 347         { B57600, LINUX_B57600 }, { B115200, LINUX_B115200 },
 348         {-1, -1 }
 349 };
 350
 351 struct linux_serial_struct {
 352         int     type;
 353         int     line;
 354         int     port;
 355         int     irq;
 356         int     flags;
 357         int     xmit_fifo_size;
 358         int     custom_divisor;
 359         int     baud_base;
 360         unsigned short close_delay;
 361         char    reserved_char[2];
 362         int     hub6;
 363         unsigned short closing_wait;
 364         unsigned short closing_wait2;
 365         int     reserved[4];
 366 };
 367
 368 static int
 369 linux_to_bsd_speed(int code, struct speedtab *table)
 370 {
 371         for ( ; table->sp_code != -1; table++)
 372                 if (table->sp_code == code)
 373                         return (table->sp_speed);
 374         return -1;
 375 }
 376
 377 static int
 378 bsd_to_linux_speed(int speed, struct speedtab *table)
 379 {
 380         for ( ; table->sp_speed != -1; table++)
 381                 if (table->sp_speed == speed)
 382                         return (table->sp_code);
 383         return -1;
 384 }
 385
 386 static void
 387 bsd_to_linux_termios(struct termios *bios, struct linux_termios *lios)
 388 {
 389         int i;
 390
 391 #ifdef DEBUG
 392         if (ldebug(ioctl)) {
 393                 printf("LINUX: BSD termios structure (input):\n");
 394                 printf("i=%08x o=%08x c=%08x l=%08x ispeed=%d ospeed=%d\n",
 395                     bios->c_iflag, bios->c_oflag, bios->c_cflag, bios->c_lflag,
 396                     bios->c_ispeed, bios->c_ospeed);
 397                 printf("c_cc ");
 398                 for (i=0; i<NCCS; i++)
 399                         printf("%02x ", bios->c_cc[i]);
 400                 printf("\n");
 401         }
 402 #endif
 403
 404         lios->c_iflag = 0;
 405         if (bios->c_iflag & IGNBRK)
 406                 lios->c_iflag |= LINUX_IGNBRK;
 407         if (bios->c_iflag & BRKINT)
 408                 lios->c_iflag |= LINUX_BRKINT;
 409         if (bios->c_iflag & IGNPAR)
 410                 lios->c_iflag |= LINUX_IGNPAR;
 411         if (bios->c_iflag & PARMRK)
 412                 lios->c_iflag |= LINUX_PARMRK;
 413         if (bios->c_iflag & INPCK)
 414                 lios->c_iflag |= LINUX_INPCK;
 415         if (bios->c_iflag & ISTRIP)
 416                 lios->c_iflag |= LINUX_ISTRIP;
 417         if (bios->c_iflag & INLCR)
 418                 lios->c_iflag |= LINUX_INLCR;
 419         if (bios->c_iflag & IGNCR)
 420                 lios->c_iflag |= LINUX_IGNCR;
 421         if (bios->c_iflag & ICRNL)
 422                 lios->c_iflag |= LINUX_ICRNL;
 423         if (bios->c_iflag & IXON)
 424                 lios->c_iflag |= LINUX_IXON;
 425         if (bios->c_iflag & IXANY)
 426                 lios->c_iflag |= LINUX_IXANY;
 427         if (bios->c_iflag & IXOFF)
 428                 lios->c_iflag |= LINUX_IXOFF;
 429         if (bios->c_iflag & IMAXBEL)
 430                 lios->c_iflag |= LINUX_IMAXBEL;
 431
 432         lios->c_oflag = 0;
 433         if (bios->c_oflag & OPOST)
 434                 lios->c_oflag |= LINUX_OPOST;
 435         if (bios->c_oflag & ONLCR)
 436                 lios->c_oflag |= LINUX_ONLCR;
 437         if (bios->c_oflag & TAB3)
 438                 lios->c_oflag |= LINUX_XTABS;
 439
 440         lios->c_cflag = bsd_to_linux_speed(bios->c_ispeed, sptab);
 441         lios->c_cflag |= (bios->c_cflag & CSIZE) >> 4;
 442         if (bios->c_cflag & CSTOPB)
 443                 lios->c_cflag |= LINUX_CSTOPB;
 444         if (bios->c_cflag & CREAD)
 445                 lios->c_cflag |= LINUX_CREAD;
 446         if (bios->c_cflag & PARENB)
 447                 lios->c_cflag |= LINUX_PARENB;
 448         if (bios->c_cflag & PARODD)
 449                 lios->c_cflag |= LINUX_PARODD;
 450         if (bios->c_cflag & HUPCL)
 451                 lios->c_cflag |= LINUX_HUPCL;
 452         if (bios->c_cflag & CLOCAL)
 453                 lios->c_cflag |= LINUX_CLOCAL;
 454         if (bios->c_cflag & CRTSCTS)
 455                 lios->c_cflag |= LINUX_CRTSCTS;
 456
 457         lios->c_lflag = 0;
 458         if (bios->c_lflag & ISIG)
 459                 lios->c_lflag |= LINUX_ISIG;
 460         if (bios->c_lflag & ICANON)
 461                 lios->c_lflag |= LINUX_ICANON;
 462         if (bios->c_lflag & ECHO)
 463                 lios->c_lflag |= LINUX_ECHO;
 464         if (bios->c_lflag & ECHOE)
 465                 lios->c_lflag |= LINUX_ECHOE;
 466         if (bios->c_lflag & ECHOK)
 467                 lios->c_lflag |= LINUX_ECHOK;
 468         if (bios->c_lflag & ECHONL)
 469                 lios->c_lflag |= LINUX_ECHONL;
 470         if (bios->c_lflag & NOFLSH)
 471                 lios->c_lflag |= LINUX_NOFLSH;
 472         if (bios->c_lflag & TOSTOP)
 473                 lios->c_lflag |= LINUX_TOSTOP;
 474         if (bios->c_lflag & ECHOCTL)
 475                 lios->c_lflag |= LINUX_ECHOCTL;
 476         if (bios->c_lflag & ECHOPRT)
 477                 lios->c_lflag |= LINUX_ECHOPRT;
 478         if (bios->c_lflag & ECHOKE)
 479                 lios->c_lflag |= LINUX_ECHOKE;
 480         if (bios->c_lflag & FLUSHO)
 481                 lios->c_lflag |= LINUX_FLUSHO;
 482         if (bios->c_lflag & PENDIN)
 483                 lios->c_lflag |= LINUX_PENDIN;
 484         if (bios->c_lflag & IEXTEN)
 485                 lios->c_lflag |= LINUX_IEXTEN;
 486
 487         for (i=0; i<LINUX_NCCS; i++)
 488                 lios->c_cc[i] = LINUX_POSIX_VDISABLE;
 489         lios->c_cc[LINUX_VINTR] = bios->c_cc[VINTR];
 490         lios->c_cc[LINUX_VQUIT] = bios->c_cc[VQUIT];
 491         lios->c_cc[LINUX_VERASE] = bios->c_cc[VERASE];
 492         lios->c_cc[LINUX_VKILL] = bios->c_cc[VKILL];
 493         lios->c_cc[LINUX_VEOF] = bios->c_cc[VEOF];
 494         lios->c_cc[LINUX_VEOL] = bios->c_cc[VEOL];
 495         lios->c_cc[LINUX_VMIN] = bios->c_cc[VMIN];
 496         lios->c_cc[LINUX_VTIME] = bios->c_cc[VTIME];
 497         lios->c_cc[LINUX_VEOL2] = bios->c_cc[VEOL2];
 498         lios->c_cc[LINUX_VSUSP] = bios->c_cc[VSUSP];
 499         lios->c_cc[LINUX_VSTART] = bios->c_cc[VSTART];
 500         lios->c_cc[LINUX_VSTOP] = bios->c_cc[VSTOP];
 501         lios->c_cc[LINUX_VREPRINT] = bios->c_cc[VREPRINT];
 502         lios->c_cc[LINUX_VDISCARD] = bios->c_cc[VDISCARD];
 503         lios->c_cc[LINUX_VWERASE] = bios->c_cc[VWERASE];
 504         lios->c_cc[LINUX_VLNEXT] = bios->c_cc[VLNEXT];
 505
 506         for (i=0; i<LINUX_NCCS; i++) {
 507                 if (i != LINUX_VMIN && i != LINUX_VTIME &&
 508                     lios->c_cc[i] == _POSIX_VDISABLE)
 509                         lios->c_cc[i] = LINUX_POSIX_VDISABLE;
 510         }
 511         lios->c_line = 0;
 512
 513 #ifdef DEBUG
 514         if (ldebug(ioctl)) {
 515                 printf("LINUX: LINUX termios structure (output):\n");
 516                 printf("i=%08x o=%08x c=%08x l=%08x line=%d\n",
 517                     lios->c_iflag, lios->c_oflag, lios->c_cflag,
 518                     lios->c_lflag, (int)lios->c_line);
 519                 printf("c_cc ");
 520                 for (i=0; i<LINUX_NCCS; i++)
 521                         printf("%02x ", lios->c_cc[i]);
 522                 printf("\n");
 523         }
 524 #endif
 525 }
 526
 527 static void
 528 linux_to_bsd_termios(struct linux_termios *lios, struct termios *bios)
 529 {
 530         int i;
 531
 532 #ifdef DEBUG
 533         if (ldebug(ioctl)) {
 534                 printf("LINUX: LINUX termios structure (input):\n");
 535                 printf("i=%08x o=%08x c=%08x l=%08x line=%d\n",
 536                     lios->c_iflag, lios->c_oflag, lios->c_cflag,
 537                     lios->c_lflag, (int)lios->c_line);
 538                 printf("c_cc ");
 539                 for (i=0; i<LINUX_NCCS; i++)
 540                         printf("%02x ", lios->c_cc[i]);
 541                 printf("\n");
 542         }
 543 #endif
 544
 545         bios->c_iflag = 0;
 546         if (lios->c_iflag & LINUX_IGNBRK)
 547                 bios->c_iflag |= IGNBRK;
 548         if (lios->c_iflag & LINUX_BRKINT)
 549                 bios->c_iflag |= BRKINT;
 550         if (lios->c_iflag & LINUX_IGNPAR)
 551                 bios->c_iflag |= IGNPAR;
 552         if (lios->c_iflag & LINUX_PARMRK)
 553                 bios->c_iflag |= PARMRK;
 554         if (lios->c_iflag & LINUX_INPCK)
 555                 bios->c_iflag |= INPCK;
 556         if (lios->c_iflag & LINUX_ISTRIP)
 557                 bios->c_iflag |= ISTRIP;
 558         if (lios->c_iflag & LINUX_INLCR)
 559                 bios->c_iflag |= INLCR;
 560         if (lios->c_iflag & LINUX_IGNCR)
 561                 bios->c_iflag |= IGNCR;
 562         if (lios->c_iflag & LINUX_ICRNL)
 563                 bios->c_iflag |= ICRNL;
 564         if (lios->c_iflag & LINUX_IXON)
 565                 bios->c_iflag |= IXON;
 566         if (lios->c_iflag & LINUX_IXANY)
 567                 bios->c_iflag |= IXANY;
 568         if (lios->c_iflag & LINUX_IXOFF)
 569                 bios->c_iflag |= IXOFF;
 570         if (lios->c_iflag & LINUX_IMAXBEL)
 571                 bios->c_iflag |= IMAXBEL;
 572
 573         bios->c_oflag = 0;
 574         if (lios->c_oflag & LINUX_OPOST)
 575                 bios->c_oflag |= OPOST;
 576         if (lios->c_oflag & LINUX_ONLCR)
 577                 bios->c_oflag |= ONLCR;
 578         if (lios->c_oflag & LINUX_XTABS)
 579                 bios->c_oflag |= TAB3;
 580
 581         bios->c_cflag = (lios->c_cflag & LINUX_CSIZE) << 4;
 582         if (lios->c_cflag & LINUX_CSTOPB)
 583                 bios->c_cflag |= CSTOPB;
 584         if (lios->c_cflag & LINUX_CREAD)
 585                 bios->c_cflag |= CREAD;
 586         if (lios->c_cflag & LINUX_PARENB)
 587                 bios->c_cflag |= PARENB;
 588         if (lios->c_cflag & LINUX_PARODD)
 589                 bios->c_cflag |= PARODD;
 590         if (lios->c_cflag & LINUX_HUPCL)
 591                 bios->c_cflag |= HUPCL;
 592         if (lios->c_cflag & LINUX_CLOCAL)
 593                 bios->c_cflag |= CLOCAL;
 594         if (lios->c_cflag & LINUX_CRTSCTS)
 595                 bios->c_cflag |= CRTSCTS;
 596
 597         bios->c_lflag = 0;
 598         if (lios->c_lflag & LINUX_ISIG)
 599                 bios->c_lflag |= ISIG;
 600         if (lios->c_lflag & LINUX_ICANON)
 601                 bios->c_lflag |= ICANON;
 602         if (lios->c_lflag & LINUX_ECHO)
 603                 bios->c_lflag |= ECHO;
 604         if (lios->c_lflag & LINUX_ECHOE)
 605                 bios->c_lflag |= ECHOE;
 606         if (lios->c_lflag & LINUX_ECHOK)
 607                 bios->c_lflag |= ECHOK;
 608         if (lios->c_lflag & LINUX_ECHONL)
 609                 bios->c_lflag |= ECHONL;
 610         if (lios->c_lflag & LINUX_NOFLSH)
 611                 bios->c_lflag |= NOFLSH;
 612         if (lios->c_lflag & LINUX_TOSTOP)
 613                 bios->c_lflag |= TOSTOP;
 614         if (lios->c_lflag & LINUX_ECHOCTL)
 615                 bios->c_lflag |= ECHOCTL;
 616         if (lios->c_lflag & LINUX_ECHOPRT)
 617                 bios->c_lflag |= ECHOPRT;
 618         if (lios->c_lflag & LINUX_ECHOKE)
 619                 bios->c_lflag |= ECHOKE;
 620         if (lios->c_lflag & LINUX_FLUSHO)
 621                 bios->c_lflag |= FLUSHO;
 622         if (lios->c_lflag & LINUX_PENDIN)
 623                 bios->c_lflag |= PENDIN;
 624         if (lios->c_lflag & LINUX_IEXTEN)
 625                 bios->c_lflag |= IEXTEN;
 626
 627         for (i=0; i<NCCS; i++)
 628                 bios->c_cc[i] = _POSIX_VDISABLE;
 629         bios->c_cc[VINTR] = lios->c_cc[LINUX_VINTR];
 630         bios->c_cc[VQUIT] = lios->c_cc[LINUX_VQUIT];
 631         bios->c_cc[VERASE] = lios->c_cc[LINUX_VERASE];
 632         bios->c_cc[VKILL] = lios->c_cc[LINUX_VKILL];
 633         bios->c_cc[VEOF] = lios->c_cc[LINUX_VEOF];
 634         bios->c_cc[VEOL] = lios->c_cc[LINUX_VEOL];
 635         bios->c_cc[VMIN] = lios->c_cc[LINUX_VMIN];
 636         bios->c_cc[VTIME] = lios->c_cc[LINUX_VTIME];
 637         bios->c_cc[VEOL2] = lios->c_cc[LINUX_VEOL2];
 638         bios->c_cc[VSUSP] = lios->c_cc[LINUX_VSUSP];
 639         bios->c_cc[VSTART] = lios->c_cc[LINUX_VSTART];
 640         bios->c_cc[VSTOP] = lios->c_cc[LINUX_VSTOP];
 641         bios->c_cc[VREPRINT] = lios->c_cc[LINUX_VREPRINT];
 642         bios->c_cc[VDISCARD] = lios->c_cc[LINUX_VDISCARD];
 643         bios->c_cc[VWERASE] = lios->c_cc[LINUX_VWERASE];
 644         bios->c_cc[VLNEXT] = lios->c_cc[LINUX_VLNEXT];
 645
 646         for (i=0; i<NCCS; i++) {
 647                 if (i != VMIN && i != VTIME &&
 648                     bios->c_cc[i] == LINUX_POSIX_VDISABLE)
 649                         bios->c_cc[i] = _POSIX_VDISABLE;
 650         }
 651
 652         bios->c_ispeed = bios->c_ospeed =
 653             linux_to_bsd_speed(lios->c_cflag & LINUX_CBAUD, sptab);
 654
 655 #ifdef DEBUG
 656         if (ldebug(ioctl)) {
 657                 printf("LINUX: BSD termios structure (output):\n");
 658                 printf("i=%08x o=%08x c=%08x l=%08x ispeed=%d ospeed=%d\n",
 659                     bios->c_iflag, bios->c_oflag, bios->c_cflag, bios->c_lflag,
 660                     bios->c_ispeed, bios->c_ospeed);
 661                 printf("c_cc ");
 662                 for (i=0; i<NCCS; i++)
 663                         printf("%02x ", bios->c_cc[i]);
 664                 printf("\n");
 665         }
 666 #endif
 667 }
 668
 669 static void
 670 bsd_to_linux_termio(struct termios *bios, struct linux_termio *lio)
 671 {
 672         struct linux_termios lios;
 673
 674         bsd_to_linux_termios(bios, &lios);
 675         lio->c_iflag = lios.c_iflag;
 676         lio->c_oflag = lios.c_oflag;
 677         lio->c_cflag = lios.c_cflag;
 678         lio->c_lflag = lios.c_lflag;
 679         lio->c_line  = lios.c_line;
 680         memcpy(lio->c_cc, lios.c_cc, LINUX_NCC);
 681 }
 682
 683 static void
 684 linux_to_bsd_termio(struct linux_termio *lio, struct termios *bios)
 685 {
 686         struct linux_termios lios;
 687         int i;
 688
 689         lios.c_iflag = lio->c_iflag;
 690         lios.c_oflag = lio->c_oflag;
 691         lios.c_cflag = lio->c_cflag;
 692         lios.c_lflag = lio->c_lflag;
 693         for (i=LINUX_NCC; i<LINUX_NCCS; i++)
 694                 lios.c_cc[i] = LINUX_POSIX_VDISABLE;
 695         memcpy(lios.c_cc, lio->c_cc, LINUX_NCC);
 696         linux_to_bsd_termios(&lios, bios);
 697 }
 698
 699 static int
 700 linux_ioctl_termio(struct thread *td, struct linux_ioctl_args *args)
 701 {
 702         struct termios bios;
 703         struct linux_termios lios;
 704         struct linux_termio lio;
 705         cap_rights_t rights;
 706         struct file *fp;
 707         int error;
 708
 709         error = fget(td, args->fd, cap_rights_init(&rights, CAP_IOCTL), &fp);
 710         if (error != 0)
 711                 return (error);
 712
 713         switch (args->cmd & 0xffff) {
 714
 715         case LINUX_TCGETS:
 716                 error = fo_ioctl(fp, TIOCGETA, (caddr_t)&bios, td->td_ucred,
 717                     td);
 718                 if (error)
 719                         break;
 720                 bsd_to_linux_termios(&bios, &lios);
 721                 error = copyout(&lios, (void *)args->arg, sizeof(lios));
 722                 break;
 723
 724         case LINUX_TCSETS:
 725                 error = copyin((void *)args->arg, &lios, sizeof(lios));
 726                 if (error)
 727                         break;
 728                 linux_to_bsd_termios(&lios, &bios);
 729                 error = (fo_ioctl(fp, TIOCSETA, (caddr_t)&bios, td->td_ucred,
 730                     td));
 731                 break;
 732
 733         case LINUX_TCSETSW:
 734                 error = copyin((void *)args->arg, &lios, sizeof(lios));
 735                 if (error)
 736                         break;
 737                 linux_to_bsd_termios(&lios, &bios);
 738                 error = (fo_ioctl(fp, TIOCSETAW, (caddr_t)&bios, td->td_ucred,
 739                     td));
 740                 break;
 741
 742         case LINUX_TCSETSF:
 743                 error = copyin((void *)args->arg, &lios, sizeof(lios));
 744                 if (error)
 745                         break;
 746                 linux_to_bsd_termios(&lios, &bios);
 747                 error = (fo_ioctl(fp, TIOCSETAF, (caddr_t)&bios, td->td_ucred,
 748                     td));
 749                 break;
 750
 751         case LINUX_TCGETA:
 752                 error = fo_ioctl(fp, TIOCGETA, (caddr_t)&bios, td->td_ucred,
 753                     td);
 754                 if (error)
 755                         break;
 756                 bsd_to_linux_termio(&bios, &lio);
 757                 error = (copyout(&lio, (void *)args->arg, sizeof(lio)));
 758                 break;
 759
 760         case LINUX_TCSETA:
 761                 error = copyin((void *)args->arg, &lio, sizeof(lio));
 762                 if (error)
 763                         break;
 764                 linux_to_bsd_termio(&lio, &bios);
 765                 error = (fo_ioctl(fp, TIOCSETA, (caddr_t)&bios, td->td_ucred,
 766                     td));
 767                 break;
 768
 769         case LINUX_TCSETAW:
 770                 error = copyin((void *)args->arg, &lio, sizeof(lio));
 771                 if (error)
 772                         break;
 773                 linux_to_bsd_termio(&lio, &bios);
 774                 error = (fo_ioctl(fp, TIOCSETAW, (caddr_t)&bios, td->td_ucred,
 775                     td));
 776                 break;
 777
 778         case LINUX_TCSETAF:
 779                 error = copyin((void *)args->arg, &lio, sizeof(lio));
 780                 if (error)
 781                         break;
 782                 linux_to_bsd_termio(&lio, &bios);
 783                 error = (fo_ioctl(fp, TIOCSETAF, (caddr_t)&bios, td->td_ucred,
 784                     td));
 785                 break;
 786
 787         /* LINUX_TCSBRK */
 788
 789         case LINUX_TCXONC: {
 790                 switch (args->arg) {
 791                 case LINUX_TCOOFF:
 792                         args->cmd = TIOCSTOP;
 793                         break;
 794                 case LINUX_TCOON:
 795                         args->cmd = TIOCSTART;
 796                         break;
 797                 case LINUX_TCIOFF:
 798                 case LINUX_TCION: {
 799                         int c;
 800                         struct write_args wr;
 801                         error = fo_ioctl(fp, TIOCGETA, (caddr_t)&bios,
 802                             td->td_ucred, td);
 803                         if (error)
 804                                 break;
 805                         fdrop(fp, td);
 806                         c = (args->arg == LINUX_TCIOFF) ? VSTOP : VSTART;
 807                         c = bios.c_cc[c];
 808                         if (c != _POSIX_VDISABLE) {
 809                                 wr.fd = args->fd;
 810                                 wr.buf = &c;
 811                                 wr.nbyte = sizeof(c);
 812                                 return (sys_write(td, &wr));
 813                         } else
 814                                 return (0);
 815                 }
 816                 default:
 817                         fdrop(fp, td);
 818                         return (EINVAL);
 819                 }
 820                 args->arg = 0;
 821                 error = (sys_ioctl(td, (struct ioctl_args *)args));
 822                 break;
 823         }
 824
 825         case LINUX_TCFLSH: {
 826                 int val;
 827                 switch (args->arg) {
 828                 case LINUX_TCIFLUSH:
 829                         val = FREAD;
 830                         break;
 831                 case LINUX_TCOFLUSH:
 832                         val = FWRITE;
 833                         break;
 834                 case LINUX_TCIOFLUSH:
 835                         val = FREAD | FWRITE;
 836                         break;
 837                 default:
 838                         fdrop(fp, td);
 839                         return (EINVAL);
 840                 }
 841                 error = (fo_ioctl(fp,TIOCFLUSH,(caddr_t)&val,td->td_ucred,td));
 842                 break;
 843         }
 844
 845         case LINUX_TIOCEXCL:
 846                 args->cmd = TIOCEXCL;
 847                 error = (sys_ioctl(td, (struct ioctl_args *)args));
 848                 break;
 849
 850         case LINUX_TIOCNXCL:
 851                 args->cmd = TIOCNXCL;
 852                 error = (sys_ioctl(td, (struct ioctl_args *)args));
 853                 break;
 854
 855         case LINUX_TIOCSCTTY:
 856                 args->cmd = TIOCSCTTY;
 857                 error = (sys_ioctl(td, (struct ioctl_args *)args));
 858                 break;
 859
 860         case LINUX_TIOCGPGRP:
 861                 args->cmd = TIOCGPGRP;
 862                 error = (sys_ioctl(td, (struct ioctl_args *)args));
 863                 break;
 864
 865         case LINUX_TIOCSPGRP:
 866                 args->cmd = TIOCSPGRP;
 867                 error = (sys_ioctl(td, (struct ioctl_args *)args));
 868                 break;
 869
 870         /* LINUX_TIOCOUTQ */
 871         /* LINUX_TIOCSTI */
 872
 873         case LINUX_TIOCGWINSZ:
 874                 args->cmd = TIOCGWINSZ;
 875                 error = (sys_ioctl(td, (struct ioctl_args *)args));
 876                 break;
 877
 878         case LINUX_TIOCSWINSZ:
 879                 args->cmd = TIOCSWINSZ;
 880                 error = (sys_ioctl(td, (struct ioctl_args *)args));
 881                 break;
 882
 883         case LINUX_TIOCMGET:
 884                 args->cmd = TIOCMGET;
 885                 error = (sys_ioctl(td, (struct ioctl_args *)args));
 886                 break;
 887
 888         case LINUX_TIOCMBIS:
 889                 args->cmd = TIOCMBIS;
 890                 error = (sys_ioctl(td, (struct ioctl_args *)args));
 891                 break;
 892
 893         case LINUX_TIOCMBIC:
 894                 args->cmd = TIOCMBIC;
 895                 error = (sys_ioctl(td, (struct ioctl_args *)args));
 896                 break;
 897
 898         case LINUX_TIOCMSET:
 899                 args->cmd = TIOCMSET;
 900                 error = (sys_ioctl(td, (struct ioctl_args *)args));
 901                 break;
 902
 903         /* TIOCGSOFTCAR */
 904         /* TIOCSSOFTCAR */
 905
 906         case LINUX_FIONREAD: /* LINUX_TIOCINQ */
 907                 args->cmd = FIONREAD;
 908                 error = (sys_ioctl(td, (struct ioctl_args *)args));
 909                 break;
 910
 911         /* LINUX_TIOCLINUX */
 912
 913         case LINUX_TIOCCONS:
 914                 args->cmd = TIOCCONS;
 915                 error = (sys_ioctl(td, (struct ioctl_args *)args));
 916                 break;
 917
 918         case LINUX_TIOCGSERIAL: {
 919                 struct linux_serial_struct lss;
 920                 lss.type = LINUX_PORT_16550A;
 921                 lss.flags = 0;
 922                 lss.close_delay = 0;
 923                 error = copyout(&lss, (void *)args->arg, sizeof(lss));
 924                 break;
 925         }
 926
 927         case LINUX_TIOCSSERIAL: {
 928                 struct linux_serial_struct lss;
 929                 error = copyin((void *)args->arg, &lss, sizeof(lss));
 930                 if (error)
 931                         break;
 932                 /* XXX - It really helps to have an implementation that
 933                  * does nothing. NOT!
 934                  */
 935                 error = 0;
 936                 break;
 937         }
 938
 939         case LINUX_TIOCPKT:
 940                 args->cmd = TIOCPKT;
 941                 error = (sys_ioctl(td, (struct ioctl_args *)args));
 942                 break;
 943
 944         case LINUX_FIONBIO:
 945                 args->cmd = FIONBIO;
 946                 error = (sys_ioctl(td, (struct ioctl_args *)args));
 947                 break;
 948
 949         case LINUX_TIOCNOTTY:
 950                 args->cmd = TIOCNOTTY;
 951                 error = (sys_ioctl(td, (struct ioctl_args *)args));
 952                 break;
 953
 954         case LINUX_TIOCSETD: {
 955                 int line;
 956                 switch (args->arg) {
 957                 case LINUX_N_TTY:
 958                         line = TTYDISC;
 959                         break;
 960                 case LINUX_N_SLIP:
 961                         line = SLIPDISC;
 962                         break;
 963                 case LINUX_N_PPP:
 964                         line = PPPDISC;
 965                         break;
 966                 default:
 967                         fdrop(fp, td);
 968                         return (EINVAL);
 969                 }
 970                 error = (fo_ioctl(fp, TIOCSETD, (caddr_t)&line, td->td_ucred,
 971                     td));
 972                 break;
 973         }
 974
 975         case LINUX_TIOCGETD: {
 976                 int linux_line;
 977                 int bsd_line = TTYDISC;
 978                 error = fo_ioctl(fp, TIOCGETD, (caddr_t)&bsd_line,
 979                     td->td_ucred, td);
 980                 if (error)
 981                         return (error);
 982                 switch (bsd_line) {
 983                 case TTYDISC:
 984                         linux_line = LINUX_N_TTY;
 985                         break;
 986                 case SLIPDISC:
 987                         linux_line = LINUX_N_SLIP;
 988                         break;
 989                 case PPPDISC:
 990                         linux_line = LINUX_N_PPP;
 991                         break;
 992                 default:
 993                         fdrop(fp, td);
 994                         return (EINVAL);
 995                 }
 996                 error = (copyout(&linux_line, (void *)args->arg, sizeof(int)));
 997                 break;
 998         }
 999
1000         /* LINUX_TCSBRKP */
1001         /* LINUX_TIOCTTYGSTRUCT */
1002
1003         case LINUX_FIONCLEX:
1004                 args->cmd = FIONCLEX;
1005                 error = (sys_ioctl(td, (struct ioctl_args *)args));
1006                 break;
1007
1008         case LINUX_FIOCLEX:
1009                 args->cmd = FIOCLEX;
1010                 error = (sys_ioctl(td, (struct ioctl_args *)args));
1011                 break;
1012
1013         case LINUX_FIOASYNC:
1014                 args->cmd = FIOASYNC;
1015                 error = (sys_ioctl(td, (struct ioctl_args *)args));
1016                 break;
1017
1018         /* LINUX_TIOCSERCONFIG */
1019         /* LINUX_TIOCSERGWILD */
1020         /* LINUX_TIOCSERSWILD */
1021         /* LINUX_TIOCGLCKTRMIOS */
1022         /* LINUX_TIOCSLCKTRMIOS */
1023
1024         case LINUX_TIOCSBRK:
1025                 args->cmd = TIOCSBRK;
1026                 error = (sys_ioctl(td, (struct ioctl_args *)args));
1027                 break;
1028
1029         case LINUX_TIOCCBRK:
1030                 args->cmd = TIOCCBRK;
1031                 error = (sys_ioctl(td, (struct ioctl_args *)args));
1032                 break;
1033         case LINUX_TIOCGPTN: {
1034                 int nb;
1035
1036                 error = fo_ioctl(fp, TIOCGPTN, (caddr_t)&nb, td->td_ucred, td);
1037                 if (!error)
1038                         error = copyout(&nb, (void *)args->arg,
1039                             sizeof(int));
1040                 break;
1041         }
1042         case LINUX_TIOCSPTLCK:
1043                 /* Our unlockpt() does nothing. */
1044                 error = 0;
1045                 break;
1046         default:
1047                 error = ENOIOCTL;
1048                 break;
1049         }
1050
1051         fdrop(fp, td);
1052         return (error);
1053 }
1054
1055 /*
1056  * CDROM related ioctls
1057  */
1058
1059 struct linux_cdrom_msf
1060 {
1061         u_char  cdmsf_min0;
1062         u_char  cdmsf_sec0;
1063         u_char  cdmsf_frame0;
1064         u_char  cdmsf_min1;
1065         u_char  cdmsf_sec1;
1066         u_char  cdmsf_frame1;
1067 };
1068
1069 struct linux_cdrom_tochdr
1070 {
1071         u_char  cdth_trk0;
1072         u_char  cdth_trk1;
1073 };
1074
1075 union linux_cdrom_addr
1076 {
1077         struct {
1078                 u_char  minute;
1079                 u_char  second;
1080                 u_char  frame;
1081         } msf;
1082         int     lba;
1083 };
1084
1085 struct linux_cdrom_tocentry
1086 {
1087         u_char  cdte_track;
1088         u_char  cdte_adr:4;
1089         u_char  cdte_ctrl:4;
1090         u_char  cdte_format;
1091         union linux_cdrom_addr cdte_addr;
1092         u_char  cdte_datamode;
1093 };
1094
1095 struct linux_cdrom_subchnl
1096 {
1097         u_char  cdsc_format;
1098         u_char  cdsc_audiostatus;
1099         u_char  cdsc_adr:4;
1100         u_char  cdsc_ctrl:4;
1101         u_char  cdsc_trk;
1102         u_char  cdsc_ind;
1103         union linux_cdrom_addr cdsc_absaddr;
1104         union linux_cdrom_addr cdsc_reladdr;
1105 };
1106
1107 struct l_cdrom_read_audio {
1108         union linux_cdrom_addr addr;
1109         u_char          addr_format;
1110         l_int           nframes;
1111         u_char          *buf;
1112 };
1113
1114 struct l_dvd_layer {
1115         u_char          book_version:4;
1116         u_char          book_type:4;
1117         u_char          min_rate:4;
1118         u_char          disc_size:4;
1119         u_char          layer_type:4;
1120         u_char          track_path:1;
1121         u_char          nlayers:2;
1122         u_char          track_density:4;
1123         u_char          linear_density:4;
1124         u_char          bca:1;
1125         u_int32_t       start_sector;
1126         u_int32_t       end_sector;
1127         u_int32_t       end_sector_l0;
1128 };
1129
1130 struct l_dvd_physical {
1131         u_char          type;
1132         u_char          layer_num;
1133         struct l_dvd_layer layer[4];
1134 };
1135
1136 struct l_dvd_copyright {
1137         u_char          type;
1138         u_char          layer_num;
1139         u_char          cpst;
1140         u_char          rmi;
1141 };
1142
1143 struct l_dvd_disckey {
1144         u_char          type;
1145         l_uint          agid:2;
1146         u_char          value[2048];
1147 };
1148
1149 struct l_dvd_bca {
1150         u_char          type;
1151         l_int           len;
1152         u_char          value[188];
1153 };
1154
1155 struct l_dvd_manufact {
1156         u_char          type;
1157         u_char          layer_num;
1158         l_int           len;
1159         u_char          value[2048];
1160 };
1161
1162 typedef union {
1163         u_char                  type;
1164         struct l_dvd_physical   physical;
1165         struct l_dvd_copyright  copyright;
1166         struct l_dvd_disckey    disckey;
1167         struct l_dvd_bca        bca;
1168         struct l_dvd_manufact   manufact;
1169 } l_dvd_struct;
1170
1171 typedef u_char l_dvd_key[5];
1172 typedef u_char l_dvd_challenge[10];
1173
1174 struct l_dvd_lu_send_agid {
1175         u_char          type;
1176         l_uint          agid:2;
1177 };
1178
1179 struct l_dvd_host_send_challenge {
1180         u_char          type;
1181         l_uint          agid:2;
1182         l_dvd_challenge chal;
1183 };
1184
1185 struct l_dvd_send_key {
1186         u_char          type;
1187         l_uint          agid:2;
1188         l_dvd_key       key;
1189 };
1190
1191 struct l_dvd_lu_send_challenge {
1192         u_char          type;
1193         l_uint          agid:2;
1194         l_dvd_challenge chal;
1195 };
1196
1197 struct l_dvd_lu_send_title_key {
1198         u_char          type;
1199         l_uint          agid:2;
1200         l_dvd_key       title_key;
1201         l_int           lba;
1202         l_uint          cpm:1;
1203         l_uint          cp_sec:1;
1204         l_uint          cgms:2;
1205 };
1206
1207 struct l_dvd_lu_send_asf {
1208         u_char          type;
1209         l_uint          agid:2;
1210         l_uint          asf:1;
1211 };
1212
1213 struct l_dvd_host_send_rpcstate {
1214         u_char          type;
1215         u_char          pdrc;
1216 };
1217
1218 struct l_dvd_lu_send_rpcstate {
1219         u_char          type:2;
1220         u_char          vra:3;
1221         u_char          ucca:3;
1222         u_char          region_mask;
1223         u_char          rpc_scheme;
1224 };
1225
1226 typedef union {
1227         u_char                          type;
1228         struct l_dvd_lu_send_agid       lsa;
1229         struct l_dvd_host_send_challenge hsc;
1230         struct l_dvd_send_key           lsk;
1231         struct l_dvd_lu_send_challenge  lsc;
1232         struct l_dvd_send_key           hsk;
1233         struct l_dvd_lu_send_title_key  lstk;
1234         struct l_dvd_lu_send_asf        lsasf;
1235         struct l_dvd_host_send_rpcstate hrpcs;
1236         struct l_dvd_lu_send_rpcstate   lrpcs;
1237 } l_dvd_authinfo;
1238
1239 static void
1240 bsd_to_linux_msf_lba(u_char af, union msf_lba *bp, union linux_cdrom_addr *lp)
1241 {
1242         if (af == CD_LBA_FORMAT)
1243                 lp->lba = bp->lba;
1244         else {
1245                 lp->msf.minute = bp->msf.minute;
1246                 lp->msf.second = bp->msf.second;
1247                 lp->msf.frame = bp->msf.frame;
1248         }
1249 }
1250
1251 static void
1252 set_linux_cdrom_addr(union linux_cdrom_addr *addr, int format, int lba)
1253 {
1254         if (format == LINUX_CDROM_MSF) {
1255                 addr->msf.frame = lba % 75;
1256                 lba /= 75;
1257                 lba += 2;
1258                 addr->msf.second = lba % 60;
1259                 addr->msf.minute = lba / 60;
1260         } else
1261                 addr->lba = lba;
1262 }
1263
1264 static int
1265 linux_to_bsd_dvd_struct(l_dvd_struct *lp, struct dvd_struct *bp)
1266 {
1267         bp->format = lp->type;
1268         switch (bp->format) {
1269         case DVD_STRUCT_PHYSICAL:
1270                 if (bp->layer_num >= 4)
1271                         return (EINVAL);
1272                 bp->layer_num = lp->physical.layer_num;
1273                 break;
1274         case DVD_STRUCT_COPYRIGHT:
1275                 bp->layer_num = lp->copyright.layer_num;
1276                 break;
1277         case DVD_STRUCT_DISCKEY:
1278                 bp->agid = lp->disckey.agid;
1279                 break;
1280         case DVD_STRUCT_BCA:
1281         case DVD_STRUCT_MANUFACT:
1282                 break;
1283         default:
1284                 return (EINVAL);
1285         }
1286         return (0);
1287 }
1288
1289 static int
1290 bsd_to_linux_dvd_struct(struct dvd_struct *bp, l_dvd_struct *lp)
1291 {
1292         switch (bp->format) {
1293         case DVD_STRUCT_PHYSICAL: {
1294                 struct dvd_layer *blp = (struct dvd_layer *)bp->data;
1295                 struct l_dvd_layer *llp = &lp->physical.layer[bp->layer_num];
1296                 memset(llp, 0, sizeof(*llp));
1297                 llp->book_version = blp->book_version;
1298                 llp->book_type = blp->book_type;
1299                 llp->min_rate = blp->max_rate;
1300                 llp->disc_size = blp->disc_size;
1301                 llp->layer_type = blp->layer_type;
1302                 llp->track_path = blp->track_path;
1303                 llp->nlayers = blp->nlayers;
1304                 llp->track_density = blp->track_density;
1305                 llp->linear_density = blp->linear_density;
1306                 llp->bca = blp->bca;
1307                 llp->start_sector = blp->start_sector;
1308                 llp->end_sector = blp->end_sector;
1309                 llp->end_sector_l0 = blp->end_sector_l0;
1310                 break;
1311         }
1312         case DVD_STRUCT_COPYRIGHT:
1313                 lp->copyright.cpst = bp->cpst;
1314                 lp->copyright.rmi = bp->rmi;
1315                 break;
1316         case DVD_STRUCT_DISCKEY:
1317                 memcpy(lp->disckey.value, bp->data, sizeof(lp->disckey.value));
1318                 break;
1319         case DVD_STRUCT_BCA:
1320                 lp->bca.len = bp->length;
1321                 memcpy(lp->bca.value, bp->data, sizeof(lp->bca.value));
1322                 break;
1323         case DVD_STRUCT_MANUFACT:
1324                 lp->manufact.len = bp->length;
1325                 memcpy(lp->manufact.value, bp->data,
1326                     sizeof(lp->manufact.value));
1327                 /* lp->manufact.layer_num is unused in linux (redhat 7.0) */
1328                 break;
1329         default:
1330                 return (EINVAL);
1331         }
1332         return (0);
1333 }
1334
1335 static int
1336 linux_to_bsd_dvd_authinfo(l_dvd_authinfo *lp, int *bcode,
1337     struct dvd_authinfo *bp)
1338 {
1339         switch (lp->type) {
1340         case LINUX_DVD_LU_SEND_AGID:
1341                 *bcode = DVDIOCREPORTKEY;
1342                 bp->format = DVD_REPORT_AGID;
1343                 bp->agid = lp->lsa.agid;
1344                 break;
1345         case LINUX_DVD_HOST_SEND_CHALLENGE:
1346                 *bcode = DVDIOCSENDKEY;
1347                 bp->format = DVD_SEND_CHALLENGE;
1348                 bp->agid = lp->hsc.agid;
1349                 memcpy(bp->keychal, lp->hsc.chal, 10);
1350                 break;
1351         case LINUX_DVD_LU_SEND_KEY1:
1352                 *bcode = DVDIOCREPORTKEY;
1353                 bp->format = DVD_REPORT_KEY1;
1354                 bp->agid = lp->lsk.agid;
1355                 break;
1356         case LINUX_DVD_LU_SEND_CHALLENGE:
1357                 *bcode = DVDIOCREPORTKEY;
1358                 bp->format = DVD_REPORT_CHALLENGE;
1359                 bp->agid = lp->lsc.agid;
1360                 break;
1361         case LINUX_DVD_HOST_SEND_KEY2:
1362                 *bcode = DVDIOCSENDKEY;
1363                 bp->format = DVD_SEND_KEY2;
1364                 bp->agid = lp->hsk.agid;
1365                 memcpy(bp->keychal, lp->hsk.key, 5);
1366                 break;
1367         case LINUX_DVD_LU_SEND_TITLE_KEY:
1368                 *bcode = DVDIOCREPORTKEY;
1369                 bp->format = DVD_REPORT_TITLE_KEY;
1370                 bp->agid = lp->lstk.agid;
1371                 bp->lba = lp->lstk.lba;
1372                 break;
1373         case LINUX_DVD_LU_SEND_ASF:
1374                 *bcode = DVDIOCREPORTKEY;
1375                 bp->format = DVD_REPORT_ASF;
1376                 bp->agid = lp->lsasf.agid;
1377                 break;
1378         case LINUX_DVD_INVALIDATE_AGID:
1379                 *bcode = DVDIOCREPORTKEY;
1380                 bp->format = DVD_INVALIDATE_AGID;
1381                 bp->agid = lp->lsa.agid;
1382                 break;
1383         case LINUX_DVD_LU_SEND_RPC_STATE:
1384                 *bcode = DVDIOCREPORTKEY;
1385                 bp->format = DVD_REPORT_RPC;
1386                 break;
1387         case LINUX_DVD_HOST_SEND_RPC_STATE:
1388                 *bcode = DVDIOCSENDKEY;
1389                 bp->format = DVD_SEND_RPC;
1390                 bp->region = lp->hrpcs.pdrc;
1391                 break;
1392         default:
1393                 return (EINVAL);
1394         }
1395         return (0);
1396 }
1397
1398 static int
1399 bsd_to_linux_dvd_authinfo(struct dvd_authinfo *bp, l_dvd_authinfo *lp)
1400 {
1401         switch (lp->type) {
1402         case LINUX_DVD_LU_SEND_AGID:
1403                 lp->lsa.agid = bp->agid;
1404                 break;
1405         case LINUX_DVD_HOST_SEND_CHALLENGE:
1406                 lp->type = LINUX_DVD_LU_SEND_KEY1;
1407                 break;
1408         case LINUX_DVD_LU_SEND_KEY1:
1409                 memcpy(lp->lsk.key, bp->keychal, sizeof(lp->lsk.key));
1410                 break;
1411         case LINUX_DVD_LU_SEND_CHALLENGE:
1412                 memcpy(lp->lsc.chal, bp->keychal, sizeof(lp->lsc.chal));
1413                 break;
1414         case LINUX_DVD_HOST_SEND_KEY2:
1415                 lp->type = LINUX_DVD_AUTH_ESTABLISHED;
1416                 break;
1417         case LINUX_DVD_LU_SEND_TITLE_KEY:
1418                 memcpy(lp->lstk.title_key, bp->keychal,
1419                     sizeof(lp->lstk.title_key));
1420                 lp->lstk.cpm = bp->cpm;
1421                 lp->lstk.cp_sec = bp->cp_sec;
1422                 lp->lstk.cgms = bp->cgms;
1423                 break;
1424         case LINUX_DVD_LU_SEND_ASF:
1425                 lp->lsasf.asf = bp->asf;
1426                 break;
1427         case LINUX_DVD_INVALIDATE_AGID:
1428                 break;
1429         case LINUX_DVD_LU_SEND_RPC_STATE:
1430                 lp->lrpcs.type = bp->reg_type;
1431                 lp->lrpcs.vra = bp->vend_rsts;
1432                 lp->lrpcs.ucca = bp->user_rsts;
1433                 lp->lrpcs.region_mask = bp->region;
1434                 lp->lrpcs.rpc_scheme = bp->rpc_scheme;
1435                 break;
1436         case LINUX_DVD_HOST_SEND_RPC_STATE:
1437                 break;
1438         default:
1439                 return (EINVAL);
1440         }
1441         return (0);
1442 }
1443
1444 static int
1445 linux_ioctl_cdrom(struct thread *td, struct linux_ioctl_args *args)
1446 {
1447         cap_rights_t rights;
1448         struct file *fp;
1449         int error;
1450
1451         error = fget(td, args->fd, cap_rights_init(&rights, CAP_IOCTL), &fp);
1452         if (error != 0)
1453                 return (error);
1454         switch (args->cmd & 0xffff) {
1455
1456         case LINUX_CDROMPAUSE:
1457                 args->cmd = CDIOCPAUSE;
1458                 error = (sys_ioctl(td, (struct ioctl_args *)args));
1459                 break;
1460
1461         case LINUX_CDROMRESUME:
1462                 args->cmd = CDIOCRESUME;
1463                 error = (sys_ioctl(td, (struct ioctl_args *)args));
1464                 break;
1465
1466         case LINUX_CDROMPLAYMSF:
1467                 args->cmd = CDIOCPLAYMSF;
1468                 error = (sys_ioctl(td, (struct ioctl_args *)args));
1469                 break;
1470
1471         case LINUX_CDROMPLAYTRKIND:
1472                 args->cmd = CDIOCPLAYTRACKS;
1473                 error = (sys_ioctl(td, (struct ioctl_args *)args));
1474                 break;
1475
1476         case LINUX_CDROMREADTOCHDR: {
1477                 struct ioc_toc_header th;
1478                 struct linux_cdrom_tochdr lth;
1479                 error = fo_ioctl(fp, CDIOREADTOCHEADER, (caddr_t)&th,
1480                     td->td_ucred, td);
1481                 if (!error) {
1482                         lth.cdth_trk0 = th.starting_track;
1483                         lth.cdth_trk1 = th.ending_track;
1484                         copyout(&lth, (void *)args->arg, sizeof(lth));
1485                 }
1486                 break;
1487         }
1488
1489         case LINUX_CDROMREADTOCENTRY: {
1490                 struct linux_cdrom_tocentry lte;
1491                 struct ioc_read_toc_single_entry irtse;
1492
1493                 error = copyin((void *)args->arg, &lte, sizeof(lte));
1494                 if (error)
1495                         break;
1496                 irtse.address_format = lte.cdte_format;
1497                 irtse.track = lte.cdte_track;
1498                 error = fo_ioctl(fp, CDIOREADTOCENTRY, (caddr_t)&irtse,
1499                     td->td_ucred, td);
1500                 if (!error) {
1501                         lte.cdte_ctrl = irtse.entry.control;
1502                         lte.cdte_adr = irtse.entry.addr_type;
1503                         bsd_to_linux_msf_lba(irtse.address_format,
1504                             &irtse.entry.addr, &lte.cdte_addr);
1505                         error = copyout(&lte, (void *)args->arg, sizeof(lte));
1506                 }
1507                 break;
1508         }
1509
1510         case LINUX_CDROMSTOP:
1511                 args->cmd = CDIOCSTOP;
1512                 error = (sys_ioctl(td, (struct ioctl_args *)args));
1513                 break;
1514
1515         case LINUX_CDROMSTART:
1516                 args->cmd = CDIOCSTART;
1517                 error = (sys_ioctl(td, (struct ioctl_args *)args));
1518                 break;
1519
1520         case LINUX_CDROMEJECT:
1521                 args->cmd = CDIOCEJECT;
1522                 error = (sys_ioctl(td, (struct ioctl_args *)args));
1523                 break;
1524
1525         /* LINUX_CDROMVOLCTRL */
1526
1527         case LINUX_CDROMSUBCHNL: {
1528                 struct linux_cdrom_subchnl sc;
1529                 struct ioc_read_subchannel bsdsc;
1530                 struct cd_sub_channel_info bsdinfo;
1531
1532                 bsdsc.address_format = CD_LBA_FORMAT;
1533                 bsdsc.data_format = CD_CURRENT_POSITION;
1534                 bsdsc.track = 0;
1535                 bsdsc.data_len = sizeof(bsdinfo);
1536                 bsdsc.data = &bsdinfo;
1537                 error = fo_ioctl(fp, CDIOCREADSUBCHANNEL_SYSSPACE,
1538                     (caddr_t)&bsdsc, td->td_ucred, td);
1539                 if (error)
1540                         break;
1541                 error = copyin((void *)args->arg, &sc, sizeof(sc));
1542                 if (error)
1543                         break;
1544                 sc.cdsc_audiostatus = bsdinfo.header.audio_status;
1545                 sc.cdsc_adr = bsdinfo.what.position.addr_type;
1546                 sc.cdsc_ctrl = bsdinfo.what.position.control;
1547                 sc.cdsc_trk = bsdinfo.what.position.track_number;
1548                 sc.cdsc_ind = bsdinfo.what.position.index_number;
1549                 set_linux_cdrom_addr(&sc.cdsc_absaddr, sc.cdsc_format,
1550                     bsdinfo.what.position.absaddr.lba);
1551                 set_linux_cdrom_addr(&sc.cdsc_reladdr, sc.cdsc_format,
1552                     bsdinfo.what.position.reladdr.lba);
1553                 error = copyout(&sc, (void *)args->arg, sizeof(sc));
1554                 break;
1555         }
1556
1557         /* LINUX_CDROMREADMODE2 */
1558         /* LINUX_CDROMREADMODE1 */
1559         /* LINUX_CDROMREADAUDIO */
1560         /* LINUX_CDROMEJECT_SW */
1561         /* LINUX_CDROMMULTISESSION */
1562         /* LINUX_CDROM_GET_UPC */
1563
1564         case LINUX_CDROMRESET:
1565                 args->cmd = CDIOCRESET;
1566                 error = (sys_ioctl(td, (struct ioctl_args *)args));
1567                 break;
1568
1569         /* LINUX_CDROMVOLREAD */
1570         /* LINUX_CDROMREADRAW */
1571         /* LINUX_CDROMREADCOOKED */
1572         /* LINUX_CDROMSEEK */
1573         /* LINUX_CDROMPLAYBLK */
1574         /* LINUX_CDROMREADALL */
1575         /* LINUX_CDROMCLOSETRAY */
1576         /* LINUX_CDROMLOADFROMSLOT */
1577         /* LINUX_CDROMGETSPINDOWN */
1578         /* LINUX_CDROMSETSPINDOWN */
1579         /* LINUX_CDROM_SET_OPTIONS */
1580         /* LINUX_CDROM_CLEAR_OPTIONS */
1581         /* LINUX_CDROM_SELECT_SPEED */
1582         /* LINUX_CDROM_SELECT_DISC */
1583         /* LINUX_CDROM_MEDIA_CHANGED */
1584         /* LINUX_CDROM_DRIVE_STATUS */
1585         /* LINUX_CDROM_DISC_STATUS */
1586         /* LINUX_CDROM_CHANGER_NSLOTS */
1587         /* LINUX_CDROM_LOCKDOOR */
1588         /* LINUX_CDROM_DEBUG */
1589         /* LINUX_CDROM_GET_CAPABILITY */
1590         /* LINUX_CDROMAUDIOBUFSIZ */
1591
1592         case LINUX_DVD_READ_STRUCT: {
1593                 l_dvd_struct *lds;
1594                 struct dvd_struct *bds;
1595
1596                 lds = malloc(sizeof(*lds), M_LINUX, M_WAITOK);
1597                 bds = malloc(sizeof(*bds), M_LINUX, M_WAITOK);
1598                 error = copyin((void *)args->arg, lds, sizeof(*lds));
1599                 if (error)
1600                         goto out;
1601                 error = linux_to_bsd_dvd_struct(lds, bds);
1602                 if (error)
1603                         goto out;
1604                 error = fo_ioctl(fp, DVDIOCREADSTRUCTURE, (caddr_t)bds,
1605                     td->td_ucred, td);
1606                 if (error)
1607                         goto out;
1608                 error = bsd_to_linux_dvd_struct(bds, lds);
1609                 if (error)
1610                         goto out;
1611                 error = copyout(lds, (void *)args->arg, sizeof(*lds));
1612         out:
1613                 free(bds, M_LINUX);
1614                 free(lds, M_LINUX);
1615                 break;
1616         }
1617
1618         /* LINUX_DVD_WRITE_STRUCT */
1619
1620         case LINUX_DVD_AUTH: {
1621                 l_dvd_authinfo lda;
1622                 struct dvd_authinfo bda;
1623                 int bcode;
1624
1625                 error = copyin((void *)args->arg, &lda, sizeof(lda));
1626                 if (error)
1627                         break;
1628                 error = linux_to_bsd_dvd_authinfo(&lda, &bcode, &bda);
1629                 if (error)
1630                         break;
1631                 error = fo_ioctl(fp, bcode, (caddr_t)&bda, td->td_ucred,
1632                     td);
1633                 if (error) {
1634                         if (lda.type == LINUX_DVD_HOST_SEND_KEY2) {
1635                                 lda.type = LINUX_DVD_AUTH_FAILURE;
1636                                 copyout(&lda, (void *)args->arg, sizeof(lda));
1637                         }
1638                         break;
1639                 }
1640                 error = bsd_to_linux_dvd_authinfo(&bda, &lda);
1641                 if (error)
1642                         break;
1643                 error = copyout(&lda, (void *)args->arg, sizeof(lda));
1644                 break;
1645         }
1646
1647         case LINUX_SCSI_GET_BUS_NUMBER:
1648         case LINUX_SCSI_GET_IDLUN:
1649                 error = linux_ioctl_sg(td, args);
1650                 break;
1651
1652         /* LINUX_CDROM_SEND_PACKET */
1653         /* LINUX_CDROM_NEXT_WRITABLE */
1654         /* LINUX_CDROM_LAST_WRITTEN */
1655
1656         default:
1657                 error = ENOIOCTL;
1658                 break;
1659         }
1660
1661         fdrop(fp, td);
1662         return (error);
1663 }
1664
1665 static int
1666 linux_ioctl_vfat(struct thread *td, struct linux_ioctl_args *args)
1667 {
1668
1669         return (ENOTTY);
1670 }
1671
1672 /*
1673  * Sound related ioctls
1674  */
1675
1676 struct linux_mixer_info {
1677         char    id[16];
1678         char    name[32];
1679         int     modify_counter;
1680         int     fillers[10];
1681 };
1682
1683 struct linux_old_mixer_info {
1684         char    id[16];
1685         char    name[32];
1686 };
1687
1688 static u_int32_t dirbits[4] = { IOC_VOID, IOC_IN, IOC_OUT, IOC_INOUT };
1689
1690 #define SETDIR(c)       (((c) & ~IOC_DIRMASK) | dirbits[args->cmd >> 30])
1691
1692 static int
1693 linux_ioctl_sound(struct thread *td, struct linux_ioctl_args *args)
1694 {
1695
1696         switch (args->cmd & 0xffff) {
1697
1698         case LINUX_SOUND_MIXER_WRITE_VOLUME:
1699                 args->cmd = SETDIR(SOUND_MIXER_WRITE_VOLUME);
1700                 return (sys_ioctl(td, (struct ioctl_args *)args));
1701
1702         case LINUX_SOUND_MIXER_WRITE_BASS:
1703                 args->cmd = SETDIR(SOUND_MIXER_WRITE_BASS);
1704                 return (sys_ioctl(td, (struct ioctl_args *)args));
1705
1706         case LINUX_SOUND_MIXER_WRITE_TREBLE:
1707                 args->cmd = SETDIR(SOUND_MIXER_WRITE_TREBLE);
1708                 return (sys_ioctl(td, (struct ioctl_args *)args));
1709
1710         case LINUX_SOUND_MIXER_WRITE_SYNTH:
1711                 args->cmd = SETDIR(SOUND_MIXER_WRITE_SYNTH);
1712                 return (sys_ioctl(td, (struct ioctl_args *)args));
1713
1714         case LINUX_SOUND_MIXER_WRITE_PCM:
1715                 args->cmd = SETDIR(SOUND_MIXER_WRITE_PCM);
1716                 return (sys_ioctl(td, (struct ioctl_args *)args));
1717
1718         case LINUX_SOUND_MIXER_WRITE_SPEAKER:
1719                 args->cmd = SETDIR(SOUND_MIXER_WRITE_SPEAKER);
1720                 return (sys_ioctl(td, (struct ioctl_args *)args));
1721
1722         case LINUX_SOUND_MIXER_WRITE_LINE:
1723                 args->cmd = SETDIR(SOUND_MIXER_WRITE_LINE);
1724                 return (sys_ioctl(td, (struct ioctl_args *)args));
1725
1726         case LINUX_SOUND_MIXER_WRITE_MIC:
1727                 args->cmd = SETDIR(SOUND_MIXER_WRITE_MIC);
1728                 return (sys_ioctl(td, (struct ioctl_args *)args));
1729
1730         case LINUX_SOUND_MIXER_WRITE_CD:
1731                 args->cmd = SETDIR(SOUND_MIXER_WRITE_CD);
1732                 return (sys_ioctl(td, (struct ioctl_args *)args));
1733
1734         case LINUX_SOUND_MIXER_WRITE_IMIX:
1735                 args->cmd = SETDIR(SOUND_MIXER_WRITE_IMIX);
1736                 return (sys_ioctl(td, (struct ioctl_args *)args));
1737
1738         case LINUX_SOUND_MIXER_WRITE_ALTPCM:
1739                 args->cmd = SETDIR(SOUND_MIXER_WRITE_ALTPCM);
1740                 return (sys_ioctl(td, (struct ioctl_args *)args));
1741
1742         case LINUX_SOUND_MIXER_WRITE_RECLEV:
1743                 args->cmd = SETDIR(SOUND_MIXER_WRITE_RECLEV);
1744                 return (sys_ioctl(td, (struct ioctl_args *)args));
1745
1746         case LINUX_SOUND_MIXER_WRITE_IGAIN:
1747                 args->cmd = SETDIR(SOUND_MIXER_WRITE_IGAIN);
1748                 return (sys_ioctl(td, (struct ioctl_args *)args));
1749
1750         case LINUX_SOUND_MIXER_WRITE_OGAIN:
1751                 args->cmd = SETDIR(SOUND_MIXER_WRITE_OGAIN);
1752                 return (sys_ioctl(td, (struct ioctl_args *)args));
1753
1754         case LINUX_SOUND_MIXER_WRITE_LINE1:
1755                 args->cmd = SETDIR(SOUND_MIXER_WRITE_LINE1);
1756                 return (sys_ioctl(td, (struct ioctl_args *)args));
1757
1758         case LINUX_SOUND_MIXER_WRITE_LINE2:
1759                 args->cmd = SETDIR(SOUND_MIXER_WRITE_LINE2);
1760                 return (sys_ioctl(td, (struct ioctl_args *)args));
1761
1762         case LINUX_SOUND_MIXER_WRITE_LINE3:
1763                 args->cmd = SETDIR(SOUND_MIXER_WRITE_LINE3);
1764                 return (sys_ioctl(td, (struct ioctl_args *)args));
1765
1766         case LINUX_SOUND_MIXER_INFO: {
1767                 /* Key on encoded length */
1768                 switch ((args->cmd >> 16) & 0x1fff) {
1769                 case 0x005c: {  /* SOUND_MIXER_INFO */
1770                         struct linux_mixer_info info;
1771                         bzero(&info, sizeof(info));
1772                         strncpy(info.id, "OSS", sizeof(info.id) - 1);
1773                         strncpy(info.name, "FreeBSD OSS Mixer", sizeof(info.name) - 1);
1774                         copyout(&info, (void *)args->arg, sizeof(info));
1775                         return (0);
1776                 }
1777                 case 0x0030: {  /* SOUND_OLD_MIXER_INFO */
1778                         struct linux_old_mixer_info info;
1779                         bzero(&info, sizeof(info));
1780                         strncpy(info.id, "OSS", sizeof(info.id) - 1);
1781                         strncpy(info.name, "FreeBSD OSS Mixer", sizeof(info.name) - 1);
1782                         copyout(&info, (void *)args->arg, sizeof(info));
1783                         return (0);
1784                 }
1785                 default:
1786                         return (ENOIOCTL);
1787                 }
1788                 break;
1789         }
1790
1791         case LINUX_OSS_GETVERSION: {
1792                 int version = linux_get_oss_version(td);
1793                 return (copyout(&version, (void *)args->arg, sizeof(int)));
1794         }
1795
1796         case LINUX_SOUND_MIXER_READ_STEREODEVS:
1797                 args->cmd = SOUND_MIXER_READ_STEREODEVS;
1798                 return (sys_ioctl(td, (struct ioctl_args *)args));
1799
1800         case LINUX_SOUND_MIXER_READ_CAPS:
1801                 args->cmd = SOUND_MIXER_READ_CAPS;
1802                 return (sys_ioctl(td, (struct ioctl_args *)args));
1803
1804         case LINUX_SOUND_MIXER_READ_RECMASK:
1805                 args->cmd = SOUND_MIXER_READ_RECMASK;
1806                 return (sys_ioctl(td, (struct ioctl_args *)args));
1807
1808         case LINUX_SOUND_MIXER_READ_DEVMASK:
1809                 args->cmd = SOUND_MIXER_READ_DEVMASK;
1810                 return (sys_ioctl(td, (struct ioctl_args *)args));
1811
1812         case LINUX_SOUND_MIXER_WRITE_RECSRC:
1813                 args->cmd = SETDIR(SOUND_MIXER_WRITE_RECSRC);
1814                 return (sys_ioctl(td, (struct ioctl_args *)args));
1815
1816         case LINUX_SNDCTL_DSP_RESET:
1817                 args->cmd = SNDCTL_DSP_RESET;
1818                 return (sys_ioctl(td, (struct ioctl_args *)args));
1819
1820         case LINUX_SNDCTL_DSP_SYNC:
1821                 args->cmd = SNDCTL_DSP_SYNC;
1822                 return (sys_ioctl(td, (struct ioctl_args *)args));
1823
1824         case LINUX_SNDCTL_DSP_SPEED:
1825                 args->cmd = SNDCTL_DSP_SPEED;
1826                 return (sys_ioctl(td, (struct ioctl_args *)args));
1827
1828         case LINUX_SNDCTL_DSP_STEREO:
1829                 args->cmd = SNDCTL_DSP_STEREO;
1830                 return (sys_ioctl(td, (struct ioctl_args *)args));
1831
1832         case LINUX_SNDCTL_DSP_GETBLKSIZE: /* LINUX_SNDCTL_DSP_SETBLKSIZE */
1833                 args->cmd = SNDCTL_DSP_GETBLKSIZE;
1834                 return (sys_ioctl(td, (struct ioctl_args *)args));
1835
1836         case LINUX_SNDCTL_DSP_SETFMT:
1837                 args->cmd = SNDCTL_DSP_SETFMT;
1838                 return (sys_ioctl(td, (struct ioctl_args *)args));
1839
1840         case LINUX_SOUND_PCM_WRITE_CHANNELS:
1841                 args->cmd = SOUND_PCM_WRITE_CHANNELS;
1842                 return (sys_ioctl(td, (struct ioctl_args *)args));
1843
1844         case LINUX_SOUND_PCM_WRITE_FILTER:
1845                 args->cmd = SOUND_PCM_WRITE_FILTER;
1846                 return (sys_ioctl(td, (struct ioctl_args *)args));
1847
1848         case LINUX_SNDCTL_DSP_POST:
1849                 args->cmd = SNDCTL_DSP_POST;
1850                 return (sys_ioctl(td, (struct ioctl_args *)args));
1851
1852         case LINUX_SNDCTL_DSP_SUBDIVIDE:
1853                 args->cmd = SNDCTL_DSP_SUBDIVIDE;
1854                 return (sys_ioctl(td, (struct ioctl_args *)args));
1855
1856         case LINUX_SNDCTL_DSP_SETFRAGMENT:
1857                 args->cmd = SNDCTL_DSP_SETFRAGMENT;
1858                 return (sys_ioctl(td, (struct ioctl_args *)args));
1859
1860         case LINUX_SNDCTL_DSP_GETFMTS:
1861                 args->cmd = SNDCTL_DSP_GETFMTS;
1862                 return (sys_ioctl(td, (struct ioctl_args *)args));
1863
1864         case LINUX_SNDCTL_DSP_GETOSPACE:
1865                 args->cmd = SNDCTL_DSP_GETOSPACE;
1866                 return (sys_ioctl(td, (struct ioctl_args *)args));
1867
1868         case LINUX_SNDCTL_DSP_GETISPACE:
1869                 args->cmd = SNDCTL_DSP_GETISPACE;
1870                 return (sys_ioctl(td, (struct ioctl_args *)args));
1871
1872         case LINUX_SNDCTL_DSP_NONBLOCK:
1873                 args->cmd = SNDCTL_DSP_NONBLOCK;
1874                 return (sys_ioctl(td, (struct ioctl_args *)args));
1875
1876         case LINUX_SNDCTL_DSP_GETCAPS:
1877                 args->cmd = SNDCTL_DSP_GETCAPS;
1878                 return (sys_ioctl(td, (struct ioctl_args *)args));
1879
1880         case LINUX_SNDCTL_DSP_SETTRIGGER: /* LINUX_SNDCTL_GETTRIGGER */
1881                 args->cmd = SNDCTL_DSP_SETTRIGGER;
1882                 return (sys_ioctl(td, (struct ioctl_args *)args));
1883
1884         case LINUX_SNDCTL_DSP_GETIPTR:
1885                 args->cmd = SNDCTL_DSP_GETIPTR;
1886                 return (sys_ioctl(td, (struct ioctl_args *)args));
1887
1888         case LINUX_SNDCTL_DSP_GETOPTR:
1889                 args->cmd = SNDCTL_DSP_GETOPTR;
1890                 return (sys_ioctl(td, (struct ioctl_args *)args));
1891
1892         case LINUX_SNDCTL_DSP_SETDUPLEX:
1893                 args->cmd = SNDCTL_DSP_SETDUPLEX;
1894                 return (sys_ioctl(td, (struct ioctl_args *)args));
1895
1896         case LINUX_SNDCTL_DSP_GETODELAY:
1897                 args->cmd = SNDCTL_DSP_GETODELAY;
1898                 return (sys_ioctl(td, (struct ioctl_args *)args));
1899
1900         case LINUX_SNDCTL_SEQ_RESET:
1901                 args->cmd = SNDCTL_SEQ_RESET;
1902                 return (sys_ioctl(td, (struct ioctl_args *)args));
1903
1904         case LINUX_SNDCTL_SEQ_SYNC:
1905                 args->cmd = SNDCTL_SEQ_SYNC;
1906                 return (sys_ioctl(td, (struct ioctl_args *)args));
1907
1908         case LINUX_SNDCTL_SYNTH_INFO:
1909                 args->cmd = SNDCTL_SYNTH_INFO;
1910                 return (sys_ioctl(td, (struct ioctl_args *)args));
1911
1912         case LINUX_SNDCTL_SEQ_CTRLRATE:
1913                 args->cmd = SNDCTL_SEQ_CTRLRATE;
1914                 return (sys_ioctl(td, (struct ioctl_args *)args));
1915
1916         case LINUX_SNDCTL_SEQ_GETOUTCOUNT:
1917                 args->cmd = SNDCTL_SEQ_GETOUTCOUNT;
1918                 return (sys_ioctl(td, (struct ioctl_args *)args));
1919
1920         case LINUX_SNDCTL_SEQ_GETINCOUNT:
1921                 args->cmd = SNDCTL_SEQ_GETINCOUNT;
1922                 return (sys_ioctl(td, (struct ioctl_args *)args));
1923
1924         case LINUX_SNDCTL_SEQ_PERCMODE:
1925                 args->cmd = SNDCTL_SEQ_PERCMODE;
1926                 return (sys_ioctl(td, (struct ioctl_args *)args));
1927
1928         case LINUX_SNDCTL_FM_LOAD_INSTR:
1929                 args->cmd = SNDCTL_FM_LOAD_INSTR;
1930                 return (sys_ioctl(td, (struct ioctl_args *)args));
1931
1932         case LINUX_SNDCTL_SEQ_TESTMIDI:
1933                 args->cmd = SNDCTL_SEQ_TESTMIDI;
1934                 return (sys_ioctl(td, (struct ioctl_args *)args));
1935
1936         case LINUX_SNDCTL_SEQ_RESETSAMPLES:
1937                 args->cmd = SNDCTL_SEQ_RESETSAMPLES;
1938                 return (sys_ioctl(td, (struct ioctl_args *)args));
1939
1940         case LINUX_SNDCTL_SEQ_NRSYNTHS:
1941                 args->cmd = SNDCTL_SEQ_NRSYNTHS;
1942                 return (sys_ioctl(td, (struct ioctl_args *)args));
1943
1944         case LINUX_SNDCTL_SEQ_NRMIDIS:
1945                 args->cmd = SNDCTL_SEQ_NRMIDIS;
1946                 return (sys_ioctl(td, (struct ioctl_args *)args));
1947
1948         case LINUX_SNDCTL_MIDI_INFO:
1949                 args->cmd = SNDCTL_MIDI_INFO;
1950                 return (sys_ioctl(td, (struct ioctl_args *)args));
1951
1952         case LINUX_SNDCTL_SEQ_TRESHOLD:
1953                 args->cmd = SNDCTL_SEQ_TRESHOLD;
1954                 return (sys_ioctl(td, (struct ioctl_args *)args));
1955
1956         case LINUX_SNDCTL_SYNTH_MEMAVL:
1957                 args->cmd = SNDCTL_SYNTH_MEMAVL;
1958                 return (sys_ioctl(td, (struct ioctl_args *)args));
1959
1960         }
1961
1962         return (ENOIOCTL);
1963 }
1964
1965 /*
1966  * Console related ioctls
1967  */
1968
1969 #define ISSIGVALID(sig)         ((sig) > 0 && (sig) < NSIG)
1970
1971 static int
1972 linux_ioctl_console(struct thread *td, struct linux_ioctl_args *args)
1973 {
1974         cap_rights_t rights;
1975         struct file *fp;
1976         int error;
1977
1978         error = fget(td, args->fd, cap_rights_init(&rights, CAP_IOCTL), &fp);
1979         if (error != 0)
1980                 return (error);
1981         switch (args->cmd & 0xffff) {
1982
1983         case LINUX_KIOCSOUND:
1984                 args->cmd = KIOCSOUND;
1985                 error = (sys_ioctl(td, (struct ioctl_args *)args));
1986                 break;
1987
1988         case LINUX_KDMKTONE:
1989                 args->cmd = KDMKTONE;
1990                 error = (sys_ioctl(td, (struct ioctl_args *)args));
1991                 break;
1992
1993         case LINUX_KDGETLED:
1994                 args->cmd = KDGETLED;
1995                 error = (sys_ioctl(td, (struct ioctl_args *)args));
1996                 break;
1997
1998         case LINUX_KDSETLED:
1999                 args->cmd = KDSETLED;
2000                 error = (sys_ioctl(td, (struct ioctl_args *)args));
2001                 break;
2002
2003         case LINUX_KDSETMODE:
2004                 args->cmd = KDSETMODE;
2005                 error = (sys_ioctl(td, (struct ioctl_args *)args));
2006                 break;
2007
2008         case LINUX_KDGETMODE:
2009                 args->cmd = KDGETMODE;
2010                 error = (sys_ioctl(td, (struct ioctl_args *)args));
2011                 break;
2012
2013         case LINUX_KDGKBMODE:
2014                 args->cmd = KDGKBMODE;
2015                 error = (sys_ioctl(td, (struct ioctl_args *)args));
2016                 break;
2017
2018         case LINUX_KDSKBMODE: {
2019                 int kbdmode;
2020                 switch (args->arg) {
2021                 case LINUX_KBD_RAW:
2022                         kbdmode = K_RAW;
2023                         break;
2024                 case LINUX_KBD_XLATE:
2025                         kbdmode = K_XLATE;
2026                         break;
2027                 case LINUX_KBD_MEDIUMRAW:
2028                         kbdmode = K_RAW;
2029                         break;
2030                 default:
2031                         fdrop(fp, td);
2032                         return (EINVAL);
2033                 }
2034                 error = (fo_ioctl(fp, KDSKBMODE, (caddr_t)&kbdmode,
2035                     td->td_ucred, td));
2036                 break;
2037         }
2038
2039         case LINUX_VT_OPENQRY:
2040                 args->cmd = VT_OPENQRY;
2041                 error = (sys_ioctl(td, (struct ioctl_args *)args));
2042                 break;
2043
2044         case LINUX_VT_GETMODE:
2045                 args->cmd = VT_GETMODE;
2046                 error = (sys_ioctl(td, (struct ioctl_args *)args));
2047                 break;
2048
2049         case LINUX_VT_SETMODE: {
2050                 struct vt_mode mode;
2051                 if ((error = copyin((void *)args->arg, &mode, sizeof(mode))))
2052                         break;
2053                 if (!ISSIGVALID(mode.frsig) && ISSIGVALID(mode.acqsig))
2054                         mode.frsig = mode.acqsig;
2055                 if ((error = copyout(&mode, (void *)args->arg, sizeof(mode))))
2056                         break;
2057                 args->cmd = VT_SETMODE;
2058                 error = (sys_ioctl(td, (struct ioctl_args *)args));
2059                 break;
2060         }
2061
2062         case LINUX_VT_GETSTATE:
2063                 args->cmd = VT_GETACTIVE;
2064                 error = (sys_ioctl(td, (struct ioctl_args *)args));
2065                 break;
2066
2067         case LINUX_VT_RELDISP:
2068                 args->cmd = VT_RELDISP;
2069                 error = (sys_ioctl(td, (struct ioctl_args *)args));
2070                 break;
2071
2072         case LINUX_VT_ACTIVATE:
2073                 args->cmd = VT_ACTIVATE;
2074                 error = (sys_ioctl(td, (struct ioctl_args *)args));
2075                 break;
2076
2077         case LINUX_VT_WAITACTIVE:
2078                 args->cmd = VT_WAITACTIVE;
2079                 error = (sys_ioctl(td, (struct ioctl_args *)args));
2080                 break;
2081
2082         default:
2083                 error = ENOIOCTL;
2084                 break;
2085         }
2086
2087         fdrop(fp, td);
2088         return (error);
2089 }
2090
2091 /*
2092  * Criteria for interface name translation
2093  */
2094 #define IFP_IS_ETH(ifp) (ifp->if_type == IFT_ETHER)
2095
2096 /*
2097  * Interface function used by linprocfs (at the time of writing). It's not
2098  * used by the Linuxulator itself.
2099  */
2100 int
2101 linux_ifname(struct ifnet *ifp, char *buffer, size_t buflen)
2102 {
2103         struct ifnet *ifscan;
2104         int ethno;
2105
2106         IFNET_RLOCK_ASSERT();
2107
2108         /* Short-circuit non ethernet interfaces */
2109         if (!IFP_IS_ETH(ifp))
2110                 return (strlcpy(buffer, ifp->if_xname, buflen));
2111
2112         /* Determine the (relative) unit number for ethernet interfaces */
2113         ethno = 0;
2114         TAILQ_FOREACH(ifscan, &V_ifnet, if_link) {
2115                 if (ifscan == ifp)
2116                         return (snprintf(buffer, buflen, "eth%d", ethno));
2117                 if (IFP_IS_ETH(ifscan))
2118                         ethno++;
2119         }
2120
2121         return (0);
2122 }
2123
2124 /*
2125  * Translate a Linux interface name to a FreeBSD interface name,
2126  * and return the associated ifnet structure
2127  * bsdname and lxname need to be least IFNAMSIZ bytes long, but
2128  * can point to the same buffer.
2129  */
2130
2131 static struct ifnet *
2132 ifname_linux_to_bsd(struct thread *td, const char *lxname, char *bsdname)
2133 {
2134         struct ifnet *ifp;
2135         int len, unit;
2136         char *ep;
2137         int is_eth, index;
2138
2139         for (len = 0; len < LINUX_IFNAMSIZ; ++len)
2140                 if (!isalpha(lxname[len]))
2141                         break;
2142         if (len == 0 || len == LINUX_IFNAMSIZ)
2143                 return (NULL);
2144         unit = (int)strtoul(lxname + len, &ep, 10);
2145         if (ep == NULL || ep == lxname + len || ep >= lxname + LINUX_IFNAMSIZ)
2146                 return (NULL);
2147         index = 0;
2148         is_eth = (len == 3 && !strncmp(lxname, "eth", len)) ? 1 : 0;
2149         CURVNET_SET(TD_TO_VNET(td));
2150         IFNET_RLOCK();
2151         TAILQ_FOREACH(ifp, &V_ifnet, if_link) {
2152                 /*
2153                  * Allow Linux programs to use FreeBSD names. Don't presume
2154                  * we never have an interface named "eth", so don't make
2155                  * the test optional based on is_eth.
2156                  */
2157                 if (strncmp(ifp->if_xname, lxname, LINUX_IFNAMSIZ) == 0)
2158                         break;
2159                 if (is_eth && IFP_IS_ETH(ifp) && unit == index++)
2160                         break;
2161         }
2162         IFNET_RUNLOCK();
2163         CURVNET_RESTORE();
2164         if (ifp != NULL)
2165                 strlcpy(bsdname, ifp->if_xname, IFNAMSIZ);
2166         return (ifp);
2167 }
2168
2169 /*
2170  * Implement the SIOCGIFCONF ioctl
2171  */
2172
2173 static int
2174 linux_ifconf(struct thread *td, struct ifconf *uifc)
2175 {
2176 #ifdef COMPAT_LINUX32
2177         struct l_ifconf ifc;
2178 #else
2179         struct ifconf ifc;
2180 #endif
2181         struct l_ifreq ifr;
2182         struct ifnet *ifp;
2183         struct ifaddr *ifa;
2184         struct sbuf *sb;
2185         int error, ethno, full = 0, valid_len, max_len;
2186
2187         error = copyin(uifc, &ifc, sizeof(ifc));
2188         if (error != 0)
2189                 return (error);
2190
2191         max_len = MAXPHYS - 1;
2192
2193         CURVNET_SET(TD_TO_VNET(td));
2194         /* handle the 'request buffer size' case */
2195         if ((l_uintptr_t)ifc.ifc_buf == PTROUT(NULL)) {
2196                 ifc.ifc_len = 0;
2197                 IFNET_RLOCK();
2198                 TAILQ_FOREACH(ifp, &V_ifnet, if_link) {
2199                         TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
2200                                 struct sockaddr *sa = ifa->ifa_addr;
2201                                 if (sa->sa_family == AF_INET)
2202                                         ifc.ifc_len += sizeof(ifr);
2203                         }
2204                 }
2205                 IFNET_RUNLOCK();
2206                 error = copyout(&ifc, uifc, sizeof(ifc));
2207                 CURVNET_RESTORE();
2208                 return (error);
2209         }
2210
2211         if (ifc.ifc_len <= 0) {
2212                 CURVNET_RESTORE();
2213                 return (EINVAL);
2214         }
2215
2216 again:
2217         /* Keep track of eth interfaces */
2218         ethno = 0;
2219         if (ifc.ifc_len <= max_len) {
2220                 max_len = ifc.ifc_len;
2221                 full = 1;
2222         }
2223         sb = sbuf_new(NULL, NULL, max_len + 1, SBUF_FIXEDLEN);
2224         max_len = 0;
2225         valid_len = 0;
2226
2227         /* Return all AF_INET addresses of all interfaces */
2228         IFNET_RLOCK();
2229         TAILQ_FOREACH(ifp, &V_ifnet, if_link) {
2230                 int addrs = 0;
2231
2232                 bzero(&ifr, sizeof(ifr));
2233                 if (IFP_IS_ETH(ifp))
2234                         snprintf(ifr.ifr_name, LINUX_IFNAMSIZ, "eth%d",
2235                             ethno++);
2236                 else
2237                         strlcpy(ifr.ifr_name, ifp->if_xname, LINUX_IFNAMSIZ);
2238
2239                 /* Walk the address list */
2240                 TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
2241                         struct sockaddr *sa = ifa->ifa_addr;
2242
2243                         if (sa->sa_family == AF_INET) {
2244                                 ifr.ifr_addr.sa_family = LINUX_AF_INET;
2245                                 memcpy(ifr.ifr_addr.sa_data, sa->sa_data,
2246                                     sizeof(ifr.ifr_addr.sa_data));
2247                                 sbuf_bcat(sb, &ifr, sizeof(ifr));
2248                                 max_len += sizeof(ifr);
2249                                 addrs++;
2250                         }
2251
2252                         if (sbuf_error(sb) == 0)
2253                                 valid_len = sbuf_len(sb);
2254                 }
2255                 if (addrs == 0) {
2256                         bzero((caddr_t)&ifr.ifr_addr, sizeof(ifr.ifr_addr));
2257                         sbuf_bcat(sb, &ifr, sizeof(ifr));
2258                         max_len += sizeof(ifr);
2259
2260                         if (sbuf_error(sb) == 0)
2261                                 valid_len = sbuf_len(sb);
2262                 }
2263         }
2264         IFNET_RUNLOCK();
2265
2266         if (valid_len != max_len && !full) {
2267                 sbuf_delete(sb);
2268                 goto again;
2269         }
2270
2271         ifc.ifc_len = valid_len;
2272         sbuf_finish(sb);
2273         error = copyout(sbuf_data(sb), PTRIN(ifc.ifc_buf), ifc.ifc_len);
2274         if (error == 0)
2275                 error = copyout(&ifc, uifc, sizeof(ifc));
2276         sbuf_delete(sb);
2277         CURVNET_RESTORE();
2278
2279         return (error);
2280 }
2281
2282 static int
2283 linux_gifflags(struct thread *td, struct ifnet *ifp, struct l_ifreq *ifr)
2284 {
2285         l_short flags;
2286
2287         flags = (ifp->if_flags | ifp->if_drv_flags) & 0xffff;
2288         /* these flags have no Linux equivalent */
2289         flags &= ~(IFF_SMART|IFF_DRV_OACTIVE|IFF_SIMPLEX|
2290             IFF_LINK0|IFF_LINK1|IFF_LINK2);
2291         /* Linux' multicast flag is in a different bit */
2292         if (flags & IFF_MULTICAST) {
2293                 flags &= ~IFF_MULTICAST;
2294                 flags |= 0x1000;
2295         }
2296
2297         return (copyout(&flags, &ifr->ifr_flags, sizeof(flags)));
2298 }
2299
2300 #define ARPHRD_ETHER    1
2301 #define ARPHRD_LOOPBACK 772
2302
2303 static int
2304 linux_gifhwaddr(struct ifnet *ifp, struct l_ifreq *ifr)
2305 {
2306         struct ifaddr *ifa;
2307         struct sockaddr_dl *sdl;
2308         struct l_sockaddr lsa;
2309
2310         if (ifp->if_type == IFT_LOOP) {
2311                 bzero(&lsa, sizeof(lsa));
2312                 lsa.sa_family = ARPHRD_LOOPBACK;
2313                 return (copyout(&lsa, &ifr->ifr_hwaddr, sizeof(lsa)));
2314         }
2315
2316         if (ifp->if_type != IFT_ETHER)
2317                 return (ENOENT);
2318
2319         TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
2320                 sdl = (struct sockaddr_dl*)ifa->ifa_addr;
2321                 if (sdl != NULL && (sdl->sdl_family == AF_LINK) &&
2322                     (sdl->sdl_type == IFT_ETHER)) {
2323                         bzero(&lsa, sizeof(lsa));
2324                         lsa.sa_family = ARPHRD_ETHER;
2325                         bcopy(LLADDR(sdl), lsa.sa_data, LINUX_IFHWADDRLEN);
2326                         return (copyout(&lsa, &ifr->ifr_hwaddr, sizeof(lsa)));
2327                 }
2328         }
2329
2330         return (ENOENT);
2331 }
2332
2333
2334  /*
2335 * If we fault in bsd_to_linux_ifreq() then we will fault when we call
2336 * the native ioctl().  Thus, we don't really need to check the return
2337 * value of this function.
2338 */
2339 static int
2340 bsd_to_linux_ifreq(struct ifreq *arg)
2341 {
2342         struct ifreq ifr;
2343         size_t ifr_len = sizeof(struct ifreq);
2344         int error;
2345
2346         if ((error = copyin(arg, &ifr, ifr_len)))
2347                 return (error);
2348
2349         *(u_short *)&ifr.ifr_addr = ifr.ifr_addr.sa_family;
2350
2351         error = copyout(&ifr, arg, ifr_len);
2352
2353         return (error);
2354 }
2355
2356 /*
2357  * Socket related ioctls
2358  */
2359
2360 static int
2361 linux_ioctl_socket(struct thread *td, struct linux_ioctl_args *args)
2362 {
2363         char lifname[LINUX_IFNAMSIZ], ifname[IFNAMSIZ];
2364         cap_rights_t rights;
2365         struct ifnet *ifp;
2366         struct file *fp;
2367         int error, type;
2368
2369         ifp = NULL;
2370         error = 0;
2371
2372         error = fget(td, args->fd, cap_rights_init(&rights, CAP_IOCTL), &fp);
2373         if (error != 0)
2374                 return (error);
2375         type = fp->f_type;
2376         fdrop(fp, td);
2377         if (type != DTYPE_SOCKET) {
2378                 /* not a socket - probably a tap / vmnet device */
2379                 switch (args->cmd) {
2380                 case LINUX_SIOCGIFADDR:
2381                 case LINUX_SIOCSIFADDR:
2382                 case LINUX_SIOCGIFFLAGS:
2383                         return (linux_ioctl_special(td, args));
2384                 default:
2385                         return (ENOIOCTL);
2386                 }
2387         }
2388
2389         switch (args->cmd & 0xffff) {
2390
2391         case LINUX_FIOGETOWN:
2392         case LINUX_FIOSETOWN:
2393         case LINUX_SIOCADDMULTI:
2394         case LINUX_SIOCATMARK:
2395         case LINUX_SIOCDELMULTI:
2396         case LINUX_SIOCGIFCONF:
2397         case LINUX_SIOCGPGRP:
2398         case LINUX_SIOCSPGRP:
2399         case LINUX_SIOCGIFCOUNT:
2400                 /* these ioctls don't take an interface name */
2401 #ifdef DEBUG
2402                 printf("%s(): ioctl %d\n", __func__,
2403                     args->cmd & 0xffff);
2404 #endif
2405                 break;
2406
2407         case LINUX_SIOCGIFFLAGS:
2408         case LINUX_SIOCGIFADDR:
2409         case LINUX_SIOCSIFADDR:
2410         case LINUX_SIOCGIFDSTADDR:
2411         case LINUX_SIOCGIFBRDADDR:
2412         case LINUX_SIOCGIFNETMASK:
2413         case LINUX_SIOCSIFNETMASK:
2414         case LINUX_SIOCGIFMTU:
2415         case LINUX_SIOCSIFMTU:
2416         case LINUX_SIOCSIFNAME:
2417         case LINUX_SIOCGIFHWADDR:
2418         case LINUX_SIOCSIFHWADDR:
2419         case LINUX_SIOCDEVPRIVATE:
2420         case LINUX_SIOCDEVPRIVATE+1:
2421         case LINUX_SIOCGIFINDEX:
2422                 /* copy in the interface name and translate it. */
2423                 error = copyin((void *)args->arg, lifname, LINUX_IFNAMSIZ);
2424                 if (error != 0)
2425                         return (error);
2426 #ifdef DEBUG
2427                 printf("%s(): ioctl %d on %.*s\n", __func__,
2428                     args->cmd & 0xffff, LINUX_IFNAMSIZ, lifname);
2429 #endif
2430                 ifp = ifname_linux_to_bsd(td, lifname, ifname);
2431                 if (ifp == NULL)
2432                         return (EINVAL);
2433                 /*
2434                  * We need to copy it back out in case we pass the
2435                  * request on to our native ioctl(), which will expect
2436                  * the ifreq to be in user space and have the correct
2437                  * interface name.
2438                  */
2439                 error = copyout(ifname, (void *)args->arg, IFNAMSIZ);
2440                 if (error != 0)
2441                         return (error);
2442 #ifdef DEBUG
2443                 printf("%s(): %s translated to %s\n", __func__,
2444                     lifname, ifname);
2445 #endif
2446                 break;
2447
2448         default:
2449                 return (ENOIOCTL);
2450         }
2451
2452         switch (args->cmd & 0xffff) {
2453
2454         case LINUX_FIOSETOWN:
2455                 args->cmd = FIOSETOWN;
2456                 error = sys_ioctl(td, (struct ioctl_args *)args);
2457                 break;
2458
2459         case LINUX_SIOCSPGRP:
2460                 args->cmd = SIOCSPGRP;
2461                 error = sys_ioctl(td, (struct ioctl_args *)args);
2462                 break;
2463
2464         case LINUX_FIOGETOWN:
2465                 args->cmd = FIOGETOWN;
2466                 error = sys_ioctl(td, (struct ioctl_args *)args);
2467                 break;
2468
2469         case LINUX_SIOCGPGRP:
2470                 args->cmd = SIOCGPGRP;
2471                 error = sys_ioctl(td, (struct ioctl_args *)args);
2472                 break;
2473
2474         case LINUX_SIOCATMARK:
2475                 args->cmd = SIOCATMARK;
2476                 error = sys_ioctl(td, (struct ioctl_args *)args);
2477                 break;
2478
2479         /* LINUX_SIOCGSTAMP */
2480
2481         case LINUX_SIOCGIFCONF:
2482                 error = linux_ifconf(td, (struct ifconf *)args->arg);
2483                 break;
2484
2485         case LINUX_SIOCGIFFLAGS:
2486                 args->cmd = SIOCGIFFLAGS;
2487                 error = linux_gifflags(td, ifp, (struct l_ifreq *)args->arg);
2488                 break;
2489
2490         case LINUX_SIOCGIFADDR:
2491                 args->cmd = SIOCGIFADDR;
2492                 error = sys_ioctl(td, (struct ioctl_args *)args);
2493                 bsd_to_linux_ifreq((struct ifreq *)args->arg);
2494                 break;
2495
2496         case LINUX_SIOCSIFADDR:
2497                 /* XXX probably doesn't work, included for completeness */
2498                 args->cmd = SIOCSIFADDR;
2499                 error = sys_ioctl(td, (struct ioctl_args *)args);
2500                 break;
2501
2502         case LINUX_SIOCGIFDSTADDR:
2503                 args->cmd = SIOCGIFDSTADDR;
2504                 error = sys_ioctl(td, (struct ioctl_args *)args);
2505                 bsd_to_linux_ifreq((struct ifreq *)args->arg);
2506                 break;
2507
2508         case LINUX_SIOCGIFBRDADDR:
2509                 args->cmd = SIOCGIFBRDADDR;
2510                 error = sys_ioctl(td, (struct ioctl_args *)args);
2511                 bsd_to_linux_ifreq((struct ifreq *)args->arg);
2512                 break;
2513
2514         case LINUX_SIOCGIFNETMASK:
2515                 args->cmd = SIOCGIFNETMASK;
2516                 error = sys_ioctl(td, (struct ioctl_args *)args);
2517                 bsd_to_linux_ifreq((struct ifreq *)args->arg);
2518                 break;
2519
2520         case LINUX_SIOCSIFNETMASK:
2521                 error = ENOIOCTL;
2522                 break;
2523
2524         case LINUX_SIOCGIFMTU:
2525                 args->cmd = SIOCGIFMTU;
2526                 error = sys_ioctl(td, (struct ioctl_args *)args);
2527                 break;
2528
2529         case LINUX_SIOCSIFMTU:
2530                 args->cmd = SIOCSIFMTU;
2531                 error = sys_ioctl(td, (struct ioctl_args *)args);
2532                 break;
2533
2534         case LINUX_SIOCSIFNAME:
2535                 error = ENOIOCTL;
2536                 break;
2537
2538         case LINUX_SIOCGIFHWADDR:
2539                 error = linux_gifhwaddr(ifp, (struct l_ifreq *)args->arg);
2540                 break;
2541
2542         case LINUX_SIOCSIFHWADDR:
2543                 error = ENOIOCTL;
2544                 break;
2545
2546         case LINUX_SIOCADDMULTI:
2547                 args->cmd = SIOCADDMULTI;
2548                 error = sys_ioctl(td, (struct ioctl_args *)args);
2549                 break;
2550
2551         case LINUX_SIOCDELMULTI:
2552                 args->cmd = SIOCDELMULTI;
2553                 error = sys_ioctl(td, (struct ioctl_args *)args);
2554                 break;
2555
2556         case LINUX_SIOCGIFINDEX:
2557                 args->cmd = SIOCGIFINDEX;
2558                 error = sys_ioctl(td, (struct ioctl_args *)args);
2559                 break;
2560
2561         case LINUX_SIOCGIFCOUNT:
2562                 error = 0;
2563                 break;
2564
2565         /*
2566          * XXX This is slightly bogus, but these ioctls are currently
2567          * XXX only used by the aironet (if_an) network driver.
2568          */
2569         case LINUX_SIOCDEVPRIVATE:
2570                 args->cmd = SIOCGPRIVATE_0;
2571                 error = sys_ioctl(td, (struct ioctl_args *)args);
2572                 break;
2573
2574         case LINUX_SIOCDEVPRIVATE+1:
2575                 args->cmd = SIOCGPRIVATE_1;
2576                 error = sys_ioctl(td, (struct ioctl_args *)args);
2577                 break;
2578         }
2579
2580         if (ifp != NULL)
2581                 /* restore the original interface name */
2582                 copyout(lifname, (void *)args->arg, LINUX_IFNAMSIZ);
2583
2584 #ifdef DEBUG
2585         printf("%s(): returning %d\n", __func__, error);
2586 #endif
2587         return (error);
2588 }
2589
2590 /*
2591  * Device private ioctl handler
2592  */
2593 static int
2594 linux_ioctl_private(struct thread *td, struct linux_ioctl_args *args)
2595 {
2596         cap_rights_t rights;
2597         struct file *fp;
2598         int error, type;
2599
2600         error = fget(td, args->fd, cap_rights_init(&rights, CAP_IOCTL), &fp);
2601         if (error != 0)
2602                 return (error);
2603         type = fp->f_type;
2604         fdrop(fp, td);
2605         if (type == DTYPE_SOCKET)
2606                 return (linux_ioctl_socket(td, args));
2607         return (ENOIOCTL);
2608 }
2609
2610 /*
2611  * DRM ioctl handler (sys/dev/drm)
2612  */
2613 static int
2614 linux_ioctl_drm(struct thread *td, struct linux_ioctl_args *args)
2615 {
2616         args->cmd = SETDIR(args->cmd);
2617         return sys_ioctl(td, (struct ioctl_args *)args);
2618 }
2619
2620 static int
2621 linux_ioctl_sg(struct thread *td, struct linux_ioctl_args *args)
2622 {
2623         cap_rights_t rights;
2624         struct file *fp;
2625         u_long cmd;
2626         int error;
2627
2628         error = fget(td, args->fd, cap_rights_init(&rights, CAP_IOCTL), &fp);
2629         if (error != 0) {
2630                 printf("sg_linux_ioctl: fget returned %d\n", error);
2631                 return (error);
2632         }
2633         cmd = args->cmd;
2634
2635         error = (fo_ioctl(fp, cmd, (caddr_t)args->arg, td->td_ucred, td));
2636         fdrop(fp, td);
2637         return (error);
2638 }
2639
2640 /*
2641  * Video4Linux (V4L) ioctl handler
2642  */
2643 static int
2644 linux_to_bsd_v4l_tuner(struct l_video_tuner *lvt, struct video_tuner *vt)
2645 {
2646         vt->tuner = lvt->tuner;
2647         strlcpy(vt->name, lvt->name, LINUX_VIDEO_TUNER_NAME_SIZE);
2648         vt->rangelow = lvt->rangelow;   /* possible long size conversion */
2649         vt->rangehigh = lvt->rangehigh; /* possible long size conversion */
2650         vt->flags = lvt->flags;
2651         vt->mode = lvt->mode;
2652         vt->signal = lvt->signal;
2653         return (0);
2654 }
2655
2656 static int
2657 bsd_to_linux_v4l_tuner(struct video_tuner *vt, struct l_video_tuner *lvt)
2658 {
2659         lvt->tuner = vt->tuner;
2660         strlcpy(lvt->name, vt->name, LINUX_VIDEO_TUNER_NAME_SIZE);
2661         lvt->rangelow = vt->rangelow;   /* possible long size conversion */
2662         lvt->rangehigh = vt->rangehigh; /* possible long size conversion */
2663         lvt->flags = vt->flags;
2664         lvt->mode = vt->mode;
2665         lvt->signal = vt->signal;
2666         return (0);
2667 }
2668
2669 #ifdef COMPAT_LINUX_V4L_CLIPLIST
2670 static int
2671 linux_to_bsd_v4l_clip(struct l_video_clip *lvc, struct video_clip *vc)
2672 {
2673         vc->x = lvc->x;
2674         vc->y = lvc->y;
2675         vc->width = lvc->width;
2676         vc->height = lvc->height;
2677         vc->next = PTRIN(lvc->next);    /* possible pointer size conversion */
2678         return (0);
2679 }
2680 #endif
2681
2682 static int
2683 linux_to_bsd_v4l_window(struct l_video_window *lvw, struct video_window *vw)
2684 {
2685         vw->x = lvw->x;
2686         vw->y = lvw->y;
2687         vw->width = lvw->width;
2688         vw->height = lvw->height;
2689         vw->chromakey = lvw->chromakey;
2690         vw->flags = lvw->flags;
2691         vw->clips = PTRIN(lvw->clips);  /* possible pointer size conversion */
2692         vw->clipcount = lvw->clipcount;
2693         return (0);
2694 }
2695
2696 static int
2697 bsd_to_linux_v4l_window(struct video_window *vw, struct l_video_window *lvw)
2698 {
2699         lvw->x = vw->x;
2700         lvw->y = vw->y;
2701         lvw->width = vw->width;
2702         lvw->height = vw->height;
2703         lvw->chromakey = vw->chromakey;
2704         lvw->flags = vw->flags;
2705         lvw->clips = PTROUT(vw->clips); /* possible pointer size conversion */
2706         lvw->clipcount = vw->clipcount;
2707         return (0);
2708 }
2709
2710 static int
2711 linux_to_bsd_v4l_buffer(struct l_video_buffer *lvb, struct video_buffer *vb)
2712 {
2713         vb->base = PTRIN(lvb->base);    /* possible pointer size conversion */
2714         vb->height = lvb->height;
2715         vb->width = lvb->width;
2716         vb->depth = lvb->depth;
2717         vb->bytesperline = lvb->bytesperline;
2718         return (0);
2719 }
2720
2721 static int
2722 bsd_to_linux_v4l_buffer(struct video_buffer *vb, struct l_video_buffer *lvb)
2723 {
2724         lvb->base = PTROUT(vb->base);   /* possible pointer size conversion */
2725         lvb->height = vb->height;
2726         lvb->width = vb->width;
2727         lvb->depth = vb->depth;
2728         lvb->bytesperline = vb->bytesperline;
2729         return (0);
2730 }
2731
2732 static int
2733 linux_to_bsd_v4l_code(struct l_video_code *lvc, struct video_code *vc)
2734 {
2735         strlcpy(vc->loadwhat, lvc->loadwhat, LINUX_VIDEO_CODE_LOADWHAT_SIZE);
2736         vc->datasize = lvc->datasize;
2737         vc->data = PTRIN(lvc->data);    /* possible pointer size conversion */
2738         return (0);
2739 }
2740
2741 #ifdef COMPAT_LINUX_V4L_CLIPLIST
2742 static int
2743 linux_v4l_clip_copy(void *lvc, struct video_clip **ppvc)
2744 {
2745         int error;
2746         struct video_clip vclip;
2747         struct l_video_clip l_vclip;
2748
2749         error = copyin(lvc, &l_vclip, sizeof(l_vclip));
2750         if (error) return (error);
2751         linux_to_bsd_v4l_clip(&l_vclip, &vclip);
2752         /* XXX: If there can be no concurrency: s/M_NOWAIT/M_WAITOK/ */
2753         if ((*ppvc = malloc(sizeof(**ppvc), M_LINUX, M_NOWAIT)) == NULL)
2754                 return (ENOMEM);    /* XXX: linux has no ENOMEM here */
2755         memcpy(*ppvc, &vclip, sizeof(vclip));
2756         (*ppvc)->next = NULL;
2757         return (0);
2758 }
2759
2760 static int
2761 linux_v4l_cliplist_free(struct video_window *vw)
2762 {
2763         struct video_clip **ppvc;
2764         struct video_clip **ppvc_next;
2765
2766         for (ppvc = &(vw->clips); *ppvc != NULL; ppvc = ppvc_next) {
2767                 ppvc_next = &((*ppvc)->next);
2768                 free(*ppvc, M_LINUX);
2769         }
2770         vw->clips = NULL;
2771
2772         return (0);
2773 }
2774
2775 static int
2776 linux_v4l_cliplist_copy(struct l_video_window *lvw, struct video_window *vw)
2777 {
2778         int error;
2779         int clipcount;
2780         void *plvc;
2781         struct video_clip **ppvc;
2782
2783         /*
2784          * XXX: The cliplist is used to pass in a list of clipping
2785          *      rectangles or, if clipcount == VIDEO_CLIP_BITMAP, a
2786          *      clipping bitmap.  Some Linux apps, however, appear to
2787          *      leave cliplist and clips uninitialized.  In any case,
2788          *      the cliplist is not used by pwc(4), at the time of
2789          *      writing, FreeBSD's only V4L driver.  When a driver
2790          *      that uses the cliplist is developed, this code may
2791          *      need re-examiniation.
2792          */
2793         error = 0;
2794         clipcount = vw->clipcount;
2795         if (clipcount == VIDEO_CLIP_BITMAP) {
2796                 /*
2797                  * In this case, the pointer (clips) is overloaded
2798                  * to be a "void *" to a bitmap, therefore there
2799                  * is no struct video_clip to copy now.
2800                  */
2801         } else if (clipcount > 0 && clipcount <= 16384) {
2802                 /*
2803                  * Clips points to list of clip rectangles, so
2804                  * copy the list.
2805                  *
2806                  * XXX: Upper limit of 16384 was used here to try to
2807                  *      avoid cases when clipcount and clips pointer
2808                  *      are uninitialized and therefore have high random
2809                  *      values, as is the case in the Linux Skype
2810                  *      application.  The value 16384 was chosen as that
2811                  *      is what is used in the Linux stradis(4) MPEG
2812                  *      decoder driver, the only place we found an
2813                  *      example of cliplist use.
2814                  */
2815                 plvc = PTRIN(lvw->clips);
2816                 vw->clips = NULL;
2817                 ppvc = &(vw->clips);
2818                 while (clipcount-- > 0) {
2819                         if (plvc == 0) {
2820                                 error = EFAULT;
2821                                 break;
2822                         } else {
2823                                 error = linux_v4l_clip_copy(plvc, ppvc);
2824                                 if (error) {
2825                                         linux_v4l_cliplist_free(vw);
2826                                         break;
2827                                 }
2828                         }
2829                         ppvc = &((*ppvc)->next);
2830                         plvc = PTRIN(((struct l_video_clip *) plvc)->next);
2831                 }
2832         } else {
2833                 /*
2834                  * clipcount == 0 or negative (but not VIDEO_CLIP_BITMAP)
2835                  * Force cliplist to null.
2836                  */
2837                 vw->clipcount = 0;
2838                 vw->clips = NULL;
2839         }
2840         return (error);
2841 }
2842 #endif
2843
2844 static int
2845 linux_ioctl_v4l(struct thread *td, struct linux_ioctl_args *args)
2846 {
2847         cap_rights_t rights;
2848         struct file *fp;
2849         int error;
2850         struct video_tuner vtun;
2851         struct video_window vwin;
2852         struct video_buffer vbuf;
2853         struct video_code vcode;
2854         struct l_video_tuner l_vtun;
2855         struct l_video_window l_vwin;
2856         struct l_video_buffer l_vbuf;
2857         struct l_video_code l_vcode;
2858
2859         switch (args->cmd & 0xffff) {
2860         case LINUX_VIDIOCGCAP:          args->cmd = VIDIOCGCAP; break;
2861         case LINUX_VIDIOCGCHAN:         args->cmd = VIDIOCGCHAN; break;
2862         case LINUX_VIDIOCSCHAN:         args->cmd = VIDIOCSCHAN; break;
2863
2864         case LINUX_VIDIOCGTUNER:
2865                 error = fget(td, args->fd,
2866                     cap_rights_init(&rights, CAP_IOCTL), &fp);
2867                 if (error != 0)
2868                         return (error);
2869                 error = copyin((void *) args->arg, &l_vtun, sizeof(l_vtun));
2870                 if (error) {
2871                         fdrop(fp, td);
2872                         return (error);
2873                 }
2874                 linux_to_bsd_v4l_tuner(&l_vtun, &vtun);
2875                 error = fo_ioctl(fp, VIDIOCGTUNER, &vtun, td->td_ucred, td);
2876                 if (!error) {
2877                         bsd_to_linux_v4l_tuner(&vtun, &l_vtun);
2878                         error = copyout(&l_vtun, (void *) args->arg,
2879                             sizeof(l_vtun));
2880                 }
2881                 fdrop(fp, td);
2882                 return (error);
2883
2884         case LINUX_VIDIOCSTUNER:
2885                 error = fget(td, args->fd,
2886                     cap_rights_init(&rights, CAP_IOCTL), &fp);
2887                 if (error != 0)
2888                         return (error);
2889                 error = copyin((void *) args->arg, &l_vtun, sizeof(l_vtun));
2890                 if (error) {
2891                         fdrop(fp, td);
2892                         return (error);
2893                 }
2894                 linux_to_bsd_v4l_tuner(&l_vtun, &vtun);
2895                 error = fo_ioctl(fp, VIDIOCSTUNER, &vtun, td->td_ucred, td);
2896                 fdrop(fp, td);
2897                 return (error);
2898
2899         case LINUX_VIDIOCGPICT:         args->cmd = VIDIOCGPICT; break;
2900         case LINUX_VIDIOCSPICT:         args->cmd = VIDIOCSPICT; break;
2901         case LINUX_VIDIOCCAPTURE:       args->cmd = VIDIOCCAPTURE; break;
2902
2903         case LINUX_VIDIOCGWIN:
2904                 error = fget(td, args->fd,
2905                     cap_rights_init(&rights, CAP_IOCTL), &fp);
2906                 if (error != 0)
2907                         return (error);
2908                 error = fo_ioctl(fp, VIDIOCGWIN, &vwin, td->td_ucred, td);
2909                 if (!error) {
2910                         bsd_to_linux_v4l_window(&vwin, &l_vwin);
2911                         error = copyout(&l_vwin, (void *) args->arg,
2912                             sizeof(l_vwin));
2913                 }
2914                 fdrop(fp, td);
2915                 return (error);
2916
2917         case LINUX_VIDIOCSWIN:
2918                 error = fget(td, args->fd,
2919                     cap_rights_init(&rights, CAP_IOCTL), &fp);
2920                 if (error != 0)
2921                         return (error);
2922                 error = copyin((void *) args->arg, &l_vwin, sizeof(l_vwin));
2923                 if (error) {
2924                         fdrop(fp, td);
2925                         return (error);
2926                 }
2927                 linux_to_bsd_v4l_window(&l_vwin, &vwin);
2928 #ifdef COMPAT_LINUX_V4L_CLIPLIST
2929                 error = linux_v4l_cliplist_copy(&l_vwin, &vwin);
2930                 if (error) {
2931                         fdrop(fp, td);
2932                         return (error);
2933                 }
2934 #endif
2935                 error = fo_ioctl(fp, VIDIOCSWIN, &vwin, td->td_ucred, td);
2936                 fdrop(fp, td);
2937 #ifdef COMPAT_LINUX_V4L_CLIPLIST
2938                 linux_v4l_cliplist_free(&vwin);
2939 #endif
2940                 return (error);
2941
2942         case LINUX_VIDIOCGFBUF:
2943                 error = fget(td, args->fd,
2944                     cap_rights_init(&rights, CAP_IOCTL), &fp);
2945                 if (error != 0)
2946                         return (error);
2947                 error = fo_ioctl(fp, VIDIOCGFBUF, &vbuf, td->td_ucred, td);
2948                 if (!error) {
2949                         bsd_to_linux_v4l_buffer(&vbuf, &l_vbuf);
2950                         error = copyout(&l_vbuf, (void *) args->arg,
2951                             sizeof(l_vbuf));
2952                 }
2953                 fdrop(fp, td);
2954                 return (error);
2955
2956         case LINUX_VIDIOCSFBUF:
2957                 error = fget(td, args->fd,
2958                     cap_rights_init(&rights, CAP_IOCTL), &fp);
2959                 if (error != 0)
2960                         return (error);
2961                 error = copyin((void *) args->arg, &l_vbuf, sizeof(l_vbuf));
2962                 if (error) {
2963                         fdrop(fp, td);
2964                         return (error);
2965                 }
2966                 linux_to_bsd_v4l_buffer(&l_vbuf, &vbuf);
2967                 error = fo_ioctl(fp, VIDIOCSFBUF, &vbuf, td->td_ucred, td);
2968                 fdrop(fp, td);
2969                 return (error);
2970
2971         case LINUX_VIDIOCKEY:           args->cmd = VIDIOCKEY; break;
2972         case LINUX_VIDIOCGFREQ:         args->cmd = VIDIOCGFREQ; break;
2973         case LINUX_VIDIOCSFREQ:         args->cmd = VIDIOCSFREQ; break;
2974         case LINUX_VIDIOCGAUDIO:        args->cmd = VIDIOCGAUDIO; break;
2975         case LINUX_VIDIOCSAUDIO:        args->cmd = VIDIOCSAUDIO; break;
2976         case LINUX_VIDIOCSYNC:          args->cmd = VIDIOCSYNC; break;
2977         case LINUX_VIDIOCMCAPTURE:      args->cmd = VIDIOCMCAPTURE; break;
2978         case LINUX_VIDIOCGMBUF:         args->cmd = VIDIOCGMBUF; break;
2979         case LINUX_VIDIOCGUNIT:         args->cmd = VIDIOCGUNIT; break;
2980         case LINUX_VIDIOCGCAPTURE:      args->cmd = VIDIOCGCAPTURE; break;
2981         case LINUX_VIDIOCSCAPTURE:      args->cmd = VIDIOCSCAPTURE; break;
2982         case LINUX_VIDIOCSPLAYMODE:     args->cmd = VIDIOCSPLAYMODE; break;
2983         case LINUX_VIDIOCSWRITEMODE:    args->cmd = VIDIOCSWRITEMODE; break;
2984         case LINUX_VIDIOCGPLAYINFO:     args->cmd = VIDIOCGPLAYINFO; break;
2985
2986         case LINUX_VIDIOCSMICROCODE:
2987                 error = fget(td, args->fd,
2988                     cap_rights_init(&rights, CAP_IOCTL), &fp);
2989                 if (error != 0)
2990                         return (error);
2991                 error = copyin((void *) args->arg, &l_vcode, sizeof(l_vcode));
2992                 if (error) {
2993                         fdrop(fp, td);
2994                         return (error);
2995                 }
2996                 linux_to_bsd_v4l_code(&l_vcode, &vcode);
2997                 error = fo_ioctl(fp, VIDIOCSMICROCODE, &vcode, td->td_ucred, td);
2998                 fdrop(fp, td);
2999                 return (error);
3000
3001         case LINUX_VIDIOCGVBIFMT:       args->cmd = VIDIOCGVBIFMT; break;
3002         case LINUX_VIDIOCSVBIFMT:       args->cmd = VIDIOCSVBIFMT; break;
3003         default:                        return (ENOIOCTL);
3004         }
3005
3006         error = sys_ioctl(td, (struct ioctl_args *)args);
3007         return (error);
3008 }
3009
3010 /*
3011  * Special ioctl handler
3012  */
3013 static int
3014 linux_ioctl_special(struct thread *td, struct linux_ioctl_args *args)
3015 {
3016         int error;
3017
3018         switch (args->cmd) {
3019         case LINUX_SIOCGIFADDR:
3020                 args->cmd = SIOCGIFADDR;
3021                 error = sys_ioctl(td, (struct ioctl_args *)args);
3022                 break;
3023         case LINUX_SIOCSIFADDR:
3024                 args->cmd = SIOCSIFADDR;
3025                 error = sys_ioctl(td, (struct ioctl_args *)args);
3026                 break;
3027         case LINUX_SIOCGIFFLAGS:
3028                 args->cmd = SIOCGIFFLAGS;
3029                 error = sys_ioctl(td, (struct ioctl_args *)args);
3030                 break;
3031         default:
3032                 error = ENOIOCTL;
3033         }
3034
3035         return (error);
3036 }
3037
3038 static int
3039 linux_to_bsd_v4l2_standard(struct l_v4l2_standard *lvstd, struct v4l2_standard *vstd)
3040 {
3041         vstd->index = lvstd->index;
3042         vstd->id = lvstd->id;
3043         memcpy(&vstd->name, &lvstd->name, sizeof(*lvstd) - offsetof(struct l_v4l2_standard, name));
3044         return (0);
3045 }
3046
3047 static int
3048 bsd_to_linux_v4l2_standard(struct v4l2_standard *vstd, struct l_v4l2_standard *lvstd)
3049 {
3050         lvstd->index = vstd->index;
3051         lvstd->id = vstd->id;
3052         memcpy(&lvstd->name, &vstd->name, sizeof(*lvstd) - offsetof(struct l_v4l2_standard, name));
3053         return (0);
3054 }
3055
3056 static int
3057 linux_to_bsd_v4l2_buffer(struct l_v4l2_buffer *lvb, struct v4l2_buffer *vb)
3058 {
3059         vb->index = lvb->index;
3060         vb->type = lvb->type;
3061         vb->bytesused = lvb->bytesused;
3062         vb->flags = lvb->flags;
3063         vb->field = lvb->field;
3064         vb->timestamp.tv_sec = lvb->timestamp.tv_sec;
3065         vb->timestamp.tv_usec = lvb->timestamp.tv_usec;
3066         memcpy(&vb->timecode, &lvb->timecode, sizeof (lvb->timecode));
3067         vb->sequence = lvb->sequence;
3068         vb->memory = lvb->memory;
3069         if (lvb->memory == V4L2_MEMORY_USERPTR)
3070                 /* possible pointer size conversion */
3071                 vb->m.userptr = (unsigned long)PTRIN(lvb->m.userptr);
3072         else
3073                 vb->m.offset = lvb->m.offset;
3074         vb->length = lvb->length;
3075         vb->input = lvb->input;
3076         vb->reserved = lvb->reserved;
3077         return (0);
3078 }
3079
3080 static int
3081 bsd_to_linux_v4l2_buffer(struct v4l2_buffer *vb, struct l_v4l2_buffer *lvb)
3082 {
3083         lvb->index = vb->index;
3084         lvb->type = vb->type;
3085         lvb->bytesused = vb->bytesused;
3086         lvb->flags = vb->flags;
3087         lvb->field = vb->field;
3088         lvb->timestamp.tv_sec = vb->timestamp.tv_sec;
3089         lvb->timestamp.tv_usec = vb->timestamp.tv_usec;
3090         memcpy(&lvb->timecode, &vb->timecode, sizeof (vb->timecode));
3091         lvb->sequence = vb->sequence;
3092         lvb->memory = vb->memory;
3093         if (vb->memory == V4L2_MEMORY_USERPTR)
3094                 /* possible pointer size conversion */
3095                 lvb->m.userptr = PTROUT(vb->m.userptr);
3096         else
3097                 lvb->m.offset = vb->m.offset;
3098         lvb->length = vb->length;
3099         lvb->input = vb->input;
3100         lvb->reserved = vb->reserved;
3101         return (0);
3102 }
3103
3104 static int
3105 linux_to_bsd_v4l2_format(struct l_v4l2_format *lvf, struct v4l2_format *vf)
3106 {
3107         vf->type = lvf->type;
3108         if (lvf->type == V4L2_BUF_TYPE_VIDEO_OVERLAY
3109 #ifdef V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY
3110             || lvf->type == V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY
3111 #endif
3112             )
3113                 /*
3114                  * XXX TODO - needs 32 -> 64 bit conversion:
3115                  * (unused by webcams?)
3116                  */
3117                 return EINVAL;
3118         memcpy(&vf->fmt, &lvf->fmt, sizeof(vf->fmt));
3119         return 0;
3120 }
3121
3122 static int
3123 bsd_to_linux_v4l2_format(struct v4l2_format *vf, struct l_v4l2_format *lvf)
3124 {
3125         lvf->type = vf->type;
3126         if (vf->type == V4L2_BUF_TYPE_VIDEO_OVERLAY
3127 #ifdef V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY
3128             || vf->type == V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY
3129 #endif
3130             )
3131                 /*
3132                  * XXX TODO - needs 32 -> 64 bit conversion:
3133                  * (unused by webcams?)
3134                  */
3135                 return EINVAL;
3136         memcpy(&lvf->fmt, &vf->fmt, sizeof(vf->fmt));
3137         return 0;
3138 }
3139 static int
3140 linux_ioctl_v4l2(struct thread *td, struct linux_ioctl_args *args)
3141 {
3142         cap_rights_t rights;
3143         struct file *fp;
3144         int error;
3145         struct v4l2_format vformat;
3146         struct l_v4l2_format l_vformat;
3147         struct v4l2_standard vstd;
3148         struct l_v4l2_standard l_vstd;
3149         struct l_v4l2_buffer l_vbuf;
3150         struct v4l2_buffer vbuf;
3151         struct v4l2_input vinp;
3152
3153         switch (args->cmd & 0xffff) {
3154         case LINUX_VIDIOC_RESERVED:
3155         case LINUX_VIDIOC_LOG_STATUS:
3156                 if ((args->cmd & IOC_DIRMASK) != LINUX_IOC_VOID)
3157                         return ENOIOCTL;
3158                 args->cmd = (args->cmd & 0xffff) | IOC_VOID;
3159                 break;
3160
3161         case LINUX_VIDIOC_OVERLAY:
3162         case LINUX_VIDIOC_STREAMON:
3163         case LINUX_VIDIOC_STREAMOFF:
3164         case LINUX_VIDIOC_S_STD:
3165         case LINUX_VIDIOC_S_TUNER:
3166         case LINUX_VIDIOC_S_AUDIO:
3167         case LINUX_VIDIOC_S_AUDOUT:
3168         case LINUX_VIDIOC_S_MODULATOR:
3169         case LINUX_VIDIOC_S_FREQUENCY:
3170         case LINUX_VIDIOC_S_CROP:
3171         case LINUX_VIDIOC_S_JPEGCOMP:
3172         case LINUX_VIDIOC_S_PRIORITY:
3173         case LINUX_VIDIOC_DBG_S_REGISTER:
3174         case LINUX_VIDIOC_S_HW_FREQ_SEEK:
3175         case LINUX_VIDIOC_SUBSCRIBE_EVENT:
3176         case LINUX_VIDIOC_UNSUBSCRIBE_EVENT:
3177                 args->cmd = (args->cmd & ~IOC_DIRMASK) | IOC_IN;
3178                 break;
3179
3180         case LINUX_VIDIOC_QUERYCAP:
3181         case LINUX_VIDIOC_G_STD:
3182         case LINUX_VIDIOC_G_AUDIO:
3183         case LINUX_VIDIOC_G_INPUT:
3184         case LINUX_VIDIOC_G_OUTPUT:
3185         case LINUX_VIDIOC_G_AUDOUT:
3186         case LINUX_VIDIOC_G_JPEGCOMP:
3187         case LINUX_VIDIOC_QUERYSTD:
3188         case LINUX_VIDIOC_G_PRIORITY:
3189         case LINUX_VIDIOC_QUERY_DV_PRESET:
3190                 args->cmd = (args->cmd & ~IOC_DIRMASK) | IOC_OUT;
3191                 break;
3192
3193         case LINUX_VIDIOC_ENUM_FMT:
3194         case LINUX_VIDIOC_REQBUFS:
3195         case LINUX_VIDIOC_G_PARM:
3196         case LINUX_VIDIOC_S_PARM:
3197         case LINUX_VIDIOC_G_CTRL:
3198         case LINUX_VIDIOC_S_CTRL:
3199         case LINUX_VIDIOC_G_TUNER:
3200         case LINUX_VIDIOC_QUERYCTRL:
3201         case LINUX_VIDIOC_QUERYMENU:
3202         case LINUX_VIDIOC_S_INPUT:
3203         case LINUX_VIDIOC_S_OUTPUT:
3204         case LINUX_VIDIOC_ENUMOUTPUT:
3205         case LINUX_VIDIOC_G_MODULATOR:
3206         case LINUX_VIDIOC_G_FREQUENCY:
3207         case LINUX_VIDIOC_CROPCAP:
3208         case LINUX_VIDIOC_G_CROP:
3209         case LINUX_VIDIOC_ENUMAUDIO:
3210         case LINUX_VIDIOC_ENUMAUDOUT:
3211         case LINUX_VIDIOC_G_SLICED_VBI_CAP:
3212 #ifdef VIDIOC_ENUM_FRAMESIZES
3213         case LINUX_VIDIOC_ENUM_FRAMESIZES:
3214         case LINUX_VIDIOC_ENUM_FRAMEINTERVALS:
3215         case LINUX_VIDIOC_ENCODER_CMD:
3216         case LINUX_VIDIOC_TRY_ENCODER_CMD:
3217 #endif
3218         case LINUX_VIDIOC_DBG_G_REGISTER:
3219         case LINUX_VIDIOC_DBG_G_CHIP_IDENT:
3220         case LINUX_VIDIOC_ENUM_DV_PRESETS:
3221         case LINUX_VIDIOC_S_DV_PRESET:
3222         case LINUX_VIDIOC_G_DV_PRESET:
3223         case LINUX_VIDIOC_S_DV_TIMINGS:
3224         case LINUX_VIDIOC_G_DV_TIMINGS:
3225                 args->cmd = (args->cmd & ~IOC_DIRMASK) | IOC_INOUT;
3226                 break;
3227
3228         case LINUX_VIDIOC_G_FMT:
3229         case LINUX_VIDIOC_S_FMT:
3230         case LINUX_VIDIOC_TRY_FMT:
3231                 error = copyin((void *)args->arg, &l_vformat, sizeof(l_vformat));
3232                 if (error)
3233                         return (error);
3234                 error = fget(td, args->fd,
3235                     cap_rights_init(&rights, CAP_IOCTL), &fp);
3236                 if (error)
3237                         return (error);
3238                 if (linux_to_bsd_v4l2_format(&l_vformat, &vformat) != 0)
3239                         error = EINVAL;
3240                 else if ((args->cmd & 0xffff) == LINUX_VIDIOC_G_FMT)
3241                         error = fo_ioctl(fp, VIDIOC_G_FMT, &vformat,
3242                             td->td_ucred, td);
3243                 else if ((args->cmd & 0xffff) == LINUX_VIDIOC_S_FMT)
3244                         error = fo_ioctl(fp, VIDIOC_S_FMT, &vformat,
3245                             td->td_ucred, td);
3246                 else
3247                         error = fo_ioctl(fp, VIDIOC_TRY_FMT, &vformat,
3248                             td->td_ucred, td);
3249                 bsd_to_linux_v4l2_format(&vformat, &l_vformat);
3250                 copyout(&l_vformat, (void *)args->arg, sizeof(l_vformat));
3251                 fdrop(fp, td);
3252                 return (error);
3253
3254         case LINUX_VIDIOC_ENUMSTD:
3255                 error = copyin((void *)args->arg, &l_vstd, sizeof(l_vstd));
3256                 if (error)
3257                         return (error);
3258                 linux_to_bsd_v4l2_standard(&l_vstd, &vstd);
3259                 error = fget(td, args->fd,
3260                     cap_rights_init(&rights, CAP_IOCTL), &fp);
3261                 if (error)
3262                         return (error);
3263                 error = fo_ioctl(fp, VIDIOC_ENUMSTD, (caddr_t)&vstd,
3264                     td->td_ucred, td);
3265                 if (error) {
3266                         fdrop(fp, td);
3267                         return (error);
3268                 }
3269                 bsd_to_linux_v4l2_standard(&vstd, &l_vstd);
3270                 error = copyout(&l_vstd, (void *)args->arg, sizeof(l_vstd));
3271                 fdrop(fp, td);
3272                 return (error);
3273
3274         case LINUX_VIDIOC_ENUMINPUT:
3275                 /*
3276                  * The Linux struct l_v4l2_input differs only in size,
3277                  * it has no padding at the end.
3278                  */
3279                 error = copyin((void *)args->arg, &vinp,
3280                                 sizeof(struct l_v4l2_input));
3281                 if (error != 0)
3282                         return (error);
3283                 error = fget(td, args->fd,
3284                     cap_rights_init(&rights, CAP_IOCTL), &fp);
3285                 if (error != 0)
3286                         return (error);
3287                 error = fo_ioctl(fp, VIDIOC_ENUMINPUT, (caddr_t)&vinp,
3288                     td->td_ucred, td);
3289                 if (error) {
3290                         fdrop(fp, td);
3291                         return (error);
3292                 }
3293                 error = copyout(&vinp, (void *)args->arg,
3294                                 sizeof(struct l_v4l2_input));
3295                 fdrop(fp, td);
3296                 return (error);
3297
3298         case LINUX_VIDIOC_QUERYBUF:
3299         case LINUX_VIDIOC_QBUF:
3300         case LINUX_VIDIOC_DQBUF:
3301                 error = copyin((void *)args->arg, &l_vbuf, sizeof(l_vbuf));
3302                 if (error)
3303                         return (error);
3304                 error = fget(td, args->fd,
3305                     cap_rights_init(&rights, CAP_IOCTL), &fp);
3306                 if (error)
3307                         return (error);
3308                 linux_to_bsd_v4l2_buffer(&l_vbuf, &vbuf);
3309                 if ((args->cmd & 0xffff) == LINUX_VIDIOC_QUERYBUF)
3310                         error = fo_ioctl(fp, VIDIOC_QUERYBUF, &vbuf,
3311                             td->td_ucred, td);
3312                 else if ((args->cmd & 0xffff) == LINUX_VIDIOC_QBUF)
3313                         error = fo_ioctl(fp, VIDIOC_QBUF, &vbuf,
3314                             td->td_ucred, td);
3315                 else
3316                         error = fo_ioctl(fp, VIDIOC_DQBUF, &vbuf,
3317                             td->td_ucred, td);
3318                 bsd_to_linux_v4l2_buffer(&vbuf, &l_vbuf);
3319                 copyout(&l_vbuf, (void *)args->arg, sizeof(l_vbuf));
3320                 fdrop(fp, td);
3321                 return (error);
3322
3323         /*
3324          * XXX TODO - these need 32 -> 64 bit conversion:
3325          * (are any of them needed for webcams?)
3326          */
3327         case LINUX_VIDIOC_G_FBUF:
3328         case LINUX_VIDIOC_S_FBUF:
3329
3330         case LINUX_VIDIOC_G_EXT_CTRLS:
3331         case LINUX_VIDIOC_S_EXT_CTRLS:
3332         case LINUX_VIDIOC_TRY_EXT_CTRLS:
3333
3334         case LINUX_VIDIOC_DQEVENT:
3335
3336         default:                        return (ENOIOCTL);
3337         }
3338
3339         error = sys_ioctl(td, (struct ioctl_args *)args);
3340         return (error);
3341 }
3342
3343 /*
3344  * Support for emulators/linux-libusb. This port uses FBSD_LUSB* macros
3345  * instead of USB* ones. This lets us to provide correct values for cmd.
3346  * 0xffffffe0 -- 0xffffffff range seemed to be the least collision-prone.
3347  */
3348 static int
3349 linux_ioctl_fbsd_usb(struct thread *td, struct linux_ioctl_args *args)
3350 {
3351         int error;
3352
3353         error = 0;
3354         switch (args->cmd) {
3355         case FBSD_LUSB_DEVICEENUMERATE:
3356                 args->cmd = USB_DEVICEENUMERATE;
3357                 break;
3358         case FBSD_LUSB_DEV_QUIRK_ADD:
3359                 args->cmd = USB_DEV_QUIRK_ADD;
3360                 break;
3361         case FBSD_LUSB_DEV_QUIRK_GET:
3362                 args->cmd = USB_DEV_QUIRK_GET;
3363                 break;
3364         case FBSD_LUSB_DEV_QUIRK_REMOVE:
3365                 args->cmd = USB_DEV_QUIRK_REMOVE;
3366                 break;
3367         case FBSD_LUSB_DO_REQUEST:
3368                 args->cmd = USB_DO_REQUEST;
3369                 break;
3370         case FBSD_LUSB_FS_CLEAR_STALL_SYNC:
3371                 args->cmd = USB_FS_CLEAR_STALL_SYNC;
3372                 break;
3373         case FBSD_LUSB_FS_CLOSE:
3374                 args->cmd = USB_FS_CLOSE;
3375                 break;
3376         case FBSD_LUSB_FS_COMPLETE:
3377                 args->cmd = USB_FS_COMPLETE;
3378                 break;
3379         case FBSD_LUSB_FS_INIT:
3380                 args->cmd = USB_FS_INIT;
3381                 break;
3382         case FBSD_LUSB_FS_OPEN:
3383                 args->cmd = USB_FS_OPEN;
3384                 break;
3385         case FBSD_LUSB_FS_START:
3386                 args->cmd = USB_FS_START;
3387                 break;
3388         case FBSD_LUSB_FS_STOP:
3389                 args->cmd = USB_FS_STOP;
3390                 break;
3391         case FBSD_LUSB_FS_UNINIT:
3392                 args->cmd = USB_FS_UNINIT;
3393                 break;
3394         case FBSD_LUSB_GET_CONFIG:
3395                 args->cmd = USB_GET_CONFIG;
3396                 break;
3397         case FBSD_LUSB_GET_DEVICEINFO:
3398                 args->cmd = USB_GET_DEVICEINFO;
3399                 break;
3400         case FBSD_LUSB_GET_DEVICE_DESC:
3401                 args->cmd = USB_GET_DEVICE_DESC;
3402                 break;
3403         case FBSD_LUSB_GET_FULL_DESC:
3404                 args->cmd = USB_GET_FULL_DESC;
3405                 break;
3406         case FBSD_LUSB_GET_IFACE_DRIVER:
3407                 args->cmd = USB_GET_IFACE_DRIVER;
3408                 break;
3409         case FBSD_LUSB_GET_PLUGTIME:
3410                 args->cmd = USB_GET_PLUGTIME;
3411                 break;
3412         case FBSD_LUSB_GET_POWER_MODE:
3413                 args->cmd = USB_GET_POWER_MODE;
3414                 break;
3415         case FBSD_LUSB_GET_REPORT_DESC:
3416                 args->cmd = USB_GET_REPORT_DESC;
3417                 break;
3418         case FBSD_LUSB_GET_REPORT_ID:
3419                 args->cmd = USB_GET_REPORT_ID;
3420                 break;
3421         case FBSD_LUSB_GET_TEMPLATE:
3422                 args->cmd = USB_GET_TEMPLATE;
3423                 break;
3424         case FBSD_LUSB_IFACE_DRIVER_ACTIVE:
3425                 args->cmd = USB_IFACE_DRIVER_ACTIVE;
3426                 break;
3427         case FBSD_LUSB_IFACE_DRIVER_DETACH:
3428                 args->cmd = USB_IFACE_DRIVER_DETACH;
3429                 break;
3430         case FBSD_LUSB_QUIRK_NAME_GET:
3431                 args->cmd = USB_QUIRK_NAME_GET;
3432                 break;
3433         case FBSD_LUSB_READ_DIR:
3434                 args->cmd = USB_READ_DIR;
3435                 break;
3436         case FBSD_LUSB_SET_ALTINTERFACE:
3437                 args->cmd = USB_SET_ALTINTERFACE;
3438                 break;
3439         case FBSD_LUSB_SET_CONFIG:
3440                 args->cmd = USB_SET_CONFIG;
3441                 break;
3442         case FBSD_LUSB_SET_IMMED:
3443                 args->cmd = USB_SET_IMMED;
3444                 break;
3445         case FBSD_LUSB_SET_POWER_MODE:
3446                 args->cmd = USB_SET_POWER_MODE;
3447                 break;
3448         case FBSD_LUSB_SET_TEMPLATE:
3449                 args->cmd = USB_SET_TEMPLATE;
3450                 break;
3451         case FBSD_LUSB_FS_OPEN_STREAM:
3452                 args->cmd = USB_FS_OPEN_STREAM;
3453                 break;
3454         case FBSD_LUSB_GET_DEV_PORT_PATH:
3455                 args->cmd = USB_GET_DEV_PORT_PATH;
3456                 break;
3457         case FBSD_LUSB_GET_POWER_USAGE:
3458                 args->cmd = USB_GET_POWER_USAGE;
3459                 break;
3460         default:
3461                 error = ENOIOCTL;
3462         }
3463         if (error != ENOIOCTL)
3464                 error = sys_ioctl(td, (struct ioctl_args *)args);
3465         return (error);
3466 }
3467
3468 /*
3469  * main ioctl syscall function
3470  */
3471
3472 int
3473 linux_ioctl(struct thread *td, struct linux_ioctl_args *args)
3474 {
3475         cap_rights_t rights;
3476         struct file *fp;
3477         struct handler_element *he;
3478         int error, cmd;
3479
3480 #ifdef DEBUG
3481         if (ldebug(ioctl))
3482                 printf(ARGS(ioctl, "%d, %04lx, *"), args->fd,
3483                     (unsigned long)args->cmd);
3484 #endif
3485
3486         error = fget(td, args->fd, cap_rights_init(&rights, CAP_IOCTL), &fp);
3487         if (error != 0)
3488                 return (error);
3489         if ((fp->f_flag & (FREAD|FWRITE)) == 0) {
3490                 fdrop(fp, td);
3491                 return (EBADF);
3492         }
3493
3494         /* Iterate over the ioctl handlers */
3495         cmd = args->cmd & 0xffff;
3496         sx_slock(&linux_ioctl_sx);
3497         mtx_lock(&Giant);
3498         TAILQ_FOREACH(he, &handlers, list) {
3499                 if (cmd >= he->low && cmd <= he->high) {
3500                         error = (*he->func)(td, args);
3501                         if (error != ENOIOCTL) {
3502                                 mtx_unlock(&Giant);
3503                                 sx_sunlock(&linux_ioctl_sx);
3504                                 fdrop(fp, td);
3505                                 return (error);
3506                         }
3507                 }
3508         }
3509         mtx_unlock(&Giant);
3510         sx_sunlock(&linux_ioctl_sx);
3511         fdrop(fp, td);
3512
3513         linux_msg(td, "ioctl fd=%d, cmd=0x%x ('%c',%d) is not implemented",
3514             args->fd, (int)(args->cmd & 0xffff),
3515             (int)(args->cmd & 0xff00) >> 8, (int)(args->cmd & 0xff));
3516
3517         return (EINVAL);
3518 }
3519
3520 int
3521 linux_ioctl_register_handler(struct linux_ioctl_handler *h)
3522 {
3523         struct handler_element *he, *cur;
3524
3525         if (h == NULL || h->func == NULL)
3526                 return (EINVAL);
3527
3528         /*
3529          * Reuse the element if the handler is already on the list, otherwise
3530          * create a new element.
3531          */
3532         sx_xlock(&linux_ioctl_sx);
3533         TAILQ_FOREACH(he, &handlers, list) {
3534                 if (he->func == h->func)
3535                         break;
3536         }
3537         if (he == NULL) {
3538                 he = malloc(sizeof(*he),
3539                     M_LINUX, M_WAITOK);
3540                 he->func = h->func;
3541         } else
3542                 TAILQ_REMOVE(&handlers, he, list);
3543
3544         /* Initialize range information. */
3545         he->low = h->low;
3546         he->high = h->high;
3547         he->span = h->high - h->low + 1;
3548
3549         /* Add the element to the list, sorted on span. */
3550         TAILQ_FOREACH(cur, &handlers, list) {
3551                 if (cur->span > he->span) {
3552                         TAILQ_INSERT_BEFORE(cur, he, list);
3553                         sx_xunlock(&linux_ioctl_sx);
3554                         return (0);
3555                 }
3556         }
3557         TAILQ_INSERT_TAIL(&handlers, he, list);
3558         sx_xunlock(&linux_ioctl_sx);
3559
3560         return (0);
3561 }
3562
3563 int
3564 linux_ioctl_unregister_handler(struct linux_ioctl_handler *h)
3565 {
3566         struct handler_element *he;
3567
3568         if (h == NULL || h->func == NULL)
3569                 return (EINVAL);
3570
3571         sx_xlock(&linux_ioctl_sx);
3572         TAILQ_FOREACH(he, &handlers, list) {
3573                 if (he->func == h->func) {
3574                         TAILQ_REMOVE(&handlers, he, list);
3575                         sx_xunlock(&linux_ioctl_sx);
3576                         free(he, M_LINUX);
3577                         return (0);
3578                 }
3579         }
3580         sx_xunlock(&linux_ioctl_sx);
3581
3582         return (EINVAL);
3583 }