Home | History | Annotate | Line # | Download | only in ic
cy.c revision 1.53
      1 /*	$NetBSD: cy.c,v 1.53 2007/11/07 15:56:14 ad Exp $	*/
      2 
      3 /*
      4  * cy.c
      5  *
      6  * Driver for Cyclades Cyclom-8/16/32 multiport serial cards
      7  * (currently not tested with Cyclom-32 cards)
      8  *
      9  * Timo Rossi, 1996
     10  *
     11  * Supports both ISA and PCI Cyclom cards
     12  *
     13  * Lots of debug output can be enabled by defining CY_DEBUG
     14  * Some debugging counters (number of receive/transmit interrupts etc.)
     15  * can be enabled by defining CY_DEBUG1
     16  */
     17 
     18 #include <sys/cdefs.h>
     19 __KERNEL_RCSID(0, "$NetBSD: cy.c,v 1.53 2007/11/07 15:56:14 ad Exp $");
     20 
     21 #include <sys/param.h>
     22 #include <sys/ioctl.h>
     23 #include <sys/syslog.h>
     24 #include <sys/fcntl.h>
     25 #include <sys/tty.h>
     26 #include <sys/proc.h>
     27 #include <sys/conf.h>
     28 #include <sys/user.h>
     29 #include <sys/select.h>
     30 #include <sys/device.h>
     31 #include <sys/malloc.h>
     32 #include <sys/systm.h>
     33 #include <sys/callout.h>
     34 #include <sys/kauth.h>
     35 
     36 #include <sys/bus.h>
     37 
     38 #include <dev/ic/cd1400reg.h>
     39 #include <dev/ic/cyreg.h>
     40 #include <dev/ic/cyvar.h>
     41 
     42 int	cyparam(struct tty *, struct termios *);
     43 void	cystart(struct tty *);
     44 void	cy_poll(void *);
     45 int	cy_modem_control(struct cy_softc *, struct cy_port *, int, int);
     46 void	cy_enable_transmitter(struct cy_softc *, struct cy_port *);
     47 void	cd1400_channel_cmd(struct cy_softc *, struct cy_port *, int);
     48 int	cy_speed(speed_t, int *, int *, int);
     49 
     50 extern struct cfdriver cy_cd;
     51 
     52 dev_type_open(cyopen);
     53 dev_type_close(cyclose);
     54 dev_type_read(cyread);
     55 dev_type_write(cywrite);
     56 dev_type_ioctl(cyioctl);
     57 dev_type_stop(cystop);
     58 dev_type_tty(cytty);
     59 dev_type_poll(cypoll);
     60 
     61 const struct cdevsw cy_cdevsw = {
     62 	cyopen, cyclose, cyread, cywrite, cyioctl,
     63 	cystop, cytty, cypoll, nommap, ttykqfilter, D_TTY
     64 };
     65 
     66 static int      cy_open = 0;
     67 static int      cy_events = 0;
     68 
     69 int	cy_attached_ttys;
     70 bool	cy_callout_init;
     71 callout_t cy_poll_callout;
     72 
     73 /*
     74  * Common probe routine
     75  */
     76 int
     77 cy_find(struct cy_softc *sc)
     78 {
     79 	int cy_chip, chip;
     80 	u_char firmware_ver;
     81 	bus_space_tag_t tag = sc->sc_memt;
     82 	bus_space_handle_t bsh = sc->sc_bsh;
     83 	int bustype = sc->sc_bustype;
     84 
     85 	/* Cyclom card hardware reset */
     86 	bus_space_write_1(tag, bsh, CY16_RESET << bustype, 0);
     87 	DELAY(500);		/* wait for reset to complete */
     88 	bus_space_write_1(tag, bsh, CY_CLEAR_INTR << bustype, 0);
     89 
     90 #ifdef CY_DEBUG
     91 	printf("cy: card reset done\n");
     92 #endif
     93 	sc->sc_nchips = 0;
     94 
     95 	for (cy_chip = 0, chip = 0; cy_chip < CY_MAX_CD1400s;
     96 	    cy_chip++, chip += (CY_CD1400_MEMSPACING << bustype)) {
     97 		int i;
     98 
     99 		/*
    100 		 * the last 4 nchips are 'interleaved' with the first 4 on
    101 		 * 32-port boards
    102 		 */
    103 		if (cy_chip == 4)
    104 			chip -= (CY32_ADDR_FIX << bustype);
    105 
    106 #ifdef CY_DEBUG
    107 		printf("%s probe chip %d offset 0x%x ... ",
    108 		    sc->sc_dev.dv_xname, cy_chip, chip);
    109 #endif
    110 
    111 		/* wait until the chip is ready for command */
    112 		DELAY(1000);
    113 		if (bus_space_read_1(tag, bsh, chip +
    114 		    ((CD1400_CCR << 1) << bustype)) != 0) {
    115 #ifdef CY_DEBUG
    116 			printf("not ready for command\n");
    117 #endif
    118 			break;
    119 		}
    120 		/* clear the firmware version reg. */
    121 		bus_space_write_1(tag, bsh, chip +
    122 		    ((CD1400_GFRCR << 1) << bustype), 0);
    123 
    124 		/*
    125 	         * On Cyclom-16 references to non-existent chip 4
    126 	         * actually access chip 0 (address line 9 not decoded).
    127 	         * Here we check if the clearing of chip 4 GFRCR actually
    128 	         * cleared chip 0 GFRCR. In that case we have a 16 port card.
    129 	         */
    130 		if (cy_chip == 4 &&
    131 		    bus_space_read_1(tag, bsh, /* off for chip 0 (0) + */
    132 		       ((CD1400_GFRCR << 1) << bustype)) == 0)
    133 			break;
    134 
    135 		/* reset the chip */
    136 		bus_space_write_1(tag, bsh, chip +
    137 		    ((CD1400_CCR << 1) << bustype),
    138 		    CD1400_CCR_CMDRESET | CD1400_CCR_FULLRESET);
    139 
    140 		/* wait for the chip to initialize itself */
    141 		for (i = 0; i < 200; i++) {
    142 			DELAY(50);
    143 			firmware_ver = bus_space_read_1(tag, bsh, chip +
    144 			    ((CD1400_GFRCR << 1) << bustype));
    145 			if ((firmware_ver & 0xf0) == 0x40) /* found a CD1400 */
    146 				break;
    147 		}
    148 #ifdef CY_DEBUG
    149 		printf("firmware version 0x%x\n", firmware_ver);
    150 #endif
    151 
    152 		if ((firmware_ver & 0xf0) != 0x40)
    153 			break;
    154 
    155 		/* firmware version OK, CD1400 found */
    156 		sc->sc_nchips++;
    157 	}
    158 
    159 	if (sc->sc_nchips == 0) {
    160 #ifdef CY_DEBUG
    161 		printf("no CD1400s found\n");
    162 #endif
    163 		return 0;
    164 	}
    165 #ifdef CY_DEBUG
    166 	printf("found %d CD1400s\n", sc->sc_nchips);
    167 #endif
    168 
    169 	return 1;
    170 }
    171 
    172 void
    173 cy_attach(struct cy_softc *sc)
    174 {
    175 	int port, cy_chip, num_chips, cdu, chip;
    176 	int cy_clock;
    177 
    178 	if (!cy_callout_init) {
    179 		cy_callout_init = true;
    180 		callout_init(&cy_poll_callout, 0);
    181 	}
    182 
    183 	num_chips = sc->sc_nchips;
    184 	if (num_chips == 0)
    185 		return;
    186 
    187 	memset(sc->sc_ports, 0, sizeof(sc->sc_ports));
    188 
    189 	port = 0;
    190 	for (cy_chip = 0, chip = 0; cy_chip < num_chips; cy_chip++,
    191 	    chip += (CY_CD1400_MEMSPACING << sc->sc_bustype)) {
    192 
    193 		if (cy_chip == 4)
    194 			chip -= (CY32_ADDR_FIX << sc->sc_bustype);
    195 
    196 #ifdef CY_DEBUG
    197 		aprint_debug("attach CD1400 #%d offset 0x%x\n", cy_chip, chip);
    198 #endif
    199 		sc->sc_cd1400_offs[cy_chip] = chip;
    200 
    201 		/*
    202 		 * configure port 0 as serial port (should already be after
    203 		 * reset)
    204 		 */
    205 		cd_write_reg(sc, cy_chip, CD1400_GCR, 0);
    206 
    207 		if (cd_read_reg(sc, cy_chip, CD1400_GFRCR) <= 0x46)
    208 			cy_clock = CY_CLOCK;
    209 		else
    210 			cy_clock = CY_CLOCK_60;
    211 
    212 		/* set up a receive timeout period (1ms) */
    213 		cd_write_reg(sc, cy_chip, CD1400_PPR,
    214 		    (cy_clock / CD1400_PPR_PRESCALER / 1000) + 1);
    215 
    216 		for (cdu = 0; cdu < CD1400_NO_OF_CHANNELS; cdu++) {
    217 			sc->sc_ports[port].cy_softc = sc;
    218 			sc->sc_ports[port].cy_port_num = port;
    219 			sc->sc_ports[port].cy_chip = cy_chip;
    220 			sc->sc_ports[port].cy_clock = cy_clock;
    221 
    222 			/* should we initialize anything else here? */
    223 			port++;
    224 		} /* for(each port on one CD1400...) */
    225 
    226 	} /* for(each CD1400 on a card... ) */
    227 
    228 	sc->sc_nchannels = port;
    229 
    230 	aprint_normal("%s: %d channels (ttyCY%03d..ttyCY%03d)\n",
    231 	    sc->sc_dev.dv_xname, sc->sc_nchannels, cy_attached_ttys,
    232 	    cy_attached_ttys + (sc->sc_nchannels - 1));
    233 
    234 	cy_attached_ttys += sc->sc_nchannels;
    235 
    236 	/* ensure an edge for the next interrupt */
    237 	bus_space_write_1(sc->sc_memt, sc->sc_bsh,
    238 	    CY_CLEAR_INTR << sc->sc_bustype, 0);
    239 }
    240 
    241 #define	CYDIALOUT_MASK		0x80000
    242 #define	CY_DIALOUT(dev)		(minor(dev) & CYDIALOUT_MASK)
    243 
    244 #define	CY_PORT(dev)		cy_getport((dev))
    245 #define	CY_BOARD(cy)		((cy)->cy_softc)
    246 
    247 static struct cy_port *
    248 cy_getport(dev_t dev)
    249 {
    250 	int i, j, k, u = minor(dev) & ~CYDIALOUT_MASK;
    251 	struct cy_softc *sc;
    252 
    253 	for (i = 0, j = 0; i < cy_cd.cd_ndevs; i++) {
    254 		k = j;
    255 		sc = device_lookup(&cy_cd, i);
    256 		if (sc == NULL)
    257 			continue;
    258 		if (sc->sc_nchannels == 0)
    259 			continue;
    260 		j += sc->sc_nchannels;
    261 		if (j > u)
    262 			return (&sc->sc_ports[u - k]);
    263 	}
    264 
    265 	return (NULL);
    266 }
    267 
    268 /*
    269  * open routine. returns zero if successful, else error code
    270  */
    271 int
    272 cyopen(dev_t dev, int flag, int mode, struct lwp *l)
    273 {
    274 	struct cy_softc *sc;
    275 	struct cy_port *cy;
    276 	struct tty *tp;
    277 	int s, error;
    278 
    279 	cy = CY_PORT(dev);
    280 	if (cy == NULL)
    281 		return (ENXIO);
    282 	sc = CY_BOARD(cy);
    283 
    284 	s = spltty();
    285 	if (cy->cy_tty == NULL) {
    286 		if ((cy->cy_tty = ttymalloc()) == NULL) {
    287 			splx(s);
    288 			printf("%s: port %d: can't allocate tty\n",
    289 			    sc->sc_dev.dv_xname, cy->cy_port_num);
    290 			return (ENOMEM);
    291 		}
    292 		tty_attach(cy->cy_tty);
    293 	}
    294 	splx(s);
    295 
    296 	tp = cy->cy_tty;
    297 	tp->t_oproc = cystart;
    298 	tp->t_param = cyparam;
    299 	tp->t_dev = dev;
    300 
    301 	if (kauth_authorize_device_tty(l->l_cred, KAUTH_DEVICE_TTY_OPEN, tp))
    302 		return (EBUSY);
    303 
    304 	if (!ISSET(tp->t_state, TS_ISOPEN) && tp->t_wopen == 0) {
    305 		ttychars(tp);
    306 		tp->t_iflag = TTYDEF_IFLAG;
    307 		tp->t_oflag = TTYDEF_OFLAG;
    308 		tp->t_cflag = TTYDEF_CFLAG;
    309 		if (ISSET(cy->cy_openflags, TIOCFLAG_CLOCAL))
    310 			SET(tp->t_cflag, CLOCAL);
    311 		if (ISSET(cy->cy_openflags, TIOCFLAG_CRTSCTS))
    312 			SET(tp->t_cflag, CRTSCTS);
    313 		if (ISSET(cy->cy_openflags, TIOCFLAG_MDMBUF))
    314 			SET(tp->t_cflag, MDMBUF);
    315 		tp->t_lflag = TTYDEF_LFLAG;
    316 		tp->t_ispeed = tp->t_ospeed = TTYDEF_SPEED;
    317 
    318 		s = spltty();
    319 
    320 		/*
    321 		 * Allocate input ring buffer if we don't already have one
    322 		 */
    323 		if (cy->cy_ibuf == NULL) {
    324 			cy->cy_ibuf = malloc(CY_IBUF_SIZE, M_DEVBUF, M_NOWAIT);
    325 			if (cy->cy_ibuf == NULL) {
    326 				printf("%s: port %d: can't allocate input buffer\n",
    327 				       sc->sc_dev.dv_xname, cy->cy_port_num);
    328 				splx(s);
    329 				return ENOMEM;
    330 			}
    331 			cy->cy_ibuf_end = cy->cy_ibuf + CY_IBUF_SIZE;
    332 		}
    333 		/* mark the ring buffer as empty */
    334 		cy->cy_ibuf_rd_ptr = cy->cy_ibuf_wr_ptr = cy->cy_ibuf;
    335 
    336 		/* select CD1400 channel */
    337 		cd_write_reg(sc, cy->cy_chip, CD1400_CAR,
    338 		    cy->cy_port_num & CD1400_CAR_CHAN);
    339 		/* reset the channel */
    340 		cd1400_channel_cmd(sc, cy, CD1400_CCR_CMDRESET);
    341 		/* encode unit (port) number in LIVR */
    342 		/* there is just enough space for 5 bits (32 ports) */
    343 		cd_write_reg(sc, cy->cy_chip, CD1400_LIVR,
    344 		    cy->cy_port_num << 3);
    345 
    346 		cy->cy_channel_control = 0;
    347 
    348 		/* hmm... need spltty() here? */
    349 		if (cy_open == 0) {
    350 			cy_open = 1;
    351 			callout_reset(&cy_poll_callout, 1, cy_poll, NULL);
    352 		}
    353 		/* this sets parameters and raises DTR */
    354 		cyparam(tp, &tp->t_termios);
    355 
    356 		ttsetwater(tp);
    357 
    358 		/* raise RTS too */
    359 		cy_modem_control(sc, cy, TIOCM_RTS, DMBIS);
    360 
    361 		cy->cy_carrier_stat =
    362 			cd_read_reg(sc, cy->cy_chip, CD1400_MSVR2);
    363 
    364 		/* enable receiver and modem change interrupts */
    365 		cd_write_reg(sc, cy->cy_chip, CD1400_SRER,
    366 		    CD1400_SRER_MDMCH | CD1400_SRER_RXDATA);
    367 
    368 		if (CY_DIALOUT(dev) ||
    369 		    ISSET(cy->cy_openflags, TIOCFLAG_SOFTCAR) ||
    370 		    ISSET(tp->t_cflag, MDMBUF) ||
    371 		    ISSET(cy->cy_carrier_stat, CD1400_MSVR2_CD))
    372 			SET(tp->t_state, TS_CARR_ON);
    373 		else
    374 			CLR(tp->t_state, TS_CARR_ON);
    375 		splx(s);
    376 	}
    377 
    378 	/* wait for carrier if necessary */
    379 	if (!ISSET(flag, O_NONBLOCK)) {
    380 		mutex_spin_enter(&tty_lock);
    381 		while (!ISSET(tp->t_cflag, CLOCAL) &&
    382 		    !ISSET(tp->t_state, TS_CARR_ON)) {
    383 			tp->t_wopen++;
    384 			error = ttysleep(tp, &tp->t_rawq.c_cv, true, 0);
    385 			tp->t_wopen--;
    386 			if (error != 0) {
    387 				mutex_spin_exit(&tty_lock);
    388 				return error;
    389 			}
    390 		}
    391 		mutex_spin_exit(&tty_lock);
    392 	}
    393 
    394 	return (*tp->t_linesw->l_open) (dev, tp);
    395 }
    396 
    397 /*
    398  * close routine. returns zero if successful, else error code
    399  */
    400 int
    401 cyclose(dev_t dev, int flag, int mode, struct lwp *l)
    402 {
    403 	struct cy_softc *sc;
    404 	struct cy_port *cy;
    405 	struct tty *tp;
    406 	int s;
    407 
    408 	cy = CY_PORT(dev);
    409 	sc = CY_BOARD(cy);
    410 	tp = cy->cy_tty;
    411 
    412 	(*tp->t_linesw->l_close) (tp, flag);
    413 	s = spltty();
    414 
    415 	if (ISSET(tp->t_cflag, HUPCL) &&
    416 	    !ISSET(cy->cy_openflags, TIOCFLAG_SOFTCAR)) {
    417 		/*
    418 		 * drop DTR and RTS (should we wait for output buffer to
    419 		 * become empty first?)
    420 		 */
    421 		cy_modem_control(sc, cy, 0, DMSET);
    422 	}
    423 	/*
    424 	 * XXX should we disable modem change and
    425 	 * receive interrupts here or somewhere ?
    426 	 */
    427 	CLR(tp->t_state, TS_BUSY | TS_FLUSH);
    428 
    429 	splx(s);
    430 	ttyclose(tp);
    431 
    432 	return 0;
    433 }
    434 
    435 /*
    436  * Read routine
    437  */
    438 int
    439 cyread(dev_t dev, struct uio *uio, int flag)
    440 {
    441 	struct cy_port *cy;
    442 	struct tty *tp;
    443 
    444 	cy = CY_PORT(dev);
    445 	tp = cy->cy_tty;
    446 
    447 	return ((*tp->t_linesw->l_read)(tp, uio, flag));
    448 }
    449 
    450 /*
    451  * Write routine
    452  */
    453 int
    454 cywrite(dev_t dev, struct uio *uio, int flag)
    455 {
    456 	struct cy_port *cy;
    457 	struct tty *tp;
    458 
    459 	cy = CY_PORT(dev);
    460 	tp = cy->cy_tty;
    461 
    462 	return ((*tp->t_linesw->l_write)(tp, uio, flag));
    463 }
    464 
    465 /*
    466  * Poll routine
    467  */
    468 int
    469 cypoll(dev_t dev, int events, struct lwp *l)
    470 {
    471 	struct cy_port *cy;
    472 	struct tty *tp;
    473 
    474 	cy = CY_PORT(dev);
    475 	tp = cy->cy_tty;
    476 
    477 	return ((*tp->t_linesw->l_poll)(tp, events, l));
    478 }
    479 
    480 /*
    481  * return tty pointer
    482  */
    483 struct tty *
    484 cytty(dev_t dev)
    485 {
    486 	struct cy_port *cy;
    487 
    488 	cy = CY_PORT(dev);
    489 
    490 	return (cy->cy_tty);
    491 }
    492 
    493 /*
    494  * ioctl routine
    495  */
    496 int
    497 cyioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
    498 {
    499 	struct cy_softc *sc;
    500 	struct cy_port *cy;
    501 	struct tty *tp;
    502 	int error;
    503 
    504 	cy = CY_PORT(dev);
    505 	sc = CY_BOARD(cy);
    506 	tp = cy->cy_tty;
    507 
    508 	error = (*tp->t_linesw->l_ioctl)(tp, cmd, data, flag, l);
    509 	if (error != EPASSTHROUGH)
    510 		return error;
    511 
    512 	error = ttioctl(tp, cmd, data, flag, l);
    513 	if (error != EPASSTHROUGH)
    514 		return error;
    515 
    516 	/* XXX should not allow dropping DTR when dialin? */
    517 
    518 	switch (cmd) {
    519 	case TIOCSBRK:		/* start break */
    520 		SET(cy->cy_flags, CY_F_START_BREAK);
    521 		cy_enable_transmitter(sc, cy);
    522 		break;
    523 
    524 	case TIOCCBRK:		/* stop break */
    525 		SET(cy->cy_flags, CY_F_END_BREAK);
    526 		cy_enable_transmitter(sc, cy);
    527 		break;
    528 
    529 	case TIOCSDTR:		/* DTR on */
    530 		cy_modem_control(sc, cy, TIOCM_DTR, DMBIS);
    531 		break;
    532 
    533 	case TIOCCDTR:		/* DTR off */
    534 		cy_modem_control(sc, cy, TIOCM_DTR, DMBIC);
    535 		break;
    536 
    537 	case TIOCMSET:		/* set new modem control line values */
    538 		cy_modem_control(sc, cy, *((int *) data), DMSET);
    539 		break;
    540 
    541 	case TIOCMBIS:		/* turn modem control bits on */
    542 		cy_modem_control(sc, cy, *((int *) data), DMBIS);
    543 		break;
    544 
    545 	case TIOCMBIC:		/* turn modem control bits off */
    546 		cy_modem_control(sc, cy, *((int *) data), DMBIC);
    547 		break;
    548 
    549 	case TIOCMGET:		/* get modem control/status line state */
    550 		*((int *) data) = cy_modem_control(sc, cy, 0, DMGET);
    551 		break;
    552 
    553 	case TIOCGFLAGS:
    554 		*((int *) data) = cy->cy_openflags |
    555 			(CY_DIALOUT(dev) ? TIOCFLAG_SOFTCAR : 0);
    556 		break;
    557 
    558 	case TIOCSFLAGS:
    559 		error = kauth_authorize_device_tty(l->l_cred,
    560 		    KAUTH_DEVICE_TTY_PRIVSET, tp);
    561 		if (error != 0)
    562 			return EPERM;
    563 
    564 		cy->cy_openflags = *((int *) data) &
    565 		    (TIOCFLAG_SOFTCAR | TIOCFLAG_CLOCAL |
    566 		     TIOCFLAG_CRTSCTS | TIOCFLAG_MDMBUF);
    567 		break;
    568 
    569 	default:
    570 		return EPASSTHROUGH;
    571 	}
    572 
    573 	return 0;
    574 }
    575 
    576 /*
    577  * start output
    578  */
    579 void
    580 cystart(struct tty *tp)
    581 {
    582 	struct cy_softc *sc;
    583 	struct cy_port *cy;
    584 	int s;
    585 
    586 	cy = CY_PORT(tp->t_dev);
    587 	sc = cy->cy_softc;
    588 
    589 	s = spltty();
    590 
    591 #ifdef CY_DEBUG1
    592 	cy->cy_start_count++;
    593 #endif
    594 
    595 	if (!ISSET(tp->t_state, TS_TTSTOP | TS_TIMEOUT | TS_BUSY)) {
    596 		if (tp->t_outq.c_cc <= tp->t_lowat) {
    597 			if (ISSET(tp->t_state, TS_ASLEEP)) {
    598 				CLR(tp->t_state, TS_ASLEEP);
    599 				wakeup(&tp->t_outq);
    600 			}
    601 			selwakeup(&tp->t_wsel);
    602 
    603 			if (tp->t_outq.c_cc == 0)
    604 				goto out;
    605 		}
    606 		SET(tp->t_state, TS_BUSY);
    607 		cy_enable_transmitter(sc, cy);
    608 	}
    609 out:
    610 
    611 	splx(s);
    612 }
    613 
    614 /*
    615  * stop output
    616  */
    617 void
    618 cystop(struct tty *tp, int flag)
    619 {
    620 	struct cy_port *cy;
    621 	int s;
    622 
    623 	cy = CY_PORT(tp->t_dev);
    624 
    625 	s = spltty();
    626 	if (ISSET(tp->t_state, TS_BUSY)) {
    627 		if (!ISSET(tp->t_state, TS_TTSTOP))
    628 			SET(tp->t_state, TS_FLUSH);
    629 
    630 		/*
    631 		 * the transmit interrupt routine will disable transmit when it
    632 		 * notices that CY_F_STOP has been set.
    633 		 */
    634 		SET(cy->cy_flags, CY_F_STOP);
    635 	}
    636 	splx(s);
    637 }
    638 
    639 /*
    640  * parameter setting routine.
    641  * returns 0 if successful, else returns error code
    642  */
    643 int
    644 cyparam(struct tty *tp, struct termios *t)
    645 {
    646 	struct cy_softc *sc;
    647 	struct cy_port *cy;
    648 	int ibpr = 0, obpr = 0, i_clk_opt = 0, o_clk_opt = 0;	/* XXX: GCC */
    649 	int s, opt;
    650 
    651 	cy = CY_PORT(tp->t_dev);
    652 	sc = CY_BOARD(cy);
    653 
    654 	if (t->c_ospeed != 0 && cy_speed(t->c_ospeed, &o_clk_opt, &obpr, cy->cy_clock) < 0)
    655 		return EINVAL;
    656 
    657 	if (t->c_ispeed != 0 && cy_speed(t->c_ispeed, &i_clk_opt, &ibpr, cy->cy_clock) < 0)
    658 		return EINVAL;
    659 
    660 	s = spltty();
    661 
    662 	/* hang up the line is ospeed is zero, else turn DTR on */
    663 	cy_modem_control(sc, cy, TIOCM_DTR, (t->c_ospeed == 0 ? DMBIC : DMBIS));
    664 
    665 	/* channel was selected by the above call to cy_modem_control() */
    666 #if 0
    667 	cd_write_reg(sc, cy->cy_chip, CD1400_CAR, port & CD1400_CAR_CHAN);
    668 #endif
    669 
    670 	/* set transmit speed */
    671 	if (t->c_ospeed != 0) {
    672 		cd_write_reg(sc, cy->cy_chip, CD1400_TCOR, o_clk_opt);
    673 		cd_write_reg(sc, cy->cy_chip, CD1400_TBPR, obpr);
    674 	}
    675 	/* set receive speed */
    676 	if (t->c_ispeed != 0) {
    677 		cd_write_reg(sc, cy->cy_chip, CD1400_RCOR, i_clk_opt);
    678 		cd_write_reg(sc, cy->cy_chip, CD1400_RBPR, ibpr);
    679 	}
    680 	opt = CD1400_CCR_CMDCHANCTL | CD1400_CCR_XMTEN
    681 		| (ISSET(t->c_cflag, CREAD) ? CD1400_CCR_RCVEN : CD1400_CCR_RCVDIS);
    682 
    683 	if (opt != cy->cy_channel_control) {
    684 		cy->cy_channel_control = opt;
    685 		cd1400_channel_cmd(sc, cy, opt);
    686 	}
    687 	/* compute COR1 contents */
    688 	opt = 0;
    689 	if (ISSET(t->c_cflag, PARENB)) {
    690 		if (ISSET(t->c_cflag, PARODD))
    691 			opt |= CD1400_COR1_PARODD;
    692 		opt |= CD1400_COR1_PARNORMAL;
    693 	}
    694 	if (!ISSET(t->c_iflag, INPCK))
    695 		opt |= CD1400_COR1_NOINPCK;	/* no parity checking */
    696 
    697 	if (ISSET(t->c_cflag, CSTOPB))
    698 		opt |= CD1400_COR1_STOP2;
    699 
    700 	switch (t->c_cflag & CSIZE) {
    701 	case CS5:
    702 		opt |= CD1400_COR1_CS5;
    703 		break;
    704 
    705 	case CS6:
    706 		opt |= CD1400_COR1_CS6;
    707 		break;
    708 
    709 	case CS7:
    710 		opt |= CD1400_COR1_CS7;
    711 		break;
    712 
    713 	default:
    714 		opt |= CD1400_COR1_CS8;
    715 		break;
    716 	}
    717 
    718 	cd_write_reg(sc, cy->cy_chip, CD1400_COR1, opt);
    719 
    720 #ifdef CY_DEBUG
    721 	printf("cor1 = 0x%x...", opt);
    722 #endif
    723 
    724 	/*
    725 	 * use the CD1400 automatic CTS flow control if CRTSCTS is set
    726 	 *
    727 	 * CD1400_COR2_ETC is used because breaks are generated with
    728 	 * embedded transmit commands
    729 	 */
    730 	cd_write_reg(sc, cy->cy_chip, CD1400_COR2,
    731 		     CD1400_COR2_ETC |
    732 		 (ISSET(t->c_cflag, CRTSCTS) ? CD1400_COR2_CCTS_OFLOW : 0));
    733 
    734 	cd_write_reg(sc, cy->cy_chip, CD1400_COR3, CY_RX_FIFO_THRESHOLD);
    735 
    736 	cd1400_channel_cmd(sc, cy, CD1400_CCR_CMDCORCHG |
    737 	    CD1400_CCR_COR1 | CD1400_CCR_COR2 | CD1400_CCR_COR3);
    738 
    739 	cd_write_reg(sc, cy->cy_chip, CD1400_COR4, CD1400_COR4_PFO_EXCEPTION);
    740 	cd_write_reg(sc, cy->cy_chip, CD1400_COR5, 0);
    741 
    742 	/*
    743          * set modem change option registers to generate interrupts
    744          * on carrier detect changes.
    745          *
    746          * if hardware RTS handshaking is used
    747          * also set the handshaking threshold.
    748          */
    749 	if (cy->cy_clock == CY_CLOCK_60) {
    750 	   cd_write_reg(sc, cy->cy_chip, CD1400_MCOR1, CD1400_MCOR1_CDzd |
    751     	      (ISSET(t->c_cflag, CRTSCTS) ? CY_RX_DTR_THRESHOLD : 0));
    752 	} else {
    753 	   cd_write_reg(sc, cy->cy_chip, CD1400_MCOR1, CD1400_MCOR1_CDzd);
    754 	}
    755 
    756 	cd_write_reg(sc, cy->cy_chip, CD1400_MCOR2, CD1400_MCOR2_CDod);
    757 
    758 	/*
    759          * set receive timeout to approx. 2ms
    760          * could use more complex logic here...
    761          * (but is it actually needed or even useful?)
    762          */
    763 	cd_write_reg(sc, cy->cy_chip, CD1400_RTPR, 2);
    764 
    765 	/*
    766          * should do anything else here?
    767          * XXX check MDMBUF handshaking like in com.c?
    768          */
    769 
    770 	splx(s);
    771 	return 0;
    772 }
    773 
    774 /*
    775  * set/get modem line status
    776  *
    777  * bits can be: TIOCM_DTR, TIOCM_RTS, TIOCM_CTS, TIOCM_CD, TIOCM_RI, TIOCM_DSR
    778  */
    779 int
    780 cy_modem_control(struct cy_softc *sc, struct cy_port *cy, int bits, int howto)
    781 {
    782 	struct tty *tp = cy->cy_tty;
    783 	int s, msvr;
    784 
    785 	s = spltty();
    786 
    787 	/* select channel */
    788 	cd_write_reg(sc, cy->cy_chip, CD1400_CAR,
    789 	    cy->cy_port_num & CD1400_CAR_CHAN);
    790 
    791 	/* Does not manipulate RTS if it is used for flow control. */
    792 	switch (howto) {
    793 	case DMGET:
    794 		bits = 0;
    795 		if (cy->cy_channel_control & CD1400_CCR_RCVEN)
    796 			bits |= TIOCM_LE;
    797 		msvr = cd_read_reg(sc, cy->cy_chip, CD1400_MSVR2);
    798 		if (cy->cy_clock == CY_CLOCK_60) {
    799 			if (cd_read_reg(sc, cy->cy_chip, CD1400_MSVR1) &
    800 		    		CD1400_MSVR1_RTS)
    801 				bits |= TIOCM_DTR;
    802 			if (msvr & CD1400_MSVR2_DTR)
    803 				bits |= TIOCM_RTS;
    804 		} else {
    805 			if (cd_read_reg(sc, cy->cy_chip, CD1400_MSVR1) &
    806 			    CD1400_MSVR1_RTS)
    807 				bits |= TIOCM_RTS;
    808 			if (msvr & CD1400_MSVR2_DTR)
    809 				bits |= TIOCM_DTR;
    810 		}
    811 		if (msvr & CD1400_MSVR2_CTS)
    812 			bits |= TIOCM_CTS;
    813 		if (msvr & CD1400_MSVR2_CD)
    814 			bits |= TIOCM_CD;
    815 		/* Not connected on some Cyclom-Y boards? */
    816 		if (msvr & CD1400_MSVR2_DSR)
    817 			bits |= TIOCM_DSR;
    818 		/* Not connected on some Cyclom-8Y boards? */
    819 		if (msvr & CD1400_MSVR2_RI)
    820 			bits |= TIOCM_RI;
    821 		break;
    822 
    823 	case DMSET:		/* replace old values with new ones */
    824 		if (cy->cy_clock == CY_CLOCK_60) {
    825 			if (!ISSET(tp->t_cflag, CRTSCTS))
    826 				cd_write_reg(sc, cy->cy_chip, CD1400_MSVR2,
    827 				   ((bits & TIOCM_RTS) ? CD1400_MSVR2_DTR : 0));
    828 			cd_write_reg(sc, cy->cy_chip, CD1400_MSVR1,
    829 			    ((bits & TIOCM_DTR) ? CD1400_MSVR1_RTS : 0));
    830 		} else {
    831 			if (!ISSET(tp->t_cflag, CRTSCTS))
    832 				cd_write_reg(sc, cy->cy_chip, CD1400_MSVR1,
    833 				   ((bits & TIOCM_RTS) ? CD1400_MSVR1_RTS : 0));
    834 			cd_write_reg(sc, cy->cy_chip, CD1400_MSVR2,
    835 			    ((bits & TIOCM_DTR) ? CD1400_MSVR2_DTR : 0));
    836 		}
    837 		break;
    838 
    839 	case DMBIS:		/* set bits */
    840 		if (cy->cy_clock == CY_CLOCK_60) {
    841 			if (!ISSET(tp->t_cflag, CRTSCTS) &&
    842 			    (bits & TIOCM_RTS) != 0)
    843 				cd_write_reg(sc, cy->cy_chip, CD1400_MSVR2,
    844 				    CD1400_MSVR2_DTR);
    845 			if (bits & TIOCM_DTR)
    846 				cd_write_reg(sc, cy->cy_chip, CD1400_MSVR1,
    847 				    CD1400_MSVR1_RTS);
    848 		} else {
    849 			if (!ISSET(tp->t_cflag, CRTSCTS) &&
    850 			    (bits & TIOCM_RTS) != 0)
    851 				cd_write_reg(sc, cy->cy_chip, CD1400_MSVR1,
    852 				    CD1400_MSVR1_RTS);
    853 			if (bits & TIOCM_DTR)
    854 				cd_write_reg(sc, cy->cy_chip, CD1400_MSVR2,
    855 				    CD1400_MSVR2_DTR);
    856 		}
    857 		break;
    858 
    859 	case DMBIC:		/* clear bits */
    860 		if (cy->cy_clock == CY_CLOCK_60) {
    861 			if (!ISSET(tp->t_cflag, CRTSCTS) && (bits & TIOCM_RTS))
    862 				cd_write_reg(sc, cy->cy_chip, CD1400_MSVR2, 0);
    863 			if (bits & TIOCM_DTR)
    864 				cd_write_reg(sc, cy->cy_chip, CD1400_MSVR1, 0);
    865 		} else {
    866 			if (!ISSET(tp->t_cflag, CRTSCTS) && (bits & TIOCM_RTS))
    867 				cd_write_reg(sc, cy->cy_chip, CD1400_MSVR1, 0);
    868 			if (bits & TIOCM_DTR)
    869 				cd_write_reg(sc, cy->cy_chip, CD1400_MSVR2, 0);
    870 		}
    871 		break;
    872 	}
    873 	splx(s);
    874 	return ((howto == DMGET) ? bits : 0);
    875 }
    876 
    877 /*
    878  * Upper-level handler loop (called from timer interrupt?)
    879  * This routine is common for multiple cards
    880  */
    881 void
    882 cy_poll(void *arg)
    883 {
    884 	int card, port;
    885 	struct cy_softc *sc;
    886 	struct cy_port *cy;
    887 	struct tty *tp;
    888 	static int counter = 0;
    889 #ifdef CY_DEBUG1
    890 	int did_something;
    891 #endif
    892 	int s = spltty();
    893 
    894 	if (cy_events == 0 && ++counter < 200) {
    895 		splx(s);
    896 		goto out;
    897 	}
    898 	cy_events = 0;
    899 	splx(s);
    900 
    901 	for (card = 0; card < cy_cd.cd_ndevs; card++) {
    902 		sc = device_lookup(&cy_cd, card);
    903 		if (sc == NULL)
    904 			continue;
    905 
    906 #ifdef CY_DEBUG1
    907 		sc->sc_poll_count1++;
    908 		did_something = 0;
    909 #endif
    910 
    911 		for (port = 0; port < sc->sc_nchannels; port++) {
    912 			cy = &sc->sc_ports[port];
    913 			if ((tp = cy->cy_tty) == NULL || cy->cy_ibuf == NULL ||
    914 			    (!ISSET(tp->t_state, TS_ISOPEN) && tp->t_wopen == 0))
    915 				continue;
    916 
    917 			/*
    918 		         * handle received data
    919 		         */
    920 			while (cy->cy_ibuf_rd_ptr != cy->cy_ibuf_wr_ptr) {
    921 				u_char line_stat;
    922 				int chr;
    923 
    924 				line_stat = cy->cy_ibuf_rd_ptr[0];
    925 				chr = cy->cy_ibuf_rd_ptr[1];
    926 
    927 				if (line_stat &
    928 				    (CD1400_RDSR_BREAK | CD1400_RDSR_FE))
    929 					chr |= TTY_FE;
    930 				if (line_stat & CD1400_RDSR_PE)
    931 					chr |= TTY_PE;
    932 
    933 				/*
    934 				 * on an overrun error the data is treated as
    935 				 * good just as it should be.
    936 				 */
    937 
    938 #ifdef CY_DEBUG
    939 				printf("%s: port %d ttyinput 0x%x\n",
    940 				    sc->sc_dev.dv_xname, port, chr);
    941 #endif
    942 
    943 				(*tp->t_linesw->l_rint) (chr, tp);
    944 
    945 				s = spltty();	/* really necessary? */
    946 				if ((cy->cy_ibuf_rd_ptr += 2) ==
    947 				    cy->cy_ibuf_end)
    948 					cy->cy_ibuf_rd_ptr = cy->cy_ibuf;
    949 				splx(s);
    950 
    951 #ifdef CY_DEBUG1
    952 				did_something = 1;
    953 #endif
    954 			}
    955 
    956 			/*
    957 			 * If we don't have any received data in ibuf and
    958 			 * CRTSCTS is on and RTS is turned off, it is time to
    959 			 * turn RTS back on
    960 			 */
    961 			if (ISSET(tp->t_cflag, CRTSCTS)) {
    962 				/*
    963 				 * we can't use cy_modem_control() here as it
    964 				 * doesn't change RTS if RTSCTS is on
    965 				 */
    966 				cd_write_reg(sc, cy->cy_chip, CD1400_CAR,
    967 				    port & CD1400_CAR_CHAN);
    968 
    969 				if (cy->cy_clock == CY_CLOCK_60) {
    970 				  if ((cd_read_reg(sc, cy->cy_chip,
    971 				    CD1400_MSVR2) & CD1400_MSVR2_DTR) == 0) {
    972 					cd_write_reg(sc, cy->cy_chip,
    973 					CD1400_MSVR2,CD1400_MSVR2_DTR);
    974 #ifdef CY_DEBUG1
    975 					did_something = 1;
    976 #endif
    977 				  }
    978 				} else {
    979 				  if ((cd_read_reg(sc, cy->cy_chip,
    980 				    CD1400_MSVR1) & CD1400_MSVR1_RTS) == 0) {
    981 					cd_write_reg(sc, cy->cy_chip,
    982 					CD1400_MSVR1,CD1400_MSVR1_RTS);
    983 #ifdef CY_DEBUG1
    984 					did_something = 1;
    985 #endif
    986 				  }
    987 				}
    988 			}
    989 
    990 			/*
    991 		         * handle carrier changes
    992 		         */
    993 			s = spltty();
    994 			if (ISSET(cy->cy_flags, CY_F_CARRIER_CHANGED)) {
    995 				int             carrier;
    996 
    997 				CLR(cy->cy_flags, CY_F_CARRIER_CHANGED);
    998 				splx(s);
    999 
   1000 				carrier = ((cy->cy_carrier_stat &
   1001 				    CD1400_MSVR2_CD) != 0);
   1002 
   1003 #ifdef CY_DEBUG
   1004 				printf("cy_poll: carrier change "
   1005 				    "(card %d, port %d, carrier %d)\n",
   1006 				    card, port, carrier);
   1007 #endif
   1008 				if (CY_DIALOUT(tp->t_dev) == 0 &&
   1009 				    !(*tp->t_linesw->l_modem)(tp, carrier))
   1010 					cy_modem_control(sc, cy,
   1011 					    TIOCM_DTR, DMBIC);
   1012 
   1013 #ifdef CY_DEBUG1
   1014 				did_something = 1;
   1015 #endif
   1016 			} else
   1017 				splx(s);
   1018 
   1019 			s = spltty();
   1020 			if (ISSET(cy->cy_flags, CY_F_START)) {
   1021 				CLR(cy->cy_flags, CY_F_START);
   1022 				splx(s);
   1023 
   1024 				(*tp->t_linesw->l_start) (tp);
   1025 
   1026 #ifdef CY_DEBUG1
   1027 				did_something = 1;
   1028 #endif
   1029 			} else
   1030 				splx(s);
   1031 
   1032 			/* could move this to even upper level... */
   1033 			if (cy->cy_fifo_overruns) {
   1034 				cy->cy_fifo_overruns = 0;
   1035 				/*
   1036 				 * doesn't report overrun count, but
   1037 				 * shouldn't really matter
   1038 				 */
   1039 				log(LOG_WARNING, "%s: port %d fifo overrun\n",
   1040 				    sc->sc_dev.dv_xname, port);
   1041 			}
   1042 			if (cy->cy_ibuf_overruns) {
   1043 				cy->cy_ibuf_overruns = 0;
   1044 				log(LOG_WARNING, "%s: port %d ibuf overrun\n",
   1045 				    sc->sc_dev.dv_xname, port);
   1046 			}
   1047 		}		/* for(port...) */
   1048 #ifdef CY_DEBUG1
   1049 		if (did_something && counter >= 200)
   1050 			sc->sc_poll_count2++;
   1051 #endif
   1052 	} /* for(card...) */
   1053 
   1054 	counter = 0;
   1055 
   1056 out:
   1057 	callout_reset(&cy_poll_callout, 1, cy_poll, NULL);
   1058 }
   1059 
   1060 /*
   1061  * hardware interrupt routine
   1062  */
   1063 int
   1064 cy_intr(void *arg)
   1065 {
   1066 	struct cy_softc *sc = arg;
   1067 	struct cy_port *cy;
   1068 	int cy_chip, stat;
   1069 	int int_serviced = 0;
   1070 
   1071 	/*
   1072 	 * Check interrupt status of each CD1400 chip on this card
   1073 	 * (multiple cards cannot share the same interrupt)
   1074 	 */
   1075 	for (cy_chip = 0; cy_chip < sc->sc_nchips; cy_chip++) {
   1076 
   1077 		stat = cd_read_reg(sc, cy_chip, CD1400_SVRR);
   1078 		if (stat == 0)
   1079 			continue;
   1080 
   1081 		if (ISSET(stat, CD1400_SVRR_RXRDY)) {
   1082 			u_char save_car, save_rir, serv_type;
   1083 			u_char line_stat, recv_data, n_chars;
   1084 			u_char *buf_p;
   1085 
   1086 			save_rir = cd_read_reg(sc, cy_chip, CD1400_RIR);
   1087 			save_car = cd_read_reg(sc, cy_chip, CD1400_CAR);
   1088 			/* enter rx service */
   1089 			cd_write_reg(sc, cy_chip, CD1400_CAR, save_rir);
   1090 
   1091 			serv_type = cd_read_reg(sc, cy_chip, CD1400_RIVR);
   1092 			cy = &sc->sc_ports[serv_type >> 3];
   1093 
   1094 #ifdef CY_DEBUG1
   1095 			cy->cy_rx_int_count++;
   1096 #endif
   1097 
   1098 			buf_p = cy->cy_ibuf_wr_ptr;
   1099 
   1100 			if (ISSET(serv_type, CD1400_RIVR_EXCEPTION)) {
   1101 				line_stat = cd_read_reg(sc, cy->cy_chip,
   1102 				    CD1400_RDSR);
   1103 				recv_data = cd_read_reg(sc, cy->cy_chip,
   1104 				    CD1400_RDSR);
   1105 
   1106 				if (cy->cy_tty == NULL ||
   1107 				    !ISSET(cy->cy_tty->t_state, TS_ISOPEN))
   1108 					goto end_rx_serv;
   1109 
   1110 #ifdef CY_DEBUG
   1111 				printf("%s port %d recv exception, line_stat 0x%x, char 0x%x\n",
   1112 				sc->sc_dev.dv_xname, cy->cy_port_num, line_stat, recv_data);
   1113 #endif
   1114 				if (ISSET(line_stat, CD1400_RDSR_OE))
   1115 					cy->cy_fifo_overruns++;
   1116 
   1117 				*buf_p++ = line_stat;
   1118 				*buf_p++ = recv_data;
   1119 				if (buf_p == cy->cy_ibuf_end)
   1120 					buf_p = cy->cy_ibuf;
   1121 
   1122 				if (buf_p == cy->cy_ibuf_rd_ptr) {
   1123 					if (buf_p == cy->cy_ibuf)
   1124 						buf_p = cy->cy_ibuf_end;
   1125 					buf_p -= 2;
   1126 					cy->cy_ibuf_overruns++;
   1127 				}
   1128 				cy_events = 1;
   1129 			} else {/* no exception, received data OK */
   1130 				n_chars = cd_read_reg(sc, cy->cy_chip,
   1131 				    CD1400_RDCR);
   1132 
   1133 				/* If no tty or not open, discard data */
   1134 				if (cy->cy_tty == NULL ||
   1135 				    !ISSET(cy->cy_tty->t_state, TS_ISOPEN)) {
   1136 					while (n_chars--)
   1137 						(void)cd_read_reg(sc,
   1138 						    cy->cy_chip, CD1400_RDSR);
   1139 					goto end_rx_serv;
   1140 				}
   1141 
   1142 #ifdef CY_DEBUG
   1143 				printf("%s port %d receive ok %d chars\n",
   1144 				    sc->sc_dev.dv_xname, cy->cy_port_num, n_chars);
   1145 #endif
   1146 				while (n_chars--) {
   1147 					*buf_p++ = 0;	/* status: OK */
   1148 					/* data byte */
   1149 					*buf_p++ = cd_read_reg(sc,
   1150 					    cy->cy_chip, CD1400_RDSR);
   1151 					if (buf_p == cy->cy_ibuf_end)
   1152 						buf_p = cy->cy_ibuf;
   1153 					if (buf_p == cy->cy_ibuf_rd_ptr) {
   1154 						if (buf_p == cy->cy_ibuf)
   1155 							buf_p = cy->cy_ibuf_end;
   1156 						buf_p -= 2;
   1157 						cy->cy_ibuf_overruns++;
   1158 						break;
   1159 					}
   1160 				}
   1161 				cy_events = 1;
   1162 			}
   1163 
   1164 			cy->cy_ibuf_wr_ptr = buf_p;
   1165 
   1166 			/* RTS handshaking for incoming data */
   1167 			if (ISSET(cy->cy_tty->t_cflag, CRTSCTS)) {
   1168 				int bf, msvr;
   1169 
   1170 				bf = buf_p - cy->cy_ibuf_rd_ptr;
   1171 				if (bf < 0)
   1172 					bf += CY_IBUF_SIZE;
   1173 
   1174 				if (bf > (CY_IBUF_SIZE / 2)) {
   1175 					/* turn RTS off */
   1176 					if (cy->cy_clock == CY_CLOCK_60)
   1177 						msvr = CD1400_MSVR2;
   1178 					else
   1179 						msvr = CD1400_MSVR1;
   1180 					cd_write_reg(sc, cy->cy_chip, msvr, 0);
   1181 				}
   1182 			}
   1183 
   1184 	end_rx_serv:
   1185 			/* terminate service context */
   1186 			cd_write_reg(sc, cy->cy_chip, CD1400_RIR,
   1187 				     save_rir & 0x3f);
   1188 			cd_write_reg(sc, cy->cy_chip, CD1400_CAR, save_car);
   1189 			int_serviced = 1;
   1190 		} /* if (rx_service...) */
   1191 		if (ISSET(stat, CD1400_SVRR_MDMCH)) {
   1192 			u_char save_car, save_mir, serv_type, modem_stat;
   1193 
   1194 			save_mir = cd_read_reg(sc, cy_chip, CD1400_MIR);
   1195 			save_car = cd_read_reg(sc, cy_chip, CD1400_CAR);
   1196 			/* enter modem service */
   1197 			cd_write_reg(sc, cy_chip, CD1400_CAR, save_mir);
   1198 
   1199 			serv_type = cd_read_reg(sc, cy_chip, CD1400_MIVR);
   1200 			cy = &sc->sc_ports[serv_type >> 3];
   1201 
   1202 #ifdef CY_DEBUG1
   1203 			cy->cy_modem_int_count++;
   1204 #endif
   1205 
   1206 			modem_stat = cd_read_reg(sc, cy->cy_chip, CD1400_MSVR2);
   1207 
   1208 #ifdef CY_DEBUG
   1209 			printf("%s port %d modem line change, new stat 0x%x\n",
   1210 			       sc->sc_dev.dv_xname, cy->cy_port_num, modem_stat);
   1211 #endif
   1212 			if (ISSET((cy->cy_carrier_stat ^ modem_stat), CD1400_MSVR2_CD)) {
   1213 				SET(cy->cy_flags, CY_F_CARRIER_CHANGED);
   1214 				cy_events = 1;
   1215 			}
   1216 			cy->cy_carrier_stat = modem_stat;
   1217 
   1218 			/* terminate service context */
   1219 			cd_write_reg(sc, cy->cy_chip, CD1400_MIR, save_mir & 0x3f);
   1220 			cd_write_reg(sc, cy->cy_chip, CD1400_CAR, save_car);
   1221 			int_serviced = 1;
   1222 		} /* if (modem_service...) */
   1223 		if (ISSET(stat, CD1400_SVRR_TXRDY)) {
   1224 			u_char          save_car, save_tir, serv_type,
   1225 			                count, ch;
   1226 			struct tty     *tp;
   1227 
   1228 			save_tir = cd_read_reg(sc, cy_chip, CD1400_TIR);
   1229 			save_car = cd_read_reg(sc, cy_chip, CD1400_CAR);
   1230 			/* enter tx service */
   1231 			cd_write_reg(sc, cy_chip, CD1400_CAR, save_tir);
   1232 
   1233 			serv_type = cd_read_reg(sc, cy_chip, CD1400_TIVR);
   1234 			cy = &sc->sc_ports[serv_type >> 3];
   1235 
   1236 #ifdef CY_DEBUG1
   1237 			cy->cy_tx_int_count++;
   1238 #endif
   1239 #ifdef CY_DEBUG
   1240 			printf("%s port %d tx service\n", sc->sc_dev.dv_xname,
   1241 			    cy->cy_port_num);
   1242 #endif
   1243 
   1244 			/* stop transmitting if no tty or CY_F_STOP set */
   1245 			tp = cy->cy_tty;
   1246 			if (tp == NULL || ISSET(cy->cy_flags, CY_F_STOP))
   1247 				goto txdone;
   1248 
   1249 			count = 0;
   1250 			if (ISSET(cy->cy_flags, CY_F_SEND_NUL)) {
   1251 				cd_write_reg(sc, cy->cy_chip, CD1400_TDR, 0);
   1252 				cd_write_reg(sc, cy->cy_chip, CD1400_TDR, 0);
   1253 				count += 2;
   1254 				CLR(cy->cy_flags, CY_F_SEND_NUL);
   1255 			}
   1256 			if (tp->t_outq.c_cc > 0) {
   1257 				SET(tp->t_state, TS_BUSY);
   1258 				while (tp->t_outq.c_cc > 0 &&
   1259 				    count < CD1400_TX_FIFO_SIZE) {
   1260 					ch = getc(&tp->t_outq);
   1261 					/*
   1262 					 * remember to double NUL characters
   1263 					 * because embedded transmit commands
   1264 					 * are enabled
   1265 					 */
   1266 					if (ch == 0) {
   1267 						if (count >= CD1400_TX_FIFO_SIZE - 2) {
   1268 							SET(cy->cy_flags, CY_F_SEND_NUL);
   1269 							break;
   1270 						}
   1271 						cd_write_reg(sc, cy->cy_chip,
   1272 						    CD1400_TDR, ch);
   1273 						count++;
   1274 					}
   1275 					cd_write_reg(sc, cy->cy_chip,
   1276 					    CD1400_TDR, ch);
   1277 					count++;
   1278 				}
   1279 			} else {
   1280 				/*
   1281 				 * no data to send -- check if we should
   1282 				 * start/stop a break
   1283 				 */
   1284 				/*
   1285 				 * XXX does this cause too much delay before
   1286 				 * breaks?
   1287 				 */
   1288 				if (ISSET(cy->cy_flags, CY_F_START_BREAK)) {
   1289 					cd_write_reg(sc, cy->cy_chip,
   1290 					    CD1400_TDR, 0);
   1291 					cd_write_reg(sc, cy->cy_chip,
   1292 					    CD1400_TDR, 0x81);
   1293 					CLR(cy->cy_flags, CY_F_START_BREAK);
   1294 				}
   1295 				if (ISSET(cy->cy_flags, CY_F_END_BREAK)) {
   1296 					cd_write_reg(sc, cy->cy_chip,
   1297 					    CD1400_TDR, 0);
   1298 					cd_write_reg(sc, cy->cy_chip,
   1299 					    CD1400_TDR, 0x83);
   1300 					CLR(cy->cy_flags, CY_F_END_BREAK);
   1301 				}
   1302 			}
   1303 
   1304 			if (tp->t_outq.c_cc == 0) {
   1305 		txdone:
   1306 				/*
   1307 				 * No data to send or requested to stop.
   1308 				 * Disable transmit interrupt
   1309 				 */
   1310 				cd_write_reg(sc, cy->cy_chip, CD1400_SRER,
   1311 				     cd_read_reg(sc, cy->cy_chip, CD1400_SRER)
   1312 				     & ~CD1400_SRER_TXRDY);
   1313 				CLR(cy->cy_flags, CY_F_STOP);
   1314 				CLR(tp->t_state, TS_BUSY);
   1315 			}
   1316 			if (tp->t_outq.c_cc <= tp->t_lowat) {
   1317 				SET(cy->cy_flags, CY_F_START);
   1318 				cy_events = 1;
   1319 			}
   1320 			/* terminate service context */
   1321 			cd_write_reg(sc, cy->cy_chip, CD1400_TIR, save_tir & 0x3f);
   1322 			cd_write_reg(sc, cy->cy_chip, CD1400_CAR, save_car);
   1323 			int_serviced = 1;
   1324 		}		/* if (tx_service...) */
   1325 	}			/* for(...all CD1400s on a card) */
   1326 
   1327 	/* ensure an edge for next interrupt */
   1328 	bus_space_write_1(sc->sc_memt, sc->sc_bsh,
   1329 			CY_CLEAR_INTR << sc->sc_bustype, 0);
   1330 	return int_serviced;
   1331 }
   1332 
   1333 /*
   1334  * subroutine to enable CD1400 transmitter
   1335  */
   1336 void
   1337 cy_enable_transmitter(struct cy_softc *sc, struct cy_port *cy)
   1338 {
   1339 	int s = spltty();
   1340 	cd_write_reg(sc, cy->cy_chip, CD1400_CAR,
   1341 	    cy->cy_port_num & CD1400_CAR_CHAN);
   1342 	cd_write_reg(sc, cy->cy_chip, CD1400_SRER,
   1343 	    cd_read_reg(sc, cy->cy_chip, CD1400_SRER) | CD1400_SRER_TXRDY);
   1344 	splx(s);
   1345 }
   1346 
   1347 /*
   1348  * Execute a CD1400 channel command
   1349  */
   1350 void
   1351 cd1400_channel_cmd(struct cy_softc *sc, struct cy_port *cy, int cmd)
   1352 {
   1353 	u_int waitcnt = 5 * 8 * 1024;	/* approx 5 ms */
   1354 
   1355 #ifdef CY_DEBUG
   1356 	printf("c1400_channel_cmd cy %p command 0x%x\n", cy, cmd);
   1357 #endif
   1358 
   1359 	/* wait until cd1400 is ready to process a new command */
   1360 	while (cd_read_reg(sc, cy->cy_chip, CD1400_CCR) != 0 && waitcnt-- > 0);
   1361 
   1362 	if (waitcnt == 0)
   1363 		log(LOG_ERR, "%s: channel command timeout\n",
   1364 		    sc->sc_dev.dv_xname);
   1365 
   1366 	cd_write_reg(sc, cy->cy_chip, CD1400_CCR, cmd);
   1367 }
   1368 
   1369 /*
   1370  * Compute clock option register and baud rate register values
   1371  * for a given speed. Return 0 on success, -1 on failure.
   1372  *
   1373  * The error between requested and actual speed seems
   1374  * to be well within allowed limits (less than 3%)
   1375  * with every speed value between 50 and 150000 bps.
   1376  */
   1377 int
   1378 cy_speed(speed_t speed, int *cor, int *bpr, int cy_clock)
   1379 {
   1380 	int c, co, br;
   1381 
   1382 	if (speed < 50 || speed > 150000)
   1383 		return -1;
   1384 
   1385 	for (c = 0, co = 8; co <= 2048; co <<= 2, c++) {
   1386 		br = (cy_clock + (co * speed) / 2) / (co * speed);
   1387 		if (br < 0x100) {
   1388 			*bpr = br;
   1389 			*cor = c;
   1390 			return 0;
   1391 		}
   1392 	}
   1393 
   1394 	return -1;
   1395 }
   1396