Home | History | Annotate | Line # | Download | only in dev
ser.c revision 1.6.6.1
      1 /*	$NetBSD: ser.c,v 1.6.6.1 1999/04/07 08:12:40 pk Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 1997 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by Leo Weppelman.
      9  *
     10  * Redistribution and use in source and binary forms, with or without
     11  * modification, are permitted provided that the following conditions
     12  * are met:
     13  * 1. Redistributions of source code must retain the above copyright
     14  *    notice, this list of conditions and the following disclaimer.
     15  * 2. Redistributions in binary form must reproduce the above copyright
     16  *    notice, this list of conditions and the following disclaimer in the
     17  *    documentation and/or other materials provided with the distribution.
     18  * 3. All advertising materials mentioning features or use of this software
     19  *    must display the following acknowledgement:
     20  *        This product includes software developed by the NetBSD
     21  *        Foundation, Inc. and its contributors.
     22  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23  *    contributors may be used to endorse or promote products derived
     24  *    from this software without specific prior written permission.
     25  *
     26  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36  * POSSIBILITY OF SUCH DAMAGE.
     37  */
     38 /*-
     39  * Copyright (c) 1993, 1994, 1995, 1996, 1997
     40  *      Charles M. Hannum.  All rights reserved.
     41  *
     42  * Interrupt processing and hardware flow control partly based on code from
     43  * Onno van der Linden and Gordon Ross.
     44  *
     45  * Redistribution and use in source and binary forms, with or without
     46  * modification, are permitted provided that the following conditions
     47  * are met:
     48  * 1. Redistributions of source code must retain the above copyright
     49  *    notice, this list of conditions and the following disclaimer.
     50  * 2. Redistributions in binary form must reproduce the above copyright
     51  *    notice, this list of conditions and the following disclaimer in the
     52  *    documentation and/or other materials provided with the distribution.
     53  * 3. All advertising materials mentioning features or use of this software
     54  *    must display the following acknowledgement:
     55  *      This product includes software developed by Charles M. Hannum.
     56  * 4. The name of the author may not be used to endorse or promote products
     57  *    derived from this software without specific prior written permission.
     58  *
     59  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     60  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     61  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     62  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     63  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     64  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     65  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     66  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     67  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     68  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     69  */
     70 
     71 /*
     72  * Copyright (c) 1991 The Regents of the University of California.
     73  * All rights reserved.
     74  *
     75  * Redistribution and use in source and binary forms, with or without
     76  * modification, are permitted provided that the following conditions
     77  * are met:
     78  * 1. Redistributions of source code must retain the above copyright
     79  *    notice, this list of conditions and the following disclaimer.
     80  * 2. Redistributions in binary form must reproduce the above copyright
     81  *    notice, this list of conditions and the following disclaimer in the
     82  *    documentation and/or other materials provided with the distribution.
     83  * 3. All advertising materials mentioning features or use of this software
     84  *    must display the following acknowledgement:
     85  *      This product includes software developed by the University of
     86  *      California, Berkeley and its contributors.
     87  * 4. Neither the name of the University nor the names of its contributors
     88  *    may be used to endorse or promote products derived from this software
     89  *    without specific prior written permission.
     90  *
     91  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     92  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     93  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     94  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     95  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     96  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     97  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     98  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     99  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
    100  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
    101  * SUCH DAMAGE.
    102  *
    103  *      @(#)com.c       7.5 (Berkeley) 5/16/91
    104  */
    105 
    106 #include "opt_ddb.h"
    107 
    108 #include <sys/param.h>
    109 #include <sys/systm.h>
    110 #include <sys/ioctl.h>
    111 #include <sys/select.h>
    112 #include <sys/tty.h>
    113 #include <sys/proc.h>
    114 #include <sys/user.h>
    115 #include <sys/conf.h>
    116 #include <sys/file.h>
    117 #include <sys/uio.h>
    118 #include <sys/kernel.h>
    119 #include <sys/syslog.h>
    120 #include <sys/types.h>
    121 #include <sys/device.h>
    122 
    123 #include <m68k/asm_single.h>
    124 
    125 #include <machine/iomap.h>
    126 #include <machine/mfp.h>
    127 #include <atari/atari/intr.h>
    128 #include <atari/dev/ym2149reg.h>
    129 #include <atari/dev/serreg.h>
    130 
    131 /* #define SER_DEBUG */
    132 
    133 #define	SERUNIT(x)	(minor(x) & 0x7ffff)
    134 #define	SERDIALOUT(x)	(minor(x) & 0x80000)
    135 
    136 /* XXX */
    137 #define	CONSBAUD	9600
    138 #define	CONSCFLAG	TTYDEF_CFLAG
    139 /* end XXX */
    140 
    141 /* Macros to clear/set/test flags. */
    142 #define SET(t, f)	(t) |= (f)
    143 #define CLR(t, f)	(t) &= ~(f)
    144 #define ISSET(t, f)	((t) & (f))
    145 
    146 #define	splserial()	spl6()
    147 
    148 /* Buffer size for character buffer */
    149 #define RXBUFSIZE 2048		/* More than enough..			*/
    150 #define RXBUFMASK (RXBUFSIZE-1)	/* Only iff previous is a power of 2	*/
    151 #define RXHIWAT   (RXBUFSIZE >> 2)
    152 
    153 struct ser_softc {
    154 	struct device	 sc_dev;
    155 	struct tty	*sc_tty;
    156 
    157 	int		 sc_overflows;
    158 	int		 sc_floods;
    159 	int		 sc_errors;
    160 
    161 	u_char		 sc_hwflags;
    162 	u_char		 sc_swflags;
    163 
    164 	int		 sc_ospeed;		/* delay + timer-d data	*/
    165 	u_char		 sc_imra;
    166 	u_char		 sc_imrb;
    167 	u_char		 sc_ucr;		/* Uart control		*/
    168 	u_char		 sc_msr;		/* Modem status		*/
    169 	u_char		 sc_tsr;		/* Tranceiver status	*/
    170 	u_char		 sc_rsr;		/* Receiver status	*/
    171 	u_char		 sc_mcr;		/* (Pseudo) Modem ctrl. */
    172 
    173 	u_char		 sc_msr_delta;
    174 	u_char		 sc_msr_mask;
    175 	u_char		 sc_mcr_active;
    176 	u_char		 sc_mcr_dtr, sc_mcr_rts, sc_msr_cts, sc_msr_dcd;
    177 
    178 	int		 sc_r_hiwat;
    179  	volatile u_int	 sc_rbget;
    180  	volatile u_int	 sc_rbput;
    181 	volatile u_int	 sc_rbavail;
    182  	u_char		 sc_rbuf[RXBUFSIZE];
    183 	u_char		 sc_lbuf[RXBUFSIZE];
    184 
    185 	volatile u_char	 sc_rx_blocked;
    186 	volatile u_char	 sc_rx_ready;
    187 	volatile u_char	 sc_tx_busy;
    188 	volatile u_char	 sc_tx_done;
    189 	volatile u_char	 sc_tx_stopped;
    190 	volatile u_char	 sc_st_check;
    191 
    192  	u_char		*sc_tba;
    193  	int		 sc_tbc;
    194 	int		 sc_heldtbc;
    195 
    196 	volatile u_char	 sc_heldchange;
    197 };
    198 
    199 /*
    200  * For sc_hwflags:
    201  */
    202 #define	SER_HW_CONSOLE	0x01
    203 
    204 cdev_decl(ser);
    205 
    206 void	ser_break __P((struct ser_softc *, int));
    207 void	ser_hwiflow __P((struct ser_softc *, int));
    208 void	ser_iflush __P((struct ser_softc *));
    209 void	ser_loadchannelregs __P((struct ser_softc *));
    210 void	ser_modem __P((struct ser_softc *, int));
    211 void	serdiag __P((void *));
    212 int	serhwiflow __P((struct tty *, int));
    213 void	serinit __P((int));
    214 void	serinitcons __P((int));
    215 int	baud;
    216 int	sermintr __P((void *));
    217 int	sertrintr __P((void *));
    218 int	serparam __P((struct tty *, struct termios *));
    219 void	serstart __P((struct tty *));
    220 
    221 struct consdev;
    222 void	sercnprobe	__P((struct consdev *));
    223 void	sercninit	__P((struct consdev *));
    224 int	sercngetc	__P((dev_t));
    225 void	sercnputc	__P((dev_t, int));
    226 void	sercnpollc	__P((dev_t, int));
    227 
    228 static void sermsrint __P((struct ser_softc *, struct tty*));
    229 static void serrxint __P((struct ser_softc *, struct tty*));
    230 static void ser_shutdown __P((struct ser_softc *));
    231 static int serspeed __P((long));
    232 static void sersoft __P((void *));
    233 static void sertxint __P((struct ser_softc *, struct tty*));
    234 
    235 static volatile int ser_softintr_scheduled = 0;
    236 static int	sermajor;
    237 
    238 /*
    239  * Autoconfig stuff
    240  */
    241 static void serattach __P((struct device *, struct device *, void *));
    242 static int  sermatch __P((struct device *, struct cfdata *, void *));
    243 
    244 struct cfattach ser_ca = {
    245 	sizeof(struct ser_softc), sermatch, serattach
    246 };
    247 
    248 extern struct cfdriver ser_cd;
    249 
    250 /*ARGSUSED*/
    251 static	int
    252 sermatch(pdp, cfp, auxp)
    253 struct	device	*pdp;
    254 struct	cfdata	*cfp;
    255 void		*auxp;
    256 {
    257 	if (!strcmp((char *)auxp, "ser") && cfp->cf_unit == 0)
    258 		return (1);
    259 	return (0);
    260 }
    261 
    262 /*ARGSUSED*/
    263 static void
    264 serattach(pdp, dp, auxp)
    265 struct	device *pdp, *dp;
    266 void	*auxp;
    267 {
    268 	struct ser_softc *sc = (void *)dp;
    269 
    270 	if (intr_establish(1, USER_VEC, 0, (hw_ifun_t)sermintr, sc) == NULL)
    271 		printf("serattach: Can't establish interrupt (1)\n");
    272 	if (intr_establish(2, USER_VEC, 0, (hw_ifun_t)sermintr, sc) == NULL)
    273 		printf("serattach: Can't establish interrupt (2)\n");
    274 	if (intr_establish(14, USER_VEC, 0, (hw_ifun_t)sermintr, sc) == NULL)
    275 		printf("serattach: Can't establish interrupt (14)\n");
    276 	if (intr_establish(9, USER_VEC, 0, (hw_ifun_t)sertrintr, sc) == NULL)
    277 		printf("serattach: Can't establish interrupt (9)\n");
    278 	if (intr_establish(10, USER_VEC, 0, (hw_ifun_t)sertrintr, sc) == NULL)
    279 		printf("serattach: Can't establish interrupt (10)\n");
    280 	if (intr_establish(11, USER_VEC, 0, (hw_ifun_t)sertrintr, sc) == NULL)
    281 		printf("serattach: Can't establish interrupt (11)\n");
    282 	if (intr_establish(12, USER_VEC, 0, (hw_ifun_t)sertrintr, sc) == NULL)
    283 		printf("serattach: Can't establish interrupt (12)\n");
    284 
    285 	ym2149_rts(1);
    286 	ym2149_dtr(1);
    287 
    288 	/*
    289 	 * Enable but mask interrupts...
    290 	 * XXX: Look at edge-sensitivity for DCD/CTS interrupts.
    291 	 */
    292 	MFP->mf_ierb |= IB_SCTS|IB_SDCD;
    293 	MFP->mf_iera |= IA_RRDY|IA_RERR|IA_TRDY|IA_TERR;
    294 	MFP->mf_imrb &= ~(IB_SCTS|IB_SDCD);
    295 	MFP->mf_imra &= ~(IA_RRDY|IA_RERR|IA_TRDY|IA_TERR);
    296 
    297 #ifdef SERCONSOLE
    298 	/*
    299 	 * Activate serial console when DCD present...
    300 	 */
    301 	if (!(MFP->mf_gpip & MCR_DCD))
    302 		SET(sc->sc_hwflags, SER_HW_CONSOLE);
    303 #endif /* SERCONSOLE */
    304 
    305 	printf("\n");
    306 	if (ISSET(sc->sc_hwflags, SER_HW_CONSOLE)) {
    307 		serinit(CONSBAUD);
    308 		printf("%s: console\n", sc->sc_dev.dv_xname);
    309 	}
    310 }
    311 
    312 #ifdef SER_DEBUG
    313 void serstatus __P((struct ser_softc *, char *));
    314 void
    315 serstatus(sc, str)
    316 	struct ser_softc *sc;
    317 	char *str;
    318 {
    319 	struct tty *tp = sc->sc_tty;
    320 
    321 	printf("%s: %s %sclocal  %sdcd %sts_carr_on %sdtr %stx_stopped\n",
    322 	    sc->sc_dev.dv_xname, str,
    323 	    ISSET(tp->t_cflag, CLOCAL) ? "+" : "-",
    324 	    ISSET(sc->sc_msr, MCR_DCD) ? "+" : "-",
    325 	    ISSET(tp->t_state, TS_CARR_ON) ? "+" : "-",
    326 	    ISSET(sc->sc_mcr, MCR_DTR) ? "+" : "-",
    327 	    sc->sc_tx_stopped ? "+" : "-");
    328 
    329 	printf("%s: %s %scrtscts %scts %sts_ttstop  %srts %srx_blocked\n",
    330 	    sc->sc_dev.dv_xname, str,
    331 	    ISSET(tp->t_cflag, CRTSCTS) ? "+" : "-",
    332 	    ISSET(sc->sc_msr, MCR_CTS) ? "+" : "-",
    333 	    ISSET(tp->t_state, TS_TTSTOP) ? "+" : "-",
    334 	    ISSET(sc->sc_mcr, MCR_RTS) ? "+" : "-",
    335 	    sc->sc_rx_blocked ? "+" : "-");
    336 }
    337 #endif /* SER_DEBUG */
    338 
    339 int
    340 seropen(dev, flag, mode, p)
    341 	dev_t dev;
    342 	int flag, mode;
    343 	struct proc *p;
    344 {
    345 	int unit = SERUNIT(dev);
    346 	struct ser_softc *sc;
    347 	struct tty *tp;
    348 	int s, s2;
    349 	int error = 0;
    350 
    351 	if (unit >= ser_cd.cd_ndevs)
    352 		return (ENXIO);
    353 	sc = ser_cd.cd_devs[unit];
    354 	if (!sc)
    355 		return (ENXIO);
    356 
    357 	if (!sc->sc_tty) {
    358 		tp = sc->sc_tty = ttymalloc();
    359 		tty_attach(tp);
    360 	} else
    361 		tp = sc->sc_tty;
    362 
    363 	if (ISSET(tp->t_state, TS_ISOPEN) &&
    364 	    ISSET(tp->t_state, TS_XCLUDE) &&
    365 	    p->p_ucred->cr_uid != 0)
    366 		return (EBUSY);
    367 
    368 	s = spltty();
    369 
    370 	/*
    371 	 * Do the following if this is a first open.
    372 	 */
    373 	if (!ISSET(tp->t_state, TS_ISOPEN) && tp->t_wopen == 0) {
    374 	    struct termios t;
    375 
    376 	    /* Turn on interrupts. */
    377 	    sc->sc_imra = IA_RRDY|IA_RERR|IA_TRDY|IA_TERR;
    378 	    sc->sc_imrb = IB_SCTS|IB_SDCD;
    379 	    single_inst_bset_b(MFP->mf_imra, sc->sc_imra);
    380 	    single_inst_bset_b(MFP->mf_imrb, sc->sc_imrb);
    381 
    382 	    /* Fetch the current modem control status, needed later. */
    383 	    sc->sc_msr = ~MFP->mf_gpip & (IO_SDCD|IO_SCTS|IO_SRI);
    384 
    385 	    /* Add some entry points needed by the tty layer. */
    386 	    tp->t_oproc = serstart;
    387 	    tp->t_param = serparam;
    388 	    tp->t_hwiflow = serhwiflow;
    389 	    tp->t_dev = dev;
    390 
    391 	    /*
    392 	     * Initialize the termios status to the defaults.  Add in the
    393 	     * sticky bits from TIOCSFLAGS.
    394 	     */
    395 	    t.c_ispeed = 0;
    396 	    if (ISSET(sc->sc_hwflags, SER_HW_CONSOLE)) {
    397 		    t.c_ospeed = CONSBAUD;
    398 		    t.c_cflag  = CONSCFLAG;
    399 	    }
    400 	    else {
    401 		    t.c_ospeed = TTYDEF_SPEED;
    402 		    t.c_cflag = TTYDEF_CFLAG;
    403 	    }
    404 	    if (ISSET(sc->sc_swflags, TIOCFLAG_CLOCAL))
    405 		    SET(t.c_cflag, CLOCAL);
    406 	    if (ISSET(sc->sc_swflags, TIOCFLAG_CRTSCTS))
    407 		    SET(t.c_cflag, CRTSCTS);
    408 	    if (ISSET(sc->sc_swflags, TIOCFLAG_MDMBUF))
    409 		    SET(t.c_cflag, MDMBUF);
    410 	    tp->t_iflag = TTYDEF_IFLAG;
    411 	    tp->t_oflag = TTYDEF_OFLAG;
    412 	    tp->t_lflag = TTYDEF_LFLAG;
    413 	    ttychars(tp);
    414 	    (void) serparam(tp, &t);
    415 	    ttsetwater(tp);
    416 
    417 	    s2 = splserial();
    418 
    419 	    /*
    420 	     * Turn on DTR.  We must always do this, even if carrier is not
    421 	     * present, because otherwise we'd have to use TIOCSDTR
    422 	     * immediately after setting CLOCAL.  We will drop DTR only on
    423 	     * the next high-low transition of DCD, or by explicit request.
    424 	     */
    425 	    ser_modem(sc, 1);
    426 
    427 	    /* Clear the input ring, and unblock. */
    428 	    sc->sc_rbput = sc->sc_rbget = 0;
    429 	    sc->sc_rbavail = RXBUFSIZE;
    430 	    ser_iflush(sc);
    431 	    sc->sc_rx_blocked = 0;
    432 	    ser_hwiflow(sc, 0);
    433 
    434 #ifdef SER_DEBUG
    435 	    serstatus(sc, "seropen  ");
    436 #endif
    437 
    438 	    splx(s2);
    439 	}
    440 
    441 	splx(s);
    442 
    443 	error = ttyopen(tp, SERDIALOUT(dev), ISSET(flag, O_NONBLOCK));
    444 	if (error)
    445 		goto bad;
    446 
    447 	error = (*linesw[tp->t_line].l_open)(dev, tp);
    448         if (error)
    449 		goto bad;
    450 
    451 	return (0);
    452 
    453 bad:
    454 	if (!ISSET(tp->t_state, TS_ISOPEN) && tp->t_wopen == 0) {
    455 		/*
    456 		 * We failed to open the device, and nobody else had it opened.
    457 		 * Clean up the state as appropriate.
    458 		 */
    459 		ser_shutdown(sc);
    460 	}
    461 
    462 	return (error);
    463 }
    464 
    465 int
    466 serclose(dev, flag, mode, p)
    467 	dev_t		dev;
    468 	int		flag, mode;
    469 	struct proc	*p;
    470 {
    471 	int unit = SERUNIT(dev);
    472 	struct ser_softc *sc = ser_cd.cd_devs[unit];
    473 	struct tty *tp = sc->sc_tty;
    474 
    475 	/* XXX This is for cons.c. */
    476 	if (!ISSET(tp->t_state, TS_ISOPEN))
    477 		return (0);
    478 
    479 	(*linesw[tp->t_line].l_close)(tp, flag);
    480 	ttyclose(tp);
    481 
    482 	if (!ISSET(tp->t_state, TS_ISOPEN) && tp->t_wopen == 0) {
    483 		/*
    484 		 * Although we got a last close, the device may still be in
    485 		 * use; e.g. if this was the dialout node, and there are still
    486 		 * processes waiting for carrier on the non-dialout node.
    487 		 */
    488 		ser_shutdown(sc);
    489 	}
    490 
    491 	return (0);
    492 }
    493 
    494 int
    495 serread(dev, uio, flag)
    496 	dev_t dev;
    497 	struct uio *uio;
    498 	int flag;
    499 {
    500 	struct ser_softc *sc = ser_cd.cd_devs[SERUNIT(dev)];
    501 	struct tty *tp = sc->sc_tty;
    502 
    503 	return ((*linesw[tp->t_line].l_read)(tp, uio, flag));
    504 }
    505 
    506 int
    507 serwrite(dev, uio, flag)
    508 	dev_t dev;
    509 	struct uio *uio;
    510 	int flag;
    511 {
    512 	struct ser_softc *sc = ser_cd.cd_devs[SERUNIT(dev)];
    513 	struct tty *tp = sc->sc_tty;
    514 
    515 	return ((*linesw[tp->t_line].l_write)(tp, uio, flag));
    516 }
    517 
    518 struct tty *
    519 sertty(dev)
    520 	dev_t dev;
    521 {
    522 	struct ser_softc *sc = ser_cd.cd_devs[SERUNIT(dev)];
    523 	struct tty *tp = sc->sc_tty;
    524 
    525 	return (tp);
    526 }
    527 
    528 int
    529 serioctl(dev, cmd, data, flag, p)
    530 	dev_t dev;
    531 	u_long cmd;
    532 	caddr_t data;
    533 	int flag;
    534 	struct proc *p;
    535 {
    536 	int unit = SERUNIT(dev);
    537 	struct ser_softc *sc = ser_cd.cd_devs[unit];
    538 	struct tty *tp = sc->sc_tty;
    539 	int error;
    540 
    541 	error = (*linesw[tp->t_line].l_ioctl)(tp, cmd, data, flag, p);
    542 	if (error >= 0)
    543 		return (error);
    544 
    545 	error = ttioctl(tp, cmd, data, flag, p);
    546 	if (error >= 0)
    547 		return (error);
    548 
    549 	switch (cmd) {
    550 	case TIOCSBRK:
    551 		ser_break(sc, 1);
    552 		break;
    553 
    554 	case TIOCCBRK:
    555 		ser_break(sc, 0);
    556 		break;
    557 
    558 	case TIOCSDTR:
    559 		ser_modem(sc, 1);
    560 		break;
    561 
    562 	case TIOCCDTR:
    563 		ser_modem(sc, 0);
    564 		break;
    565 
    566 	case TIOCGFLAGS:
    567 		*(int *)data = sc->sc_swflags;
    568 		break;
    569 
    570 	case TIOCSFLAGS:
    571 		error = suser(p->p_ucred, &p->p_acflag);
    572 		if (error)
    573 			return (error);
    574 		sc->sc_swflags = *(int *)data;
    575 		break;
    576 
    577 	case TIOCMSET:
    578 	case TIOCMBIS:
    579 	case TIOCMBIC:
    580 	case TIOCMGET:
    581 	default:
    582 		return (ENOTTY);
    583 	}
    584 
    585 #ifdef SER_DEBUG
    586 		serstatus(sc, "serioctl ");
    587 #endif
    588 
    589 	return (0);
    590 }
    591 
    592 void
    593 ser_break(sc, onoff)
    594 	struct ser_softc *sc;
    595 	int onoff;
    596 {
    597 	int s;
    598 
    599 	s = splserial();
    600 	if (onoff)
    601 		SET(sc->sc_tsr, TSR_SBREAK);
    602 	else
    603 		CLR(sc->sc_tsr, TSR_SBREAK);
    604 
    605 	if (!sc->sc_heldchange) {
    606 		if (sc->sc_tx_busy) {
    607 			sc->sc_heldtbc = sc->sc_tbc;
    608 			sc->sc_tbc = 0;
    609 			sc->sc_heldchange = 1;
    610 		} else
    611 			ser_loadchannelregs(sc);
    612 	}
    613 	splx(s);
    614 }
    615 
    616 void
    617 ser_modem(sc, onoff)
    618 	struct ser_softc *sc;
    619 	int onoff;
    620 {
    621 	int s;
    622 
    623 	s = splserial();
    624 	if (onoff)
    625 		SET(sc->sc_mcr, sc->sc_mcr_dtr);
    626 	else
    627 		CLR(sc->sc_mcr, sc->sc_mcr_dtr);
    628 
    629 	if (!sc->sc_heldchange) {
    630 		if (sc->sc_tx_busy) {
    631 			sc->sc_heldtbc = sc->sc_tbc;
    632 			sc->sc_tbc = 0;
    633 			sc->sc_heldchange = 1;
    634 		} else
    635 			ser_loadchannelregs(sc);
    636 	}
    637 	splx(s);
    638 }
    639 
    640 int
    641 serparam(tp, t)
    642 	struct tty *tp;
    643 	struct termios *t;
    644 {
    645 	struct ser_softc *sc = ser_cd.cd_devs[SERUNIT(tp->t_dev)];
    646 	int ospeed = serspeed(t->c_ospeed);
    647 	u_char ucr;
    648 	int s;
    649 
    650 	/* check requested parameters */
    651 	if (ospeed < 0)
    652 		return (EINVAL);
    653 	if (t->c_ispeed && t->c_ispeed != t->c_ospeed)
    654 		return (EINVAL);
    655 
    656 	sc->sc_rsr = RSR_ENAB;
    657 	sc->sc_tsr = TSR_ENAB;
    658 
    659 	ucr = UCR_CLKDIV;
    660 
    661 	switch (ISSET(t->c_cflag, CSIZE)) {
    662 	case CS5:
    663 		SET(ucr, UCR_5BITS);
    664 		break;
    665 	case CS6:
    666 		SET(ucr, UCR_6BITS);
    667 		break;
    668 	case CS7:
    669 		SET(ucr, UCR_7BITS);
    670 		break;
    671 	case CS8:
    672 		SET(ucr, UCR_8BITS);
    673 		break;
    674 	}
    675 	if (ISSET(t->c_cflag, PARENB)) {
    676 		SET(ucr, UCR_PENAB);
    677 		if (!ISSET(t->c_cflag, PARODD))
    678 			SET(ucr, UCR_PEVEN);
    679 	}
    680 	if (ISSET(t->c_cflag, CSTOPB))
    681 		SET(ucr, UCR_STOPB2);
    682 	else
    683 		SET(ucr, UCR_STOPB1);
    684 
    685 	s = splserial();
    686 
    687 	sc->sc_ucr = ucr;
    688 
    689 	/*
    690 	 * For the console, always force CLOCAL and !HUPCL, so that the port
    691 	 * is always active.
    692 	 */
    693 	if (ISSET(sc->sc_swflags, TIOCFLAG_SOFTCAR) ||
    694 	    ISSET(sc->sc_hwflags, SER_HW_CONSOLE)) {
    695 		SET(t->c_cflag, CLOCAL);
    696 		CLR(t->c_cflag, HUPCL);
    697 	}
    698 
    699 	/*
    700 	 * If we're not in a mode that assumes a connection is present, then
    701 	 * ignore carrier changes.
    702 	 */
    703 	if (ISSET(t->c_cflag, CLOCAL | MDMBUF))
    704 		sc->sc_msr_dcd = 0;
    705 	else
    706 		sc->sc_msr_dcd = MCR_DCD;
    707 	/*
    708 	 * Set the flow control pins depending on the current flow control
    709 	 * mode.
    710 	 */
    711 	if (ISSET(t->c_cflag, CRTSCTS)) {
    712 		sc->sc_mcr_dtr = MCR_DTR;
    713 		sc->sc_mcr_rts = MCR_RTS;
    714 		sc->sc_msr_cts = MCR_CTS;
    715 		sc->sc_r_hiwat = RXHIWAT;
    716 	} else if (ISSET(t->c_cflag, MDMBUF)) {
    717 		/*
    718 		 * For DTR/DCD flow control, make sure we don't toggle DTR for
    719 		 * carrier detection.
    720 		 */
    721 		sc->sc_mcr_dtr = 0;
    722 		sc->sc_mcr_rts = MCR_DTR;
    723 		sc->sc_msr_cts = MCR_DCD;
    724 		sc->sc_r_hiwat = RXHIWAT;
    725 	} else {
    726 		/*
    727 		 * If no flow control, then always set RTS.  This will make
    728 		 * the other side happy if it mistakenly thinks we're doing
    729 		 * RTS/CTS flow control.
    730 		 */
    731 		sc->sc_mcr_dtr = MCR_DTR | MCR_RTS;
    732 		sc->sc_mcr_rts = 0;
    733 		sc->sc_msr_cts = 0;
    734 		sc->sc_r_hiwat = 0;
    735 		if (ISSET(sc->sc_mcr, MCR_DTR))
    736 			SET(sc->sc_mcr, MCR_RTS);
    737 		else
    738 			CLR(sc->sc_mcr, MCR_RTS);
    739 	}
    740 	sc->sc_msr_mask = sc->sc_msr_cts | sc->sc_msr_dcd;
    741 
    742 #if 0
    743 	if (ospeed == 0)
    744 		CLR(sc->sc_mcr, sc->sc_mcr_dtr);
    745 	else
    746 		SET(sc->sc_mcr, sc->sc_mcr_dtr);
    747 #endif
    748 
    749 	sc->sc_ospeed = ospeed;
    750 
    751 	/* and copy to tty */
    752 	tp->t_ispeed = 0;
    753 	tp->t_ospeed = t->c_ospeed;
    754 	tp->t_cflag = t->c_cflag;
    755 
    756 	if (!sc->sc_heldchange) {
    757 		if (sc->sc_tx_busy) {
    758 			sc->sc_heldtbc = sc->sc_tbc;
    759 			sc->sc_tbc = 0;
    760 			sc->sc_heldchange = 1;
    761 		} else
    762 			ser_loadchannelregs(sc);
    763 	}
    764 
    765 	splx(s);
    766 
    767 	/*
    768 	 * Update the tty layer's idea of the carrier bit, in case we changed
    769 	 * CLOCAL or MDMBUF.  We don't hang up here; we only do that if we
    770 	 * lose carrier while carrier detection is on.
    771 	 */
    772 	(void) (*linesw[tp->t_line].l_modem)(tp, ISSET(sc->sc_msr, MCR_DCD));
    773 
    774 #ifdef SER_DEBUG
    775 	serstatus(sc, "serparam ");
    776 #endif
    777 
    778 	/* XXXXX FIX ME */
    779 	/* Block or unblock as needed. */
    780 	if (!ISSET(t->c_cflag, CHWFLOW)) {
    781 		if (sc->sc_rx_blocked) {
    782 			sc->sc_rx_blocked = 0;
    783 			ser_hwiflow(sc, 0);
    784 		}
    785 		if (sc->sc_tx_stopped) {
    786 			sc->sc_tx_stopped = 0;
    787 			serstart(tp);
    788 		}
    789 	} else {
    790 #if 0
    791 		sermsrint(sc, tp);
    792 #endif
    793 	}
    794 
    795 	return (0);
    796 }
    797 
    798 void
    799 ser_iflush(sc)
    800 	struct ser_softc *sc;
    801 {
    802 	u_char	tmp;
    803 
    804 	/* flush any pending I/O */
    805 	while (ISSET(MFP->mf_rsr, RSR_CIP|RSR_BFULL))
    806 		tmp = MFP->mf_udr;
    807 }
    808 
    809 void
    810 ser_loadchannelregs(sc)
    811 	struct ser_softc *sc;
    812 {
    813 	/* XXXXX necessary? */
    814 	ser_iflush(sc);
    815 
    816 	/*
    817 	 * No interrupts please...
    818 	 */
    819 if((MFP->mf_imra & (IA_RRDY|IA_RERR|IA_TRDY|IA_TERR)) != sc->sc_imra) {
    820 printf("loadchannelregs: mf_imra: %x sc_imra: %x\n", (u_int)MFP->mf_imra,
    821 						     (u_int)sc->sc_imra);
    822 }
    823 if((MFP->mf_imrb & (IB_SCTS|IB_SDCD)) != sc->sc_imrb) {
    824 printf("loadchannelregs: mf_imrb: %x sc_imrb: %x\n", (u_int)MFP->mf_imrb,
    825 						     (u_int)sc->sc_imrb);
    826 }
    827 	single_inst_bclr_b(MFP->mf_imra, IA_RRDY|IA_RERR|IA_TRDY|IA_TERR);
    828 	single_inst_bclr_b(MFP->mf_imrb, IB_SCTS|IB_SDCD);
    829 
    830 	MFP->mf_ucr = sc->sc_ucr;
    831 	MFP->mf_rsr = sc->sc_rsr;
    832 	MFP->mf_tsr = sc->sc_tsr;
    833 
    834 	single_inst_bclr_b(MFP->mf_tcdcr, 0x07);
    835 	MFP->mf_tddr  = sc->sc_ospeed;
    836 	single_inst_bset_b(MFP->mf_tcdcr, (sc->sc_ospeed >> 8) & 0x0f);
    837 
    838 	sc->sc_mcr_active = sc->sc_mcr;
    839 
    840 	if (machineid & ATARI_HADES) {
    841 		/* PCB fault, wires exchanged..... */
    842 		ym2149_rts(!(sc->sc_mcr_active & MCR_DTR));
    843 		ym2149_dtr(!(sc->sc_mcr_active & MCR_RTS));
    844 	}
    845 	else {
    846 		ym2149_rts(!(sc->sc_mcr_active & MCR_RTS));
    847 		ym2149_dtr(!(sc->sc_mcr_active & MCR_DTR));
    848 	}
    849 
    850 	single_inst_bset_b(MFP->mf_imra, sc->sc_imra);
    851 	single_inst_bset_b(MFP->mf_imrb, sc->sc_imrb);
    852 }
    853 
    854 int
    855 serhwiflow(tp, block)
    856 	struct tty *tp;
    857 	int block;
    858 {
    859 	struct ser_softc *sc = ser_cd.cd_devs[SERUNIT(tp->t_dev)];
    860 	int s;
    861 
    862 	if (sc->sc_mcr_rts == 0)
    863 		return (0);
    864 
    865 	s = splserial();
    866 	if (block) {
    867 		/*
    868 		 * The tty layer is asking us to block input.
    869 		 * If we already did it, just return TRUE.
    870 		 */
    871 		if (sc->sc_rx_blocked)
    872 			goto out;
    873 		sc->sc_rx_blocked = 1;
    874 	} else {
    875 		/*
    876 		 * The tty layer is asking us to resume input.
    877 		 * The input ring is always empty by now.
    878 		 */
    879 		sc->sc_rx_blocked = 0;
    880 	}
    881 	ser_hwiflow(sc, block);
    882 out:
    883 	splx(s);
    884 	return (1);
    885 }
    886 
    887 /*
    888  * (un)block input via hw flowcontrol
    889  */
    890 void
    891 ser_hwiflow(sc, block)
    892 	struct ser_softc *sc;
    893 	int block;
    894 {
    895 	if (sc->sc_mcr_rts == 0)
    896 		return;
    897 
    898 	if (block) {
    899 		CLR(sc->sc_mcr, sc->sc_mcr_rts);
    900 		CLR(sc->sc_mcr_active, sc->sc_mcr_rts);
    901 	} else {
    902 		SET(sc->sc_mcr, sc->sc_mcr_rts);
    903 		SET(sc->sc_mcr_active, sc->sc_mcr_rts);
    904 	}
    905 	if (machineid & ATARI_HADES) {
    906 		/* PCB fault, wires exchanged..... */
    907 		ym2149_dtr(sc->sc_mcr_active & MCR_RTS);
    908 	}
    909 	else {
    910 		ym2149_rts(sc->sc_mcr_active & MCR_RTS);
    911 	}
    912 }
    913 
    914 void
    915 serstart(tp)
    916 	struct tty *tp;
    917 {
    918 	struct ser_softc *sc = ser_cd.cd_devs[SERUNIT(tp->t_dev)];
    919 	int s;
    920 
    921 	s = spltty();
    922 	if (ISSET(tp->t_state, TS_BUSY))
    923 		goto out;
    924 	if (ISSET(tp->t_state, TS_TIMEOUT | TS_TTSTOP))
    925 		goto stopped;
    926 
    927 	if (sc->sc_tx_stopped)
    928 		goto stopped;
    929 
    930 	if (tp->t_outq.c_cc <= tp->t_lowat) {
    931 		if (ISSET(tp->t_state, TS_ASLEEP)) {
    932 			CLR(tp->t_state, TS_ASLEEP);
    933 			wakeup(&tp->t_outq);
    934 		}
    935 		selwakeup(&tp->t_wsel);
    936 		if (tp->t_outq.c_cc == 0)
    937 			goto stopped;
    938 	}
    939 
    940 	/* Grab the first contiguous region of buffer space. */
    941 	{
    942 		u_char *tba;
    943 		int tbc;
    944 
    945 		tba = tp->t_outq.c_cf;
    946 		tbc = ndqb(&tp->t_outq, 0);
    947 
    948 		(void)splserial();
    949 
    950 		sc->sc_tba = tba;
    951 		sc->sc_tbc = tbc;
    952 	}
    953 
    954 	SET(tp->t_state, TS_BUSY);
    955 	sc->sc_tx_busy = 1;
    956 
    957 	/* Enable transmit completion interrupts if necessary. */
    958 	if (!ISSET(sc->sc_imra, IA_TRDY)) {
    959 		SET(sc->sc_imra, IA_TRDY|IA_TERR);
    960 		single_inst_bset_b(MFP->mf_imra, IA_TRDY|IA_TERR);
    961 	}
    962 
    963 	/* Output the first char */
    964 	MFP->mf_udr = *sc->sc_tba;
    965 	sc->sc_tbc --;
    966 	sc->sc_tba ++;
    967 
    968 	splx(s);
    969 	return;
    970 
    971 stopped:
    972 	/* Disable transmit completion interrupts if necessary. */
    973 	if (ISSET(sc->sc_imra, IA_TRDY)) {
    974 		CLR(sc->sc_imra, IA_TRDY|IA_TERR);
    975 		single_inst_bclr_b(MFP->mf_imra, IA_TRDY|IA_TERR);
    976 	}
    977 out:
    978 	splx(s);
    979 	return;
    980 }
    981 
    982 /*
    983  * Stop output on a line.
    984  */
    985 void
    986 serstop(tp, flag)
    987 	struct tty *tp;
    988 	int flag;
    989 {
    990 	struct ser_softc *sc = ser_cd.cd_devs[SERUNIT(tp->t_dev)];
    991 	int s;
    992 
    993 	s = splserial();
    994 	if (ISSET(tp->t_state, TS_BUSY)) {
    995 		/* Stop transmitting at the next chunk. */
    996 		sc->sc_tbc = 0;
    997 		sc->sc_heldtbc = 0;
    998 		if (!ISSET(tp->t_state, TS_TTSTOP))
    999 			SET(tp->t_state, TS_FLUSH);
   1000 	}
   1001 	splx(s);
   1002 }
   1003 
   1004 void
   1005 serdiag(arg)
   1006 	void *arg;
   1007 {
   1008 	struct ser_softc *sc = arg;
   1009 	int overflows, floods;
   1010 	int s;
   1011 
   1012 	s = splserial();
   1013 	overflows = sc->sc_overflows;
   1014 	sc->sc_overflows = 0;
   1015 	floods = sc->sc_floods;
   1016 	sc->sc_floods = 0;
   1017 	sc->sc_errors = 0;
   1018 	splx(s);
   1019 
   1020 	log(LOG_WARNING,
   1021 	    "%s: %d silo overflow%s, %d ibuf flood%s\n",
   1022 	    sc->sc_dev.dv_xname,
   1023 	    overflows, overflows == 1 ? "" : "s",
   1024 	    floods, floods == 1 ? "" : "s");
   1025 }
   1026 
   1027 static
   1028 void ser_shutdown(sc)
   1029 	struct ser_softc *sc;
   1030 {
   1031 	int	s;
   1032 	struct tty *tp = sc->sc_tty;
   1033 
   1034 
   1035 	s = splserial();
   1036 
   1037 	/* If we were asserting flow control, then deassert it. */
   1038 	sc->sc_rx_blocked = 1;
   1039 	ser_hwiflow(sc, 1);
   1040 
   1041 	/* Clear any break condition set with TIOCSBRK. */
   1042 	ser_break(sc, 0);
   1043 
   1044 	/*
   1045 	 * Hang up if necessary.  Wait a bit, so the other side has time to
   1046 	 * notice even if we immediately open the port again.
   1047 	 */
   1048 	if (ISSET(tp->t_cflag, HUPCL)) {
   1049 		ser_modem(sc, 0);
   1050 		(void) tsleep(sc, TTIPRI, ttclos, hz);
   1051 	}
   1052 
   1053 	/* Turn off interrupts. */
   1054 	CLR(sc->sc_imra, IA_RRDY|IA_RERR|IA_TRDY|IA_TERR);
   1055 	CLR(sc->sc_imrb, IB_SCTS|IB_SDCD);
   1056 	single_inst_bclr_b(MFP->mf_imrb, IB_SCTS|IB_SDCD);
   1057 	single_inst_bclr_b(MFP->mf_imra, IA_RRDY|IA_RERR|IA_TRDY|IA_TERR);
   1058 	splx(s);
   1059 }
   1060 
   1061 static void
   1062 serrxint(sc, tp)
   1063 	struct ser_softc	*sc;
   1064 	struct tty		*tp;
   1065 {
   1066 	u_int	get, cc, scc;
   1067 	int	code;
   1068 	u_char	rsr;
   1069 	int	s;
   1070 	static int lsrmap[8] = {
   1071 		0,      TTY_PE,
   1072 		TTY_FE, TTY_PE|TTY_FE,
   1073 		TTY_FE, TTY_PE|TTY_FE,
   1074 		TTY_FE, TTY_PE|TTY_FE
   1075 	};
   1076 
   1077 	get = sc->sc_rbget;
   1078 	scc = cc = RXBUFSIZE - sc->sc_rbavail;
   1079 
   1080 	if (cc == RXBUFSIZE) {
   1081 		sc->sc_floods++;
   1082 		if (sc->sc_errors++ == 0)
   1083 			timeout(serdiag, sc, 60 * hz);
   1084 	}
   1085 
   1086 	while (cc--) {
   1087 		rsr = sc->sc_lbuf[get];
   1088 		if (ISSET(rsr, RSR_BREAK)) {
   1089 #ifdef DDB
   1090 			if (ISSET(sc->sc_hwflags, SER_HW_CONSOLE))
   1091 				Debugger();
   1092 #endif
   1093 		}
   1094 		else if (ISSET(rsr, RSR_OERR)) {
   1095 			sc->sc_overflows++;
   1096 			if (sc->sc_errors++ == 0)
   1097 				timeout(serdiag, sc, 60 * hz);
   1098 		}
   1099 		code = sc->sc_rbuf[get] |
   1100 		    lsrmap[(rsr & (RSR_BREAK|RSR_FERR|RSR_PERR)) >> 3];
   1101 		(*linesw[tp->t_line].l_rint)(code, tp);
   1102 		get = (get + 1) & RXBUFMASK;
   1103 	}
   1104 
   1105 	sc->sc_rbget = get;
   1106 	s = splserial();
   1107 	sc->sc_rbavail += scc;
   1108 	/*
   1109 	 * Buffers should be ok again, release possible block, but only if the
   1110 	 * tty layer isn't blocking too.
   1111 	 */
   1112 	if (sc->sc_rx_blocked && !ISSET(tp->t_state, TS_TBLOCK)) {
   1113 		sc->sc_rx_blocked = 0;
   1114 		ser_hwiflow(sc, 0);
   1115 	}
   1116 	splx(s);
   1117 }
   1118 
   1119 static void
   1120 sertxint(sc, tp)
   1121 	struct ser_softc	*sc;
   1122 	struct tty		*tp;
   1123 {
   1124 
   1125 	CLR(tp->t_state, TS_BUSY);
   1126 	if (ISSET(tp->t_state, TS_FLUSH))
   1127 		CLR(tp->t_state, TS_FLUSH);
   1128 	else
   1129 		ndflush(&tp->t_outq, (int)(sc->sc_tba - tp->t_outq.c_cf));
   1130 	(*linesw[tp->t_line].l_start)(tp);
   1131 }
   1132 
   1133 static void
   1134 sermsrint(sc, tp)
   1135 	struct ser_softc	*sc;
   1136 	struct tty		*tp;
   1137 {
   1138 	u_char msr, delta;
   1139 	int s;
   1140 
   1141 	s = splserial();
   1142 	msr = sc->sc_msr;
   1143 	delta = sc->sc_msr_delta;
   1144 	sc->sc_msr_delta = 0;
   1145 	splx(s);
   1146 
   1147 	if (ISSET(delta, sc->sc_msr_dcd)) {
   1148 		/*
   1149 		 * Inform the tty layer that carrier detect changed.
   1150 		 */
   1151 		(void) (*linesw[tp->t_line].l_modem)(tp, ISSET(msr, MCR_DCD));
   1152 	}
   1153 
   1154 	if (ISSET(delta, sc->sc_msr_cts)) {
   1155 		/* Block or unblock output according to flow control. */
   1156 		if (ISSET(msr, sc->sc_msr_cts)) {
   1157 			sc->sc_tx_stopped = 0;
   1158 			(*linesw[tp->t_line].l_start)(tp);
   1159 		} else {
   1160 			sc->sc_tx_stopped = 1;
   1161 			serstop(tp, 0);
   1162 		}
   1163 	}
   1164 
   1165 #ifdef SER_DEBUG
   1166 	serstatus(sc, "sermsrint");
   1167 #endif
   1168 }
   1169 
   1170 void
   1171 sersoft(arg)
   1172 	void *arg;
   1173 {
   1174 	struct ser_softc *sc = arg;
   1175 	struct tty	*tp;
   1176 
   1177 	ser_softintr_scheduled = 0;
   1178 
   1179 	tp = sc->sc_tty;
   1180 	if (tp == NULL)
   1181 		return;
   1182 
   1183 	if (!ISSET(tp->t_state, TS_ISOPEN) && (tp->t_wopen == 0))
   1184 		return;
   1185 
   1186 	if (sc->sc_rx_ready) {
   1187 		sc->sc_rx_ready = 0;
   1188 		serrxint(sc, tp);
   1189 	}
   1190 
   1191 	if (sc->sc_st_check) {
   1192 		sc->sc_st_check = 0;
   1193 		sermsrint(sc, tp);
   1194 	}
   1195 
   1196 	if (sc->sc_tx_done) {
   1197 		sc->sc_tx_done = 0;
   1198 		sertxint(sc, tp);
   1199 	}
   1200 }
   1201 
   1202 int
   1203 sermintr(arg)
   1204 void	*arg;
   1205 {
   1206 	struct ser_softc *sc = arg;
   1207 	u_char	msr, delta;
   1208 
   1209 	msr = ~MFP->mf_gpip;
   1210 	delta = msr ^ sc->sc_msr;
   1211 	sc->sc_msr  = sc->sc_msr & ~(MCR_CTS|MCR_DCD|MCR_RI);
   1212 	sc->sc_msr |= msr & (MCR_CTS|MCR_DCD|MCR_RI);
   1213 
   1214 	if (ISSET(delta, sc->sc_msr_mask)) {
   1215 		sc->sc_msr_delta |= delta;
   1216 
   1217 		/*
   1218 		 * Stop output immediately if we lose the output
   1219 		 * flow control signal or carrier detect.
   1220 		 */
   1221 		if (ISSET(~msr, sc->sc_msr_mask)) {
   1222 			sc->sc_tbc = 0;
   1223 			sc->sc_heldtbc = 0;
   1224 #ifdef SER_DEBUG
   1225 			serstatus(sc, "sermintr  ");
   1226 #endif
   1227 		}
   1228 
   1229 		sc->sc_st_check = 1;
   1230 	}
   1231 	if (!ser_softintr_scheduled)
   1232 		add_sicallback((si_farg)sersoft, sc, 0);
   1233 	return 1;
   1234 }
   1235 
   1236 int
   1237 sertrintr(arg)
   1238 	void	*arg;
   1239 {
   1240 	struct ser_softc *sc = arg;
   1241 	u_int	put, cc;
   1242 	u_char	rsr, tsr;
   1243 
   1244 	put = sc->sc_rbput;
   1245 	cc = sc->sc_rbavail;
   1246 
   1247 	rsr = MFP->mf_rsr;
   1248 	if (ISSET(rsr, RSR_BFULL|RSR_BREAK)) {
   1249 		for (; ISSET(rsr, RSR_BFULL|RSR_BREAK) && cc > 0; cc--) {
   1250 			sc->sc_rbuf[put] = MFP->mf_udr;
   1251 			sc->sc_lbuf[put] = rsr;
   1252 			put = (put + 1) & RXBUFMASK;
   1253 			if ((rsr & RSR_BREAK) && (MFP->mf_rsr & RSR_BREAK))
   1254 				rsr = 0;
   1255 			else rsr = MFP->mf_rsr;
   1256 		}
   1257 		/*
   1258 		 * Current string of incoming characters ended because
   1259 		 * no more data was available. Schedule a receive event
   1260 		 * if any data was received. Drop any characters that
   1261 		 * we couldn't handle.
   1262 		 */
   1263 		sc->sc_rbput    = put;
   1264 		sc->sc_rbavail  = cc;
   1265 		sc->sc_rx_ready = 1;
   1266 		/*
   1267 		 * See if we are in danger of overflowing a buffer. If
   1268 		 * so, use hardware flow control to ease the pressure.
   1269 		 */
   1270 		if (sc->sc_rx_blocked == 0 &&
   1271 		    cc < sc->sc_r_hiwat) {
   1272 			sc->sc_rx_blocked = 1;
   1273 			ser_hwiflow(sc, 1);
   1274 		}
   1275 		/*
   1276 		 * If we're out of space, throw away any further input.
   1277 		 */
   1278 		if (!cc) {
   1279 			while (ISSET(rsr, RSR_BFULL|RSR_BREAK)) {
   1280 				rsr = MFP->mf_udr;
   1281 				rsr = MFP->mf_rsr;
   1282 			}
   1283 		}
   1284 	}
   1285 
   1286 	/*
   1287 	 * Done handling any receive interrupts. See if data can be
   1288 	 * transmitted as well. Schedule tx done event if no data left
   1289 	 * and tty was marked busy.
   1290 	 */
   1291 	tsr = MFP->mf_tsr;
   1292 	if (ISSET(tsr, TSR_BE)) {
   1293 		/*
   1294 		 * If we've delayed a parameter change, do it now, and restart
   1295 		 * output.
   1296 		 */
   1297 		if (sc->sc_heldchange) {
   1298 			ser_loadchannelregs(sc);
   1299 			sc->sc_heldchange = 0;
   1300 			sc->sc_tbc = sc->sc_heldtbc;
   1301 			sc->sc_heldtbc = 0;
   1302 		}
   1303 		/* Output the next character, if any. */
   1304 		if (sc->sc_tbc > 0) {
   1305 			MFP->mf_udr = *sc->sc_tba;
   1306 			sc->sc_tbc --;
   1307 			sc->sc_tba ++;
   1308 		} else if (sc->sc_tx_busy) {
   1309 			sc->sc_tx_busy = 0;
   1310 			sc->sc_tx_done = 1;
   1311 		}
   1312 	}
   1313 
   1314 	if (!ser_softintr_scheduled)
   1315 		add_sicallback((si_farg)sersoft, sc, 0);
   1316 	return 1;
   1317 }
   1318 
   1319 static int
   1320 serspeed(speed)
   1321 	long speed;
   1322 {
   1323 #define	divrnd(n, q)	(((n)*2/(q)+1)/2)	/* divide and round off */
   1324 
   1325 	int div, x, err;
   1326 
   1327 	if (speed <= 0)
   1328 		return (-1);
   1329 
   1330 	for (div = 4; div <= 64; div *= 4) {
   1331 		x = divrnd((SER_FREQ / div), speed);
   1332 
   1333 		/*
   1334 		 * The value must fit in the timer-d dataregister. If
   1335 		 * not, try another delay-mode.
   1336 		 */
   1337 		if ((x/2) > 255)
   1338 			continue;
   1339 
   1340 		/*
   1341 		 * Baudrate to high for the interface or cannot be made
   1342 		 * within tolerance.
   1343 		 */
   1344 		if (x <= 0)
   1345 			return (-1);
   1346 
   1347 		err = divrnd((SER_FREQ / div) * 1000, speed * x) - 1000;
   1348 		if (err < 0)
   1349 			err = -err;
   1350 		if (err > SER_TOLERANCE)
   1351 			continue;
   1352 
   1353 		/*
   1354 		 * Translate 'div' to delay-code
   1355 		 */
   1356 		if (div == 4)
   1357 			div = 1;
   1358 		else if (div == 16)
   1359 			div = 3;
   1360 		else if (div == 64)
   1361 			div = 5;
   1362 
   1363 		return ((x/2) | (div << 8));
   1364 	}
   1365 	return (-1);
   1366 
   1367 #undef	divrnd(n, q)
   1368 }
   1369 
   1370 /*
   1371  * Following are all routines needed for SER to act as console
   1372  */
   1373 #include <dev/cons.h>
   1374 
   1375 void
   1376 sercnprobe(cp)
   1377 	struct consdev *cp;
   1378 {
   1379 	/*
   1380 	 * Activate serial console when DCD present...
   1381 	 */
   1382 	if (MFP->mf_gpip & MCR_DCD) {
   1383 		cp->cn_pri = CN_DEAD;
   1384 		return;
   1385 	}
   1386 	for (sermajor = 0; sermajor < nchrdev; sermajor++)
   1387 		if (cdevsw[sermajor].d_open == seropen)
   1388 			break;
   1389 
   1390 	/* initialize required fields */
   1391 	cp->cn_dev = makedev(sermajor, 0); /* XXX: LWP What unit? */
   1392 #ifdef SERCONSOLE
   1393 	cp->cn_pri = CN_REMOTE;	/* Force a serial port console */
   1394 #else
   1395 	cp->cn_pri = CN_NORMAL;
   1396 #endif
   1397 }
   1398 
   1399 void
   1400 sercninit(cp)
   1401 	struct consdev *cp;
   1402 {
   1403 	serinitcons(CONSBAUD);
   1404 }
   1405 
   1406 /*
   1407  * Initialize UART to known state.
   1408  */
   1409 void
   1410 serinit(baud)
   1411 int	baud;
   1412 {
   1413 	int ospeed = serspeed(baud);
   1414 
   1415 	MFP->mf_ucr = UCR_CLKDIV|UCR_8BITS|UCR_STOPB1;
   1416 	MFP->mf_rsr = RSR_ENAB;
   1417 	MFP->mf_tsr = TSR_ENAB;
   1418 
   1419 	single_inst_bclr_b(MFP->mf_tcdcr, 0x07);
   1420 	MFP->mf_tddr  = ospeed;
   1421 	single_inst_bset_b(MFP->mf_tcdcr, (ospeed >> 8) & 0x0f);
   1422 }
   1423 
   1424 /*
   1425  * Set UART for console use. Do normal init, then enable interrupts.
   1426  */
   1427 void
   1428 serinitcons(baud)
   1429 int	baud;
   1430 {
   1431 	serinit(baud);
   1432 
   1433 	/* Set rts/dtr */
   1434 	ym2149_rts(0);
   1435 	ym2149_dtr(0);
   1436 
   1437 	single_inst_bset_b(MFP->mf_imra, (IA_RRDY|IA_RERR|IA_TRDY|IA_TERR));
   1438 }
   1439 
   1440 int
   1441 sercngetc(dev)
   1442 	dev_t dev;
   1443 {
   1444 	u_char	stat, c;
   1445 	int	s;
   1446 
   1447 	s = splserial();
   1448 	while (!ISSET(stat = MFP->mf_rsr, RSR_BFULL)) {
   1449 		if (!ISSET(stat, RSR_ENAB)) /* XXX */
   1450 			MFP->mf_rsr |= RSR_ENAB;
   1451 		if (stat & (RSR_FERR|RSR_PERR|RSR_OERR))
   1452 			c = MFP->mf_udr;
   1453 	}
   1454 	c = MFP->mf_udr;
   1455 	splx(s);
   1456 	return c;
   1457 }
   1458 
   1459 u_int s_imra;
   1460 u_int s_stat1, s_stat2, s_stat3;
   1461 void
   1462 sercnputc(dev, c)
   1463 	dev_t dev;
   1464 	int c;
   1465 {
   1466 	int	timo;
   1467 	u_char	stat, imra;
   1468 
   1469 	/* Mask serial interrupts */
   1470 	imra  = MFP->mf_imra & (IA_RRDY|IA_RERR|IA_TRDY|IA_TERR);
   1471 	single_inst_bclr_b(MFP->mf_imra, imra);
   1472 s_imra = imra;
   1473 
   1474 	/* wait for any pending transmission to finish */
   1475 	timo = 50000;
   1476 s_stat1 = MFP->mf_tsr;
   1477 	while (!ISSET(stat = MFP->mf_tsr, TSR_BE) && --timo)
   1478 		;
   1479 	MFP->mf_udr = c;
   1480 	/* wait for this transmission to complete */
   1481 	timo = 1500000;
   1482 s_stat2 = MFP->mf_tsr;
   1483 	while (!ISSET(stat = MFP->mf_tsr, TSR_BE) && --timo)
   1484 		;
   1485 
   1486 s_stat3 = MFP->mf_tsr;
   1487 	/* Clear pending serial interrupts and re-enable */
   1488 	single_inst_bclr_b(MFP->mf_ipra, imra);
   1489 	single_inst_bset_b(MFP->mf_imra, imra);
   1490 }
   1491 
   1492 void
   1493 sercnpollc(dev, on)
   1494 	dev_t dev;
   1495 	int on;
   1496 {
   1497 
   1498 }
   1499