402 lines
9.9 KiB
C
402 lines
9.9 KiB
C
/* $NetBSD: vrkiu.c,v 1.37 2005/12/11 12:17:34 christos Exp $ */
|
|
|
|
/*-
|
|
* Copyright (c) 1999 SASAKI Takesi All rights reserved.
|
|
* Copyright (c) 1999, 2000, 2002 TAKEMRUA, Shin All rights reserved.
|
|
* Copyright (c) 1999 PocketBSD Project. All rights reserved.
|
|
*
|
|
* 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.
|
|
* 3. All advertising materials mentioning features or use of this software
|
|
* must display the following acknowledgement:
|
|
* This product includes software developed by the PocketBSD project
|
|
* and its contributors.
|
|
* 4. Neither the name of the project nor the names of its contributors
|
|
* may be used to endorse or promote products derived from this software
|
|
* without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE REGENTS 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 REGENTS 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: vrkiu.c,v 1.37 2005/12/11 12:17:34 christos Exp $");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/tty.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/device.h>
|
|
#include <sys/conf.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/proc.h>
|
|
|
|
#include <machine/intr.h>
|
|
#include <machine/cpu.h>
|
|
#include <machine/bus.h>
|
|
#include <machine/platid.h>
|
|
#include <machine/platid_mask.h>
|
|
|
|
#include <dev/hpc/hpckbdvar.h>
|
|
|
|
#include <hpcmips/vr/vr.h>
|
|
#include <hpcmips/vr/vripif.h>
|
|
#include <hpcmips/vr/vrkiureg.h>
|
|
#include <hpcmips/vr/vrkiuvar.h>
|
|
#include <hpcmips/vr/icureg.h>
|
|
|
|
#include "opt_wsdisplay_compat.h"
|
|
#include "opt_pckbd_layout.h"
|
|
#include <dev/wscons/wsconsio.h>
|
|
#include <dev/wscons/wskbdvar.h>
|
|
#include <dev/wscons/wsksymdef.h>
|
|
#include <dev/wscons/wsksymvar.h>
|
|
#ifdef WSDISPLAY_COMPAT_RAWKBD
|
|
#include <dev/hpc/pckbd_encode.h>
|
|
#endif
|
|
|
|
#define VRKIUDEBUG
|
|
#ifdef VRKIUDEBUG
|
|
int vrkiu_debug = 0;
|
|
#define DPRINTF(arg) if (vrkiu_debug) printf arg;
|
|
#else
|
|
#define DPRINTF(arg)
|
|
#endif
|
|
|
|
static int vrkiumatch(struct device *, struct cfdata *, void *);
|
|
static void vrkiuattach(struct device *, struct device *, void *);
|
|
|
|
int vrkiu_intr(void *);
|
|
|
|
static int vrkiu_init(struct vrkiu_chip *, bus_space_tag_t, bus_space_handle_t);
|
|
static void vrkiu_write(struct vrkiu_chip *, int, unsigned short);
|
|
static unsigned short vrkiu_read(struct vrkiu_chip *, int);
|
|
static int vrkiu_is_console(bus_space_tag_t, bus_space_handle_t);
|
|
static void vrkiu_scan(struct vrkiu_chip *);
|
|
static int countbits(int);
|
|
static void eliminate_phantom_keys(struct vrkiu_chip *, unsigned short *);
|
|
static int vrkiu_poll(void*);
|
|
static int vrkiu_input_establish(void*, struct hpckbd_if*);
|
|
|
|
CFATTACH_DECL(vrkiu, sizeof(struct vrkiu_softc),
|
|
vrkiumatch, vrkiuattach, NULL, NULL);
|
|
|
|
struct vrkiu_chip *vrkiu_consdata = NULL;
|
|
|
|
static inline void
|
|
vrkiu_write(struct vrkiu_chip *chip, int port, unsigned short val)
|
|
{
|
|
|
|
bus_space_write_2(chip->kc_iot, chip->kc_ioh, port, val);
|
|
}
|
|
|
|
static inline unsigned short
|
|
vrkiu_read(struct vrkiu_chip *chip, int port)
|
|
{
|
|
|
|
return (bus_space_read_2(chip->kc_iot, chip->kc_ioh, port));
|
|
}
|
|
|
|
static inline int
|
|
vrkiu_is_console(bus_space_tag_t iot, bus_space_handle_t ioh)
|
|
{
|
|
|
|
if (vrkiu_consdata &&
|
|
vrkiu_consdata->kc_iot == iot &&
|
|
vrkiu_consdata->kc_ioh == ioh) {
|
|
return (1);
|
|
} else {
|
|
return (0);
|
|
}
|
|
}
|
|
|
|
static int
|
|
vrkiumatch(struct device *parent, struct cfdata *cf, void *aux)
|
|
{
|
|
|
|
return (1);
|
|
}
|
|
|
|
static void
|
|
vrkiuattach(struct device *parent, struct device *self, void *aux)
|
|
{
|
|
struct vrkiu_softc *sc = (struct vrkiu_softc *)self;
|
|
struct vrip_attach_args *va = aux;
|
|
struct hpckbd_attach_args haa;
|
|
int isconsole, res;
|
|
|
|
bus_space_tag_t iot = va->va_iot;
|
|
bus_space_handle_t ioh;
|
|
|
|
if (va->va_parent_ioh != 0)
|
|
res = bus_space_subregion(iot, va->va_parent_ioh, va->va_addr,
|
|
va->va_size, &ioh);
|
|
else
|
|
res = bus_space_map(iot, va->va_addr, 1, 0, &ioh);
|
|
if (res != 0) {
|
|
printf(": can't map bus space\n");
|
|
return;
|
|
}
|
|
|
|
isconsole = vrkiu_is_console(iot, ioh);
|
|
if (isconsole) {
|
|
sc->sc_chip = vrkiu_consdata;
|
|
} else {
|
|
sc->sc_chip = &sc->sc_chip_body;
|
|
vrkiu_init(sc->sc_chip, iot, ioh);
|
|
}
|
|
sc->sc_chip->kc_sc = sc;
|
|
|
|
if (!(sc->sc_handler =
|
|
vrip_intr_establish(va->va_vc, va->va_unit, 0, IPL_TTY,
|
|
vrkiu_intr, sc))) {
|
|
printf (": can't map interrupt line.\n");
|
|
return;
|
|
}
|
|
/* Level2 register setting */
|
|
vrip_intr_setmask2(va->va_vc, sc->sc_handler, KIUINT_KDATRDY, 1);
|
|
|
|
printf("\n");
|
|
|
|
/* attach hpckbd */
|
|
haa.haa_ic = &sc->sc_chip->kc_if;
|
|
config_found(self, &haa, hpckbd_print);
|
|
}
|
|
|
|
/*
|
|
* initialize device
|
|
*/
|
|
static int
|
|
vrkiu_init(struct vrkiu_chip *chip, bus_space_tag_t iot,
|
|
bus_space_handle_t ioh)
|
|
{
|
|
|
|
memset(chip, 0, sizeof(struct vrkiu_chip));
|
|
chip->kc_iot = iot;
|
|
chip->kc_ioh = ioh;
|
|
chip->kc_enabled = 0;
|
|
|
|
chip->kc_if.hii_ctx = chip;
|
|
chip->kc_if.hii_establish = vrkiu_input_establish;
|
|
chip->kc_if.hii_poll = vrkiu_poll;
|
|
|
|
/* set KIU */
|
|
vrkiu_write(chip, KIURST, 1); /* reset */
|
|
vrkiu_write(chip, KIUSCANLINE, 0); /* 96keys */
|
|
vrkiu_write(chip, KIUWKS, 0x18a4); /* XXX: scan timing! */
|
|
vrkiu_write(chip, KIUWKI, 450);
|
|
vrkiu_write(chip, KIUSCANREP, 0x8023);
|
|
/* KEYEN | STPREP = 2 | ATSTP | ATSCAN */
|
|
|
|
return (0);
|
|
}
|
|
|
|
int
|
|
vrkiu_intr(void *arg)
|
|
{
|
|
struct vrkiu_softc *sc = arg;
|
|
|
|
/* When key scan finisshed, this entry is called. */
|
|
#if 0
|
|
DPRINTF(("vrkiu_intr: intr=%x scan=%x\n",
|
|
vrkiu_read(sc->sc_chip, KIUINT) & 7,
|
|
vrkiu_read(sc->sc_chip, KIUSCANS) & KIUSCANS_SSTAT_MASK));
|
|
#endif
|
|
|
|
/*
|
|
* First, we must clear the interrupt register because
|
|
* vrkiu_scan() may takes long time if a bitmap screen
|
|
* scrolls up and it makes us to miss some key release
|
|
* event.
|
|
*/
|
|
vrkiu_write(sc->sc_chip, KIUINT, 0x7); /* Clear all interrupt */
|
|
|
|
#if 1
|
|
/* just return if kiu is scanning keyboard. */
|
|
if ((vrkiu_read(sc->sc_chip, KIUSCANS) & KIUSCANS_SSTAT_MASK) ==
|
|
KIUSCANS_SSTAT_SCANNING)
|
|
return (0);
|
|
#endif
|
|
vrkiu_scan(sc->sc_chip);
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
countbits(int d)
|
|
{
|
|
int i, n;
|
|
|
|
for (i = 0, n = 0; i < NBBY; i++)
|
|
if (d & (1 << i))
|
|
n++;
|
|
return (n);
|
|
}
|
|
|
|
static void
|
|
eliminate_phantom_keys(struct vrkiu_chip *chip, unsigned short *scandata)
|
|
{
|
|
unsigned char inkey[KIU_NSCANLINE], *prevkey, *reskey;
|
|
int i, j;
|
|
#ifdef VRKIUDEBUG
|
|
int modified = 0;
|
|
static int prevmod = 0;
|
|
#endif
|
|
|
|
reskey = (unsigned char *)scandata;
|
|
for (i = 0; i < KIU_NSCANLINE; i++)
|
|
inkey[i] = reskey[i];
|
|
prevkey = (unsigned char *)chip->kc_scandata;
|
|
|
|
for (i = 0; i < KIU_NSCANLINE; i++) {
|
|
if (countbits(inkey[i]) > 1) {
|
|
for (j = 0; j < KIU_NSCANLINE; j++) {
|
|
if (i != j && (inkey[i] & inkey[j])) {
|
|
#ifdef VRKIUDEBUG
|
|
modified = 1;
|
|
if (!prevmod) {
|
|
DPRINTF(("vrkiu_scan: %x:%02x->%02x",
|
|
i, inkey[i], prevkey[i]));
|
|
DPRINTF((" %x:%02x->%02x\n",
|
|
j, inkey[j], prevkey[j]));
|
|
}
|
|
#endif
|
|
reskey[i] = prevkey[i];
|
|
reskey[j] = prevkey[j];
|
|
}
|
|
}
|
|
}
|
|
}
|
|
#ifdef VRKIUDEBUG
|
|
prevmod = modified;
|
|
#endif
|
|
}
|
|
|
|
static void
|
|
vrkiu_scan(struct vrkiu_chip* chip)
|
|
{
|
|
int i, j, modified, mask;
|
|
unsigned short scandata[KIU_NSCANLINE/2];
|
|
|
|
if (!chip->kc_enabled)
|
|
return;
|
|
|
|
for (i = 0; i < KIU_NSCANLINE / 2; i++) {
|
|
scandata[i] = vrkiu_read(chip, KIUDATP + i * 2);
|
|
}
|
|
eliminate_phantom_keys(chip, scandata);
|
|
|
|
for (i = 0; i < KIU_NSCANLINE / 2; i++) {
|
|
modified = scandata[i] ^ chip->kc_scandata[i];
|
|
chip->kc_scandata[i] = scandata[i];
|
|
mask = 1;
|
|
for (j = 0; j < 16; j++, mask <<= 1) {
|
|
/*
|
|
* Simultaneous keypresses are resolved by registering
|
|
* the one with the lowest bit index first.
|
|
*/
|
|
if (modified & mask) {
|
|
int key = i * 16 + j;
|
|
DPRINTF(("vrkiu_scan: %s(%d,%d)\n",
|
|
(scandata[i] & mask) ? "down" : "up",
|
|
i, j));
|
|
hpckbd_input(chip->kc_hpckbd,
|
|
(scandata[i] & mask), key);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
/* called from bicons.c */
|
|
int
|
|
vrkiu_getc()
|
|
{
|
|
static int flag = 1;
|
|
|
|
/*
|
|
* XXX, currently
|
|
*/
|
|
if (flag) {
|
|
flag = 0;
|
|
printf("%s(%d): vrkiu_getc() is not implemented\n",
|
|
__FILE__, __LINE__);
|
|
}
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* hpckbd interface routines
|
|
*/
|
|
int
|
|
vrkiu_input_establish(void *ic, struct hpckbd_if *kbdif)
|
|
{
|
|
struct vrkiu_chip *kc = ic;
|
|
|
|
/* save hpckbd interface */
|
|
kc->kc_hpckbd = kbdif;
|
|
|
|
kc->kc_enabled = 1;
|
|
|
|
return (0);
|
|
}
|
|
|
|
int
|
|
vrkiu_poll(void *ic)
|
|
{
|
|
struct vrkiu_chip *kc = ic;
|
|
|
|
#if 1
|
|
/* wait until kiu completes keyboard scan. */
|
|
while ((vrkiu_read(kc, KIUSCANS) & KIUSCANS_SSTAT_MASK) ==
|
|
KIUSCANS_SSTAT_SCANNING)
|
|
/* wait until kiu completes keyboard scan */;
|
|
#endif
|
|
|
|
vrkiu_scan(kc);
|
|
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* console support routine
|
|
*/
|
|
int
|
|
vrkiu_cnattach(bus_space_tag_t iot, int iobase)
|
|
{
|
|
static struct vrkiu_chip vrkiu_consdata_body;
|
|
bus_space_handle_t ioh;
|
|
|
|
if (vrkiu_consdata) {
|
|
panic("vrkiu is already attached as the console");
|
|
}
|
|
if (bus_space_map(iot, iobase, 1, 0, &ioh)) {
|
|
printf("%s(%d): can't map bus space\n", __FILE__, __LINE__);
|
|
return (-1);
|
|
}
|
|
|
|
if (vrkiu_init(&vrkiu_consdata_body, iot, ioh) != 0) {
|
|
DPRINTF(("%s(%d): vrkiu_init() failed\n", __FILE__, __LINE__));
|
|
return (-1);
|
|
}
|
|
vrkiu_consdata = &vrkiu_consdata_body;
|
|
|
|
hpckbd_cnattach(&vrkiu_consdata_body.kc_if);
|
|
|
|
return (0);
|
|
}
|