fdc_acpi.c revision 1.5
1 /* $NetBSD: fdc_acpi.c,v 1.5 2003/01/09 12:18:38 jdolecek Exp $ */ 2 3 /* 4 * Copyright (c) 2002 Jared D. McNeill <jmcneill (at) invisible.ca> 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions and the following disclaimer. 12 * 2. The name of the author may not be used to endorse or promote products 13 * derived from this software without specific prior written permission. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 16 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 17 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 18 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 19 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 20 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 21 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 22 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 23 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25 * SUCH DAMAGE. 26 */ 27 28 /* 29 * ACPI attachment for the PC Floppy Controller driver, based on 30 * sys/arch/i386/pnpbios/fdc_pnpbios.c by Jason R. Thorpe 31 */ 32 33 #include <sys/cdefs.h> 34 __KERNEL_RCSID(0, "$NetBSD: fdc_acpi.c,v 1.5 2003/01/09 12:18:38 jdolecek Exp $"); 35 36 #include "rnd.h" 37 38 #include <sys/param.h> 39 #include <sys/systm.h> 40 #include <sys/callout.h> 41 #include <sys/device.h> 42 #include <sys/buf.h> 43 #include <sys/queue.h> 44 #include <sys/disk.h> 45 #include <sys/dkstat.h> 46 #if NRND > 0 47 #include <sys/rnd.h> 48 #endif 49 50 #include <machine/bus.h> 51 #include <machine/intr.h> 52 53 #include <dev/isa/isavar.h> 54 #include <dev/isa/isadmavar.h> 55 56 #include <dev/acpi/acpica.h> 57 #include <dev/acpi/acpireg.h> 58 #include <dev/acpi/acpivar.h> 59 60 #include <dev/isa/fdcvar.h> 61 #include <dev/isa/fdvar.h> 62 #include <dev/isa/fdreg.h> 63 64 #include <dev/acpi/fdc_acpireg.h> 65 66 int fdc_acpi_match(struct device *, struct cfdata *, void *); 67 void fdc_acpi_attach(struct device *, struct device *, void *); 68 69 struct fdc_acpi_softc { 70 struct fdc_softc sc_fdc; 71 bus_space_handle_t sc_baseioh; 72 struct acpi_devnode *sc_node; /* ACPI devnode */ 73 }; 74 75 static int fdc_acpi_enumerate(struct fdc_acpi_softc *); 76 static void fdc_acpi_getknownfds(struct fdc_acpi_softc *); 77 78 static const struct fd_type *fdc_acpi_nvtotype(char *, int, int); 79 80 CFATTACH_DECL(fdc_acpi, sizeof(struct fdc_acpi_softc), fdc_acpi_match, 81 fdc_acpi_attach, NULL, NULL); 82 83 /* 84 * Supported device IDs 85 */ 86 87 static const char * const fdc_acpi_ids[] = { 88 "PNP0700", /* PC standard floppy disk controller */ 89 #if 0 /* XXX do we support this? */ 90 "PNP0701", /* Standard floppy controller for MS Device Bay Spec */ 91 #endif 92 NULL 93 }; 94 95 /* 96 * fdc_acpi_match: autoconf(9) match routine 97 */ 98 int 99 fdc_acpi_match(struct device *parent, struct cfdata *match, void *aux) 100 { 101 struct acpi_attach_args *aa = aux; 102 const char *id; 103 int i; 104 105 if (aa->aa_node->ad_type != ACPI_TYPE_DEVICE) 106 return 0; 107 108 for (i = 0; (id = fdc_acpi_ids[i]) != NULL; ++i) { 109 if (strcmp(aa->aa_node->ad_devinfo.HardwareId, id) == 0) 110 return 1; 111 } 112 113 /* No matches found */ 114 return 0; 115 } 116 117 /* 118 * fdc_acpi_attach: autoconf(9) attach routine 119 */ 120 void 121 fdc_acpi_attach(struct device *parent, struct device *self, void *aux) 122 { 123 struct fdc_acpi_softc *asc = (struct fdc_acpi_softc *)self; 124 struct fdc_softc *sc = &asc->sc_fdc; 125 struct acpi_attach_args *aa = aux; 126 struct acpi_resources res; 127 struct acpi_io *io, *ctlio; 128 struct acpi_irq *irq; 129 struct acpi_drq *drq; 130 ACPI_STATUS rv; 131 132 printf("\n"); 133 134 sc->sc_ic = aa->aa_ic; 135 asc->sc_node = aa->aa_node; 136 137 /* parse resources */ 138 rv = acpi_resource_parse(&sc->sc_dev, aa->aa_node, &res, 139 &acpi_resource_parse_ops_default); 140 if (rv != AE_OK) { 141 printf("%s: unable to parse resources\n", sc->sc_dev.dv_xname); 142 return; 143 } 144 145 /* find our i/o registers */ 146 io = acpi_res_io(&res, 0); 147 if (io == NULL) { 148 printf("%s: unable to find i/o register resource\n", 149 sc->sc_dev.dv_xname); 150 return; 151 } 152 153 /* find our IRQ */ 154 irq = acpi_res_irq(&res, 0); 155 if (irq == NULL) { 156 printf("%s: unable to find irq resource\n", 157 sc->sc_dev.dv_xname); 158 return; 159 } 160 161 /* find our DRQ */ 162 drq = acpi_res_drq(&res, 0); 163 if (drq == NULL) { 164 printf("%s: unable to find drq resource\n", 165 sc->sc_dev.dv_xname); 166 return; 167 } 168 sc->sc_drq = drq->ar_drq; 169 170 sc->sc_iot = aa->aa_iot; 171 if (bus_space_map(sc->sc_iot, io->ar_base, io->ar_length, 172 0, &asc->sc_baseioh)) { 173 printf("%s: can't map i/o space\n", sc->sc_dev.dv_xname); 174 return; 175 } 176 177 switch (io->ar_length) { 178 case 4: 179 sc->sc_ioh = asc->sc_baseioh; 180 break; 181 case 6: 182 if (bus_space_subregion(sc->sc_iot, asc->sc_baseioh, 2, 4, 183 &sc->sc_ioh)) { 184 printf("%s: unable to subregion i/o space\n", 185 sc->sc_dev.dv_xname); 186 return; 187 } 188 break; 189 default: 190 printf("%s: unknown size: %d of io mapping\n", 191 sc->sc_dev.dv_xname, io->ar_length); 192 return; 193 } 194 195 /* 196 * omitting the controller I/O port. (One has to exist for there to 197 * be a working fdc). Just try and force the mapping in. 198 */ 199 ctlio = acpi_res_io(&res, 1); 200 if (ctlio == NULL) { 201 if (bus_space_map(sc->sc_iot, io->ar_base + io->ar_length + 1, 202 1, 0, &sc->sc_fdctlioh)) { 203 printf("%s: unable to force map ctl i/o space\n", 204 sc->sc_dev.dv_xname); 205 return; 206 } 207 printf("%s: ctl io %x did't probe. Forced attach\n", 208 sc->sc_dev.dv_xname, io->ar_base + io->ar_length + 1); 209 } else { 210 if (bus_space_map(sc->sc_iot, ctlio->ar_base, ctlio->ar_length, 211 0, &sc->sc_fdctlioh)) { 212 printf("%s: unable to map ctl i/o space\n", 213 sc->sc_dev.dv_xname); 214 return; 215 } 216 } 217 218 sc->sc_ih = isa_intr_establish(aa->aa_ic, irq->ar_irq, 0, 219 IPL_BIO, fdcintr, sc); 220 221 /* Setup direct configuration of floppy drives */ 222 sc->sc_present = fdc_acpi_enumerate(asc); 223 if (sc->sc_present >= 0) { 224 sc->sc_known = 1; 225 fdc_acpi_getknownfds(asc); 226 } else { 227 /* 228 * XXX if there is no _FDE control method, attempt to 229 * probe without pnp 230 */ 231 #ifdef ACPI_FDC_DEBUG 232 printf("%s: unable to enumerate, attempting normal probe\n", 233 sc->sc_dev.dv_xname); 234 #endif 235 } 236 237 fdcattach(sc); 238 } 239 240 static int 241 fdc_acpi_enumerate(struct fdc_acpi_softc *asc) 242 { 243 struct fdc_softc *sc = &asc->sc_fdc; 244 ACPI_OBJECT *fde; 245 ACPI_BUFFER buf; 246 ACPI_STATUS rv; 247 UINT32 *p; 248 int i, drives = -1; 249 250 rv = acpi_eval_struct(asc->sc_node->ad_handle, "_FDE", &buf); 251 if (rv != AE_OK) { 252 #ifdef ACPI_FDC_DEBUG 253 printf("%s: failed to evalulate _FDE: %x\n", 254 sc->sc_dev.dv_xname, rv); 255 #endif 256 return drives; 257 } 258 fde = (ACPI_OBJECT *)buf.Pointer; 259 if (fde->Type != ACPI_TYPE_BUFFER) { 260 printf("%s: expected BUFFER, got %d\n", sc->sc_dev.dv_xname, 261 fde->Type); 262 goto out; 263 } 264 if (fde->Buffer.Length < 5 * sizeof(UINT32)) { 265 printf("%s: expected buffer len of %d, got %d\n", 266 sc->sc_dev.dv_xname, 267 5 * sizeof(UINT32), fde->Buffer.Length); 268 goto out; 269 } 270 271 p = (UINT32 *) fde->Buffer.Pointer; 272 273 /* 274 * Indexes 0 through 3 are each UINT32 booleans. True if a drive 275 * is present. 276 */ 277 drives = 0; 278 for (i = 0; i < 4; i++) { 279 if (p[i]) drives |= (1 << i); 280 #ifdef ACPI_FDC_DEBUG 281 printf("%s: drive %d %sattached\n", sc->sc_dev.dv_xname, i, 282 p[i] ? "" : "not "); 283 #endif 284 } 285 286 /* 287 * p[4] reports tape presence. Possible values: 288 * 0 - Unknown if device is present 289 * 1 - Device is present 290 * 2 - Device is never present 291 * >2 - Reserved 292 * 293 * we don't currently use this. 294 */ 295 296 out: 297 AcpiOsFree(buf.Pointer); 298 return drives; 299 } 300 301 static void 302 fdc_acpi_getknownfds(struct fdc_acpi_softc *asc) 303 { 304 struct fdc_softc *sc = &asc->sc_fdc; 305 ACPI_OBJECT *fdi, *e; 306 ACPI_BUFFER buf; 307 ACPI_STATUS rv; 308 int i; 309 310 for (i = 0; i < 4; i++) { 311 if ((sc->sc_present & (1 << i)) == 0) 312 continue; 313 rv = acpi_eval_struct(asc->sc_node->ad_handle, "_FDI", &buf); 314 if (rv != AE_OK) { 315 #ifdef ACPI_FDC_DEBUG 316 printf("%s: failed to evalulate _FDI: %x on drive %d\n", 317 sc->sc_dev.dv_xname, rv, i); 318 #endif 319 /* XXX if _FDI fails, assume 1.44MB floppy */ 320 sc->sc_knownfds[i] = &fdc_acpi_fdtypes[0]; 321 continue; 322 } 323 fdi = (ACPI_OBJECT *)buf.Pointer; 324 if (fdi->Type != ACPI_TYPE_PACKAGE) { 325 printf("%s: expected PACKAGE, got %d\n", 326 sc->sc_dev.dv_xname, fdi->Type); 327 goto out; 328 } 329 e = fdi->Package.Elements; 330 sc->sc_knownfds[i] = fdc_acpi_nvtotype(sc->sc_dev.dv_xname, 331 e[1].Integer.Value, e[0].Integer.Value); 332 333 /* if fdc_acpi_nvtotype returns NULL, don't attach drive */ 334 if (!sc->sc_knownfds[i]) 335 sc->sc_present &= ~(1 << i); 336 337 out: 338 AcpiOsFree(buf.Pointer); 339 } 340 } 341 342 static const struct fd_type * 343 fdc_acpi_nvtotype(char *fdc, int nvraminfo, int drive) 344 { 345 int type; 346 347 type = (drive == 0 ? nvraminfo : nvraminfo << 4) & 0xf0; 348 switch (type) { 349 case ACPI_FDC_DISKETTE_NONE: 350 return NULL; 351 case ACPI_FDC_DISKETTE_12M: 352 return &fdc_acpi_fdtypes[1]; 353 case ACPI_FDC_DISKETTE_TYPE5: 354 case ACPI_FDC_DISKETTE_TYPE6: 355 case ACPI_FDC_DISKETTE_144M: 356 return &fdc_acpi_fdtypes[0]; 357 case ACPI_FDC_DISKETTE_360K: 358 return &fdc_acpi_fdtypes[3]; 359 case ACPI_FDC_DISKETTE_720K: 360 return &fdc_acpi_fdtypes[4]; 361 default: 362 #ifdef ACPI_FDC_DEBUG 363 printf("%s: drive %d: unknown device type 0x%x\n", 364 fdc, drive, type); 365 #endif 366 return NULL; 367 } 368 } 369
Indexes created Tue Sep 23 07:09:52 GMT 2025