1 /* $OpenBSD: fdc.c,v 1.20 2015/03/14 03:38:47 jsg 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/disk.h> 53 #include <sys/buf.h> 54 #include <sys/malloc.h> 55 #include <sys/uio.h> 56 #include <sys/mtio.h> 57 #include <sys/syslog.h> 58 #include <sys/queue.h> 59 #include <sys/timeout.h> 60 61 #include <machine/cpu.h> 62 #include <machine/bus.h> 63 #include <machine/conf.h> 64 #include <machine/intr.h> 65 #include <machine/ioctl_fd.h> 66 67 #include <dev/isa/isavar.h> 68 #include <dev/isa/fdreg.h> 69 70 #if defined(__i386__) || defined(__amd64__) /* XXX */ 71 #include <dev/ic/mc146818reg.h> /* for NVRAM access */ 72 #include <i386/isa/nvram.h> 73 #endif 74 75 #include <dev/isa/fdlink.h> 76 77 #include "fd.h" 78 79 /* controller driver configuration */ 80 int fdcprobe(struct device *, void *, void *); 81 void fdcattach(struct device *, struct device *, void *); 82 83 struct cfattach fdc_ca = { 84 sizeof(struct fdc_softc), fdcprobe, fdcattach 85 }; 86 87 struct cfdriver fdc_cd = { 88 NULL, "fdc", DV_DULL 89 }; 90 91 int fddprint(void *, const char *); 92 int fdcintr(void *); 93 94 int 95 fdcprobe(struct device *parent, void *match, void *aux) 96 { 97 register struct isa_attach_args *ia = aux; 98 bus_space_tag_t iot; 99 bus_space_handle_t ioh; 100 bus_space_handle_t ioh_ctl; 101 int rv; 102 103 iot = ia->ia_iot; 104 rv = 0; 105 106 /* Map the i/o space. */ 107 if (bus_space_map(iot, ia->ia_iobase, FDC_NPORT, 0, &ioh)) 108 return 0; 109 if (bus_space_map(iot, ia->ia_iobase + FDCTL_OFFSET, 110 FDCTL_NPORT, 0, &ioh_ctl)) 111 return 0; 112 113 /* reset */ 114 bus_space_write_1(iot, ioh, fdout, 0); 115 delay(100); 116 bus_space_write_1(iot, ioh, fdout, FDO_FRST); 117 118 /* see if it can handle a command */ 119 if (out_fdc(iot, ioh, NE7CMD_SPECIFY) < 0) 120 goto out; 121 out_fdc(iot, ioh, 0xdf); 122 out_fdc(iot, ioh, 2); 123 124 rv = 1; 125 ia->ia_iosize = FDC_NPORT; 126 ia->ia_msize = 0; 127 128 out: 129 bus_space_unmap(iot, ioh, FDC_NPORT); 130 bus_space_unmap(iot, ioh_ctl, FDCTL_NPORT); 131 return rv; 132 } 133 134 void 135 fdcattach(struct device *parent, struct device *self, void *aux) 136 { 137 struct fdc_softc *fdc = (void *)self; 138 bus_space_tag_t iot; 139 bus_space_handle_t ioh; 140 bus_space_handle_t ioh_ctl; 141 struct isa_attach_args *ia = aux; 142 struct fdc_attach_args fa; 143 int type; 144 145 iot = ia->ia_iot; 146 147 /* Re-map the I/O space. */ 148 if (bus_space_map(iot, ia->ia_iobase, FDC_NPORT, 0, &ioh) || 149 bus_space_map(iot, ia->ia_iobase + FDCTL_OFFSET, 150 FDCTL_NPORT, 0, &ioh_ctl)) 151 panic("fdcattach: couldn't map I/O ports"); 152 153 fdc->sc_iot = iot; 154 fdc->sc_ioh = ioh; 155 fdc->sc_ioh_ctl = ioh_ctl; 156 157 fdc->sc_drq = ia->ia_drq; 158 fdc->sc_state = DEVIDLE; 159 TAILQ_INIT(&fdc->sc_link.fdlink.sc_drives); /* XXX */ 160 161 printf("\n"); 162 163 fdc->sc_ih = isa_intr_establish(ia->ia_ic, ia->ia_irq, IST_EDGE, 164 IPL_BIO, fdcintr, fdc, fdc->sc_dev.dv_xname); 165 166 #if defined(__i386__) || defined(__amd64__) 167 /* 168 * The NVRAM info only tells us about the first two disks on the 169 * `primary' floppy controller. 170 */ 171 if (fdc->sc_dev.dv_unit == 0) 172 type = mc146818_read(NULL, NVRAM_DISKETTE); /* XXX softc */ 173 else 174 #endif 175 type = -1; 176 177 timeout_set(&fdc->fdcpseudointr_to, fdcpseudointr, fdc); 178 179 /* physical limit: four drives per controller. */ 180 for (fa.fa_drive = 0; fa.fa_drive < 4; fa.fa_drive++) { 181 fa.fa_flags = 0; 182 fa.fa_type = 0; 183 #if NFD > 0 184 if (type >= 0 && fa.fa_drive < 2) 185 fa.fa_deftype = fd_nvtotype(fdc->sc_dev.dv_xname, 186 type, fa.fa_drive); 187 else 188 #endif 189 fa.fa_deftype = NULL; /* unknown */ 190 (void)config_found(self, (void *)&fa, fddprint); 191 } 192 } 193 194 /* 195 * Print the location of a disk/tape drive (called just before attaching the 196 * the drive). If `fdc' is not NULL, the drive was found but was not 197 * in the system config file; print the drive name as well. 198 * Return QUIET (config_find ignores this if the device was configured) to 199 * avoid printing `fdN not configured' messages. 200 */ 201 int 202 fddprint(void *aux, const char *fdc) 203 { 204 register struct fdc_attach_args *fa = aux; 205 206 if (!fdc) 207 printf(" drive %d", fa->fa_drive); 208 return QUIET; 209 } 210 211 int 212 fdcresult(struct fdc_softc *fdc) 213 { 214 bus_space_tag_t iot = fdc->sc_iot; 215 bus_space_handle_t ioh = fdc->sc_ioh; 216 u_char i; 217 int j = 100000, n = 0; 218 219 for (; j; j--) { 220 i = bus_space_read_1(iot, ioh, fdsts) & 221 (NE7_DIO | NE7_RQM | NE7_CB); 222 if (i == NE7_RQM) 223 return n; 224 if (i == (NE7_DIO | NE7_RQM | NE7_CB)) { 225 if (n >= sizeof(fdc->sc_status)) { 226 log(LOG_ERR, "fdcresult: overrun\n"); 227 return -1; 228 } 229 fdc->sc_status[n++] = 230 bus_space_read_1(iot, ioh, fddata); 231 } 232 delay(10); 233 } 234 return -1; 235 } 236 237 int 238 out_fdc(bus_space_tag_t iot, bus_space_handle_t ioh, u_char x) 239 { 240 int i = 100000; 241 242 while ((bus_space_read_1(iot, ioh, fdsts) & NE7_DIO) && i-- > 0); 243 if (i <= 0) 244 return -1; 245 while ((bus_space_read_1(iot, ioh, fdsts) & NE7_RQM) == 0 && i-- > 0); 246 if (i <= 0) 247 return -1; 248 bus_space_write_1(iot, ioh, fddata, x); 249 return 0; 250 } 251 252 void 253 fdcstart(struct fdc_softc *fdc) 254 { 255 256 #ifdef DIAGNOSTIC 257 /* only got here if controller's drive queue was inactive; should 258 be in idle state */ 259 if (fdc->sc_state != DEVIDLE) { 260 printf("fdcstart: not idle\n"); 261 return; 262 } 263 #endif 264 (void) fdcintr(fdc); 265 } 266 267 void 268 fdcstatus(struct device *dv, int n, char *s) 269 { 270 struct fdc_softc *fdc = (void *)dv->dv_parent; 271 272 if (n == 0) { 273 out_fdc(fdc->sc_iot, fdc->sc_ioh, NE7CMD_SENSEI); 274 (void) fdcresult(fdc); 275 n = 2; 276 } 277 278 printf("%s: %s", dv->dv_xname, s); 279 280 switch (n) { 281 case 0: 282 printf("\n"); 283 break; 284 case 2: 285 printf(" (st0 %b cyl %d)\n", 286 fdc->sc_status[0], NE7_ST0BITS, 287 fdc->sc_status[1]); 288 break; 289 case 7: 290 printf(" (st0 %b st1 %b st2 %b cyl %d head %d sec %d)\n", 291 fdc->sc_status[0], NE7_ST0BITS, 292 fdc->sc_status[1], NE7_ST1BITS, 293 fdc->sc_status[2], NE7_ST2BITS, 294 fdc->sc_status[3], fdc->sc_status[4], fdc->sc_status[5]); 295 break; 296 #ifdef DIAGNOSTIC 297 default: 298 printf("\nfdcstatus: weird size"); 299 break; 300 #endif 301 } 302 } 303 304 void 305 fdcpseudointr(void *arg) 306 { 307 int s; 308 309 /* Just ensure it has the right spl. */ 310 s = splbio(); 311 (void) fdcintr(arg); 312 splx(s); 313 } 314 315 int 316 fdcintr(void *arg) 317 { 318 #if NFD > 0 319 struct fdc_softc *fdc = arg; 320 extern int fdintr(struct fdc_softc *); 321 322 /* Will switch on device type, shortly. */ 323 return (fdintr(fdc)); 324 #else 325 printf("fdcintr: got interrupt, but no devices!\n"); 326 return (1); 327 #endif 328 } 329