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