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