Home | History | Annotate | Line # | Download | only in dev
zs.c revision 1.1
      1  1.1  leo /*	$NetBSD: zs.c,v 1.1 1995/03/26 07:12:14 leo Exp $	*/
      2  1.1  leo 
      3  1.1  leo /*
      4  1.1  leo  * Copyright (c) 1995 L. Weppelman (Atari modifications)
      5  1.1  leo  * Copyright (c) 1992, 1993
      6  1.1  leo  *	The Regents of the University of California.  All rights reserved.
      7  1.1  leo  *
      8  1.1  leo  * This software was developed by the Computer Systems Engineering group
      9  1.1  leo  * at Lawrence Berkeley Laboratory under DARPA contract BG 91-66 and
     10  1.1  leo  * contributed to Berkeley.
     11  1.1  leo  *
     12  1.1  leo  *
     13  1.1  leo  * All advertising materials mentioning features or use of this software
     14  1.1  leo  * must display the following acknowledgement:
     15  1.1  leo  *	This product includes software developed by the University of
     16  1.1  leo  *	California, Lawrence Berkeley Laboratory.
     17  1.1  leo  *
     18  1.1  leo  * Redistribution and use in source and binary forms, with or without
     19  1.1  leo  * modification, are permitted provided that the following conditions
     20  1.1  leo  * are met:
     21  1.1  leo  * 1. Redistributions of source code must retain the above copyright
     22  1.1  leo  *    notice, this list of conditions and the following disclaimer.
     23  1.1  leo  * 2. Redistributions in binary form must reproduce the above copyright
     24  1.1  leo  *    notice, this list of conditions and the following disclaimer in the
     25  1.1  leo  *    documentation and/or other materials provided with the distribution.
     26  1.1  leo  * 3. All advertising materials mentioning features or use of this software
     27  1.1  leo  *    must display the following acknowledgement:
     28  1.1  leo  *	This product includes software developed by the University of
     29  1.1  leo  *	California, Berkeley and its contributors.
     30  1.1  leo  * 4. Neither the name of the University nor the names of its contributors
     31  1.1  leo  *    may be used to endorse or promote products derived from this software
     32  1.1  leo  *    without specific prior written permission.
     33  1.1  leo  *
     34  1.1  leo  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     35  1.1  leo  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     36  1.1  leo  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     37  1.1  leo  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     38  1.1  leo  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     39  1.1  leo  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     40  1.1  leo  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     41  1.1  leo  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     42  1.1  leo  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     43  1.1  leo  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     44  1.1  leo  * SUCH DAMAGE.
     45  1.1  leo  *
     46  1.1  leo  *	@(#)zs.c	8.1 (Berkeley) 7/19/93
     47  1.1  leo  */
     48  1.1  leo 
     49  1.1  leo /*
     50  1.1  leo  * Zilog Z8530 (ZSCC) driver.
     51  1.1  leo  *
     52  1.1  leo  * Runs two tty ports (modem2 and serial2) on zs0.
     53  1.1  leo  *
     54  1.1  leo  * This driver knows far too much about chip to usage mappings.
     55  1.1  leo  */
     56  1.1  leo #include <sys/param.h>
     57  1.1  leo #include <sys/proc.h>
     58  1.1  leo #include <sys/device.h>
     59  1.1  leo #include <sys/conf.h>
     60  1.1  leo #include <sys/file.h>
     61  1.1  leo #include <sys/ioctl.h>
     62  1.1  leo #include <sys/tty.h>
     63  1.1  leo #include <sys/time.h>
     64  1.1  leo #include <sys/kernel.h>
     65  1.1  leo #include <sys/syslog.h>
     66  1.1  leo 
     67  1.1  leo #include <machine/cpu.h>
     68  1.1  leo #include <machine/iomap.h>
     69  1.1  leo #include <machine/scu.h>
     70  1.1  leo #include <machine/mfp.h>
     71  1.1  leo 
     72  1.1  leo #include <atari/dev/zsreg.h>
     73  1.1  leo #include <atari/dev/zsvar.h>
     74  1.1  leo #include "zs.h"
     75  1.1  leo #if NZS > 1
     76  1.1  leo #error "This driver supports only 1 85C30!"
     77  1.1  leo #endif
     78  1.1  leo 
     79  1.1  leo #if NZS > 0
     80  1.1  leo 
     81  1.1  leo #define PCLK	(8000000)	/* PCLK pin input clock rate */
     82  1.1  leo 
     83  1.1  leo #define splzs	spl5
     84  1.1  leo 
     85  1.1  leo /*
     86  1.1  leo  * Software state per found chip.
     87  1.1  leo  */
     88  1.1  leo struct zs_softc {
     89  1.1  leo     struct	device		zi_dev;    /* base device		  */
     90  1.1  leo     volatile struct zsdevice	*zi_zs;    /* chip registers		  */
     91  1.1  leo     struct	zs_chanstate	zi_cs[2];  /* chan A and B software state */
     92  1.1  leo };
     93  1.1  leo 
     94  1.1  leo /*
     95  1.1  leo  * Define the registers for a closed port
     96  1.1  leo  */
     97  1.1  leo u_char zs_init_regs[16] = {
     98  1.1  leo /*  0 */	0,
     99  1.1  leo /*  1 */	0,
    100  1.1  leo /*  2 */	0x60,
    101  1.1  leo /*  3 */	0,
    102  1.1  leo /*  4 */	0,
    103  1.1  leo /*  5 */	0,
    104  1.1  leo /*  6 */	0,
    105  1.1  leo /*  7 */	0,
    106  1.1  leo /*  8 */	0,
    107  1.1  leo /*  9 */	ZSWR9_VECTOR_INCL_STAT,
    108  1.1  leo /* 10 */	ZSWR10_NRZ,
    109  1.1  leo /* 11 */	ZSWR11_TXCLK_BAUD | ZSWR11_RXCLK_BAUD,
    110  1.1  leo /* 12 */	0,
    111  1.1  leo /* 13 */	0,
    112  1.1  leo /* 14 */	ZSWR14_BAUD_FROM_PCLK | ZSWR14_BAUD_ENA,
    113  1.1  leo /* 15 */	0
    114  1.1  leo };
    115  1.1  leo 
    116  1.1  leo struct tty *zs_tty[NZS * 2];		/* XXX should be dynamic */
    117  1.1  leo 
    118  1.1  leo /* Definition of the driver for autoconfig. */
    119  1.1  leo static int	zsmatch __P((struct device *, struct cfdata *, void *));
    120  1.1  leo static void	zsattach __P((struct device *, struct device *, void *));
    121  1.1  leo struct cfdriver zscd = {
    122  1.1  leo 	NULL, "zs", (cfmatch_t)zsmatch, zsattach, DV_TTY,
    123  1.1  leo 	sizeof(struct zs_softc), NULL, 0 };
    124  1.1  leo 
    125  1.1  leo /* Interrupt handlers. */
    126  1.1  leo int		zshard __P((long));
    127  1.1  leo static int	zssoft __P((long));
    128  1.1  leo static int	zsrint __P((struct zs_chanstate *, volatile struct zschan *));
    129  1.1  leo static int	zsxint __P((struct zs_chanstate *, volatile struct zschan *));
    130  1.1  leo static int	zssint __P((struct zs_chanstate *, volatile struct zschan *));
    131  1.1  leo 
    132  1.1  leo struct zs_chanstate *zslist;
    133  1.1  leo 
    134  1.1  leo /* Routines called from other code. */
    135  1.1  leo static void	zsstart __P((struct tty *));
    136  1.1  leo void		zsstop __P((struct tty *, int));
    137  1.1  leo static int	zsparam __P((struct tty *, struct termios *));
    138  1.1  leo 
    139  1.1  leo /* Routines purely local to this driver. */
    140  1.1  leo static void	zs_reset __P((volatile struct zschan *, int, int));
    141  1.1  leo static int	zs_modem __P((struct zs_chanstate *, int, int));
    142  1.1  leo static void	zs_loadchannelregs __P((volatile struct zschan *, u_char *));
    143  1.1  leo 
    144  1.1  leo int zsshortcuts;	/* number of "shortcut" software interrupts */
    145  1.1  leo 
    146  1.1  leo static int zsmatch(pdp, cfp, auxp)
    147  1.1  leo struct device	*pdp;
    148  1.1  leo struct cfdata	*cfp;
    149  1.1  leo void		*auxp;
    150  1.1  leo {
    151  1.1  leo 	if(strcmp("zs", auxp) || cfp->cf_unit != 0)
    152  1.1  leo 		return(0);
    153  1.1  leo 	return(1);
    154  1.1  leo }
    155  1.1  leo 
    156  1.1  leo /*
    157  1.1  leo  * Attach a found zs.
    158  1.1  leo  */
    159  1.1  leo static void
    160  1.1  leo zsattach(parent, dev, aux)
    161  1.1  leo struct device	*parent;
    162  1.1  leo struct device	*dev;
    163  1.1  leo void		*aux;
    164  1.1  leo {
    165  1.1  leo 	register struct zs_softc		*zi;
    166  1.1  leo 	register struct zs_chanstate		*cs;
    167  1.1  leo 	register volatile struct zsdevice	*addr;
    168  1.1  leo 	register struct tty			*tp;
    169  1.1  leo 		 char				tmp;
    170  1.1  leo 
    171  1.1  leo 	addr      = (struct zsdevice *)AD_SCC;
    172  1.1  leo 	zi        = (struct zs_softc *)dev;
    173  1.1  leo 	zi->zi_zs = addr;
    174  1.1  leo 	cs        = zi->zi_cs;
    175  1.1  leo 
    176  1.1  leo 	/*
    177  1.1  leo 	 * Get the command register into a known state.
    178  1.1  leo 	 */
    179  1.1  leo 	tmp = addr->zs_chan[CHAN_A].zc_csr;
    180  1.1  leo 	tmp = addr->zs_chan[CHAN_A].zc_csr;
    181  1.1  leo 	tmp = addr->zs_chan[CHAN_B].zc_csr;
    182  1.1  leo 	tmp = addr->zs_chan[CHAN_B].zc_csr;
    183  1.1  leo 
    184  1.1  leo 	/*
    185  1.1  leo 	 * Do a hardware reset.
    186  1.1  leo 	 */
    187  1.1  leo 	ZS_WRITE(&addr->zs_chan[CHAN_A], 9, ZSWR9_HARD_RESET);
    188  1.1  leo 	delay(50000);	/*enough ? */
    189  1.1  leo 	ZS_WRITE(&addr->zs_chan[CHAN_A], 9, 0);
    190  1.1  leo 
    191  1.1  leo 	/*
    192  1.1  leo 	 * Initialize both channels
    193  1.1  leo 	 */
    194  1.1  leo 	zs_loadchannelregs(&addr->zs_chan[CHAN_A], zs_init_regs);
    195  1.1  leo 	zs_loadchannelregs(&addr->zs_chan[CHAN_B], zs_init_regs);
    196  1.1  leo 
    197  1.1  leo 	/*
    198  1.1  leo 	 * enable scc related interrupts
    199  1.1  leo 	 */
    200  1.1  leo 	SCU->sys_mask |= SCU_SCC;
    201  1.1  leo 
    202  1.1  leo 	/* link into interrupt list with order (A,B) (B=A+1) */
    203  1.1  leo 	cs[0].cs_next = &cs[1];
    204  1.1  leo 	cs[1].cs_next = zslist;
    205  1.1  leo 	zslist        = cs;
    206  1.1  leo 
    207  1.1  leo 	cs->cs_unit  = 0;
    208  1.1  leo 	cs->cs_zc    = &addr->zs_chan[CHAN_A];
    209  1.1  leo 	cs++;
    210  1.1  leo 	cs->cs_unit  = 1;
    211  1.1  leo 	cs->cs_zc    = &addr->zs_chan[CHAN_B];
    212  1.1  leo 
    213  1.1  leo 	printf(": serial2 on channel a and modem2 on channel b\n");
    214  1.1  leo }
    215  1.1  leo 
    216  1.1  leo /*
    217  1.1  leo  * Open a zs serial port.
    218  1.1  leo  */
    219  1.1  leo int
    220  1.1  leo zsopen(dev, flags, mode, p)
    221  1.1  leo dev_t		dev;
    222  1.1  leo int		flags;
    223  1.1  leo int		mode;
    224  1.1  leo struct proc	*p;
    225  1.1  leo {
    226  1.1  leo 	register struct tty		*tp;
    227  1.1  leo 	register struct zs_chanstate	*cs;
    228  1.1  leo 		 struct zs_softc	*zi;
    229  1.1  leo 		 int			unit = ZS_UNIT(dev);
    230  1.1  leo 		 int			zs = unit >> 1;
    231  1.1  leo 		 int			error, s;
    232  1.1  leo 
    233  1.1  leo 	if(zs >= zscd.cd_ndevs || (zi = zscd.cd_devs[zs]) == NULL)
    234  1.1  leo 		return (ENXIO);
    235  1.1  leo 	cs = &zi->zi_cs[unit & 1];
    236  1.1  leo 	tp = cs->cs_ttyp;
    237  1.1  leo 	if(tp == NULL) {
    238  1.1  leo 		cs->cs_ttyp  = tp = zs_tty[unit] = ttymalloc();
    239  1.1  leo 		tp->t_dev    = dev;
    240  1.1  leo 		tp->t_oproc  = zsstart;
    241  1.1  leo 		tp->t_param  = zsparam;
    242  1.1  leo 	}
    243  1.1  leo 
    244  1.1  leo 	s  = spltty();
    245  1.1  leo 	if((tp->t_state & TS_ISOPEN) == 0) {
    246  1.1  leo 		ttychars(tp);
    247  1.1  leo 		if(tp->t_ispeed == 0) {
    248  1.1  leo 			tp->t_iflag = TTYDEF_IFLAG;
    249  1.1  leo 			tp->t_oflag = TTYDEF_OFLAG;
    250  1.1  leo 			tp->t_cflag = TTYDEF_CFLAG;
    251  1.1  leo 			tp->t_lflag = TTYDEF_LFLAG;
    252  1.1  leo 			tp->t_ispeed = tp->t_ospeed = TTYDEF_SPEED;
    253  1.1  leo 		}
    254  1.1  leo 		(void)zsparam(tp, &tp->t_termios);
    255  1.1  leo 		ttsetwater(tp);
    256  1.1  leo 	}
    257  1.1  leo 	else if(tp->t_state & TS_XCLUDE && p->p_ucred->cr_uid != 0) {
    258  1.1  leo 			splx(s);
    259  1.1  leo 			return (EBUSY);
    260  1.1  leo 	}
    261  1.1  leo 	error = 0;
    262  1.1  leo 	for(;;) {
    263  1.1  leo 		/* loop, turning on the device, until carrier present */
    264  1.1  leo 		zs_modem(cs, ZSWR5_RTS|ZSWR5_DTR, DMSET);
    265  1.1  leo 		if(cs->cs_softcar)
    266  1.1  leo 			tp->t_state |= TS_CARR_ON;
    267  1.1  leo 		if(flags & O_NONBLOCK || tp->t_cflag & CLOCAL ||
    268  1.1  leo 		    tp->t_state & TS_CARR_ON)
    269  1.1  leo 			break;
    270  1.1  leo 		tp->t_state |= TS_WOPEN;
    271  1.1  leo 		if(error = ttysleep(tp, (caddr_t)&tp->t_rawq, TTIPRI | PCATCH,
    272  1.1  leo 		    ttopen, 0)) {
    273  1.1  leo 			if(!(tp->t_state & TS_ISOPEN)) {
    274  1.1  leo 				zs_modem(cs, 0, DMSET);
    275  1.1  leo 				tp->t_state &= ~TS_WOPEN;
    276  1.1  leo 				ttwakeup(tp);
    277  1.1  leo 			}
    278  1.1  leo 			splx(s);
    279  1.1  leo 			return error;
    280  1.1  leo 		}
    281  1.1  leo 	}
    282  1.1  leo 	splx(s);
    283  1.1  leo 	if(error == 0)
    284  1.1  leo 		error = linesw[tp->t_line].l_open(dev, tp);
    285  1.1  leo 	if(error)
    286  1.1  leo 		zs_modem(cs, 0, DMSET);
    287  1.1  leo 	return(error);
    288  1.1  leo }
    289  1.1  leo 
    290  1.1  leo /*
    291  1.1  leo  * Close a zs serial port.
    292  1.1  leo  */
    293  1.1  leo int
    294  1.1  leo zsclose(dev, flags, mode, p)
    295  1.1  leo dev_t		dev;
    296  1.1  leo int		flags;
    297  1.1  leo int		mode;
    298  1.1  leo struct proc	*p;
    299  1.1  leo {
    300  1.1  leo 	register struct zs_chanstate	*cs;
    301  1.1  leo 	register struct tty		*tp;
    302  1.1  leo 		 struct zs_softc	*zi;
    303  1.1  leo 		 int			unit = ZS_UNIT(dev);
    304  1.1  leo 		 int			s;
    305  1.1  leo 
    306  1.1  leo 	zi = zscd.cd_devs[unit >> 1];
    307  1.1  leo 	cs = &zi->zi_cs[unit & 1];
    308  1.1  leo 	tp = cs->cs_ttyp;
    309  1.1  leo 	linesw[tp->t_line].l_close(tp, flags);
    310  1.1  leo 	if(tp->t_cflag & HUPCL || tp->t_state & TS_WOPEN ||
    311  1.1  leo 	    (tp->t_state & TS_ISOPEN) == 0) {
    312  1.1  leo 		zs_modem(cs, 0, DMSET);
    313  1.1  leo 		/* hold low for 1 second */
    314  1.1  leo 		(void)tsleep((caddr_t)cs, TTIPRI, ttclos, hz);
    315  1.1  leo 	}
    316  1.1  leo 	if(cs->cs_creg[5] & ZSWR5_BREAK) {
    317  1.1  leo 		s = splzs();
    318  1.1  leo 		cs->cs_preg[5] &= ~ZSWR5_BREAK;
    319  1.1  leo 		cs->cs_creg[5] &= ~ZSWR5_BREAK;
    320  1.1  leo 		ZS_WRITE(cs->cs_zc, 5, cs->cs_creg[5]);
    321  1.1  leo 		splx(s);
    322  1.1  leo 	}
    323  1.1  leo 	ttyclose(tp);
    324  1.1  leo 
    325  1.1  leo 	/*
    326  1.1  leo 	 * Drop all lines and cancel interrupts
    327  1.1  leo 	 */
    328  1.1  leo 	zs_loadchannelregs(&zi->zi_zs->zs_chan[unit & 1], zs_init_regs);
    329  1.1  leo 	return (0);
    330  1.1  leo }
    331  1.1  leo 
    332  1.1  leo /*
    333  1.1  leo  * Read/write zs serial port.
    334  1.1  leo  */
    335  1.1  leo int
    336  1.1  leo zsread(dev, uio, flags)
    337  1.1  leo dev_t		dev;
    338  1.1  leo struct uio	*uio;
    339  1.1  leo int		flags;
    340  1.1  leo {
    341  1.1  leo 	register struct tty *tp = zs_tty[ZS_UNIT(dev)];
    342  1.1  leo 
    343  1.1  leo 	return(linesw[tp->t_line].l_read(tp, uio, flags));
    344  1.1  leo }
    345  1.1  leo 
    346  1.1  leo int zswrite(dev, uio, flags)
    347  1.1  leo dev_t		dev;
    348  1.1  leo struct uio	*uio;
    349  1.1  leo int		flags;
    350  1.1  leo {
    351  1.1  leo 	register struct tty *tp = zs_tty[ZS_UNIT(dev)];
    352  1.1  leo 
    353  1.1  leo 	return(linesw[tp->t_line].l_write(tp, uio, flags));
    354  1.1  leo }
    355  1.1  leo 
    356  1.1  leo /*
    357  1.1  leo  * ZS hardware interrupt.  Scan all ZS channels.  NB: we know here that
    358  1.1  leo  * channels are kept in (A,B) pairs.
    359  1.1  leo  *
    360  1.1  leo  * Do just a little, then get out; set a software interrupt if more
    361  1.1  leo  * work is needed.
    362  1.1  leo  *
    363  1.1  leo  * We deliberately ignore the vectoring Zilog gives us, and match up
    364  1.1  leo  * only the number of `reset interrupt under service' operations, not
    365  1.1  leo  * the order.
    366  1.1  leo  */
    367  1.1  leo int
    368  1.1  leo zshard(sr)
    369  1.1  leo long sr;
    370  1.1  leo {
    371  1.1  leo 	register struct zs_chanstate	*a;
    372  1.1  leo #define	b (a + 1)
    373  1.1  leo 	register volatile struct zschan *zc;
    374  1.1  leo 	register int			rr3, intflags = 0, v, i;
    375  1.1  leo 
    376  1.1  leo 	for(a = zslist; a != NULL; a = b->cs_next) {
    377  1.1  leo 		rr3 = ZS_READ(a->cs_zc, 3);
    378  1.1  leo 		if(rr3 & (ZSRR3_IP_A_RX|ZSRR3_IP_A_TX|ZSRR3_IP_A_STAT)) {
    379  1.1  leo 			intflags |= 2;
    380  1.1  leo 			zc = a->cs_zc;
    381  1.1  leo 			i  = a->cs_rbput;
    382  1.1  leo 			if(rr3 & ZSRR3_IP_A_RX && (v = zsrint(a, zc)) != 0) {
    383  1.1  leo 				a->cs_rbuf[i++ & ZLRB_RING_MASK] = v;
    384  1.1  leo 				intflags |= 1;
    385  1.1  leo 			}
    386  1.1  leo 			if(rr3 & ZSRR3_IP_A_TX && (v = zsxint(a, zc)) != 0) {
    387  1.1  leo 				a->cs_rbuf[i++ & ZLRB_RING_MASK] = v;
    388  1.1  leo 				intflags |= 1;
    389  1.1  leo 			}
    390  1.1  leo 			if(rr3 & ZSRR3_IP_A_STAT && (v = zssint(a, zc)) != 0) {
    391  1.1  leo 				a->cs_rbuf[i++ & ZLRB_RING_MASK] = v;
    392  1.1  leo 				intflags |= 1;
    393  1.1  leo 			}
    394  1.1  leo 			a->cs_rbput = i;
    395  1.1  leo 		}
    396  1.1  leo 		if(rr3 & (ZSRR3_IP_B_RX|ZSRR3_IP_B_TX|ZSRR3_IP_B_STAT)) {
    397  1.1  leo 			intflags |= 2;
    398  1.1  leo 			zc = b->cs_zc;
    399  1.1  leo 			i  = b->cs_rbput;
    400  1.1  leo 			if(rr3 & ZSRR3_IP_B_RX && (v = zsrint(b, zc)) != 0) {
    401  1.1  leo 				b->cs_rbuf[i++ & ZLRB_RING_MASK] = v;
    402  1.1  leo 				intflags |= 1;
    403  1.1  leo 			}
    404  1.1  leo 			if(rr3 & ZSRR3_IP_B_TX && (v = zsxint(b, zc)) != 0) {
    405  1.1  leo 				b->cs_rbuf[i++ & ZLRB_RING_MASK] = v;
    406  1.1  leo 				intflags |= 1;
    407  1.1  leo 			}
    408  1.1  leo 			if(rr3 & ZSRR3_IP_B_STAT && (v = zssint(b, zc)) != 0) {
    409  1.1  leo 				b->cs_rbuf[i++ & ZLRB_RING_MASK] = v;
    410  1.1  leo 				intflags |= 1;
    411  1.1  leo 			}
    412  1.1  leo 			b->cs_rbput = i;
    413  1.1  leo 		}
    414  1.1  leo 	}
    415  1.1  leo #undef b
    416  1.1  leo 
    417  1.1  leo 	if(intflags & 1) {
    418  1.1  leo 		if(BASEPRI(sr)) {
    419  1.1  leo 			spl1();
    420  1.1  leo 			zsshortcuts++;
    421  1.1  leo 			return(zssoft(sr));
    422  1.1  leo 		}
    423  1.1  leo 		else add_sicallback(zssoft, 0, 0);
    424  1.1  leo 	}
    425  1.1  leo 	return(intflags & 2);
    426  1.1  leo }
    427  1.1  leo 
    428  1.1  leo static int
    429  1.1  leo zsrint(cs, zc)
    430  1.1  leo register struct zs_chanstate	*cs;
    431  1.1  leo register volatile struct zschan	*zc;
    432  1.1  leo {
    433  1.1  leo 	register int c = zc->zc_data;
    434  1.1  leo 
    435  1.1  leo 	/* compose receive character and status */
    436  1.1  leo 	c <<= 8;
    437  1.1  leo 	c |= ZS_READ(zc, 1);
    438  1.1  leo 
    439  1.1  leo 	/* clear receive error & interrupt condition */
    440  1.1  leo 	zc->zc_csr = ZSWR0_RESET_ERRORS;
    441  1.1  leo 	zc->zc_csr = ZSWR0_CLR_INTR;
    442  1.1  leo 
    443  1.1  leo 	return(ZRING_MAKE(ZRING_RINT, c));
    444  1.1  leo }
    445  1.1  leo 
    446  1.1  leo static int
    447  1.1  leo zsxint(cs, zc)
    448  1.1  leo register struct zs_chanstate	*cs;
    449  1.1  leo register volatile struct zschan	*zc;
    450  1.1  leo {
    451  1.1  leo 	register int i = cs->cs_tbc;
    452  1.1  leo 
    453  1.1  leo 	if(i == 0) {
    454  1.1  leo 		zc->zc_csr = ZSWR0_RESET_TXINT;
    455  1.1  leo 		zc->zc_csr = ZSWR0_CLR_INTR;
    456  1.1  leo 		return(ZRING_MAKE(ZRING_XINT, 0));
    457  1.1  leo 	}
    458  1.1  leo 	cs->cs_tbc = i - 1;
    459  1.1  leo 	zc->zc_data = *cs->cs_tba++;
    460  1.1  leo 	zc->zc_csr = ZSWR0_CLR_INTR;
    461  1.1  leo 	return (0);
    462  1.1  leo }
    463  1.1  leo 
    464  1.1  leo static int
    465  1.1  leo zssint(cs, zc)
    466  1.1  leo register struct zs_chanstate	*cs;
    467  1.1  leo register volatile struct zschan	*zc;
    468  1.1  leo {
    469  1.1  leo 	register int rr0;
    470  1.1  leo 
    471  1.1  leo 	rr0 = zc->zc_csr;
    472  1.1  leo 	zc->zc_csr = ZSWR0_RESET_STATUS;
    473  1.1  leo 	zc->zc_csr = ZSWR0_CLR_INTR;
    474  1.1  leo 	/*
    475  1.1  leo 	 * The chip's hardware flow control is, as noted in zsreg.h,
    476  1.1  leo 	 * busted---if the DCD line goes low the chip shuts off the
    477  1.1  leo 	 * receiver (!).  If we want hardware CTS flow control but do
    478  1.1  leo 	 * not have it, and carrier is now on, turn HFC on; if we have
    479  1.1  leo 	 * HFC now but carrier has gone low, turn it off.
    480  1.1  leo 	 */
    481  1.1  leo 	if(rr0 & ZSRR0_DCD) {
    482  1.1  leo 		if(cs->cs_ttyp->t_cflag & CCTS_OFLOW &&
    483  1.1  leo 		    (cs->cs_creg[3] & ZSWR3_HFC) == 0) {
    484  1.1  leo 			cs->cs_creg[3] |= ZSWR3_HFC;
    485  1.1  leo 			ZS_WRITE(zc, 3, cs->cs_creg[3]);
    486  1.1  leo 		}
    487  1.1  leo 	}
    488  1.1  leo 	else {
    489  1.1  leo 		if (cs->cs_creg[3] & ZSWR3_HFC) {
    490  1.1  leo 			cs->cs_creg[3] &= ~ZSWR3_HFC;
    491  1.1  leo 			ZS_WRITE(zc, 3, cs->cs_creg[3]);
    492  1.1  leo 		}
    493  1.1  leo 	}
    494  1.1  leo 	return(ZRING_MAKE(ZRING_SINT, rr0));
    495  1.1  leo }
    496  1.1  leo 
    497  1.1  leo /*
    498  1.1  leo  * Print out a ring or fifo overrun error message.
    499  1.1  leo  */
    500  1.1  leo static void
    501  1.1  leo zsoverrun(unit, ptime, what)
    502  1.1  leo int	unit;
    503  1.1  leo long	*ptime;
    504  1.1  leo char	*what;
    505  1.1  leo {
    506  1.1  leo 
    507  1.1  leo 	if(*ptime != time.tv_sec) {
    508  1.1  leo 		*ptime = time.tv_sec;
    509  1.1  leo 		log(LOG_WARNING, "zs%d%c: %s overrun\n", unit >> 1,
    510  1.1  leo 		    (unit & 1) + 'a', what);
    511  1.1  leo 	}
    512  1.1  leo }
    513  1.1  leo 
    514  1.1  leo /*
    515  1.1  leo  * ZS software interrupt.  Scan all channels for deferred interrupts.
    516  1.1  leo  */
    517  1.1  leo int
    518  1.1  leo zssoft(sr)
    519  1.1  leo long sr;
    520  1.1  leo {
    521  1.1  leo     register struct zs_chanstate	*cs;
    522  1.1  leo     register volatile struct zschan	*zc;
    523  1.1  leo     register struct linesw		*line;
    524  1.1  leo     register struct tty			*tp;
    525  1.1  leo     register int			get, n, c, cc, unit, s;
    526  1.1  leo  	     int			retval = 0;
    527  1.1  leo 
    528  1.1  leo     s = spltty();
    529  1.1  leo     for(cs = zslist; cs != NULL; cs = cs->cs_next) {
    530  1.1  leo 	get = cs->cs_rbget;
    531  1.1  leo again:
    532  1.1  leo 	n = cs->cs_rbput;	/* atomic			*/
    533  1.1  leo 	if(get == n)		/* nothing more on this line	*/
    534  1.1  leo 		continue;
    535  1.1  leo 	retval = 1;
    536  1.1  leo 	unit   = cs->cs_unit;	/* set up to handle interrupts	*/
    537  1.1  leo 	zc     = cs->cs_zc;
    538  1.1  leo 	tp     = cs->cs_ttyp;
    539  1.1  leo 	line   = &linesw[tp->t_line];
    540  1.1  leo 	/*
    541  1.1  leo 	 * Compute the number of interrupts in the receive ring.
    542  1.1  leo 	 * If the count is overlarge, we lost some events, and
    543  1.1  leo 	 * must advance to the first valid one.  It may get
    544  1.1  leo 	 * overwritten if more data are arriving, but this is
    545  1.1  leo 	 * too expensive to check and gains nothing (we already
    546  1.1  leo 	 * lost out; all we can do at this point is trade one
    547  1.1  leo 	 * kind of loss for another).
    548  1.1  leo 	 */
    549  1.1  leo 	n -= get;
    550  1.1  leo 	if(n > ZLRB_RING_SIZE) {
    551  1.1  leo 		zsoverrun(unit, &cs->cs_rotime, "ring");
    552  1.1  leo 		get += n - ZLRB_RING_SIZE;
    553  1.1  leo 		n    = ZLRB_RING_SIZE;
    554  1.1  leo 	}
    555  1.1  leo 	while(--n >= 0) {
    556  1.1  leo 		/* race to keep ahead of incoming interrupts */
    557  1.1  leo 		c = cs->cs_rbuf[get++ & ZLRB_RING_MASK];
    558  1.1  leo 		switch (ZRING_TYPE(c)) {
    559  1.1  leo 
    560  1.1  leo 		case ZRING_RINT:
    561  1.1  leo 			c = ZRING_VALUE(c);
    562  1.1  leo 			if(c & ZSRR1_DO)
    563  1.1  leo 				zsoverrun(unit, &cs->cs_fotime, "fifo");
    564  1.1  leo 			cc = c >> 8;
    565  1.1  leo 			if(c & ZSRR1_FE)
    566  1.1  leo 				cc |= TTY_FE;
    567  1.1  leo 			if(c & ZSRR1_PE)
    568  1.1  leo 				cc |= TTY_PE;
    569  1.1  leo 			line->l_rint(cc, tp);
    570  1.1  leo 			break;
    571  1.1  leo 
    572  1.1  leo 		case ZRING_XINT:
    573  1.1  leo 			/*
    574  1.1  leo 			 * Transmit done: change registers and resume,
    575  1.1  leo 			 * or clear BUSY.
    576  1.1  leo 			 */
    577  1.1  leo 			if(cs->cs_heldchange) {
    578  1.1  leo 				int sps;
    579  1.1  leo 
    580  1.1  leo 				sps = splzs();
    581  1.1  leo 				c = zc->zc_csr;
    582  1.1  leo 				if((c & ZSRR0_DCD) == 0)
    583  1.1  leo 					cs->cs_preg[3] &= ~ZSWR3_HFC;
    584  1.1  leo 				bcopy((caddr_t)cs->cs_preg,
    585  1.1  leo 				    (caddr_t)cs->cs_creg, 16);
    586  1.1  leo 				zs_loadchannelregs(zc, cs->cs_creg);
    587  1.1  leo 				splx(sps);
    588  1.1  leo 				cs->cs_heldchange = 0;
    589  1.1  leo 				if(cs->cs_heldtbc
    590  1.1  leo 					&& (tp->t_state & TS_TTSTOP) == 0) {
    591  1.1  leo 					cs->cs_tbc = cs->cs_heldtbc - 1;
    592  1.1  leo 					zc->zc_data = *cs->cs_tba++;
    593  1.1  leo 					goto again;
    594  1.1  leo 				}
    595  1.1  leo 			}
    596  1.1  leo 			tp->t_state &= ~TS_BUSY;
    597  1.1  leo 			if(tp->t_state & TS_FLUSH)
    598  1.1  leo 				tp->t_state &= ~TS_FLUSH;
    599  1.1  leo 			else ndflush(&tp->t_outq,cs->cs_tba
    600  1.1  leo 						- (caddr_t)tp->t_outq.c_cf);
    601  1.1  leo 			line->l_start(tp);
    602  1.1  leo 			break;
    603  1.1  leo 
    604  1.1  leo 		case ZRING_SINT:
    605  1.1  leo 			/*
    606  1.1  leo 			 * Status line change.  HFC bit is run in
    607  1.1  leo 			 * hardware interrupt, to avoid locking
    608  1.1  leo 			 * at splzs here.
    609  1.1  leo 			 */
    610  1.1  leo 			c = ZRING_VALUE(c);
    611  1.1  leo 			if((c ^ cs->cs_rr0) & ZSRR0_DCD) {
    612  1.1  leo 				cc = (c & ZSRR0_DCD) != 0;
    613  1.1  leo 				if(line->l_modem(tp, cc) == 0)
    614  1.1  leo 					zs_modem(cs, ZSWR5_RTS|ZSWR5_DTR,
    615  1.1  leo 							cc ? DMBIS : DMBIC);
    616  1.1  leo 			}
    617  1.1  leo 			cs->cs_rr0 = c;
    618  1.1  leo 			break;
    619  1.1  leo 
    620  1.1  leo 		default:
    621  1.1  leo 			log(LOG_ERR, "zs%d%c: bad ZRING_TYPE (%x)\n",
    622  1.1  leo 			    unit >> 1, (unit & 1) + 'a', c);
    623  1.1  leo 			break;
    624  1.1  leo 		}
    625  1.1  leo 	}
    626  1.1  leo 	cs->cs_rbget = get;
    627  1.1  leo 	goto again;
    628  1.1  leo     }
    629  1.1  leo     splx(s);
    630  1.1  leo     return (retval);
    631  1.1  leo }
    632  1.1  leo 
    633  1.1  leo int
    634  1.1  leo zsioctl(dev, cmd, data, flag, p)
    635  1.1  leo dev_t		dev;
    636  1.1  leo u_long		cmd;
    637  1.1  leo caddr_t		data;
    638  1.1  leo int		flag;
    639  1.1  leo struct proc	*p;
    640  1.1  leo {
    641  1.1  leo 		 int			unit = ZS_UNIT(dev);
    642  1.1  leo 		 struct zs_softc	*zi = zscd.cd_devs[unit >> 1];
    643  1.1  leo 	register struct tty		*tp = zi->zi_cs[unit & 1].cs_ttyp;
    644  1.1  leo 	register int			error, s;
    645  1.1  leo 	register struct zs_chanstate	*cs = &zi->zi_cs[unit & 1];
    646  1.1  leo 
    647  1.1  leo 	error = linesw[tp->t_line].l_ioctl(tp, cmd, data, flag, p);
    648  1.1  leo 	if(error >= 0)
    649  1.1  leo 		return(error);
    650  1.1  leo 	error = ttioctl(tp, cmd, data, flag, p);
    651  1.1  leo 	if(error >= 0)
    652  1.1  leo 		return (error);
    653  1.1  leo 
    654  1.1  leo 	switch (cmd) {
    655  1.1  leo 	case TIOCSBRK:
    656  1.1  leo 		s = splzs();
    657  1.1  leo 		cs->cs_preg[5] |= ZSWR5_BREAK;
    658  1.1  leo 		cs->cs_creg[5] |= ZSWR5_BREAK;
    659  1.1  leo 		ZS_WRITE(cs->cs_zc, 5, cs->cs_creg[5]);
    660  1.1  leo 		splx(s);
    661  1.1  leo 		break;
    662  1.1  leo 	case TIOCCBRK:
    663  1.1  leo 		s = splzs();
    664  1.1  leo 		cs->cs_preg[5] &= ~ZSWR5_BREAK;
    665  1.1  leo 		cs->cs_creg[5] &= ~ZSWR5_BREAK;
    666  1.1  leo 		ZS_WRITE(cs->cs_zc, 5, cs->cs_creg[5]);
    667  1.1  leo 		splx(s);
    668  1.1  leo 		break;
    669  1.1  leo 	case TIOCGFLAGS: {
    670  1.1  leo 		int bits = 0;
    671  1.1  leo 
    672  1.1  leo 		if(cs->cs_softcar)
    673  1.1  leo 			bits |= TIOCFLAG_SOFTCAR;
    674  1.1  leo 		if(cs->cs_creg[15] & ZSWR15_DCD_IE)
    675  1.1  leo 			bits |= TIOCFLAG_CLOCAL;
    676  1.1  leo 		if(cs->cs_creg[3] & ZSWR3_HFC)
    677  1.1  leo 			bits |= TIOCFLAG_CRTSCTS;
    678  1.1  leo 		*(int *)data = bits;
    679  1.1  leo 		break;
    680  1.1  leo 	}
    681  1.1  leo 	case TIOCSFLAGS: {
    682  1.1  leo 		int userbits, driverbits = 0;
    683  1.1  leo 
    684  1.1  leo 		error = suser(p->p_ucred, &p->p_acflag);
    685  1.1  leo 		if(error != 0)
    686  1.1  leo 			return (EPERM);
    687  1.1  leo 
    688  1.1  leo 		userbits = *(int *)data;
    689  1.1  leo 
    690  1.1  leo 		/*
    691  1.1  leo 		 * can have `local' or `softcar', and `rtscts' or `mdmbuf'
    692  1.1  leo 		 # defaulting to software flow control.
    693  1.1  leo 		 */
    694  1.1  leo 		if(userbits & TIOCFLAG_SOFTCAR && userbits & TIOCFLAG_CLOCAL)
    695  1.1  leo 			return(EINVAL);
    696  1.1  leo 		if(userbits & TIOCFLAG_MDMBUF)	/* don't support this (yet?) */
    697  1.1  leo 			return(ENXIO);
    698  1.1  leo 
    699  1.1  leo 		s = splzs();
    700  1.1  leo 		if((userbits & TIOCFLAG_SOFTCAR)) {
    701  1.1  leo 			cs->cs_softcar = 1;	/* turn on softcar */
    702  1.1  leo 			cs->cs_preg[15] &= ~ZSWR15_DCD_IE; /* turn off dcd */
    703  1.1  leo 			cs->cs_creg[15] &= ~ZSWR15_DCD_IE;
    704  1.1  leo 			ZS_WRITE(cs->cs_zc, 15, cs->cs_creg[15]);
    705  1.1  leo 		}
    706  1.1  leo 		else if(userbits & TIOCFLAG_CLOCAL) {
    707  1.1  leo 			cs->cs_softcar = 0; 	/* turn off softcar */
    708  1.1  leo 			cs->cs_preg[15] |= ZSWR15_DCD_IE; /* turn on dcd */
    709  1.1  leo 			cs->cs_creg[15] |= ZSWR15_DCD_IE;
    710  1.1  leo 			ZS_WRITE(cs->cs_zc, 15, cs->cs_creg[15]);
    711  1.1  leo 			tp->t_termios.c_cflag |= CLOCAL;
    712  1.1  leo 		}
    713  1.1  leo 		if(userbits & TIOCFLAG_CRTSCTS) {
    714  1.1  leo 			cs->cs_preg[15] |= ZSWR15_CTS_IE;
    715  1.1  leo 			cs->cs_creg[15] |= ZSWR15_CTS_IE;
    716  1.1  leo 			ZS_WRITE(cs->cs_zc, 15, cs->cs_creg[15]);
    717  1.1  leo 			cs->cs_preg[3] |= ZSWR3_HFC;
    718  1.1  leo 			cs->cs_creg[3] |= ZSWR3_HFC;
    719  1.1  leo 			ZS_WRITE(cs->cs_zc, 3, cs->cs_creg[3]);
    720  1.1  leo 			tp->t_termios.c_cflag |= CRTSCTS;
    721  1.1  leo 		}
    722  1.1  leo 		else {
    723  1.1  leo 			/* no mdmbuf, so we must want software flow control */
    724  1.1  leo 			cs->cs_preg[15] &= ~ZSWR15_CTS_IE;
    725  1.1  leo 			cs->cs_creg[15] &= ~ZSWR15_CTS_IE;
    726  1.1  leo 			ZS_WRITE(cs->cs_zc, 15, cs->cs_creg[15]);
    727  1.1  leo 			cs->cs_preg[3] &= ~ZSWR3_HFC;
    728  1.1  leo 			cs->cs_creg[3] &= ~ZSWR3_HFC;
    729  1.1  leo 			ZS_WRITE(cs->cs_zc, 3, cs->cs_creg[3]);
    730  1.1  leo 			tp->t_termios.c_cflag &= ~CRTSCTS;
    731  1.1  leo 		}
    732  1.1  leo 		splx(s);
    733  1.1  leo 		break;
    734  1.1  leo 	}
    735  1.1  leo 	case TIOCSDTR:
    736  1.1  leo 		zs_modem(cs, ZSWR5_DTR, DMBIS);
    737  1.1  leo 		break;
    738  1.1  leo 	case TIOCCDTR:
    739  1.1  leo 		zs_modem(cs, ZSWR5_DTR, DMBIC);
    740  1.1  leo 		break;
    741  1.1  leo 	case TIOCMGET:
    742  1.1  leo 		zs_modem(cs, 0, DMGET);
    743  1.1  leo 		break;
    744  1.1  leo 	case TIOCMSET:
    745  1.1  leo 	case TIOCMBIS:
    746  1.1  leo 	case TIOCMBIC:
    747  1.1  leo 	default:
    748  1.1  leo 		return (ENOTTY);
    749  1.1  leo 	}
    750  1.1  leo 	return (0);
    751  1.1  leo }
    752  1.1  leo 
    753  1.1  leo /*
    754  1.1  leo  * Start or restart transmission.
    755  1.1  leo  */
    756  1.1  leo static void
    757  1.1  leo zsstart(tp)
    758  1.1  leo register struct tty *tp;
    759  1.1  leo {
    760  1.1  leo 	register struct zs_chanstate	*cs;
    761  1.1  leo 	register int			s, nch;
    762  1.1  leo 		 int			unit = ZS_UNIT(tp->t_dev);
    763  1.1  leo 		 struct zs_softc	*zi = zscd.cd_devs[unit >> 1];
    764  1.1  leo 
    765  1.1  leo 	cs = &zi->zi_cs[unit & 1];
    766  1.1  leo 	s  = spltty();
    767  1.1  leo 
    768  1.1  leo 	/*
    769  1.1  leo 	 * If currently active or delaying, no need to do anything.
    770  1.1  leo 	 */
    771  1.1  leo 	if(tp->t_state & (TS_TIMEOUT | TS_BUSY | TS_TTSTOP))
    772  1.1  leo 		goto out;
    773  1.1  leo 
    774  1.1  leo 	/*
    775  1.1  leo 	 * If there are sleepers, and output has drained below low
    776  1.1  leo 	 * water mark, awaken.
    777  1.1  leo 	 */
    778  1.1  leo 	if(tp->t_outq.c_cc <= tp->t_lowat) {
    779  1.1  leo 		if(tp->t_state & TS_ASLEEP) {
    780  1.1  leo 			tp->t_state &= ~TS_ASLEEP;
    781  1.1  leo 			wakeup((caddr_t)&tp->t_outq);
    782  1.1  leo 		}
    783  1.1  leo 		selwakeup(&tp->t_wsel);
    784  1.1  leo 	}
    785  1.1  leo 
    786  1.1  leo 	nch = ndqb(&tp->t_outq, 0);	/* XXX */
    787  1.1  leo 	if(nch) {
    788  1.1  leo 		register char *p = tp->t_outq.c_cf;
    789  1.1  leo 
    790  1.1  leo 		/* mark busy, enable tx done interrupts, & send first byte */
    791  1.1  leo 		tp->t_state |= TS_BUSY;
    792  1.1  leo 		(void) splzs();
    793  1.1  leo 		cs->cs_preg[1] |= ZSWR1_TIE;
    794  1.1  leo 		cs->cs_creg[1] |= ZSWR1_TIE;
    795  1.1  leo 		ZS_WRITE(cs->cs_zc, 1, cs->cs_creg[1]);
    796  1.1  leo 		cs->cs_zc->zc_data = *p;
    797  1.1  leo 		cs->cs_tba = p + 1;
    798  1.1  leo 		cs->cs_tbc = nch - 1;
    799  1.1  leo 	} else {
    800  1.1  leo 		/*
    801  1.1  leo 		 * Nothing to send, turn off transmit done interrupts.
    802  1.1  leo 		 * This is useful if something is doing polled output.
    803  1.1  leo 		 */
    804  1.1  leo 		(void) splzs();
    805  1.1  leo 		cs->cs_preg[1] &= ~ZSWR1_TIE;
    806  1.1  leo 		cs->cs_creg[1] &= ~ZSWR1_TIE;
    807  1.1  leo 		ZS_WRITE(cs->cs_zc, 1, cs->cs_creg[1]);
    808  1.1  leo 	}
    809  1.1  leo out:
    810  1.1  leo 	splx(s);
    811  1.1  leo }
    812  1.1  leo 
    813  1.1  leo /*
    814  1.1  leo  * Stop output, e.g., for ^S or output flush.
    815  1.1  leo  */
    816  1.1  leo void
    817  1.1  leo zsstop(tp, flag)
    818  1.1  leo register struct tty	*tp;
    819  1.1  leo 	 int		flag;
    820  1.1  leo {
    821  1.1  leo 	register struct zs_chanstate	*cs;
    822  1.1  leo 	register int			s, unit = ZS_UNIT(tp->t_dev);
    823  1.1  leo 		 struct zs_softc	*zi = zscd.cd_devs[unit >> 1];
    824  1.1  leo 
    825  1.1  leo 	cs = &zi->zi_cs[unit & 1];
    826  1.1  leo 	s  = splzs();
    827  1.1  leo 	if(tp->t_state & TS_BUSY) {
    828  1.1  leo 		/*
    829  1.1  leo 		 * Device is transmitting; must stop it.
    830  1.1  leo 		 */
    831  1.1  leo 		cs->cs_tbc = 0;
    832  1.1  leo 		if ((tp->t_state & TS_TTSTOP) == 0)
    833  1.1  leo 			tp->t_state |= TS_FLUSH;
    834  1.1  leo 	}
    835  1.1  leo 	splx(s);
    836  1.1  leo }
    837  1.1  leo 
    838  1.1  leo /*
    839  1.1  leo  * Set ZS tty parameters from termios.
    840  1.1  leo  *
    841  1.1  leo  * This routine makes use of the fact that only registers
    842  1.1  leo  * 1, 3, 4, 5, 9, 10, 11, 12, 13, 14, and 15 are written.
    843  1.1  leo  */
    844  1.1  leo static int
    845  1.1  leo zsparam(tp, t)
    846  1.1  leo register struct tty	*tp;
    847  1.1  leo register struct termios	*t;
    848  1.1  leo {
    849  1.1  leo 		 int			unit = ZS_UNIT(tp->t_dev);
    850  1.1  leo 		 struct zs_softc	*zi = zscd.cd_devs[unit >> 1];
    851  1.1  leo 	register struct zs_chanstate	*cs = &zi->zi_cs[unit & 1];
    852  1.1  leo 	register int			tmp, tmp5, cflag, s;
    853  1.1  leo 
    854  1.1  leo 	tmp = t->c_ospeed;
    855  1.1  leo 	if(tmp < 0 || (t->c_ispeed && t->c_ispeed != tmp))
    856  1.1  leo 		return(EINVAL);
    857  1.1  leo 	if(tmp == 0) {
    858  1.1  leo 		/* stty 0 => drop DTR and RTS */
    859  1.1  leo 		zs_modem(cs, 0, DMSET);
    860  1.1  leo 		return(0);
    861  1.1  leo 	}
    862  1.1  leo 	tmp = BPS_TO_TCONST(PCLK / 16, tmp);
    863  1.1  leo 	if(tmp < 2)
    864  1.1  leo 		return(EINVAL);
    865  1.1  leo 
    866  1.1  leo 	cflag = t->c_cflag;
    867  1.1  leo 	tp->t_ispeed = tp->t_ospeed = TCONST_TO_BPS(PCLK / 16, tmp);
    868  1.1  leo 	tp->t_cflag = cflag;
    869  1.1  leo 
    870  1.1  leo 	/*
    871  1.1  leo 	 * Block interrupts so that state will not
    872  1.1  leo 	 * be altered until we are done setting it up.
    873  1.1  leo 	 */
    874  1.1  leo 	s = splzs();
    875  1.1  leo 	cs->cs_preg[12] = tmp;
    876  1.1  leo 	cs->cs_preg[13] = tmp >> 8;
    877  1.1  leo 	cs->cs_preg[1]  = ZSWR1_RIE | ZSWR1_TIE | ZSWR1_SIE;
    878  1.1  leo 	switch(cflag & CSIZE) {
    879  1.1  leo 	case CS5:
    880  1.1  leo 		tmp  = ZSWR3_RX_5;
    881  1.1  leo 		tmp5 = ZSWR5_TX_5;
    882  1.1  leo 		break;
    883  1.1  leo 	case CS6:
    884  1.1  leo 		tmp  = ZSWR3_RX_6;
    885  1.1  leo 		tmp5 = ZSWR5_TX_6;
    886  1.1  leo 		break;
    887  1.1  leo 	case CS7:
    888  1.1  leo 		tmp  = ZSWR3_RX_7;
    889  1.1  leo 		tmp5 = ZSWR5_TX_7;
    890  1.1  leo 		break;
    891  1.1  leo 	case CS8:
    892  1.1  leo 	default:
    893  1.1  leo 		tmp  = ZSWR3_RX_8;
    894  1.1  leo 		tmp5 = ZSWR5_TX_8;
    895  1.1  leo 		break;
    896  1.1  leo 	}
    897  1.1  leo 
    898  1.1  leo 	/*
    899  1.1  leo 	 * Output hardware flow control on the chip is horrendous: if
    900  1.1  leo 	 * carrier detect drops, the receiver is disabled.  Hence we
    901  1.1  leo 	 * can only do this when the carrier is on.
    902  1.1  leo 	 */
    903  1.1  leo 	if(cflag & CCTS_OFLOW && cs->cs_zc->zc_csr & ZSRR0_DCD)
    904  1.1  leo 		tmp |= ZSWR3_HFC | ZSWR3_RX_ENABLE;
    905  1.1  leo 	else tmp |= ZSWR3_RX_ENABLE;
    906  1.1  leo 	cs->cs_preg[3] = tmp;
    907  1.1  leo 	cs->cs_preg[5] = tmp5 | ZSWR5_TX_ENABLE | ZSWR5_DTR | ZSWR5_RTS;
    908  1.1  leo 
    909  1.1  leo 	tmp = ZSWR4_CLK_X16 | (cflag & CSTOPB ? ZSWR4_TWOSB : ZSWR4_ONESB);
    910  1.1  leo 	if((cflag & PARODD) == 0)
    911  1.1  leo 		tmp |= ZSWR4_EVENP;
    912  1.1  leo 	if (cflag & PARENB)
    913  1.1  leo 		tmp |= ZSWR4_PARENB;
    914  1.1  leo 	cs->cs_preg[4]  = tmp;
    915  1.1  leo 	cs->cs_preg[9]  = ZSWR9_MASTER_IE | ZSWR9_VECTOR_INCL_STAT;
    916  1.1  leo 	cs->cs_preg[10] = ZSWR10_NRZ;
    917  1.1  leo 	cs->cs_preg[11] = ZSWR11_TXCLK_BAUD | ZSWR11_RXCLK_BAUD;
    918  1.1  leo 	cs->cs_preg[14] = ZSWR14_BAUD_FROM_PCLK | ZSWR14_BAUD_ENA;
    919  1.1  leo 	cs->cs_preg[15] = ZSWR15_BREAK_IE | ZSWR15_DCD_IE;
    920  1.1  leo 
    921  1.1  leo 	/*
    922  1.1  leo 	 * If nothing is being transmitted, set up new current values,
    923  1.1  leo 	 * else mark them as pending.
    924  1.1  leo 	 */
    925  1.1  leo 	if(cs->cs_heldchange == 0) {
    926  1.1  leo 		if (cs->cs_ttyp->t_state & TS_BUSY) {
    927  1.1  leo 			cs->cs_heldtbc = cs->cs_tbc;
    928  1.1  leo 			cs->cs_tbc = 0;
    929  1.1  leo 			cs->cs_heldchange = 1;
    930  1.1  leo 		}
    931  1.1  leo 		else {
    932  1.1  leo 			bcopy((caddr_t)cs->cs_preg, (caddr_t)cs->cs_creg, 16);
    933  1.1  leo 			zs_loadchannelregs(cs->cs_zc, cs->cs_creg);
    934  1.1  leo 		}
    935  1.1  leo 	}
    936  1.1  leo 	splx(s);
    937  1.1  leo 	return (0);
    938  1.1  leo }
    939  1.1  leo 
    940  1.1  leo /*
    941  1.1  leo  * Raise or lower modem control (DTR/RTS) signals.  If a character is
    942  1.1  leo  * in transmission, the change is deferred.
    943  1.1  leo  */
    944  1.1  leo static int
    945  1.1  leo zs_modem(cs, bits, how)
    946  1.1  leo struct zs_chanstate	*cs;
    947  1.1  leo int			bits, how;
    948  1.1  leo {
    949  1.1  leo 	int s, mbits;
    950  1.1  leo 
    951  1.1  leo 	bits  &= ZSWR5_DTR | ZSWR5_RTS;
    952  1.1  leo 
    953  1.1  leo 	s = splzs();
    954  1.1  leo 	mbits  = cs->cs_preg[5] &  (ZSWR5_DTR | ZSWR5_RTS);
    955  1.1  leo 
    956  1.1  leo 	switch(how) {
    957  1.1  leo 		case DMSET:
    958  1.1  leo 				mbits  = bits;
    959  1.1  leo 				break;
    960  1.1  leo 		case DMBIS:
    961  1.1  leo 				mbits |= bits;
    962  1.1  leo 				break;
    963  1.1  leo 		case DMBIC:
    964  1.1  leo 				mbits &= ~bits;
    965  1.1  leo 				break;
    966  1.1  leo 		case DMGET:
    967  1.1  leo 				splx(s);
    968  1.1  leo 				return(mbits);
    969  1.1  leo 	}
    970  1.1  leo 
    971  1.1  leo 	cs->cs_preg[5] = (cs->cs_preg[5] & ~(ZSWR5_DTR | ZSWR5_RTS)) | mbits;
    972  1.1  leo 	if(cs->cs_heldchange == 0) {
    973  1.1  leo 		if(cs->cs_ttyp->t_state & TS_BUSY) {
    974  1.1  leo 			cs->cs_heldtbc = cs->cs_tbc;
    975  1.1  leo 			cs->cs_tbc = 0;
    976  1.1  leo 			cs->cs_heldchange = 1;
    977  1.1  leo 		}
    978  1.1  leo 		else {
    979  1.1  leo 			ZS_WRITE(cs->cs_zc, 5, cs->cs_creg[5]);
    980  1.1  leo 		}
    981  1.1  leo 	}
    982  1.1  leo 	splx(s);
    983  1.1  leo 	return(0);
    984  1.1  leo }
    985  1.1  leo 
    986  1.1  leo /*
    987  1.1  leo  * Write the given register set to the given zs channel in the proper order.
    988  1.1  leo  * The channel must not be transmitting at the time.  The receiver will
    989  1.1  leo  * be disabled for the time it takes to write all the registers.
    990  1.1  leo  */
    991  1.1  leo static void
    992  1.1  leo zs_loadchannelregs(zc, reg)
    993  1.1  leo volatile struct zschan	*zc;
    994  1.1  leo u_char			*reg;
    995  1.1  leo {
    996  1.1  leo 	int i;
    997  1.1  leo 
    998  1.1  leo 	zc->zc_csr = ZSM_RESET_ERR;	/* reset error condition */
    999  1.1  leo 	i = zc->zc_data;		/* drain fifo */
   1000  1.1  leo 	i = zc->zc_data;
   1001  1.1  leo 	i = zc->zc_data;
   1002  1.1  leo 	ZS_WRITE(zc,  4, reg[4]);
   1003  1.1  leo 	ZS_WRITE(zc, 10, reg[10]);
   1004  1.1  leo 	ZS_WRITE(zc,  3, reg[3] & ~ZSWR3_RX_ENABLE);
   1005  1.1  leo 	ZS_WRITE(zc,  5, reg[5] & ~ZSWR5_TX_ENABLE);
   1006  1.1  leo 	ZS_WRITE(zc,  1, reg[1]);
   1007  1.1  leo 	ZS_WRITE(zc,  9, reg[9]);
   1008  1.1  leo 	ZS_WRITE(zc, 11, reg[11]);
   1009  1.1  leo 	ZS_WRITE(zc, 12, reg[12]);
   1010  1.1  leo 	ZS_WRITE(zc, 13, reg[13]);
   1011  1.1  leo 	ZS_WRITE(zc, 14, reg[14]);
   1012  1.1  leo 	ZS_WRITE(zc, 15, reg[15]);
   1013  1.1  leo 	ZS_WRITE(zc,  3, reg[3]);
   1014  1.1  leo 	ZS_WRITE(zc,  5, reg[5]);
   1015  1.1  leo }
   1016  1.1  leo #endif /* NZS > 1 */
   1017