NetBSD/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);
}