488 lines
11 KiB
C
488 lines
11 KiB
C
/* $NetBSD: pdc.c,v 1.19 2006/10/01 20:31:50 elad Exp $ */
|
|
|
|
/* $OpenBSD: pdc.c,v 1.14 2001/04/29 21:05:43 mickey Exp $ */
|
|
|
|
/*
|
|
* Copyright (c) 1998-2001 Michael Shalayeff
|
|
* 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 Michael Shalayeff.
|
|
* 4. The name of the author may not be used to endorse or promote products
|
|
* derived from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 AUTHOR 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 MIND,
|
|
* 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: pdc.c,v 1.19 2006/10/01 20:31:50 elad Exp $");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/device.h>
|
|
#include <sys/proc.h>
|
|
#include <sys/tty.h>
|
|
#include <sys/user.h>
|
|
#include <sys/callout.h>
|
|
#include <sys/conf.h>
|
|
#include <sys/kauth.h>
|
|
|
|
#include <dev/cons.h>
|
|
#include <dev/clock_subr.h>
|
|
|
|
#include <machine/pdc.h>
|
|
#include <machine/iomod.h>
|
|
#include <machine/autoconf.h>
|
|
|
|
#include <hp700/hp700/machdep.h>
|
|
|
|
typedef
|
|
struct pdc_softc {
|
|
struct device sc_dv;
|
|
struct tty *sc_tty;
|
|
struct callout sc_to;
|
|
} pdcsoftc_t;
|
|
|
|
pdcio_t pdc;
|
|
int pdcret[32] PDC_ALIGNMENT;
|
|
char pdc_consbuf[IODC_MINIOSIZ] PDC_ALIGNMENT;
|
|
iodcio_t pdc_cniodc, pdc_kbdiodc;
|
|
pz_device_t *pz_kbd, *pz_cons;
|
|
int CONADDR;
|
|
|
|
int pdcmatch(struct device *, struct cfdata *, void *);
|
|
void pdcattach(struct device *, struct device *, void *);
|
|
|
|
CFATTACH_DECL(pdc, sizeof(pdcsoftc_t),
|
|
pdcmatch, pdcattach, NULL, NULL);
|
|
|
|
extern struct cfdriver pdc_cd;
|
|
|
|
static int pdc_attached;
|
|
|
|
dev_type_open(pdcopen);
|
|
dev_type_close(pdcclose);
|
|
dev_type_read(pdcread);
|
|
dev_type_write(pdcwrite);
|
|
dev_type_ioctl(pdcioctl);
|
|
dev_type_stop(pdcstop);
|
|
dev_type_tty(pdctty);
|
|
dev_type_poll(pdcpoll);
|
|
|
|
const struct cdevsw pdc_cdevsw = {
|
|
pdcopen, pdcclose, pdcread, pdcwrite, pdcioctl,
|
|
pdcstop, pdctty, pdcpoll, nommap, ttykqfilter, D_TTY
|
|
};
|
|
|
|
void pdcstart(struct tty *);
|
|
void pdctimeout(void *);
|
|
int pdcparam(struct tty *, struct termios *);
|
|
int pdccnlookc(dev_t, int *);
|
|
|
|
static struct cnm_state pdc_cnm_state;
|
|
|
|
static int pdcgettod(todr_chip_handle_t, volatile struct timeval *);
|
|
static int pdcsettod(todr_chip_handle_t, volatile struct timeval *);
|
|
|
|
static struct pdc_tod tod PDC_ALIGNMENT;
|
|
|
|
void
|
|
pdc_init(void)
|
|
{
|
|
static struct todr_chip_handle todr = {
|
|
.todr_settime = pdcsettod,
|
|
.todr_gettime = pdcgettod,
|
|
};
|
|
static int kbd_iodc[IODC_MAXSIZE/sizeof(int)];
|
|
static int cn_iodc[IODC_MAXSIZE/sizeof(int)];
|
|
int err;
|
|
int pagezero_cookie;
|
|
|
|
pagezero_cookie = hp700_pagezero_map();
|
|
|
|
/* XXX locore've done it XXX pdc = (pdcio_t)PAGE0->mem_pdc; */
|
|
pz_kbd = &PAGE0->mem_kbd;
|
|
pz_cons = &PAGE0->mem_cons;
|
|
|
|
/* XXX should we reset the console/kbd here?
|
|
well, /boot did that for us anyway */
|
|
if ((err = pdc_call((iodcio_t)pdc, 0, PDC_IODC, PDC_IODC_READ,
|
|
pdcret, pz_cons->pz_hpa, IODC_IO, cn_iodc, IODC_MAXSIZE)) < 0 ||
|
|
(err = pdc_call((iodcio_t)pdc, 0, PDC_IODC, PDC_IODC_READ,
|
|
pdcret, pz_kbd->pz_hpa, IODC_IO, kbd_iodc, IODC_MAXSIZE)) < 0) {
|
|
#ifdef DEBUG
|
|
printf("pdc_init: failed reading IODC (%d)\n", err);
|
|
#endif
|
|
}
|
|
|
|
pdc_cniodc = (iodcio_t)cn_iodc;
|
|
pdc_kbdiodc = (iodcio_t)kbd_iodc;
|
|
|
|
/* XXX make pdc current console */
|
|
cn_tab = &constab[0];
|
|
/* TODO: detect that we are on cereal, and set CONADDR */
|
|
|
|
cn_init_magic(&pdc_cnm_state);
|
|
cn_set_magic("+++++");
|
|
|
|
hp700_pagezero_unmap(pagezero_cookie);
|
|
|
|
/* attach the TOD clock */
|
|
todr_attach(&todr);
|
|
}
|
|
|
|
int
|
|
pdcmatch(struct device *parent, struct cfdata *cf, void *aux)
|
|
{
|
|
struct confargs *ca = aux;
|
|
|
|
/* there could be only one */
|
|
if (pdc_attached || strcmp(ca->ca_name, "pdc"))
|
|
return 0;
|
|
|
|
return 1;
|
|
}
|
|
|
|
void
|
|
pdcattach(struct device *parent, struct device *self, void *aux)
|
|
{
|
|
struct pdc_softc *sc = (struct pdc_softc *)self;
|
|
|
|
pdc_attached = 1;
|
|
|
|
if (!pdc)
|
|
pdc_init();
|
|
|
|
printf("\n");
|
|
|
|
callout_init(&sc->sc_to);
|
|
}
|
|
|
|
int
|
|
pdcopen(dev_t dev, int flag, int mode, struct lwp *l)
|
|
{
|
|
int unit = minor(dev);
|
|
struct pdc_softc *sc;
|
|
struct tty *tp;
|
|
int s;
|
|
int error = 0, setuptimeout;
|
|
|
|
if (unit >= pdc_cd.cd_ndevs || (sc = pdc_cd.cd_devs[unit]) == NULL)
|
|
return ENXIO;
|
|
|
|
s = spltty();
|
|
|
|
if (sc->sc_tty)
|
|
tp = sc->sc_tty;
|
|
else
|
|
tty_attach(tp = sc->sc_tty = ttymalloc());
|
|
|
|
tp->t_oproc = pdcstart;
|
|
tp->t_param = pdcparam;
|
|
tp->t_dev = dev;
|
|
|
|
if (kauth_authorize_device_tty(l->l_cred, KAUTH_DEVICE_TTY_OPEN, tp)) {
|
|
splx(s);
|
|
return (EBUSY);
|
|
}
|
|
|
|
if ((tp->t_state & TS_ISOPEN) == 0) {
|
|
tp->t_state |= TS_CARR_ON;
|
|
ttychars(tp);
|
|
tp->t_iflag = TTYDEF_IFLAG;
|
|
tp->t_oflag = TTYDEF_OFLAG;
|
|
tp->t_cflag = TTYDEF_CFLAG|CLOCAL;
|
|
tp->t_lflag = TTYDEF_LFLAG;
|
|
tp->t_ispeed = tp->t_ospeed = 9600;
|
|
ttsetwater(tp);
|
|
|
|
setuptimeout = 1;
|
|
} else
|
|
setuptimeout = 0;
|
|
tp->t_state |= TS_CARR_ON;
|
|
|
|
splx(s);
|
|
|
|
error = (*tp->t_linesw->l_open)(dev, tp);
|
|
if (error == 0 && setuptimeout)
|
|
pdctimeout(sc);
|
|
|
|
return error;
|
|
}
|
|
|
|
int
|
|
pdcclose(dev_t dev, int flag, int mode, struct lwp *l)
|
|
{
|
|
int unit = minor(dev);
|
|
struct tty *tp;
|
|
struct pdc_softc *sc;
|
|
|
|
if (unit >= pdc_cd.cd_ndevs || (sc = pdc_cd.cd_devs[unit]) == NULL)
|
|
return ENXIO;
|
|
|
|
tp = sc->sc_tty;
|
|
callout_stop(&sc->sc_to);
|
|
(*tp->t_linesw->l_close)(tp, flag);
|
|
ttyclose(tp);
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
pdcread(dev_t dev, struct uio *uio, int flag)
|
|
{
|
|
int unit = minor(dev);
|
|
struct tty *tp;
|
|
struct pdc_softc *sc;
|
|
|
|
if (unit >= pdc_cd.cd_ndevs || (sc = pdc_cd.cd_devs[unit]) == NULL)
|
|
return ENXIO;
|
|
|
|
tp = sc->sc_tty;
|
|
return ((*tp->t_linesw->l_read)(tp, uio, flag));
|
|
}
|
|
|
|
int
|
|
pdcwrite(dev_t dev, struct uio *uio, int flag)
|
|
{
|
|
int unit = minor(dev);
|
|
struct tty *tp;
|
|
struct pdc_softc *sc;
|
|
|
|
if (unit >= pdc_cd.cd_ndevs || (sc = pdc_cd.cd_devs[unit]) == NULL)
|
|
return ENXIO;
|
|
|
|
tp = sc->sc_tty;
|
|
return ((*tp->t_linesw->l_write)(tp, uio, flag));
|
|
}
|
|
|
|
int
|
|
pdcpoll(dev_t dev, int events, struct lwp *l)
|
|
{
|
|
struct pdc_softc *sc = pdc_cd.cd_devs[minor(dev)];
|
|
struct tty *tp = sc->sc_tty;
|
|
|
|
return ((*tp->t_linesw->l_poll)(tp, events, l));
|
|
}
|
|
|
|
int
|
|
pdcioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct lwp *l)
|
|
{
|
|
int unit = minor(dev);
|
|
int error;
|
|
struct tty *tp;
|
|
struct pdc_softc *sc;
|
|
|
|
if (unit >= pdc_cd.cd_ndevs || (sc = pdc_cd.cd_devs[unit]) == NULL)
|
|
return ENXIO;
|
|
|
|
tp = sc->sc_tty;
|
|
error = (*tp->t_linesw->l_ioctl)(tp, cmd, data, flag, l);
|
|
if (error >= 0)
|
|
return error;
|
|
error = ttioctl(tp, cmd, data, flag, l);
|
|
if (error >= 0)
|
|
return error;
|
|
|
|
return ENOTTY;
|
|
}
|
|
|
|
int
|
|
pdcparam(struct tty *tp, struct termios *t)
|
|
{
|
|
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
pdcstart(struct tty *tp)
|
|
{
|
|
int s;
|
|
|
|
s = spltty();
|
|
if (tp->t_state & (TS_TTSTOP | TS_BUSY)) {
|
|
splx(s);
|
|
return;
|
|
}
|
|
if (tp->t_outq.c_cc <= tp->t_lowat) {
|
|
if (tp->t_state & TS_ASLEEP) {
|
|
tp->t_state &= ~TS_ASLEEP;
|
|
wakeup((caddr_t)&tp->t_outq);
|
|
}
|
|
selwakeup(&tp->t_wsel);
|
|
}
|
|
tp->t_state |= TS_BUSY;
|
|
while (tp->t_outq.c_cc != 0)
|
|
pdccnputc(tp->t_dev, getc(&tp->t_outq));
|
|
tp->t_state &= ~TS_BUSY;
|
|
splx(s);
|
|
}
|
|
|
|
void
|
|
pdcstop(struct tty *tp, int flag)
|
|
{
|
|
int s;
|
|
|
|
s = spltty();
|
|
if (tp->t_state & TS_BUSY)
|
|
if ((tp->t_state & TS_TTSTOP) == 0)
|
|
tp->t_state |= TS_FLUSH;
|
|
splx(s);
|
|
}
|
|
|
|
void
|
|
pdctimeout(void *v)
|
|
{
|
|
struct pdc_softc *sc = v;
|
|
struct tty *tp = sc->sc_tty;
|
|
int c;
|
|
|
|
while (pdccnlookc(tp->t_dev, &c)) {
|
|
cn_check_magic(tp->t_dev, c, pdc_cnm_state);
|
|
if (tp->t_state & TS_ISOPEN)
|
|
(*tp->t_linesw->l_rint)(c, tp);
|
|
}
|
|
callout_reset(&sc->sc_to, 1, pdctimeout, sc);
|
|
}
|
|
|
|
struct tty *
|
|
pdctty(dev_t dev)
|
|
{
|
|
int unit = minor(dev);
|
|
struct pdc_softc *sc;
|
|
|
|
if (unit >= pdc_cd.cd_ndevs || (sc = pdc_cd.cd_devs[unit]) == NULL)
|
|
return NULL;
|
|
|
|
return sc->sc_tty;
|
|
}
|
|
|
|
void
|
|
pdccnprobe(struct consdev *cn)
|
|
{
|
|
|
|
cn->cn_dev = makedev(22,0);
|
|
cn->cn_pri = CN_NORMAL;
|
|
}
|
|
|
|
void
|
|
pdccninit(struct consdev *cn)
|
|
{
|
|
#ifdef DEBUG
|
|
printf("pdc0: console init\n");
|
|
#endif
|
|
}
|
|
|
|
int
|
|
pdccnlookc(dev_t dev, int *cp)
|
|
{
|
|
int s, err, l, pagezero_cookie;
|
|
|
|
s = splhigh();
|
|
pagezero_cookie = hp700_pagezero_map();
|
|
err = pdc_call(pdc_kbdiodc, 0, pz_kbd->pz_hpa, IODC_IO_CONSIN,
|
|
pz_kbd->pz_spa, pz_kbd->pz_layers, pdcret, 0, pdc_consbuf, 1, 0);
|
|
l = pdcret[0];
|
|
*cp = pdc_consbuf[0];
|
|
hp700_pagezero_unmap(pagezero_cookie);
|
|
splx(s);
|
|
|
|
#ifdef DEBUG
|
|
if (err < 0)
|
|
printf("pdccnlookc: input error: %d\n", err);
|
|
#endif
|
|
return l;
|
|
}
|
|
|
|
int
|
|
pdccngetc(dev_t dev)
|
|
{
|
|
int c;
|
|
|
|
if (!pdc)
|
|
return 0;
|
|
while (!pdccnlookc(dev, &c))
|
|
;
|
|
return (c);
|
|
}
|
|
|
|
void
|
|
pdccnputc(dev_t dev, int c)
|
|
{
|
|
int s, err, pagezero_cookie;
|
|
|
|
s = splhigh();
|
|
pagezero_cookie = hp700_pagezero_map();
|
|
*pdc_consbuf = c;
|
|
err = pdc_call(pdc_cniodc, 0, pz_cons->pz_hpa, IODC_IO_CONSOUT,
|
|
pz_cons->pz_spa, pz_cons->pz_layers, pdcret, 0, pdc_consbuf, 1, 0);
|
|
hp700_pagezero_unmap(pagezero_cookie);
|
|
splx(s);
|
|
|
|
if (err < 0) {
|
|
#if defined(DDB) || defined(KGDB)
|
|
__asm volatile ("break %0, %1"
|
|
:: "i" (HPPA_BREAK_KERNEL), "i" (HPPA_BREAK_KGDB));
|
|
#endif /* DDB || KGDB */
|
|
delay(250000);
|
|
#if 0
|
|
/*
|
|
* It's not a good idea to use the output to print
|
|
* an output error.
|
|
*/
|
|
printf("pdccnputc: output error: %d\n", err);
|
|
#endif
|
|
}
|
|
}
|
|
|
|
void
|
|
pdccnpollc(dev_t dev, int on)
|
|
{
|
|
}
|
|
|
|
static int
|
|
pdcgettod(todr_chip_handle_t tch, volatile struct timeval *tvp)
|
|
{
|
|
int pagezero_cookie;
|
|
|
|
pagezero_cookie = hp700_pagezero_map();
|
|
pdc_call((iodcio_t)PAGE0->mem_pdc, 1, PDC_TOD, PDC_TOD_READ,
|
|
&tod, 0, 0, 0, 0, 0);
|
|
hp700_pagezero_unmap(pagezero_cookie);
|
|
|
|
tvp->tv_sec = tod.sec;
|
|
tvp->tv_usec = tod.usec;
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
pdcsettod(todr_chip_handle_t tch, volatile struct timeval *tvp)
|
|
{
|
|
int pagezero_cookie;
|
|
|
|
tod.sec = tvp->tv_sec;
|
|
tod.usec = tvp->tv_usec;
|
|
|
|
pagezero_cookie = hp700_pagezero_map();
|
|
pdc_call((iodcio_t)PAGE0->mem_pdc, 1, PDC_TOD, PDC_TOD_WRITE, &tod);
|
|
hp700_pagezero_unmap(pagezero_cookie);
|
|
return 0;
|
|
}
|