/* $NetBSD: fdc_acpi.c,v 1.43 2015/04/13 16:33:23 riastradh Exp $ */ /* * Copyright (c) 2002 Jared D. McNeill * All rights reserved. * * 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. The name of the author may not be used to endorse or promote products * derived from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 AUTHOR 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. */ /* * ACPI attachment for the PC Floppy Controller driver, based on * sys/arch/i386/pnpbios/fdc_pnpbios.c by Jason R. Thorpe */ #include __KERNEL_RCSID(0, "$NetBSD: fdc_acpi.c,v 1.43 2015/04/13 16:33:23 riastradh Exp $"); #include #include #include #include #include #include #include #include #include #include #include #define _COMPONENT ACPI_RESOURCE_COMPONENT ACPI_MODULE_NAME ("fdc_acpi") static int fdc_acpi_match(device_t, cfdata_t, void *); static void fdc_acpi_attach(device_t, device_t, void *); struct fdc_acpi_softc { struct fdc_softc sc_fdc; bus_space_handle_t sc_baseioh; struct acpi_devnode *sc_node; /* ACPI devnode */ }; static int fdc_acpi_enumerate(struct fdc_acpi_softc *); static void fdc_acpi_getknownfds(struct fdc_acpi_softc *); static const struct fd_type *fdc_acpi_nvtotype(const char *, int, int); CFATTACH_DECL_NEW(fdc_acpi, sizeof(struct fdc_acpi_softc), fdc_acpi_match, fdc_acpi_attach, NULL, NULL); /* * Supported device IDs */ static const char * const fdc_acpi_ids[] = { "PNP07??", /* PC standard floppy disk controller */ NULL }; /* * fdc_acpi_match: autoconf(9) match routine */ static int fdc_acpi_match(device_t parent, cfdata_t match, void *aux) { struct acpi_attach_args *aa = aux; if (aa->aa_node->ad_type != ACPI_TYPE_DEVICE) return 0; return acpi_match_hid(aa->aa_node->ad_devinfo, fdc_acpi_ids); } /* * fdc_acpi_attach: autoconf(9) attach routine */ static void fdc_acpi_attach(device_t parent, device_t self, void *aux) { struct fdc_acpi_softc *asc = device_private(self); struct fdc_softc *sc = &asc->sc_fdc; struct acpi_attach_args *aa = aux; struct acpi_io *io, *ctlio; struct acpi_irq *irq; struct acpi_drq *drq; struct acpi_resources res; ACPI_STATUS rv; sc->sc_dev = self; sc->sc_ic = aa->aa_ic; asc->sc_node = aa->aa_node; /* parse resources */ rv = acpi_resource_parse(sc->sc_dev, aa->aa_node->ad_handle, "_CRS", &res, &acpi_resource_parse_ops_default); if (ACPI_FAILURE(rv)) return; /* find our i/o registers */ io = acpi_res_io(&res, 0); if (io == NULL) { aprint_error_dev(sc->sc_dev, "unable to find i/o register resource\n"); goto out; } /* find our IRQ */ irq = acpi_res_irq(&res, 0); if (irq == NULL) { aprint_error_dev(sc->sc_dev, "unable to find irq resource\n"); goto out; } /* find our DRQ */ drq = acpi_res_drq(&res, 0); if (drq == NULL) { aprint_error_dev(sc->sc_dev, "unable to find drq resource\n"); goto out; } sc->sc_drq = drq->ar_drq; sc->sc_iot = aa->aa_iot; if (bus_space_map(sc->sc_iot, io->ar_base, io->ar_length, 0, &asc->sc_baseioh)) { aprint_error_dev(sc->sc_dev, "can't map i/o space\n"); goto out; } switch (io->ar_length) { case 4: sc->sc_ioh = asc->sc_baseioh; break; case 6: if (bus_space_subregion(sc->sc_iot, asc->sc_baseioh, 2, 4, &sc->sc_ioh)) { aprint_error_dev(sc->sc_dev, "unable to subregion i/o space\n"); goto out; } break; default: aprint_error_dev(sc->sc_dev, "unknown size: %d of io mapping\n", io->ar_length); goto out; } /* * omitting the controller I/O port. (One has to exist for there to * be a working fdc). Just try and force the mapping in. */ ctlio = acpi_res_io(&res, 1); if (ctlio == NULL) { if (bus_space_map(sc->sc_iot, io->ar_base + io->ar_length + 1, 1, 0, &sc->sc_fdctlioh)) { aprint_error_dev(sc->sc_dev, "unable to force map ctl i/o space\n"); goto out; } aprint_verbose_dev(sc->sc_dev, "ctl io %x did't probe. Forced attach\n", io->ar_base + io->ar_length + 1); } else { if (bus_space_map(sc->sc_iot, ctlio->ar_base, ctlio->ar_length, 0, &sc->sc_fdctlioh)) { aprint_error_dev(sc->sc_dev, "unable to map ctl i/o space\n"); goto out; } } sc->sc_ih = isa_intr_establish(aa->aa_ic, irq->ar_irq, (irq->ar_type == ACPI_EDGE_SENSITIVE) ? IST_EDGE : IST_LEVEL, IPL_BIO, fdcintr, sc); /* Setup direct configuration of floppy drives */ sc->sc_present = fdc_acpi_enumerate(asc); if (sc->sc_present >= 0) { sc->sc_known = 1; fdc_acpi_getknownfds(asc); } else { /* * XXX if there is no _FDE control method, attempt to * probe without pnp */ aprint_debug_dev(sc->sc_dev, "unable to enumerate, attempting normal probe\n"); } fdcattach(sc); out: acpi_resource_cleanup(&res); } static int fdc_acpi_enumerate(struct fdc_acpi_softc *asc) { struct fdc_softc *sc = &asc->sc_fdc; ACPI_OBJECT *fde; ACPI_BUFFER abuf; ACPI_STATUS rv; uint32_t *p; int i, drives = -1; rv = acpi_eval_struct(asc->sc_node->ad_handle, "_FDE", &abuf); if (ACPI_FAILURE(rv)) { aprint_normal_dev(sc->sc_dev, "failed to evaluate _FDE: %s\n", AcpiFormatException(rv)); return drives; } fde = abuf.Pointer; if (fde->Type != ACPI_TYPE_BUFFER) { aprint_error_dev(sc->sc_dev, "expected BUFFER, got %u\n", fde->Type); goto out; } if (fde->Buffer.Length < 5 * sizeof(uint32_t)) { aprint_error_dev(sc->sc_dev, "expected buffer len of %lu, got %u\n", (unsigned long)(5 * sizeof(uint32_t)), fde->Buffer.Length); goto out; } p = (uint32_t *)fde->Buffer.Pointer; /* * Indexes 0 through 3 are each uint32_t booleans. True if a drive * is present. */ drives = 0; for (i = 0; i < 4; i++) { if (p[i]) drives |= (1 << i); aprint_normal_dev(sc->sc_dev, "drive %d %sattached\n", i, p[i] ? "" : "not "); } /* * p[4] reports tape presence. Possible values: * 0 - Unknown if device is present * 1 - Device is present * 2 - Device is never present * >2 - Reserved * * we don't currently use this. */ out: ACPI_FREE(abuf.Pointer); return drives; } static void fdc_acpi_getknownfds(struct fdc_acpi_softc *asc) { struct fdc_softc *sc = &asc->sc_fdc; ACPI_OBJECT *fdi, *e; ACPI_BUFFER abuf; ACPI_STATUS rv; int i; for (i = 0; i < 4; i++) { if ((sc->sc_present & (1 << i)) == 0) continue; rv = acpi_eval_struct(asc->sc_node->ad_handle, "_FDI", &abuf); if (ACPI_FAILURE(rv)) { aprint_normal_dev(sc->sc_dev, "failed to evaluate _FDI: %s on drive %d\n", AcpiFormatException(rv), i); /* XXX if _FDI fails, assume 1.44MB floppy */ sc->sc_knownfds[i] = &fdc_acpi_fdtypes[0]; continue; } fdi = abuf.Pointer; if (fdi->Type != ACPI_TYPE_PACKAGE) { aprint_error_dev(sc->sc_dev, "expected PACKAGE, got %u\n", fdi->Type); goto out; } e = fdi->Package.Elements; sc->sc_knownfds[i] = fdc_acpi_nvtotype( device_xname(sc->sc_dev), e[1].Integer.Value, e[0].Integer.Value); /* if fdc_acpi_nvtotype returns NULL, don't attach drive */ if (!sc->sc_knownfds[i]) sc->sc_present &= ~(1 << i); out: ACPI_FREE(abuf.Pointer); } } static const struct fd_type * fdc_acpi_nvtotype(const char *fdc, int nvraminfo, int drive) { int type; type = (drive == 0 ? nvraminfo : nvraminfo << 4) & 0xf0; switch (type) { case ACPI_FDC_DISKETTE_NONE: return NULL; case ACPI_FDC_DISKETTE_12M: return &fdc_acpi_fdtypes[1]; case ACPI_FDC_DISKETTE_TYPE5: case ACPI_FDC_DISKETTE_TYPE6: case ACPI_FDC_DISKETTE_144M: return &fdc_acpi_fdtypes[0]; case ACPI_FDC_DISKETTE_360K: return &fdc_acpi_fdtypes[3]; case ACPI_FDC_DISKETTE_720K: return &fdc_acpi_fdtypes[4]; default: aprint_normal("%s: drive %d: unknown device type 0x%x\n", fdc, drive, type); return NULL; } }