diff options
Diffstat (limited to 'sys/pc98/cbus/fdc.c')
-rw-r--r-- | sys/pc98/cbus/fdc.c | 2489 |
1 files changed, 2489 insertions, 0 deletions
diff --git a/sys/pc98/cbus/fdc.c b/sys/pc98/cbus/fdc.c new file mode 100644 index 000000000000..55a83544b912 --- /dev/null +++ b/sys/pc98/cbus/fdc.c @@ -0,0 +1,2489 @@ +/* + * Copyright (c) 1990 The Regents of the University of California. + * All rights reserved. + * + * This code is derived from software contributed to Berkeley by + * Don Ahn. + * + * Copyright (c) 1993, 1994 by + * jc@irbs.UUCP (John Capo) + * vak@zebub.msk.su (Serge Vakulenko) + * ache@astral.msk.su (Andrew A. Chernov) + * + * Copyright (c) 1993, 1994, 1995 by + * joerg_wunsch@uriah.sax.de (Joerg Wunsch) + * dufault@hda.com (Peter Dufault) + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. All advertising materials mentioning features or use of this software + * must display the following acknowledgement: + * This product includes software developed by the University of + * California, Berkeley and its contributors. + * 4. Neither the name of the University nor the names of its contributors + * may be used to endorse or promote products derived from this software + * without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + * + * from: @(#)fd.c 7.4 (Berkeley) 5/25/91 + * $Id: fd.c,v 1.89 1996/05/03 20:15:11 phk Exp $ + * + */ + +#include "ft.h" +#if NFT < 1 +#undef NFDC +#endif +#include "fd.h" + +#if NFDC > 0 + +#include <sys/param.h> +#include <sys/systm.h> +#include <sys/kernel.h> +#include <sys/conf.h> +#include <sys/file.h> +#include <sys/ioctl.h> +#include <machine/clock.h> +#include <machine/ioctl_fd.h> +#include <sys/disklabel.h> +#include <sys/diskslice.h> +#include <sys/buf.h> +#include <sys/uio.h> +#include <sys/malloc.h> +#include <sys/proc.h> +#include <sys/syslog.h> +#include <sys/devconf.h> +#include <sys/dkstat.h> +#ifdef PC98 +#include <pc98/pc98/pc98.h> +#include <pc98/pc98/pc98_device.h> +#include <pc98/pc98/fdreg.h> +#include <pc98/pc98/fdc.h> +#else +#include <i386/isa/isa.h> +#include <i386/isa/isa_device.h> +#include <i386/isa/fdreg.h> +#include <i386/isa/fdc.h> +#include <i386/isa/rtc.h> +#endif +#include <machine/stdarg.h> +#if NFT > 0 +#include <sys/ftape.h> +#ifdef PC98 +#include <pc98/pc98/ftreg.h> +#else +#include <i386/isa/ftreg.h> +#endif +#endif +#ifdef DEVFS +#include <sys/devfsext.h> +#endif + + +static int fd_goaway(struct kern_devconf *, int); +static int fdc_goaway(struct kern_devconf *, int); +static int fd_externalize(struct kern_devconf *, struct sysctl_req *); + +/* + * Templates for the kern_devconf structures used when we attach. + */ +static struct kern_devconf kdc_fd[NFD] = { { + 0, 0, 0, /* filled in by kern_devconf.c */ + "fd", 0, { MDDT_DISK, 0 }, + fd_externalize, 0, fd_goaway, DISK_EXTERNALLEN, + 0, /* parent */ + 0, /* parentdata */ + DC_UNCONFIGURED, /* state */ + "floppy disk", + DC_CLS_DISK /* class */ +} }; + +struct kern_devconf kdc_fdc[NFDC] = { { + 0, 0, 0, /* filled in by kern_devconf.c */ +#ifdef PC98 + "fdc", 0, { MDDT_PC98, 0, "bio" }, + pc98_generic_externalize, 0, fdc_goaway, PC98_EXTERNALLEN, +#else + "fdc", 0, { MDDT_ISA, 0, "bio" }, + isa_generic_externalize, 0, fdc_goaway, ISA_EXTERNALLEN, +#endif + 0, /* parent */ + 0, /* parentdata */ + DC_UNCONFIGURED, /* state */ + "floppy disk/tape controller", + DC_CLS_MISC /* class */ +} }; + +static inline void +fd_registerdev(int ctlr, int unit) +{ + if(unit != 0) + kdc_fd[unit] = kdc_fd[0]; + + kdc_fd[unit].kdc_unit = unit; + kdc_fd[unit].kdc_parent = &kdc_fdc[ctlr]; + kdc_fd[unit].kdc_parentdata = 0; + dev_attach(&kdc_fd[unit]); +} + +static inline void +#ifdef PC98 +fdc_registerdev(struct pc98_device *dvp) +#else +fdc_registerdev(struct isa_device *dvp) +#endif +{ + int unit = dvp->id_unit; + + if(unit != 0) + kdc_fdc[unit] = kdc_fdc[0]; + + kdc_fdc[unit].kdc_unit = unit; +#ifdef PC98 + kdc_fdc[unit].kdc_parent = &kdc_nec0; +#else + kdc_fdc[unit].kdc_parent = &kdc_isa0; +#endif + kdc_fdc[unit].kdc_parentdata = dvp; + dev_attach(&kdc_fdc[unit]); +} + +static int +fdc_goaway(struct kern_devconf *kdc, int force) +{ + if(force) { + dev_detach(kdc); + return 0; + } else { + return EBUSY; /* XXX fix */ + } +} + +static int +fd_goaway(struct kern_devconf *kdc, int force) +{ + dev_detach(kdc); + return 0; +} + +#define b_cylin b_resid /* XXX now spelled b_cylinder elsewhere */ + +/* misuse a flag to identify format operation */ +#define B_FORMAT B_XXX + +/* + * this biotab field doubles as a field for the physical unit number + * on the controller + */ +#define id_physid id_scsiid + +/* error returns for fd_cmd() */ +#define FD_FAILED -1 +#define FD_NOT_VALID -2 +#define FDC_ERRMAX 100 /* do not log more */ + +#ifdef PC98 +#define NUMTYPES 5 +#define NUMDENS NUMTYPES +#else +#define NUMTYPES 14 +#define NUMDENS (NUMTYPES - 6) +#endif + +/* These defines (-1) must match index for fd_types */ +#define F_TAPE_TYPE 0x020 /* bit for fd_types to indicate tape */ +#define NO_TYPE 0 /* must match NO_TYPE in ft.c */ +#ifdef PC98 +#define FDT_NONE 0 /* none present */ +#define FDT_12M 1 /* 1M/640K FDD */ +#define FDT_144M 2 /* 1.44M/1M/640K FDD */ + +#define FD_1200 1 +#define FD_1232 2 +#define FD_720 3 +#define FD_640 4 +#define FD_1440 5 +#else +#define FD_1720 1 +#define FD_1480 2 +#define FD_1440 3 +#define FD_1200 4 +#define FD_820 5 +#define FD_800 6 +#define FD_720 7 +#define FD_360 8 + +#define FD_1480in5_25 9 +#define FD_1440in5_25 10 +#define FD_820in5_25 11 +#define FD_800in5_25 12 +#define FD_720in5_25 13 +#define FD_360in5_25 14 +#endif + + +static struct fd_type fd_types[NUMTYPES] = +{ +#ifdef PC98 +{ 15,2,0xFF,0x1B,80,2400,1,0,2,0x54,1 }, /* 1.2 meg HD floppy */ +{ 8,3,0xFF,0x35,77,1232,1,0,2,0x74,1 }, /* 1.2 meg HD floppy 1024/sec */ +{ 9,2,0xFF,0x20,80,1440,1,1,2,0x50,1 }, /* 720k floppy in 1.2meg drive */ +{ 8,2,0xFF,0x2A,80,1280,1,1,2,0x50,1 }, /* 640k floppy in 1.2meg drive */ +{ 18,2,0xFF,0x1B,80,2880,1,2,2,0x54,1 }, /* 1.44 meg HD 3.5in floppy */ +#else +{ 21,2,0xFF,0x04,82,3444,1,FDC_500KBPS,2,0x0C,2 }, /* 1.72M in HD 3.5in */ +{ 18,2,0xFF,0x1B,82,2952,1,FDC_500KBPS,2,0x6C,1 }, /* 1.48M in HD 3.5in */ +{ 18,2,0xFF,0x1B,80,2880,1,FDC_500KBPS,2,0x6C,1 }, /* 1.44M in HD 3.5in */ +{ 15,2,0xFF,0x1B,80,2400,1,FDC_500KBPS,2,0x54,1 }, /* 1.2M in HD 5.25/3.5 */ +{ 10,2,0xFF,0x10,82,1640,1,FDC_250KBPS,2,0x2E,1 }, /* 820K in HD 3.5in */ +{ 10,2,0xFF,0x10,80,1600,1,FDC_250KBPS,2,0x2E,1 }, /* 800K in HD 3.5in */ +{ 9,2,0xFF,0x20,80,1440,1,FDC_250KBPS,2,0x50,1 }, /* 720K in HD 3.5in */ +{ 9,2,0xFF,0x2A,40, 720,1,FDC_250KBPS,2,0x50,1 }, /* 360K in DD 5.25in */ + +{ 18,2,0xFF,0x02,82,2952,1,FDC_500KBPS,2,0x02,2 }, /* 1.48M in HD 5.25in */ +{ 18,2,0xFF,0x02,80,2880,1,FDC_500KBPS,2,0x02,2 }, /* 1.44M in HD 5.25in */ +{ 10,2,0xFF,0x10,82,1640,1,FDC_300KBPS,2,0x2E,1 }, /* 820K in HD 5.25in */ +{ 10,2,0xFF,0x10,80,1600,1,FDC_300KBPS,2,0x2E,1 }, /* 800K in HD 5.25in */ +{ 9,2,0xFF,0x20,80,1440,1,FDC_300KBPS,2,0x50,1 }, /* 720K in HD 5.25in */ +{ 9,2,0xFF,0x23,40, 720,2,FDC_300KBPS,2,0x50,1 }, /* 360K in HD 5.25in */ +#endif +}; + +#ifdef PC98 +#define DRVS_PER_CTLR 4 /* 4 floppies */ +#else +#define DRVS_PER_CTLR 2 /* 2 floppies */ +#endif + +/***********************************************************************\ +* Per controller structure. * +\***********************************************************************/ +struct fdc_data fdc_data[NFDC]; + +/***********************************************************************\ +* Per drive structure. * +* N per controller (DRVS_PER_CTLR) * +\***********************************************************************/ +static struct fd_data { + struct fdc_data *fdc; /* pointer to controller structure */ + int fdsu; /* this units number on this controller */ + int type; /* Drive type (FD_1440...) */ + struct fd_type *ft; /* pointer to the type descriptor */ + int flags; +#define FD_OPEN 0x01 /* it's open */ +#define FD_ACTIVE 0x02 /* it's active */ +#define FD_MOTOR 0x04 /* motor should be on */ +#define FD_MOTOR_WAIT 0x08 /* motor coming up */ + int skip; + int hddrv; +#define FD_NO_TRACK -2 + int track; /* where we think the head is */ + int options; /* user configurable options, see ioctl_fd.h */ + int dkunit; /* disk stats unit number */ +#ifdef DEVFS + void *bdevs[1 + NUMDENS + MAXPARTITIONS]; + void *cdevs[1 + NUMDENS + MAXPARTITIONS]; +#endif +#ifdef PC98 + int pc98_trans; +#endif +} fd_data[NFD]; + +#ifdef EPSON_NRDISK +typedef unsigned int nrd_t; + +#define P_NRD_ADDRH 0xc24 +#define P_NRD_ADDRM 0xc22 +#define P_NRD_ADDRL 0xc20 +#define P_NRD_CHECK 0xc20 +#define P_NRD_DATA 0xc26 +#define P_NRD_LED 0xc36 +#define B_NRD_CHK 0x80 +#define B_NRD_LED 0x40 +#define A_NRD_INFO 0x2 +#define A_NRD_BASE 0x400 +#define NRD_STATUS 0x0 +#define NRD_ST0_HD 0x04 + +static fdu_t nrdu=-1; +static int nrdsec=0; +static nrd_t nrdblkn=0; +static nrd_t nrdaddr=0x0; + +#define nrd_check_ready() ({ \ + (epson_inb(P_NRD_CHECK) & B_NRD_CHK) ? 0 : 1; \ + }) +#define nrd_LED_on() epson_outb(P_NRD_LED, B_NRD_LED) +#define nrd_LED_off() epson_outb(P_NRD_LED, ~B_NRD_LED) +#define nrd_trac() ((int)(nrd_info(nrdaddr) & 0xff)) +#define nrd_head() ((int)((nrd_info(nrdaddr) >> 8) & 0xff)) +#define nrd_sec() ((int)(nrd_info(nrdaddr + 2) & 0xff)) +#define nrd_secsize() ((int)((nrd_info(A_NRD_INFO) >> 8) & 0xff)) +#define nrd_addrset(p) nrd_addr((nrd_t)((nrd_t)p+A_NRD_BASE)) + +static inline void +nrd_addr(addr) + nrd_t addr; +{ + epson_outb(P_NRD_ADDRH, (u_char)((addr >> 16) & 0x1f)); + epson_outb(P_NRD_ADDRM, (u_char)((addr >> 8) & 0xff)); + epson_outb(P_NRD_ADDRL, (u_char)(addr & 0xff)); +} + +static inline u_short +nrd_info(addr) + nrd_t addr; +{ + u_short tmp; + + nrd_addr(addr); + outb(0x43f, 0x42); + tmp = (short)inw(P_NRD_DATA); + outb(0x43f, 0x40); + return ((u_short)tmp); +} +#endif /* EPSON_NRDISK */ + +/***********************************************************************\ +* Throughout this file the following conventions will be used: * +* fd is a pointer to the fd_data struct for the drive in question * +* fdc is a pointer to the fdc_data struct for the controller * +* fdu is the floppy drive unit number * +* fdcu is the floppy controller unit number * +* fdsu is the floppy drive unit number on that controller. (sub-unit) * +\***********************************************************************/ + +#if NFT > 0 +int ftopen(dev_t, int); +int ftintr(ftu_t ftu); +int ftclose(dev_t, int); +void ftstrategy(struct buf *); +int ftioctl(dev_t, int, caddr_t, int, struct proc *); +int ftdump(dev_t); +int ftsize(dev_t); +#ifdef PC98 +int ftattach(struct pc98_device *, struct pc98_device *, int); +#else +int ftattach(struct isa_device *, struct isa_device *, int); +#endif +#endif + +/* autoconfig functions */ +#ifdef PC98 +static int fdprobe(struct pc98_device *); +static int fdattach(struct pc98_device *); +#else +static int fdprobe(struct isa_device *); +static int fdattach(struct isa_device *); +#endif + +/* needed for ft driver, thus exported */ +int in_fdc(fdcu_t); +int out_fdc(fdcu_t, int); + +/* internal functions */ +static void set_motor(fdcu_t, int, int); +# define TURNON 1 +# define TURNOFF 0 +static timeout_t fd_turnoff; +static timeout_t fd_motor_on; +static void fd_turnon(fdu_t); +static void fdc_reset(fdc_p); +static int fd_in(fdcu_t, int *); +static void fdstart(fdcu_t); +static timeout_t fd_timeout; +static timeout_t fd_pseudointr; +static int fdstate(fdcu_t, fdc_p); +static int retrier(fdcu_t); +static int fdformat(dev_t, struct fd_formb *, struct proc *); + + +#define DEVIDLE 0 +#define FINDWORK 1 +#define DOSEEK 2 +#define SEEKCOMPLETE 3 +#define IOCOMPLETE 4 +#define RECALCOMPLETE 5 +#define STARTRECAL 6 +#define RESETCTLR 7 +#define SEEKWAIT 8 +#define RECALWAIT 9 +#define MOTORWAIT 10 +#define IOTIMEDOUT 11 + +#ifdef DEBUG +char *fdstates[] = +{ +"DEVIDLE", +"FINDWORK", +"DOSEEK", +"SEEKCOMPLETE", +"IOCOMPLETE", +"RECALCOMPLETE", +"STARTRECAL", +"RESETCTLR", +"SEEKWAIT", +"RECALWAIT", +"MOTORWAIT", +"IOTIMEDOUT" +}; + +/* CAUTION: fd_debug causes huge amounts of logging output */ +int fd_debug = 0; +#define TRACE0(arg) if(fd_debug) printf(arg) +#define TRACE1(arg1, arg2) if(fd_debug) printf(arg1, arg2) +#else /* DEBUG */ +#define TRACE0(arg) +#define TRACE1(arg1, arg2) +#endif /* DEBUG */ + +/* autoconfig structure */ +#ifdef PC98 +struct pc98_driver fdcdriver = { +#else +struct isa_driver fdcdriver = { +#endif + fdprobe, fdattach, "fdc", +}; + +static d_open_t Fdopen; /* NOTE, not fdopen */ +static d_close_t fdclose; +static d_ioctl_t fdioctl; +static d_strategy_t fdstrategy; + +#define CDEV_MAJOR 9 +#define BDEV_MAJOR 2 +extern struct cdevsw fd_cdevsw; +static struct bdevsw fd_bdevsw = + { Fdopen, fdclose, fdstrategy, fdioctl, /*2*/ + nodump, nopsize, 0, "fd", &fd_cdevsw, -1 }; + +static struct cdevsw fd_cdevsw = + { Fdopen, fdclose, rawread, rawwrite, /*9*/ + fdioctl, nostop, nullreset, nodevtotty, + seltrue, nommap, fdstrategy, "fd", + &fd_bdevsw, -1 }; + +#ifdef PC98 +static struct pc98_device *fdcdevs[NFDC]; +#else +static struct isa_device *fdcdevs[NFDC]; +#endif + +/* + * Provide hw.devconf information. + */ +static int +fd_externalize(struct kern_devconf *kdc, struct sysctl_req *req) +{ + return disk_externalize(fd_data[kdc->kdc_unit].fdsu, req); +} + +static int +fdc_err(fdcu_t fdcu, const char *s) +{ + fdc_data[fdcu].fdc_errs++; + if(s) { + if(fdc_data[fdcu].fdc_errs < FDC_ERRMAX) + printf("fdc%d: %s", fdcu, s); + else if(fdc_data[fdcu].fdc_errs == FDC_ERRMAX) + printf("fdc%d: too many errors, not logging any more\n", + fdcu); + } + + return FD_FAILED; +} + +/* + * fd_cmd: Send a command to the chip. Takes a varargs with this structure: + * Unit number, + * # of output bytes, output bytes as ints ..., + * # of input bytes, input bytes as ints ... + */ + +static int +fd_cmd(fdcu_t fdcu, int n_out, ...) +{ + u_char cmd; + int n_in; + int n; + va_list ap; + + va_start(ap, n_out); + cmd = (u_char)(va_arg(ap, int)); + va_end(ap); + va_start(ap, n_out); + for (n = 0; n < n_out; n++) + { + if (out_fdc(fdcu, va_arg(ap, int)) < 0) + { + char msg[50]; + sprintf(msg, + "cmd %x failed at out byte %d of %d\n", + cmd, n + 1, n_out); + return fdc_err(fdcu, msg); + } + } + n_in = va_arg(ap, int); + for (n = 0; n < n_in; n++) + { + int *ptr = va_arg(ap, int *); + if (fd_in(fdcu, ptr) < 0) + { + char msg[50]; + sprintf(msg, + "cmd %02x failed at in byte %d of %d\n", + cmd, n + 1, n_in); + return fdc_err(fdcu, msg); + } + } + + return 0; +} + +static int +fd_sense_drive_status(fdc_p fdc, int *st3p) +{ + int st3; + + if (fd_cmd(fdc->fdcu, 2, NE7CMD_SENSED, fdc->fdu, 1, &st3)) + { + return fdc_err(fdc->fdcu, "Sense Drive Status failed\n"); + } + if (st3p) + *st3p = st3; + + return 0; +} + +static int +fd_sense_int(fdc_p fdc, int *st0p, int *cylp) +{ + int st0, cyl; + +#ifdef EPSON_NRDISK + if (fdc->fdu == nrdu) { + if (fdc->fd->track >= 0) nrdaddr = (fdc->fd->track + 1) * 8; + else nrdaddr = 0x0; + *st0p = nrd_head() ? NRD_ST0_HD : NRD_STATUS; + *cylp = nrd_trac(); + } + else { +#endif /* EPSON_NRDISK */ + int ret = fd_cmd(fdc->fdcu, 1, NE7CMD_SENSEI, 1, &st0); + + if (ret) + { + (void)fdc_err(fdc->fdcu, + "sense intr err reading stat reg 0\n"); + return ret; + } + + if (st0p) + *st0p = st0; + + if ((st0 & NE7_ST0_IC) == NE7_ST0_IC_IV) + { + /* + * There doesn't seem to have been an interrupt. + */ + return FD_NOT_VALID; + } + + if (fd_in(fdc->fdcu, &cyl) < 0) + { + return fdc_err(fdc->fdcu, "can't get cyl num\n"); + } + + if (cylp) + *cylp = cyl; + +#ifdef EPSON_NRDISK + } +#endif /* EPSON_NRDISK */ + return 0; +} + + +static int +fd_read_status(fdc_p fdc, int fdsu) +{ + int i, ret; + + for (i = 0; i < 7; i++) + { + /* + * XXX types are poorly chosen. Only bytes can by read + * from the hardware, but fdc_status wants u_longs and + * fd_in() gives ints. + */ + int status; + +#ifdef EPSON_NRDISK + if (fdc->fdu == nrdu) { + switch (i) { + case 0: fdc->status[i] = nrd_head() + ? NRD_ST0_HD : NRD_STATUS; break; + case 1: fdc->status[i] = NRD_STATUS; break; + case 2: fdc->status[i] = NRD_STATUS; break; + case 3: fdc->status[i] = nrd_trac(); break; + case 4: fdc->status[i] = nrd_head(); break; + case 5: fdc->status[i] = nrdsec; break; + case 6: fdc->status[i] = nrd_secsize(); break; + } + ret = 0; + } + else { +#endif /* EPSON_NRDISK */ + ret = fd_in(fdc->fdcu, &status); + fdc->status[i] = status; + if (ret != 0) + break; +#ifdef EPSON_NRDISK + } +#endif /* EPSON_NRDISK */ + } + + if (ret == 0) + fdc->flags |= FDC_STAT_VALID; + else + fdc->flags &= ~FDC_STAT_VALID; + + return ret; +} + +/****************************************************************************/ +/* autoconfiguration stuff */ +/****************************************************************************/ +#ifdef PC98 +static int pc98_trans = 0; /* 0 : HD , 1 : DD , 2 : 1.44 */ +static int pc98_trans_prev = 0; + +static void set_density(fdcu_t, fdu_t); +static int pc98_fd_check_ready(fdu_t); + +static void set_density(fdcu, fdu) + fdcu_t fdcu; + fdu_t fdu; +{ + /* always motor on */ + outb(IO_FDPORT, + (pc98_trans != 1 ? FDP_FDDEXC : 0) | FDP_PORTEXC); + DELAY(100); + outb(fdc_data[fdcu].baseport + FDOUT, FDO_RST | FDO_DMAE); + /* in the case of note W, always inhibit 100ms timer */ +} + +static int pc98_fd_check_ready(fdu) + fdu_t fdu; +{ + fd_p fd = fd_data + fdu; + fdcu_t fdcu = fd->fdc->fdcu; + int retry = 0; + +#ifdef EPSON_NRDISK + if (fdu == nrdu) { + if (nrd_check_ready()) return 0; + else return -1; + } +#endif + while (retry++ < 30000) { + set_motor(fdcu, fd->fdsu, TURNON); + out_fdc(fdcu, NE7CMD_SENSED); /* Sense Drive Status */ + DELAY(100); + out_fdc(fdcu, fdu); /* Drive number */ + DELAY(100); + if ((in_fdc(fdcu) & NE7_ST3_RD)){ + outb(fdc_data[fdcu].baseport + FDOUT, + FDO_DMAE | FDO_MTON); + DELAY(10); + return 0; + } + } + return -1; +} +#endif + + +/* + * probe for existance of controller + */ +static int +#ifdef PC98 +fdprobe(struct pc98_device *dev) +#else +fdprobe(struct isa_device *dev) +#endif +{ + fdcu_t fdcu = dev->id_unit; + if(fdc_data[fdcu].flags & FDC_ATTACHED) + { + printf("fdc%d: unit used multiple times\n", fdcu); + return 0; + } + + fdcdevs[fdcu] = dev; + fdc_data[fdcu].baseport = dev->id_iobase; + +#ifndef DEV_LKM + fdc_registerdev(dev); +#endif + +#ifndef PC98 + /* First - lets reset the floppy controller */ + outb(dev->id_iobase+FDOUT, 0); + DELAY(100); + outb(dev->id_iobase+FDOUT, FDO_FRST); +#endif + + /* see if it can handle a command */ +#ifdef PC98 + if (fd_cmd(fdcu, + 3, NE7CMD_SPECIFY, NE7_SPEC_1(4, 240), NE7_SPEC_2(2, 0), + 0)) +#else + if (fd_cmd(fdcu, + 3, NE7CMD_SPECIFY, NE7_SPEC_1(3, 240), NE7_SPEC_2(2, 0), + 0)) +#endif + { + return(0); + } + kdc_fdc[fdcu].kdc_state = DC_IDLE; + return (IO_FDCSIZE); +} + +/* + * wire controller into system, look for floppy units + */ +static int +#ifdef PC98 +fdattach(struct pc98_device *dev) +#else +fdattach(struct isa_device *dev) +#endif +{ + unsigned fdt; + fdu_t fdu; + fdcu_t fdcu = dev->id_unit; + fdc_p fdc = fdc_data + fdcu; + fd_p fd; + int fdsu, st0, st3, i, unithasfd; +#ifdef PC98 + struct pc98_device *fdup; +#else + struct isa_device *fdup; +#endif + int ic_type = 0; +#ifdef DEVFS + int mynor; + int typemynor; + int typesize; +#endif + + fdc->fdcu = fdcu; + fdc->flags |= FDC_ATTACHED; +#ifdef PC98 + fdc->dmachan = 2; + if (fdc->dmachan != dev->id_drq) { + dev->id_drq = fdc->dmachan; + printf(" [dma is changed to #%d]", fdc->dmachan); + } + /* Acquire the DMA channel forever, The driver will do the rest */ + pc98_dma_acquire(fdc->dmachan); + pc98_dmainit(fdc->dmachan, 128 << 3 /* XXX max secsize */); + fdc->state = DEVIDLE; + fdc_reset(fdc); +#else + fdc->dmachan = dev->id_drq; + /* Acquire the DMA channel forever, The driver will do the rest */ + isa_dma_acquire(fdc->dmachan); + isa_dmainit(fdc->dmachan, 128 << 3 /* XXX max secsize */); + fdc->state = DEVIDLE; + /* reset controller, turn motor off, clear fdout mirror reg */ + outb(fdc->baseport + FDOUT, ((fdc->fdout = 0))); +#endif + TAILQ_INIT(&fdc->head); + + /* check for each floppy drive */ +#ifdef PC98 + for (fdup = pc98_biotab_fdc; fdup->id_driver != 0; fdup++) { +#else + for (fdup = isa_biotab_fdc; fdup->id_driver != 0; fdup++) { +#endif + if (fdup->id_iobase != dev->id_iobase) + continue; + fdu = fdup->id_unit; + fd = &fd_data[fdu]; + if (fdu >= (NFD+NFT)) + continue; + fdsu = fdup->id_physid; + /* look up what bios thinks we have */ + switch (fdu) { +#ifdef PC98 + case 0: case 1: case 2: case 3: + if ((PC98_SYSTEM_PARAMETER(0x5ae) >> fdu) & 0x01) + fdt = FDT_144M; +#ifdef EPSON_NRDISK + else if ((PC98_SYSTEM_PARAMETER(0x55c) >> fdu) & 0x01) { + fdt = FDT_12M; + switch (epson_machine_id) { + case 0x20: case 0x27: + if ((PC98_SYSTEM_PARAMETER(0x488) >> fdu) & 0x01) { + if (nrd_check_ready()) { + nrd_LED_on(); + nrdu = fdu; + } + else fdt = FDT_NONE; + } + } + } +#else /* !EPSON_NRDISK */ + else if ((PC98_SYSTEM_PARAMETER(0x55c) >> fdu) & 0x01) { + fdt = FDT_12M; + switch (epson_machine_id) { + case 0x20: case 0x27: + if ((PC98_SYSTEM_PARAMETER(0x488) >> fdu) & 0x01) + fdt = FDT_NONE; + } + } +#endif /* EPSON_NRDISK */ + else fdt = FDT_NONE; + break; + default: + fdt = FDT_NONE; + break; +#else + case 0: fdt = (rtcin(RTC_FDISKETTE) & 0xf0); + break; + case 1: fdt = ((rtcin(RTC_FDISKETTE) << 4) & 0xf0); + break; + default: fdt = RTCFDT_NONE; + break; +#endif + } + /* is there a unit? */ +#ifdef PC98 + if ((fdt == FDT_NONE) +#else + if ((fdt == RTCFDT_NONE) +#endif +#if NFT > 0 + || (fdsu >= DRVS_PER_CTLR)) { +#else + ) { +#ifdef PC98 + fd->fdc = fdc; +#endif + fd->type = NO_TYPE; +#endif +#if NFT > 0 + /* If BIOS says no floppy, or > 2nd device */ + /* Probe for and attach a floppy tape. */ + /* Tell FT if there was already a disk */ + /* with this unit number found. */ + + unithasfd = 0; + if (fdu < NFD && fd->type != NO_TYPE) + unithasfd = 1; + if (ftattach(dev, fdup, unithasfd)) + continue; + if (fdsu < DRVS_PER_CTLR) + fd->type = NO_TYPE; +#endif + continue; + } + +#ifdef PC98 + kdc_fdc[fdcu].kdc_description = + "NEC 765 floppy disk/tape controller"; +#else + /* select it */ + set_motor(fdcu, fdsu, TURNON); + DELAY(1000000); /* 1 sec */ + + if (ic_type == 0 && + fd_cmd(fdcu, 1, NE7CMD_VERSION, 1, &ic_type) == 0) + { + printf("fdc%d: ", fdcu); + ic_type = (u_char)ic_type; + switch( ic_type ) { + case 0x80: + printf("NEC 765\n"); + fdc->fdct = FDC_NE765; + kdc_fdc[fdcu].kdc_description = + "NEC 765 floppy disk/tape controller"; + break; + case 0x81: + printf("Intel 82077\n"); + fdc->fdct = FDC_I82077; + kdc_fdc[fdcu].kdc_description = + "Intel 82077 floppy disk/tape controller"; + break; + case 0x90: + printf("NEC 72065B\n"); + fdc->fdct = FDC_NE72065; + kdc_fdc[fdcu].kdc_description = + "NEC 72065B floppy disk/tape controller"; + break; + default: + printf("unknown IC type %02x\n", ic_type); + fdc->fdct = FDC_UNKNOWN; + break; + } + } + if ((fd_cmd(fdcu, 2, NE7CMD_SENSED, fdsu, 1, &st3) == 0) && + (st3 & NE7_ST3_T0)) { + /* if at track 0, first seek inwards */ + /* seek some steps: */ + (void)fd_cmd(fdcu, 3, NE7CMD_SEEK, fdsu, 10, 0); + DELAY(300000); /* ...wait a moment... */ + (void)fd_sense_int(fdc, 0, 0); /* make ctrlr happy */ + } + + /* If we're at track 0 first seek inwards. */ + if ((fd_sense_drive_status(fdc, &st3) == 0) && + (st3 & NE7_ST3_T0)) { + /* Seek some steps... */ + if (fd_cmd(fdcu, 3, NE7CMD_SEEK, fdsu, 10, 0) == 0) { + /* ...wait a moment... */ + DELAY(300000); + /* make ctrlr happy: */ + (void)fd_sense_int(fdc, 0, 0); + } + } + + for(i = 0; i < 2; i++) { + /* + * we must recalibrate twice, just in case the + * heads have been beyond cylinder 76, since most + * FDCs still barf when attempting to recalibrate + * more than 77 steps + */ + /* go back to 0: */ + if (fd_cmd(fdcu, 2, NE7CMD_RECAL, fdsu, 0) == 0) { + /* a second being enough for full stroke seek*/ + DELAY(i == 0? 1000000: 300000); + + /* anything responding? */ + if (fd_sense_int(fdc, &st0, 0) == 0 && + (st0 & NE7_ST0_EC) == 0) + break; /* already probed succesfully */ + } + } + + set_motor(fdcu, fdsu, TURNOFF); + + if (st0 & NE7_ST0_EC) /* no track 0 -> no drive present */ + continue; +#endif + + fd->track = FD_NO_TRACK; + fd->fdc = fdc; + fd->fdsu = fdsu; + fd->options = 0; + printf("fd%d: ", fdu); + + fd_registerdev(fdcu, fdu); + switch (fdt) { +#ifdef PC98 + case FDT_12M: +#ifdef EPSON_NRDISK + if (fdu == nrdu) { + printf("EPSON RAM DRIVE\n"); + nrd_LED_off(); + } + else printf("1M/640M FDD\n"); +#else /* !EPSON_NRDISK */ + printf("1M/640K FDD\n"); +#endif /* EPSON_NRDISK */ + fd->type = FD_1200; + fd->pc98_trans = 0; + kdc_fd[fdu].kdc_description = + "1M/640K floppy disk drive"; +#ifdef DEVFS + sprintf(name,"rfd%d.1200",fdu); +#endif /* DEVFS */ + break; + case FDT_144M: + printf("1.44M FDD\n"); + fd->type = FD_1200; + fd->pc98_trans = 0; + outb(0x4be, (fdu << 5) | 0x10); + kdc_fd[fdu].kdc_description = + "1.44MB (1440K) 3.5in floppy disk drive"; +#ifdef DEVFS + sprintf(name,"rfd%d.1440",fdu); +#endif /* DEVFS */ + break; +#else + case RTCFDT_12M: + printf("1.2MB 5.25in\n"); + fd->type = FD_1200; + kdc_fd[fdu].kdc_description = + "1.2MB (1200K) 5.25in floppy disk drive"; + break; + case RTCFDT_144M: + printf("1.44MB 3.5in\n"); + fd->type = FD_1440; + kdc_fd[fdu].kdc_description = + "1.44MB (1440K) 3.5in floppy disk drive"; + break; + case RTCFDT_288M: + case RTCFDT_288M_1: + printf("2.88MB 3.5in - 1.44MB mode\n"); + fd->type = FD_1440; + kdc_fd[fdu].kdc_description = + "2.88MB (2880K) 3.5in floppy disk drive in 1.44 mode"; + break; + case RTCFDT_360K: + printf("360KB 5.25in\n"); + fd->type = FD_360; + kdc_fd[fdu].kdc_description = + "360KB 5.25in floppy disk drive"; + break; + case RTCFDT_720K: + printf("720KB 3.5in\n"); + fd->type = FD_720; + kdc_fd[fdu].kdc_description = + "720KB 3.5in floppy disk drive"; + break; +#endif + default: + printf("unknown\n"); + fd->type = NO_TYPE; + dev_detach(&kdc_fd[fdu]); + continue; + } + kdc_fd[fdu].kdc_state = DC_IDLE; +#ifdef DEVFS + mynor = fdu << 6; + fd->bdevs[0] = devfs_add_devswf(&fd_bdevsw, mynor, DV_BLK, + UID_ROOT, GID_OPERATOR, 0640, + "fd%d", fdu); + fd->cdevs[0] = devfs_add_devswf(&fd_cdevsw, mynor, DV_CHR, + UID_ROOT, GID_OPERATOR, 0640, + "rfd%d", fdu); + for (i = 1; i < 1 + NUMDENS; i++) { + /* + * XXX this and the lookup in Fdopen() should be + * data driven. + */ + switch (fd->type) { + case FD_360: + if (i != FD_360) + continue; + break; + case FD_720: + if (i != FD_720 && i != FD_800 && i != FD_820) + continue; + break; + case FD_1200: + if (i != FD_360 && i != FD_720 && i != FD_800 + && i != FD_820 && i != FD_1200 + && i != FD_1440 && i != FD_1480) + continue; + break; + case FD_1440: + if (i != FD_720 && i != FD_800 && i != FD_820 + && i != FD_1200 && i != FD_1440 + && i != FD_1480 && i != FD_1720) + continue; + break; + } + typemynor = mynor | i; + typesize = fd_types[i - 1].size / 2; + /* + * XXX all these conversions give bloated code and + * confusing names. + */ + if (typesize == 1476) + typesize = 1480; + if (typesize == 1722) + typesize = 1720; + fd->bdevs[i] = + devfs_add_devswf(&fd_bdevsw, typemynor, DV_BLK, + UID_ROOT, GID_OPERATOR, 0640, + "fd%d.%d", fdu, typesize); + fd->cdevs[i] = + devfs_add_devswf(&fd_cdevsw, typemynor, DV_CHR, + UID_ROOT, GID_OPERATOR, 0640, + "rfd%d.%d", fdu, typesize); + } + for (i = 0; i < MAXPARTITIONS; i++) { + fd->bdevs[1 + NUMDENS + i] = + devfs_link(fd->bdevs[0], + "fd%d%c", fdu, 'a' + i); + fd->cdevs[1 + NUMDENS + i] = + devfs_link(fd->cdevs[0], + "rfd%d%c", fdu, 'a' + i); + } +#endif /* DEVFS */ + if (dk_ndrive < DK_NDRIVE) { + sprintf(dk_names[dk_ndrive], "fd%d", fdu); + fd->dkunit = dk_ndrive++; + /* + * XXX assume rate is FDC_500KBPS. + */ + dk_wpms[dk_ndrive] = 500000 / 8 / 2; + } else { + fd->dkunit = -1; + } + } + + return (1); +} + +/****************************************************************************/ +/* motor control stuff */ +/* remember to not deselect the drive we're working on */ +/****************************************************************************/ +static void +set_motor(fdcu_t fdcu, int fdsu, int turnon) +{ + int fdout = fdc_data[fdcu].fdout; + int needspecify = 0; + +#ifdef PC98 + outb(IO_FDPORT, (pc98_trans != 1 ? FDP_FDDEXC : 0)|FDP_PORTEXC); + DELAY(10); + fdout = FDO_DMAE|FDO_MTON; +#else + if(turnon) { + fdout &= ~FDO_FDSEL; + fdout |= (FDO_MOEN0 << fdsu) + fdsu; + } else + fdout &= ~(FDO_MOEN0 << fdsu); + + if(!turnon + && (fdout & (FDO_MOEN0+FDO_MOEN1+FDO_MOEN2+FDO_MOEN3)) == 0) + /* gonna turn off the last drive, put FDC to bed */ + fdout &= ~ (FDO_FRST|FDO_FDMAEN); + else { + /* make sure controller is selected and specified */ + if((fdout & (FDO_FRST|FDO_FDMAEN)) == 0) + needspecify = 1; + fdout |= (FDO_FRST|FDO_FDMAEN); + } +#endif + + outb(fdc_data[fdcu].baseport+FDOUT, fdout); + DELAY(10); + fdc_data[fdcu].fdout = fdout; +#ifndef PC98 + kdc_fdc[fdcu].kdc_state = (fdout & FDO_FRST)? DC_BUSY: DC_IDLE; +#endif + TRACE1("[0x%x->FDOUT]", fdout); + + if(needspecify) { + /* + * XXX + * special case: since we have just woken up the FDC + * from its sleep, we silently assume the command will + * be accepted, and do not test for a timeout + */ +#ifdef PC98 + (void)fd_cmd(fdcu, 3, NE7CMD_SPECIFY, + NE7_SPEC_1(4, 240), NE7_SPEC_2(2, 0), + 0); +#else + (void)fd_cmd(fdcu, 3, NE7CMD_SPECIFY, + NE7_SPEC_1(3, 240), NE7_SPEC_2(2, 0), + 0); +#endif + } +} + +static void +fd_turnoff(void *arg1) +{ + fdu_t fdu = (fdu_t)arg1; + int s; + fd_p fd = fd_data + fdu; + + TRACE1("[fd%d: turnoff]", fdu); + + /* + * Don't turn off the motor yet if the drive is active. + * XXX shouldn't even schedule turnoff until drive is inactive + * and nothing is queued on it. + */ + if (fd->fdc->state != DEVIDLE && fd->fdc->fdu == fdu) { + timeout(fd_turnoff, arg1, 4 * hz); + return; + } + + s = splbio(); + fd->flags &= ~FD_MOTOR; + set_motor(fd->fdc->fdcu, fd->fdsu, TURNOFF); + splx(s); +} + +static void +fd_motor_on(void *arg1) +{ + fdu_t fdu = (fdu_t)arg1; + int s; + + fd_p fd = fd_data + fdu; + s = splbio(); + fd->flags &= ~FD_MOTOR_WAIT; + if((fd->fdc->fd == fd) && (fd->fdc->state == MOTORWAIT)) + { + fdintr(fd->fdc->fdcu); + } + splx(s); +} + +static void +fd_turnon(fdu_t fdu) +{ + fd_p fd = fd_data + fdu; + if(!(fd->flags & FD_MOTOR)) + { + fd->flags |= (FD_MOTOR + FD_MOTOR_WAIT); + set_motor(fd->fdc->fdcu, fd->fdsu, TURNON); + timeout(fd_motor_on, (caddr_t)fdu, hz); /* in 1 sec its ok */ + } +} + +static void +fdc_reset(fdc_p fdc) +{ + fdcu_t fdcu = fdc->fdcu; + + /* Try a reset, keep motor on */ +#ifdef PC98 + set_density(fdcu, 0); + if (pc98_machine_type & M_EPSON_PC98) + outb(fdc->baseport + FDOUT, 0xe8); + else + outb(fdc->baseport + FDOUT, 0xd8); + DELAY(200); + outb(fdc->baseport + FDOUT, 0x18); + DELAY(10); +#else + outb(fdc->baseport + FDOUT, fdc->fdout & ~(FDO_FRST|FDO_FDMAEN)); + TRACE1("[0x%x->FDOUT]", fdc->fdout & ~(FDO_FRST|FDO_FDMAEN)); + DELAY(100); + /* enable FDC, but defer interrupts a moment */ + outb(fdc->baseport + FDOUT, fdc->fdout & ~FDO_FDMAEN); + TRACE1("[0x%x->FDOUT]", fdc->fdout & ~FDO_FDMAEN); + DELAY(100); + outb(fdc->baseport + FDOUT, fdc->fdout); + TRACE1("[0x%x->FDOUT]", fdc->fdout); +#endif + + /* XXX after a reset, silently believe the FDC will accept commands */ +#ifdef PC98 + (void)fd_cmd(fdcu, 3, NE7CMD_SPECIFY, + NE7_SPEC_1(4, 240), NE7_SPEC_2(2, 0), + 0); +#else + (void)fd_cmd(fdcu, 3, NE7CMD_SPECIFY, + NE7_SPEC_1(3, 240), NE7_SPEC_2(2, 0), + 0); +#endif +} + +/****************************************************************************/ +/* fdc in/out */ +/****************************************************************************/ +int +in_fdc(fdcu_t fdcu) +{ + int baseport = fdc_data[fdcu].baseport; + int i, j = 1000000; + while ((i = inb(baseport+FDSTS) & (NE7_DIO|NE7_RQM)) + != (NE7_DIO|NE7_RQM) && j-- > 0) { + if (i == NE7_RQM) + return fdc_err(fdcu, "ready for output in input\n"); + } + if (j <= 0) + return fdc_err(fdcu, bootverbose? "input ready timeout\n": 0); +#ifdef DEBUG + i = inb(baseport+FDDATA); + TRACE1("[FDDATA->0x%x]", (unsigned char)i); + return(i); +#else + return inb(baseport+FDDATA); +#endif +} + +/* + * fd_in: Like in_fdc, but allows you to see if it worked. + */ +static int +fd_in(fdcu_t fdcu, int *ptr) +{ + int baseport = fdc_data[fdcu].baseport; + int i, j = 1000000; + while ((i = inb(baseport+FDSTS) & (NE7_DIO|NE7_RQM)) + != (NE7_DIO|NE7_RQM) && j-- > 0) { + DELAY(10); + if (i == NE7_RQM) + return fdc_err(fdcu, "ready for output in input\n"); + } + if (j <= 0) + return fdc_err(fdcu, bootverbose? "input ready timeout\n": 0); +#ifdef DEBUG + i = inb(baseport+FDDATA); + TRACE1("[FDDATA->0x%x]", (unsigned char)i); + *ptr = i; + return 0; +#else + i = inb(baseport+FDDATA); + if (ptr) + *ptr = i; + return 0; +#endif +} + +int +out_fdc(fdcu_t fdcu, int x) +{ + int baseport = fdc_data[fdcu].baseport; + int i; + + /* Check that the direction bit is set */ + i = 1000000; + while ((inb(baseport+FDSTS) & NE7_DIO) && i-- > 0) + DELAY(10); + if (i <= 0) return fdc_err(fdcu, "direction bit not set\n"); + + /* Check that the floppy controller is ready for a command */ + i = 1000000; + while ((inb(baseport+FDSTS) & NE7_RQM) == 0 && i-- > 0) + DELAY(10); + if (i <= 0) + return fdc_err(fdcu, bootverbose? "output ready timeout\n": 0); + + /* Send the command and return */ + outb(baseport+FDDATA, x); + DELAY(10); + TRACE1("[0x%x->FDDATA]", x); + return (0); +} + +/****************************************************************************/ +/* fdopen/fdclose */ +/****************************************************************************/ +int +Fdopen(dev_t dev, int flags, int mode, struct proc *p) +{ + fdu_t fdu = FDUNIT(minor(dev)); + int type = FDTYPE(minor(dev)); + fdc_p fdc; + +#if NFT > 0 + /* check for a tape open */ + if (type & F_TAPE_TYPE) + return(ftopen(dev, flags)); +#endif + /* check bounds */ + if (fdu >= NFD) + return(ENXIO); + fdc = fd_data[fdu].fdc; + if ((fdc == NULL) || (fd_data[fdu].type == NO_TYPE)) + return(ENXIO); + if (type > NUMDENS) + return(ENXIO); +#ifdef PC98 + if (pc98_fd_check_ready(fdu) == -1) + return(EIO); +#endif + if (type == 0) + type = fd_data[fdu].type; +#ifndef PC98 + else { + if (type != fd_data[fdu].type) { + switch (fd_data[fdu].type) { + case FD_360: + return(ENXIO); + case FD_720: + if ( type != FD_820 + && type != FD_800 + ) + return(ENXIO); + break; + case FD_1200: + switch (type) { + case FD_1480: + type = FD_1480in5_25; + break; + case FD_1440: + type = FD_1440in5_25; + break; + case FD_820: + type = FD_820in5_25; + break; + case FD_800: + type = FD_800in5_25; + break; + case FD_720: + type = FD_720in5_25; + break; + case FD_360: + type = FD_360in5_25; + break; + default: + return(ENXIO); + } + break; + case FD_1440: + if ( type != FD_1720 + && type != FD_1480 + && type != FD_1200 + && type != FD_820 + && type != FD_800 + && type != FD_720 + ) + return(ENXIO); + break; + } + } + } +#endif + fd_data[fdu].ft = fd_types + type - 1; + fd_data[fdu].flags |= FD_OPEN; + kdc_fd[fdu].kdc_state = DC_BUSY; + + return 0; +} + +int +fdclose(dev_t dev, int flags, int mode, struct proc *p) +{ + fdu_t fdu = FDUNIT(minor(dev)); + +#if NFT > 0 + int type = FDTYPE(minor(dev)); + + if (type & F_TAPE_TYPE) + return ftclose(dev, flags); +#endif + fd_data[fdu].flags &= ~FD_OPEN; + fd_data[fdu].options &= ~FDOPT_NORETRY; + kdc_fd[fdu].kdc_state = DC_IDLE; + + return(0); +} + + +/****************************************************************************/ +/* fdstrategy */ +/****************************************************************************/ +void +fdstrategy(struct buf *bp) +{ + long nblocks, blknum; + int s; + fdcu_t fdcu; + fdu_t fdu; + fdc_p fdc; + fd_p fd; + size_t fdblk; + + fdu = FDUNIT(minor(bp->b_dev)); + fd = &fd_data[fdu]; + fdc = fd->fdc; + fdcu = fdc->fdcu; + +#if NFT > 0 + if (FDTYPE(minor(bp->b_dev)) & F_TAPE_TYPE) { + /* ft tapes do not (yet) support strategy i/o */ + bp->b_error = ENODEV; + bp->b_flags |= B_ERROR; + goto bad; + } + /* check for controller already busy with tape */ + if (fdc->flags & FDC_TAPE_BUSY) { + bp->b_error = EBUSY; + bp->b_flags |= B_ERROR; + goto bad; + } +#endif + fdblk = 128 << (fd->ft->secsize); + if (!(bp->b_flags & B_FORMAT)) { + if ((fdu >= NFD) || (bp->b_blkno < 0)) { + printf( + "fd%d: fdstrat: bad request blkno = %lu, bcount = %ld\n", + fdu, (u_long)bp->b_blkno, bp->b_bcount); + bp->b_error = EINVAL; + bp->b_flags |= B_ERROR; + goto bad; + } + if ((bp->b_bcount % fdblk) != 0) { + bp->b_error = EINVAL; + bp->b_flags |= B_ERROR; + goto bad; + } + } + + /* + * Set up block calculations. + */ + blknum = (unsigned long) bp->b_blkno * DEV_BSIZE/fdblk; + nblocks = fd->ft->size; +#ifdef PC98 +#define B_XXX2 0x8000000 + if (bp->b_flags & B_XXX2) { + blknum *= 2; + bp->b_blkno *= 2; + bp->b_flags &= ~B_XXX2; + } +#endif + if (blknum + (bp->b_bcount / fdblk) > nblocks) { + if (blknum == nblocks) { + bp->b_resid = bp->b_bcount; + } else { + bp->b_error = ENOSPC; + bp->b_flags |= B_ERROR; + } + goto bad; + } + bp->b_cylin = blknum / (fd->ft->sectrac * fd->ft->heads); + bp->b_pblkno = bp->b_blkno; + s = splbio(); + tqdisksort(&fdc->head, bp); + untimeout(fd_turnoff, (caddr_t)fdu); /* a good idea */ + fdstart(fdcu); + splx(s); + return; + +bad: + biodone(bp); +} + +/***************************************************************\ +* fdstart * +* We have just queued something.. if the controller is not busy * +* then simulate the case where it has just finished a command * +* So that it (the interrupt routine) looks on the queue for more* +* work to do and picks up what we just added. * +* If the controller is already busy, we need do nothing, as it * +* will pick up our work when the present work completes * +\***************************************************************/ +static void +fdstart(fdcu_t fdcu) +{ + int s; + + s = splbio(); + if(fdc_data[fdcu].state == DEVIDLE) + { + fdintr(fdcu); + } + splx(s); +} + +static void +fd_timeout(void *arg1) +{ + fdcu_t fdcu = (fdcu_t)arg1; + fdu_t fdu = fdc_data[fdcu].fdu; + int baseport = fdc_data[fdcu].baseport; + struct buf *bp; + int s; + + bp = TAILQ_FIRST(&fdc_data[fdcu].head); + + /* + * Due to IBM's brain-dead design, the FDC has a faked ready + * signal, hardwired to ready == true. Thus, any command + * issued if there's no diskette in the drive will _never_ + * complete, and must be aborted by resetting the FDC. + * Many thanks, Big Blue! + */ + + s = splbio(); + + TRACE1("fd%d[fd_timeout()]", fdu); + /* See if the controller is still busy (patiently awaiting data) */ + if(((inb(baseport + FDSTS)) & (NE7_CB|NE7_RQM)) == NE7_CB) + { + DELAY(5); + TRACE1("[FDSTS->0x%x]", inb(baseport + FDSTS)); + /* yup, it is; kill it now */ + fdc_reset(&fdc_data[fdcu]); + printf("fd%d: Operation timeout\n", fdu); + } + + if (bp) + { + retrier(fdcu); + fdc_data[fdcu].status[0] = NE7_ST0_IC_RC; + fdc_data[fdcu].state = IOTIMEDOUT; + if( fdc_data[fdcu].retry < 6) + fdc_data[fdcu].retry = 6; + } + else + { + fdc_data[fdcu].fd = (fd_p) 0; + fdc_data[fdcu].fdu = -1; + fdc_data[fdcu].state = DEVIDLE; + } + fdintr(fdcu); + splx(s); +} + +/* just ensure it has the right spl */ +static void +fd_pseudointr(void *arg1) +{ + fdcu_t fdcu = (fdcu_t)arg1; + int s; + + s = splbio(); + fdintr(fdcu); + splx(s); +} + +/***********************************************************************\ +* fdintr * +* keep calling the state machine until it returns a 0 * +* ALWAYS called at SPLBIO * +\***********************************************************************/ +void +fdintr(fdcu_t fdcu) +{ + fdc_p fdc = fdc_data + fdcu; +#if NFT > 0 + fdu_t fdu = fdc->fdu; + + if (fdc->flags & FDC_TAPE_BUSY) + (ftintr(fdu)); + else +#endif + while(fdstate(fdcu, fdc)) + ; +} + +/***********************************************************************\ +* The controller state machine. * +* if it returns a non zero value, it should be called again immediatly * +\***********************************************************************/ +static int +fdstate(fdcu_t fdcu, fdc_p fdc) +{ + int read, format, head, sec = 0, sectrac, st0, cyl, st3; + unsigned long blknum; + fdu_t fdu = fdc->fdu; + fd_p fd; + register struct buf *bp; + struct fd_formb *finfo = NULL; + size_t fdblk; + + bp = TAILQ_FIRST(&fdc->head); + if(!bp) { + /***********************************************\ + * nothing left for this controller to do * + * Force into the IDLE state, * + \***********************************************/ + fdc->state = DEVIDLE; + if(fdc->fd) + { + printf("fd%d: unexpected valid fd pointer\n", + fdc->fdu); + fdc->fd = (fd_p) 0; + fdc->fdu = -1; + } + TRACE1("[fdc%d IDLE]", fdcu); + return(0); + } + fdu = FDUNIT(minor(bp->b_dev)); + fd = fd_data + fdu; + fdblk = 128 << fd->ft->secsize; + if (fdc->fd && (fd != fdc->fd)) + { + printf("fd%d: confused fd pointers\n", fdu); + } + read = bp->b_flags & B_READ; + format = bp->b_flags & B_FORMAT; + if(format) + finfo = (struct fd_formb *)bp->b_un.b_addr; + TRACE1("fd%d", fdu); + TRACE1("[%s]", fdstates[fdc->state]); + TRACE1("(0x%x)", fd->flags); + untimeout(fd_turnoff, (caddr_t)fdu); + timeout(fd_turnoff, (caddr_t)fdu, 4 * hz); + switch (fdc->state) + { + case DEVIDLE: + case FINDWORK: /* we have found new work */ + fdc->retry = 0; + fd->skip = 0; + fdc->fd = fd; + fdc->fdu = fdu; +#ifdef PC98 + pc98_trans = fd->ft->trans; + if (pc98_trans_prev != pc98_trans) { + int i; + set_density(fdcu, fdu); + for (i = 0; i < 10; i++) { + outb(0x5f, 0); + outb(0x5f, 0); + } + pc98_trans_prev = pc98_trans; + } + if (pc98_trans != fd->pc98_trans) { + if (pc98_trans != 1 && + (PC98_SYSTEM_PARAMETER(0x5ae) >> fdu) & 0x01) { + outb(0x4be, (fdu << 5) | 0x10 | (pc98_trans >> 1)); + outb(0x5f, 0); + outb(0x5f, 0); + } + fd->pc98_trans = pc98_trans; + } +#else + outb(fdc->baseport+FDCTL, fd->ft->trans); +#endif + TRACE1("[0x%x->FDCTL]", fd->ft->trans); + /*******************************************************\ + * If the next drive has a motor startup pending, then * + * it will start up in it's own good time * + \*******************************************************/ + if(fd->flags & FD_MOTOR_WAIT) + { + fdc->state = MOTORWAIT; + return(0); /* come back later */ + } + /*******************************************************\ + * Maybe if it's not starting, it SHOULD be starting * + \*******************************************************/ +#ifdef EPSON_NRDISK + if (fdu != nrdu) { + if (!(fd->flags & FD_MOTOR)) + { + fdc->state = MOTORWAIT; + fd_turnon(fdu); + return(0); + } + else /* at least make sure we are selected */ + { + set_motor(fdcu, fd->fdsu, TURNON); + } + } +#else /* !EPSON_NRDISK */ + if (!(fd->flags & FD_MOTOR)) + { + fdc->state = MOTORWAIT; + fd_turnon(fdu); + return(0); + } + else /* at least make sure we are selected */ + { + set_motor(fdcu, fd->fdsu, TURNON); + } +#endif + fdc->state = DOSEEK; + break; + case DOSEEK: + if (bp->b_cylin == fd->track) + { + fdc->state = SEEKCOMPLETE; + break; + } +#ifdef PC98 + pc98_fd_check_ready(fdu); +#endif + if (fd_cmd(fdcu, 3, NE7CMD_SEEK, + fd->fdsu, bp->b_cylin * fd->ft->steptrac, + 0)) + { + /* + * seek command not accepted, looks like + * the FDC went off to the Saints... + */ + fdc->retry = 6; /* try a reset */ + return(retrier(fdcu)); + } + fd->track = FD_NO_TRACK; + fdc->state = SEEKWAIT; + return(0); /* will return later */ + case SEEKWAIT: + /* allow heads to settle */ + timeout(fd_pseudointr, (caddr_t)fdcu, hz / 16); + fdc->state = SEEKCOMPLETE; + return(0); /* will return later */ + case SEEKCOMPLETE : /* SEEK DONE, START DMA */ + /* Make sure seek really happened*/ + if(fd->track == FD_NO_TRACK) + { + int descyl = bp->b_cylin * fd->ft->steptrac; + do { + /* + * This might be a "ready changed" interrupt, + * which cannot really happen since the + * RDY pin is hardwired to + 5 volts. This + * generally indicates a "bouncing" intr + * line, so do one of the following: + * + * When running on an enhanced FDC that is + * known to not go stuck after responding + * with INVALID, fetch all interrupt states + * until seeing either an INVALID or a + * real interrupt condition. + * + * When running on a dumb old NE765, give + * up immediately. The controller will + * provide up to four dummy RC interrupt + * conditions right after reset (for the + * corresponding four drives), so this is + * our only chance to get notice that it + * was not the FDC that caused the interrupt. + */ + if (fd_sense_int(fdc, &st0, &cyl) + == FD_NOT_VALID) + return 0; + if(fdc->fdct == FDC_NE765 + && (st0 & NE7_ST0_IC) == NE7_ST0_IC_RC) + return 0; /* hope for a real intr */ + } while ((st0 & NE7_ST0_IC) == NE7_ST0_IC_RC); + + if (0 == descyl) + { + int failed = 0; + /* + * seek to cyl 0 requested; make sure we are + * really there + */ + if (fd_sense_drive_status(fdc, &st3)) + failed = 1; +#ifdef EPSON_NRDISK + if (fdu == nrdu) st3 = NE7_ST3_T0; +#endif /* EPSON_NRDISK */ + if ((st3 & NE7_ST3_T0) == 0) { + printf( + "fd%d: Seek to cyl 0, but not really there (ST3 = %b)\n", + fdu, st3, NE7_ST3BITS); + failed = 1; + } + + if (failed) + { + if(fdc->retry < 3) + fdc->retry = 3; + return(retrier(fdcu)); + } + } +#ifdef EPSON_NRDISK + if (fdu == nrdu) cyl = descyl; +#endif + + if (cyl != descyl) + { + printf( + "fd%d: Seek to cyl %d failed; am at cyl %d (ST0 = 0x%x)\n", + fdu, descyl, cyl, st0); + return(retrier(fdcu)); + } + } + + fd->track = bp->b_cylin; + if(format) + fd->skip = (char *)&(finfo->fd_formb_cylno(0)) + - (char *)finfo; +#ifdef EPSON_NRDISK + if (fdu != nrdu) { +#endif /* EPSON_NRDISK */ +#ifdef PC98 + pc98_dmastart(bp->b_flags, bp->b_un.b_addr+fd->skip, +#else + isa_dmastart(bp->b_flags, bp->b_un.b_addr+fd->skip, +#endif + format ? bp->b_bcount : fdblk, fdc->dmachan); + blknum = (unsigned long)bp->b_blkno*DEV_BSIZE/fdblk + + fd->skip/fdblk; + sectrac = fd->ft->sectrac; + sec = blknum % (sectrac * fd->ft->heads); + head = sec / sectrac; + sec = sec % sectrac + 1; + fd->hddrv = ((head&1)<<2)+fdu; + if(format || !read) + { + /* make sure the drive is writable */ + if(fd_sense_drive_status(fdc, &st3) != 0) + { + /* stuck controller? */ + fdc->retry = 6; /* reset the beast */ + return(retrier(fdcu)); + } + if(st3 & NE7_ST3_WP) + { + /* + * XXX YES! this is ugly. + * in order to force the current operation + * to fail, we will have to fake an FDC + * error - all error handling is done + * by the retrier() + */ + fdc->status[0] = NE7_ST0_IC_AT; + fdc->status[1] = NE7_ST1_NW; + fdc->status[2] = 0; + fdc->status[3] = fd->track; + fdc->status[4] = head; + fdc->status[5] = sec; + fdc->retry = 8; /* break out immediately */ + fdc->state = IOTIMEDOUT; /* not really... */ + return (1); + } + } + + if(format) + { + /* formatting */ + if(fd_cmd(fdcu, 6, + NE7CMD_FORMAT, + head << 2 | fdu, + finfo->fd_formb_secshift, + finfo->fd_formb_nsecs, + finfo->fd_formb_gaplen, + finfo->fd_formb_fillbyte, + 0)) + { + /* controller fell over */ + fdc->retry = 6; + return(retrier(fdcu)); + } + } + else + { + if (fd_cmd(fdcu, 9, + (read ? NE7CMD_READ : NE7CMD_WRITE), + head << 2 | fdu, /* head & unit */ + fd->track, /* track */ + head, + sec, /* sector + 1 */ + fd->ft->secsize, /* sector size */ + sectrac, /* sectors/track */ + fd->ft->gap, /* gap size */ + fd->ft->datalen, /* data length */ + 0)) + { + /* the beast is sleeping again */ + fdc->retry = 6; + return(retrier(fdcu)); + } + } + fdc->state = IOCOMPLETE; + timeout(fd_timeout, (caddr_t)fdcu, hz); + return(0); /* will return later */ +#ifdef EPSON_NRDISK + } + else { + nrdblkn = (nrd_t)((unsigned long)bp->b_blkno*DEV_BSIZE/fdblk + + fd->skip/fdblk); + nrd_LED_on(); + nrd_addrset(fdblk * nrdblkn); + while (!nrd_check_ready()) DELAY(1); + if (read) epson_insw(P_NRD_DATA, + bp->b_un.b_addr + fd->skip, + fdblk / sizeof(short)); + else epson_outsw(P_NRD_DATA, + bp->b_un.b_addr + fd->skip, + (format ? bp->b_bcount : fdblk) + / sizeof(short)); + + blknum = (unsigned long)bp->b_blkno*DEV_BSIZE/fdblk + + fd->skip/fdblk; + sectrac = fd->ft->sectrac; + sec = blknum % (sectrac * fd->ft->heads); + head = sec / sectrac; + sec = sec % sectrac + 1; + fd->hddrv = ((head&1)<<2)+fdu; + + if (nrdsec++ >= nrd_sec()) + nrdaddr = (nrd_t)(fd->track * 8 + head * 4); + nrdsec = sec; + fdc->state = IOCOMPLETE; + } +#endif + case IOCOMPLETE: /* IO DONE, post-analyze */ +#ifdef EPSON_NRDISK + if (fdu != nrdu) untimeout(fd_timeout, (caddr_t)fdcu); +#else + untimeout(fd_timeout, (caddr_t)fdcu); +#endif + + if (fd_read_status(fdc, fd->fdsu)) + { + if (fdc->retry < 6) + fdc->retry = 6; /* force a reset */ + return retrier(fdcu); + } + + fdc->state = IOTIMEDOUT; + + /* FALLTHROUGH */ + + case IOTIMEDOUT: +#ifdef EPSON_NRDISK + if (fdu != nrdu) { +#endif /* EPSON_NRDISK */ +#ifdef PC98 + pc98_dmadone(bp->b_flags, bp->b_un.b_addr+fd->skip, +#else + isa_dmadone(bp->b_flags, bp->b_un.b_addr+fd->skip, +#endif + format ? bp->b_bcount : fdblk, fdc->dmachan); +#ifdef EPSON_NRDISK + } + else nrd_LED_off(); +#endif /* EPSON_NRDISK */ + if (fdc->status[0] & NE7_ST0_IC) + { + if ((fdc->status[0] & NE7_ST0_IC) == NE7_ST0_IC_AT + && fdc->status[1] & NE7_ST1_OR) { + /* + * DMA overrun. Someone hogged the bus + * and didn't release it in time for the + * next FDC transfer. + * Just restart it, don't increment retry + * count. (vak) + */ + fdc->state = SEEKCOMPLETE; + return (1); + } + else if((fdc->status[0] & NE7_ST0_IC) == NE7_ST0_IC_IV + && fdc->retry < 6) + fdc->retry = 6; /* force a reset */ + else if((fdc->status[0] & NE7_ST0_IC) == NE7_ST0_IC_AT + && fdc->status[2] & NE7_ST2_WC + && fdc->retry < 3) + fdc->retry = 3; /* force recalibrate */ + return(retrier(fdcu)); + } + /* All OK */ + fd->skip += fdblk; + if (!format && fd->skip < bp->b_bcount) + { + /* set up next transfer */ + blknum = (unsigned long)bp->b_blkno*DEV_BSIZE/fdblk + + fd->skip/fdblk; +#ifdef EPSON_NRDISK + nrdblkn = (unsigned long)bp->b_blkno*DEV_BSIZE/fdblk + + fd->skip/fdblk; +#endif + bp->b_cylin = + (blknum / (fd->ft->sectrac * fd->ft->heads)); + fdc->state = DOSEEK; + } + else + { + /* ALL DONE */ + fd->skip = 0; + bp->b_resid = 0; + TAILQ_REMOVE(&fdc->head, bp, b_act); + biodone(bp); + fdc->fd = (fd_p) 0; + fdc->fdu = -1; + fdc->state = FINDWORK; + } + return(1); + case RESETCTLR: + fdc_reset(fdc); + fdc->retry++; + fdc->state = STARTRECAL; + break; + case STARTRECAL: + /* XXX clear the fdc results from the last reset, if any. */ + { + int i; + for (i = 0; i < 4; i++) + (void)fd_sense_int(fdc, &st0, &cyl); + } + +#ifdef PC98 + pc98_fd_check_ready(fdu); +#endif + if(fd_cmd(fdcu, + 2, NE7CMD_RECAL, fdu, + 0)) /* Recalibrate Function */ + { + /* arrgl */ + fdc->retry = 6; + return(retrier(fdcu)); + } + fdc->state = RECALWAIT; + return(0); /* will return later */ + case RECALWAIT: + /* allow heads to settle */ + timeout(fd_pseudointr, (caddr_t)fdcu, hz / 8); + fdc->state = RECALCOMPLETE; + return(0); /* will return later */ + case RECALCOMPLETE: + do { + /* + * See SEEKCOMPLETE for a comment on this: + */ + if (fd_sense_int(fdc, &st0, &cyl) == FD_NOT_VALID) + return 0; + if(fdc->fdct == FDC_NE765 + && (st0 & NE7_ST0_IC) == NE7_ST0_IC_RC) + return 0; /* hope for a real intr */ + } while ((st0 & NE7_ST0_IC) == NE7_ST0_IC_RC); +#ifdef EPSON_NRDISK + if (fdu == nrdu) { + st0 = NE7_ST0_IC_NT; + cyl = 0; + } +#endif + if ((st0 & NE7_ST0_IC) != NE7_ST0_IC_NT || cyl != 0) + { + if(fdc->retry > 3) + /* + * a recalibrate from beyond cylinder 77 + * will "fail" due to the FDC limitations; + * since people used to complain much about + * the failure message, try not logging + * this one if it seems to be the first + * time in a line + */ + printf("fd%d: recal failed ST0 %b cyl %d\n", + fdu, st0, NE7_ST0BITS, cyl); + if(fdc->retry < 3) fdc->retry = 3; + return(retrier(fdcu)); + } + fd->track = 0; + /* Seek (probably) necessary */ + fdc->state = DOSEEK; + return(1); /* will return immediatly */ + case MOTORWAIT: + if(fd->flags & FD_MOTOR_WAIT) + { + return(0); /* time's not up yet */ + } + /* + * since the controller was off, it has lost its + * idea about the current track it were; thus, + * recalibrate the bastard + */ + fdc->state = STARTRECAL; + return(1); /* will return immediatly */ + default: + printf("fdc%d: Unexpected FD int->", fdcu); + if (fd_read_status(fdc, fd->fdsu) == 0) + printf("FDC status :%lx %lx %lx %lx %lx %lx %lx ", + fdc->status[0], + fdc->status[1], + fdc->status[2], + fdc->status[3], + fdc->status[4], + fdc->status[5], + fdc->status[6] ); + else + printf("No status available "); + if (fd_sense_int(fdc, &st0, &cyl) != 0) + { + printf("[controller is dead now]\n"); + return(0); + } + printf("ST0 = %x, PCN = %x\n", st0, cyl); + return(0); + } + /*XXX confusing: some branches return immediately, others end up here*/ + return(1); /* Come back immediatly to new state */ +} + +static int +retrier(fdcu) + fdcu_t fdcu; +{ + fdc_p fdc = fdc_data + fdcu; + register struct buf *bp; + + bp = TAILQ_FIRST(&fdc->head); + + if(fd_data[FDUNIT(minor(bp->b_dev))].options & FDOPT_NORETRY) + goto fail; + switch(fdc->retry) + { + case 0: case 1: case 2: + fdc->state = SEEKCOMPLETE; + break; + case 3: case 4: case 5: + fdc->state = STARTRECAL; + break; + case 6: + fdc->state = RESETCTLR; + break; + case 7: + break; + default: + fail: + { + dev_t sav_b_dev = bp->b_dev; + /* Trick diskerr */ + bp->b_dev = makedev(major(bp->b_dev), + (FDUNIT(minor(bp->b_dev))<<3)|RAW_PART); + diskerr(bp, "fd", "hard error", LOG_PRINTF, + fdc->fd->skip / DEV_BSIZE, + (struct disklabel *)NULL); + bp->b_dev = sav_b_dev; + if (fdc->flags & FDC_STAT_VALID) + { + printf( + " (ST0 %b ST1 %b ST2 %b cyl %ld hd %ld sec %ld)\n", + fdc->status[0], NE7_ST0BITS, + fdc->status[1], NE7_ST1BITS, + fdc->status[2], NE7_ST2BITS, + fdc->status[3], fdc->status[4], + fdc->status[5]); + } + else + printf(" (No status)\n"); + } + bp->b_flags |= B_ERROR; + bp->b_error = EIO; + bp->b_resid = bp->b_bcount - fdc->fd->skip; + TAILQ_REMOVE(&fdc->head, bp, b_act); + fdc->fd->skip = 0; + biodone(bp); + fdc->state = FINDWORK; + fdc->fd = (fd_p) 0; + fdc->fdu = -1; + /* XXX abort current command, if any. */ + return(1); + } + fdc->retry++; + return(1); +} + +static int +fdformat(dev, finfo, p) + dev_t dev; + struct fd_formb *finfo; + struct proc *p; +{ + fdu_t fdu; + fd_p fd; + + struct buf *bp; + int rv = 0, s; + size_t fdblk; + + fdu = FDUNIT(minor(dev)); + fd = &fd_data[fdu]; + fdblk = 128 << fd->ft->secsize; + + /* set up a buffer header for fdstrategy() */ + bp = (struct buf *)malloc(sizeof(struct buf), M_TEMP, M_NOWAIT); + if(bp == 0) + return ENOBUFS; + /* + * keep the process from being swapped + */ + p->p_flag |= P_PHYSIO; + bzero((void *)bp, sizeof(struct buf)); + bp->b_flags = B_BUSY | B_PHYS | B_FORMAT; + bp->b_proc = p; + bp->b_dev = dev; + + /* + * calculate a fake blkno, so fdstrategy() would initiate a + * seek to the requested cylinder + */ + bp->b_blkno = (finfo->cyl * (fd->ft->sectrac * fd->ft->heads) + + finfo->head * fd->ft->sectrac) * fdblk / DEV_BSIZE; + + bp->b_bcount = sizeof(struct fd_idfield_data) * finfo->fd_formb_nsecs; + bp->b_un.b_addr = (caddr_t)finfo; + + /* now do the format */ + fdstrategy(bp); + + /* ...and wait for it to complete */ + s = splbio(); + while(!(bp->b_flags & B_DONE)) + { + rv = tsleep((caddr_t)bp, PRIBIO, "fdform", 20 * hz); + if(rv == EWOULDBLOCK) + break; + } + splx(s); + + if(rv == EWOULDBLOCK) { + /* timed out */ + rv = EIO; + biodone(bp); + } + if(bp->b_flags & B_ERROR) + rv = bp->b_error; + /* + * allow the process to be swapped + */ + p->p_flag &= ~P_PHYSIO; + free(bp, M_TEMP); + return rv; +} + +/* + * TODO: don't allocate buffer on stack. + */ + +int +fdioctl(dev, cmd, addr, flag, p) + dev_t dev; + int cmd; + caddr_t addr; + int flag; + struct proc *p; +{ + fdu_t fdu = FDUNIT(minor(dev)); + fd_p fd = &fd_data[fdu]; + size_t fdblk; + + struct fd_type *fdt; + struct disklabel *dl; + char buffer[DEV_BSIZE]; + int error = 0; + +#if NFT > 0 + int type = FDTYPE(minor(dev)); + + /* check for a tape ioctl */ + if (type & F_TAPE_TYPE) + return ftioctl(dev, cmd, addr, flag, p); +#endif + + fdblk = 128 << fd->ft->secsize; + +#ifdef PC98 + pc98_fd_check_ready(fdu); +#endif + switch (cmd) + { + case DIOCGDINFO: + bzero(buffer, sizeof (buffer)); + dl = (struct disklabel *)buffer; + dl->d_secsize = fdblk; + fdt = fd_data[FDUNIT(minor(dev))].ft; + dl->d_secpercyl = fdt->size / fdt->tracks; + dl->d_type = DTYPE_FLOPPY; + + if (readdisklabel(dkmodpart(dev, RAW_PART), fdstrategy, dl) + == NULL) + error = 0; + else + error = EINVAL; + + *(struct disklabel *)addr = *dl; + break; + + case DIOCSDINFO: + if ((flag & FWRITE) == 0) + error = EBADF; + break; + + case DIOCWLABEL: + if ((flag & FWRITE) == 0) + error = EBADF; + break; + + case DIOCWDINFO: + if ((flag & FWRITE) == 0) + { + error = EBADF; + break; + } + + dl = (struct disklabel *)addr; + + if ((error = setdisklabel((struct disklabel *)buffer, dl, + (u_long)0)) != 0) + break; + + error = writedisklabel(dev, fdstrategy, + (struct disklabel *)buffer); + break; + + case FD_FORM: + if((flag & FWRITE) == 0) + error = EBADF; /* must be opened for writing */ + else if(((struct fd_formb *)addr)->format_version != + FD_FORMAT_VERSION) + error = EINVAL; /* wrong version of formatting prog */ + else + error = fdformat(dev, (struct fd_formb *)addr, p); + break; + + case FD_GTYPE: /* get drive type */ + *(struct fd_type *)addr = *fd_data[FDUNIT(minor(dev))].ft; + break; + + case FD_STYPE: /* set drive type */ + /* this is considered harmful; only allow for superuser */ + if(suser(p->p_ucred, &p->p_acflag) != 0) + return EPERM; + *fd_data[FDUNIT(minor(dev))].ft = *(struct fd_type *)addr; + break; + + case FD_GOPTS: /* get drive options */ + *(int *)addr = fd_data[FDUNIT(minor(dev))].options; + break; + + case FD_SOPTS: /* set drive options */ + fd_data[FDUNIT(minor(dev))].options = *(int *)addr; + break; + + default: + error = ENOTTY; + break; + } + return (error); +} + + +static fd_devsw_installed = 0; + +static void fd_drvinit(void *notused ) +{ + dev_t dev; + + if( ! fd_devsw_installed ) { + dev = makedev(CDEV_MAJOR, 0); + cdevsw_add(&dev,&fd_cdevsw, NULL); + dev = makedev(BDEV_MAJOR, 0); + bdevsw_add(&dev,&fd_bdevsw, NULL); + fd_devsw_installed = 1; + } +} + +SYSINIT(fddev,SI_SUB_DRIVERS,SI_ORDER_MIDDLE+CDEV_MAJOR,fd_drvinit,NULL) + +#endif +/* + * Hello emacs, these are the + * Local Variables: + * c-indent-level: 8 + * c-continued-statement-offset: 8 + * c-continued-brace-offset: 0 + * c-brace-offset: -8 + * c-brace-imaginary-offset: 0 + * c-argdecl-indent: 8 + * c-label-offset: -8 + * c++-hanging-braces: 1 + * c++-access-specifier-offset: -8 + * c++-empty-arglist-indent: 8 + * c++-friend-offset: 0 + * End: + */ |