NetBSD/sys/arch/evbppc/explora/dev/pckbc_elb.c

124 lines
3.6 KiB
C

/* $NetBSD: pckbc_elb.c,v 1.6 2008/04/28 20:23:17 martin Exp $ */
/*-
* Copyright (c) 2003 The NetBSD Foundation, Inc.
* All rights reserved.
*
* This code is derived from software contributed to The NetBSD Foundation
* by Juergen Hannken-Illjes.
*
* 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: pckbc_elb.c,v 1.6 2008/04/28 20:23:17 martin Exp $");
#include <sys/param.h>
#include <sys/conf.h>
#include <sys/device.h>
#include <sys/systm.h>
#include <sys/malloc.h>
#include <machine/bus.h>
#include <dev/ic/i8042reg.h>
#include <dev/ic/pckbcvar.h>
#include <evbppc/explora/dev/elbvar.h>
struct pckbc_elb_softc {
struct pckbc_softc sc_pckbc;
int sc_irq;
};
static int pckbc_elb_probe(device_t, cfdata_t, void *);
static void pckbc_elb_attach(device_t, device_t, void *);
static void pckbc_elb_intr_establish(struct pckbc_softc *, pckbc_slot_t);
CFATTACH_DECL_NEW(pckbc_elb, sizeof(struct pckbc_elb_softc),
pckbc_elb_probe, pckbc_elb_attach, NULL, NULL);
int
pckbc_elb_probe(device_t parent, cfdata_t cf, void *aux)
{
struct elb_attach_args *oaa = aux;
if (strcmp(oaa->elb_name, cf->cf_name) != 0)
return 0;
return (1);
}
void
pckbc_elb_attach(device_t parent, device_t self, void *aux)
{
struct pckbc_elb_softc *msc = device_private(self);
struct pckbc_softc *sc = &msc->sc_pckbc;
struct elb_attach_args *eaa = aux;
struct pckbc_internal *t;
sc->sc_dv = self;
/*
* Setup interrupt data.
*/
msc->sc_irq = eaa->elb_irq;
sc->intr_establish = pckbc_elb_intr_establish;
if (pckbc_is_console(eaa->elb_bt, eaa->elb_base)) {
t = &pckbc_consdata;
pckbc_console_attached = 1;
} else {
t = malloc(sizeof(struct pckbc_internal), M_DEVBUF, M_WAITOK);
memset(t, 0, sizeof(struct pckbc_internal));
}
t->t_iot = eaa->elb_bt;
bus_space_map(eaa->elb_bt,
_BUS_SPACE_UNSTRIDE(eaa->elb_bt, eaa->elb_base), 1, 0, &t->t_ioh_d);
bus_space_map(eaa->elb_bt,
_BUS_SPACE_UNSTRIDE(eaa->elb_bt, eaa->elb_base2), 1, 0, &t->t_ioh_c);
t->t_addr = eaa->elb_base;
t->t_sc = sc;
sc->id = t;
aprint_normal("\n");
pckbc_attach(sc);
}
static void
pckbc_elb_intr_establish(struct pckbc_softc *sc, pckbc_slot_t slot)
{
struct pckbc_elb_softc *msc = (void *)sc;
int irq = msc->sc_irq;
/*
* We ignore slot since all slots use the same interrupt.
*/
if (irq >= 0)
intr_establish(irq, IST_LEVEL, IPL_SERIAL, pckbcintr, sc);
irq = -1;
}