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