summaryrefslogtreecommitdiff
path: root/i386/i386at/nfd.c
diff options
context:
space:
mode:
authorThomas Schwinge <tschwinge@gnu.org>2006-02-20 19:04:31 +0000
committerThomas Schwinge <tschwinge@gnu.org>2009-06-18 00:26:32 +0200
commitb40d1da0855a87519b5764415aec6519025a8338 (patch)
treee7f52b1b1b0b9892576f2e05c059a07757fd9728 /i386/i386at/nfd.c
parent9335c8094c3797c93876b6a9f9a3d0e3842ad651 (diff)
2006-02-20 Thomas Schwinge <tschwinge@gnu.org>
Remove unused and unsupported code. Consult the file `DEVELOPMENT' for details. Partly based on suggestions by Gianluca Guida <glguida@gmail.com>. * i386/bogus/fd.h: Remove file. * i386/i386at/fd.c: Likewise. * i386/i386at/fdreg.h: Likewise. * i386/i386at/nfd.c: Likewise. * i386/i386at/nfdreg.h: Likewise. * i386/Makefile.in (i386at-files): Remove `fd.c'. * i386/i386at/autoconf.c: Don't include <fd.h> anymore and adopt all users of NFD as if it were always defined to `0'. * i386/i386at/conf.c: Likewise.
Diffstat (limited to 'i386/i386at/nfd.c')
-rw-r--r--i386/i386at/nfd.c1484
1 files changed, 0 insertions, 1484 deletions
diff --git a/i386/i386at/nfd.c b/i386/i386at/nfd.c
deleted file mode 100644
index 950f896..0000000
--- a/i386/i386at/nfd.c
+++ /dev/null
@@ -1,1484 +0,0 @@
-/*
- * Copyright (c) 1994 Shantanu Goel
- * All Rights Reserved.
- *
- * Permission to use, copy, modify and distribute this software and its
- * documentation is hereby granted, provided that both the copyright
- * notice and this permission notice appear in all copies of the
- * software, derivative works or modified versions, and any portions
- * thereof, and that both notices appear in supporting documentation.
- *
- * THE AUTHOR ALLOWS FREE USE OF THIS SOFTWARE IN ITS "AS IS"
- * CONDITION. THE AUTHOR DISCLAIMS ANY LIABILITY OF ANY KIND FOR
- * ANY DAMAGES WHATSOEVER RESULTING FROM THE USE OF THIS SOFTWARE.
- */
-
-#include <fd.h>
-#if NFD > 0
-/*
- * Floppy disk driver.
- *
- * Supports:
- * 1 controller and 2 drives.
- * Media change and automatic media detection.
- * Arbitrarily sized read/write requests.
- * Misaligned requests
- * DMA above 16 Meg
- *
- * TODO:
- * 1) Real probe routines for controller and drives.
- * 2) Support for multiple controllers. The driver does
- * not assume a single controller since all functions
- * take the controller and/or device structure as an
- * argument, however the probe routines limit the
- * number of controllers and drives to 1 and 2 respectively.
- * 3) V_VERIFY ioctl.
- * 4) User defined diskette parameters.
- * 5) Detect Intel 82077 or compatible and use its FIFO mode.
- *
- * Shantanu Goel (goel@cs.columbia.edu)
- */
-#include <sys/types.h>
-#include <sys/ioctl.h>
-#include "vm_param.h"
-#include <kern/time_out.h>
-#include <vm/pmap.h>
-#include <device/param.h>
-#include <device/buf.h>
-#include <device/errno.h>
-#include <chips/busses.h>
-#include <i386/machspl.h>
-#include <i386/pio.h>
-#include <i386at/cram.h>
-#include <i386at/disk.h>
-#include <i386at/nfdreg.h>
-
-/*
- * Number of drives supported by an FDC.
- * The controller is actually capable of
- * supporting 4 drives, however, most (all?)
- * board implementations only support 2.
- */
-#define NDRIVES_PER_FDC 2
-#define NFDC ((NFD + NDRIVES_PER_FDC - 1) / NDRIVES_PER_FDC)
-
-#define fdunit(dev) (((int)(dev) >> 6) & 3)
-#define fdmedia(dev) ((int)(dev) & 3)
-
-#define b_cylin b_resid
-#define B_FORMAT B_MD1
-
-#define SECSIZE 512
-
-#define DMABSIZE (18*1024) /* size of DMA bounce buffer */
-
-#define OP_TIMEOUT 5 /* time to wait (secs) for an
- operation before giving up */
-#define MOTOR_TIMEOUT 5 /* time to wait (secs) before turning
- off an idle drive motor */
-#define MAX_RETRIES 48 /* number of times to try
- an I/O operation */
-
-#define SRTHUT 0xdf /* step rate/head unload time */
-#define HLTND 0x02 /* head load time/dma mode */
-
-/*
- * DMA controller.
- *
- * XXX: There should be a generic <i386/dma.h> file.
- */
-
-/*
- * Ports
- */
-#define DMA2_PAGE 0x81 /* channel 2, page register */
-#define DMA2_ADDR 0x04 /* channel 2, addr register */
-#define DMA2_COUNT 0x05 /* channel 2, count register */
-#define DMA_STATUS 0x08 /* status register */
-#define DMA_COMMAND 0x08 /* command register */
-#define DMA_WREQ 0x09 /* request register */
-#define DMA_SINGLEMSK 0x0a /* single mask register */
-#define DMA_MODE 0x0b /* mode register */
-#define DMA_FLIPFLOP 0x0c /* pointer flip/flop */
-#define DMA_TEMP 0x0d /* temporary register */
-#define DMA_MASTERCLR 0x0d /* master clear */
-#define DMA_CLRMASK 0x0e /* clear mask register */
-#define DMA_ALLMASK 0x0f /* all mask register */
-
-/*
- * Commands
- */
-#define DMA_WRITE 0x46 /* write on channel 2 */
-#define DMA_READ 0x4a /* read on channel 2 */
-
-/*
- * Autoconfiguration stuff.
- */
-struct bus_ctlr *fdminfo[NFDC];
-struct bus_device *fddinfo[NFD];
-int fdstd[] = { 0 };
-int fdprobe(), fdslave(), fdintr();
-void fdattach();
-struct bus_driver fddriver = {
- fdprobe, fdslave, fdattach, 0, fdstd, "fd", fddinfo, "fdc", fdminfo
-};
-
-/*
- * Per-controller state.
- */
-struct fdcsoftc {
- int sc_flags;
-#define FDF_WANT 0x01 /* someone needs direct controller access */
-#define FDF_RESET 0x02 /* controller needs reset */
-#define FDF_LIMIT 0x04 /* limit transfer to a single sector */
-#define FDF_BOUNCE 0x08 /* using bounce buffer */
- int sc_state; /* transfer fsm */
- caddr_t sc_addr; /* buffer address */
- int sc_resid; /* amount left to transfer */
- int sc_amt; /* amount currently being transferred */
- int sc_op; /* operation being performed */
- int sc_mode; /* DMA mode */
- int sc_sn; /* sector number */
- int sc_tn; /* track number */
- int sc_cn; /* cylinder number */
- int sc_recalerr; /* # recalibration errors */
- int sc_seekerr; /* # seek errors */
- int sc_ioerr; /* # i/o errors */
- int sc_dor; /* copy of digital output register */
- int sc_rate; /* copy of transfer rate register */
- int sc_wticks; /* watchdog */
- u_int sc_buf; /* buffer for transfers > 16 Meg */
- u_char sc_cmd[9]; /* command buffer */
- u_char sc_results[7]; /* operation results */
-} fdcsoftc[NFDC];
-
-#define sc_st0 sc_results[0]
-#define sc_st3 sc_results[0]
-#define sc_st1 sc_results[1]
-#define sc_pcn sc_results[1]
-#define sc_st2 sc_results[2]
-#define sc_c sc_results[3]
-#define sc_h sc_results[4]
-#define sc_r sc_results[5]
-#define sc_n sc_results[6]
-
-/*
- * Transfer states.
- */
-#define IDLE 0 /* controller is idle */
-#define RESET 1 /* reset controller */
-#define RESETDONE 2 /* reset completion interrupt */
-#define RECAL 3 /* recalibrate drive */
-#define RECALDONE 4 /* recalibration complete interrupt */
-#define SEEK 5 /* perform seek on drive */
-#define SEEKDONE 6 /* seek completion interrupt */
-#define TRANSFER 7 /* perform transfer on drive */
-#define TRANSFERDONE 8 /* transfer completion interrupt */
-
-/*
- * Per-drive state.
- */
-struct fdsoftc {
- int sc_flags;
-#define FDF_RECAL 0x02 /* drive needs recalibration */
-#define FDF_SEEK 0x04 /* force seek during auto-detection */
-#define FDF_AUTO 0x08 /* performing auto-density */
-#define FDF_AUTOFORCE 0x10 /* force auto-density */
-#define FDF_INIT 0x20 /* drive is being initialized */
- int sc_type; /* drive type */
- struct fddk *sc_dk; /* diskette type */
- int sc_cyl; /* current head position */
- int sc_mticks; /* motor timeout */
-} fdsoftc[NFD];
-
-struct buf fdtab[NFDC]; /* controller queues */
-struct buf fdutab[NFD]; /* drive queues */
-
-/*
- * Floppy drive type names.
- */
-char *fdnames[] = { "360K", "1.2 Meg", "720K", "1.44 Meg" };
-#define NTYPES (sizeof(fdnames) / sizeof(fdnames[0]))
-
-/*
- * Floppy diskette parameters.
- */
-struct fddk {
- int dk_nspu; /* sectors/unit */
- int dk_nspc; /* sectors/cylinder */
- int dk_ncyl; /* cylinders/unit */
- int dk_nspt; /* sectors/track */
- int dk_step; /* !=0 means double track steps */
- int dk_gap; /* read/write gap length */
- int dk_fgap; /* format gap length */
- int dk_rate; /* transfer rate */
- int dk_drives; /* bit mask of drives that accept diskette */
- char *dk_name; /* type name */
-} fddk[] = {
- /*
- * NOTE: largest density for each drive type must be first so
- * fdauto() tries it before any lower ones.
- */
- { 2880, 36, 80, 18, 0, 0x1b, 0x6c, 0x00, 0x08, "1.44 Meg" },
- { 2400, 30, 80, 15, 0, 0x1b, 0x54, 0x00, 0x02, "1.2 Meg" },
- { 1440, 18, 80, 9, 0, 0x2a, 0x50, 0x02, 0x0c, "720K" },
- { 720, 18, 40, 9, 1, 0x23, 0x50, 0x01, 0x02, "360K" },
- { 720, 18, 40, 9, 0, 0x2a, 0x50, 0x02, 0x01, "360K PC" }
-};
-#define NDKTYPES (sizeof(fddk) / sizeof(fddk[0]))
-
-/*
- * For compatibility with old driver.
- * This array is indexed by the old floppy type codes
- * and points to the corresponding entry for that
- * type in fddk[] above.
- */
-struct fddk *fdcompat[NDKTYPES];
-
-int fdwstart = 0;
-int fdstrategy(), fdformat();
-char *fderrmsg();
-void fdwatch(), fdminphys(), fdspinup(), wakeup();
-
-#define FDDEBUG
-#ifdef FDDEBUG
-int fddebug = 0;
-#define DEBUGF(n, stmt) { if (fddebug >= (n)) stmt; }
-#else
-#define DEBUGF(n, stmt)
-#endif
-
-/*
- * Probe for a controller.
- */
-int
-fdprobe(xxx, um)
- int xxx;
- struct bus_ctlr *um;
-{
- struct fdcsoftc *fdc;
-
- if (um->unit >= NFDC) {
- printf("fdc%d: not configured\n", um->unit);
- return (0);
- }
- if (um->unit > 0) /* XXX: only 1 controller */
- return (0);
-
- /*
- * XXX: need real probe
- */
- take_ctlr_irq(um);
- printf("%s%d: port 0x%x, spl %d, pic %d.\n",
- um->name, um->unit, um->address, um->sysdep, um->sysdep1);
-
- /*
- * Set up compatibility array.
- */
- fdcompat[0] = &fddk[2];
- fdcompat[1] = &fddk[0];
- fdcompat[2] = &fddk[3];
- fdcompat[3] = &fddk[1];
-
- fdc = &fdcsoftc[um->unit];
- fdc->sc_rate = -1;
- if (!fdc->sc_buf) {
- fdc->sc_buf = alloc_dma_mem(DMABSIZE, 64*1024);
- if (fdc->sc_buf == 0)
- panic("fd: alloc_dma_mem() failed");
- }
- fdc->sc_dor = DOR_RSTCLR | DOR_IENABLE;
- outb(FD_DOR(um->address), fdc->sc_dor);
- return (1);
-}
-
-/*
- * Probe for a drive.
- */
-int
-fdslave(ui)
- struct bus_device *ui;
-{
- struct fdsoftc *sc;
-
- if (ui->unit >= NFD) {
- printf("fd%d: not configured\n", ui->unit);
- return (0);
- }
- if (ui->unit > 1) /* XXX: only 2 drives */
- return (0);
-
- /*
- * Find out from CMOS if drive exists.
- */
- sc = &fdsoftc[ui->unit];
- outb(CMOS_ADDR, 0x10);
- sc->sc_type = inb(CMOS_DATA);
- if (ui->unit == 0)
- sc->sc_type >>= 4;
- sc->sc_type &= 0x0f;
- return (sc->sc_type);
-}
-
-/*
- * Attach a drive to the system.
- */
-void
-fdattach(ui)
- struct bus_device *ui;
-{
- struct fdsoftc *sc;
-
- sc = &fdsoftc[ui->unit];
- if (--sc->sc_type >= NTYPES) {
- printf(": unknown drive type %d", sc->sc_type);
- ui->alive = 0;
- return;
- }
- printf(": %s", fdnames[sc->sc_type]);
- sc->sc_flags = FDF_RECAL | FDF_SEEK | FDF_AUTOFORCE;
-}
-
-int
-fdopen(dev, mode)
- dev_t dev;
- int mode;
-{
- int unit = fdunit(dev), error;
- struct bus_device *ui;
- struct fdsoftc *sc;
-
- if (unit >= NFD || (ui = fddinfo[unit]) == 0 || ui->alive == 0)
- return (ENXIO);
-
- /*
- * Start watchdog.
- */
- if (!fdwstart) {
- fdwstart++;
- timeout(fdwatch, 0, hz);
- }
- /*
- * Do media detection if drive is being opened for the
- * first time or diskette has been changed since the last open.
- */
- sc = &fdsoftc[unit];
- if ((sc->sc_flags & FDF_AUTOFORCE) || fddskchg(ui)) {
- if (error = fdauto(dev))
- return (error);
- sc->sc_flags &= ~FDF_AUTOFORCE;
- }
- return (0);
-}
-
-int
-fdclose(dev)
- dev_t dev;
-{
- int s, unit = fdunit(dev);
- struct fdsoftc *sc = &fdsoftc[unit];
-
- /*
- * Wait for pending operations to complete.
- */
- s = splbio();
- while (fdutab[unit].b_active) {
- sc->sc_flags |= FDF_WANT;
- assert_wait((event_t)sc, FALSE);
- thread_block((void (*)())0);
- }
- splx(s);
- return (0);
-}
-
-int
-fdread(dev, ior)
- dev_t dev;
- io_req_t ior;
-{
- return (block_io(fdstrategy, fdminphys, ior));
-}
-
-int
-fdwrite(dev, ior)
- dev_t dev;
- io_req_t ior;
-{
- return (block_io(fdstrategy, fdminphys, ior));
-}
-
-int
-fdgetstat(dev, flavor, status, status_count)
- dev_t dev;
- dev_flavor_t flavor;
- dev_status_t status;
- mach_msg_type_number_t *status_count;
-{
- switch (flavor) {
-
- case DEV_GET_SIZE:
- {
- int *info;
- io_return_t error;
- struct disk_parms dp;
-
- if (error = fdgetparms(dev, &dp))
- return (error);
- info = (int *)status;
- info[DEV_GET_SIZE_DEVICE_SIZE] = dp.dp_pnumsec * SECSIZE;
- info[DEV_GET_SIZE_RECORD_SIZE] = SECSIZE;
- *status_count = DEV_GET_SIZE_COUNT;
- return (D_SUCCESS);
- }
- case V_GETPARMS:
- if (*status_count < (sizeof(struct disk_parms) / sizeof(int)))
- return (D_INVALID_OPERATION);
- *status_count = sizeof(struct disk_parms) / sizeof(int);
- return (fdgetparms(dev, (struct disk_parms *)status));
-
- default:
- return (D_INVALID_OPERATION);
- }
-}
-
-int
-fdsetstat(dev, flavor, status, status_count)
- dev_t dev;
- dev_flavor_t flavor;
- dev_status_t status;
- mach_msg_type_number_t status_count;
-{
- switch (flavor) {
-
- case V_SETPARMS:
- return (fdsetparms(dev, *(int *)status));
-
- case V_FORMAT:
- return (fdformat(dev, (union io_arg *)status));
-
- case V_VERIFY:
- /*
- * XXX: needs to be implemented
- */
- return (D_SUCCESS);
-
- default:
- return (D_INVALID_OPERATION);
- }
-}
-
-int
-fddevinfo(dev, flavor, info)
- dev_t dev;
- int flavor;
- char *info;
-{
- switch (flavor) {
-
- case D_INFO_BLOCK_SIZE:
- *(int *)info = SECSIZE;
- return (D_SUCCESS);
-
- default:
- return (D_INVALID_OPERATION);
- }
-}
-
-/*
- * Allow arbitrary transfers. Standard minphys restricts
- * transfers to a maximum of 256K preventing us from reading
- * an entire diskette in a single system call.
- */
-void
-fdminphys(ior)
- io_req_t ior;
-{
-}
-
-/*
- * Return current media parameters.
- */
-int
-fdgetparms(dev, dp)
- dev_t dev;
- struct disk_parms *dp;
-{
- struct fddk *dk = fdsoftc[fdunit(dev)].sc_dk;
-
- dp->dp_type = DPT_FLOPPY;
- dp->dp_heads = 2;
- dp->dp_sectors = dk->dk_nspt;
- dp->dp_pstartsec = 0;
- dp->dp_cyls = dk->dk_ncyl;
- dp->dp_pnumsec = dk->dk_nspu;
- return (0);
-}
-
-/*
- * Set media parameters.
- */
-int
-fdsetparms(dev, type)
- dev_t dev;
- int type;
-{
- struct fdsoftc *sc;
- struct fddk *dk;
-
- if (type < 0 || type >= NDKTYPES)
- return (EINVAL);
- dk = fdcompat[type];
- sc = &fdsoftc[fdunit(dev)];
- if ((dk->dk_drives & (1 << sc->sc_type)) == 0)
- return (EINVAL);
- sc->sc_dk = dk;
- return (D_SUCCESS);
-}
-
-/*
- * Format a floppy.
- */
-int
-fdformat(dev, arg)
- dev_t dev;
- union io_arg *arg;
-{
- int i, j, sect, error = 0;
- unsigned track, num_trks;
- struct buf *bp;
- struct fddk *dk;
- struct format_info *fmt;
-
- dk = fdsoftc[fdunit(dev)].sc_dk;
- num_trks = arg->ia_fmt.num_trks;
- track = arg->ia_fmt.start_trk;
- if (num_trks == 0 || track + num_trks > (dk->dk_ncyl << 1)
- || arg->ia_fmt.intlv >= dk->dk_nspt)
- return (EINVAL);
-
- bp = (struct buf *)geteblk(SECSIZE);
- bp->b_dev = dev;
- bp->b_bcount = dk->dk_nspt * sizeof(struct format_info);
- bp->b_blkno = track * dk->dk_nspt;
-
- while (num_trks-- > 0) {
- /*
- * Set up format information.
- */
- fmt = (struct format_info *)bp->b_un.b_addr;
- for (i = 0; i < dk->dk_nspt; i++)
- fmt[i].sector = 0;
- for (i = 0, j = 0, sect = 1; i < dk->dk_nspt; i++) {
- fmt[j].cyl = track >> 1;
- fmt[j].head = track & 1;
- fmt[j].sector = sect++;
- fmt[j].secsize = 2;
- if ((j += arg->ia_fmt.intlv) < dk->dk_nspt)
- continue;
- for (j -= dk->dk_nspt; j < dk->dk_nspt; j++)
- if (fmt[j].sector == 0)
- break;
- }
- bp->b_flags = B_FORMAT;
- fdstrategy(bp);
- biowait(bp);
- if (bp->b_flags & B_ERROR) {
- error = bp->b_error;
- break;
- }
- bp->b_blkno += dk->dk_nspt;
- track++;
- }
- bp->b_flags &= ~B_FORMAT;
- brelse(bp);
- return (error);
-}
-
-/*
- * Strategy routine.
- * Enqueue a request on drive queue.
- */
-int
-fdstrategy(bp)
- struct buf *bp;
-{
- int unit = fdunit(bp->b_dev), s;
- int bn, sz, maxsz;
- struct buf *dp;
- struct bus_device *ui = fddinfo[unit];
- struct fddk *dk = fdsoftc[unit].sc_dk;
-
- bn = bp->b_blkno;
- sz = (bp->b_bcount + SECSIZE - 1) / SECSIZE;
- maxsz = dk->dk_nspu;
- if (bn < 0 || bn + sz > maxsz) {
- if (bn == maxsz) {
- bp->b_resid = bp->b_bcount;
- goto done;
- }
- sz = maxsz - bn;
- if (sz <= 0) {
- bp->b_error = EINVAL;
- bp->b_flags |= B_ERROR;
- goto done;
- }
- bp->b_bcount = sz * SECSIZE;
- }
- bp->b_cylin = bn / dk->dk_nspc;
- dp = &fdutab[unit];
- s = splbio();
- disksort(dp, bp);
- if (!dp->b_active) {
- fdustart(ui);
- if (!fdtab[ui->mi->unit].b_active)
- fdstart(ui->mi);
- }
- splx(s);
- return;
- done:
- biodone(bp);
- return;
-}
-
-/*
- * Unit start routine.
- * Move request from drive to controller queue.
- */
-int
-fdustart(ui)
- struct bus_device *ui;
-{
- struct buf *bp;
- struct buf *dp;
-
- bp = &fdutab[ui->unit];
- if (bp->b_actf == 0)
- return;
- dp = &fdtab[ui->mi->unit];
- if (dp->b_actf == 0)
- dp->b_actf = bp;
- else
- dp->b_actl->b_forw = bp;
- bp->b_forw = 0;
- dp->b_actl = bp;
- bp->b_active++;
-}
-
-/*
- * Start output on controller.
- */
-int
-fdstart(um)
- struct bus_ctlr *um;
-{
- struct buf *bp;
- struct buf *dp;
- struct fdsoftc *sc;
- struct fdcsoftc *fdc;
- struct bus_device *ui;
- struct fddk *dk;
-
- /*
- * Pull a request from the controller queue.
- */
- dp = &fdtab[um->unit];
- if ((bp = dp->b_actf) == 0)
- return;
- bp = bp->b_actf;
-
- fdc = &fdcsoftc[um->unit];
- ui = fddinfo[fdunit(bp->b_dev)];
- sc = &fdsoftc[ui->unit];
- dk = sc->sc_dk;
-
- /*
- * Mark controller busy.
- */
- dp->b_active++;
-
- /*
- * Figure out where this request is going.
- */
- fdc->sc_cn = bp->b_cylin;
- fdc->sc_sn = bp->b_blkno % dk->dk_nspc;
- fdc->sc_tn = fdc->sc_sn / dk->dk_nspt;
- fdc->sc_sn %= dk->dk_nspt;
-
- /*
- * Set up for multi-sector transfer.
- */
- fdc->sc_op = ((bp->b_flags & B_FORMAT) ? CMD_FORMAT
- : ((bp->b_flags & B_READ) ? CMD_READ : CMD_WRITE));
- fdc->sc_mode = (bp->b_flags & B_READ) ? DMA_WRITE : DMA_READ;
- fdc->sc_addr = bp->b_un.b_addr;
- fdc->sc_resid = bp->b_bcount;
- fdc->sc_wticks = 0;
- fdc->sc_recalerr = 0;
- fdc->sc_seekerr = 0;
- fdc->sc_ioerr = 0;
-
- /*
- * Set initial transfer state.
- */
- if (fdc->sc_flags & FDF_RESET)
- fdc->sc_state = RESET;
- else if (sc->sc_flags & FDF_RECAL)
- fdc->sc_state = RECAL;
- else if (sc->sc_cyl != fdc->sc_cn)
- fdc->sc_state = SEEK;
- else
- fdc->sc_state = TRANSFER;
-
- /*
- * Set transfer rate.
- */
- if (fdc->sc_rate != dk->dk_rate) {
- fdc->sc_rate = dk->dk_rate;
- outb(FD_RATE(um->address), fdc->sc_rate);
- }
- /*
- * Turn on drive motor.
- * Don't start I/O if drive is spinning up.
- */
- if (fdmotoron(ui)) {
- timeout(fdspinup, (void *)um, hz / 2);
- return;
- }
- /*
- * Call transfer state routine to do the actual I/O.
- */
- fdstate(um);
-}
-
-/*
- * Interrupt routine.
- */
-int
-fdintr(ctlr)
- int ctlr;
-{
- int timedout;
- u_char results[7];
- struct buf *bp;
- struct bus_device *ui;
- struct fdsoftc *sc;
- struct buf *dp = &fdtab[ctlr];
- struct fdcsoftc *fdc = &fdcsoftc[ctlr];
- struct bus_ctlr *um = fdminfo[ctlr];
-
- if (!dp->b_active) {
- printf("fdc%d: stray interrupt\n", ctlr);
- return;
- }
- timedout = fdc->sc_wticks >= OP_TIMEOUT;
- fdc->sc_wticks = 0;
- bp = dp->b_actf->b_actf;
- ui = fddinfo[fdunit(bp->b_dev)];
- sc = &fdsoftc[ui->unit];
-
- /*
- * Operation timed out, terminate request.
- */
- if (timedout) {
- fderror("timed out", ui);
- fdmotoroff(ui);
- sc->sc_flags |= FDF_RECAL;
- bp->b_flags |= B_ERROR;
- bp->b_error = ENXIO;
- fddone(ui, bp);
- return;
- }
- /*
- * Read results from FDC.
- * For transfer completion they can be read immediately.
- * For anything else, we must issue a Sense Interrupt
- * Status Command. We keep issuing this command till
- * FDC returns invalid command status. The Controller Busy
- * bit in the status register indicates completion of a
- * read/write/format operation.
- */
- if (inb(FD_STATUS(um->address)) & ST_CB) {
- if (!fdresults(um, fdc->sc_results))
- return;
- } else {
- while (1) {
- fdc->sc_cmd[0] = CMD_SENSEI;
- if (!fdcmd(um, 1)) {
- DEBUGF(2, printf(2, "fd%d: SENSEI failed\n"));
- return;
- }
- if (!fdresults(um, results))
- return;
- if ((results[0] & ST0_IC) == 0x80)
- break;
- if ((results[0] & ST0_US) == ui->slave) {
- fdc->sc_results[0] = results[0];
- fdc->sc_results[1] = results[1];
- }
- }
- }
- /*
- * Let transfer state routine handle the rest.
- */
- fdstate(um);
-}
-
-/*
- * Transfer finite state machine driver.
- */
-int
-fdstate(um)
- struct bus_ctlr *um;
-{
- int unit, max, pa, s;
- struct buf *bp;
- struct fdsoftc *sc;
- struct bus_device *ui;
- struct fddk *dk;
- struct fdcsoftc *fdc = &fdcsoftc[um->unit];
-
- bp = fdtab[um->unit].b_actf->b_actf;
- ui = fddinfo[fdunit(bp->b_dev)];
- sc = &fdsoftc[ui->unit];
- dk = sc->sc_dk;
-
- while (1) switch (fdc->sc_state) {
-
- case RESET:
- /*
- * Reset the controller.
- */
- fdreset(um);
- return;
-
- case RESETDONE:
- /*
- * Reset complete.
- * Mark all drives as needing recalibration
- * and issue specify command.
- */
- for (unit = 0; unit < NFD; unit++)
- if (fddinfo[unit] && fddinfo[unit]->alive
- && fddinfo[unit]->mi == um)
- fdsoftc[unit].sc_flags |= FDF_RECAL;
- fdc->sc_cmd[0] = CMD_SPECIFY;
- fdc->sc_cmd[1] = SRTHUT;
- fdc->sc_cmd[2] = HLTND;
- if (!fdcmd(um, 3))
- return;
- fdc->sc_flags &= ~FDF_RESET;
- fdc->sc_state = RECAL;
- break;
-
- case RECAL:
- /*
- * Recalibrate drive.
- */
- fdc->sc_state = RECALDONE;
- fdc->sc_cmd[0] = CMD_RECAL;
- fdc->sc_cmd[1] = ui->slave;
- fdcmd(um, 2);
- return;
-
- case RECALDONE:
- /*
- * Recalibration complete.
- */
- if ((fdc->sc_st0 & ST0_IC) || (fdc->sc_st0 & ST0_EC)) {
- if (++fdc->sc_recalerr == 2) {
- fderror("recalibrate failed", ui);
- goto bad;
- }
- fdc->sc_state = RESET;
- break;
- }
- sc->sc_flags &= ~FDF_RECAL;
- fdc->sc_recalerr = 0;
- sc->sc_cyl = -1;
- fdc->sc_state = SEEK;
- break;
-
- case SEEK:
- /*
- * Perform seek operation.
- */
- fdc->sc_state = SEEKDONE;
- fdc->sc_cmd[0] = CMD_SEEK;
- fdc->sc_cmd[1] = (fdc->sc_tn << 2) | ui->slave;
- fdc->sc_cmd[2] = fdc->sc_cn;
- if (dk->dk_step)
- fdc->sc_cmd[2] <<= 1;
- fdcmd(um, 3);
- return;
-
- case SEEKDONE:
- /*
- * Seek complete.
- */
- if (dk->dk_step)
- fdc->sc_pcn >>= 1;
- if ((fdc->sc_st0 & ST0_IC) || (fdc->sc_st0 & ST0_SE) == 0
- || fdc->sc_pcn != fdc->sc_cn) {
- if (++fdc->sc_seekerr == 2) {
- fderror("seek failed", ui);
- goto bad;
- }
- fdc->sc_state = RESET;
- break;
- }
- fdc->sc_seekerr = 0;
- sc->sc_cyl = fdc->sc_pcn;
- fdc->sc_state = TRANSFER;
- break;
-
- case TRANSFER:
- /*
- * Perform I/O transfer.
- */
- fdc->sc_flags &= ~FDF_BOUNCE;
- pa = pmap_extract(kernel_pmap, fdc->sc_addr);
- if (fdc->sc_op == CMD_FORMAT) {
- max = sizeof(struct format_info) * dk->dk_nspt;
- } else if (fdc->sc_flags & FDF_LIMIT) {
- fdc->sc_flags &= ~FDF_LIMIT;
- max = SECSIZE;
- } else {
- max = (dk->dk_nspc - dk->dk_nspt * fdc->sc_tn
- - fdc->sc_sn) * SECSIZE;
- }
- if (max > fdc->sc_resid)
- max = fdc->sc_resid;
- if (pa >= 16*1024*1024) {
- fdc->sc_flags |= FDF_BOUNCE;
- pa = fdc->sc_buf;
- if (max < DMABSIZE)
- fdc->sc_amt = max;
- else
- fdc->sc_amt = DMABSIZE;
- } else {
- int prevpa, curpa, omax;
- vm_offset_t va;
-
- omax = max;
- if (max > 65536 - (pa & 0xffff))
- max = 65536 - (pa & 0xffff);
- fdc->sc_amt = I386_PGBYTES - (pa & (I386_PGBYTES - 1));
- va = (vm_offset_t)fdc->sc_addr + fdc->sc_amt;
- prevpa = pa & ~(I386_PGBYTES - 1);
- while (fdc->sc_amt < max) {
- curpa = pmap_extract(kernel_pmap, va);
- if (curpa >= 16*1024*1024
- || curpa != prevpa + I386_PGBYTES)
- break;
- fdc->sc_amt += I386_PGBYTES;
- va += I386_PGBYTES;
- prevpa = curpa;
- }
- if (fdc->sc_amt > max)
- fdc->sc_amt = max;
- if (fdc->sc_op == CMD_FORMAT) {
- if (fdc->sc_amt != omax) {
- fdc->sc_flags |= FDF_BOUNCE;
- pa = fdc->sc_buf;
- fdc->sc_amt = omax;
- }
- } else if (fdc->sc_amt != fdc->sc_resid) {
- if (fdc->sc_amt < SECSIZE) {
- fdc->sc_flags |= FDF_BOUNCE;
- pa = fdc->sc_buf;
- if (omax > DMABSIZE)
- fdc->sc_amt = DMABSIZE;
- else
- fdc->sc_amt = omax;
- } else
- fdc->sc_amt &= ~(SECSIZE - 1);
- }
- }
-
- DEBUGF(2, printf("fd%d: TRANSFER: amt %d cn %d tn %d sn %d\n",
- ui->unit, fdc->sc_amt, fdc->sc_cn,
- fdc->sc_tn, fdc->sc_sn + 1));
-
- if ((fdc->sc_flags & FDF_BOUNCE) && fdc->sc_op != CMD_READ) {
- fdc->sc_flags &= ~FDF_BOUNCE;
- bcopy(fdc->sc_addr, (caddr_t)phystokv(fdc->sc_buf),
- fdc->sc_amt);
- }
- /*
- * Set up DMA.
- */
- s = sploff();
- outb(DMA_SINGLEMSK, 0x04 | 0x02);
- outb(DMA_FLIPFLOP, 0);
- outb(DMA_MODE, fdc->sc_mode);
- outb(DMA2_ADDR, pa);
- outb(DMA2_ADDR, pa >> 8);
- outb(DMA2_PAGE, pa >> 16);
- outb(DMA2_COUNT, fdc->sc_amt - 1);
- outb(DMA2_COUNT, (fdc->sc_amt - 1) >> 8);
- outb(DMA_SINGLEMSK, 0x02);
- splon(s);
-
- /*
- * Issue command to FDC.
- */
- fdc->sc_state = TRANSFERDONE;
- fdc->sc_cmd[0] = fdc->sc_op;
- fdc->sc_cmd[1] = (fdc->sc_tn << 2) | ui->slave;
- if (fdc->sc_op == CMD_FORMAT) {
- fdc->sc_cmd[2] = 0x02;
- fdc->sc_cmd[3] = dk->dk_nspt;
- fdc->sc_cmd[4] = dk->dk_fgap;
- fdc->sc_cmd[5] = 0xda;
- fdcmd(um, 6);
- } else {
- fdc->sc_cmd[2] = fdc->sc_cn;
- fdc->sc_cmd[3] = fdc->sc_tn;
- fdc->sc_cmd[4] = fdc->sc_sn + 1;
- fdc->sc_cmd[5] = 0x02;
- fdc->sc_cmd[6] = dk->dk_nspt;
- fdc->sc_cmd[7] = dk->dk_gap;
- fdc->sc_cmd[8] = 0xff;
- fdcmd(um, 9);
- }
- return;
-
- case TRANSFERDONE:
- /*
- * Transfer complete.
- */
- if (fdc->sc_st0 & ST0_IC) {
- fdc->sc_ioerr++;
- if (sc->sc_flags & FDF_AUTO) {
- /*
- * Give up on second try if
- * media detection is in progress.
- */
- if (fdc->sc_ioerr == 2)
- goto bad;
- fdc->sc_state = RECAL;
- break;
- }
- if (fdc->sc_ioerr == MAX_RETRIES) {
- fderror(fderrmsg(ui), ui);
- goto bad;
- }
- /*
- * Give up immediately on write-protected diskettes.
- */
- if (fdc->sc_st1 & ST1_NW) {
- fderror("write-protected diskette", ui);
- goto bad;
- }
- /*
- * Limit transfer to a single sector.
- */
- fdc->sc_flags |= FDF_LIMIT;
- /*
- * Every fourth attempt recalibrate the drive.
- * Every eight attempt reset the controller.
- * Also, every eighth attempt inform user
- * about the error.
- */
- if (fdc->sc_ioerr & 3)
- fdc->sc_state = TRANSFER;
- else if (fdc->sc_ioerr & 7)
- fdc->sc_state = RECAL;
- else {
- fdc->sc_state = RESET;
- fderror(fderrmsg(ui), ui);
- }
- break;
- }
- /*
- * Transfer completed successfully.
- * Advance counters/pointers, and if more
- * is left, initiate I/O.
- */
- if (fdc->sc_flags & FDF_BOUNCE) {
- fdc->sc_flags &= ~FDF_BOUNCE;
- bcopy((caddr_t)phystokv(fdc->sc_buf), fdc->sc_addr,
- fdc->sc_amt);
- }
- if ((fdc->sc_resid -= fdc->sc_amt) == 0) {
- bp->b_resid = 0;
- fddone(ui, bp);
- return;
- }
- fdc->sc_state = TRANSFER;
- fdc->sc_ioerr = 0;
- fdc->sc_addr += fdc->sc_amt;
- if (fdc->sc_op == CMD_FORMAT) {
- fdc->sc_sn = 0;
- if (fdc->sc_tn == 1) {
- fdc->sc_tn = 0;
- fdc->sc_cn++;
- fdc->sc_state = SEEK;
- } else
- fdc->sc_tn = 1;
- } else {
- fdc->sc_sn += fdc->sc_amt / SECSIZE;
- while (fdc->sc_sn >= dk->dk_nspt) {
- fdc->sc_sn -= dk->dk_nspt;
- if (fdc->sc_tn == 1) {
- fdc->sc_tn = 0;
- fdc->sc_cn++;
- fdc->sc_state = SEEK;
- } else
- fdc->sc_tn = 1;
- }
- }
- break;
-
- default:
- printf("fd%d: invalid state\n", ui->unit);
- panic("fdstate");
- /*NOTREACHED*/
- }
- bad:
- bp->b_flags |= B_ERROR;
- bp->b_error = EIO;
- sc->sc_flags |= FDF_RECAL;
- fddone(ui, bp);
-}
-
-/*
- * Terminate current request and start
- * any others that are queued.
- */
-int
-fddone(ui, bp)
- struct bus_device *ui;
- struct buf *bp;
-{
- struct bus_ctlr *um = ui->mi;
- struct fdsoftc *sc = &fdsoftc[ui->unit];
- struct fdcsoftc *fdc = &fdcsoftc[um->unit];
- struct buf *dp = &fdtab[um->unit];
-
- DEBUGF(1, printf("fd%d: fddone()\n", ui->unit));
-
- /*
- * Remove this request from queue.
- */
- if (bp) {
- fdutab[ui->unit].b_actf = bp->b_actf;
- biodone(bp);
- bp = &fdutab[ui->unit];
- dp->b_actf = bp->b_forw;
- } else
- bp = &fdutab[ui->unit];
-
- /*
- * Mark controller and drive idle.
- */
- dp->b_active = 0;
- bp->b_active = 0;
- fdc->sc_state = IDLE;
- sc->sc_mticks = 0;
- fdc->sc_flags &= ~(FDF_LIMIT|FDF_BOUNCE);
-
- /*
- * Start up other requests.
- */
- fdustart(ui);
- fdstart(um);
-
- /*
- * Wakeup anyone waiting for drive or controller.
- */
- if (sc->sc_flags & FDF_WANT) {
- sc->sc_flags &= ~FDF_WANT;
- wakeup((void *)sc);
- }
- if (fdc->sc_flags & FDF_WANT) {
- fdc->sc_flags &= ~FDF_WANT;
- wakeup((void *)fdc);
- }
-}
-
-/*
- * Check if diskette change has occured since the last open.
- */
-int
-fddskchg(ui)
- struct bus_device *ui;
-{
- int s, dir;
- struct fdsoftc *sc = &fdsoftc[ui->unit];
- struct bus_ctlr *um = ui->mi;
- struct fdcsoftc *fdc = &fdcsoftc[um->unit];
-
- /*
- * Get access to controller.
- */
- s = splbio();
- while (fdtab[um->unit].b_active) {
- fdc->sc_flags |= FDF_WANT;
- assert_wait((event_t)fdc, FALSE);
- thread_block((void (*)())0);
- }
- fdtab[um->unit].b_active = 1;
- fdutab[ui->unit].b_active = 1;
-
- /*
- * Turn on drive motor and read digital input register.
- */
- if (fdmotoron(ui)) {
- timeout(wakeup, (void *)fdc, hz / 2);
- assert_wait((event_t)fdc, FALSE);
- thread_block((void (*)())0);
- }
- dir = inb(FD_DIR(um->address));
- fddone(ui, NULL);
- splx(s);
-
- if (dir & DIR_DSKCHG) {
- printf("fd%d: diskette change detected\n", ui->unit);
- sc->sc_flags |= FDF_SEEK;
- return (1);
- }
- return (0);
-}
-
-/*
- * Do media detection.
- */
-int
-fdauto(dev)
- dev_t dev;
-{
- int i, error = 0;
- struct buf *bp;
- struct bus_device *ui = fddinfo[fdunit(dev)];
- struct fdsoftc *sc = &fdsoftc[ui->unit];
- struct fddk *dk, *def = 0;
-
- sc->sc_flags |= FDF_AUTO;
- bp = (struct buf *)geteblk(SECSIZE);
- for (i = 0, dk = fddk; i < NDKTYPES; i++, dk++) {
- if ((dk->dk_drives & (1 << sc->sc_type)) == 0)
- continue;
- if (def == 0)
- def = dk;
- sc->sc_dk = dk;
- bp->b_flags = B_READ;
- bp->b_dev = dev;
- bp->b_bcount = SECSIZE;
- if (sc->sc_flags & FDF_SEEK) {
- sc->sc_flags &= ~FDF_SEEK;
- bp->b_blkno = 100;
- } else
- bp->b_blkno = 0;
- fdstrategy(bp);
- biowait(bp);
- if ((bp->b_flags & B_ERROR) == 0 || bp->b_error == ENXIO)
- break;
- }
- if (i == NDKTYPES) {
- printf("fd%d: couldn't detect type, using %s\n",
- ui->unit, def->dk_name);
- sc->sc_dk = def;
- } else if ((bp->b_flags & B_ERROR) == 0)
- printf("fd%d: detected %s\n", ui->unit, sc->sc_dk->dk_name);
- else
- error = ENXIO;
- sc->sc_flags &= ~FDF_AUTO;
- brelse(bp);
- return (error);
-}
-
-/*
- * Turn on drive motor and select drive.
- */
-int
-fdmotoron(ui)
- struct bus_device *ui;
-{
- int bit;
- struct bus_ctlr *um = ui->mi;
- struct fdcsoftc *fdc = &fdcsoftc[um->unit];
-
- bit = 1 << (ui->slave + 4);
- if ((fdc->sc_dor & bit) == 0) {
- fdc->sc_dor &= ~3;
- fdc->sc_dor |= bit | ui->slave;
- outb(FD_DOR(um->address), fdc->sc_dor);
- return (1);
- }
- if ((fdc->sc_dor & 3) != ui->slave) {
- fdc->sc_dor &= ~3;
- fdc->sc_dor |= ui->slave;
- outb(FD_DOR(um->address), fdc->sc_dor);
- }
- return (0);
-}
-
-/*
- * Turn off drive motor.
- */
-int
-fdmotoroff(ui)
- struct bus_device *ui;
-{
- struct bus_ctlr *um = ui->mi;
- struct fdcsoftc *fdc = &fdcsoftc[um->unit];
-
- fdc->sc_dor &= ~(1 << (ui->slave + 4));
- outb(FD_DOR(um->address), fdc->sc_dor);
-}
-
-/*
- * This routine is invoked via timeout() by fdstart()
- * to call fdstate() at splbio.
- */
-void
-fdspinup(um)
- struct bus_ctlr *um;
-{
- int s;
-
- s = splbio();
- fdstate(um);
- splx(s);
-}
-
-/*
- * Watchdog routine.
- * Check for hung operations.
- * Turn off motor of idle drives.
- */
-void
-fdwatch()
-{
- int unit, s;
- struct bus_device *ui;
-
- timeout(fdwatch, 0, hz);
- s = splbio();
- for (unit = 0; unit < NFDC; unit++)
- if (fdtab[unit].b_active
- && ++fdcsoftc[unit].sc_wticks == OP_TIMEOUT)
- fdintr(unit);
- for (unit = 0; unit < NFD; unit++) {
- if ((ui = fddinfo[unit]) == 0 || ui->alive == 0)
- continue;
- if (fdutab[unit].b_active == 0
- && (fdcsoftc[ui->mi->unit].sc_dor & (1 << (ui->slave + 4)))
- && ++fdsoftc[unit].sc_mticks == MOTOR_TIMEOUT)
- fdmotoroff(ui);
- }
- splx(s);
-}
-
-/*
- * Print an error message.
- */
-int
-fderror(msg, ui)
- char *msg;
- struct bus_device *ui;
-{
- struct fdcsoftc *fdc = &fdcsoftc[ui->mi->unit];
-
- printf("fd%d: %s, %sing cn %d tn %d sn %d\n", ui->unit, msg,
- (fdc->sc_op == CMD_READ ? "read"
- : (fdc->sc_op == CMD_WRITE ? "writ" : "formatt")),
- fdc->sc_cn, fdc->sc_tn, fdc->sc_sn + 1);
-}
-
-/*
- * Return an error message for an I/O error.
- */
-char *
-fderrmsg(ui)
- struct bus_device *ui;
-{
- struct fdcsoftc *fdc = &fdcsoftc[ui->mi->unit];
-
- if (fdc->sc_st1 & ST1_EC)
- return ("invalid sector");
- if (fdc->sc_st1 & ST1_DE)
- return ("CRC error");
- if (fdc->sc_st1 & ST1_OR)
- return ("DMA overrun");
- if (fdc->sc_st1 & ST1_ND)
- return ("sector not found");
- if (fdc->sc_st1 & ST1_NW)
- return ("write-protected diskette");
- if (fdc->sc_st1 & ST1_MA)
- return ("missing address mark");
- return ("hard error");
-}
-
-/*
- * Output a command to FDC.
- */
-int
-fdcmd(um, n)
- struct bus_ctlr *um;
- int n;
-{
- int i, j;
- struct fdcsoftc *fdc = &fdcsoftc[um->unit];
-
- for (i = j = 0; i < 200; i++) {
- if ((inb(FD_STATUS(um->address)) & (ST_RQM|ST_DIO)) != ST_RQM)
- continue;
- outb(FD_DATA(um->address), fdc->sc_cmd[j++]);
- if (--n == 0)
- return (1);
- }
- /*
- * Controller is not responding, reset it.
- */
- DEBUGF(1, printf("fdc%d: fdcmd() failed\n", um->unit));
- fdreset(um);
- return (0);
-}
-
-/*
- * Read results from FDC.
- */
-int
-fdresults(um, rp)
- struct bus_ctlr *um;
- u_char *rp;
-{
- int i, j, status;
-
- for (i = j = 0; i < 200; i++) {
- status = inb(FD_STATUS(um->address));
- if ((status & ST_RQM) == 0)
- continue;
- if ((status & ST_DIO) == 0)
- return (j);
- if (j == 7)
- break;
- *rp++ = inb(FD_DATA(um->address));
- j++;
- }
- /*
- * Controller is not responding, reset it.
- */
- DEBUGF(1, printf("fdc%d: fdresults() failed\n", um->unit));
- fdreset(um);
- return (0);
-}
-
-/*
- * Reset controller.
- */
-int
-fdreset(um)
- struct bus_ctlr *um;
-{
- struct fdcsoftc *fdc = &fdcsoftc[um->unit];
-
- outb(FD_DOR(um->address), fdc->sc_dor & ~(DOR_RSTCLR|DOR_IENABLE));
- fdc->sc_state = RESETDONE;
- fdc->sc_flags |= FDF_RESET;
- outb(FD_DOR(um->address), fdc->sc_dor);
-}
-
-#endif /* NFD > 0 */