Annotation of sys/dev/isa/fdc.c, Revision 1.1
1.1 ! nbrk 1: /* $OpenBSD: fdc.c,v 1.17 2005/09/19 01:28:04 deraadt Exp $ */
! 2: /* $NetBSD: fd.c,v 1.90 1996/05/12 23:12:03 mycroft Exp $ */
! 3:
! 4: /*-
! 5: * Copyright (c) 1993, 1994, 1995 Charles Hannum.
! 6: * Copyright (c) 1990 The Regents of the University of California.
! 7: * All rights reserved.
! 8: *
! 9: * This code is derived from software contributed to Berkeley by
! 10: * Don Ahn.
! 11: *
! 12: * Portions Copyright (c) 1993, 1994 by
! 13: * jc@irbs.UUCP (John Capo)
! 14: * vak@zebub.msk.su (Serge Vakulenko)
! 15: * ache@astral.msk.su (Andrew A. Chernov)
! 16: * joerg_wunsch@uriah.sax.de (Joerg Wunsch)
! 17: *
! 18: * Redistribution and use in source and binary forms, with or without
! 19: * modification, are permitted provided that the following conditions
! 20: * are met:
! 21: * 1. Redistributions of source code must retain the above copyright
! 22: * notice, this list of conditions and the following disclaimer.
! 23: * 2. Redistributions in binary form must reproduce the above copyright
! 24: * notice, this list of conditions and the following disclaimer in the
! 25: * documentation and/or other materials provided with the distribution.
! 26: * 3. Neither the name of the University nor the names of its contributors
! 27: * may be used to endorse or promote products derived from this software
! 28: * without specific prior written permission.
! 29: *
! 30: * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
! 31: * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
! 32: * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
! 33: * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
! 34: * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
! 35: * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
! 36: * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
! 37: * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
! 38: * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
! 39: * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
! 40: * SUCH DAMAGE.
! 41: *
! 42: * @(#)fd.c 7.4 (Berkeley) 5/25/91
! 43: */
! 44:
! 45: #include <sys/param.h>
! 46: #include <sys/systm.h>
! 47: #include <sys/kernel.h>
! 48: #include <sys/file.h>
! 49: #include <sys/ioctl.h>
! 50: #include <sys/device.h>
! 51: #include <sys/disklabel.h>
! 52: #include <sys/dkstat.h>
! 53: #include <sys/disk.h>
! 54: #include <sys/buf.h>
! 55: #include <sys/malloc.h>
! 56: #include <sys/uio.h>
! 57: #include <sys/mtio.h>
! 58: #include <sys/syslog.h>
! 59: #include <sys/queue.h>
! 60: #include <sys/timeout.h>
! 61:
! 62: #include <machine/cpu.h>
! 63: #include <machine/bus.h>
! 64: #include <machine/conf.h>
! 65: #include <machine/intr.h>
! 66: #include <machine/ioctl_fd.h>
! 67:
! 68: #include <dev/isa/isavar.h>
! 69: #include <dev/isa/isadmavar.h>
! 70: #include <dev/isa/fdreg.h>
! 71:
! 72: #if defined(__i386__) || defined(__amd64__) /* XXX */
! 73: #include <dev/ic/mc146818reg.h> /* for NVRAM access */
! 74: #include <i386/isa/nvram.h>
! 75: #endif
! 76:
! 77: #include <dev/isa/fdlink.h>
! 78:
! 79: #include "fd.h"
! 80:
! 81: /* controller driver configuration */
! 82: int fdcprobe(struct device *, void *, void *);
! 83: void fdcattach(struct device *, struct device *, void *);
! 84:
! 85: struct cfattach fdc_ca = {
! 86: sizeof(struct fdc_softc), fdcprobe, fdcattach
! 87: };
! 88:
! 89: struct cfdriver fdc_cd = {
! 90: NULL, "fdc", DV_DULL
! 91: };
! 92:
! 93: int fddprint(void *, const char *);
! 94: int fdcintr(void *);
! 95:
! 96: int
! 97: fdcprobe(parent, match, aux)
! 98: struct device *parent;
! 99: void *match, *aux;
! 100: {
! 101: register struct isa_attach_args *ia = aux;
! 102: bus_space_tag_t iot;
! 103: bus_space_handle_t ioh;
! 104: bus_space_handle_t ioh_ctl;
! 105: int rv;
! 106:
! 107: iot = ia->ia_iot;
! 108: rv = 0;
! 109:
! 110: /* Map the i/o space. */
! 111: if (bus_space_map(iot, ia->ia_iobase, FDC_NPORT, 0, &ioh))
! 112: return 0;
! 113: if (bus_space_map(iot, ia->ia_iobase + FDCTL_OFFSET,
! 114: FDCTL_NPORT, 0, &ioh_ctl))
! 115: return 0;
! 116:
! 117: /* reset */
! 118: bus_space_write_1(iot, ioh, fdout, 0);
! 119: delay(100);
! 120: bus_space_write_1(iot, ioh, fdout, FDO_FRST);
! 121:
! 122: /* see if it can handle a command */
! 123: if (out_fdc(iot, ioh, NE7CMD_SPECIFY) < 0)
! 124: goto out;
! 125: out_fdc(iot, ioh, 0xdf);
! 126: out_fdc(iot, ioh, 2);
! 127:
! 128: rv = 1;
! 129: ia->ia_iosize = FDC_NPORT;
! 130: ia->ia_msize = 0;
! 131:
! 132: out:
! 133: bus_space_unmap(iot, ioh, FDC_NPORT);
! 134: bus_space_unmap(iot, ioh_ctl, FDCTL_NPORT);
! 135: return rv;
! 136: }
! 137:
! 138: void
! 139: fdcattach(parent, self, aux)
! 140: struct device *parent, *self;
! 141: void *aux;
! 142: {
! 143: struct fdc_softc *fdc = (void *)self;
! 144: bus_space_tag_t iot;
! 145: bus_space_handle_t ioh;
! 146: bus_space_handle_t ioh_ctl;
! 147: struct isa_attach_args *ia = aux;
! 148: struct fdc_attach_args fa;
! 149: int type;
! 150:
! 151: iot = ia->ia_iot;
! 152:
! 153: /* Re-map the I/O space. */
! 154: if (bus_space_map(iot, ia->ia_iobase, FDC_NPORT, 0, &ioh) ||
! 155: bus_space_map(iot, ia->ia_iobase + FDCTL_OFFSET,
! 156: FDCTL_NPORT, 0, &ioh_ctl))
! 157: panic("fdcattach: couldn't map I/O ports");
! 158:
! 159: fdc->sc_iot = iot;
! 160: fdc->sc_ioh = ioh;
! 161: fdc->sc_ioh_ctl = ioh_ctl;
! 162:
! 163: fdc->sc_drq = ia->ia_drq;
! 164: fdc->sc_state = DEVIDLE;
! 165: TAILQ_INIT(&fdc->sc_link.fdlink.sc_drives); /* XXX */
! 166:
! 167: printf("\n");
! 168:
! 169: fdc->sc_ih = isa_intr_establish(ia->ia_ic, ia->ia_irq, IST_EDGE,
! 170: IPL_BIO, fdcintr, fdc, fdc->sc_dev.dv_xname);
! 171:
! 172: #if defined(__i386__) || defined(__amd64__)
! 173: /*
! 174: * The NVRAM info only tells us about the first two disks on the
! 175: * `primary' floppy controller.
! 176: */
! 177: if (fdc->sc_dev.dv_unit == 0)
! 178: type = mc146818_read(NULL, NVRAM_DISKETTE); /* XXX softc */
! 179: else
! 180: #endif
! 181: type = -1;
! 182:
! 183: timeout_set(&fdc->fdcpseudointr_to, fdcpseudointr, fdc);
! 184:
! 185: /* physical limit: four drives per controller. */
! 186: for (fa.fa_drive = 0; fa.fa_drive < 4; fa.fa_drive++) {
! 187: fa.fa_flags = 0;
! 188: fa.fa_type = 0;
! 189: #if NFD > 0
! 190: if (type >= 0 && fa.fa_drive < 2)
! 191: fa.fa_deftype = fd_nvtotype(fdc->sc_dev.dv_xname,
! 192: type, fa.fa_drive);
! 193: else
! 194: #endif
! 195: fa.fa_deftype = NULL; /* unknown */
! 196: (void)config_found(self, (void *)&fa, fddprint);
! 197: }
! 198: }
! 199:
! 200: /*
! 201: * Print the location of a disk/tape drive (called just before attaching the
! 202: * the drive). If `fdc' is not NULL, the drive was found but was not
! 203: * in the system config file; print the drive name as well.
! 204: * Return QUIET (config_find ignores this if the device was configured) to
! 205: * avoid printing `fdN not configured' messages.
! 206: */
! 207: int
! 208: fddprint(aux, fdc)
! 209: void *aux;
! 210: const char *fdc;
! 211: {
! 212: register struct fdc_attach_args *fa = aux;
! 213:
! 214: if (!fdc)
! 215: printf(" drive %d", fa->fa_drive);
! 216: return QUIET;
! 217: }
! 218:
! 219: int
! 220: fdcresult(fdc)
! 221: struct fdc_softc *fdc;
! 222: {
! 223: bus_space_tag_t iot = fdc->sc_iot;
! 224: bus_space_handle_t ioh = fdc->sc_ioh;
! 225: u_char i;
! 226: int j = 100000, n = 0;
! 227:
! 228: for (; j; j--) {
! 229: i = bus_space_read_1(iot, ioh, fdsts) &
! 230: (NE7_DIO | NE7_RQM | NE7_CB);
! 231: if (i == NE7_RQM)
! 232: return n;
! 233: if (i == (NE7_DIO | NE7_RQM | NE7_CB)) {
! 234: if (n >= sizeof(fdc->sc_status)) {
! 235: log(LOG_ERR, "fdcresult: overrun\n");
! 236: return -1;
! 237: }
! 238: fdc->sc_status[n++] =
! 239: bus_space_read_1(iot, ioh, fddata);
! 240: }
! 241: delay(10);
! 242: }
! 243: return -1;
! 244: }
! 245:
! 246: int
! 247: out_fdc(iot, ioh, x)
! 248: bus_space_tag_t iot;
! 249: bus_space_handle_t ioh;
! 250: u_char x;
! 251: {
! 252: int i = 100000;
! 253:
! 254: while ((bus_space_read_1(iot, ioh, fdsts) & NE7_DIO) && i-- > 0);
! 255: if (i <= 0)
! 256: return -1;
! 257: while ((bus_space_read_1(iot, ioh, fdsts) & NE7_RQM) == 0 && i-- > 0);
! 258: if (i <= 0)
! 259: return -1;
! 260: bus_space_write_1(iot, ioh, fddata, x);
! 261: return 0;
! 262: }
! 263:
! 264: void
! 265: fdcstart(fdc)
! 266: struct fdc_softc *fdc;
! 267: {
! 268:
! 269: #ifdef DIAGNOSTIC
! 270: /* only got here if controller's drive queue was inactive; should
! 271: be in idle state */
! 272: if (fdc->sc_state != DEVIDLE) {
! 273: printf("fdcstart: not idle\n");
! 274: return;
! 275: }
! 276: #endif
! 277: (void) fdcintr(fdc);
! 278: }
! 279:
! 280: void
! 281: fdcstatus(dv, n, s)
! 282: struct device *dv;
! 283: int n;
! 284: char *s;
! 285: {
! 286: struct fdc_softc *fdc = (void *)dv->dv_parent;
! 287:
! 288: if (n == 0) {
! 289: out_fdc(fdc->sc_iot, fdc->sc_ioh, NE7CMD_SENSEI);
! 290: (void) fdcresult(fdc);
! 291: n = 2;
! 292: }
! 293:
! 294: printf("%s: %s", dv->dv_xname, s);
! 295:
! 296: switch (n) {
! 297: case 0:
! 298: printf("\n");
! 299: break;
! 300: case 2:
! 301: printf(" (st0 %b cyl %d)\n",
! 302: fdc->sc_status[0], NE7_ST0BITS,
! 303: fdc->sc_status[1]);
! 304: break;
! 305: case 7:
! 306: printf(" (st0 %b st1 %b st2 %b cyl %d head %d sec %d)\n",
! 307: fdc->sc_status[0], NE7_ST0BITS,
! 308: fdc->sc_status[1], NE7_ST1BITS,
! 309: fdc->sc_status[2], NE7_ST2BITS,
! 310: fdc->sc_status[3], fdc->sc_status[4], fdc->sc_status[5]);
! 311: break;
! 312: #ifdef DIAGNOSTIC
! 313: default:
! 314: printf("\nfdcstatus: weird size");
! 315: break;
! 316: #endif
! 317: }
! 318: }
! 319:
! 320: void
! 321: fdcpseudointr(arg)
! 322: void *arg;
! 323: {
! 324: int s;
! 325:
! 326: /* Just ensure it has the right spl. */
! 327: s = splbio();
! 328: (void) fdcintr(arg);
! 329: splx(s);
! 330: }
! 331:
! 332: int
! 333: fdcintr(arg)
! 334: void *arg;
! 335: {
! 336: #if NFD > 0
! 337: struct fdc_softc *fdc = arg;
! 338: extern int fdintr(struct fdc_softc *);
! 339:
! 340: /* Will switch on device type, shortly. */
! 341: return (fdintr(fdc));
! 342: #else
! 343: printf("fdcintr: got interrupt, but no devices!\n");
! 344: return (1);
! 345: #endif
! 346: }
CVSweb
![[BACK]](/icons/back.gif){kind=icon}
Return to fdc.c CVS log ![[TXT]](/icons/text.gif){kind=icon}
![[DIR]](/icons/dir.gif){kind=icon}
Up to [local] / sys / dev / isa