#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/device.h>
#include <sys/conf.h>
#include <sys/timeout.h>
#include <machine/bus.h>
#include <machine/autoconf.h>
#include <machine/openfirm.h>
#include <sparc64/dev/ebusreg.h>
#include <sparc64/dev/ebusvar.h>
#include "pckbd.h"
#if NPCKBD > 0
#include <dev/ic/pckbcvar.h>
#include <dev/pckbc/pckbdvar.h>
#endif
struct beeper_softc {
struct device sc_dev;
bus_space_tag_t sc_iot;
bus_space_handle_t sc_ioh;
struct timeout sc_to;
int sc_belltimeout, sc_bellactive;
};
#define BEEP_REG 0
int beeper_match(struct device *, void *, void *);
void beeper_attach(struct device *, struct device *, void *);
const struct cfattach beeper_ca = {
sizeof(struct beeper_softc), beeper_match, beeper_attach
};
struct cfdriver beeper_cd = {
NULL, "beeper", DV_DULL
};
#if NPCKBD > 0
void beeper_stop(void *);
void beeper_bell(void *, u_int, u_int, u_int, int);
#endif
int
beeper_match(struct device *parent, void *match, void *aux)
{
struct ebus_attach_args *ea = aux;
if (strcmp(ea->ea_name, "beeper") == 0)
return (1);
return (0);
}
void
beeper_attach(struct device *parent, struct device *self, void *aux)
{
struct beeper_softc *sc = (void *)self;
struct ebus_attach_args *ea = aux;
sc->sc_iot = ea->ea_memtag;
if (ea->ea_nvaddrs) {
if (bus_space_map(sc->sc_iot, ea->ea_vaddrs[0], 0,
BUS_SPACE_MAP_PROMADDRESS, &sc->sc_ioh)) {
printf(": can't map PROM register space\n");
return;
}
} else if (ebus_bus_map(sc->sc_iot, 0,
EBUS_PADDR_FROM_REG(&ea->ea_regs[0]), ea->ea_regs[0].size, 0, 0,
&sc->sc_ioh) != 0) {
printf(": can't map register space\n");
return;
}
#if NPCKBD > 0
timeout_set(&sc->sc_to, beeper_stop, sc);
pckbd_hookup_bell(beeper_bell, sc);
#endif
printf("\n");
}
#if NPCKBD > 0
void
beeper_stop(void *vsc)
{
struct beeper_softc *sc = vsc;
int s;
s = spltty();
bus_space_write_4(sc->sc_iot, sc->sc_ioh, BEEP_REG, 0);
sc->sc_bellactive = 0;
sc->sc_belltimeout = 0;
splx(s);
}
void
beeper_bell(void *vsc, u_int pitch, u_int period, u_int volume, int poll)
{
struct beeper_softc *sc = vsc;
int s;
s = spltty();
if (sc->sc_bellactive) {
if (sc->sc_belltimeout == 0)
timeout_del(&sc->sc_to);
}
if (pitch == 0 || period == 0) {
beeper_stop(sc);
splx(s);
return;
}
if (!sc->sc_bellactive) {
sc->sc_bellactive = 1;
sc->sc_belltimeout = 1;
bus_space_write_4(sc->sc_iot, sc->sc_ioh, BEEP_REG, 1);
timeout_add_msec(&sc->sc_to, period);
}
splx(s);
}
#endif