root/sys/dev/acpi/fdc_acpi.c
/* $NetBSD: fdc_acpi.c,v 1.47 2021/10/15 19:21:45 jmcneill Exp $ */

/*
 * Copyright (c) 2002 Jared D. McNeill <jmcneill@invisible.ca>
 * 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 <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: fdc_acpi.c,v 1.47 2021/10/15 19:21:45 jmcneill Exp $");

#include <sys/param.h>
#include <sys/device.h>
#include <sys/disk.h>
#include <sys/systm.h>

#include <dev/acpi/acpireg.h>
#include <dev/acpi/acpivar.h>
#include <dev/acpi/acpi_intr.h>

#include <dev/isa/isadmavar.h>
#include <dev/isa/fdcvar.h>
#include <dev/isa/fdvar.h>
#include <dev/isa/fdreg.h>

#include <dev/acpi/fdc_acpireg.h>

#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 struct device_compatible_entry compat_data[] = {
        { .compat = "PNP07??" }, /* PC standard floppy disk controller */
        DEVICE_COMPAT_EOL
};

/*
 * 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;

        return acpi_compatible_match(aa, compat_data);
}

/*
 * 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_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 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 = acpi_intr_establish(self,
            (uint64_t)(uintptr_t)aa->aa_node->ad_handle,
            IPL_BIO, false, fdcintr, sc, device_xname(self));
        if (sc->sc_ih == NULL) {
                aprint_error_dev(sc->sc_dev, "unable to establish interrupt\n");
                goto out;
        }

        /* 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_debug_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)) {
                        /* 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,
                            "_FDI: 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;
        }
}