121 lines
2.7 KiB
C
121 lines
2.7 KiB
C
/* $NetBSD: joy_eap.c,v 1.9 2008/03/26 18:27:07 xtraeme Exp $ */
|
|
|
|
#include <sys/cdefs.h>
|
|
__KERNEL_RCSID(0, "$NetBSD: joy_eap.c,v 1.9 2008/03/26 18:27:07 xtraeme Exp $");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/device.h>
|
|
#include <sys/audioio.h>
|
|
#include <dev/audio_if.h>
|
|
#include <sys/bus.h>
|
|
|
|
#include <dev/pci/eapreg.h>
|
|
#include <dev/pci/eapvar.h>
|
|
#include <dev/ic/joyvar.h>
|
|
|
|
struct joy_eap_aa {
|
|
struct audio_attach_args aa_aaa;
|
|
bus_space_tag_t aa_iot;
|
|
bus_space_handle_t aa_ioh;
|
|
};
|
|
|
|
device_t
|
|
eap_joy_attach(device_t eapdev, struct eap_gameport_args *gpa)
|
|
{
|
|
int i;
|
|
bus_space_handle_t ioh;
|
|
u_int32_t icsc;
|
|
struct joy_eap_aa aa;
|
|
device_t joydev;
|
|
|
|
/*
|
|
* There are 4 possible locations. Just try to map one of them.
|
|
* XXX This is questionable for 2 reasons:
|
|
* - We don't know whether these addresses are usable on our
|
|
* PCI bus (might be a secondary one).
|
|
* - PCI probing is early. ISA devices might conflict.
|
|
*/
|
|
for (i = 0; i < 4; i++) {
|
|
if (bus_space_map(gpa->gpa_iot, 0x200 + i * 8, 1,
|
|
0, &ioh) == 0)
|
|
break;
|
|
}
|
|
if (i == 4)
|
|
return 0;
|
|
|
|
printf("%s: enabling gameport at legacy io port 0x%x\n",
|
|
eapdev->dv_xname, 0x200 + i * 8);
|
|
|
|
/* enable gameport on eap */
|
|
icsc = bus_space_read_4(gpa->gpa_iot, gpa->gpa_ioh, EAP_ICSC);
|
|
icsc &= ~E1371_JOY_ASELBITS;
|
|
icsc |= EAP_JYSTK_EN | E1371_JOY_ASEL(i);
|
|
bus_space_write_4(gpa->gpa_iot, gpa->gpa_ioh, EAP_ICSC, icsc);
|
|
|
|
aa.aa_aaa.type = AUDIODEV_TYPE_AUX;
|
|
aa.aa_iot = gpa->gpa_iot;
|
|
aa.aa_ioh = ioh;
|
|
joydev = config_found(eapdev, &aa, 0);
|
|
/* this cannot fail */
|
|
KASSERT(joydev != NULL);
|
|
|
|
return joydev;
|
|
}
|
|
|
|
int
|
|
eap_joy_detach(device_t joydev, struct eap_gameport_args *gpa)
|
|
{
|
|
int res;
|
|
struct joy_softc *sc = (struct joy_softc *)joydev;
|
|
u_int32_t icsc;
|
|
|
|
res = config_detach(joydev, 0);
|
|
if (res)
|
|
return res;
|
|
|
|
/* disable gameport on eap */
|
|
icsc = bus_space_read_4(gpa->gpa_iot, gpa->gpa_ioh, EAP_ICSC);
|
|
icsc &= ~EAP_JYSTK_EN;
|
|
bus_space_write_4(gpa->gpa_iot, gpa->gpa_ioh, EAP_ICSC, icsc);
|
|
|
|
bus_space_unmap(sc->sc_iot, sc->sc_ioh, 1);
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
joy_eap_match(device_t parent, cfdata_t match, void *aux)
|
|
{
|
|
struct joy_eap_aa *eaa = aux;
|
|
|
|
if (eaa->aa_aaa.type != AUDIODEV_TYPE_AUX)
|
|
return 0;
|
|
return 1;
|
|
}
|
|
|
|
static void
|
|
joy_eap_attach(device_t parent, device_t self, void *aux)
|
|
{
|
|
struct joy_softc *sc = device_private(self);
|
|
struct joy_eap_aa *eaa = aux;
|
|
|
|
aprint_normal("\n");
|
|
|
|
sc->sc_iot = eaa->aa_iot;
|
|
sc->sc_ioh = eaa->aa_ioh;
|
|
sc->sc_dev = self;
|
|
|
|
joyattach(sc);
|
|
}
|
|
|
|
static int
|
|
joy_eap_detach(device_t self, int flags)
|
|
{
|
|
|
|
return joydetach((struct joy_softc *)self, flags);
|
|
}
|
|
|
|
CFATTACH_DECL_NEW(joy_eap, sizeof (struct joy_softc),
|
|
joy_eap_match, joy_eap_attach, joy_eap_detach, NULL);
|