Home | History | Annotate | Line # | Download | only in ic
com.c revision 1.33
      1   1.1      cgd /*-
      2  1.21  mycroft  * Copyright (c) 1993, 1994 Charles Hannum.
      3   1.1      cgd  * Copyright (c) 1991 The Regents of the University of California.
      4   1.1      cgd  * All rights reserved.
      5   1.1      cgd  *
      6   1.1      cgd  * Redistribution and use in source and binary forms, with or without
      7   1.1      cgd  * modification, are permitted provided that the following conditions
      8   1.1      cgd  * are met:
      9   1.1      cgd  * 1. Redistributions of source code must retain the above copyright
     10   1.1      cgd  *    notice, this list of conditions and the following disclaimer.
     11   1.1      cgd  * 2. Redistributions in binary form must reproduce the above copyright
     12   1.1      cgd  *    notice, this list of conditions and the following disclaimer in the
     13   1.1      cgd  *    documentation and/or other materials provided with the distribution.
     14   1.1      cgd  * 3. All advertising materials mentioning features or use of this software
     15   1.1      cgd  *    must display the following acknowledgement:
     16   1.1      cgd  *	This product includes software developed by the University of
     17   1.1      cgd  *	California, Berkeley and its contributors.
     18   1.1      cgd  * 4. Neither the name of the University nor the names of its contributors
     19   1.1      cgd  *    may be used to endorse or promote products derived from this software
     20   1.1      cgd  *    without specific prior written permission.
     21   1.1      cgd  *
     22   1.1      cgd  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     23   1.1      cgd  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     24   1.1      cgd  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     25   1.1      cgd  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     26   1.1      cgd  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     27   1.1      cgd  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     28   1.1      cgd  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     29   1.1      cgd  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     30   1.1      cgd  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     31   1.1      cgd  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     32   1.1      cgd  * SUCH DAMAGE.
     33   1.1      cgd  *
     34   1.7      cgd  *	from: @(#)com.c	7.5 (Berkeley) 5/16/91
     35  1.33  mycroft  *	$Id: com.c,v 1.33 1994/08/07 11:27:51 mycroft Exp $
     36   1.1      cgd  */
     37   1.1      cgd 
     38   1.1      cgd /*
     39   1.1      cgd  * COM driver, based on HP dca driver
     40   1.1      cgd  * uses National Semiconductor NS16450/NS16550AF UART
     41   1.1      cgd  */
     42  1.21  mycroft #include "com.h"
     43  1.21  mycroft 
     44  1.14  mycroft #include <sys/param.h>
     45  1.14  mycroft #include <sys/systm.h>
     46  1.14  mycroft #include <sys/ioctl.h>
     47  1.14  mycroft #include <sys/select.h>
     48  1.14  mycroft #include <sys/tty.h>
     49  1.14  mycroft #include <sys/proc.h>
     50  1.14  mycroft #include <sys/user.h>
     51  1.14  mycroft #include <sys/conf.h>
     52  1.14  mycroft #include <sys/file.h>
     53  1.14  mycroft #include <sys/uio.h>
     54  1.14  mycroft #include <sys/kernel.h>
     55  1.14  mycroft #include <sys/syslog.h>
     56  1.14  mycroft #include <sys/types.h>
     57  1.21  mycroft #include <sys/device.h>
     58  1.14  mycroft 
     59  1.21  mycroft #include <machine/cpu.h>
     60  1.14  mycroft #include <machine/pio.h>
     61  1.14  mycroft 
     62  1.29  mycroft #include <i386/isa/isavar.h>
     63  1.14  mycroft #include <i386/isa/comreg.h>
     64  1.14  mycroft #include <i386/isa/ic/ns16550.h>
     65  1.14  mycroft 
     66  1.21  mycroft struct com_softc {
     67  1.21  mycroft 	struct device sc_dev;
     68  1.30  mycroft 	struct intrhand sc_ih;
     69   1.1      cgd 
     70  1.33  mycroft 	int sc_overflows;
     71  1.21  mycroft 	u_short sc_iobase;
     72  1.22      cgd 	u_char sc_hwflags;
     73  1.29  mycroft #define	COM_HW_NOIEN	0x01
     74  1.22      cgd #define	COM_HW_FIFO	0x02
     75  1.22      cgd #define	COM_HW_CONSOLE	0x40
     76  1.22      cgd 	u_char sc_swflags;
     77  1.22      cgd #define	COM_SW_SOFTCAR	0x01
     78  1.22      cgd #define	COM_SW_CLOCAL	0x02
     79  1.22      cgd #define	COM_SW_CRTSCTS	0x04
     80  1.25      cgd #define	COM_SW_MDMBUF	0x08
     81  1.21  mycroft 	u_char sc_msr, sc_mcr;
     82  1.29  mycroft };
     83  1.21  mycroft /* XXXX should be in com_softc, but not ready for that yet */
     84  1.21  mycroft struct	tty *com_tty[NCOM];
     85  1.21  mycroft 
     86  1.29  mycroft int comprobe();
     87  1.29  mycroft void comattach();
     88  1.21  mycroft int comopen __P((dev_t, int, int, struct proc *));
     89  1.21  mycroft int comclose __P((dev_t, int, int, struct proc *));
     90  1.33  mycroft void comdiag __P((void *));
     91  1.30  mycroft int comintr __P((struct com_softc *));
     92  1.21  mycroft int comparam __P((struct tty *, struct termios *));
     93  1.21  mycroft void comstart __P((struct tty *));
     94   1.1      cgd 
     95  1.29  mycroft struct cfdriver comcd = {
     96  1.29  mycroft 	NULL, "com", comprobe, comattach, DV_TTY, sizeof(struct com_softc)
     97   1.1      cgd };
     98   1.1      cgd 
     99  1.21  mycroft int	comdefaultrate = TTYDEF_SPEED;
    100   1.1      cgd #ifdef COMCONSOLE
    101   1.1      cgd int	comconsole = COMCONSOLE;
    102   1.1      cgd #else
    103   1.1      cgd int	comconsole = -1;
    104   1.1      cgd #endif
    105   1.1      cgd int	comconsinit;
    106   1.1      cgd int	commajor;
    107   1.1      cgd 
    108   1.1      cgd #ifdef KGDB
    109  1.14  mycroft #include <machine/remote-sl.h>
    110   1.1      cgd extern int kgdb_dev;
    111   1.1      cgd extern int kgdb_rate;
    112   1.1      cgd extern int kgdb_debug_init;
    113   1.1      cgd #endif
    114   1.1      cgd 
    115  1.21  mycroft #define	COMUNIT(x)	(minor(x))
    116   1.1      cgd 
    117  1.21  mycroft #define	bis(c, b)	do { const register u_short com_ad = (c); \
    118  1.21  mycroft 			     outb(com_ad, inb(com_ad) | (b)); } while(0)
    119  1.21  mycroft #define	bic(c, b)	do { const register u_short com_ad = (c); \
    120  1.21  mycroft 			     outb(com_ad, inb(com_ad) & ~(b)); } while(0)
    121  1.21  mycroft 
    122  1.21  mycroft int
    123  1.21  mycroft comspeed(speed)
    124  1.21  mycroft 	long speed;
    125   1.1      cgd {
    126  1.21  mycroft #define	divrnd(n, q)	(((n)*2/(q)+1)/2)	/* divide and round off */
    127  1.21  mycroft 
    128  1.21  mycroft 	int x, err;
    129  1.21  mycroft 
    130  1.21  mycroft 	if (speed == 0)
    131  1.21  mycroft 		return 0;
    132  1.21  mycroft 	if (speed < 0)
    133  1.21  mycroft 		return -1;
    134  1.21  mycroft 	x = divrnd((COM_FREQ / 16), speed);
    135  1.21  mycroft 	if (x <= 0)
    136  1.21  mycroft 		return -1;
    137  1.21  mycroft 	err = divrnd((COM_FREQ / 16) * 1000, speed * x) - 1000;
    138  1.21  mycroft 	if (err < 0)
    139  1.21  mycroft 		err = -err;
    140  1.21  mycroft 	if (err > COM_TOLERANCE)
    141  1.21  mycroft 		return -1;
    142  1.21  mycroft 	return x;
    143  1.21  mycroft 
    144  1.21  mycroft #undef	divrnd(n, q)
    145  1.21  mycroft }
    146  1.21  mycroft 
    147  1.21  mycroft int
    148  1.21  mycroft comprobe1(iobase)
    149  1.21  mycroft 	u_short iobase;
    150  1.21  mycroft {
    151  1.21  mycroft 
    152   1.1      cgd 	/* force access to id reg */
    153  1.21  mycroft 	outb(iobase + com_cfcr, 0);
    154  1.21  mycroft 	outb(iobase + com_iir, 0);
    155  1.21  mycroft 	if (inb(iobase + com_iir) & 0x38)
    156  1.21  mycroft 		return 0;
    157  1.21  mycroft 
    158  1.21  mycroft 	return 1;
    159   1.1      cgd }
    160   1.1      cgd 
    161  1.21  mycroft int
    162  1.29  mycroft comprobe(parent, self, aux)
    163  1.29  mycroft 	struct device *parent, *self;
    164  1.29  mycroft 	void *aux;
    165  1.29  mycroft {
    166  1.29  mycroft 	struct com_softc *sc = (void *)self;
    167  1.29  mycroft 	struct isa_attach_args *ia = aux;
    168  1.29  mycroft 	u_short iobase = ia->ia_iobase;
    169  1.21  mycroft 
    170  1.21  mycroft 	if (!comprobe1(iobase))
    171  1.21  mycroft 		return 0;
    172  1.21  mycroft 
    173  1.29  mycroft 	ia->ia_iosize = COM_NPORTS;
    174  1.29  mycroft 	ia->ia_msize = 0;
    175  1.29  mycroft 	return 1;
    176  1.21  mycroft }
    177   1.1      cgd 
    178  1.29  mycroft void
    179  1.29  mycroft comattach(parent, self, aux)
    180  1.29  mycroft 	struct device *parent, *self;
    181  1.29  mycroft 	void *aux;
    182  1.29  mycroft {
    183  1.29  mycroft 	struct com_softc *sc = (void *)self;
    184  1.29  mycroft 	struct isa_attach_args *ia = aux;
    185  1.29  mycroft 	struct cfdata *cf = sc->sc_dev.dv_cfdata;
    186  1.29  mycroft 	u_short iobase = ia->ia_iobase;
    187  1.21  mycroft 	struct tty *tp;
    188   1.1      cgd 
    189  1.21  mycroft 	sc->sc_iobase = iobase;
    190  1.29  mycroft 	sc->sc_hwflags = cf->cf_flags & COM_HW_NOIEN;
    191  1.22      cgd 	sc->sc_swflags = 0;
    192  1.21  mycroft 
    193  1.29  mycroft 	if (sc->sc_dev.dv_unit == comconsole)
    194  1.29  mycroft 		delay(1000);
    195  1.26      cgd 
    196   1.1      cgd 	/* look for a NS 16550AF UART with FIFOs */
    197  1.21  mycroft 	outb(iobase + com_fifo,
    198  1.21  mycroft 	    FIFO_ENABLE | FIFO_RCV_RST | FIFO_XMT_RST | FIFO_TRIGGER_14);
    199  1.20  mycroft 	delay(100);
    200  1.21  mycroft 	if ((inb(iobase + com_iir) & IIR_FIFO_MASK) == IIR_FIFO_MASK)
    201  1.21  mycroft 		if ((inb(iobase + com_fifo) & FIFO_TRIGGER_14) == FIFO_TRIGGER_14) {
    202  1.22      cgd 			sc->sc_hwflags |= COM_HW_FIFO;
    203  1.29  mycroft 			printf(": ns16550a, working fifo\n");
    204  1.21  mycroft 		} else
    205  1.29  mycroft 			printf(": ns82550 or ns16550, broken fifo\n");
    206  1.21  mycroft 	else
    207  1.29  mycroft 		printf(": ns82450 or ns16450, no fifo\n");
    208  1.21  mycroft 	outb(iobase + com_fifo, 0);
    209  1.21  mycroft 
    210  1.21  mycroft 	/* disable interrupts */
    211  1.21  mycroft 	outb(iobase + com_ier, 0);
    212  1.21  mycroft 	outb(iobase + com_mcr, 0);
    213   1.1      cgd 
    214  1.30  mycroft 	if (!parent) {	/* XXX no master */
    215  1.30  mycroft 		sc->sc_ih.ih_fun = comintr;
    216  1.30  mycroft 		sc->sc_ih.ih_arg = sc;
    217  1.30  mycroft 		sc->sc_ih.ih_level = IPL_TTY;
    218  1.30  mycroft 		intr_establish(ia->ia_irq, &sc->sc_ih);
    219  1.30  mycroft 	}
    220  1.30  mycroft 
    221   1.1      cgd #ifdef KGDB
    222   1.2      cgd 	if (kgdb_dev == makedev(commajor, unit)) {
    223   1.1      cgd 		if (comconsole == unit)
    224   1.1      cgd 			kgdb_dev = -1;	/* can't debug over console port */
    225   1.1      cgd 		else {
    226   1.1      cgd 			(void) cominit(unit, kgdb_rate);
    227   1.1      cgd 			if (kgdb_debug_init) {
    228   1.1      cgd 				/*
    229   1.1      cgd 				 * Print prefix of device name,
    230   1.1      cgd 				 * let kgdb_connect print the rest.
    231   1.1      cgd 				 */
    232  1.21  mycroft 				printf("%s: ", sc->sc_dev.dv_xname);
    233   1.1      cgd 				kgdb_connect(1);
    234   1.1      cgd 			} else
    235  1.21  mycroft 				printf("%s: kgdb enabled\n",
    236  1.21  mycroft 				    sc->sc_dev.dv_xname);
    237   1.1      cgd 		}
    238   1.1      cgd 	}
    239   1.1      cgd #endif
    240  1.21  mycroft 
    241  1.29  mycroft 	if (sc->sc_dev.dv_unit == comconsole) {
    242  1.29  mycroft 		/*
    243  1.29  mycroft 		 * Need to reset baud rate, etc. of next print so reset
    244  1.29  mycroft 		 * comconsinit.  Also make sure console is always "hardwired".
    245  1.29  mycroft 		 */
    246   1.1      cgd 		comconsinit = 0;
    247  1.22      cgd 		sc->sc_hwflags |= COM_HW_CONSOLE;
    248  1.22      cgd 		sc->sc_swflags |= COM_SW_SOFTCAR;
    249   1.1      cgd 	}
    250   1.1      cgd }
    251   1.1      cgd 
    252  1.21  mycroft int
    253  1.21  mycroft comopen(dev, flag, mode, p)
    254  1.21  mycroft 	dev_t dev;
    255  1.21  mycroft 	int flag, mode;
    256  1.21  mycroft 	struct proc *p;
    257   1.1      cgd {
    258  1.21  mycroft 	int unit = COMUNIT(dev);
    259  1.21  mycroft 	struct com_softc *sc;
    260  1.21  mycroft 	u_short iobase;
    261  1.21  mycroft 	struct tty *tp;
    262  1.21  mycroft 	int s;
    263   1.1      cgd 	int error = 0;
    264   1.1      cgd 
    265  1.29  mycroft 	if (unit >= comcd.cd_ndevs)
    266  1.21  mycroft 		return ENXIO;
    267  1.29  mycroft 	sc = comcd.cd_devs[unit];
    268  1.29  mycroft 	if (!sc)
    269  1.21  mycroft 		return ENXIO;
    270  1.21  mycroft 
    271  1.21  mycroft 	s = spltty();
    272  1.21  mycroft 
    273  1.21  mycroft 	if (!com_tty[unit])
    274  1.11  mycroft 		tp = com_tty[unit] = ttymalloc();
    275  1.21  mycroft 	else
    276   1.8  deraadt 		tp = com_tty[unit];
    277  1.21  mycroft 
    278   1.1      cgd 	tp->t_oproc = comstart;
    279   1.1      cgd 	tp->t_param = comparam;
    280   1.1      cgd 	tp->t_dev = dev;
    281   1.1      cgd 	if ((tp->t_state & TS_ISOPEN) == 0) {
    282   1.1      cgd 		tp->t_state |= TS_WOPEN;
    283   1.1      cgd 		ttychars(tp);
    284  1.16       ws 		tp->t_iflag = TTYDEF_IFLAG;
    285  1.16       ws 		tp->t_oflag = TTYDEF_OFLAG;
    286  1.16       ws 		tp->t_cflag = TTYDEF_CFLAG;
    287  1.22      cgd 		if (sc->sc_swflags & COM_SW_CLOCAL)
    288  1.22      cgd 			tp->t_cflag |= CLOCAL;
    289  1.22      cgd 		if (sc->sc_swflags & COM_SW_CRTSCTS)
    290  1.22      cgd 			tp->t_cflag |= CRTSCTS;
    291  1.25      cgd 		if (sc->sc_swflags & COM_SW_MDMBUF)
    292  1.25      cgd 			tp->t_cflag |= MDMBUF;
    293  1.16       ws 		tp->t_lflag = TTYDEF_LFLAG;
    294  1.16       ws 		tp->t_ispeed = tp->t_ospeed = comdefaultrate;
    295   1.1      cgd 		comparam(tp, &tp->t_termios);
    296   1.1      cgd 		ttsetwater(tp);
    297  1.21  mycroft 
    298  1.21  mycroft 		iobase = sc->sc_iobase;
    299  1.21  mycroft 		/* flush any pending I/O */
    300  1.22      cgd 		if (sc->sc_hwflags & COM_HW_FIFO)
    301  1.21  mycroft 			outb(iobase + com_fifo,
    302  1.21  mycroft 			    FIFO_ENABLE | FIFO_RCV_RST | FIFO_XMT_RST |
    303  1.21  mycroft 			    FIFO_TRIGGER_8);
    304  1.21  mycroft 		(void) inb(iobase + com_lsr);
    305  1.21  mycroft 		(void) inb(iobase + com_data);
    306  1.21  mycroft 		/* you turn me on, baby */
    307  1.26      cgd 		sc->sc_mcr = MCR_DTR | MCR_RTS;
    308  1.29  mycroft 		if (!(sc->sc_hwflags & COM_HW_NOIEN))
    309  1.26      cgd 			sc->sc_mcr |= MCR_IENABLE;
    310  1.26      cgd 		outb(iobase + com_mcr, sc->sc_mcr);
    311  1.21  mycroft 		outb(iobase + com_ier,
    312  1.21  mycroft 		    IER_ERXRDY | IER_ETXRDY | IER_ERLS | IER_EMSC);
    313  1.21  mycroft 
    314  1.21  mycroft 		sc->sc_msr = inb(iobase + com_msr);
    315  1.25      cgd 		if (sc->sc_swflags & COM_SW_SOFTCAR || sc->sc_msr & MSR_DCD ||
    316  1.25      cgd 		    tp->t_lflag&MDMBUF)
    317  1.21  mycroft 			tp->t_state |= TS_CARR_ON;
    318  1.21  mycroft 		else
    319  1.21  mycroft 			tp->t_state &= ~TS_CARR_ON;
    320  1.21  mycroft 	} else if (tp->t_state&TS_XCLUDE && p->p_ucred->cr_uid != 0) {
    321  1.21  mycroft 		splx(s);
    322  1.21  mycroft 		return EBUSY;
    323  1.21  mycroft 	}
    324  1.21  mycroft 
    325  1.21  mycroft 	/* wait for carrier if necessary */
    326  1.21  mycroft 	if ((flag & O_NONBLOCK) == 0)
    327  1.21  mycroft 		while ((tp->t_cflag & CLOCAL) == 0 &&
    328  1.21  mycroft 		    (tp->t_state & TS_CARR_ON) == 0) {
    329  1.21  mycroft 			tp->t_state |= TS_WOPEN;
    330  1.21  mycroft 			error = ttysleep(tp, (caddr_t)&tp->t_rawq,
    331  1.21  mycroft 			    TTIPRI | PCATCH, ttopen, 0);
    332  1.21  mycroft 			if (error) {
    333  1.21  mycroft 				/* XXX should turn off chip if we're the
    334  1.21  mycroft 				   only waiter */
    335  1.21  mycroft 				splx(s);
    336  1.21  mycroft 				return error;
    337  1.21  mycroft 			}
    338  1.21  mycroft 		}
    339  1.21  mycroft 	splx(s);
    340  1.21  mycroft 
    341  1.21  mycroft 	return (*linesw[tp->t_line].l_open)(dev, tp);
    342   1.1      cgd }
    343   1.1      cgd 
    344  1.21  mycroft int
    345   1.1      cgd comclose(dev, flag, mode, p)
    346   1.1      cgd 	dev_t dev;
    347   1.1      cgd 	int flag, mode;
    348   1.1      cgd 	struct proc *p;
    349   1.1      cgd {
    350  1.21  mycroft 	int unit = COMUNIT(dev);
    351  1.29  mycroft 	struct com_softc *sc = comcd.cd_devs[unit];
    352  1.21  mycroft 	u_short iobase = sc->sc_iobase;
    353  1.21  mycroft 	struct tty *tp = com_tty[unit];
    354  1.21  mycroft 
    355   1.1      cgd 	(*linesw[tp->t_line].l_close)(tp, flag);
    356   1.1      cgd #ifdef KGDB
    357   1.1      cgd 	/* do not disable interrupts if debugging */
    358   1.2      cgd 	if (kgdb_dev != makedev(commajor, unit))
    359   1.1      cgd #endif
    360  1.21  mycroft 	{
    361  1.21  mycroft 		bic(iobase + com_cfcr, CFCR_SBREAK);
    362  1.21  mycroft 		outb(iobase + com_ier, 0);
    363  1.22      cgd 		if (tp->t_cflag & HUPCL &&
    364  1.22      cgd 		    (sc->sc_swflags & COM_SW_SOFTCAR) == 0)
    365  1.21  mycroft 			/* XXX perhaps only clear DTR */
    366  1.21  mycroft 			outb(iobase + com_mcr, 0);
    367  1.21  mycroft 	}
    368   1.1      cgd 	ttyclose(tp);
    369  1.21  mycroft #ifdef notyet /* XXXX */
    370  1.21  mycroft 	if (unit != comconsole) {
    371  1.21  mycroft 		ttyfree(tp);
    372  1.21  mycroft 		com_tty[unit] = (struct tty *)NULL;
    373  1.21  mycroft 	}
    374  1.13      cgd #endif
    375  1.21  mycroft 	return 0;
    376   1.1      cgd }
    377   1.1      cgd 
    378  1.21  mycroft int
    379   1.1      cgd comread(dev, uio, flag)
    380   1.1      cgd 	dev_t dev;
    381   1.1      cgd 	struct uio *uio;
    382  1.21  mycroft 	int flag;
    383   1.1      cgd {
    384  1.21  mycroft 	struct tty *tp = com_tty[COMUNIT(dev)];
    385   1.1      cgd 
    386   1.1      cgd 	return ((*linesw[tp->t_line].l_read)(tp, uio, flag));
    387   1.1      cgd }
    388   1.1      cgd 
    389  1.21  mycroft int
    390   1.1      cgd comwrite(dev, uio, flag)
    391   1.1      cgd 	dev_t dev;
    392   1.1      cgd 	struct uio *uio;
    393  1.21  mycroft 	int flag;
    394   1.1      cgd {
    395  1.21  mycroft 	struct tty *tp = com_tty[COMUNIT(dev)];
    396   1.1      cgd 
    397   1.1      cgd 	return ((*linesw[tp->t_line].l_write)(tp, uio, flag));
    398   1.1      cgd }
    399   1.1      cgd 
    400  1.21  mycroft static u_char
    401  1.21  mycroft tiocm_xxx2mcr(data)
    402  1.21  mycroft 	int data;
    403  1.21  mycroft {
    404  1.21  mycroft 	u_char m = 0;
    405  1.21  mycroft 
    406  1.21  mycroft 	if (data & TIOCM_DTR)
    407  1.21  mycroft 		m |= MCR_DTR;
    408  1.21  mycroft 	if (data & TIOCM_RTS)
    409  1.21  mycroft 		m |= MCR_RTS;
    410  1.21  mycroft 	return m;
    411   1.1      cgd }
    412   1.1      cgd 
    413  1.21  mycroft int
    414  1.19  mycroft comioctl(dev, cmd, data, flag, p)
    415   1.1      cgd 	dev_t dev;
    416  1.19  mycroft 	int cmd;
    417   1.1      cgd 	caddr_t data;
    418  1.19  mycroft 	int flag;
    419  1.19  mycroft 	struct proc *p;
    420   1.1      cgd {
    421  1.21  mycroft 	int unit = COMUNIT(dev);
    422  1.29  mycroft 	struct com_softc *sc = comcd.cd_devs[unit];
    423  1.21  mycroft 	u_short iobase = sc->sc_iobase;
    424  1.21  mycroft 	struct tty *tp = com_tty[unit];
    425  1.21  mycroft 	int error;
    426  1.21  mycroft 
    427  1.19  mycroft 	error = (*linesw[tp->t_line].l_ioctl)(tp, cmd, data, flag, p);
    428   1.1      cgd 	if (error >= 0)
    429  1.21  mycroft 		return error;
    430  1.19  mycroft 	error = ttioctl(tp, cmd, data, flag, p);
    431   1.1      cgd 	if (error >= 0)
    432  1.21  mycroft 		return error;
    433   1.1      cgd 
    434   1.1      cgd 	switch (cmd) {
    435   1.1      cgd 	case TIOCSBRK:
    436  1.21  mycroft 		bis(iobase + com_cfcr, CFCR_SBREAK);
    437   1.1      cgd 		break;
    438   1.1      cgd 	case TIOCCBRK:
    439  1.21  mycroft 		bic(iobase + com_cfcr, CFCR_SBREAK);
    440   1.1      cgd 		break;
    441   1.1      cgd 	case TIOCSDTR:
    442  1.21  mycroft 		outb(iobase + com_mcr, sc->sc_mcr |= (MCR_DTR | MCR_RTS));
    443   1.1      cgd 		break;
    444   1.1      cgd 	case TIOCCDTR:
    445  1.21  mycroft 		outb(iobase + com_mcr, sc->sc_mcr &= ~(MCR_DTR | MCR_RTS));
    446   1.1      cgd 		break;
    447   1.1      cgd 	case TIOCMSET:
    448  1.21  mycroft 		sc->sc_mcr &= ~(MCR_DTR | MCR_RTS);
    449   1.1      cgd 	case TIOCMBIS:
    450  1.21  mycroft 		outb(iobase + com_mcr,
    451  1.21  mycroft 		    sc->sc_mcr |= tiocm_xxx2mcr(*(int *)data));
    452   1.1      cgd 		break;
    453   1.1      cgd 	case TIOCMBIC:
    454  1.21  mycroft 		outb(iobase + com_mcr,
    455  1.21  mycroft 		    sc->sc_mcr &= ~tiocm_xxx2mcr(*(int *)data));
    456   1.1      cgd 		break;
    457  1.21  mycroft 	case TIOCMGET: {
    458  1.21  mycroft 		u_char m;
    459  1.21  mycroft 		int bits = 0;
    460  1.21  mycroft 
    461  1.21  mycroft 		m = sc->sc_mcr;
    462  1.21  mycroft 		if (m & MCR_DTR)
    463  1.21  mycroft 			bits |= TIOCM_DTR;
    464  1.21  mycroft 		if (m & MCR_RTS)
    465  1.21  mycroft 			bits |= TIOCM_RTS;
    466  1.21  mycroft 		m = sc->sc_msr;
    467  1.21  mycroft 		if (m & MSR_DCD)
    468  1.21  mycroft 			bits |= TIOCM_CD;
    469  1.21  mycroft 		if (m & MSR_CTS)
    470  1.21  mycroft 			bits |= TIOCM_CTS;
    471  1.21  mycroft 		if (m & MSR_DSR)
    472  1.21  mycroft 			bits |= TIOCM_DSR;
    473  1.21  mycroft 		if (m & (MSR_RI | MSR_TERI))
    474  1.21  mycroft 			bits |= TIOCM_RI;
    475  1.21  mycroft 		if (inb(iobase + com_ier))
    476  1.21  mycroft 			bits |= TIOCM_LE;
    477  1.21  mycroft 		*(int *)data = bits;
    478   1.1      cgd 		break;
    479  1.21  mycroft 	}
    480  1.22      cgd 	case TIOCGFLAGS: {
    481  1.22      cgd 		int bits = 0;
    482  1.22      cgd 
    483  1.22      cgd 		if (sc->sc_swflags & COM_SW_SOFTCAR)
    484  1.22      cgd 			bits |= TIOCFLAG_SOFTCAR;
    485  1.22      cgd 		if (sc->sc_swflags & COM_SW_CLOCAL)
    486  1.22      cgd 			bits |= TIOCFLAG_CLOCAL;
    487  1.22      cgd 		if (sc->sc_swflags & COM_SW_CRTSCTS)
    488  1.22      cgd 			bits |= TIOCFLAG_CRTSCTS;
    489  1.25      cgd 		if (sc->sc_swflags & COM_SW_MDMBUF)
    490  1.25      cgd 			bits |= TIOCFLAG_MDMBUF;
    491  1.22      cgd 
    492  1.22      cgd 		*(int *)data = bits;
    493  1.22      cgd 		break;
    494  1.22      cgd 	}
    495  1.22      cgd 	case TIOCSFLAGS: {
    496  1.22      cgd 		int userbits, driverbits = 0;
    497  1.22      cgd 
    498  1.23      cgd 		error = suser(p->p_ucred, &p->p_acflag);
    499  1.23      cgd 		if (error != 0)
    500  1.23      cgd 			return(EPERM);
    501  1.22      cgd 
    502  1.22      cgd 		userbits = *(int *)data;
    503  1.23      cgd 		if ((userbits & TIOCFLAG_SOFTCAR) ||
    504  1.22      cgd 		    (sc->sc_hwflags & COM_HW_CONSOLE))
    505  1.23      cgd 			driverbits |= COM_SW_SOFTCAR;
    506  1.22      cgd 		if (userbits & TIOCFLAG_CLOCAL)
    507  1.22      cgd 			driverbits |= COM_SW_CLOCAL;
    508  1.22      cgd 		if (userbits & TIOCFLAG_CRTSCTS)
    509  1.22      cgd 			driverbits |= COM_SW_CRTSCTS;
    510  1.31      cgd 		if (userbits & TIOCFLAG_MDMBUF)
    511  1.31      cgd 			driverbits |= COM_SW_MDMBUF;
    512  1.22      cgd 
    513  1.23      cgd 		sc->sc_swflags = driverbits;
    514  1.22      cgd 		break;
    515  1.22      cgd 	}
    516   1.1      cgd 	default:
    517  1.21  mycroft 		return ENOTTY;
    518   1.1      cgd 	}
    519  1.21  mycroft 
    520  1.21  mycroft 	return 0;
    521   1.1      cgd }
    522   1.1      cgd 
    523  1.21  mycroft int
    524   1.1      cgd comparam(tp, t)
    525  1.21  mycroft 	struct tty *tp;
    526  1.21  mycroft 	struct termios *t;
    527   1.1      cgd {
    528  1.29  mycroft 	struct com_softc *sc = comcd.cd_devs[COMUNIT(tp->t_dev)];
    529  1.21  mycroft 	u_short iobase = sc->sc_iobase;
    530  1.21  mycroft 	int ospeed = comspeed(t->c_ospeed);
    531  1.21  mycroft 	u_char cfcr;
    532  1.21  mycroft 	int s;
    533  1.21  mycroft 
    534   1.1      cgd 	/* check requested parameters */
    535  1.21  mycroft 	if (ospeed < 0 || (t->c_ispeed && t->c_ispeed != t->c_ospeed))
    536  1.21  mycroft 		return EINVAL;
    537  1.21  mycroft 
    538  1.21  mycroft 	switch (t->c_cflag & CSIZE) {
    539   1.1      cgd 	case CS5:
    540  1.21  mycroft 		cfcr = CFCR_5BITS;
    541  1.21  mycroft 		break;
    542   1.1      cgd 	case CS6:
    543  1.21  mycroft 		cfcr = CFCR_6BITS;
    544  1.21  mycroft 		break;
    545   1.1      cgd 	case CS7:
    546  1.21  mycroft 		cfcr = CFCR_7BITS;
    547  1.21  mycroft 		break;
    548   1.1      cgd 	case CS8:
    549  1.21  mycroft 		cfcr = CFCR_8BITS;
    550  1.21  mycroft 		break;
    551   1.1      cgd 	}
    552  1.21  mycroft 	if (t->c_cflag & PARENB) {
    553   1.1      cgd 		cfcr |= CFCR_PENAB;
    554  1.21  mycroft 		if ((t->c_cflag & PARODD) == 0)
    555   1.1      cgd 			cfcr |= CFCR_PEVEN;
    556   1.1      cgd 	}
    557  1.21  mycroft 	if (t->c_cflag & CSTOPB)
    558   1.1      cgd 		cfcr |= CFCR_STOPB;
    559   1.1      cgd 
    560  1.21  mycroft 	s = spltty();
    561  1.21  mycroft 
    562  1.21  mycroft 	if (ospeed == 0)
    563  1.21  mycroft 		outb(iobase + com_mcr, sc->sc_mcr &= ~MCR_DTR);
    564  1.21  mycroft 	else
    565  1.21  mycroft 		outb(iobase + com_mcr, sc->sc_mcr |= MCR_DTR);
    566  1.21  mycroft 
    567  1.21  mycroft 	outb(iobase + com_cfcr, cfcr | CFCR_DLAB);
    568  1.21  mycroft 	outb(iobase + com_dlbl, ospeed);
    569  1.21  mycroft 	outb(iobase + com_dlbh, ospeed>>8);
    570  1.21  mycroft 	outb(iobase + com_cfcr, cfcr);
    571  1.21  mycroft 
    572  1.22      cgd 	/* When not using CRTSCTS, RTS follows DTR. */
    573  1.22      cgd 	if ((t->c_cflag & CRTSCTS) == 0) {
    574  1.21  mycroft 		if (sc->sc_mcr & MCR_DTR) {
    575  1.21  mycroft 			if ((sc->sc_mcr & MCR_RTS) == 0)
    576  1.21  mycroft 				outb(iobase + com_mcr, sc->sc_mcr |= MCR_RTS);
    577  1.21  mycroft 		} else {
    578  1.21  mycroft 			if (sc->sc_mcr & MCR_RTS)
    579  1.21  mycroft 				outb(iobase + com_mcr, sc->sc_mcr &= ~MCR_RTS);
    580  1.21  mycroft 		}
    581  1.21  mycroft 	}
    582  1.21  mycroft 
    583  1.25      cgd 	/*
    584  1.25      cgd 	 * If CTS is off and CRTSCTS is changed, we must toggle TS_TTSTOP.
    585  1.25      cgd 	 * XXX should be done at tty layer.
    586  1.25      cgd 	 */
    587  1.21  mycroft 	if ((sc->sc_msr & MSR_CTS) == 0 &&
    588  1.22      cgd 	    (tp->t_cflag & CRTSCTS) != (t->c_cflag & CRTSCTS)) {
    589  1.22      cgd 		if ((t->c_cflag & CRTSCTS) == 0) {
    590  1.25      cgd 			tp->t_state &= ~TS_TTSTOP;
    591  1.32  mycroft 			(*linesw[tp->t_line].l_start)(tp);
    592  1.25      cgd 		} else
    593  1.25      cgd 			tp->t_state |= TS_TTSTOP;
    594  1.25      cgd 	}
    595  1.25      cgd 
    596  1.25      cgd 	/*
    597  1.25      cgd 	 * If DCD is off and MDMBUF is changed, we must toggle TS_TTSTOP.
    598  1.25      cgd 	 * XXX should be done at tty layer.
    599  1.25      cgd 	 */
    600  1.25      cgd 	if ((sc->sc_swflags & COM_SW_SOFTCAR) == 0 &&
    601  1.25      cgd 	    (sc->sc_msr & MSR_DCD) == 0 &&
    602  1.25      cgd 	    (tp->t_cflag & MDMBUF) != (t->c_cflag & MDMBUF)) {
    603  1.25      cgd 		if ((t->c_cflag & MDMBUF) == 0) {
    604  1.21  mycroft 			tp->t_state &= ~TS_TTSTOP;
    605  1.32  mycroft 			(*linesw[tp->t_line].l_start)(tp);
    606  1.21  mycroft 		} else
    607  1.21  mycroft 			tp->t_state |= TS_TTSTOP;
    608  1.21  mycroft 	}
    609   1.1      cgd 
    610  1.32  mycroft 	/* and copy to tty */
    611  1.32  mycroft 	tp->t_ispeed = t->c_ispeed;
    612  1.32  mycroft 	tp->t_ospeed = t->c_ospeed;
    613  1.32  mycroft 	tp->t_cflag = t->c_cflag;
    614  1.32  mycroft 
    615  1.21  mycroft 	splx(s);
    616  1.21  mycroft 	return 0;
    617   1.1      cgd }
    618  1.21  mycroft 
    619  1.12  deraadt void
    620   1.1      cgd comstart(tp)
    621  1.21  mycroft 	struct tty *tp;
    622   1.1      cgd {
    623  1.29  mycroft 	struct com_softc *sc = comcd.cd_devs[COMUNIT(tp->t_dev)];
    624  1.21  mycroft 	u_short iobase = sc->sc_iobase;
    625  1.21  mycroft 	int s;
    626  1.21  mycroft 
    627   1.1      cgd 	s = spltty();
    628  1.21  mycroft 	if (tp->t_state & (TS_TTSTOP | TS_BUSY))
    629  1.21  mycroft 		goto out;
    630  1.21  mycroft #if 0 /* XXXX I think this is handled adequately by commint() and comparam(). */
    631  1.22      cgd 	if (tp->t_cflag & CRTSCTS && (sc->sc_mcr & MSR_CTS) == 0)
    632   1.1      cgd 		goto out;
    633  1.21  mycroft #endif
    634  1.11  mycroft 	if (tp->t_outq.c_cc <= tp->t_lowat) {
    635  1.21  mycroft 		if (tp->t_state & TS_ASLEEP) {
    636   1.1      cgd 			tp->t_state &= ~TS_ASLEEP;
    637  1.11  mycroft 			wakeup((caddr_t)&tp->t_outq);
    638   1.1      cgd 		}
    639   1.7      cgd 		selwakeup(&tp->t_wsel);
    640   1.1      cgd 	}
    641  1.11  mycroft 	if (tp->t_outq.c_cc == 0)
    642   1.1      cgd 		goto out;
    643  1.21  mycroft 	tp->t_state |= TS_BUSY;
    644  1.21  mycroft 	if ((inb(iobase + com_lsr) & LSR_TXRDY) == 0)
    645  1.21  mycroft 		goto out;
    646  1.22      cgd 	if (sc->sc_hwflags & COM_HW_FIFO) {
    647  1.21  mycroft 		u_char buffer[16], *cp = buffer;
    648  1.21  mycroft 		int n = q_to_b(&tp->t_outq, cp, sizeof buffer);
    649  1.21  mycroft 		do {
    650  1.21  mycroft 			outb(iobase + com_data, *cp++);
    651  1.21  mycroft 		} while (--n);
    652  1.21  mycroft 	} else
    653  1.21  mycroft 		outb(iobase + com_data, getc(&tp->t_outq));
    654   1.1      cgd out:
    655   1.1      cgd 	splx(s);
    656   1.1      cgd }
    657  1.21  mycroft 
    658   1.1      cgd /*
    659   1.1      cgd  * Stop output on a line.
    660   1.1      cgd  */
    661  1.21  mycroft void
    662   1.1      cgd comstop(tp, flag)
    663  1.21  mycroft 	struct tty *tp;
    664   1.1      cgd {
    665  1.21  mycroft 	int s;
    666   1.1      cgd 
    667   1.1      cgd 	s = spltty();
    668  1.21  mycroft 	if (tp->t_state & TS_BUSY)
    669  1.21  mycroft 		if ((tp->t_state & TS_TTSTOP) == 0)
    670   1.1      cgd 			tp->t_state |= TS_FLUSH;
    671   1.1      cgd 	splx(s);
    672   1.1      cgd }
    673   1.1      cgd 
    674  1.21  mycroft static inline void
    675  1.21  mycroft comeint(sc, stat)
    676  1.21  mycroft 	struct com_softc *sc;
    677  1.21  mycroft 	int stat;
    678  1.21  mycroft {
    679  1.21  mycroft 	u_short iobase = sc->sc_iobase;
    680  1.21  mycroft 	int unit = sc->sc_dev.dv_unit;
    681  1.21  mycroft 	struct tty *tp = com_tty[unit];
    682  1.21  mycroft 	int c;
    683   1.1      cgd 
    684  1.21  mycroft 	c = inb(iobase + com_data);
    685  1.21  mycroft 	if ((tp->t_state & TS_ISOPEN) == 0) {
    686  1.21  mycroft #ifdef KGDB
    687  1.21  mycroft 		/* we don't care about parity errors */
    688  1.21  mycroft 		if (((stat & (LSR_BI | LSR_FE | LSR_PE)) == LSR_PE) &&
    689  1.21  mycroft 		    kgdb_dev == makedev(commajor, unit) && c == FRAME_END)
    690  1.21  mycroft 			kgdb_connect(0); /* trap into kgdb */
    691  1.21  mycroft #endif
    692  1.21  mycroft 		return;
    693  1.21  mycroft 	}
    694  1.21  mycroft 	if (stat & (LSR_BI | LSR_FE))
    695  1.21  mycroft 		c |= TTY_FE;
    696  1.21  mycroft 	else if (stat & LSR_PE)
    697  1.21  mycroft 		c |= TTY_PE;
    698  1.33  mycroft 	if (stat & LSR_OE) {
    699  1.33  mycroft 		if (sc->sc_overflows++ == 0)
    700  1.33  mycroft 			timeout(comdiag, sc, 60 * hz);
    701  1.33  mycroft 	}
    702  1.21  mycroft 	/* XXXX put in FIFO and process later */
    703  1.21  mycroft 	(*linesw[tp->t_line].l_rint)(c, tp);
    704  1.21  mycroft }
    705  1.21  mycroft 
    706  1.21  mycroft static inline void
    707  1.21  mycroft commint(sc)
    708  1.21  mycroft 	struct com_softc *sc;
    709  1.21  mycroft {
    710  1.21  mycroft 	u_short iobase = sc->sc_iobase;
    711  1.21  mycroft 	struct tty *tp = com_tty[sc->sc_dev.dv_unit];
    712  1.21  mycroft 	u_char msr, delta;
    713  1.21  mycroft 
    714  1.21  mycroft 	msr = inb(iobase + com_msr);
    715  1.21  mycroft 	delta = msr ^ sc->sc_msr;
    716  1.21  mycroft 	sc->sc_msr = msr;
    717   1.1      cgd 
    718  1.22      cgd 	if (delta & MSR_DCD && (sc->sc_swflags & COM_SW_SOFTCAR) == 0) {
    719  1.21  mycroft 		if (msr & MSR_DCD)
    720  1.21  mycroft 			(void)(*linesw[tp->t_line].l_modem)(tp, 1);
    721  1.21  mycroft 		else if ((*linesw[tp->t_line].l_modem)(tp, 0) == 0)
    722  1.21  mycroft 			outb(iobase + com_mcr,
    723  1.21  mycroft 			    sc->sc_mcr &= ~(MCR_DTR | MCR_RTS));
    724  1.21  mycroft 	}
    725  1.22      cgd 	if (delta & MSR_CTS && tp->t_cflag & CRTSCTS) {
    726  1.21  mycroft 		/* the line is up and we want to do rts/cts flow control */
    727  1.21  mycroft 		if (msr & MSR_CTS) {
    728  1.21  mycroft 			tp->t_state &= ~TS_TTSTOP;
    729  1.32  mycroft 			(*linesw[tp->t_line].l_start)(tp);
    730  1.21  mycroft 		} else
    731  1.21  mycroft 			tp->t_state |= TS_TTSTOP;
    732  1.21  mycroft 	}
    733  1.33  mycroft }
    734  1.33  mycroft 
    735  1.33  mycroft void
    736  1.33  mycroft comdiag(arg)
    737  1.33  mycroft 	void *arg;
    738  1.33  mycroft {
    739  1.33  mycroft 	struct com_softc *sc = arg;
    740  1.33  mycroft 	int overflows;
    741  1.33  mycroft 	int s;
    742  1.33  mycroft 
    743  1.33  mycroft 	s = spltty();
    744  1.33  mycroft 	overflows = sc->sc_overflows;
    745  1.33  mycroft 	sc->sc_overflows = 0;
    746  1.33  mycroft 	splx(s);
    747  1.33  mycroft 
    748  1.33  mycroft 	if (overflows)
    749  1.33  mycroft 		log(LOG_WARNING, "%s: %d silo overflow%s\n",
    750  1.33  mycroft 		    sc->sc_dev.dv_xname, overflows, overflows == 1 ? "" : "s");
    751  1.21  mycroft }
    752   1.1      cgd 
    753  1.21  mycroft int
    754  1.30  mycroft comintr(sc)
    755  1.30  mycroft 	struct com_softc *sc;
    756  1.21  mycroft {
    757  1.21  mycroft 	u_short iobase = sc->sc_iobase;
    758  1.21  mycroft 	struct tty *tp;
    759  1.21  mycroft 	u_char code;
    760  1.21  mycroft 
    761  1.21  mycroft 	code = inb(iobase + com_iir) & IIR_IMASK;
    762  1.21  mycroft 	if (code & IIR_NOPEND)
    763  1.21  mycroft 		return 0;
    764  1.21  mycroft 
    765  1.21  mycroft 	for (;;) {
    766  1.21  mycroft 		if (code & IIR_RXRDY) {
    767  1.21  mycroft 			tp = com_tty[sc->sc_dev.dv_unit];
    768  1.21  mycroft 			/* XXXX put in FIFO and process later */
    769  1.21  mycroft 			while (code = (inb(iobase + com_lsr) & LSR_RCV_MASK)) {
    770  1.21  mycroft 				if (code == LSR_RXRDY) {
    771  1.21  mycroft 					code = inb(iobase + com_data);
    772  1.21  mycroft 					if (tp->t_state & TS_ISOPEN)
    773  1.21  mycroft 						(*linesw[tp->t_line].l_rint)(code, tp);
    774  1.21  mycroft #ifdef KGDB
    775  1.21  mycroft 					else {
    776  1.21  mycroft 						if (kgdb_dev == makedev(commajor, unit) &&
    777  1.21  mycroft 						    code == FRAME_END)
    778  1.21  mycroft 							kgdb_connect(0);
    779  1.21  mycroft 					}
    780  1.21  mycroft #endif
    781  1.21  mycroft 				} else
    782  1.21  mycroft 					comeint(sc, code);
    783  1.21  mycroft 			}
    784  1.21  mycroft 		} else if (code == IIR_TXRDY) {
    785  1.21  mycroft 			tp = com_tty[sc->sc_dev.dv_unit];
    786  1.21  mycroft 			tp->t_state &= ~TS_BUSY;
    787  1.21  mycroft 			if (tp->t_state & TS_FLUSH)
    788  1.21  mycroft 				tp->t_state &= ~TS_FLUSH;
    789  1.21  mycroft 			else
    790  1.21  mycroft 				if (tp->t_line)
    791  1.21  mycroft 					(*linesw[tp->t_line].l_start)(tp);
    792  1.21  mycroft 				else
    793  1.21  mycroft 					comstart(tp);
    794  1.21  mycroft 		} else if (code == IIR_MLSC) {
    795  1.21  mycroft 			commint(sc);
    796  1.21  mycroft 		} else {
    797  1.21  mycroft 			log(LOG_WARNING, "%s: weird interrupt: iir=0x%02x\n",
    798  1.21  mycroft 			    sc->sc_dev.dv_xname, code);
    799  1.21  mycroft 		}
    800  1.21  mycroft 		code = inb(iobase + com_iir) & IIR_IMASK;
    801  1.21  mycroft 		if (code & IIR_NOPEND)
    802  1.21  mycroft 			return 1;
    803   1.1      cgd 	}
    804   1.1      cgd }
    805   1.1      cgd 
    806   1.1      cgd /*
    807   1.1      cgd  * Following are all routines needed for COM to act as console
    808   1.1      cgd  */
    809  1.17      cgd #include <dev/cons.h>
    810   1.1      cgd 
    811   1.1      cgd comcnprobe(cp)
    812   1.1      cgd 	struct consdev *cp;
    813   1.1      cgd {
    814  1.21  mycroft 
    815  1.21  mycroft 	if (!comprobe1(CONADDR)) {
    816  1.21  mycroft 		cp->cn_pri = CN_DEAD;
    817  1.21  mycroft 		return;
    818  1.21  mycroft 	}
    819   1.1      cgd 
    820   1.1      cgd 	/* locate the major number */
    821   1.1      cgd 	for (commajor = 0; commajor < nchrdev; commajor++)
    822   1.1      cgd 		if (cdevsw[commajor].d_open == comopen)
    823   1.1      cgd 			break;
    824   1.1      cgd 
    825   1.1      cgd 	/* initialize required fields */
    826  1.29  mycroft 	cp->cn_dev = makedev(commajor, CONUNIT);
    827   1.1      cgd #ifdef	COMCONSOLE
    828   1.1      cgd 	cp->cn_pri = CN_REMOTE;		/* Force a serial port console */
    829   1.1      cgd #else
    830   1.1      cgd 	cp->cn_pri = CN_NORMAL;
    831   1.1      cgd #endif
    832   1.1      cgd }
    833   1.1      cgd 
    834   1.1      cgd comcninit(cp)
    835   1.1      cgd 	struct consdev *cp;
    836   1.1      cgd {
    837   1.1      cgd 
    838  1.29  mycroft 	cominit(CONUNIT, comdefaultrate);
    839  1.29  mycroft 	comconsole = CONUNIT;
    840  1.21  mycroft 	comconsinit = 0;
    841   1.1      cgd }
    842   1.1      cgd 
    843   1.1      cgd cominit(unit, rate)
    844   1.1      cgd 	int unit, rate;
    845   1.1      cgd {
    846  1.21  mycroft 	int s = splhigh();
    847  1.29  mycroft 	u_short iobase = CONADDR;
    848  1.21  mycroft 	u_char stat;
    849   1.1      cgd 
    850  1.21  mycroft 	outb(iobase + com_cfcr, CFCR_DLAB);
    851  1.21  mycroft 	rate = comspeed(comdefaultrate);
    852  1.21  mycroft 	outb(iobase + com_dlbl, rate);
    853  1.21  mycroft 	outb(iobase + com_dlbh, rate >> 8);
    854  1.21  mycroft 	outb(iobase + com_cfcr, CFCR_8BITS);
    855  1.21  mycroft 	outb(iobase + com_ier, IER_ERXRDY | IER_ETXRDY);
    856  1.21  mycroft 	outb(iobase + com_fifo, FIFO_ENABLE | FIFO_RCV_RST | FIFO_XMT_RST | FIFO_TRIGGER_4);
    857  1.21  mycroft 	stat = inb(iobase + com_iir);
    858   1.1      cgd 	splx(s);
    859   1.1      cgd }
    860   1.1      cgd 
    861   1.1      cgd comcngetc(dev)
    862  1.21  mycroft 	dev_t dev;
    863   1.1      cgd {
    864  1.21  mycroft 	int s = splhigh();
    865  1.29  mycroft 	u_short iobase = CONADDR;
    866  1.21  mycroft 	u_char stat, c;
    867   1.1      cgd 
    868  1.21  mycroft 	while (((stat = inb(iobase + com_lsr)) & LSR_RXRDY) == 0)
    869   1.1      cgd 		;
    870  1.21  mycroft 	c = inb(iobase + com_data);
    871  1.21  mycroft 	stat = inb(iobase + com_iir);
    872   1.1      cgd 	splx(s);
    873  1.21  mycroft 	return c;
    874   1.1      cgd }
    875   1.1      cgd 
    876   1.1      cgd /*
    877   1.1      cgd  * Console kernel output character routine.
    878   1.1      cgd  */
    879   1.1      cgd comcnputc(dev, c)
    880   1.1      cgd 	dev_t dev;
    881  1.21  mycroft 	int c;
    882   1.1      cgd {
    883  1.21  mycroft 	int s = splhigh();
    884  1.29  mycroft 	u_short iobase = CONADDR;
    885  1.21  mycroft 	u_char stat;
    886   1.1      cgd 	register int timo;
    887   1.1      cgd 
    888   1.1      cgd #ifdef KGDB
    889   1.1      cgd 	if (dev != kgdb_dev)
    890   1.1      cgd #endif
    891   1.1      cgd 	if (comconsinit == 0) {
    892  1.21  mycroft 		(void) cominit(COMUNIT(dev), comdefaultrate);
    893   1.1      cgd 		comconsinit = 1;
    894   1.1      cgd 	}
    895   1.1      cgd 	/* wait for any pending transmission to finish */
    896   1.1      cgd 	timo = 50000;
    897  1.21  mycroft 	while (((stat = inb(iobase + com_lsr)) & LSR_TXRDY) == 0 && --timo)
    898   1.1      cgd 		;
    899  1.21  mycroft 	outb(iobase + com_data, c);
    900   1.1      cgd 	/* wait for this transmission to complete */
    901   1.1      cgd 	timo = 1500000;
    902  1.21  mycroft 	while (((stat = inb(iobase + com_lsr)) & LSR_TXRDY) == 0 && --timo)
    903   1.1      cgd 		;
    904   1.1      cgd 	/* clear any interrupts generated by this transmission */
    905  1.21  mycroft 	stat = inb(iobase + com_iir);
    906   1.1      cgd 	splx(s);
    907   1.2      cgd }
    908