Home | History | Annotate | Line # | Download | only in dev
kd.c revision 1.13.6.1
      1  1.13.6.1      yamt /*	$NetBSD: kd.c,v 1.13.6.1 2006/10/22 06:05:15 yamt 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.13.6.1      yamt __KERNEL_RCSID(0, "$NetBSD: kd.c,v 1.13.6.1 2006/10/22 06:05:15 yamt 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.12      elad #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.13.6.1      yamt 	if (kauth_authorize_device_tty(l->l_cred, KAUTH_DEVICE_TTY_OPEN, tp))
    225       1.1  fredette 		return (EBUSY);
    226       1.1  fredette 
    227       1.1  fredette 	s = spltty();
    228       1.1  fredette 
    229       1.1  fredette 	if ((tp->t_state & TS_ISOPEN) == 0) {
    230       1.1  fredette 		/* First open. */
    231       1.1  fredette 
    232       1.1  fredette 		/* Notify the input device that serves us */
    233       1.1  fredette 		struct cons_channel *cc = kd->kd_in;
    234       1.1  fredette 		if (cc != NULL &&
    235       1.1  fredette 		    (error = (*cc->cc_iopen)(cc)) != 0) {
    236       1.1  fredette 			splx(s);
    237       1.1  fredette 			return (error);
    238       1.1  fredette 		}
    239       1.1  fredette 
    240       1.1  fredette 		ttychars(tp);
    241       1.1  fredette 		tp->t_iflag = TTYDEF_IFLAG;
    242       1.1  fredette 		tp->t_oflag = TTYDEF_OFLAG;
    243       1.1  fredette 		tp->t_cflag = TTYDEF_CFLAG;
    244       1.1  fredette 		tp->t_lflag = TTYDEF_LFLAG;
    245       1.1  fredette 		tp->t_ispeed = tp->t_ospeed = TTYDEF_SPEED;
    246       1.1  fredette 		(void) kdparam(tp, &tp->t_termios);
    247       1.1  fredette 		ttsetwater(tp);
    248       1.1  fredette 		tp->t_winsize.ws_row = kd->rows;
    249       1.1  fredette 		tp->t_winsize.ws_col = kd->cols;
    250       1.1  fredette 		/* Flush pending input?  Clear translator? */
    251       1.1  fredette 		/* This (pseudo)device always has SOFTCAR */
    252       1.1  fredette 		tp->t_state |= TS_CARR_ON;
    253       1.1  fredette 	}
    254       1.1  fredette 
    255       1.1  fredette 	splx(s);
    256       1.1  fredette 
    257       1.1  fredette 	return ((*tp->t_linesw->l_open)(dev, tp));
    258       1.1  fredette }
    259       1.1  fredette 
    260       1.9       chs int
    261      1.11  christos kdclose(dev_t dev, int flag, int mode, struct lwp *l)
    262       1.1  fredette {
    263       1.1  fredette 	struct kd_softc *kd;
    264       1.1  fredette 	struct tty *tp;
    265       1.1  fredette 	struct cons_channel *cc;
    266       1.1  fredette 
    267       1.1  fredette 	kd = &kd_softc; 	/* XXX */
    268       1.1  fredette 	tp = kd->kd_tty;
    269       1.1  fredette 
    270       1.1  fredette 	/* XXX This is for cons.c. */
    271       1.1  fredette 	if ((tp->t_state & TS_ISOPEN) == 0)
    272       1.1  fredette 		return 0;
    273       1.1  fredette 
    274       1.1  fredette 	(*tp->t_linesw->l_close)(tp, flag);
    275       1.1  fredette 	ttyclose(tp);
    276       1.1  fredette 
    277       1.1  fredette 	if ((cc = kd->kd_in) != NULL)
    278       1.3    martin 		(void)(*cc->cc_iclose)(cc);
    279       1.1  fredette 
    280       1.1  fredette 	return (0);
    281       1.1  fredette }
    282       1.1  fredette 
    283       1.9       chs int
    284       1.9       chs kdread(dev_t dev, struct uio *uio, int flag)
    285       1.1  fredette {
    286       1.1  fredette 	struct kd_softc *kd;
    287       1.1  fredette 	struct tty *tp;
    288       1.1  fredette 
    289       1.1  fredette 	kd = &kd_softc; 	/* XXX */
    290       1.1  fredette 	tp = kd->kd_tty;
    291       1.1  fredette 
    292       1.1  fredette 	return ((*tp->t_linesw->l_read)(tp, uio, flag));
    293       1.1  fredette }
    294       1.1  fredette 
    295       1.9       chs int
    296       1.9       chs kdwrite(dev_t dev, struct uio *uio, int flag)
    297       1.1  fredette {
    298       1.1  fredette 	struct kd_softc *kd;
    299       1.1  fredette 	struct tty *tp;
    300       1.1  fredette 
    301       1.1  fredette 	kd = &kd_softc; 	/* XXX */
    302       1.1  fredette 	tp = kd->kd_tty;
    303       1.1  fredette 
    304       1.1  fredette 	return ((*tp->t_linesw->l_write)(tp, uio, flag));
    305       1.1  fredette }
    306       1.1  fredette 
    307       1.9       chs int
    308      1.11  christos kdpoll(dev_t dev, int events, struct lwp *l)
    309       1.1  fredette {
    310       1.1  fredette 	struct kd_softc *kd;
    311       1.1  fredette 	struct tty *tp;
    312       1.1  fredette 
    313       1.1  fredette 	kd = &kd_softc; 	/* XXX */
    314       1.1  fredette 	tp = kd->kd_tty;
    315       1.1  fredette 
    316      1.11  christos 	return ((*tp->t_linesw->l_poll)(tp, events, l));
    317       1.1  fredette }
    318       1.1  fredette 
    319       1.9       chs int
    320      1.11  christos kdioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct lwp *l)
    321       1.1  fredette {
    322       1.1  fredette 	struct kd_softc *kd;
    323       1.1  fredette 	struct tty *tp;
    324       1.1  fredette 	int error;
    325       1.1  fredette 
    326       1.1  fredette 	kd = &kd_softc; 	/* XXX */
    327       1.1  fredette 	tp = kd->kd_tty;
    328       1.1  fredette 
    329      1.11  christos 	error = (*tp->t_linesw->l_ioctl)(tp, cmd, data, flag, l);
    330       1.1  fredette 	if (error != EPASSTHROUGH)
    331       1.1  fredette 		return error;
    332       1.1  fredette 
    333      1.11  christos 	error = ttioctl(tp, cmd, data, flag, l);
    334       1.1  fredette 	if (error != EPASSTHROUGH)
    335       1.1  fredette 		return error;
    336       1.1  fredette 
    337       1.1  fredette 	/* Handle any ioctl commands specific to kbd/display. */
    338       1.1  fredette 	/* XXX - Send KB* ioctls to kbd module? */
    339       1.1  fredette 	/* XXX - Send FB* ioctls to fb module?  */
    340       1.1  fredette 
    341       1.1  fredette 	return EPASSTHROUGH;
    342       1.1  fredette }
    343       1.1  fredette 
    344       1.9       chs static int
    345       1.9       chs kdparam(struct tty *tp, struct termios *t)
    346       1.1  fredette {
    347       1.1  fredette 	/* XXX - These are ignored... */
    348       1.1  fredette 	tp->t_ispeed = t->c_ispeed;
    349       1.1  fredette 	tp->t_ospeed = t->c_ospeed;
    350       1.1  fredette 	tp->t_cflag = t->c_cflag;
    351       1.1  fredette 	return 0;
    352       1.1  fredette }
    353       1.1  fredette 
    354       1.1  fredette 
    355       1.1  fredette static void kd_later(void*);
    356       1.1  fredette static void kd_putfb(struct tty *);
    357       1.1  fredette 
    358       1.9       chs static void
    359       1.9       chs kdstart(struct tty *tp)
    360       1.1  fredette {
    361       1.1  fredette 	struct clist *cl;
    362       1.9       chs 	int s;
    363       1.1  fredette 
    364       1.1  fredette 	s = spltty();
    365       1.1  fredette 	if (tp->t_state & (TS_BUSY|TS_TTSTOP|TS_TIMEOUT))
    366       1.1  fredette 		goto out;
    367       1.1  fredette 
    368       1.1  fredette 	cl = &tp->t_outq;
    369       1.1  fredette 	if (cl->c_cc) {
    370       1.1  fredette 		if (kd_is_console) {
    371       1.1  fredette 			tp->t_state |= TS_BUSY;
    372       1.1  fredette 			if (is_spl0(s)) {
    373       1.1  fredette 				/* called at level zero - update screen now. */
    374       1.1  fredette 				(void) spllowersoftclock();
    375       1.1  fredette 				kd_putfb(tp);
    376       1.1  fredette 				(void) spltty();
    377       1.1  fredette 				tp->t_state &= ~TS_BUSY;
    378       1.1  fredette 			} else {
    379       1.1  fredette 				/* called at interrupt level - do it later */
    380       1.1  fredette 				callout_reset(&tp->t_rstrt_ch, 0,
    381       1.1  fredette 				    kd_later, tp);
    382       1.1  fredette 			}
    383       1.1  fredette 		} else {
    384       1.1  fredette 			/*
    385       1.1  fredette 			 * This driver uses the PROM for writing the screen,
    386       1.1  fredette 			 * and that only works if this is the console device.
    387       1.1  fredette 			 * If this is not the console, just flush the output.
    388       1.1  fredette 			 * Sorry.  (In that case, use xdm instead of getty.)
    389       1.1  fredette 			 */
    390       1.1  fredette 			ndflush(cl, cl->c_cc);
    391       1.1  fredette 		}
    392       1.1  fredette 	}
    393       1.1  fredette 	if (cl->c_cc <= tp->t_lowat) {
    394       1.1  fredette 		if (tp->t_state & TS_ASLEEP) {
    395       1.1  fredette 			tp->t_state &= ~TS_ASLEEP;
    396       1.1  fredette 			wakeup((caddr_t)cl);
    397       1.1  fredette 		}
    398       1.1  fredette 		selwakeup(&tp->t_wsel);
    399       1.1  fredette 	}
    400       1.1  fredette out:
    401       1.1  fredette 	splx(s);
    402       1.1  fredette }
    403       1.1  fredette 
    404       1.1  fredette /*
    405       1.1  fredette  * Timeout function to do delayed writes to the screen.
    406       1.1  fredette  * Called at splsoftclock when requested by kdstart.
    407       1.1  fredette  */
    408       1.9       chs static void
    409       1.9       chs kd_later(void *tpaddr)
    410       1.1  fredette {
    411       1.1  fredette 	struct tty *tp = tpaddr;
    412       1.9       chs 	int s;
    413       1.1  fredette 
    414       1.1  fredette 	kd_putfb(tp);
    415       1.1  fredette 
    416       1.1  fredette 	s = spltty();
    417       1.1  fredette 	tp->t_state &= ~TS_BUSY;
    418       1.1  fredette 	(*tp->t_linesw->l_start)(tp);
    419       1.1  fredette 	splx(s);
    420       1.1  fredette }
    421       1.1  fredette 
    422       1.1  fredette /*
    423       1.1  fredette  * Put text on the screen using the PROM monitor.
    424       1.1  fredette  * This can take a while, so to avoid missing
    425       1.1  fredette  * interrupts, this is called at splsoftclock.
    426       1.1  fredette  */
    427       1.9       chs static void
    428       1.9       chs kd_putfb(struct tty *tp)
    429       1.1  fredette {
    430       1.1  fredette 	char buf[PUT_WSIZE];
    431       1.1  fredette 	struct clist *cl = &tp->t_outq;
    432       1.1  fredette 	char *p, *end;
    433       1.1  fredette 	int len;
    434       1.1  fredette 
    435       1.1  fredette 	while ((len = q_to_b(cl, buf, PUT_WSIZE-1)) > 0) {
    436       1.1  fredette 		/* PROM will barf if high bits are set. */
    437       1.1  fredette 		p = buf;
    438       1.1  fredette 		end = buf + len;
    439       1.1  fredette 		while (p < end)
    440       1.1  fredette 			*p++ &= 0x7f;
    441       1.1  fredette 		/* Now let the PROM print it. */
    442       1.1  fredette 		prom_putstr(buf, len);
    443       1.1  fredette 	}
    444       1.1  fredette }
    445       1.1  fredette 
    446       1.1  fredette /*
    447       1.1  fredette  * Default PROM-based console input stream
    448       1.1  fredette  */
    449       1.9       chs static int kd_rom_iopen(struct cons_channel *);
    450       1.9       chs static int kd_rom_iclose(struct cons_channel *);
    451       1.1  fredette 
    452       1.1  fredette static struct cons_channel prom_cons_channel;
    453       1.1  fredette 
    454       1.9       chs int
    455       1.9       chs kd_rom_iopen(struct cons_channel *cc)
    456       1.1  fredette {
    457       1.1  fredette 	return (0);
    458       1.1  fredette }
    459       1.1  fredette 
    460       1.9       chs int
    461       1.9       chs kd_rom_iclose(struct cons_channel *cc)
    462       1.1  fredette {
    463       1.1  fredette 	return (0);
    464       1.1  fredette }
    465       1.1  fredette 
    466       1.1  fredette /*
    467       1.1  fredette  * Our "interrupt" routine for input. This is called by
    468       1.1  fredette  * the keyboard driver (dev/sun/kbd.c) at spltty.
    469       1.1  fredette  */
    470       1.9       chs void
    471       1.9       chs kd_cons_input(int c)
    472       1.1  fredette {
    473       1.1  fredette 	struct kd_softc *kd = &kd_softc;
    474       1.1  fredette 	struct tty *tp;
    475       1.1  fredette 
    476       1.1  fredette 	/* XXX: Make sure the device is open. */
    477       1.1  fredette 	tp = kd->kd_tty;
    478       1.1  fredette 	if (tp == NULL)
    479       1.1  fredette 		return;
    480       1.1  fredette 	if ((tp->t_state & TS_ISOPEN) == 0)
    481       1.1  fredette 		return;
    482       1.1  fredette 
    483       1.1  fredette 	(*tp->t_linesw->l_rint)(c, tp);
    484       1.1  fredette }
    485       1.1  fredette 
    486       1.1  fredette 
    487       1.1  fredette /****************************************************************
    488       1.1  fredette  * kd console support
    489       1.1  fredette  ****************************************************************/
    490       1.1  fredette 
    491       1.1  fredette /* The debugger gets its own key translation state. */
    492       1.1  fredette static struct kbd_state *kdcn_state;
    493       1.1  fredette 
    494       1.9       chs static void kdcnprobe(struct consdev *);
    495       1.9       chs static void kdcninit(struct consdev *);
    496       1.9       chs static void kdcnputc(dev_t, int);
    497       1.9       chs static void kdcnpollc(dev_t, int);
    498       1.1  fredette 
    499       1.1  fredette /* The keyboard driver uses cn_hw to access the real console driver */
    500       1.1  fredette extern struct consdev consdev_prom;
    501       1.1  fredette struct consdev consdev_kd = {
    502       1.1  fredette 	kdcnprobe,
    503       1.1  fredette 	kdcninit,
    504       1.1  fredette 	kdcngetc,
    505       1.1  fredette 	kdcnputc,
    506       1.1  fredette 	kdcnpollc,
    507       1.1  fredette 	NULL,
    508       1.1  fredette };
    509       1.1  fredette struct consdev *cn_hw = &consdev_kd;
    510       1.1  fredette 
    511       1.9       chs void
    512       1.9       chs cons_attach_input(struct cons_channel *cc, struct consdev *cn)
    513       1.1  fredette {
    514       1.1  fredette 	struct kd_softc *kd = &kd_softc;
    515       1.1  fredette 	struct kbd_softc *kds = cc->cc_dev;
    516       1.1  fredette 	struct kbd_state *ks;
    517       1.1  fredette 
    518       1.1  fredette 	/* Share the keyboard state */
    519       1.1  fredette 	kdcn_state = ks = &kds->k_state;
    520       1.1  fredette 
    521       1.1  fredette 	kd->kd_in = cc;
    522       1.1  fredette 	cc->cc_upstream = kd_cons_input;
    523       1.1  fredette 
    524       1.1  fredette 	/* Attach lower level. */
    525       1.1  fredette 	cn_hw->cn_dev = cn->cn_dev;
    526       1.1  fredette 	cn_hw->cn_pollc = cn->cn_pollc;
    527       1.1  fredette 	cn_hw->cn_getc = cn->cn_getc;
    528       1.1  fredette 
    529       1.1  fredette 	/* Attach us as console. */
    530       1.2   gehenna 	cn_tab->cn_dev = makedev(cdevsw_lookup_major(&kd_cdevsw), 0);
    531       1.1  fredette 	cn_tab->cn_probe = kdcnprobe;
    532       1.1  fredette 	cn_tab->cn_init = kdcninit;
    533       1.1  fredette 	cn_tab->cn_getc = kdcngetc;
    534       1.1  fredette 	cn_tab->cn_pollc = kdcnpollc;
    535       1.1  fredette 	cn_tab->cn_pri = CN_INTERNAL;
    536       1.1  fredette 
    537       1.1  fredette 	/* Set up initial PROM input channel for /dev/console */
    538       1.1  fredette 	prom_cons_channel.cc_dev = NULL;
    539       1.1  fredette 	prom_cons_channel.cc_iopen = kd_rom_iopen;
    540       1.1  fredette 	prom_cons_channel.cc_iclose = kd_rom_iclose;
    541       1.1  fredette 
    542       1.1  fredette 	/* Indicate that it is OK to use the PROM fbwrite */
    543       1.1  fredette 	kd_is_console = 1;
    544       1.1  fredette }
    545       1.1  fredette 
    546       1.1  fredette 
    547       1.1  fredette void kd_attach_input(struct cons_channel *);
    548       1.9       chs void
    549       1.9       chs kd_attach_input(struct cons_channel *cc)
    550       1.1  fredette {
    551       1.1  fredette 	struct kd_softc *kd = &kd_softc;
    552       1.1  fredette 
    553       1.1  fredette 	kd->kd_in = cc;
    554       1.1  fredette 	cc->cc_upstream = kd_cons_input;
    555       1.1  fredette }
    556       1.1  fredette 
    557       1.1  fredette 
    558       1.1  fredette /* We never call this. */
    559       1.9       chs static void
    560       1.9       chs kdcnprobe(struct consdev *cn)
    561       1.1  fredette {
    562       1.1  fredette }
    563       1.1  fredette 
    564       1.9       chs static void
    565       1.9       chs kdcninit(struct consdev *cn)
    566       1.1  fredette {
    567       1.1  fredette #if 0
    568       1.1  fredette 	struct kbd_state *ks = kdcn_state;
    569       1.1  fredette 
    570       1.2   gehenna 	cn->cn_dev = makedev(cdevsw_lookup_major(&kd_cdevsw), 0);
    571       1.1  fredette 	cn->cn_pri = CN_INTERNAL;
    572       1.1  fredette 
    573       1.1  fredette 	/* This prepares kbd_translate() */
    574       1.1  fredette 	ks->kbd_id = KBD_MIN_TYPE;
    575       1.1  fredette 	kbd_xlate_init(ks);
    576       1.1  fredette 
    577       1.1  fredette 	/* Set up initial PROM input channel for /dev/console */
    578       1.1  fredette 	prom_cons_channel.cc_dev = NULL;
    579       1.1  fredette 	prom_cons_channel.cc_iopen = kd_rom_iopen;
    580       1.1  fredette 	prom_cons_channel.cc_iclose = kd_rom_iclose;
    581       1.1  fredette 	cons_attach_input(&prom_cons_channel);
    582       1.1  fredette 
    583       1.1  fredette 	/* Indicate that it is OK to use the PROM fbwrite */
    584       1.1  fredette 	kd_is_console = 1;
    585       1.1  fredette #endif
    586       1.1  fredette }
    587       1.1  fredette 
    588       1.9       chs static int
    589       1.9       chs kdcngetc(dev_t dev)
    590       1.1  fredette {
    591       1.1  fredette 	struct kbd_state *ks = kdcn_state;
    592       1.1  fredette 	int code, class, data, keysym;
    593       1.9       chs 	extern int prom_cngetc(dev_t);
    594       1.1  fredette 
    595       1.1  fredette 
    596       1.1  fredette 	if (cn_hw->cn_getc == prom_cngetc) return (*cn_hw->cn_getc)(dev);
    597       1.1  fredette 	for (;;) {
    598       1.1  fredette 		code = (*cn_hw->cn_getc)(dev);
    599       1.1  fredette 		keysym = kbd_code_to_keysym(ks, code);
    600       1.1  fredette 		class = KEYSYM_CLASS(keysym);
    601       1.1  fredette 
    602       1.1  fredette 		switch (class) {
    603       1.1  fredette 		case KEYSYM_ASCII:
    604       1.1  fredette 			goto out;
    605       1.1  fredette 
    606       1.1  fredette 		case KEYSYM_CLRMOD:
    607       1.1  fredette 		case KEYSYM_SETMOD:
    608       1.1  fredette 			data = (keysym & 0x1F);
    609       1.1  fredette 			/* Only allow ctrl or shift. */
    610       1.1  fredette 			if (data > KBMOD_SHIFT_R)
    611       1.1  fredette 				break;
    612       1.1  fredette 			data = 1 << data;
    613       1.1  fredette 			if (class == KEYSYM_SETMOD)
    614       1.1  fredette 				ks->kbd_modbits |= data;
    615       1.1  fredette 			else
    616       1.1  fredette 				ks->kbd_modbits &= ~data;
    617       1.1  fredette 			break;
    618       1.1  fredette 
    619       1.1  fredette 		case KEYSYM_ALL_UP:
    620       1.1  fredette 			/* No toggle keys here. */
    621       1.1  fredette 			ks->kbd_modbits = 0;
    622       1.1  fredette 			break;
    623       1.1  fredette 
    624       1.1  fredette 		default:	/* ignore all other keysyms */
    625       1.1  fredette 			break;
    626       1.1  fredette 		}
    627       1.1  fredette 	}
    628       1.1  fredette out:
    629       1.1  fredette 	return (keysym);
    630       1.1  fredette }
    631       1.1  fredette 
    632       1.9       chs static void
    633       1.9       chs kdcnputc(dev_t dev, int c)
    634       1.1  fredette {
    635       1.1  fredette 	int s;
    636       1.1  fredette 
    637       1.1  fredette 	s = splhigh();
    638       1.1  fredette 	prom_putchar(c);
    639       1.1  fredette 	splx(s);
    640       1.1  fredette }
    641       1.1  fredette 
    642       1.9       chs static void
    643       1.9       chs kdcnpollc(dev_t dev, int on)
    644       1.1  fredette {
    645       1.1  fredette 	struct kbd_state *ks = kdcn_state;
    646       1.1  fredette 
    647       1.1  fredette 	if (on) {
    648       1.1  fredette 		/* Entering debugger. */
    649       1.1  fredette #if NFB > 0
    650       1.1  fredette 		fb_unblank();
    651       1.1  fredette #endif
    652       1.1  fredette 		/* Clear shift keys too. */
    653       1.1  fredette 		ks->kbd_modbits = 0;
    654       1.1  fredette 	} else {
    655       1.1  fredette 		/* Resuming kernel. */
    656       1.1  fredette 	}
    657       1.1  fredette 	(*cn_hw->cn_pollc)(dev, on);
    658       1.1  fredette }
    659