#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 "hidkbd.h"
#if NHIDKBD > 0
#include <dev/hid/hidkbdvar.h>
#endif
#define BEEP_CTRL 0
#define BEEP_CNT_0 2
#define BEEP_CNT_1 3
#define BEEP_CNT_2 4
#define BEEP_CNT_3 5
#define BEEP_CTRL_ON 0x01
#define BEEP_CTRL_OFF 0x00
struct beep_freq {
int freq;
u_int32_t reg;
};
struct beep_softc {
struct device sc_dev;
bus_space_tag_t sc_iot;
bus_space_handle_t sc_ioh;
int sc_clk;
struct beep_freq sc_freqs[9];
struct timeout sc_to;
int sc_belltimeout;
int sc_bellactive;
};
int beep_match(struct device *, void *, void *);
void beep_attach(struct device *, struct device *, void *);
void beep_setfreq(struct beep_softc *, int);
const struct cfattach beep_ca = {
sizeof(struct beep_softc), beep_match, beep_attach
};
struct cfdriver beep_cd = {
NULL, "beep", DV_DULL
};
#if NHIDKBD > 0
void beep_stop(void *);
void beep_bell(void *, u_int, u_int, u_int, int);
#endif
int
beep_match(struct device *parent, void *match, void *aux)
{
struct ebus_attach_args *ea = aux;
if (strcmp(ea->ea_name, "beep") == 0)
return (1);
return (0);
}
void
beep_attach(struct device *parent, struct device *self, void *aux)
{
struct beep_softc *sc = (void *)self;
struct ebus_attach_args *ea = aux;
int i;
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;
}
sc->sc_clk = getpropint(findroot(), "clock-frequency", 0);
sc->sc_clk /= 2;
for (i = 0; i < 9; i++) {
sc->sc_freqs[i].reg = 1 << (18 - i);
sc->sc_freqs[i].freq = sc->sc_clk / sc->sc_freqs[i].reg;
}
beep_setfreq(sc, 1200);
#if 0
bus_space_write_1(sc->sc_iot, sc->sc_ioh, BEEP_CTRL,
BEEP_CTRL_ON);
for (i = 0; i < 1000; i++)
DELAY(1000);
bus_space_write_1(sc->sc_iot, sc->sc_ioh, BEEP_CTRL,
BEEP_CTRL_OFF);
#endif
printf(": clock %sMHz\n", clockfreq(sc->sc_clk));
#if NHIDKBD > 0
timeout_set(&sc->sc_to, beep_stop, sc);
hidkbd_hookup_bell(beep_bell, sc);
#endif
}
void
beep_setfreq(struct beep_softc *sc, int freq)
{
int i, n, selected = -1;
n = sizeof(sc->sc_freqs)/sizeof(sc->sc_freqs[0]);
if (freq < sc->sc_freqs[0].freq)
selected = 0;
if (freq > sc->sc_freqs[n - 1].freq)
selected = n - 1;
for (i = 1; selected == -1 && i < n; i++) {
if (sc->sc_freqs[i].freq == freq)
selected = i;
else if (sc->sc_freqs[i].freq > freq) {
int diff1, diff2;
diff1 = freq - sc->sc_freqs[i - 1].freq;
diff2 = sc->sc_freqs[i].freq - freq;
if (diff1 < diff2)
selected = i - 1;
else
selected = i;
}
}
if (selected == -1)
selected = 0;
bus_space_write_1(sc->sc_iot, sc->sc_ioh, BEEP_CNT_0,
(sc->sc_freqs[selected].reg >> 24) & 0xff);
bus_space_write_1(sc->sc_iot, sc->sc_ioh, BEEP_CNT_1,
(sc->sc_freqs[selected].reg >> 16) & 0xff);
bus_space_write_1(sc->sc_iot, sc->sc_ioh, BEEP_CNT_2,
(sc->sc_freqs[selected].reg >> 8) & 0xff);
bus_space_write_1(sc->sc_iot, sc->sc_ioh, BEEP_CNT_3,
(sc->sc_freqs[selected].reg >> 0) & 0xff);
}
#if NHIDKBD > 0
void
beep_stop(void *vsc)
{
struct beep_softc *sc = vsc;
int s;
s = spltty();
bus_space_write_1(sc->sc_iot, sc->sc_ioh, BEEP_CTRL,
BEEP_CTRL_OFF);
sc->sc_bellactive = 0;
sc->sc_belltimeout = 0;
splx(s);
}
void
beep_bell(void *vsc, u_int pitch, u_int period, u_int volume, int poll)
{
struct beep_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 || volume == 0) {
beep_stop(sc);
splx(s);
return;
}
if (!sc->sc_bellactive) {
sc->sc_bellactive = 1;
sc->sc_belltimeout = 1;
bus_space_write_1(sc->sc_iot, sc->sc_ioh, BEEP_CTRL,
BEEP_CTRL_ON);
timeout_add_msec(&sc->sc_to, period);
}
splx(s);
}
#endif