Home | History | Annotate | Line # | Download | only in ofw
ofcons.c revision 1.13
      1  1.13       scw /*	$NetBSD: ofcons.c,v 1.13 2001/05/02 10:32:10 scw Exp $	*/
      2   1.1        ws 
      3   1.1        ws /*
      4   1.1        ws  * Copyright (C) 1995, 1996 Wolfgang Solfrank.
      5   1.1        ws  * Copyright (C) 1995, 1996 TooLs GmbH.
      6   1.1        ws  * All rights reserved.
      7   1.1        ws  *
      8   1.1        ws  * Redistribution and use in source and binary forms, with or without
      9   1.1        ws  * modification, are permitted provided that the following conditions
     10   1.1        ws  * are met:
     11   1.1        ws  * 1. Redistributions of source code must retain the above copyright
     12   1.1        ws  *    notice, this list of conditions and the following disclaimer.
     13   1.1        ws  * 2. Redistributions in binary form must reproduce the above copyright
     14   1.1        ws  *    notice, this list of conditions and the following disclaimer in the
     15   1.1        ws  *    documentation and/or other materials provided with the distribution.
     16   1.1        ws  * 3. All advertising materials mentioning features or use of this software
     17   1.1        ws  *    must display the following acknowledgement:
     18   1.1        ws  *	This product includes software developed by TooLs GmbH.
     19   1.1        ws  * 4. The name of TooLs GmbH may not be used to endorse or promote products
     20   1.1        ws  *    derived from this software without specific prior written permission.
     21   1.1        ws  *
     22   1.1        ws  * THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR
     23   1.1        ws  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     24   1.1        ws  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     25   1.1        ws  * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
     26   1.1        ws  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
     27   1.1        ws  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
     28   1.1        ws  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
     29   1.1        ws  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
     30   1.1        ws  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
     31   1.1        ws  * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     32   1.1        ws  */
     33   1.1        ws 
     34   1.1        ws #include <sys/param.h>
     35   1.1        ws #include <sys/conf.h>
     36   1.1        ws #include <sys/device.h>
     37   1.1        ws #include <sys/proc.h>
     38   1.1        ws #include <sys/systm.h>
     39  1.10   thorpej #include <sys/callout.h>
     40   1.1        ws #include <sys/tty.h>
     41   1.1        ws 
     42   1.1        ws #include <dev/cons.h>
     43   1.1        ws 
     44   1.1        ws #include <dev/ofw/openfirm.h>
     45   1.1        ws 
     46   1.8   mycroft struct ofcons_softc {
     47   1.1        ws 	struct device of_dev;
     48   1.1        ws 	struct tty *of_tty;
     49  1.10   thorpej 	struct callout sc_poll_ch;
     50   1.1        ws 	int of_flags;
     51   1.1        ws };
     52   1.1        ws /* flags: */
     53   1.1        ws #define	OFPOLL		1
     54   1.1        ws 
     55   1.1        ws #define	OFBURSTLEN	128	/* max number of bytes to write in one chunk */
     56   1.1        ws 
     57   1.1        ws static int stdin, stdout;
     58   1.1        ws 
     59   1.8   mycroft static int ofcons_match __P((struct device *, struct cfdata *, void *));
     60   1.8   mycroft static void ofcons_attach __P((struct device *, struct device *, void *));
     61   1.1        ws 
     62   1.1        ws struct cfattach ofcons_ca = {
     63   1.8   mycroft 	sizeof(struct ofcons_softc), ofcons_match, ofcons_attach
     64   1.1        ws };
     65   1.1        ws 
     66   1.6   thorpej extern struct cfdriver ofcons_cd;
     67   1.1        ws 
     68   1.8   mycroft static int ofcons_probe __P((void));
     69   1.1        ws 
     70   1.1        ws static int
     71   1.8   mycroft ofcons_match(parent, match, aux)
     72   1.1        ws 	struct device *parent;
     73   1.4   thorpej 	struct cfdata *match;
     74   1.4   thorpej 	void *aux;
     75   1.1        ws {
     76   1.8   mycroft 	struct ofbus_attach_args *oba = aux;
     77   1.1        ws 
     78   1.8   mycroft 	if (strcmp(oba->oba_busname, "ofw"))
     79   1.8   mycroft 		return (0);
     80   1.8   mycroft 	if (!ofcons_probe())
     81   1.1        ws 		return 0;
     82   1.8   mycroft 	return OF_instance_to_package(stdin) == oba->oba_phandle
     83   1.8   mycroft 		|| OF_instance_to_package(stdout) == oba->oba_phandle;
     84   1.1        ws }
     85   1.1        ws 
     86   1.1        ws static void
     87   1.8   mycroft ofcons_attach(parent, self, aux)
     88   1.1        ws 	struct device *parent, *self;
     89   1.1        ws 	void *aux;
     90   1.1        ws {
     91  1.11       scw 	struct ofcons_softc *sc = (struct ofcons_softc *) self;
     92  1.11       scw 
     93   1.3  christos 	printf("\n");
     94  1.10   thorpej 
     95  1.11       scw 	callout_init(&sc->sc_poll_ch);
     96   1.1        ws }
     97   1.1        ws 
     98   1.8   mycroft static void ofcons_start __P((struct tty *));
     99   1.8   mycroft static int ofcons_param __P((struct tty *, struct termios *));
    100  1.13       scw static void ofcons_pollin __P((void *));
    101   1.1        ws 
    102   1.1        ws int
    103   1.8   mycroft ofcons_open(dev, flag, mode, p)
    104   1.1        ws 	dev_t dev;
    105   1.1        ws 	int flag, mode;
    106   1.1        ws 	struct proc *p;
    107   1.1        ws {
    108   1.8   mycroft 	struct ofcons_softc *sc;
    109   1.1        ws 	int unit = minor(dev);
    110   1.1        ws 	struct tty *tp;
    111   1.1        ws 
    112   1.1        ws 	if (unit >= ofcons_cd.cd_ndevs)
    113   1.1        ws 		return ENXIO;
    114   1.1        ws 	sc = ofcons_cd.cd_devs[unit];
    115   1.1        ws 	if (!sc)
    116   1.1        ws 		return ENXIO;
    117   1.1        ws 	if (!(tp = sc->of_tty))
    118   1.1        ws 		sc->of_tty = tp = ttymalloc();
    119   1.8   mycroft 	tp->t_oproc = ofcons_start;
    120   1.8   mycroft 	tp->t_param = ofcons_param;
    121   1.1        ws 	tp->t_dev = dev;
    122   1.1        ws 	if (!(tp->t_state & TS_ISOPEN)) {
    123   1.1        ws 		ttychars(tp);
    124   1.1        ws 		tp->t_iflag = TTYDEF_IFLAG;
    125   1.1        ws 		tp->t_oflag = TTYDEF_OFLAG;
    126   1.1        ws 		tp->t_cflag = TTYDEF_CFLAG;
    127   1.1        ws 		tp->t_lflag = TTYDEF_LFLAG;
    128   1.1        ws 		tp->t_ispeed = tp->t_ospeed = TTYDEF_SPEED;
    129   1.8   mycroft 		ofcons_param(tp, &tp->t_termios);
    130   1.1        ws 		ttsetwater(tp);
    131   1.1        ws 	} else if ((tp->t_state&TS_XCLUDE) && suser(p->p_ucred, &p->p_acflag))
    132   1.1        ws 		return EBUSY;
    133   1.1        ws 	tp->t_state |= TS_CARR_ON;
    134   1.1        ws 
    135   1.1        ws 	if (!(sc->of_flags & OFPOLL)) {
    136   1.1        ws 		sc->of_flags |= OFPOLL;
    137  1.13       scw 		callout_reset(&sc->sc_poll_ch, 1, ofcons_pollin, sc);
    138   1.1        ws 	}
    139   1.1        ws 
    140  1.12       eeh 	return (*tp->t_linesw->l_open)(dev, tp);
    141   1.1        ws }
    142   1.1        ws 
    143   1.1        ws int
    144   1.8   mycroft ofcons_close(dev, flag, mode, p)
    145   1.1        ws 	dev_t dev;
    146   1.1        ws 	int flag, mode;
    147   1.1        ws 	struct proc *p;
    148   1.1        ws {
    149   1.8   mycroft 	struct ofcons_softc *sc = ofcons_cd.cd_devs[minor(dev)];
    150   1.1        ws 	struct tty *tp = sc->of_tty;
    151   1.1        ws 
    152  1.10   thorpej 	callout_stop(&sc->sc_poll_ch);
    153   1.1        ws 	sc->of_flags &= ~OFPOLL;
    154  1.12       eeh 	(*tp->t_linesw->l_close)(tp, flag);
    155   1.1        ws 	ttyclose(tp);
    156   1.1        ws 	return 0;
    157   1.1        ws }
    158   1.1        ws 
    159   1.1        ws int
    160   1.8   mycroft ofcons_read(dev, uio, flag)
    161   1.1        ws 	dev_t dev;
    162   1.1        ws 	struct uio *uio;
    163   1.1        ws 	int flag;
    164   1.1        ws {
    165   1.8   mycroft 	struct ofcons_softc *sc = ofcons_cd.cd_devs[minor(dev)];
    166   1.1        ws 	struct tty *tp = sc->of_tty;
    167   1.1        ws 
    168  1.12       eeh 	return (*tp->t_linesw->l_read)(tp, uio, flag);
    169   1.1        ws }
    170   1.1        ws 
    171   1.1        ws int
    172   1.8   mycroft ofcons_write(dev, uio, flag)
    173   1.1        ws 	dev_t dev;
    174   1.1        ws 	struct uio *uio;
    175   1.1        ws 	int flag;
    176   1.1        ws {
    177   1.8   mycroft 	struct ofcons_softc *sc = ofcons_cd.cd_devs[minor(dev)];
    178   1.1        ws 	struct tty *tp = sc->of_tty;
    179   1.1        ws 
    180  1.12       eeh 	return (*tp->t_linesw->l_write)(tp, uio, flag);
    181   1.1        ws }
    182   1.1        ws 
    183   1.1        ws int
    184  1.13       scw ofcons_poll(dev, events, p)
    185  1.13       scw 	dev_t dev;
    186  1.13       scw 	int events;
    187  1.13       scw 	struct proc *p;
    188  1.13       scw {
    189  1.13       scw 	struct ofcons_softc *sc = ofcons_cd.cd_devs[minor(dev)];
    190  1.13       scw 	struct tty *tp = sc->of_tty;
    191  1.13       scw 
    192  1.13       scw 	return ((*tp->t_linesw->l_poll)(tp, events, p));
    193  1.13       scw }
    194  1.13       scw int
    195   1.8   mycroft ofcons_ioctl(dev, cmd, data, flag, p)
    196   1.1        ws 	dev_t dev;
    197   1.1        ws 	u_long cmd;
    198   1.1        ws 	caddr_t data;
    199   1.1        ws 	int flag;
    200   1.1        ws 	struct proc *p;
    201   1.1        ws {
    202   1.8   mycroft 	struct ofcons_softc *sc = ofcons_cd.cd_devs[minor(dev)];
    203   1.1        ws 	struct tty *tp = sc->of_tty;
    204   1.1        ws 	int error;
    205   1.1        ws 
    206  1.12       eeh 	if ((error = (*tp->t_linesw->l_ioctl)(tp, cmd, data, flag, p)) >= 0)
    207   1.1        ws 		return error;
    208   1.1        ws 	if ((error = ttioctl(tp, cmd, data, flag, p)) >= 0)
    209   1.1        ws 		return error;
    210   1.1        ws 	return ENOTTY;
    211   1.1        ws }
    212   1.1        ws 
    213   1.1        ws struct tty *
    214   1.8   mycroft ofcons_tty(dev)
    215   1.1        ws 	dev_t dev;
    216   1.1        ws {
    217   1.8   mycroft 	struct ofcons_softc *sc = ofcons_cd.cd_devs[minor(dev)];
    218   1.1        ws 
    219   1.1        ws 	return sc->of_tty;
    220   1.1        ws }
    221   1.1        ws 
    222   1.1        ws void
    223   1.8   mycroft ofcons_stop(tp, flag)
    224   1.1        ws 	struct tty *tp;
    225   1.1        ws 	int flag;
    226   1.1        ws {
    227   1.1        ws }
    228   1.1        ws 
    229   1.1        ws static void
    230   1.8   mycroft ofcons_start(tp)
    231   1.1        ws 	struct tty *tp;
    232   1.1        ws {
    233   1.1        ws 	struct clist *cl;
    234   1.1        ws 	int s, len;
    235   1.1        ws 	u_char buf[OFBURSTLEN];
    236   1.1        ws 
    237   1.1        ws 	s = spltty();
    238   1.1        ws 	if (tp->t_state & (TS_TIMEOUT | TS_BUSY | TS_TTSTOP)) {
    239   1.1        ws 		splx(s);
    240   1.1        ws 		return;
    241   1.1        ws 	}
    242   1.1        ws 	tp->t_state |= TS_BUSY;
    243   1.1        ws 	splx(s);
    244   1.1        ws 	cl = &tp->t_outq;
    245   1.1        ws 	len = q_to_b(cl, buf, OFBURSTLEN);
    246   1.1        ws 	OF_write(stdout, buf, len);
    247   1.1        ws 	s = spltty();
    248   1.1        ws 	tp->t_state &= ~TS_BUSY;
    249   1.1        ws 	if (cl->c_cc) {
    250   1.1        ws 		tp->t_state |= TS_TIMEOUT;
    251  1.10   thorpej 		callout_reset(&tp->t_rstrt_ch, 1, ttrstrt, (void *)tp);
    252   1.1        ws 	}
    253   1.1        ws 	if (cl->c_cc <= tp->t_lowat) {
    254   1.1        ws 		if (tp->t_state & TS_ASLEEP) {
    255   1.1        ws 			tp->t_state &= ~TS_ASLEEP;
    256   1.1        ws 			wakeup(cl);
    257   1.1        ws 		}
    258   1.1        ws 		selwakeup(&tp->t_wsel);
    259   1.1        ws 	}
    260   1.1        ws 	splx(s);
    261   1.1        ws }
    262   1.1        ws 
    263   1.1        ws static int
    264   1.8   mycroft ofcons_param(tp, t)
    265   1.1        ws 	struct tty *tp;
    266   1.1        ws 	struct termios *t;
    267   1.1        ws {
    268   1.1        ws 	tp->t_ispeed = t->c_ispeed;
    269   1.1        ws 	tp->t_ospeed = t->c_ospeed;
    270   1.1        ws 	tp->t_cflag = t->c_cflag;
    271   1.1        ws 	return 0;
    272   1.1        ws }
    273   1.1        ws 
    274   1.1        ws static void
    275  1.13       scw ofcons_pollin(aux)
    276   1.1        ws 	void *aux;
    277   1.1        ws {
    278   1.8   mycroft 	struct ofcons_softc *sc = aux;
    279   1.1        ws 	struct tty *tp = sc->of_tty;
    280   1.1        ws 	char ch;
    281   1.1        ws 
    282   1.1        ws 	while (OF_read(stdin, &ch, 1) > 0) {
    283   1.1        ws 		if (tp && (tp->t_state & TS_ISOPEN))
    284  1.12       eeh 			(*tp->t_linesw->l_rint)(ch, tp);
    285   1.1        ws 	}
    286  1.13       scw 	callout_reset(&sc->sc_poll_ch, 1, ofcons_pollin, sc);
    287   1.1        ws }
    288   1.1        ws 
    289   1.1        ws static int
    290   1.8   mycroft ofcons_probe()
    291   1.1        ws {
    292   1.1        ws 	int chosen;
    293   1.7       cgd 	char stdinbuf[4], stdoutbuf[4];
    294   1.1        ws 
    295   1.1        ws 	if (stdin)
    296   1.1        ws 		return 1;
    297   1.1        ws 	if ((chosen = OF_finddevice("/chosen")) == -1)
    298   1.1        ws 		return 0;
    299   1.7       cgd 	if (OF_getprop(chosen, "stdin", stdinbuf, sizeof stdinbuf) !=
    300   1.7       cgd 	      sizeof stdinbuf ||
    301   1.7       cgd 	    OF_getprop(chosen, "stdout", stdoutbuf, sizeof stdoutbuf) !=
    302   1.7       cgd 	      sizeof stdoutbuf)
    303   1.1        ws 		return 0;
    304   1.7       cgd 
    305   1.7       cgd 	/* Decode properties. */
    306   1.7       cgd 	stdin = of_decode_int(stdinbuf);
    307   1.7       cgd 	stdout = of_decode_int(stdoutbuf);
    308   1.7       cgd 
    309   1.1        ws 	return 1;
    310   1.1        ws }
    311   1.1        ws 
    312   1.1        ws void
    313   1.8   mycroft ofcons_cnprobe(cd)
    314   1.1        ws 	struct consdev *cd;
    315   1.1        ws {
    316   1.1        ws 	int maj;
    317   1.1        ws 
    318   1.8   mycroft 	if (!ofcons_probe())
    319   1.1        ws 		return;
    320   1.1        ws 
    321   1.1        ws 	for (maj = 0; maj < nchrdev; maj++)
    322   1.8   mycroft 		if (cdevsw[maj].d_open == ofcons_open)
    323   1.1        ws 			break;
    324   1.1        ws 	cd->cn_dev = makedev(maj, 0);
    325   1.1        ws 	cd->cn_pri = CN_INTERNAL;
    326   1.1        ws }
    327   1.1        ws 
    328   1.1        ws void
    329   1.8   mycroft ofcons_cninit(cd)
    330   1.1        ws 	struct consdev *cd;
    331   1.1        ws {
    332   1.1        ws }
    333   1.1        ws 
    334   1.1        ws int
    335   1.8   mycroft ofcons_cngetc(dev)
    336   1.1        ws 	dev_t dev;
    337   1.1        ws {
    338   1.5   mycroft 	unsigned char ch = '\0';
    339   1.1        ws 	int l;
    340   1.1        ws 
    341   1.1        ws 	while ((l = OF_read(stdin, &ch, 1)) != 1)
    342   1.5   mycroft 		if (l != -2 && l != 0)
    343   1.1        ws 			return -1;
    344   1.1        ws 	return ch;
    345   1.1        ws }
    346   1.1        ws 
    347   1.1        ws void
    348   1.8   mycroft ofcons_cnputc(dev, c)
    349   1.1        ws 	dev_t dev;
    350   1.1        ws 	int c;
    351   1.1        ws {
    352   1.1        ws 	char ch = c;
    353   1.1        ws 
    354   1.1        ws 	OF_write(stdout, &ch, 1);
    355   1.1        ws }
    356   1.1        ws 
    357   1.1        ws void
    358   1.8   mycroft ofcons_cnpollc(dev, on)
    359   1.1        ws 	dev_t dev;
    360   1.1        ws 	int on;
    361   1.1        ws {
    362   1.8   mycroft 	struct ofcons_softc *sc = ofcons_cd.cd_devs[minor(dev)];
    363   1.1        ws 
    364   1.1        ws 	if (!sc)
    365   1.1        ws 		return;
    366   1.1        ws 	if (on) {
    367   1.1        ws 		if (sc->of_flags & OFPOLL)
    368  1.10   thorpej 			callout_stop(&sc->sc_poll_ch);
    369   1.1        ws 		sc->of_flags &= ~OFPOLL;
    370   1.1        ws 	} else {
    371   1.1        ws 		if (!(sc->of_flags & OFPOLL)) {
    372   1.1        ws 			sc->of_flags |= OFPOLL;
    373  1.13       scw 			callout_reset(&sc->sc_poll_ch, 1, ofcons_pollin, sc);
    374   1.1        ws 		}
    375   1.1        ws 	}
    376   1.1        ws }
    377