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