The Design and Implementation of the FreeBSD Operating System, Second Edition
Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

FreeBSD/Linux Kernel Cross Reference
sys/dev/fdc/fdc.c

Version: -  FREEBSD  -  FREEBSD-13-STABLE  -  FREEBSD-13-0  -  FREEBSD-12-STABLE  -  FREEBSD-12-0  -  FREEBSD-11-STABLE  -  FREEBSD-11-0  -  FREEBSD-10-STABLE  -  FREEBSD-10-0  -  FREEBSD-9-STABLE  -  FREEBSD-9-0  -  FREEBSD-8-STABLE  -  FREEBSD-8-0  -  FREEBSD-7-STABLE  -  FREEBSD-7-0  -  FREEBSD-6-STABLE  -  FREEBSD-6-0  -  FREEBSD-5-STABLE  -  FREEBSD-5-0  -  FREEBSD-4-STABLE  -  FREEBSD-3-STABLE  -  FREEBSD22  -  l41  -  OPENBSD  -  linux-2.6  -  MK84  -  PLAN9  -  xnu-8792 
SearchContext: -  none  -  3  -  10 

    1 /*-
    2  * Copyright (c) 2004 Poul-Henning Kamp
    3  * Copyright (c) 1990 The Regents of the University of California.
    4  * All rights reserved.
    5  *
    6  * This code is derived from software contributed to Berkeley by
    7  * Don Ahn.
    8  *
    9  * Libretto PCMCIA floppy support by David Horwitt (dhorwitt@ucsd.edu)
   10  * aided by the Linux floppy driver modifications from David Bateman
   11  * (dbateman@eng.uts.edu.au).
   12  *
   13  * Copyright (c) 1993, 1994 by
   14  *  jc@irbs.UUCP (John Capo)
   15  *  vak@zebub.msk.su (Serge Vakulenko)
   16  *  ache@astral.msk.su (Andrew A. Chernov)
   17  *
   18  * Copyright (c) 1993, 1994, 1995 by
   19  *  joerg_wunsch@uriah.sax.de (Joerg Wunsch)
   20  *  dufault@hda.com (Peter Dufault)
   21  *
   22  * Copyright (c) 2001 Joerg Wunsch,
   23  *  joerg_wunsch@uriah.heep.sax.de (Joerg Wunsch)
   24  *
   25  * Redistribution and use in source and binary forms, with or without
   26  * modification, are permitted provided that the following conditions
   27  * are met:
   28  * 1. Redistributions of source code must retain the above copyright
   29  *    notice, this list of conditions and the following disclaimer.
   30  * 2. Redistributions in binary form must reproduce the above copyright
   31  *    notice, this list of conditions and the following disclaimer in the
   32  *    documentation and/or other materials provided with the distribution.
   33  * 4. Neither the name of the University nor the names of its contributors
   34  *    may be used to endorse or promote products derived from this software
   35  *    without specific prior written permission.
   36  *
   37  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
   38  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
   39  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
   40  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
   41  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
   42  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
   43  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
   44  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
   45  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
   46  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
   47  * SUCH DAMAGE.
   48  *
   49  *      from:   @(#)fd.c        7.4 (Berkeley) 5/25/91
   50  *
   51  */
   52 
   53 #include <sys/cdefs.h>
   54 __FBSDID("$FreeBSD: releng/10.2/sys/dev/fdc/fdc.c 254937 2013-08-26 21:15:50Z joerg $");
   55 
   56 #include "opt_fdc.h"
   57 
   58 #include <sys/param.h>
   59 #include <sys/bio.h>
   60 #include <sys/bus.h>
   61 #include <sys/devicestat.h>
   62 #include <sys/disk.h>
   63 #include <sys/fcntl.h>
   64 #include <sys/fdcio.h>
   65 #include <sys/filio.h>
   66 #include <sys/kernel.h>
   67 #include <sys/kthread.h>
   68 #include <sys/lock.h>
   69 #include <sys/malloc.h>
   70 #include <sys/module.h>
   71 #include <sys/mutex.h>
   72 #include <sys/priv.h>
   73 #include <sys/proc.h>
   74 #include <sys/rman.h>
   75 #include <sys/sysctl.h>
   76 #include <sys/systm.h>
   77 
   78 #include <geom/geom.h>
   79 
   80 #include <machine/bus.h>
   81 #include <machine/clock.h>
   82 #include <machine/stdarg.h>
   83 
   84 #include <isa/isavar.h>
   85 #include <isa/isareg.h>
   86 #include <dev/fdc/fdcvar.h>
   87 #include <isa/rtc.h>
   88 
   89 #include <dev/ic/nec765.h>
   90 
   91 /*
   92  * Runtime configuration hints/flags
   93  */
   94 
   95 /* configuration flags for fd */
   96 #define FD_TYPEMASK     0x0f    /* drive type, matches enum
   97                                  * fd_drivetype; on i386 machines, if
   98                                  * given as 0, use RTC type for fd0
   99                                  * and fd1 */
  100 #define FD_NO_CHLINE    0x10    /* drive does not support changeline
  101                                  * aka. unit attention */
  102 #define FD_NO_PROBE     0x20    /* don't probe drive (seek test), just
  103                                  * assume it is there */
  104 
  105 /*
  106  * Things that could conceiveably considered parameters or tweakables
  107  */
  108 
  109 /*
  110  * Maximal number of bytes in a cylinder.
  111  * This is used for ISADMA bouncebuffer allocation and sets the max
  112  * xfersize we support.
  113  *
  114  * 2.88M format has 2 x 36 x 512, allow for hacked up density.
  115  */
  116 #define MAX_BYTES_PER_CYL       (2 * 40 * 512)
  117 
  118 /*
  119  * Timeout value for the PIO loops to wait until the FDC main status
  120  * register matches our expectations (request for master, direction
  121  * bit).  This is supposed to be a number of microseconds, although
  122  * timing might actually not be very accurate.
  123  *
  124  * Timeouts of 100 msec are believed to be required for some broken
  125  * (old) hardware.
  126  */
  127 #define FDSTS_TIMEOUT   100000
  128 
  129 /*
  130  * After this many errors, stop whining.  Close will reset this count.
  131  */
  132 #define FDC_ERRMAX      100
  133 
  134 /*
  135  * AutoDensity search lists for each drive type.
  136  */
  137 
  138 static struct fd_type fd_searchlist_360k[] = {
  139         { FDF_5_360 },
  140         { 0 }
  141 };
  142 
  143 static struct fd_type fd_searchlist_12m[] = {
  144         { FDF_5_1200 | FL_AUTO },
  145         { FDF_5_360 | FL_2STEP | FL_AUTO},
  146         { 0 }
  147 };
  148 
  149 static struct fd_type fd_searchlist_720k[] = {
  150         { FDF_3_720 },
  151         { 0 }
  152 };
  153 
  154 static struct fd_type fd_searchlist_144m[] = {
  155         { FDF_3_1440 | FL_AUTO},
  156         { FDF_3_720 | FL_AUTO},
  157         { 0 }
  158 };
  159 
  160 static struct fd_type fd_searchlist_288m[] = {
  161         { FDF_3_1440 | FL_AUTO },
  162 #if 0
  163         { FDF_3_2880 | FL_AUTO }, /* XXX: probably doesn't work */
  164 #endif
  165         { FDF_3_720 | FL_AUTO},
  166         { 0 }
  167 };
  168 
  169 /*
  170  * Order must match enum fd_drivetype in <sys/fdcio.h>.
  171  */
  172 static struct fd_type *fd_native_types[] = {
  173         NULL,                           /* FDT_NONE */
  174         fd_searchlist_360k,             /* FDT_360K */
  175         fd_searchlist_12m,              /* FDT_12M */
  176         fd_searchlist_720k,             /* FDT_720K */
  177         fd_searchlist_144m,             /* FDT_144M */
  178         fd_searchlist_288m,             /* FDT_288M_1 (mapped to FDT_288M) */
  179         fd_searchlist_288m,             /* FDT_288M */
  180 };
  181 
  182 /*
  183  * Internals start here
  184  */
  185 
  186 /* registers */
  187 #define FDOUT   2       /* Digital Output Register (W) */
  188 #define FDO_FDSEL       0x03    /*  floppy device select */
  189 #define FDO_FRST        0x04    /*  floppy controller reset */
  190 #define FDO_FDMAEN      0x08    /*  enable floppy DMA and Interrupt */
  191 #define FDO_MOEN0       0x10    /*  motor enable drive 0 */
  192 #define FDO_MOEN1       0x20    /*  motor enable drive 1 */
  193 #define FDO_MOEN2       0x40    /*  motor enable drive 2 */
  194 #define FDO_MOEN3       0x80    /*  motor enable drive 3 */
  195 
  196 #define FDSTS   4       /* NEC 765 Main Status Register (R) */
  197 #define FDDSR   4       /* Data Rate Select Register (W) */
  198 #define FDDATA  5       /* NEC 765 Data Register (R/W) */
  199 #define FDCTL   7       /* Control Register (W) */
  200 
  201 /*
  202  * The YE-DATA PC Card floppies use PIO to read in the data rather
  203  * than DMA due to the wild variability of DMA for the PC Card
  204  * devices.  DMA was deleted from the PC Card specification in version
  205  * 7.2 of the standard, but that post-dates the YE-DATA devices by many
  206  * years.
  207  *
  208  * In addition, if we cannot setup the DMA resources for the ISA
  209  * attachment, we'll use this same offset for data transfer.  However,
  210  * that almost certainly won't work.
  211  *
  212  * For this mode, offset 0 and 1 must be used to setup the transfer
  213  * for this floppy.  This is OK for PC Card YE Data devices, but for
  214  * ISA this is likely wrong.  These registers are only available on
  215  * those systems that map them to the floppy drive.  Newer systems do
  216  * not do this, and we should likely prohibit access to them (or
  217  * disallow NODMA to be set).
  218  */
  219 #define FDBCDR          0       /* And 1 */
  220 #define FD_YE_DATAPORT  6       /* Drive Data port */
  221 
  222 #define FDI_DCHG        0x80    /* diskette has been changed */
  223                                 /* requires drive and motor being selected */
  224                                 /* is cleared by any step pulse to drive */
  225 
  226 /*
  227  * We have three private BIO commands.
  228  */
  229 #define BIO_PROBE       BIO_CMD0
  230 #define BIO_RDID        BIO_CMD1
  231 #define BIO_FMT         BIO_CMD2
  232 
  233 /*
  234  * Per drive structure (softc).
  235  */
  236 struct fd_data {
  237         u_char  *fd_ioptr;      /* IO pointer */
  238         u_int   fd_iosize;      /* Size of IO chunks */
  239         u_int   fd_iocount;     /* Outstanding requests */
  240         struct  fdc_data *fdc;  /* pointer to controller structure */
  241         int     fdsu;           /* this units number on this controller */
  242         enum    fd_drivetype type; /* drive type */
  243         struct  fd_type *ft;    /* pointer to current type descriptor */
  244         struct  fd_type fts;    /* type descriptors */
  245         int     sectorsize;
  246         int     flags;
  247 #define FD_WP           (1<<0)  /* Write protected      */
  248 #define FD_MOTOR        (1<<1)  /* motor should be on   */
  249 #define FD_MOTORWAIT    (1<<2)  /* motor should be on   */
  250 #define FD_EMPTY        (1<<3)  /* no media             */
  251 #define FD_NEWDISK      (1<<4)  /* media changed        */
  252 #define FD_ISADMA       (1<<5)  /* isa dma started      */
  253         int     track;          /* where we think the head is */
  254 #define FD_NO_TRACK      -2
  255         int     options;        /* FDOPT_* */
  256         struct  callout toffhandle;
  257         struct g_geom *fd_geom;
  258         struct g_provider *fd_provider;
  259         device_t dev;
  260         struct bio_queue_head fd_bq;
  261 };
  262 
  263 #define FD_NOT_VALID -2
  264 
  265 static driver_intr_t fdc_intr;
  266 static driver_filter_t fdc_intr_fast;
  267 static void fdc_reset(struct fdc_data *);
  268 static int fd_probe_disk(struct fd_data *, int *);
  269 
  270 static SYSCTL_NODE(_debug, OID_AUTO, fdc, CTLFLAG_RW, 0, "fdc driver");
  271 
  272 static int fifo_threshold = 8;
  273 SYSCTL_INT(_debug_fdc, OID_AUTO, fifo, CTLFLAG_RW, &fifo_threshold, 0,
  274         "FIFO threshold setting");
  275 
  276 static int debugflags = 0;
  277 SYSCTL_INT(_debug_fdc, OID_AUTO, debugflags, CTLFLAG_RW, &debugflags, 0,
  278         "Debug flags");
  279 
  280 static int retries = 10;
  281 SYSCTL_INT(_debug_fdc, OID_AUTO, retries, CTLFLAG_RW, &retries, 0,
  282         "Number of retries to attempt");
  283 
  284 static int spec1 = 0xaf;
  285 SYSCTL_INT(_debug_fdc, OID_AUTO, spec1, CTLFLAG_RW, &spec1, 0,
  286         "Specification byte one (step-rate + head unload)");
  287 
  288 static int spec2 = 0x10;
  289 SYSCTL_INT(_debug_fdc, OID_AUTO, spec2, CTLFLAG_RW, &spec2, 0,
  290         "Specification byte two (head load time + no-dma)");
  291 
  292 static int settle;
  293 SYSCTL_INT(_debug_fdc, OID_AUTO, settle, CTLFLAG_RW, &settle, 0,
  294         "Head settling time in sec/hz");
  295 
  296 static void
  297 fdprinttype(struct fd_type *ft)
  298 {
  299 
  300         printf("(%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,0x%x)",
  301             ft->sectrac, ft->secsize, ft->datalen, ft->gap, ft->tracks,
  302             ft->size, ft->trans, ft->heads, ft->f_gap, ft->f_inter,
  303             ft->offset_side2, ft->flags);
  304 }
  305 
  306 static void
  307 fdsettype(struct fd_data *fd, struct fd_type *ft)
  308 {
  309         fd->ft = ft;
  310         ft->size = ft->sectrac * ft->heads * ft->tracks;
  311         fd->sectorsize = 128 << fd->ft->secsize;
  312 }
  313 
  314 /*
  315  * Bus space handling (access to low-level IO).
  316  */
  317 static inline void
  318 fdregwr(struct fdc_data *fdc, int reg, uint8_t v)
  319 {
  320 
  321         bus_space_write_1(fdc->iot, fdc->ioh[reg], fdc->ioff[reg], v);
  322 }
  323 
  324 static inline uint8_t
  325 fdregrd(struct fdc_data *fdc, int reg)
  326 {
  327 
  328         return bus_space_read_1(fdc->iot, fdc->ioh[reg], fdc->ioff[reg]);
  329 }
  330 
  331 static void
  332 fdctl_wr(struct fdc_data *fdc, u_int8_t v)
  333 {
  334 
  335         fdregwr(fdc, FDCTL, v);
  336 }
  337 
  338 static void
  339 fdout_wr(struct fdc_data *fdc, u_int8_t v)
  340 {
  341 
  342         fdregwr(fdc, FDOUT, v);
  343 }
  344 
  345 static u_int8_t
  346 fdsts_rd(struct fdc_data *fdc)
  347 {
  348 
  349         return fdregrd(fdc, FDSTS);
  350 }
  351 
  352 static void
  353 fddsr_wr(struct fdc_data *fdc, u_int8_t v)
  354 {
  355 
  356         fdregwr(fdc, FDDSR, v);
  357 }
  358 
  359 static void
  360 fddata_wr(struct fdc_data *fdc, u_int8_t v)
  361 {
  362 
  363         fdregwr(fdc, FDDATA, v);
  364 }
  365 
  366 static u_int8_t
  367 fddata_rd(struct fdc_data *fdc)
  368 {
  369 
  370         return fdregrd(fdc, FDDATA);
  371 }
  372 
  373 static u_int8_t
  374 fdin_rd(struct fdc_data *fdc)
  375 {
  376 
  377         return fdregrd(fdc, FDCTL);
  378 }
  379 
  380 /*
  381  * Magic pseudo-DMA initialization for YE FDC. Sets count and
  382  * direction.
  383  */
  384 static void
  385 fdbcdr_wr(struct fdc_data *fdc, int iswrite, uint16_t count)
  386 {
  387         fdregwr(fdc, FDBCDR, (count - 1) & 0xff);
  388         fdregwr(fdc, FDBCDR + 1,
  389             (iswrite ? 0x80 : 0) | (((count - 1) >> 8) & 0x7f));
  390 }
  391 
  392 static int
  393 fdc_err(struct fdc_data *fdc, const char *s)
  394 {
  395         fdc->fdc_errs++;
  396         if (s) {
  397                 if (fdc->fdc_errs < FDC_ERRMAX)
  398                         device_printf(fdc->fdc_dev, "%s", s);
  399                 else if (fdc->fdc_errs == FDC_ERRMAX)
  400                         device_printf(fdc->fdc_dev, "too many errors, not "
  401                                                     "logging any more\n");
  402         }
  403 
  404         return (1);
  405 }
  406 
  407 /*
  408  * FDC IO functions, take care of the main status register, timeout
  409  * in case the desired status bits are never set.
  410  *
  411  * These PIO loops initially start out with short delays between
  412  * each iteration in the expectation that the required condition
  413  * is usually met quickly, so it can be handled immediately.
  414  */
  415 static int
  416 fdc_in(struct fdc_data *fdc, int *ptr)
  417 {
  418         int i, j, step;
  419 
  420         step = 1;
  421         for (j = 0; j < FDSTS_TIMEOUT; j += step) {
  422                 i = fdsts_rd(fdc) & (NE7_DIO | NE7_RQM);
  423                 if (i == (NE7_DIO|NE7_RQM)) {
  424                         i = fddata_rd(fdc);
  425                         if (ptr)
  426                                 *ptr = i;
  427                         return (0);
  428                 }
  429                 if (i == NE7_RQM)
  430                         return (fdc_err(fdc, "ready for output in input\n"));
  431                 step += step;
  432                 DELAY(step);
  433         }
  434         return (fdc_err(fdc, bootverbose? "input ready timeout\n": 0));
  435 }
  436 
  437 static int
  438 fdc_out(struct fdc_data *fdc, int x)
  439 {
  440         int i, j, step;
  441 
  442         step = 1;
  443         for (j = 0; j < FDSTS_TIMEOUT; j += step) {
  444                 i = fdsts_rd(fdc) & (NE7_DIO | NE7_RQM);
  445                 if (i == NE7_RQM) {
  446                         fddata_wr(fdc, x);
  447                         return (0);
  448                 }
  449                 if (i == (NE7_DIO|NE7_RQM))
  450                         return (fdc_err(fdc, "ready for input in output\n"));
  451                 step += step;
  452                 DELAY(step);
  453         }
  454         return (fdc_err(fdc, bootverbose? "output ready timeout\n": 0));
  455 }
  456 
  457 /*
  458  * fdc_cmd: Send a command to the chip.
  459  * Takes a varargs with this structure:
  460  *      # of output bytes
  461  *      output bytes as int [...]
  462  *      # of input bytes
  463  *      input bytes as int* [...]
  464  */
  465 static int
  466 fdc_cmd(struct fdc_data *fdc, int n_out, ...)
  467 {
  468         u_char cmd = 0;
  469         int n_in;
  470         int n, i;
  471         va_list ap;
  472 
  473         va_start(ap, n_out);
  474         for (n = 0; n < n_out; n++) {
  475                 i = va_arg(ap, int);
  476                 if (n == 0)
  477                         cmd = i;
  478                 if (fdc_out(fdc, i) < 0) {
  479                         char msg[50];
  480                         snprintf(msg, sizeof(msg),
  481                                 "cmd %x failed at out byte %d of %d\n",
  482                                 cmd, n + 1, n_out);
  483                         fdc->flags |= FDC_NEEDS_RESET;
  484                         va_end(ap);
  485                         return fdc_err(fdc, msg);
  486                 }
  487         }
  488         n_in = va_arg(ap, int);
  489         for (n = 0; n < n_in; n++) {
  490                 int *ptr = va_arg(ap, int *);
  491                 if (fdc_in(fdc, ptr) < 0) {
  492                         char msg[50];
  493                         snprintf(msg, sizeof(msg),
  494                                 "cmd %02x failed at in byte %d of %d\n",
  495                                 cmd, n + 1, n_in);
  496                         fdc->flags |= FDC_NEEDS_RESET;
  497                         va_end(ap);
  498                         return fdc_err(fdc, msg);
  499                 }
  500         }
  501         va_end(ap);
  502         return (0);
  503 }
  504 
  505 static void
  506 fdc_reset(struct fdc_data *fdc)
  507 {
  508         int i, r[10];
  509 
  510         if (fdc->fdct == FDC_ENHANCED) {
  511                 /* Try a software reset, default precomp, and 500 kb/s */
  512                 fddsr_wr(fdc, I8207X_DSR_SR);
  513         } else {
  514                 /* Try a hardware reset, keep motor on */
  515                 fdout_wr(fdc, fdc->fdout & ~(FDO_FRST|FDO_FDMAEN));
  516                 DELAY(100);
  517                 /* enable FDC, but defer interrupts a moment */
  518                 fdout_wr(fdc, fdc->fdout & ~FDO_FDMAEN);
  519         }
  520         DELAY(100);
  521         fdout_wr(fdc, fdc->fdout);
  522 
  523         /* XXX after a reset, silently believe the FDC will accept commands */
  524         if (fdc_cmd(fdc, 3, NE7CMD_SPECIFY, spec1, spec2, 0))
  525                 device_printf(fdc->fdc_dev, " SPECIFY failed in reset\n");
  526 
  527         if (fdc->fdct == FDC_ENHANCED) {
  528                 if (fdc_cmd(fdc, 4,
  529                     I8207X_CONFIG,
  530                     0,
  531                     /* 0x40 | */                /* Enable Implied Seek -
  532                                                  * breaks 2step! */
  533                     0x10 |                      /* Polling disabled */
  534                     (fifo_threshold - 1),       /* Fifo threshold */
  535                     0x00,                       /* Precomp track */
  536                     0))
  537                         device_printf(fdc->fdc_dev,
  538                             " CONFIGURE failed in reset\n");
  539                 if (debugflags & 1) {
  540                         if (fdc_cmd(fdc, 1,
  541                             I8207X_DUMPREG,
  542                             10, &r[0], &r[1], &r[2], &r[3], &r[4],
  543                             &r[5], &r[6], &r[7], &r[8], &r[9]))
  544                                 device_printf(fdc->fdc_dev,
  545                                     " DUMPREG failed in reset\n");
  546                         for (i = 0; i < 10; i++)
  547                                 printf(" %02x", r[i]);
  548                         printf("\n");
  549                 }
  550         }
  551 }
  552 
  553 static int
  554 fdc_sense_drive(struct fdc_data *fdc, int *st3p)
  555 {
  556         int st3;
  557 
  558         if (fdc_cmd(fdc, 2, NE7CMD_SENSED, fdc->fd->fdsu, 1, &st3))
  559                 return (fdc_err(fdc, "Sense Drive Status failed\n"));
  560         if (st3p)
  561                 *st3p = st3;
  562         return (0);
  563 }
  564 
  565 static int
  566 fdc_sense_int(struct fdc_data *fdc, int *st0p, int *cylp)
  567 {
  568         int cyl, st0, ret;
  569 
  570         ret = fdc_cmd(fdc, 1, NE7CMD_SENSEI, 1, &st0);
  571         if (ret) {
  572                 (void)fdc_err(fdc, "sense intr err reading stat reg 0\n");
  573                 return (ret);
  574         }
  575 
  576         if (st0p)
  577                 *st0p = st0;
  578 
  579         if ((st0 & NE7_ST0_IC) == NE7_ST0_IC_IV) {
  580                 /*
  581                  * There doesn't seem to have been an interrupt.
  582                  */
  583                 return (FD_NOT_VALID);
  584         }
  585 
  586         if (fdc_in(fdc, &cyl) < 0)
  587                 return fdc_err(fdc, "can't get cyl num\n");
  588 
  589         if (cylp)
  590                 *cylp = cyl;
  591 
  592         return (0);
  593 }
  594 
  595 static int
  596 fdc_read_status(struct fdc_data *fdc)
  597 {
  598         int i, ret, status;
  599 
  600         for (i = ret = 0; i < 7; i++) {
  601                 ret = fdc_in(fdc, &status);
  602                 fdc->status[i] = status;
  603                 if (ret != 0)
  604                         break;
  605         }
  606 
  607         if (ret == 0)
  608                 fdc->flags |= FDC_STAT_VALID;
  609         else
  610                 fdc->flags &= ~FDC_STAT_VALID;
  611 
  612         return ret;
  613 }
  614 
  615 /*
  616  * Select this drive
  617  */
  618 static void
  619 fd_select(struct fd_data *fd)
  620 {
  621         struct fdc_data *fdc;
  622 
  623         /* XXX: lock controller */
  624         fdc = fd->fdc;
  625         fdc->fdout &= ~FDO_FDSEL;
  626         fdc->fdout |= FDO_FDMAEN | FDO_FRST | fd->fdsu;
  627         fdout_wr(fdc, fdc->fdout);
  628 }
  629 
  630 static void
  631 fd_turnon(void *arg)
  632 {
  633         struct fd_data *fd;
  634         struct bio *bp;
  635         int once;
  636 
  637         fd = arg;
  638         mtx_assert(&fd->fdc->fdc_mtx, MA_OWNED);
  639         fd->flags &= ~FD_MOTORWAIT;
  640         fd->flags |= FD_MOTOR;
  641         once = 0;
  642         for (;;) {
  643                 bp = bioq_takefirst(&fd->fd_bq);
  644                 if (bp == NULL)
  645                         break;
  646                 bioq_disksort(&fd->fdc->head, bp);
  647                 once = 1;
  648         }
  649         if (once)
  650                 wakeup(&fd->fdc->head);
  651 }
  652 
  653 static void
  654 fd_motor(struct fd_data *fd, int turnon)
  655 {
  656         struct fdc_data *fdc;
  657 
  658         fdc = fd->fdc;
  659 /*
  660         mtx_assert(&fdc->fdc_mtx, MA_OWNED);
  661 */
  662         if (turnon) {
  663                 fd->flags |= FD_MOTORWAIT;
  664                 fdc->fdout |= (FDO_MOEN0 << fd->fdsu);
  665                 callout_reset(&fd->toffhandle, hz, fd_turnon, fd);
  666         } else {
  667                 callout_stop(&fd->toffhandle);
  668                 fd->flags &= ~(FD_MOTOR|FD_MOTORWAIT);
  669                 fdc->fdout &= ~(FDO_MOEN0 << fd->fdsu);
  670         }
  671         fdout_wr(fdc, fdc->fdout);
  672 }
  673 
  674 static void
  675 fd_turnoff(void *xfd)
  676 {
  677         struct fd_data *fd = xfd;
  678 
  679         mtx_assert(&fd->fdc->fdc_mtx, MA_OWNED);
  680         fd_motor(fd, 0);
  681 }
  682 
  683 /*
  684  * fdc_intr - wake up the worker thread.
  685  */
  686 
  687 static void
  688 fdc_intr(void *arg)
  689 {
  690 
  691         wakeup(arg);
  692 }
  693 
  694 static int
  695 fdc_intr_fast(void *arg)
  696 {
  697 
  698         wakeup(arg);
  699         return(FILTER_HANDLED);
  700 }
  701 
  702 /*
  703  * fdc_pio(): perform programmed IO read/write for YE PCMCIA floppy.
  704  */
  705 static void
  706 fdc_pio(struct fdc_data *fdc)
  707 {
  708         u_char *cptr;
  709         struct bio *bp;
  710         u_int count;
  711 
  712         bp = fdc->bp;
  713         cptr = fdc->fd->fd_ioptr;
  714         count = fdc->fd->fd_iosize;
  715 
  716         if (bp->bio_cmd == BIO_READ) {
  717                 fdbcdr_wr(fdc, 0, count);
  718                 bus_space_read_multi_1(fdc->iot, fdc->ioh[FD_YE_DATAPORT],
  719                     fdc->ioff[FD_YE_DATAPORT], cptr, count);
  720         } else {
  721                 bus_space_write_multi_1(fdc->iot, fdc->ioh[FD_YE_DATAPORT],
  722                     fdc->ioff[FD_YE_DATAPORT], cptr, count);
  723                 fdbcdr_wr(fdc, 0, count);       /* needed? */
  724         }
  725 }
  726 
  727 static int
  728 fdc_biodone(struct fdc_data *fdc, int error)
  729 {
  730         struct fd_data *fd;
  731         struct bio *bp;
  732 
  733         fd = fdc->fd;
  734         bp = fdc->bp;
  735 
  736         mtx_lock(&fdc->fdc_mtx);
  737         if (--fd->fd_iocount == 0)
  738                 callout_reset(&fd->toffhandle, 4 * hz, fd_turnoff, fd);
  739         fdc->bp = NULL;
  740         fdc->fd = NULL;
  741         mtx_unlock(&fdc->fdc_mtx);
  742         if (bp->bio_to != NULL) {
  743                 if ((debugflags & 2) && fd->fdc->retry > 0)
  744                         printf("retries: %d\n", fd->fdc->retry);
  745                 g_io_deliver(bp, error);
  746                 return (0);
  747         }
  748         bp->bio_error = error;
  749         bp->bio_flags |= BIO_DONE;
  750         wakeup(bp);
  751         return (0);
  752 }
  753 
  754 static int retry_line;
  755 
  756 static int
  757 fdc_worker(struct fdc_data *fdc)
  758 {
  759         struct fd_data *fd;
  760         struct bio *bp;
  761         int i, nsect;
  762         int st0, st3, cyl, mfm, steptrac, cylinder, descyl, sec;
  763         int head;
  764         int override_error;
  765         static int need_recal;
  766         struct fdc_readid *idp;
  767         struct fd_formb *finfo;
  768 
  769         override_error = 0;
  770 
  771         /* Have we exhausted our retries ? */
  772         bp = fdc->bp;
  773         fd = fdc->fd;
  774         if (bp != NULL &&
  775                 (fdc->retry >= retries || (fd->options & FDOPT_NORETRY))) {
  776                 if ((debugflags & 4))
  777                         printf("Too many retries (EIO)\n");
  778                 if (fdc->flags & FDC_NEEDS_RESET) {
  779                         mtx_lock(&fdc->fdc_mtx);
  780                         fd->flags |= FD_EMPTY;
  781                         mtx_unlock(&fdc->fdc_mtx);
  782                 }
  783                 return (fdc_biodone(fdc, EIO));
  784         }
  785 
  786         /* Disable ISADMA if we bailed while it was active */
  787         if (fd != NULL && (fd->flags & FD_ISADMA)) {
  788                 isa_dmadone(
  789                     bp->bio_cmd & BIO_READ ? ISADMA_READ : ISADMA_WRITE,
  790                     fd->fd_ioptr, fd->fd_iosize, fdc->dmachan);
  791                 mtx_lock(&fdc->fdc_mtx);
  792                 fd->flags &= ~FD_ISADMA;
  793                 mtx_unlock(&fdc->fdc_mtx);
  794         }
  795 
  796         /* Unwedge the controller ? */
  797         if (fdc->flags & FDC_NEEDS_RESET) {
  798                 fdc->flags &= ~FDC_NEEDS_RESET;
  799                 fdc_reset(fdc);
  800                 tsleep(fdc, PRIBIO, "fdcrst", hz);
  801                 /* Discard results */
  802                 for (i = 0; i < 4; i++)
  803                         fdc_sense_int(fdc, &st0, &cyl);
  804                 /* All drives must recal */
  805                 need_recal = 0xf;
  806         }
  807 
  808         /* Pick up a request, if need be wait for it */
  809         if (fdc->bp == NULL) {
  810                 mtx_lock(&fdc->fdc_mtx);
  811                 do {
  812                         fdc->bp = bioq_takefirst(&fdc->head);
  813                         if (fdc->bp == NULL)
  814                                 msleep(&fdc->head, &fdc->fdc_mtx,
  815                                     PRIBIO, "-", hz);
  816                 } while (fdc->bp == NULL &&
  817                     (fdc->flags & FDC_KTHREAD_EXIT) == 0);
  818                 mtx_unlock(&fdc->fdc_mtx);
  819 
  820                 if (fdc->bp == NULL)
  821                         /*
  822                          * Nothing to do, worker thread has been
  823                          * requested to stop.
  824                          */
  825                         return (0);
  826 
  827                 bp = fdc->bp;
  828                 fd = fdc->fd = bp->bio_driver1;
  829                 fdc->retry = 0;
  830                 fd->fd_ioptr = bp->bio_data;
  831                 if (bp->bio_cmd & BIO_FMT) {
  832                         i = offsetof(struct fd_formb, fd_formb_cylno(0));
  833                         fd->fd_ioptr += i;
  834                         fd->fd_iosize = bp->bio_length - i;
  835                 }
  836         }
  837 
  838         /* Select drive, setup params */
  839         fd_select(fd);
  840         if (fdc->fdct == FDC_ENHANCED)
  841                 fddsr_wr(fdc, fd->ft->trans);
  842         else
  843                 fdctl_wr(fdc, fd->ft->trans);
  844 
  845         if (bp->bio_cmd & BIO_PROBE) {
  846                 if ((!(device_get_flags(fd->dev) & FD_NO_CHLINE) &&
  847                     !(fdin_rd(fdc) & FDI_DCHG) &&
  848                     !(fd->flags & FD_EMPTY)) ||
  849                     fd_probe_disk(fd, &need_recal) == 0)
  850                         return (fdc_biodone(fdc, 0));
  851                 return (1);
  852         }
  853 
  854         /*
  855          * If we are dead just flush the requests
  856          */
  857         if (fd->flags & FD_EMPTY)
  858                 return (fdc_biodone(fdc, ENXIO));
  859 
  860         /* Check if we lost our media */
  861         if (fdin_rd(fdc) & FDI_DCHG) {
  862                 if (debugflags & 0x40)
  863                         printf("Lost disk\n");
  864                 mtx_lock(&fdc->fdc_mtx);
  865                 fd->flags |= FD_EMPTY;
  866                 fd->flags |= FD_NEWDISK;
  867                 mtx_unlock(&fdc->fdc_mtx);
  868                 g_topology_lock();
  869                 g_orphan_provider(fd->fd_provider, ENXIO);
  870                 fd->fd_provider->flags |= G_PF_WITHER;
  871                 fd->fd_provider =
  872                     g_new_providerf(fd->fd_geom, "%s", fd->fd_geom->name);
  873                 g_error_provider(fd->fd_provider, 0);
  874                 g_topology_unlock();
  875                 return (fdc_biodone(fdc, ENXIO));
  876         }
  877 
  878         /* Check if the floppy is write-protected */
  879         if(bp->bio_cmd & (BIO_FMT | BIO_WRITE)) {
  880                 retry_line = __LINE__;
  881                 if(fdc_sense_drive(fdc, &st3) != 0)
  882                         return (1);
  883                 if(st3 & NE7_ST3_WP)
  884                         return (fdc_biodone(fdc, EROFS));
  885         }
  886 
  887         mfm = (fd->ft->flags & FL_MFM)? NE7CMD_MFM: 0;
  888         steptrac = (fd->ft->flags & FL_2STEP)? 2: 1;
  889         i = fd->ft->sectrac * fd->ft->heads;
  890         cylinder = bp->bio_pblkno / i;
  891         descyl = cylinder * steptrac;
  892         sec = bp->bio_pblkno % i;
  893         nsect = i - sec;
  894         head = sec / fd->ft->sectrac;
  895         sec = sec % fd->ft->sectrac + 1;
  896 
  897         /* If everything is going swimmingly, use multisector xfer */
  898         if (fdc->retry == 0 && bp->bio_cmd & (BIO_READ|BIO_WRITE)) {
  899                 fd->fd_iosize = imin(nsect * fd->sectorsize, bp->bio_resid);
  900                 nsect = fd->fd_iosize / fd->sectorsize;
  901         } else if (bp->bio_cmd & (BIO_READ|BIO_WRITE)) {
  902                 fd->fd_iosize = fd->sectorsize;
  903                 nsect = 1;
  904         }
  905 
  906         /* Do RECAL if we need to or are going to track zero anyway */
  907         if ((need_recal & (1 << fd->fdsu)) ||
  908             (cylinder == 0 && fd->track != 0) ||
  909             fdc->retry > 2) {
  910                 retry_line = __LINE__;
  911                 if (fdc_cmd(fdc, 2, NE7CMD_RECAL, fd->fdsu, 0))
  912                         return (1);
  913                 tsleep(fdc, PRIBIO, "fdrecal", hz);
  914                 retry_line = __LINE__;
  915                 if (fdc_sense_int(fdc, &st0, &cyl) == FD_NOT_VALID)
  916                         return (1); /* XXX */
  917                 retry_line = __LINE__;
  918                 if ((st0 & 0xc0) || cyl != 0)
  919                         return (1);
  920                 need_recal &= ~(1 << fd->fdsu);
  921                 fd->track = 0;
  922                 /* let the heads settle */
  923                 if (settle)
  924                         tsleep(fdc->fd, PRIBIO, "fdhdstl", settle);
  925         }
  926 
  927         /*
  928          * SEEK to where we want to be
  929          */
  930         if (cylinder != fd->track) {
  931                 retry_line = __LINE__;
  932                 if (fdc_cmd(fdc, 3, NE7CMD_SEEK, fd->fdsu, descyl, 0))
  933                         return (1);
  934                 tsleep(fdc, PRIBIO, "fdseek", hz);
  935                 retry_line = __LINE__;
  936                 if (fdc_sense_int(fdc, &st0, &cyl) == FD_NOT_VALID)
  937                         return (1); /* XXX */
  938                 retry_line = __LINE__;
  939                 if ((st0 & 0xc0) || cyl != descyl) {
  940                         need_recal |= (1 << fd->fdsu);
  941                         return (1);
  942                 }
  943                 /* let the heads settle */
  944                 if (settle)
  945                         tsleep(fdc->fd, PRIBIO, "fdhdstl", settle);
  946         }
  947         fd->track = cylinder;
  948 
  949         if (debugflags & 8)
  950                 printf("op %x bn %ju siz %u ptr %p retry %d\n",
  951                     bp->bio_cmd, bp->bio_pblkno, fd->fd_iosize,
  952                     fd->fd_ioptr, fdc->retry);
  953 
  954         /* Setup ISADMA if we need it and have it */
  955         if ((bp->bio_cmd & (BIO_READ|BIO_WRITE|BIO_FMT))
  956              && !(fdc->flags & FDC_NODMA)) {
  957                 isa_dmastart(
  958                     bp->bio_cmd & BIO_READ ? ISADMA_READ : ISADMA_WRITE,
  959                     fd->fd_ioptr, fd->fd_iosize, fdc->dmachan);
  960                 mtx_lock(&fdc->fdc_mtx);
  961                 fd->flags |= FD_ISADMA;
  962                 mtx_unlock(&fdc->fdc_mtx);
  963         }
  964 
  965         /* Do PIO if we have to */
  966         if (fdc->flags & FDC_NODMA) {
  967                 if (bp->bio_cmd & (BIO_READ|BIO_WRITE|BIO_FMT))
  968                         fdbcdr_wr(fdc, 1, fd->fd_iosize);
  969                 if (bp->bio_cmd & (BIO_WRITE|BIO_FMT))
  970                         fdc_pio(fdc);
  971         }
  972 
  973         switch(bp->bio_cmd) {
  974         case BIO_FMT:
  975                 /* formatting */
  976                 finfo = (struct fd_formb *)bp->bio_data;
  977                 retry_line = __LINE__;
  978                 if (fdc_cmd(fdc, 6,
  979                     NE7CMD_FORMAT | mfm,
  980                     head << 2 | fd->fdsu,
  981                     finfo->fd_formb_secshift,
  982                     finfo->fd_formb_nsecs,
  983                     finfo->fd_formb_gaplen,
  984                     finfo->fd_formb_fillbyte, 0))
  985                         return (1);
  986                 break;
  987         case BIO_RDID:
  988                 retry_line = __LINE__;
  989                 if (fdc_cmd(fdc, 2,
  990                     NE7CMD_READID | mfm,
  991                     head << 2 | fd->fdsu, 0))
  992                         return (1);
  993                 break;
  994         case BIO_READ:
  995                 retry_line = __LINE__;
  996                 if (fdc_cmd(fdc, 9,
  997                     NE7CMD_READ | NE7CMD_SK | mfm | NE7CMD_MT,
  998                     head << 2 | fd->fdsu,       /* head & unit */
  999                     fd->track,                  /* track */
 1000                     head,                       /* head */
 1001                     sec,                        /* sector + 1 */
 1002                     fd->ft->secsize,            /* sector size */
 1003                     fd->ft->sectrac,            /* sectors/track */
 1004                     fd->ft->gap,                /* gap size */
 1005                     fd->ft->datalen,            /* data length */
 1006                     0))
 1007                         return (1);
 1008                 break;
 1009         case BIO_WRITE:
 1010                 retry_line = __LINE__;
 1011                 if (fdc_cmd(fdc, 9,
 1012                     NE7CMD_WRITE | mfm | NE7CMD_MT,
 1013                     head << 2 | fd->fdsu,       /* head & unit */
 1014                     fd->track,                  /* track */
 1015                     head,                       /* head */
 1016                     sec,                        /* sector + 1 */
 1017                     fd->ft->secsize,            /* sector size */
 1018                     fd->ft->sectrac,            /* sectors/track */
 1019                     fd->ft->gap,                /* gap size */
 1020                     fd->ft->datalen,            /* data length */
 1021                     0))
 1022                         return (1);
 1023                 break;
 1024         default:
 1025                 KASSERT(0 == 1, ("Wrong bio_cmd %x\n", bp->bio_cmd));
 1026         }
 1027 
 1028         /* Wait for interrupt */
 1029         i = tsleep(fdc, PRIBIO, "fddata", hz);
 1030 
 1031         /* PIO if the read looks good */
 1032         if (i == 0 && (fdc->flags & FDC_NODMA) && (bp->bio_cmd & BIO_READ))
 1033                 fdc_pio(fdc);
 1034 
 1035         /* Finish DMA */
 1036         if (fd->flags & FD_ISADMA) {
 1037                 isa_dmadone(
 1038                     bp->bio_cmd & BIO_READ ? ISADMA_READ : ISADMA_WRITE,
 1039                     fd->fd_ioptr, fd->fd_iosize, fdc->dmachan);
 1040                 mtx_lock(&fdc->fdc_mtx);
 1041                 fd->flags &= ~FD_ISADMA;
 1042                 mtx_unlock(&fdc->fdc_mtx);
 1043         }
 1044 
 1045         if (i != 0) {
 1046                 /*
 1047                  * Timeout.
 1048                  *
 1049                  * Due to IBM's brain-dead design, the FDC has a faked ready
 1050                  * signal, hardwired to ready == true. Thus, any command
 1051                  * issued if there's no diskette in the drive will _never_
 1052                  * complete, and must be aborted by resetting the FDC.
 1053                  * Many thanks, Big Blue!
 1054                  */
 1055                 retry_line = __LINE__;
 1056                 fdc->flags |= FDC_NEEDS_RESET;
 1057                 return (1);
 1058         }
 1059 
 1060         retry_line = __LINE__;
 1061         if (fdc_read_status(fdc))
 1062                 return (1);
 1063 
 1064         if (debugflags & 0x10)
 1065                 printf("  -> %x %x %x %x\n",
 1066                     fdc->status[0], fdc->status[1],
 1067                     fdc->status[2], fdc->status[3]);
 1068 
 1069         st0 = fdc->status[0] & NE7_ST0_IC;
 1070         if (st0 != 0) {
 1071                 retry_line = __LINE__;
 1072                 if (st0 == NE7_ST0_IC_AT && fdc->status[1] & NE7_ST1_OR) {
 1073                         /*
 1074                          * DMA overrun. Someone hogged the bus and
 1075                          * didn't release it in time for the next
 1076                          * FDC transfer.
 1077                          */
 1078                         return (1);
 1079                 }
 1080                 retry_line = __LINE__;
 1081                 if(st0 == NE7_ST0_IC_IV) {
 1082                         fdc->flags |= FDC_NEEDS_RESET;
 1083                         return (1);
 1084                 }
 1085                 retry_line = __LINE__;
 1086                 if(st0 == NE7_ST0_IC_AT && fdc->status[2] & NE7_ST2_WC) {
 1087                         need_recal |= (1 << fd->fdsu);
 1088                         return (1);
 1089                 }
 1090                 if (debugflags & 0x20) {
 1091                         printf("status %02x %02x %02x %02x %02x %02x\n",
 1092                             fdc->status[0], fdc->status[1], fdc->status[2],
 1093                             fdc->status[3], fdc->status[4], fdc->status[5]);
 1094                 }
 1095                 retry_line = __LINE__;
 1096                 if (fd->options & FDOPT_NOERROR)
 1097                         override_error = 1;
 1098                 else
 1099                         return (1);
 1100         }
 1101         /* All OK */
 1102         switch(bp->bio_cmd) {
 1103         case BIO_RDID:
 1104                 /* copy out ID field contents */
 1105                 idp = (struct fdc_readid *)bp->bio_data;
 1106                 idp->cyl = fdc->status[3];
 1107                 idp->head = fdc->status[4];
 1108                 idp->sec = fdc->status[5];
 1109                 idp->secshift = fdc->status[6];
 1110                 if (debugflags & 0x40)
 1111                         printf("c %d h %d s %d z %d\n",
 1112                             idp->cyl, idp->head, idp->sec, idp->secshift);
 1113                 break;
 1114         case BIO_READ:
 1115         case BIO_WRITE:
 1116                 bp->bio_pblkno += nsect;
 1117                 bp->bio_resid -= fd->fd_iosize;
 1118                 bp->bio_completed += fd->fd_iosize;
 1119                 fd->fd_ioptr += fd->fd_iosize;
 1120                 if (override_error) {
 1121                         if ((debugflags & 4))
 1122                                 printf("FDOPT_NOERROR: returning bad data\n");
 1123                 } else {
 1124                         /* Since we managed to get something done,
 1125                          * reset the retry */
 1126                         fdc->retry = 0;
 1127                         if (bp->bio_resid > 0)
 1128                                 return (0);
 1129                 }
 1130                 break;
 1131         case BIO_FMT:
 1132                 break;
 1133         }
 1134         return (fdc_biodone(fdc, 0));
 1135 }
 1136 
 1137 static void
 1138 fdc_thread(void *arg)
 1139 {
 1140         struct fdc_data *fdc;
 1141 
 1142         fdc = arg;
 1143         int i;
 1144 
 1145         mtx_lock(&fdc->fdc_mtx);
 1146         fdc->flags |= FDC_KTHREAD_ALIVE;
 1147         while ((fdc->flags & FDC_KTHREAD_EXIT) == 0) {
 1148                 mtx_unlock(&fdc->fdc_mtx);
 1149                 i = fdc_worker(fdc);
 1150                 if (i && debugflags & 0x20) {
 1151                         if (fdc->bp != NULL) {
 1152                                 g_print_bio(fdc->bp);
 1153                                 printf("\n");
 1154                         }
 1155                         printf("Retry line %d\n", retry_line);
 1156                 }
 1157                 fdc->retry += i;
 1158                 mtx_lock(&fdc->fdc_mtx);
 1159         }
 1160         fdc->flags &= ~(FDC_KTHREAD_EXIT | FDC_KTHREAD_ALIVE);
 1161         mtx_unlock(&fdc->fdc_mtx);
 1162 
 1163         kproc_exit(0);
 1164 }
 1165 
 1166 /*
 1167  * Enqueue a request.
 1168  */
 1169 static void
 1170 fd_enqueue(struct fd_data *fd, struct bio *bp)
 1171 {
 1172         struct fdc_data *fdc;
 1173         int call;
 1174 
 1175         call = 0;
 1176         fdc = fd->fdc;
 1177         mtx_lock(&fdc->fdc_mtx);
 1178         /* If we go from idle, cancel motor turnoff */
 1179         if (fd->fd_iocount++ == 0)
 1180                 callout_stop(&fd->toffhandle);
 1181         if (fd->flags & FD_MOTOR) {
 1182                 /* The motor is on, send it directly to the controller */
 1183                 bioq_disksort(&fdc->head, bp);
 1184                 wakeup(&fdc->head);
 1185         } else {
 1186                 /* Queue it on the drive until the motor has started */
 1187                 bioq_insert_tail(&fd->fd_bq, bp);
 1188                 if (!(fd->flags & FD_MOTORWAIT))
 1189                         fd_motor(fd, 1);
 1190         }
 1191         mtx_unlock(&fdc->fdc_mtx);
 1192 }
 1193 
 1194 /*
 1195  * Try to find out if we have a disk in the drive.
 1196  */
 1197 static int
 1198 fd_probe_disk(struct fd_data *fd, int *recal)
 1199 {
 1200         struct fdc_data *fdc;
 1201         int st0, st3, cyl;
 1202         int oopts, ret;
 1203 
 1204         fdc = fd->fdc;
 1205         oopts = fd->options;
 1206         fd->options |= FDOPT_NOERRLOG | FDOPT_NORETRY;
 1207         ret = 1;
 1208 
 1209         /*
 1210          * First recal, then seek to cyl#1, this clears the old condition on
 1211          * the disk change line so we can examine it for current status.
 1212          */
 1213         if (debugflags & 0x40)
 1214                 printf("New disk in probe\n");
 1215         mtx_lock(&fdc->fdc_mtx);
 1216         fd->flags |= FD_NEWDISK;
 1217         mtx_unlock(&fdc->fdc_mtx);
 1218         if (fdc_cmd(fdc, 2, NE7CMD_RECAL, fd->fdsu, 0))
 1219                 goto done;
 1220         tsleep(fdc, PRIBIO, "fdrecal", hz);
 1221         if (fdc_sense_int(fdc, &st0, &cyl) == FD_NOT_VALID)
 1222                 goto done;      /* XXX */
 1223         if ((st0 & 0xc0) || cyl != 0)
 1224                 goto done;
 1225 
 1226         /* Seek to track 1 */
 1227         if (fdc_cmd(fdc, 3, NE7CMD_SEEK, fd->fdsu, 1, 0))
 1228                 goto done;
 1229         tsleep(fdc, PRIBIO, "fdseek", hz);
 1230         if (fdc_sense_int(fdc, &st0, &cyl) == FD_NOT_VALID)
 1231                 goto done;      /* XXX */
 1232         *recal |= (1 << fd->fdsu);
 1233         if (fdin_rd(fdc) & FDI_DCHG) {
 1234                 if (debugflags & 0x40)
 1235                         printf("Empty in probe\n");
 1236                 mtx_lock(&fdc->fdc_mtx);
 1237                 fd->flags |= FD_EMPTY;
 1238                 mtx_unlock(&fdc->fdc_mtx);
 1239         } else {
 1240                 if (fdc_sense_drive(fdc, &st3) != 0)
 1241                         goto done;
 1242                 if (debugflags & 0x40)
 1243                         printf("Got disk in probe\n");
 1244                 mtx_lock(&fdc->fdc_mtx);
 1245                 fd->flags &= ~FD_EMPTY;
 1246                 if (st3 & NE7_ST3_WP)
 1247                         fd->flags |= FD_WP;
 1248                 else
 1249                         fd->flags &= ~FD_WP;
 1250                 mtx_unlock(&fdc->fdc_mtx);
 1251         }
 1252         ret = 0;
 1253 
 1254 done:
 1255         fd->options = oopts;
 1256         return (ret);
 1257 }
 1258 
 1259 static int
 1260 fdmisccmd(struct fd_data *fd, u_int cmd, void *data)
 1261 {
 1262         struct bio *bp;
 1263         struct fd_formb *finfo;
 1264         struct fdc_readid *idfield;
 1265         int error;
 1266 
 1267         bp = malloc(sizeof(struct bio), M_TEMP, M_WAITOK | M_ZERO);
 1268 
 1269         /*
 1270          * Set up a bio request for fdstrategy().  bio_offset is faked
 1271          * so that fdstrategy() will seek to the requested
 1272          * cylinder, and use the desired head.
 1273          */
 1274         bp->bio_cmd = cmd;
 1275         if (cmd == BIO_FMT) {
 1276                 finfo = (struct fd_formb *)data;
 1277                 bp->bio_pblkno =
 1278                     (finfo->cyl * fd->ft->heads + finfo->head) *
 1279                     fd->ft->sectrac;
 1280                 bp->bio_length = sizeof *finfo;
 1281         } else if (cmd == BIO_RDID) {
 1282                 idfield = (struct fdc_readid *)data;
 1283                 bp->bio_pblkno =
 1284                     (idfield->cyl * fd->ft->heads + idfield->head) *
 1285                     fd->ft->sectrac;
 1286                 bp->bio_length = sizeof(struct fdc_readid);
 1287         } else if (cmd == BIO_PROBE) {
 1288                 /* nothing */
 1289         } else
 1290                 panic("wrong cmd in fdmisccmd()");
 1291         bp->bio_offset = bp->bio_pblkno * fd->sectorsize;
 1292         bp->bio_data = data;
 1293         bp->bio_driver1 = fd;
 1294         bp->bio_flags = 0;
 1295 
 1296         fd_enqueue(fd, bp);
 1297 
 1298         do {
 1299                 tsleep(bp, PRIBIO, "fdwait", hz);
 1300         } while (!(bp->bio_flags & BIO_DONE));
 1301         error = bp->bio_error;
 1302 
 1303         free(bp, M_TEMP);
 1304         return (error);
 1305 }
 1306 
 1307 /*
 1308  * Try figuring out the density of the media present in our device.
 1309  */
 1310 static int
 1311 fdautoselect(struct fd_data *fd)
 1312 {
 1313         struct fd_type *fdtp;
 1314         struct fdc_readid id;
 1315         int oopts, rv;
 1316 
 1317         if (!(fd->ft->flags & FL_AUTO))
 1318                 return (0);
 1319 
 1320         fdtp = fd_native_types[fd->type];
 1321         fdsettype(fd, fdtp);
 1322         if (!(fd->ft->flags & FL_AUTO))
 1323                 return (0);
 1324 
 1325         /*
 1326          * Try reading sector ID fields, first at cylinder 0, head 0,
 1327          * then at cylinder 2, head N.  We don't probe cylinder 1,
 1328          * since for 5.25in DD media in a HD drive, there are no data
 1329          * to read (2 step pulses per media cylinder required).  For
 1330          * two-sided media, the second probe always goes to head 1, so
 1331          * we can tell them apart from single-sided media.  As a
 1332          * side-effect this means that single-sided media should be
 1333          * mentioned in the search list after two-sided media of an
 1334          * otherwise identical density.  Media with a different number
 1335          * of sectors per track but otherwise identical parameters
 1336          * cannot be distinguished at all.
 1337          *
 1338          * If we successfully read an ID field on both cylinders where
 1339          * the recorded values match our expectation, we are done.
 1340          * Otherwise, we try the next density entry from the table.
 1341          *
 1342          * Stepping to cylinder 2 has the side-effect of clearing the
 1343          * unit attention bit.
 1344          */
 1345         oopts = fd->options;
 1346         fd->options |= FDOPT_NOERRLOG | FDOPT_NORETRY;
 1347         for (; fdtp->heads; fdtp++) {
 1348                 fdsettype(fd, fdtp);
 1349 
 1350                 id.cyl = id.head = 0;
 1351                 rv = fdmisccmd(fd, BIO_RDID, &id);
 1352                 if (rv != 0)
 1353                         continue;
 1354                 if (id.cyl != 0 || id.head != 0 || id.secshift != fdtp->secsize)
 1355                         continue;
 1356                 id.cyl = 2;
 1357                 id.head = fd->ft->heads - 1;
 1358                 rv = fdmisccmd(fd, BIO_RDID, &id);
 1359                 if (id.cyl != 2 || id.head != fdtp->heads - 1 ||
 1360                     id.secshift != fdtp->secsize)
 1361                         continue;
 1362                 if (rv == 0)
 1363                         break;
 1364         }
 1365 
 1366         fd->options = oopts;
 1367         if (fdtp->heads == 0) {
 1368                 if (debugflags & 0x40)
 1369                         device_printf(fd->dev, "autoselection failed\n");
 1370                 fdsettype(fd, fd_native_types[fd->type]);
 1371                 return (-1);
 1372         } else {
 1373                 if (debugflags & 0x40) {
 1374                         device_printf(fd->dev,
 1375                             "autoselected %d KB medium\n", fd->ft->size / 2);
 1376                         fdprinttype(fd->ft);
 1377                 }
 1378                 return (0);
 1379         }
 1380 }
 1381 
 1382 /*
 1383  * GEOM class implementation
 1384  */
 1385 
 1386 static g_access_t       fd_access;
 1387 static g_start_t        fd_start;
 1388 static g_ioctl_t        fd_ioctl;
 1389 
 1390 struct g_class g_fd_class = {
 1391         .name =         "FD",
 1392         .version =      G_VERSION,
 1393         .start =        fd_start,
 1394         .access =       fd_access,
 1395         .ioctl =        fd_ioctl,
 1396 };
 1397 
 1398 static int
 1399 fd_access(struct g_provider *pp, int r, int w, int e)
 1400 {
 1401         struct fd_data *fd;
 1402         struct fdc_data *fdc;
 1403         int ar, aw, ae;
 1404         int busy;
 1405 
 1406         fd = pp->geom->softc;
 1407         fdc = fd->fdc;
 1408 
 1409         /*
 1410          * If our provider is withering, we can only get negative requests
 1411          * and we don't want to even see them
 1412          */
 1413         if (pp->flags & G_PF_WITHER)
 1414                 return (0);
 1415 
 1416         ar = r + pp->acr;
 1417         aw = w + pp->acw;
 1418         ae = e + pp->ace;
 1419 
 1420         if (ar == 0 && aw == 0 && ae == 0) {
 1421                 fd->options &= ~(FDOPT_NORETRY | FDOPT_NOERRLOG | FDOPT_NOERROR);
 1422                 device_unbusy(fd->dev);
 1423                 return (0);
 1424         }
 1425 
 1426         busy = 0;
 1427         if (pp->acr == 0 && pp->acw == 0 && pp->ace == 0) {
 1428                 if (fdmisccmd(fd, BIO_PROBE, NULL))
 1429                         return (ENXIO);
 1430                 if (fd->flags & FD_EMPTY)
 1431                         return (ENXIO);
 1432                 if (fd->flags & FD_NEWDISK) {
 1433                         if (fdautoselect(fd) != 0 &&
 1434                             (device_get_flags(fd->dev) & FD_NO_CHLINE)) {
 1435                                 mtx_lock(&fdc->fdc_mtx);
 1436                                 fd->flags |= FD_EMPTY;
 1437                                 mtx_unlock(&fdc->fdc_mtx);
 1438                                 return (ENXIO);
 1439                         }
 1440                         mtx_lock(&fdc->fdc_mtx);
 1441                         fd->flags &= ~FD_NEWDISK;
 1442                         mtx_unlock(&fdc->fdc_mtx);
 1443                 }
 1444                 device_busy(fd->dev);
 1445                 busy = 1;
 1446         }
 1447 
 1448         if (w > 0 && (fd->flags & FD_WP)) {
 1449                 if (busy)
 1450                         device_unbusy(fd->dev);
 1451                 return (EROFS);
 1452         }
 1453 
 1454         pp->sectorsize = fd->sectorsize;
 1455         pp->stripesize = fd->ft->heads * fd->ft->sectrac * fd->sectorsize;
 1456         pp->mediasize = pp->stripesize * fd->ft->tracks;
 1457         return (0);
 1458 }
 1459 
 1460 static void
 1461 fd_start(struct bio *bp)
 1462 {
 1463         struct fdc_data *       fdc;
 1464         struct fd_data *        fd;
 1465 
 1466         fd = bp->bio_to->geom->softc;
 1467         fdc = fd->fdc;
 1468         bp->bio_driver1 = fd;
 1469         if (bp->bio_cmd & BIO_GETATTR) {
 1470                 if (g_handleattr_int(bp, "GEOM::fwsectors", fd->ft->sectrac))
 1471                         return;
 1472                 if (g_handleattr_int(bp, "GEOM::fwheads", fd->ft->heads))
 1473                         return;
 1474                 g_io_deliver(bp, ENOIOCTL);
 1475                 return;
 1476         }
 1477         if (!(bp->bio_cmd & (BIO_READ|BIO_WRITE))) {
 1478                 g_io_deliver(bp, EOPNOTSUPP);
 1479                 return;
 1480         }
 1481         bp->bio_pblkno = bp->bio_offset / fd->sectorsize;
 1482         bp->bio_resid = bp->bio_length;
 1483         fd_enqueue(fd, bp);
 1484         return;
 1485 }
 1486 
 1487 static int
 1488 fd_ioctl(struct g_provider *pp, u_long cmd, void *data, int fflag, struct thread *td)
 1489 {
 1490         struct fd_data *fd;
 1491         struct fdc_status *fsp;
 1492         struct fdc_readid *rid;
 1493         int error;
 1494 
 1495         fd = pp->geom->softc;
 1496 
 1497         switch (cmd) {
 1498         case FD_GTYPE:                  /* get drive type */
 1499                 *(struct fd_type *)data = *fd->ft;
 1500                 return (0);
 1501 
 1502         case FD_STYPE:                  /* set drive type */
 1503                 /*
 1504                  * Allow setting drive type temporarily iff
 1505                  * currently unset.  Used for fdformat so any
 1506                  * user can set it, and then start formatting.
 1507                  */
 1508                 fd->fts = *(struct fd_type *)data;
 1509                 if (fd->fts.sectrac) {
 1510                         /* XXX: check for rubbish */
 1511                         fdsettype(fd, &fd->fts);
 1512                 } else {
 1513                         fdsettype(fd, fd_native_types[fd->type]);
 1514                 }
 1515                 if (debugflags & 0x40)
 1516                         fdprinttype(fd->ft);
 1517                 return (0);
 1518 
 1519         case FD_GOPTS:                  /* get drive options */
 1520                 *(int *)data = fd->options;
 1521                 return (0);
 1522 
 1523         case FD_SOPTS:                  /* set drive options */
 1524                 fd->options = *(int *)data;
 1525                 return (0);
 1526 
 1527         case FD_CLRERR:
 1528                 error = priv_check(td, PRIV_DRIVER);
 1529                 if (error)
 1530                         return (error);
 1531                 fd->fdc->fdc_errs = 0;
 1532                 return (0);
 1533 
 1534         case FD_GSTAT:
 1535                 fsp = (struct fdc_status *)data;
 1536                 if ((fd->fdc->flags & FDC_STAT_VALID) == 0)
 1537                         return (EINVAL);
 1538                 memcpy(fsp->status, fd->fdc->status, 7 * sizeof(u_int));
 1539                 return (0);
 1540 
 1541         case FD_GDTYPE:
 1542                 *(enum fd_drivetype *)data = fd->type;
 1543                 return (0);
 1544 
 1545         case FD_FORM:
 1546                 if (!(fflag & FWRITE))
 1547                         return (EPERM);
 1548                 if (((struct fd_formb *)data)->format_version !=
 1549                     FD_FORMAT_VERSION)
 1550                         return (EINVAL); /* wrong version of formatting prog */
 1551                 error = fdmisccmd(fd, BIO_FMT, data);
 1552                 mtx_lock(&fd->fdc->fdc_mtx);
 1553                 fd->flags |= FD_NEWDISK;
 1554                 mtx_unlock(&fd->fdc->fdc_mtx);
 1555                 break;
 1556 
 1557         case FD_READID:
 1558                 rid = (struct fdc_readid *)data;
 1559                 if (rid->cyl > 85 || rid->head > 1)
 1560                         return (EINVAL);
 1561                 error = fdmisccmd(fd, BIO_RDID, data);
 1562                 break;
 1563 
 1564         case FIONBIO:
 1565         case FIOASYNC:
 1566                 /* For backwards compat with old fd*(8) tools */
 1567                 error = 0;
 1568                 break;
 1569 
 1570         default:
 1571                 if (debugflags & 0x80)
 1572                         printf("Unknown ioctl %lx\n", cmd);
 1573                 error = ENOIOCTL;
 1574                 break;
 1575         }
 1576         return (error);
 1577 };
 1578 
 1579 
 1580 
 1581 /*
 1582  * Configuration/initialization stuff, per controller.
 1583  */
 1584 
 1585 devclass_t fdc_devclass;
 1586 static devclass_t fd_devclass;
 1587 
 1588 struct fdc_ivars {
 1589         int     fdunit;
 1590         int     fdtype;
 1591 };
 1592 
 1593 void
 1594 fdc_release_resources(struct fdc_data *fdc)
 1595 {
 1596         device_t dev;
 1597         struct resource *last;
 1598         int i;
 1599 
 1600         dev = fdc->fdc_dev;
 1601         if (fdc->fdc_intr)
 1602                 bus_teardown_intr(dev, fdc->res_irq, fdc->fdc_intr);
 1603         fdc->fdc_intr = NULL;
 1604         if (fdc->res_irq != NULL)
 1605                 bus_release_resource(dev, SYS_RES_IRQ, fdc->rid_irq,
 1606                     fdc->res_irq);
 1607         fdc->res_irq = NULL;
 1608         last = NULL;
 1609         for (i = 0; i < FDC_MAXREG; i++) {
 1610                 if (fdc->resio[i] != NULL && fdc->resio[i] != last) {
 1611                         bus_release_resource(dev, SYS_RES_IOPORT,
 1612                             fdc->ridio[i], fdc->resio[i]);
 1613                         last = fdc->resio[i];
 1614                         fdc->resio[i] = NULL;
 1615                 }
 1616         }
 1617         if (fdc->res_drq != NULL)
 1618                 bus_release_resource(dev, SYS_RES_DRQ, fdc->rid_drq,
 1619                     fdc->res_drq);
 1620         fdc->res_drq = NULL;
 1621 }
 1622 
 1623 int
 1624 fdc_read_ivar(device_t dev, device_t child, int which, uintptr_t *result)
 1625 {
 1626         struct fdc_ivars *ivars = device_get_ivars(child);
 1627 
 1628         switch (which) {
 1629         case FDC_IVAR_FDUNIT:
 1630                 *result = ivars->fdunit;
 1631                 break;
 1632         case FDC_IVAR_FDTYPE:
 1633                 *result = ivars->fdtype;
 1634                 break;
 1635         default:
 1636                 return (ENOENT);
 1637         }
 1638         return (0);
 1639 }
 1640 
 1641 int
 1642 fdc_write_ivar(device_t dev, device_t child, int which, uintptr_t value)
 1643 {
 1644         struct fdc_ivars *ivars = device_get_ivars(child);
 1645 
 1646         switch (which) {
 1647         case FDC_IVAR_FDUNIT:
 1648                 ivars->fdunit = value;
 1649                 break;
 1650         case FDC_IVAR_FDTYPE:
 1651                 ivars->fdtype = value;
 1652                 break;
 1653         default:
 1654                 return (ENOENT);
 1655         }
 1656         return (0);
 1657 }
 1658 
 1659 int
 1660 fdc_initial_reset(device_t dev, struct fdc_data *fdc)
 1661 {
 1662         int ic_type, part_id;
 1663 
 1664         /*
 1665          * A status value of 0xff is very unlikely, but not theoretically
 1666          * impossible, but it is far more likely to indicate an empty bus.
 1667          */
 1668         if (fdsts_rd(fdc) == 0xff)
 1669                 return (ENXIO);
 1670 
 1671         /*
 1672          * Assert a reset to the floppy controller and check that the status
 1673          * register goes to zero.
 1674          */
 1675         fdout_wr(fdc, 0);
 1676         fdout_wr(fdc, 0);
 1677         if (fdsts_rd(fdc) != 0)
 1678                 return (ENXIO);
 1679 
 1680         /*
 1681          * Clear the reset and see it come ready.
 1682          */
 1683         fdout_wr(fdc, FDO_FRST);
 1684         DELAY(100);
 1685         if (fdsts_rd(fdc) != 0x80)
 1686                 return (ENXIO);
 1687 
 1688         /* Then, see if it can handle a command. */
 1689         if (fdc_cmd(fdc, 3, NE7CMD_SPECIFY, 0xaf, 0x1e, 0))
 1690                 return (ENXIO);
 1691 
 1692         /*
 1693          * Try to identify the chip.
 1694          *
 1695          * The i8272 datasheet documents that unknown commands
 1696          * will return ST0 as 0x80.  The i8272 is supposedly identical
 1697          * to the NEC765.
 1698          * The i82077SL datasheet says 0x90 for the VERSION command,
 1699          * and several "superio" chips emulate this.
 1700          */
 1701         if (fdc_cmd(fdc, 1, NE7CMD_VERSION, 1, &ic_type))
 1702                 return (ENXIO);
 1703         if (fdc_cmd(fdc, 1, 0x18, 1, &part_id))
 1704                 return (ENXIO);
 1705         if (bootverbose)
 1706                 device_printf(dev,
 1707                     "ic_type %02x part_id %02x\n", ic_type, part_id);
 1708         switch (ic_type & 0xff) {
 1709         case 0x80:
 1710                 device_set_desc(dev, "NEC 765 or clone");
 1711                 fdc->fdct = FDC_NE765;
 1712                 break;
 1713         case 0x81:
 1714         case 0x90:
 1715                 device_set_desc(dev,
 1716                     "Enhanced floppy controller");
 1717                 fdc->fdct = FDC_ENHANCED;
 1718                 break;
 1719         default:
 1720                 device_set_desc(dev, "Generic floppy controller");
 1721                 fdc->fdct = FDC_UNKNOWN;
 1722                 break;
 1723         }
 1724         return (0);
 1725 }
 1726 
 1727 int
 1728 fdc_detach(device_t dev)
 1729 {
 1730         struct  fdc_data *fdc;
 1731         int     error;
 1732 
 1733         fdc = device_get_softc(dev);
 1734 
 1735         /* have our children detached first */
 1736         if ((error = bus_generic_detach(dev)))
 1737                 return (error);
 1738 
 1739         if (fdc->fdc_intr)
 1740                 bus_teardown_intr(dev, fdc->res_irq, fdc->fdc_intr);
 1741         fdc->fdc_intr = NULL;
 1742 
 1743         /* kill worker thread */
 1744         mtx_lock(&fdc->fdc_mtx);
 1745         fdc->flags |= FDC_KTHREAD_EXIT;
 1746         wakeup(&fdc->head);
 1747         while ((fdc->flags & FDC_KTHREAD_ALIVE) != 0)
 1748                 msleep(fdc->fdc_thread, &fdc->fdc_mtx, PRIBIO, "fdcdet", 0);
 1749         mtx_unlock(&fdc->fdc_mtx);
 1750 
 1751         /* reset controller, turn motor off */
 1752         fdout_wr(fdc, 0);
 1753 
 1754         if (!(fdc->flags & FDC_NODMA))
 1755                 isa_dma_release(fdc->dmachan);
 1756         fdc_release_resources(fdc);
 1757         mtx_destroy(&fdc->fdc_mtx);
 1758         return (0);
 1759 }
 1760 
 1761 /*
 1762  * Add a child device to the fdc controller.  It will then be probed etc.
 1763  */
 1764 device_t
 1765 fdc_add_child(device_t dev, const char *name, int unit)
 1766 {
 1767         struct fdc_ivars *ivar;
 1768         device_t child;
 1769 
 1770         ivar = malloc(sizeof *ivar, M_DEVBUF /* XXX */, M_NOWAIT | M_ZERO);
 1771         if (ivar == NULL)
 1772                 return (NULL);
 1773         child = device_add_child(dev, name, unit);
 1774         if (child == NULL) {
 1775                 free(ivar, M_DEVBUF);
 1776                 return (NULL);
 1777         }
 1778         device_set_ivars(child, ivar);
 1779         ivar->fdunit = unit;
 1780         ivar->fdtype = FDT_NONE;
 1781         if (resource_disabled(name, unit))
 1782                 device_disable(child);
 1783         return (child);
 1784 }
 1785 
 1786 int
 1787 fdc_attach(device_t dev)
 1788 {
 1789         struct  fdc_data *fdc;
 1790         int     error;
 1791 
 1792         fdc = device_get_softc(dev);
 1793         fdc->fdc_dev = dev;
 1794         error = fdc_initial_reset(dev, fdc);
 1795         if (error) {
 1796                 device_printf(dev, "does not respond\n");
 1797                 return (error);
 1798         }
 1799         error = bus_setup_intr(dev, fdc->res_irq,
 1800             INTR_TYPE_BIO | INTR_ENTROPY | 
 1801             ((fdc->flags & FDC_NOFAST) ? INTR_MPSAFE : 0),                     
 1802             ((fdc->flags & FDC_NOFAST) ? NULL : fdc_intr_fast),             
 1803             ((fdc->flags & FDC_NOFAST) ? fdc_intr : NULL), 
 1804                                fdc, &fdc->fdc_intr);
 1805         if (error) {
 1806                 device_printf(dev, "cannot setup interrupt\n");
 1807                 return (error);
 1808         }
 1809         if (!(fdc->flags & FDC_NODMA)) {
 1810                 error = isa_dma_acquire(fdc->dmachan);
 1811                 if (!error) {
 1812                         error = isa_dma_init(fdc->dmachan,
 1813                             MAX_BYTES_PER_CYL, M_WAITOK);
 1814                         if (error)
 1815                                 isa_dma_release(fdc->dmachan);
 1816                 }
 1817                 if (error)
 1818                         return (error);
 1819         }
 1820         fdc->fdcu = device_get_unit(dev);
 1821         fdc->flags |= FDC_NEEDS_RESET;
 1822 
 1823         mtx_init(&fdc->fdc_mtx, "fdc lock", NULL, MTX_DEF);
 1824 
 1825         /* reset controller, turn motor off, clear fdout mirror reg */
 1826         fdout_wr(fdc, fdc->fdout = 0);
 1827         bioq_init(&fdc->head);
 1828 
 1829         kproc_create(fdc_thread, fdc, &fdc->fdc_thread, 0, 0,
 1830             "fdc%d", device_get_unit(dev));
 1831 
 1832         settle = hz / 8;
 1833 
 1834         return (0);
 1835 }
 1836 
 1837 int
 1838 fdc_hints_probe(device_t dev)
 1839 {
 1840         const char *name, *dname;
 1841         int i, error, dunit;
 1842 
 1843         /*
 1844          * Probe and attach any children.  We should probably detect
 1845          * devices from the BIOS unless overridden.
 1846          */
 1847         name = device_get_nameunit(dev);
 1848         i = 0;
 1849         while ((resource_find_match(&i, &dname, &dunit, "at", name)) == 0) {
 1850                 resource_int_value(dname, dunit, "drive", &dunit);
 1851                 fdc_add_child(dev, dname, dunit);
 1852         }
 1853 
 1854         if ((error = bus_generic_attach(dev)) != 0)
 1855                 return (error);
 1856         return (0);
 1857 }
 1858 
 1859 int
 1860 fdc_print_child(device_t me, device_t child)
 1861 {
 1862         int retval = 0, flags;
 1863 
 1864         retval += bus_print_child_header(me, child);
 1865         retval += printf(" on %s drive %d", device_get_nameunit(me),
 1866                fdc_get_fdunit(child));
 1867         if ((flags = device_get_flags(me)) != 0)
 1868                 retval += printf(" flags %#x", flags);
 1869         retval += printf("\n");
 1870 
 1871         return (retval);
 1872 }
 1873 
 1874 /*
 1875  * Configuration/initialization, per drive.
 1876  */
 1877 static int
 1878 fd_probe(device_t dev)
 1879 {
 1880         int     i, unit;
 1881         u_int   st0, st3;
 1882         struct  fd_data *fd;
 1883         struct  fdc_data *fdc;
 1884         int     fdsu;
 1885         int     flags, type;
 1886 
 1887         fdsu = fdc_get_fdunit(dev);
 1888         fd = device_get_softc(dev);
 1889         fdc = device_get_softc(device_get_parent(dev));
 1890         flags = device_get_flags(dev);
 1891 
 1892         fd->dev = dev;
 1893         fd->fdc = fdc;
 1894         fd->fdsu = fdsu;
 1895         unit = device_get_unit(dev);
 1896 
 1897         /* Auto-probe if fdinfo is present, but always allow override. */
 1898         type = flags & FD_TYPEMASK;
 1899         if (type == FDT_NONE && (type = fdc_get_fdtype(dev)) != FDT_NONE) {
 1900                 fd->type = type;
 1901                 goto done;
 1902         } else {
 1903                 /* make sure fdautoselect() will be called */
 1904                 fd->flags = FD_EMPTY;
 1905                 fd->type = type;
 1906         }
 1907 
 1908 #if (defined(__i386__) && !defined(PC98)) || defined(__amd64__)
 1909         if (fd->type == FDT_NONE && (unit == 0 || unit == 1)) {
 1910                 /* Look up what the BIOS thinks we have. */
 1911                 if (unit == 0)
 1912                         fd->type = (rtcin(RTC_FDISKETTE) & 0xf0) >> 4;
 1913                 else
 1914                         fd->type = rtcin(RTC_FDISKETTE) & 0x0f;
 1915                 if (fd->type == FDT_288M_1)
 1916                         fd->type = FDT_288M;
 1917         }
 1918 #endif /* __i386__ || __amd64__ */
 1919         /* is there a unit? */
 1920         if (fd->type == FDT_NONE)
 1921                 return (ENXIO);
 1922 
 1923 /*
 1924         mtx_lock(&fdc->fdc_mtx);
 1925 */
 1926         /* select it */
 1927         fd_select(fd);
 1928         fd_motor(fd, 1);
 1929         fdc->fd = fd;
 1930         fdc_reset(fdc);         /* XXX reset, then unreset, etc. */
 1931         DELAY(1000000); /* 1 sec */
 1932 
 1933         if ((flags & FD_NO_PROBE) == 0) {
 1934                 /* If we're at track 0 first seek inwards. */
 1935                 if ((fdc_sense_drive(fdc, &st3) == 0) &&
 1936                     (st3 & NE7_ST3_T0)) {
 1937                         /* Seek some steps... */
 1938                         if (fdc_cmd(fdc, 3, NE7CMD_SEEK, fdsu, 10, 0) == 0) {
 1939                                 /* ...wait a moment... */
 1940                                 DELAY(300000);
 1941                                 /* make ctrlr happy: */
 1942                                 fdc_sense_int(fdc, NULL, NULL);
 1943                         }
 1944                 }
 1945 
 1946                 for (i = 0; i < 2; i++) {
 1947                         /*
 1948                          * we must recalibrate twice, just in case the
 1949                          * heads have been beyond cylinder 76, since
 1950                          * most FDCs still barf when attempting to
 1951                          * recalibrate more than 77 steps
 1952                          */
 1953                         /* go back to 0: */
 1954                         if (fdc_cmd(fdc, 2, NE7CMD_RECAL, fdsu, 0) == 0) {
 1955                                 /* a second being enough for full stroke seek*/
 1956                                 DELAY(i == 0 ? 1000000 : 300000);
 1957 
 1958                                 /* anything responding? */
 1959                                 if (fdc_sense_int(fdc, &st0, NULL) == 0 &&
 1960                                     (st0 & NE7_ST0_EC) == 0)
 1961                                         break; /* already probed succesfully */
 1962                         }
 1963                 }
 1964         }
 1965 
 1966         fd_motor(fd, 0);
 1967         fdc->fd = NULL;
 1968 /*
 1969         mtx_unlock(&fdc->fdc_mtx);
 1970 */
 1971 
 1972         if ((flags & FD_NO_PROBE) == 0 &&
 1973             (st0 & NE7_ST0_EC) != 0) /* no track 0 -> no drive present */
 1974                 return (ENXIO);
 1975 
 1976 done:
 1977 
 1978         switch (fd->type) {
 1979         case FDT_12M:
 1980                 device_set_desc(dev, "1200-KB 5.25\" drive");
 1981                 break;
 1982         case FDT_144M:
 1983                 device_set_desc(dev, "1440-KB 3.5\" drive");
 1984                 break;
 1985         case FDT_288M:
 1986                 device_set_desc(dev, "2880-KB 3.5\" drive (in 1440-KB mode)");
 1987                 break;
 1988         case FDT_360K:
 1989                 device_set_desc(dev, "360-KB 5.25\" drive");
 1990                 break;
 1991         case FDT_720K:
 1992                 device_set_desc(dev, "720-KB 3.5\" drive");
 1993                 break;
 1994         default:
 1995                 return (ENXIO);
 1996         }
 1997         fd->track = FD_NO_TRACK;
 1998         fd->fdc = fdc;
 1999         fd->fdsu = fdsu;
 2000         fd->options = 0;
 2001         callout_init_mtx(&fd->toffhandle, &fd->fdc->fdc_mtx, 0);
 2002 
 2003         /* initialize densities for subdevices */
 2004         fdsettype(fd, fd_native_types[fd->type]);
 2005         return (0);
 2006 }
 2007 
 2008 /*
 2009  * We have to do this in a geom event because GEOM is not running
 2010  * when fd_attach() is.
 2011  * XXX: move fd_attach after geom like ata/scsi disks
 2012  */
 2013 static void
 2014 fd_attach2(void *arg, int flag)
 2015 {
 2016         struct  fd_data *fd;
 2017 
 2018         fd = arg;
 2019 
 2020         fd->fd_geom = g_new_geomf(&g_fd_class,
 2021             "fd%d", device_get_unit(fd->dev));
 2022         fd->fd_provider = g_new_providerf(fd->fd_geom, "%s", fd->fd_geom->name);
 2023         fd->fd_geom->softc = fd;
 2024         g_error_provider(fd->fd_provider, 0);
 2025 }
 2026 
 2027 static int
 2028 fd_attach(device_t dev)
 2029 {
 2030         struct  fd_data *fd;
 2031 
 2032         fd = device_get_softc(dev);
 2033         g_post_event(fd_attach2, fd, M_WAITOK, NULL);
 2034         fd->flags |= FD_EMPTY;
 2035         bioq_init(&fd->fd_bq);
 2036 
 2037         return (0);
 2038 }
 2039 
 2040 static void
 2041 fd_detach_geom(void *arg, int flag)
 2042 {
 2043         struct  fd_data *fd = arg;
 2044 
 2045         g_topology_assert();
 2046         g_wither_geom(fd->fd_geom, ENXIO);
 2047 }
 2048 
 2049 static int
 2050 fd_detach(device_t dev)
 2051 {
 2052         struct  fd_data *fd;
 2053 
 2054         fd = device_get_softc(dev);
 2055         g_waitfor_event(fd_detach_geom, fd, M_WAITOK, NULL);
 2056         while (device_get_state(dev) == DS_BUSY)
 2057                 tsleep(fd, PZERO, "fdd", hz/10);
 2058         callout_drain(&fd->toffhandle);
 2059 
 2060         return (0);
 2061 }
 2062 
 2063 static device_method_t fd_methods[] = {
 2064         /* Device interface */
 2065         DEVMETHOD(device_probe,         fd_probe),
 2066         DEVMETHOD(device_attach,        fd_attach),
 2067         DEVMETHOD(device_detach,        fd_detach),
 2068         DEVMETHOD(device_shutdown,      bus_generic_shutdown),
 2069         DEVMETHOD(device_suspend,       bus_generic_suspend), /* XXX */
 2070         DEVMETHOD(device_resume,        bus_generic_resume), /* XXX */
 2071         { 0, 0 }
 2072 };
 2073 
 2074 static driver_t fd_driver = {
 2075         "fd",
 2076         fd_methods,
 2077         sizeof(struct fd_data)
 2078 };
 2079 
 2080 static int
 2081 fdc_modevent(module_t mod, int type, void *data)
 2082 {
 2083 
 2084         return (g_modevent(NULL, type, &g_fd_class));
 2085 }
 2086 
 2087 DRIVER_MODULE(fd, fdc, fd_driver, fd_devclass, fdc_modevent, 0);

Cache object: 7f28227352250a7bfb9ed78eb7223280


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]


This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.