#include "libsa.h"
#include <sys/param.h>
#include <sys/disklabel.h>
#include <machine/pdc.h>
#include <machine/iomod.h>
#include <dev/cons.h>
#include "dev_hppa.h"
iodcio_t cniodc;
iodcio_t kyiodc;
pz_device_t *cons_pzdev, *kbd_pzdev;
char cnbuf[IODC_MINIOSIZ] __attribute__ ((aligned (IODC_MINIOSIZ)));
int kycode[IODC_MAXSIZE/sizeof(int)];
int
cnspeed(dev_t dev, int sp)
{
return CONSPEED;
}
void
ite_probe(cn)
struct consdev *cn;
{
cniodc = (iodcio_t)PAGE0->mem_free;
cons_pzdev = &PAGE0->mem_cons;
kbd_pzdev = &PAGE0->mem_kbd;
if ((*pdc) (PDC_IODC, PDC_IODC_READ, pdcbuf, cons_pzdev->pz_hpa,
IODC_INIT, cniodc, IODC_MAXSIZE) < 0 ||
(*cniodc)(cons_pzdev->pz_hpa,
(cons_pzdev->pz_hpa==PAGE0->mem_boot.pz_hpa)?
IODC_INIT_DEV: IODC_INIT_ALL, cons_pzdev->pz_spa,
cons_pzdev->pz_layers, pdcbuf, 0,0,0,0) < 0 ||
(*pdc) (PDC_IODC, PDC_IODC_READ, pdcbuf, cons_pzdev->pz_hpa,
IODC_IO, cniodc, IODC_MAXSIZE) < 0) {
cons_pzdev->pz_iodc_io = kbd_pzdev->pz_iodc_io = NULL;
} else {
cn->cn_pri = CN_MIDPRI;
cn->cn_dev = makedev(0, 0);
}
}
void
ite_init(cn)
struct consdev *cn;
{
if (cons_pzdev->pz_class != PCL_DUPLEX ||
kbd_pzdev->pz_class == PCL_KEYBD) {
kyiodc = (iodcio_t)kycode;
if ((*pdc) (PDC_IODC, PDC_IODC_READ, pdcbuf, kbd_pzdev->pz_hpa,
IODC_INIT, kyiodc, IODC_MAXSIZE) < 0 ||
(*kyiodc)(kbd_pzdev->pz_hpa,
(kbd_pzdev->pz_hpa == PAGE0->mem_boot.pz_hpa ||
kbd_pzdev->pz_hpa == cons_pzdev->pz_hpa)?
IODC_INIT_DEV: IODC_INIT_ALL, kbd_pzdev->pz_spa,
kbd_pzdev->pz_layers, pdcbuf, 0, 0, 0, 0) < 0 ||
(*pdc) (PDC_IODC, PDC_IODC_READ, pdcbuf, kbd_pzdev->pz_hpa,
IODC_IO, kyiodc, IODC_MAXSIZE))
kyiodc = NULL;
} else {
kyiodc = cniodc;
bcopy((char *)&PAGE0->mem_cons, (char *)&PAGE0->mem_kbd,
sizeof(struct pz_device));
}
cons_pzdev->pz_iodc_io = (u_int)cniodc;
kbd_pzdev->pz_iodc_io = (u_int)kyiodc;
#ifdef DEBUG
if (!kyiodc)
printf("ite_init: no kbd\n");
#endif
}
void
ite_putc(dev, c)
dev_t dev;
int c;
{
if (cniodc == NULL)
return;
*cnbuf = c;
(*cniodc)(cons_pzdev->pz_hpa, IODC_IO_CONSOUT, cons_pzdev->pz_spa,
cons_pzdev->pz_layers, pdcbuf, 0, cnbuf, 1, 0);
}
int
ite_getc(dev)
dev_t dev;
{
static int stash = 0;
int err, c, l, i;
if (kyiodc == NULL)
return(0x100);
if (stash) {
c = stash;
if (!(dev & 0x80))
stash = 0;
return c;
}
i = 16;
do {
err = (*kyiodc)(kbd_pzdev->pz_hpa, IODC_IO_CONSIN,
kbd_pzdev->pz_spa, kbd_pzdev->pz_layers,
pdcbuf, 0, cnbuf, 1, 0);
l = pdcbuf[0];
c = cnbuf[0];
#ifdef DEBUG
if (debug && err < 0)
printf("KBD input error: %d", err);
#endif
if (!i-- && (dev & 0x80) && l == 0) {
#ifdef DEBUG
if (debug > 2)
printf("ite_getc(0x%x): no char %d(%x)\n",
dev, l, c);
#endif
return (0);
}
} while(!l);
#if DEBUG
if (debug && l > 1)
printf("KBD input got too much (%d)\n", l);
if (debug > 3)
printf("kbd: \'%c\' (0x%x)\n", c, c);
#endif
if (dev & 0x80)
stash = c;
return (c);
}
void
ite_pollc(dev, on)
dev_t dev;
int on;
{
}