#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: lcdkp_subr.c,v 1.7 2011/05/14 02:58:27 rmind Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/proc.h>
#include <sys/conf.h>
#include <sys/kernel.h>
#include <sys/types.h>
#include <machine/autoconf.h>
#include <sys/intr.h>
#include <sys/bus.h>
#include <dev/ic/lcdkp_subr.h>
#define HD_POLL_RATE (hz / 10)
static int lcdkp_poll(struct lcdkp_chip *);
static u_char lcdkp_scan(struct lcdkp_chip *, u_int8_t *);
void
lcdkp_attach_subr(struct lcdkp_chip *sc)
{
sc->sc_flags = 0x0;
mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NONE);
}
int
lcdkp_scankey(struct lcdkp_chip *sc)
{
int ret;
if ((sc->sc_knum == 0) || (sc->sc_kpad == NULL))
return 0;
mutex_enter(&sc->sc_lock);
if (!(sc->sc_flags & LCDKP_HAS_BUF)) {
u_int8_t b;
if (lcdkp_scan(sc, &b) != 0) {
sc->sc_buf = b;
sc->sc_flags |= LCDKP_HAS_BUF;
}
}
ret = (sc->sc_flags & LCDKP_HAS_BUF);
mutex_exit(&sc->sc_lock);
return ret;
}
int
lcdkp_readkey(struct lcdkp_chip *sc, u_int8_t *result)
{
int error;
if ((sc->sc_knum == 0) || (sc->sc_kpad == NULL))
return EIO;
mutex_enter(&sc->sc_lock);
if ( (error = lcdkp_poll(sc)) == 0) {
*result = sc->sc_buf;
sc->sc_flags &= ~LCDKP_HAS_BUF;
}
mutex_exit(&sc->sc_lock);
return 0;
}
static u_char
lcdkp_scan(struct lcdkp_chip *sc, u_int8_t *b)
{
u_int8_t i;
u_int8_t c;
c = lcdkp_dr_read(sc);
for (i = 0; i < sc->sc_knum; i++) {
if (sc->sc_kpad[i].x_keycode == c) {
*b = sc->sc_kpad[i].x_outcode;
return 1;
}
}
return 0;
}
static int
lcdkp_poll(struct lcdkp_chip *sc)
{
int error;
uint8_t b;
KASSERT(mutex_owned(&sc->sc_lock));
if (sc->sc_flags & LCDKP_HAS_BUF) {
return 0;
}
while (lcdkp_scan(sc, &b) == 0) {
error = mtsleep((void*)sc, PRIBIO | PCATCH, "kppoll",
HD_POLL_RATE, &sc->sc_lock);
if (error != EWOULDBLOCK) {
if (lcdkp_scan(sc, &b) != 0)
break;
return EINTR;
}
}
sc->sc_buf = b;
sc->sc_flags |= LCDKP_HAS_BUF;
return 0;
}