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