root/sys/dev/isa/ess_isa.c
/*      $NetBSD: ess_isa.c,v 1.24 2010/05/22 16:35:00 tsutsui Exp $     */

/*-
 * Copyright (c) 1999 The NetBSD Foundation, Inc.
 * All rights reserved.
 *
 * This code is derived from software contributed to The NetBSD Foundation
 * by Nathan J. Williams.
 *
 * 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. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
 * ``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 FOUNDATION OR CONTRIBUTORS
 * 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.
 */

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: ess_isa.c,v 1.24 2010/05/22 16:35:00 tsutsui Exp $");

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

#include <sys/cpu.h>
#include <sys/bus.h>

#include <dev/isa/isavar.h>

#include <dev/isa/essreg.h>
#include <dev/isa/essvar.h>

#include "joy_ess.h"

#ifdef ESS_ISA_DEBUG
#define DPRINTF(x)      printf x
#else
#define DPRINTF(x)      {}
#endif

int ess_isa_probe(device_t, cfdata_t, void *);
void ess_isa_attach(device_t, device_t, void *);

CFATTACH_DECL_NEW(ess_isa, sizeof(struct ess_softc),
    ess_isa_probe, ess_isa_attach, NULL, NULL);

int
ess_isa_probe(device_t parent, cfdata_t match, void *aux)
{
        int ret;
        struct isa_attach_args *ia;
        struct ess_softc probesc, *sc;

        ia = aux;
        sc= &probesc;
        if (ia->ia_nio < 1)
                return 0;
        if (ia->ia_nirq < 1)
                return 0;
        if (ia->ia_ndrq < 1)
                return 0;

        if (ISA_DIRECT_CONFIG(ia))
                return 0;

        memset(sc, 0, sizeof *sc);

        sc->sc_ic = ia->ia_ic;
        sc->sc_iot = ia->ia_iot;
        sc->sc_iobase = ia->ia_io[0].ir_addr;
        if (bus_space_map(sc->sc_iot, sc->sc_iobase, ESS_NPORT, 0,
            &sc->sc_ioh)) {
                DPRINTF(("ess_isa_probe: Couldn't map I/O region at %x, "
                    "size %x\n", sc->sc_iobase, ESS_NPORT));
                return 0;
        }

        sc->sc_audio1.irq = ia->ia_irq[0].ir_irq;
        sc->sc_audio1.ist = IST_EDGE;
        sc->sc_audio1.drq = ia->ia_drq[0].ir_drq;
        sc->sc_audio2.irq = -1;
        sc->sc_audio2.drq = (ia->ia_ndrq > 1) ? ia->ia_drq[1].ir_drq : -1;

        ret = essmatch(sc);

        bus_space_unmap(sc->sc_iot, sc->sc_ioh, ESS_NPORT);

        if (ret) {
                DPRINTF(("ess_isa_probe succeeded (score %d)\n", ret));
                ia->ia_nio = 1;
                ia->ia_io[0].ir_size = ESS_NPORT;

                ia->ia_nirq = 1;

                if (ia->ia_ndrq > 1 &&
                    ia->ia_drq[1].ir_drq != ISA_UNKNOWN_DRQ)
                        ia->ia_ndrq = 2;
                else
                        ia->ia_ndrq = 1;

                ia->ia_niomem = 0;
        } else
                DPRINTF(("ess_isa_probe failed\n"));

        return ret;
}

void
ess_isa_attach(device_t parent, device_t self, void *aux)
{
        struct ess_softc *sc;
        struct isa_attach_args *ia;
        int enablejoy;

        sc = device_private(self);

        sc->sc_dev = self;
        ia = aux;
        enablejoy = 0;

        aprint_naive("\n");
        aprint_normal("\n");

        sc->sc_ic = ia->ia_ic;
        sc->sc_iot = ia->ia_iot;
        sc->sc_iobase = ia->ia_io[0].ir_addr;
        if (bus_space_map(sc->sc_iot, sc->sc_iobase, ESS_NPORT, 0,
            &sc->sc_ioh)) {
                DPRINTF(("ess_isa_attach: Couldn't map I/O region at %x, "
                    "size %x\n", sc->sc_iobase, ESS_NPORT));
                return;
        }

        sc->sc_audio1.irq = ia->ia_irq[0].ir_irq;
        sc->sc_audio1.ist = IST_EDGE;
        sc->sc_audio1.drq = ia->ia_drq[0].ir_drq;
        sc->sc_audio2.irq = -1;
        sc->sc_audio2.drq = ia->ia_ndrq > 1 ? ia->ia_drq[1].ir_drq : -1;

#if NJOY_ESS > 0
        if (device_cfdata(self)->cf_flags & 1) {
                sc->sc_joy_iot = ia->ia_iot;
                if (!bus_space_map(sc->sc_joy_iot, 0x201, 1, 0,
                                   &sc->sc_joy_ioh))
                        enablejoy = 1;
        }
#endif

        aprint_normal_dev(self, "");

        essattach(sc, enablejoy);
}