Home | History | Annotate | Line # | Download | only in dev
kd.c revision 1.38
      1  1.38   gehenna /*	$NetBSD: kd.c,v 1.38 2002/09/06 13:18:43 gehenna Exp $	*/
      2   1.4       cgd 
      3  1.21       gwr /*-
      4  1.21       gwr  * Copyright (c) 1996 The NetBSD Foundation, Inc.
      5   1.1       gwr  * All rights reserved.
      6   1.1       gwr  *
      7  1.21       gwr  * This code is derived from software contributed to The NetBSD Foundation
      8  1.21       gwr  * by Gordon W. Ross.
      9  1.21       gwr  *
     10   1.1       gwr  * Redistribution and use in source and binary forms, with or without
     11   1.1       gwr  * modification, are permitted provided that the following conditions
     12   1.1       gwr  * are met:
     13   1.1       gwr  * 1. Redistributions of source code must retain the above copyright
     14   1.1       gwr  *    notice, this list of conditions and the following disclaimer.
     15   1.1       gwr  * 2. Redistributions in binary form must reproduce the above copyright
     16   1.1       gwr  *    notice, this list of conditions and the following disclaimer in the
     17   1.1       gwr  *    documentation and/or other materials provided with the distribution.
     18  1.21       gwr  * 3. All advertising materials mentioning features or use of this software
     19  1.11       gwr  *    must display the following acknowledgement:
     20  1.21       gwr  *        This product includes software developed by the NetBSD
     21  1.21       gwr  *        Foundation, Inc. and its contributors.
     22  1.21       gwr  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23  1.21       gwr  *    contributors may be used to endorse or promote products derived
     24  1.21       gwr  *    from this software without specific prior written permission.
     25   1.1       gwr  *
     26  1.21       gwr  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27  1.21       gwr  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28  1.21       gwr  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29  1.23       gwr  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30  1.23       gwr  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31  1.21       gwr  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32  1.21       gwr  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33  1.21       gwr  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34  1.21       gwr  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35  1.21       gwr  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36  1.21       gwr  * POSSIBILITY OF SUCH DAMAGE.
     37   1.1       gwr  */
     38   1.1       gwr 
     39   1.1       gwr /*
     40   1.1       gwr  * Keyboard/Display device.
     41   1.1       gwr  *
     42   1.1       gwr  * This driver exists simply to provide a tty device that
     43   1.1       gwr  * the indirect console driver can point to.
     44   1.1       gwr  * The kbd driver sends its input here.
     45  1.20  christos  * Output goes to the screen via PROM printf.
     46   1.1       gwr  */
     47   1.1       gwr 
     48   1.1       gwr #include <sys/param.h>
     49   1.1       gwr #include <sys/proc.h>
     50   1.1       gwr #include <sys/systm.h>
     51   1.1       gwr #include <sys/ioctl.h>
     52   1.1       gwr #include <sys/tty.h>
     53   1.1       gwr #include <sys/file.h>
     54   1.1       gwr #include <sys/conf.h>
     55   1.1       gwr #include <sys/device.h>
     56   1.1       gwr 
     57   1.1       gwr #include <machine/autoconf.h>
     58   1.1       gwr #include <machine/mon.h>
     59  1.11       gwr #include <machine/psl.h>
     60   1.1       gwr 
     61   1.1       gwr #include <dev/cons.h>
     62  1.29        pk #include <dev/sun/event_var.h>
     63  1.14       gwr #include <dev/sun/kbd_xlate.h>
     64  1.29        pk #include <dev/sun/kbdvar.h>
     65  1.22       gwr #include <sun3/dev/zs_cons.h>
     66  1.22       gwr 
     67  1.26       gwr #include "fb.h"
     68  1.26       gwr 
     69  1.22       gwr extern void fb_unblank __P((void)); /* XXX */
     70   1.1       gwr 
     71  1.14       gwr #define PUT_WSIZE	64
     72  1.14       gwr 
     73  1.14       gwr struct kd_softc {
     74  1.14       gwr 	struct	device kd_dev;		/* required first: base device */
     75  1.14       gwr 	struct  tty *kd_tty;
     76  1.29        pk 
     77  1.29        pk 	/* Console input hook */
     78  1.29        pk 	struct cons_channel *kd_in;
     79  1.14       gwr };
     80   1.1       gwr 
     81  1.13       gwr /*
     82  1.13       gwr  * There is no point in pretending there might be
     83  1.13       gwr  * more than one keyboard/display device.
     84  1.13       gwr  */
     85  1.25       gwr static struct kd_softc kd_softc;
     86  1.25       gwr static int kd_is_console;
     87   1.1       gwr 
     88   1.1       gwr static int kdparam(struct tty *, struct termios *);
     89   1.1       gwr static void kdstart(struct tty *);
     90  1.29        pk static void kd_init __P((struct kd_softc *));
     91  1.29        pk static void kd_cons_input __P((int));
     92   1.1       gwr 
     93  1.38   gehenna dev_type_open(kdopen);
     94  1.38   gehenna dev_type_close(kdclose);
     95  1.38   gehenna dev_type_read(kdread);
     96  1.38   gehenna dev_type_write(kdwrite);
     97  1.38   gehenna dev_type_ioctl(kdioctl);
     98  1.38   gehenna dev_type_tty(kdtty);
     99  1.38   gehenna dev_type_poll(kdpoll);
    100  1.38   gehenna 
    101  1.38   gehenna const struct cdevsw kd_cdevsw = {
    102  1.38   gehenna 	kdopen, kdclose, kdread, kdwrite, kdioctl,
    103  1.38   gehenna 	nostop, kdtty, kdpoll, nommap, D_TTY
    104  1.38   gehenna };
    105  1.10       gwr 
    106  1.14       gwr /*
    107  1.29        pk  * Prepare the console tty; called on first open of /dev/console
    108  1.14       gwr  */
    109   1.7       gwr void
    110  1.29        pk kd_init(kd)
    111  1.29        pk 	struct kd_softc *kd;
    112   1.1       gwr {
    113  1.14       gwr 	struct tty *tp;
    114  1.14       gwr 
    115  1.14       gwr 	tp = ttymalloc();
    116  1.14       gwr 	tp->t_oproc = kdstart;
    117  1.14       gwr 	tp->t_param = kdparam;
    118  1.38   gehenna 	tp->t_dev = makedev(cdevsw_lookup_major(&kd_cdevsw), 0);
    119  1.29        pk 
    120  1.17       gwr 	tty_attach(tp);
    121  1.17       gwr 	kd->kd_tty = tp;
    122  1.14       gwr 
    123  1.14       gwr 	return;
    124  1.13       gwr }
    125  1.13       gwr 
    126  1.13       gwr struct tty *
    127  1.13       gwr kdtty(dev)
    128  1.13       gwr 	dev_t dev;
    129  1.13       gwr {
    130  1.14       gwr 	struct kd_softc *kd;
    131  1.14       gwr 
    132  1.14       gwr 	kd = &kd_softc; 	/* XXX */
    133  1.14       gwr 	return (kd->kd_tty);
    134   1.1       gwr }
    135   1.1       gwr 
    136   1.1       gwr int
    137   1.1       gwr kdopen(dev, flag, mode, p)
    138   1.1       gwr 	dev_t dev;
    139   1.1       gwr 	int flag, mode;
    140   1.1       gwr 	struct proc *p;
    141   1.1       gwr {
    142  1.14       gwr 	struct kd_softc *kd;
    143  1.14       gwr 	int error, s, unit;
    144   1.1       gwr 	struct tty *tp;
    145  1.29        pk static	int firstopen = 1;
    146   1.1       gwr 
    147   1.1       gwr 	unit = minor(dev);
    148  1.14       gwr 	if (unit != 0)
    149   1.1       gwr 		return ENXIO;
    150  1.14       gwr 	kd = &kd_softc; 	/* XXX */
    151  1.29        pk 	if (firstopen) {
    152  1.29        pk 		kd_init(kd);
    153  1.29        pk 		firstopen = 0;
    154  1.29        pk 	}
    155  1.14       gwr 	tp = kd->kd_tty;
    156   1.3       gwr 
    157  1.14       gwr 	/* It's simpler to do this up here. */
    158  1.14       gwr 	if (((tp->t_state & (TS_ISOPEN | TS_XCLUDE))
    159  1.14       gwr 	     ==             (TS_ISOPEN | TS_XCLUDE))
    160  1.14       gwr 	    && (p->p_ucred->cr_uid != 0) )
    161  1.14       gwr 	{
    162  1.14       gwr 		return (EBUSY);
    163  1.14       gwr 	}
    164  1.14       gwr 
    165  1.14       gwr 	s = spltty();
    166  1.14       gwr 
    167   1.1       gwr 	if ((tp->t_state & TS_ISOPEN) == 0) {
    168  1.14       gwr 		/* First open. */
    169  1.29        pk 
    170  1.29        pk 		/* Notify the input device that serves us */
    171  1.29        pk 		struct cons_channel *cc = kd->kd_in;
    172  1.29        pk 		if (cc != NULL &&
    173  1.29        pk 		    (error = (*cc->cc_iopen)(cc)) != 0) {
    174  1.29        pk 			return (error);
    175  1.29        pk 		}
    176  1.29        pk 
    177   1.1       gwr 		ttychars(tp);
    178   1.1       gwr 		tp->t_iflag = TTYDEF_IFLAG;
    179   1.1       gwr 		tp->t_oflag = TTYDEF_OFLAG;
    180   1.1       gwr 		tp->t_cflag = TTYDEF_CFLAG;
    181   1.1       gwr 		tp->t_lflag = TTYDEF_LFLAG;
    182   1.1       gwr 		tp->t_ispeed = tp->t_ospeed = TTYDEF_SPEED;
    183  1.14       gwr 		(void) kdparam(tp, &tp->t_termios);
    184   1.1       gwr 		ttsetwater(tp);
    185  1.14       gwr 		/* Flush pending input?  Clear translator? */
    186  1.14       gwr 		/* This (pseudo)device always has SOFTCAR */
    187  1.14       gwr 		tp->t_state |= TS_CARR_ON;
    188  1.14       gwr 	}
    189  1.14       gwr 
    190  1.14       gwr 	splx(s);
    191   1.1       gwr 
    192  1.34       eeh 	return ((*tp->t_linesw->l_open)(dev, tp));
    193   1.1       gwr }
    194   1.1       gwr 
    195   1.1       gwr int
    196   1.1       gwr kdclose(dev, flag, mode, p)
    197   1.1       gwr 	dev_t dev;
    198   1.1       gwr 	int flag, mode;
    199   1.1       gwr 	struct proc *p;
    200   1.1       gwr {
    201  1.14       gwr 	struct kd_softc *kd;
    202  1.14       gwr 	struct tty *tp;
    203  1.29        pk 	struct cons_channel *cc;
    204  1.14       gwr 
    205  1.14       gwr 	kd = &kd_softc; 	/* XXX */
    206  1.14       gwr 	tp = kd->kd_tty;
    207  1.14       gwr 
    208  1.14       gwr 	/* XXX This is for cons.c. */
    209  1.14       gwr 	if ((tp->t_state & TS_ISOPEN) == 0)
    210  1.14       gwr 		return 0;
    211   1.1       gwr 
    212  1.34       eeh 	(*tp->t_linesw->l_close)(tp, flag);
    213   1.1       gwr 	ttyclose(tp);
    214  1.29        pk 	if ((cc = kd->kd_in) != NULL)
    215  1.29        pk 		(void)(*cc->cc_iclose)(cc->cc_dev);
    216   1.1       gwr 	return (0);
    217   1.1       gwr }
    218   1.1       gwr 
    219   1.1       gwr int
    220   1.1       gwr kdread(dev, uio, flag)
    221   1.1       gwr 	dev_t dev;
    222   1.1       gwr 	struct uio *uio;
    223   1.1       gwr 	int flag;
    224   1.1       gwr {
    225  1.14       gwr 	struct kd_softc *kd;
    226  1.14       gwr 	struct tty *tp;
    227  1.14       gwr 
    228  1.14       gwr 	kd = &kd_softc; 	/* XXX */
    229  1.14       gwr 	tp = kd->kd_tty;
    230   1.1       gwr 
    231  1.34       eeh 	return ((*tp->t_linesw->l_read)(tp, uio, flag));
    232   1.1       gwr }
    233   1.1       gwr 
    234   1.1       gwr int
    235   1.1       gwr kdwrite(dev, uio, flag)
    236   1.1       gwr 	dev_t dev;
    237   1.1       gwr 	struct uio *uio;
    238   1.1       gwr 	int flag;
    239   1.1       gwr {
    240  1.14       gwr 	struct kd_softc *kd;
    241  1.14       gwr 	struct tty *tp;
    242  1.14       gwr 
    243  1.14       gwr 	kd = &kd_softc; 	/* XXX */
    244  1.14       gwr 	tp = kd->kd_tty;
    245   1.1       gwr 
    246  1.34       eeh 	return ((*tp->t_linesw->l_write)(tp, uio, flag));
    247  1.35       scw }
    248  1.35       scw 
    249  1.35       scw int
    250  1.35       scw kdpoll(dev, events, p)
    251  1.35       scw 	dev_t dev;
    252  1.35       scw 	int events;
    253  1.35       scw 	struct proc *p;
    254  1.35       scw {
    255  1.35       scw 	struct kd_softc *kd;
    256  1.35       scw 	struct tty *tp;
    257  1.35       scw 
    258  1.35       scw 	kd = &kd_softc; 	/* XXX */
    259  1.35       scw 	tp = kd->kd_tty;
    260  1.35       scw 
    261  1.35       scw 	return ((*tp->t_linesw->l_poll)(tp, events, p));
    262  1.12   mycroft }
    263  1.12   mycroft 
    264  1.12   mycroft int
    265   1.1       gwr kdioctl(dev, cmd, data, flag, p)
    266   1.1       gwr 	dev_t dev;
    267  1.14       gwr 	u_long cmd;
    268   1.1       gwr 	caddr_t data;
    269   1.1       gwr 	int flag;
    270   1.1       gwr 	struct proc *p;
    271   1.1       gwr {
    272  1.14       gwr 	struct kd_softc *kd;
    273  1.14       gwr 	struct tty *tp;
    274   1.1       gwr 	int error;
    275  1.14       gwr 
    276  1.14       gwr 	kd = &kd_softc; 	/* XXX */
    277  1.14       gwr 	tp = kd->kd_tty;
    278   1.1       gwr 
    279  1.34       eeh 	error = (*tp->t_linesw->l_ioctl)(tp, cmd, data, flag, p);
    280  1.37    atatat 	if (error != EPASSTHROUGH)
    281   1.1       gwr 		return error;
    282  1.37    atatat 
    283   1.1       gwr 	error = ttioctl(tp, cmd, data, flag, p);
    284  1.37    atatat 	if (error != EPASSTHROUGH)
    285   1.1       gwr 		return error;
    286   1.1       gwr 
    287   1.1       gwr 	/* Handle any ioctl commands specific to kbd/display. */
    288   1.1       gwr 	/* XXX - Send KB* ioctls to kbd module? */
    289   1.1       gwr 	/* XXX - Send FB* ioctls to fb module?  */
    290   1.1       gwr 
    291  1.37    atatat 	return EPASSTHROUGH;
    292   1.1       gwr }
    293   1.1       gwr 
    294  1.14       gwr static int
    295  1.14       gwr kdparam(tp, t)
    296  1.14       gwr 	struct tty *tp;
    297  1.14       gwr 	struct termios *t;
    298  1.14       gwr {
    299  1.14       gwr 	/* XXX - These are ignored... */
    300  1.14       gwr 	tp->t_ispeed = t->c_ispeed;
    301  1.14       gwr 	tp->t_ospeed = t->c_ospeed;
    302  1.14       gwr 	tp->t_cflag = t->c_cflag;
    303  1.14       gwr 	return 0;
    304  1.14       gwr }
    305  1.14       gwr 
    306  1.14       gwr 
    307  1.11       gwr static void kd_later(void*);
    308  1.11       gwr static void kd_putfb(struct tty *);
    309  1.11       gwr 
    310  1.25       gwr static void
    311   1.1       gwr kdstart(tp)
    312   1.1       gwr 	struct tty *tp;
    313   1.1       gwr {
    314   1.1       gwr 	struct clist *cl;
    315  1.36   tsutsui 	int s;
    316   1.1       gwr 
    317   1.1       gwr 	s = spltty();
    318   1.1       gwr 	if (tp->t_state & (TS_BUSY|TS_TTSTOP|TS_TIMEOUT))
    319   1.1       gwr 		goto out;
    320  1.11       gwr 
    321   1.1       gwr 	cl = &tp->t_outq;
    322  1.11       gwr 	if (cl->c_cc) {
    323  1.10       gwr 		if (kd_is_console) {
    324  1.11       gwr 			tp->t_state |= TS_BUSY;
    325  1.11       gwr 			if ((s & PSL_IPL) == 0) {
    326  1.11       gwr 				/* called at level zero - update screen now. */
    327  1.27   thorpej 				(void) spllowersoftclock();
    328  1.11       gwr 				kd_putfb(tp);
    329  1.11       gwr 				(void) spltty();
    330  1.11       gwr 				tp->t_state &= ~TS_BUSY;
    331  1.11       gwr 			} else {
    332  1.11       gwr 				/* called at interrupt level - do it later */
    333  1.30   thorpej 				callout_reset(&tp->t_rstrt_ch, 0,
    334  1.30   thorpej 				    kd_later, tp);
    335  1.11       gwr 			}
    336  1.11       gwr 		} else {
    337  1.11       gwr 			/*
    338  1.11       gwr 			 * This driver uses the PROM for writing the screen,
    339  1.11       gwr 			 * and that only works if this is the console device.
    340  1.11       gwr 			 * If this is not the console, just flush the output.
    341  1.11       gwr 			 * Sorry.  (In that case, use xdm instead of getty.)
    342  1.11       gwr 			 */
    343  1.11       gwr 			ndflush(cl, cl->c_cc);
    344  1.11       gwr 		}
    345  1.11       gwr 	}
    346  1.11       gwr 	if (cl->c_cc <= tp->t_lowat) {
    347  1.11       gwr 		if (tp->t_state & TS_ASLEEP) {
    348  1.11       gwr 			tp->t_state &= ~TS_ASLEEP;
    349  1.11       gwr 			wakeup((caddr_t)cl);
    350  1.10       gwr 		}
    351  1.11       gwr 		selwakeup(&tp->t_wsel);
    352   1.1       gwr 	}
    353  1.11       gwr out:
    354  1.11       gwr 	splx(s);
    355  1.11       gwr }
    356  1.11       gwr 
    357  1.11       gwr /*
    358  1.11       gwr  * Timeout function to do delayed writes to the screen.
    359  1.11       gwr  * Called at splsoftclock when requested by kdstart.
    360  1.11       gwr  */
    361  1.11       gwr static void
    362  1.11       gwr kd_later(tpaddr)
    363  1.11       gwr 	void *tpaddr;
    364  1.11       gwr {
    365  1.11       gwr 	struct tty *tp = tpaddr;
    366  1.36   tsutsui 	int s;
    367   1.1       gwr 
    368  1.11       gwr 	kd_putfb(tp);
    369  1.11       gwr 
    370  1.11       gwr 	s = spltty();
    371   1.1       gwr 	tp->t_state &= ~TS_BUSY;
    372  1.34       eeh 	(*tp->t_linesw->l_start)(tp);
    373  1.11       gwr 	splx(s);
    374  1.11       gwr }
    375  1.11       gwr 
    376  1.11       gwr /*
    377  1.11       gwr  * Put text on the screen using the PROM monitor.
    378  1.11       gwr  * This can take a while, so to avoid missing
    379  1.11       gwr  * interrupts, this is called at splsoftclock.
    380  1.11       gwr  */
    381  1.25       gwr static void
    382  1.25       gwr kd_putfb(tp)
    383  1.11       gwr 	struct tty *tp;
    384  1.11       gwr {
    385  1.14       gwr 	char buf[PUT_WSIZE];
    386  1.11       gwr 	struct clist *cl = &tp->t_outq;
    387  1.11       gwr 	char *p, *end;
    388  1.11       gwr 	int len;
    389  1.11       gwr 
    390  1.14       gwr 	while ((len = q_to_b(cl, buf, PUT_WSIZE-1)) > 0) {
    391  1.11       gwr 		/* PROM will barf if high bits are set. */
    392  1.11       gwr 		p = buf;
    393  1.11       gwr 		end = buf + len;
    394  1.11       gwr 		while (p < end)
    395  1.11       gwr 			*p++ &= 0x7f;
    396  1.11       gwr 		(romVectorPtr->fbWriteStr)(buf, len);
    397   1.1       gwr 	}
    398   1.1       gwr }
    399   1.1       gwr 
    400  1.29        pk void
    401  1.32       eeh cons_attach_input(cc, cn)
    402  1.29        pk 	struct cons_channel *cc;
    403  1.32       eeh 	struct consdev *cn;
    404  1.29        pk {
    405  1.29        pk 	struct kd_softc *kd = &kd_softc;
    406  1.29        pk 
    407  1.29        pk 	kd->kd_in = cc;
    408  1.29        pk 	cc->cc_upstream = kd_cons_input;
    409  1.29        pk }
    410  1.29        pk 
    411  1.29        pk /*
    412  1.29        pk  * Default PROM-based console input stream
    413  1.29        pk  */
    414  1.29        pk static int kd_rom_iopen __P((struct cons_channel *));
    415  1.29        pk static int kd_rom_iclose __P((struct cons_channel *));
    416  1.29        pk 
    417  1.29        pk static struct cons_channel prom_cons_channel;
    418  1.29        pk 
    419  1.29        pk int
    420  1.29        pk kd_rom_iopen(cc)
    421  1.29        pk 	struct cons_channel *cc;
    422  1.29        pk {
    423  1.29        pk 	/* No-op */
    424  1.29        pk 	return (0);
    425  1.29        pk }
    426  1.29        pk 
    427  1.29        pk int
    428  1.29        pk kd_rom_iclose(cc)
    429  1.29        pk 	struct cons_channel *cc;
    430  1.29        pk {
    431  1.29        pk 	/* No-op */
    432  1.29        pk 	return (0);
    433  1.29        pk }
    434  1.29        pk 
    435  1.14       gwr /*
    436  1.15       gwr  * Our "interrupt" routine for input. This is called by
    437  1.15       gwr  * the keyboard driver (dev/sun/kbd.c) at spltty.
    438  1.14       gwr  */
    439  1.14       gwr void
    440  1.29        pk kd_cons_input(c)
    441  1.14       gwr 	int c;
    442  1.14       gwr {
    443  1.14       gwr 	struct kd_softc *kd = &kd_softc;
    444  1.14       gwr 	struct tty *tp;
    445  1.14       gwr 
    446  1.14       gwr 	/* XXX: Make sure the device is open. */
    447  1.14       gwr 	tp = kd->kd_tty;
    448  1.14       gwr 	if (tp == NULL)
    449  1.14       gwr 		return;
    450  1.25       gwr 	if ((tp->t_state & TS_ISOPEN) == 0)
    451  1.14       gwr 		return;
    452  1.11       gwr 
    453  1.34       eeh 	(*tp->t_linesw->l_rint)(c, tp);
    454   1.1       gwr }
    455   1.1       gwr 
    456   1.1       gwr 
    457  1.14       gwr /****************************************************************
    458   1.1       gwr  * kd console support
    459  1.14       gwr  ****************************************************************/
    460   1.1       gwr 
    461  1.14       gwr /* The debugger gets its own key translation state. */
    462  1.14       gwr static struct kbd_state kdcn_state;
    463   1.1       gwr 
    464  1.25       gwr static void kdcnprobe __P((struct consdev *));
    465  1.25       gwr static void kdcninit __P((struct consdev *));
    466  1.25       gwr static int  kdcngetc __P((dev_t));
    467  1.25       gwr static void kdcnputc __P((dev_t, int));
    468  1.25       gwr static void kdcnpollc __P((dev_t, int));
    469  1.25       gwr 
    470  1.25       gwr struct consdev consdev_kd = {
    471  1.25       gwr 	kdcnprobe,
    472  1.25       gwr 	kdcninit,
    473  1.25       gwr 	kdcngetc,
    474  1.25       gwr 	kdcnputc,
    475  1.25       gwr 	kdcnpollc,
    476  1.28   thorpej 	NULL,
    477  1.25       gwr };
    478  1.25       gwr 
    479  1.25       gwr /* We never call this. */
    480  1.25       gwr static void
    481  1.25       gwr kdcnprobe(cn)
    482  1.25       gwr 	struct consdev *cn;
    483  1.25       gwr {
    484  1.25       gwr }
    485  1.25       gwr 
    486  1.25       gwr static void
    487  1.14       gwr kdcninit(cn)
    488  1.14       gwr 	struct consdev *cn;
    489   1.1       gwr {
    490  1.14       gwr 	struct kbd_state *ks = &kdcn_state;
    491   1.8       gwr 
    492  1.38   gehenna 	cn->cn_dev = makedev(cdevsw_lookup_major(&kd_cdevsw), 0);
    493  1.24       gwr 	cn->cn_pri = CN_INTERNAL;
    494   1.8       gwr 
    495   1.8       gwr 	/* This prepares kbd_translate() */
    496  1.14       gwr 	ks->kbd_id = KBD_MIN_TYPE;
    497  1.14       gwr 	kbd_xlate_init(ks);
    498  1.29        pk 
    499  1.29        pk 	/* Set up initial PROM input channel for /dev/console */
    500  1.29        pk 	prom_cons_channel.cc_dev = NULL;
    501  1.29        pk 	prom_cons_channel.cc_iopen = kd_rom_iopen;
    502  1.29        pk 	prom_cons_channel.cc_iclose = kd_rom_iclose;
    503  1.33       eeh 	cons_attach_input(&prom_cons_channel, cn);
    504  1.10       gwr 
    505  1.10       gwr 	/* Indicate that it is OK to use the PROM fbwrite */
    506  1.10       gwr 	kd_is_console = 1;
    507   1.1       gwr }
    508   1.1       gwr 
    509  1.25       gwr static int
    510   1.1       gwr kdcngetc(dev)
    511   1.1       gwr 	dev_t dev;
    512   1.1       gwr {
    513  1.14       gwr 	struct kbd_state *ks = &kdcn_state;
    514  1.14       gwr 	int code, class, data, keysym;
    515  1.14       gwr 
    516  1.14       gwr 	for (;;) {
    517  1.14       gwr 		code = zs_getc(zs_conschan);
    518  1.14       gwr 		keysym = kbd_code_to_keysym(ks, code);
    519  1.14       gwr 		class = KEYSYM_CLASS(keysym);
    520  1.14       gwr 
    521  1.14       gwr 		switch (class) {
    522  1.14       gwr 		case KEYSYM_ASCII:
    523  1.14       gwr 			goto out;
    524  1.14       gwr 
    525  1.14       gwr 		case KEYSYM_CLRMOD:
    526  1.14       gwr 		case KEYSYM_SETMOD:
    527  1.14       gwr 			data = (keysym & 0x1F);
    528  1.14       gwr 			/* Only allow ctrl or shift. */
    529  1.14       gwr 			if (data > KBMOD_SHIFT_R)
    530  1.14       gwr 				break;
    531  1.14       gwr 			data = 1 << data;
    532  1.14       gwr 			if (class == KEYSYM_SETMOD)
    533  1.14       gwr 				ks->kbd_modbits |= data;
    534  1.14       gwr 			else
    535  1.14       gwr 				ks->kbd_modbits &= ~data;
    536  1.14       gwr 			break;
    537   1.1       gwr 
    538  1.14       gwr 		case KEYSYM_ALL_UP:
    539  1.14       gwr 			/* No toggle keys here. */
    540  1.14       gwr 			ks->kbd_modbits = 0;
    541  1.14       gwr 			break;
    542   1.1       gwr 
    543  1.14       gwr 		default:	/* ignore all other keysyms */
    544  1.14       gwr 			break;
    545  1.14       gwr 		}
    546  1.14       gwr 	}
    547  1.14       gwr out:
    548  1.14       gwr 	return (keysym);
    549   1.1       gwr }
    550   1.1       gwr 
    551  1.25       gwr static void
    552   1.1       gwr kdcnputc(dev, c)
    553   1.1       gwr 	dev_t dev;
    554   1.1       gwr 	int c;
    555   1.1       gwr {
    556  1.11       gwr 	(romVectorPtr->fbWriteChar)(c & 0x7f);
    557   1.9       gwr }
    558   1.9       gwr 
    559  1.25       gwr static void
    560  1.25       gwr kdcnpollc(dev, on)
    561   1.9       gwr 	dev_t dev;
    562   1.9       gwr 	int on;
    563   1.9       gwr {
    564  1.14       gwr 	struct kbd_state *ks = &kdcn_state;
    565  1.14       gwr 
    566  1.14       gwr 	if (on) {
    567  1.14       gwr 		/* Entering debugger. */
    568  1.26       gwr #if NFB > 0
    569   1.9       gwr 		fb_unblank();
    570  1.26       gwr #endif
    571  1.14       gwr 		/* Clear shift keys too. */
    572  1.14       gwr 		ks->kbd_modbits = 0;
    573  1.14       gwr 	} else {
    574  1.14       gwr 		/* Resuming kernel. */
    575  1.14       gwr 	}
    576   1.1       gwr }
    577  1.14       gwr 
    578