NetBSD/sys/dev/ic/cy.c

/*	$NetBSD: cy.c,v 1.6 1997/04/13 20:00:29 cgd Exp $	*/

/*
 * cy.c
 *
 * Driver for Cyclades Cyclom-8/16/32 multiport serial cards
 * (currently not tested with Cyclom-32 cards)
 *
 * Timo Rossi, 1996
 *
 * Supports both ISA and PCI Cyclom cards
 *
 * Uses CD1400 automatic CTS flow control, and
 * if CY_HW_RTS is defined, uses CD1400 automatic input flow control.
 * This requires a special cable that exchanges the RTS and DTR lines.
 *
 * Lots of debug output can be enabled by defining CY_DEBUG
 * Some debugging counters (number of receive/transmit interrupts etc.)
 * can be enabled by defining CY_DEBUG1
 */

#include <sys/types.h>
#include <sys/param.h>
#include <sys/ioctl.h>
#include <sys/syslog.h>
#include <sys/fcntl.h>
#include <sys/tty.h>
#include <sys/proc.h>
#include <sys/conf.h>
#include <sys/user.h>
#include <sys/ioctl.h>
#include <sys/select.h>
#include <sys/device.h>
#include <sys/malloc.h>
#include <sys/systm.h>

#include <machine/bus.h>

#include <dev/ic/cd1400reg.h>
#include <dev/ic/cyreg.h>
#include <dev/ic/cyvar.h>

/* Macros to clear/set/test flags. */
#define	SET(t, f)	(t) |= (f)
#define	CLR(t, f)	(t) &= ~(f)
#define	ISSET(t, f)	((t) & (f))

static int cyparam __P((struct tty *, struct termios *));
static void cystart __P((struct tty *));
static void cy_poll __P((void *));
static int cy_modem_control __P((struct cy_softc *,
    struct cy_port *, int, int));
static void cy_enable_transmitter __P((struct cy_softc *, struct cy_port *));
static void cd1400_channel_cmd __P((struct cy_softc *, struct cy_port *, int));
static int cy_speed __P((speed_t, int *, int *));

struct cfdriver cy_cd = {
	NULL, "cy", DV_TTY
};

static int      cy_open = 0;
static int      cy_events = 0;

cdev_decl(cy);

/*
 * Common probe routine
 */
int
cy_find(sc)
	struct cy_softc *sc;
{
	int cy_chip, chip;
	u_char firmware_ver;
	bus_space_tag_t tag = sc->sc_memt;
	bus_space_handle_t bsh = sc->sc_bsh;
	int bustype = sc->sc_bustype;

	/* Cyclom card hardware reset */
	bus_space_write_1(tag, bsh, CY16_RESET << bustype, 0);
	DELAY(500);		/* wait for reset to complete */
	bus_space_write_1(tag, bsh, CY_CLEAR_INTR << bustype, 0);

#ifdef CY_DEBUG
	printf("cy: card reset done\n");
#endif
	sc->sc_nchips = 0;

	for (cy_chip = 0, chip = 0; cy_chip < CY_MAX_CD1400s;
	    cy_chip++, chip += (CY_CD1400_MEMSPACING << bustype)) {
		int i;

		/*
		 * the last 4 nchips are 'interleaved' with the first 4 on
		 * 32-port boards
		 */
		if (cy_chip == 4)
			chip -= (CY32_ADDR_FIX << bustype);

#ifdef CY_DEBUG
		printf("%s probe chip %d offset 0x%lx ... ",
		    sc->sc_dev.dv_xname, cy_chip, chip);
#endif

		/* wait until the chip is ready for command */
		DELAY(1000);
		if (bus_space_read_1(tag, bsh, chip + 
		    ((CD1400_CCR << 1) << bustype)) != 0) {
#ifdef CY_DEBUG
			printf("not ready for command\n");
#endif
			break;
		}
		/* clear the firmware version reg. */
		bus_space_write_1(tag, bsh, chip +
		    ((CD1400_GFRCR << 1) << bustype), 0);

		/*
	         * On Cyclom-16 references to non-existent chip 4
	         * actually access chip 0 (address line 9 not decoded).
	         * Here we check if the clearing of chip 4 GFRCR actually
	         * cleared chip 0 GFRCR. In that case we have a 16 port card.
	         */
		if (cy_chip == 4 &&
		    bus_space_read_1(tag, bsh, chip +
		       ((CD1400_GFRCR << 1) << bustype)) == 0)
			break;

		/* reset the chip */
		bus_space_write_1(tag, bsh, chip +
		    ((CD1400_CCR << 1) << bustype),
		    CD1400_CCR_CMDRESET | CD1400_CCR_FULLRESET);

		/* wait for the chip to initialize itself */
		for (i = 0; i < 200; i++) {
			DELAY(50);
			firmware_ver = bus_space_read_1(tag, bsh, chip +
			    ((CD1400_GFRCR << 1) << bustype));
			if ((firmware_ver & 0xf0) == 0x40) /* found a CD1400 */
				break;
		}
#ifdef CY_DEBUG
		printf("firmware version 0x%x\n", firmware_ver);
#endif

		if ((firmware_ver & 0xf0) != 0x40)
			break;

		/* firmware version OK, CD1400 found */
		sc->sc_nchips++;
	}

	if (sc->sc_nchips == 0) {
#ifdef CY_DEBUG
		printf("no CD1400s found\n");
#endif
		return 0;
	}
#ifdef CY_DEBUG
	printf("found %d CD1400s\n", sc->sc_nchips);
#endif

	return 1;
}

void
cy_attach(parent, self, aux)
	struct device  *parent, *self;
	void *aux;
{
	int  port, cy_chip, num_chips, cdu, chip;
	struct cy_softc *sc = (void *) self;

	num_chips = sc->sc_nchips;
	if (num_chips == 0)
		return;

	bzero(sc->sc_ports, sizeof(sc->sc_ports));

	port = 0;
	for (cy_chip = 0, chip = 0; cy_chip < num_chips; cy_chip++,
	    chip += (CY_CD1400_MEMSPACING << sc->sc_bustype)) {

		if (cy_chip == 4)
			chip -= (CY32_ADDR_FIX << sc->sc_bustype);

#ifdef CY_DEBUG
		printf("attach CD1400 #%d offset 0x%x\n", cy_chip, chip);
#endif
		sc->sc_cd1400_offs[cy_chip] = chip;

		/*
		 * configure port 0 as serial port (should already be after
		 * reset)
		 */
		cd_write_reg(sc, cy_chip, CD1400_GCR, 0);

		/* set up a receive timeout period (1ms) */
		cd_write_reg(sc, cy_chip, CD1400_PPR,
		    (CY_CLOCK / CD1400_PPR_PRESCALER / 1000) + 1);

		for (cdu = 0; cdu < CD1400_NO_OF_CHANNELS; cdu++) {
			sc->sc_ports[port].cy_port_num = port;
			sc->sc_ports[port].cy_chip = chip;

			/* should we initialize anything else here? */
			port++;
		} /* for(each port on one CD1400...) */

	} /* for(each CD1400 on a card... ) */

	printf(": %d ports\n", port);

	/* ensure an edge for the next interrupt */
	bus_space_write_1(sc->sc_memt, sc->sc_bsh,
	    CY_CLEAR_INTR << sc->sc_bustype, 0);
}

/*
 * open routine. returns zero if successfull, else error code
 */
int
cyopen(dev, flag, mode, p)
	dev_t dev;
	int flag, mode;
	struct proc *p;
{
	int card = CY_CARD(dev);
	int port = CY_PORT(dev);
	struct cy_softc *sc;
	struct cy_port *cy;
	struct tty *tp;
	int s, error;

#ifdef CY_DEBUG
	printf("cy%d open port %d flag 0x%x mode 0x%x\n",
	    card, port, flag, mode);
#endif

	if (card >= cy_cd.cd_ndevs || (sc = cy_cd.cd_devs[card]) == NULL)
		return ENXIO;

	cy = &sc->sc_ports[port];

	s = spltty();
	if (cy->cy_tty == NULL) {
		if ((cy->cy_tty = ttymalloc()) == NULL) {
			splx(s);
			printf("cy%d: port %d: can't allocate tty\n",
			    card, port);
			return ENOMEM;
		}
		tty_attach(cy->cy_tty);
	}
	splx(s);

	tp = cy->cy_tty;
	tp->t_oproc = cystart;
	tp->t_param = cyparam;
	tp->t_dev = dev;

	if (!ISSET(tp->t_state, TS_ISOPEN)) {
		SET(tp->t_state, TS_WOPEN);
		ttychars(tp);
		tp->t_iflag = TTYDEF_IFLAG;
		tp->t_oflag = TTYDEF_OFLAG;
		tp->t_cflag = TTYDEF_CFLAG;
		if (ISSET(cy->cy_openflags, TIOCFLAG_CLOCAL))
			SET(tp->t_cflag, CLOCAL);
		if (ISSET(cy->cy_openflags, TIOCFLAG_CRTSCTS))
			SET(tp->t_cflag, CRTSCTS);
		if (ISSET(cy->cy_openflags, TIOCFLAG_MDMBUF))
			SET(tp->t_cflag, MDMBUF);
		tp->t_lflag = TTYDEF_LFLAG;
		tp->t_ispeed = tp->t_ospeed = TTYDEF_SPEED;

		s = spltty();

		/*
		 * Allocate input ring buffer if we don't already have one
		 */
		if (cy->cy_ibuf == NULL) {
			cy->cy_ibuf = malloc(CY_IBUF_SIZE, M_DEVBUF, M_NOWAIT);
			if (cy->cy_ibuf == NULL) {
				printf("%s: port %d: can't allocate input buffer\n",
				       sc->sc_dev.dv_xname, port);
				splx(s);
				return ENOMEM;
			}
			cy->cy_ibuf_end = cy->cy_ibuf + CY_IBUF_SIZE;
		}
		/* mark the ring buffer as empty */
		cy->cy_ibuf_rd_ptr = cy->cy_ibuf_wr_ptr = cy->cy_ibuf;

		/* select CD1400 channel */
		cd_write_reg(sc, cy->cy_chip, CD1400_CAR,
		    port & CD1400_CAR_CHAN);
		/* reset the channel */
		cd1400_channel_cmd(sc, cy, CD1400_CCR_CMDRESET);
		/* encode unit (port) number in LIVR */
		/* there is just enough space for 5 bits (32 ports) */
		cd_write_reg(sc, cy->cy_chip, CD1400_LIVR, port << 3);

		cy->cy_channel_control = 0;

		/* hmm... need spltty() here? */
		if (cy_open == 0) {
			cy_open = 1;
			timeout(cy_poll, NULL, 1);
		}
		/* this sets parameters and raises DTR */
		cyparam(tp, &tp->t_termios);

		ttsetwater(tp);

		/* raise RTS too */
		cy_modem_control(sc, cy, TIOCM_RTS, DMBIS);

		cy->cy_carrier_stat =
			cd_read_reg(sc, cy->cy_chip, CD1400_MSVR2);

		/* enable receiver and modem change interrupts */
		cd_write_reg(sc, cy->cy_chip, CD1400_SRER,
		    CD1400_SRER_MDMCH | CD1400_SRER_RXDATA);

		if (CY_DIALOUT(dev) ||
		    ISSET(cy->cy_openflags, TIOCFLAG_SOFTCAR) ||
		    ISSET(tp->t_cflag, MDMBUF) ||
		    ISSET(cy->cy_carrier_stat, CD1400_MSVR2_CD))
			SET(tp->t_state, TS_CARR_ON);
		else
			CLR(tp->t_state, TS_CARR_ON);
	} else if (ISSET(tp->t_state, TS_XCLUDE) && p->p_ucred->cr_uid != 0) {
		return EBUSY;
	} else {
		s = spltty();
	}

	/* wait for carrier if necessary */
	if (!ISSET(flag, O_NONBLOCK)) {
		while (!ISSET(tp->t_cflag, CLOCAL) &&
		    !ISSET(tp->t_state, TS_CARR_ON)) {
			SET(tp->t_state, TS_WOPEN);
			error = ttysleep(tp, &tp->t_rawq, TTIPRI | PCATCH,
			    "cydcd", 0);
			if (error != 0) {
				splx(s);
				return error;
			}
		}
	}
	splx(s);

	return (*linesw[tp->t_line].l_open) (dev, tp);
}

/*
 * close routine. returns zero if successfull, else error code
 */
int
cyclose(dev, flag, mode, p)
	dev_t dev;
	int flag, mode;
	struct proc *p;
{
	int card = CY_CARD(dev);
	int port = CY_PORT(dev);
	struct cy_softc *sc = cy_cd.cd_devs[card];
	struct cy_port *cy = &sc->sc_ports[port];
	struct tty *tp = cy->cy_tty;
	int s;

#ifdef CY_DEBUG
	printf("%s: close port %d, flag 0x%x, mode 0x%x\n",
	    sc->sc_dev.dv_xname, port, flag, mode);
#endif

	(*linesw[tp->t_line].l_close) (tp, flag);
	s = spltty();

	if (ISSET(tp->t_cflag, HUPCL) &&
	    !ISSET(cy->cy_openflags, TIOCFLAG_SOFTCAR)) {
		/*
		 * drop DTR and RTS (should we wait for output buffer to
		 * become empty first?)
		 */
		cy_modem_control(sc, cy, 0, DMSET);
	}
	/*
	 * XXX should we disable modem change and
	 * receive interrupts here or somewhere ?
	 */
	CLR(tp->t_state, TS_BUSY | TS_FLUSH);

	splx(s);
	ttyclose(tp);

	return 0;
}

/*
 * Read routine
 */
int
cyread(dev, uio, flag)
	dev_t dev;
	struct uio *uio;
	int flag;
{
	int card = CY_CARD(dev);
	int port = CY_PORT(dev);
	struct cy_softc *sc = cy_cd.cd_devs[card];
	struct cy_port *cy = &sc->sc_ports[port];
	struct tty *tp = cy->cy_tty;

#ifdef CY_DEBUG
	printf("%s: read port %d uio 0x%x flag 0x%x\n",
	    sc->sc_dev.dv_xname, port, uio, flag);
#endif

	return ((*linesw[tp->t_line].l_read) (tp, uio, flag));
}

/*
 * Write routine
 */
int
cywrite(dev, uio, flag)
	dev_t dev;
	struct uio *uio;
	int flag;
{
	int card = CY_CARD(dev);
	int port = CY_PORT(dev);
	struct cy_softc *sc = cy_cd.cd_devs[card];
	struct cy_port *cy = &sc->sc_ports[port];
	struct tty *tp = cy->cy_tty;

#ifdef CY_DEBUG
	printf("%s: write port %d uio 0x%x flag 0x%x\n",
	    sc->sc_dev.dv_xname, port, uio, flag);
#endif

	return ((*linesw[tp->t_line].l_write) (tp, uio, flag));
}

/*
 * return tty pointer
 */
struct tty *
cytty(dev)
	dev_t dev;
{
	int card = CY_CARD(dev);
	int port = CY_PORT(dev);
	struct cy_softc *sc = cy_cd.cd_devs[card];
	struct cy_port *cy = &sc->sc_ports[port];
	struct tty *tp = cy->cy_tty;

#ifdef CY_DEBUG
	printf("%s: tty port %d tp 0x%x\n", sc->sc_dev.dv_xname, port, tp);
#endif
	return tp;
}

/*
 * ioctl routine
 */
int
cyioctl(dev, cmd, data, flag, p)
	dev_t dev;
	u_long cmd;
	caddr_t data;
	int flag;
	struct proc *p;
{
	int card = CY_CARD(dev);
	int port = CY_PORT(dev);
	struct cy_softc *sc = cy_cd.cd_devs[card];
	struct cy_port *cy = &sc->sc_ports[port];
	struct tty *tp = cy->cy_tty;
	int error;

#ifdef CY_DEBUG
	printf("%s: port %d ioctl cmd 0x%x data 0x%x flag 0x%x\n",
	    sc->sc_dev.dv_xname, port, cmd, data, flag);
#endif

	error = (*linesw[tp->t_line].l_ioctl) (tp, cmd, data, flag, p);
	if (error >= 0)
		return error;

	error = ttioctl(tp, cmd, data, flag, p);
	if (error >= 0)
		return error;

	/* XXX should not allow dropping DTR when dialin? */

	switch (cmd) {
	case TIOCSBRK:		/* start break */
		SET(cy->cy_flags, CY_F_START_BREAK);
		cy_enable_transmitter(sc, cy);
		break;

	case TIOCCBRK:		/* stop break */
		SET(cy->cy_flags, CY_F_END_BREAK);
		cy_enable_transmitter(sc, cy);
		break;

	case TIOCSDTR:		/* DTR on */
		cy_modem_control(sc, cy, TIOCM_DTR, DMBIS);
		break;

	case TIOCCDTR:		/* DTR off */
		cy_modem_control(sc, cy, TIOCM_DTR, DMBIC);
		break;

	case TIOCMSET:		/* set new modem control line values */
		cy_modem_control(sc, cy, *((int *) data), DMSET);
		break;

	case TIOCMBIS:		/* turn modem control bits on */
		cy_modem_control(sc, cy, *((int *) data), DMBIS);
		break;

	case TIOCMBIC:		/* turn modem control bits off */
		cy_modem_control(sc, cy, *((int *) data), DMBIC);
		break;

	case TIOCMGET:		/* get modem control/status line state */
		*((int *) data) = cy_modem_control(sc, cy, 0, DMGET);
		break;

	case TIOCGFLAGS:
		*((int *) data) = cy->cy_openflags |
			(CY_DIALOUT(dev) ? TIOCFLAG_SOFTCAR : 0);
		break;

	case TIOCSFLAGS:
		error = suser(p->p_ucred, &p->p_acflag);
		if (error != 0)
			return EPERM;

		cy->cy_openflags = *((int *) data) &
		    (TIOCFLAG_SOFTCAR | TIOCFLAG_CLOCAL |
		     TIOCFLAG_CRTSCTS | TIOCFLAG_MDMBUF);
		break;

	default:
		return ENOTTY;
	}

	return 0;
}

/*
 * start output
 */
void
cystart(tp)
	struct tty *tp;
{
	int card = CY_CARD(tp->t_dev);
	int port = CY_PORT(tp->t_dev);
	struct cy_softc *sc = cy_cd.cd_devs[card];
	struct cy_port *cy = &sc->sc_ports[port];
	int s;

#ifdef CY_DEBUG
	printf("%s: port %d start, tty 0x%x\n", sc->sc_dev.dv_xname, port, tp);
#endif


	s = spltty();

#ifdef CY_DEBUG1
	cy->cy_start_count++;
#endif

	if (!ISSET(tp->t_state, TS_TTSTOP | TS_TIMEOUT | TS_BUSY)) {
		if (tp->t_outq.c_cc <= tp->t_lowat) {
			if (ISSET(tp->t_state, TS_ASLEEP)) {
				CLR(tp->t_state, TS_ASLEEP);
				wakeup(&tp->t_outq);
			}
			selwakeup(&tp->t_wsel);

			if (tp->t_outq.c_cc == 0)
				goto out;
		}
		SET(tp->t_state, TS_BUSY);
		cy_enable_transmitter(sc, cy);
	}
out:

	splx(s);
}

/*
 * stop output
 */
void
cystop(tp, flag)
	struct tty *tp;
	int flag;
{
	int card = CY_CARD(tp->t_dev);
	int port = CY_PORT(tp->t_dev);
	struct cy_softc *sc = cy_cd.cd_devs[card];
	struct cy_port *cy = &sc->sc_ports[port];
	int s;

#ifdef CY_DEBUG
	printf("%s: port %d stop tty 0x%x flag 0x%x\n",
	    sc->sc_dev.dv_xname, port, tp, flag);
#endif

	s = spltty();

	if (ISSET(tp->t_state, TS_BUSY)) {
		if (!ISSET(tp->t_state, TS_TTSTOP))
			SET(tp->t_state, TS_FLUSH);

		/*
		 * the transmit interrupt routine will disable transmit when it
		 * notices that CY_F_STOP has been set.
		 */
		SET(cy->cy_flags, CY_F_STOP);
	}
	splx(s);
}

/*
 * parameter setting routine.
 * returns 0 if successfull, else returns error code
 */
static int
cyparam(tp, t)
	struct tty *tp;
	struct termios *t;
{
	int card = CY_CARD(tp->t_dev);
	int port = CY_PORT(tp->t_dev);
	struct cy_softc *sc = cy_cd.cd_devs[card];
	struct cy_port *cy = &sc->sc_ports[port];
	int ibpr, obpr, i_clk_opt, o_clk_opt;
	int s, opt;

#ifdef CY_DEBUG
	printf("%s: port %d param tty 0x%x termios 0x%x\n",
	    sc->sc_dev.dv_xname, port, tp, t);
	printf("ispeed %d ospeed %d\n", t->c_ispeed, t->c_ospeed);
#endif

	if (t->c_ospeed != 0 && cy_speed(t->c_ospeed, &o_clk_opt, &obpr) < 0)
		return EINVAL;

	if (t->c_ispeed != 0 && cy_speed(t->c_ispeed, &i_clk_opt, &ibpr) < 0)
		return EINVAL;

	s = spltty();

	/* hang up the line is ospeed is zero, else turn DTR on */
	cy_modem_control(sc, cy, TIOCM_DTR, (t->c_ospeed == 0 ? DMBIC : DMBIS));

	/* channel was selected by the above call to cy_modem_control() */
#if 0
	cd_write_reg(sc, cy->cy_chip, CD1400_CAR, port & CD1400_CAR_CHAN); 
#endif

	/* set transmit speed */
	if (t->c_ospeed != 0) {
		cd_write_reg(sc, cy->cy_chip, CD1400_TCOR, o_clk_opt);
		cd_write_reg(sc, cy->cy_chip, CD1400_TBPR, obpr);
	}
	/* set receive speed */
	if (t->c_ispeed != 0) {
		cd_write_reg(sc, cy->cy_chip, CD1400_RCOR, i_clk_opt);
		cd_write_reg(sc, cy->cy_chip, CD1400_RBPR, ibpr);
	}
	opt = CD1400_CCR_CMDCHANCTL | CD1400_CCR_XMTEN
		| (ISSET(t->c_cflag, CREAD) ? CD1400_CCR_RCVEN : CD1400_CCR_RCVDIS);

	if (opt != cy->cy_channel_control) {
		cy->cy_channel_control = opt;
		cd1400_channel_cmd(sc, cy, opt);
	}
	/* compute COR1 contents */
	opt = 0;
	if (ISSET(t->c_cflag, PARENB)) {
		if (ISSET(t->c_cflag, PARODD))
			opt |= CD1400_COR1_PARODD;
		opt |= CD1400_COR1_PARNORMAL;
	}
	if (!ISSET(t->c_iflag, INPCK))
		opt |= CD1400_COR1_NOINPCK;	/* no parity checking */

	if (ISSET(t->c_cflag, CSTOPB))
		opt |= CD1400_COR1_STOP2;

	switch (t->c_cflag & CSIZE) {
	case CS5:
		opt |= CD1400_COR1_CS5;
		break;

	case CS6:
		opt |= CD1400_COR1_CS6;
		break;

	case CS7:
		opt |= CD1400_COR1_CS7;
		break;

	default:
		opt |= CD1400_COR1_CS8;
		break;
	}

	cd_write_reg(sc, cy->cy_chip, CD1400_COR1, opt);

#ifdef CY_DEBUG
	printf("cor1 = 0x%x...", opt);
#endif

	/*
	 * use the CD1400 automatic CTS flow control if CRTSCTS is set
	 *
	 * CD1400_COR2_ETC is used because breaks are generated with
	 * embedded transmit commands
	 */
	cd_write_reg(sc, cy->cy_chip, CD1400_COR2,
		     CD1400_COR2_ETC |
		 (ISSET(t->c_cflag, CRTSCTS) ? CD1400_COR2_CCTS_OFLOW : 0));

	cd_write_reg(sc, cy->cy_chip, CD1400_COR3, CY_RX_FIFO_THRESHOLD);

	cd1400_channel_cmd(sc, cy, CD1400_CCR_CMDCORCHG |
	    CD1400_CCR_COR1 | CD1400_CCR_COR2 | CD1400_CCR_COR3);

	cd_write_reg(sc, cy->cy_chip, CD1400_COR4, CD1400_COR4_PFO_EXCEPTION);
	cd_write_reg(sc, cy->cy_chip, CD1400_COR5, 0);

	/*
         * set modem change option registers to generate interrupts
         * on carrier detect changes.
         *
         * if hardware RTS handshaking is used (CY_HW_RTS, DTR and RTS lines
         * exchanged), also set the handshaking threshold.
         */
#ifdef CY_HW_RTS
	cd_write_reg(sc, cy->cy_chip, CD1400_MCOR1, CD1400_MCOR1_CDzd |
		     (ISSET(t->c_cflag, CRTSCTS) ? RX_DTR_THRESHOLD : 0));
#else
	cd_write_reg(sc, cy->cy_chip, CD1400_MCOR1, CD1400_MCOR1_CDzd);
#endif				/* CY_HW_RTS */

	cd_write_reg(sc, cy->cy_chip, CD1400_MCOR2, CD1400_MCOR2_CDod);

	/*
         * set receive timeout to approx. 2ms
         * could use more complex logic here...
         * (but is it actually needed or even useful?)
         */
	cd_write_reg(sc, cy->cy_chip, CD1400_RTPR, 2);

	/*
         * should do anything else here?
         * XXX check MDMBUF handshaking like in com.c?
         */

	splx(s);
	return 0;
}

/*
 * set/get modem line status
 *
 * bits can be: TIOCM_DTR, TIOCM_RTS, TIOCM_CTS, TIOCM_CD, TIOCM_RI, TIOCM_DSR
 *
 * RTS and DTR are exchanged if CY_HW_RTS is set
 *
 */
static int
cy_modem_control(sc, cy, bits, howto)
	struct cy_softc *sc;
	struct cy_port *cy;
	int bits;
	int howto;
{
	int s, msvr;
	struct tty *tp = cy->cy_tty;

	s = spltty();

	/* select channel */
	cd_write_reg(sc, cy->cy_chip, CD1400_CAR,
	    cy->cy_port_num & CD1400_CAR_CHAN);

	/* does not manipulate RTS if it is used for flow control */
	switch (howto) {
	case DMGET:
		splx(s);
		bits = 0;
		if (cy->cy_channel_control & CD1400_CCR_RCVEN)
			bits |= TIOCM_LE;
		msvr = cd_read_reg(sc, cy->cy_chip, CD1400_MSVR2);
#ifdef CY_HW_RTS
		if (cd_read_reg(sc, cy->cy_chip, CD1400_MSVR1) &
		    CD1400_MSVR1_RTS)
			bits |= TIOCM_DTR;
		if (msvr & CD1400_MSVR2_DTR)
			bits |= TIOCM_RTS;
#else
		if (cd_read_reg(sc, cy->cy_chip, CD1400_MSVR1) &
		    CD1400_MSVR1_RTS)
			bits |= TIOCM_RTS;
		if (msvr & CD1400_MSVR2_DTR)
			bits |= TIOCM_DTR;
#endif				/* CY_HW_RTS */
		if (msvr & CD1400_MSVR2_CTS)
			bits |= TIOCM_CTS;
		if (msvr & CD1400_MSVR2_CD)
			bits |= TIOCM_CD;
		if (msvr & CD1400_MSVR2_DSR)	/* not connected on some
						 * Cyclom cards? */
			bits |= TIOCM_DSR;
		if (msvr & CD1400_MSVR2_RI)	/* not connected on Cyclom-8Y
						 * cards? */
			bits |= TIOCM_RI;
		splx(s);
		return bits;

	case DMSET:		/* replace old values with new ones */
#ifdef CY_HW_RTS
		if (!ISSET(tp->>t_cflag, CRTSCTS))
			cd_write_reg(sc, cy->cy_chip, CD1400_MSVR2,
			    ((bits & TIOCM_RTS) ? CD1400_MSVR2_DTR : 0));
		cd_write_reg(sc, cy->cy_chip, CD1400_MSVR1,
		    ((bits & TIOCM_DTR) ? CD1400_MSVR1_RTS : 0));
#else
		if (!ISSET(tp->t_cflag, CRTSCTS))
			cd_write_reg(sc, cy->cy_chip, CD1400_MSVR1,
			   ((bits & TIOCM_RTS) ? CD1400_MSVR1_RTS : 0));
		cd_write_reg(sc, cy->cy_chip, CD1400_MSVR2,
		    ((bits & TIOCM_DTR) ? CD1400_MSVR2_DTR : 0));
#endif /* CY_HW_RTS */
		break;

	case DMBIS:		/* set bits */
#ifdef CY_HW_RTS
		if (!ISSET(tp->t_cflag, CRTSCTS) && (bits & TIOCM_RTS) != 0)
			cd_write_reg(sc, cy->cy_chip, CD1400_MSVR2,
			    CD1400_MSVR2_DTR);
		if (bits & TIOCM_DTR)
			cd_write_reg(sc, cy->cy_chip, CD1400_MSVR1,
			    CD1400_MSVR1_RTS);
#else
		if (!ISSET(tp->t_cflag, CRTSCTS) && (bits & TIOCM_RTS) != 0)
			cd_write_reg(sc, cy->cy_chip, CD1400_MSVR1,
			    CD1400_MSVR1_RTS);
		if (bits & TIOCM_DTR)
			cd_write_reg(sc, cy->cy_chip, CD1400_MSVR2,
			    CD1400_MSVR2_DTR);
#endif /* CY_HW_RTS */
		break;

	case DMBIC:		/* clear bits */
#ifdef CY_HW_RTS
		if (!ISSET(tp->t_cflag, CRTSCTS) && (bits & TIOCM_RTS))
			cd_write_reg(sc, cy->cy_chip, CD1400_MSVR2, 0);
		if (bits & TIOCM_DTR)
			cd_write_reg(sc, cy->cy_chip, CD1400_MSVR1, 0);
#else
		if (!ISSET(tp->t_cflag, CRTSCTS) && (bits & TIOCM_RTS))
			cd_write_reg(sc, cy->cy_chip, CD1400_MSVR1, 0);
		if (bits & TIOCM_DTR)
			cd_write_reg(sc, cy->cy_chip, CD1400_MSVR2, 0);
#endif /* CY_HW_RTS */
		break;
	}
	splx(s);
	return 0;
}

/*
 * Upper-level handler loop (called from timer interrupt?)
 * This routine is common for multiple cards
 */
static void
cy_poll(arg)
	void *arg;
{
	int card, port;
	struct cy_softc *sc;
	struct cy_port *cy;
	struct tty *tp;
	static int counter = 0;
#ifdef CY_DEBUG1
	int did_something;
#endif
	int s = spltty();

	if (cy_events == 0 && ++counter < 200) {
		splx(s);
		goto out;
	}
	cy_events = 0;
	splx(s);

	for (card = 0; card < cy_cd.cd_ndevs; card++) {
		sc = cy_cd.cd_devs[card];
		if (sc == NULL)
			continue;

#ifdef CY_DEBUG1
		sc->sc_poll_count1++;
		did_something = 0;
#endif

		for (port = 0; port < sc->sc_nchips * CD1400_NO_OF_CHANNELS;
		    port++) {
			cy = &sc->sc_ports[port];
			if ((tp = cy->cy_tty) == NULL || cy->cy_ibuf == NULL ||
			    !ISSET(tp->t_state, TS_ISOPEN | TS_WOPEN))
				continue;

			/*
		         * handle received data
		         */
			while (cy->cy_ibuf_rd_ptr != cy->cy_ibuf_wr_ptr) {
				u_char line_stat;
				int chr;

				line_stat = cy->cy_ibuf_rd_ptr[0];
				chr = cy->cy_ibuf_rd_ptr[1];

				if (line_stat &
				    (CD1400_RDSR_BREAK | CD1400_RDSR_FE))
					chr |= TTY_FE;
				if (line_stat & CD1400_RDSR_PE)
					chr |= TTY_PE;

				/*
				 * on an overrun error the data is treated as
				 * good just as it should be.
				 */

#ifdef CY_DEBUG
				printf("%s: port %d ttyinput 0x%x\n",
				    sc->sc_dev.dv_xname, port, chr);
#endif

				(*linesw[tp->t_line].l_rint) (chr, tp);

				s = spltty();	/* really necessary? */
				if ((cy->cy_ibuf_rd_ptr += 2) ==
				    cy->cy_ibuf_end)
					cy->cy_ibuf_rd_ptr = cy->cy_ibuf;
				splx(s);

#ifdef CY_DEBUG1
				did_something = 1;
#endif
			}

#ifndef CY_HW_RTS
			/*
			 * If we don't have any received data in ibuf and
			 * CRTSCTS is on and RTS is turned off, it is time to
			 * turn RTS back on
			 */
			if (ISSET(tp->t_cflag, CRTSCTS)) {
				/*
				 * we can't use cy_modem_control() here as it
				 * doesn't change RTS if RTSCTS is on
				 */
				cd_write_reg(sc, cy->cy_chip, CD1400_CAR,
				    port & CD1400_CAR_CHAN);

				if ((cd_read_reg(sc, cy->cy_chip,
				    CD1400_MSVR1) & CD1400_MSVR1_RTS) == 0) {
					cd_write_reg(sc, cy->cy_chip, CD1400_MSVR1,
					    CD1400_MSVR1_RTS);
#ifdef CY_DEBUG1
					did_something = 1;
#endif
				}
			}
#endif /* CY_HW_RTS */

			/*
		         * handle carrier changes
		         */
			s = spltty();
			if (ISSET(cy->cy_flags, CY_F_CARRIER_CHANGED)) {
				int             carrier;

				CLR(cy->cy_flags, CY_F_CARRIER_CHANGED);
				splx(s);

				carrier = ((cy->cy_carrier_stat &
				    CD1400_MSVR2_CD) != 0);

#ifdef CY_DEBUG
				printf("cy_poll: carrier change "
				    "(card %d, port %d, carrier %d)\n",
				    card, port, carrier);
#endif
				if (CY_DIALIN(tp->t_dev) &&
				    !(*linesw[tp->t_line].l_modem)(tp, carrier))
					cy_modem_control(sc, cy,
					    TIOCM_DTR, DMBIC);

#ifdef CY_DEBUG1
				did_something = 1;
#endif
			} else 
				splx(s);

			s = spltty();
			if (ISSET(cy->cy_flags, CY_F_START)) {
				CLR(cy->cy_flags, CY_F_START);
				splx(s);

				(*linesw[tp->t_line].l_start) (tp);

#ifdef CY_DEBUG1
				did_something = 1;
#endif
			} else
				splx(s);

			/* could move this to even upper level... */
			if (cy->cy_fifo_overruns) {
				cy->cy_fifo_overruns = 0;
				/*
				 * doesn't report overrun count, but
				 * shouldn't really matter
				 */
				log(LOG_WARNING, "%s: port %d fifo overrun\n",
				    sc->sc_dev.dv_xname, port);
			}
			if (cy->cy_ibuf_overruns) {
				cy->cy_ibuf_overruns = 0;
				log(LOG_WARNING, "%s: port %d ibuf overrun\n",
				    sc->sc_dev.dv_xname, port);
			}
		}		/* for(port...) */
#ifdef CY_DEBUG1
		if (did_something && counter >= 200)
			sc->sc_poll_count2++;
#endif
	} /* for(card...) */

	counter = 0;

out:
	timeout(cy_poll, NULL, 1);
}

/*
 * hardware interrupt routine
 */
int
cy_intr(arg)
	void *arg;
{
	struct cy_softc *sc = arg;
	struct cy_port *cy;
	int cy_chip, stat;
	int int_serviced = 0;

	/*
	 * Check interrupt status of each CD1400 chip on this card
	 * (multiple cards cannot share the same interrupt)
	 */
	for (cy_chip = 0; cy_chip < sc->sc_nchips; cy_chip++) {

		stat = cd_read_reg(sc, cy_chip, CD1400_SVRR);
		if (stat == 0)
			continue;

		if (ISSET(stat, CD1400_SVRR_RXRDY)) {
			u_char save_car, save_rir, serv_type;
			u_char line_stat, recv_data, n_chars;
			u_char *buf_p;

			save_rir = cd_read_reg(sc, cy_chip, CD1400_RIR);
			save_car = cd_read_reg(sc, cy_chip, CD1400_CAR);
			/* enter rx service */
			cd_write_reg(sc, cy_chip, CD1400_CAR, save_rir);

			serv_type = cd_read_reg(sc, cy_chip, CD1400_RIVR);
			cy = &sc->sc_ports[serv_type >> 3];

#ifdef CY_DEBUG1
			cy->cy_rx_int_count++;
#endif

			if (cy->cy_tty == NULL ||
			    !ISSET(cy->cy_tty->t_state, TS_ISOPEN))
				goto end_rx_serv;

			buf_p = cy->cy_ibuf_wr_ptr;

			if (ISSET(serv_type, CD1400_RIVR_EXCEPTION)) {
				line_stat = cd_read_reg(sc, cy->cy_chip,
				    CD1400_RDSR);
				recv_data = cd_read_reg(sc, cy->cy_chip,
				    CD1400_RDSR);

#ifdef CY_DEBUG
				printf("cy%d port %d recv exception, line_stat 0x%x, char 0x%x\n",
				card, cy->cy_port_num, line_stat, recv_data);
#endif
				if (ISSET(line_stat, CD1400_RDSR_OE))
					cy->cy_fifo_overruns++;

				*buf_p++ = line_stat;
				*buf_p++ = recv_data;
				if (buf_p == cy->cy_ibuf_end)
					buf_p = cy->cy_ibuf;

				if (buf_p == cy->cy_ibuf_rd_ptr) {
					if (buf_p == cy->cy_ibuf)
						buf_p = cy->cy_ibuf_end;
					buf_p -= 2;
					cy->cy_ibuf_overruns++;
				}
				cy_events = 1;
			} else {/* no exception, received data OK */
				n_chars = cd_read_reg(sc, cy->cy_chip,
				    CD1400_RDCR);
#ifdef CY_DEBUG
				printf("cy%d port %d receive ok %d chars\n",
				    card, cy->cy_port_num, n_chars);
#endif
				while (n_chars--) {
					*buf_p++ = 0;	/* status: OK */
					/* data byte */
					*buf_p++ = cd_read_reg(sc,
					    cy->cy_chip, CD1400_RDSR);
					if (buf_p == cy->cy_ibuf_end)
						buf_p = cy->cy_ibuf;
					if (buf_p == cy->cy_ibuf_rd_ptr) {
						if (buf_p == cy->cy_ibuf)
							buf_p = cy->cy_ibuf_end;
						buf_p -= 2;
						cy->cy_ibuf_overruns++;
						break;
					}
				}
				cy_events = 1;
			}

			cy->cy_ibuf_wr_ptr = buf_p;

#ifndef CY_HW_RTS
			/* RTS handshaking for incoming data */
			if (ISSET(cy->cy_tty->t_cflag, CRTSCTS)) {
				int bf;

				bf = buf_p - cy->cy_ibuf_rd_ptr;
				if (bf < 0)
					bf += CY_IBUF_SIZE;

				if (bf > (CY_IBUF_SIZE / 2)) /* turn RTS off */
					cd_write_reg(sc, cy->cy_chip, CD1400_MSVR1, 0);
			}
#endif				/* CY_HW_RTS */

	end_rx_serv:
			/* terminate service context */
			cd_write_reg(sc, cy->cy_chip, CD1400_RIR, save_rir & 0x3f);
			cd_write_reg(sc, cy->cy_chip, CD1400_CAR, save_car);
			int_serviced = 1;
		} /* if(rx_service...) */
		if (ISSET(stat, CD1400_SVRR_MDMCH)) {
			u_char save_car, save_mir, serv_type, modem_stat;

			save_mir = cd_read_reg(sc, cy_chip, CD1400_MIR);
			save_car = cd_read_reg(sc, cy_chip, CD1400_CAR);
			/* enter modem service */
			cd_write_reg(sc, cy_chip, CD1400_CAR, save_mir);

			serv_type = cd_read_reg(sc, cy_chip, CD1400_MIVR);
			cy = &sc->sc_ports[serv_type >> 3];

#ifdef CY_DEBUG1
			cy->cy_modem_int_count++;
#endif

			modem_stat = cd_read_reg(sc, cy->cy_chip, CD1400_MSVR2);

#ifdef CY_DEBUG
			printf("cy%d port %d modem line change, new stat 0x%x\n",
			       card, cy->cy_port_num, modem_stat);
#endif
			if (ISSET((cy->cy_carrier_stat ^ modem_stat), CD1400_MSVR2_CD)) {
				SET(cy->cy_flags, CY_F_CARRIER_CHANGED);
				cy_events = 1;
			}
			cy->cy_carrier_stat = modem_stat;

			/* terminate service context */
			cd_write_reg(sc, cy->cy_chip, CD1400_MIR, save_mir & 0x3f);
			cd_write_reg(sc, cy->cy_chip, CD1400_CAR, save_car);
			int_serviced = 1;
		} /* if(modem_service...) */
		if (ISSET(stat, CD1400_SVRR_TXRDY)) {
			u_char          save_car, save_tir, serv_type,
			                count, ch;
			struct tty     *tp;

			save_tir = cd_read_reg(sc, cy_chip, CD1400_TIR);
			save_car = cd_read_reg(sc, cy_chip, CD1400_CAR);
			/* enter tx service */
			cd_write_reg(sc, cy_chip, CD1400_CAR, save_tir);

			serv_type = cd_read_reg(sc, cy_chip, CD1400_TIVR);
			cy = &sc->sc_ports[serv_type >> 3];

#ifdef CY_DEBUG1
			cy->cy_tx_int_count++;
#endif
#ifdef CY_DEBUG
			printf("cy%d port %d tx service\n", card, 
			    cy->cy_port_num);
#endif

			/* stop transmitting if no tty or CY_F_STOP set */
			tp = cy->cy_tty;
			if (tp == NULL || ISSET(cy->cy_flags, CY_F_STOP))
				goto txdone;

			count = 0;
			if (ISSET(cy->cy_flags, CY_F_SEND_NUL)) {
				cd_write_reg(sc, cy->cy_chip, CD1400_TDR, 0);
				cd_write_reg(sc, cy->cy_chip, CD1400_TDR, 0);
				count += 2;
				CLR(cy->cy_flags, CY_F_SEND_NUL);
			}
			if (tp->t_outq.c_cc > 0) {
				SET(tp->t_state, TS_BUSY);
				while (tp->t_outq.c_cc > 0 &&
				    count < CD1400_TX_FIFO_SIZE) {
					ch = getc(&tp->t_outq);
					/*
					 * remember to double NUL characters
					 * because embedded transmit commands
					 * are enabled
					 */
					if (ch == 0) {
						if (count >= CD1400_TX_FIFO_SIZE - 2) {
							SET(cy->cy_flags, CY_F_SEND_NUL);
							break;
						}
						cd_write_reg(sc, cy->cy_chip,
						    CD1400_TDR, ch);
						count++;
					}
					cd_write_reg(sc, cy->cy_chip,
					    CD1400_TDR, ch);
					count++;
				}
			} else {
				/*
				 * no data to send -- check if we should
				 * start/stop a break
				 */
				/*
				 * XXX does this cause too much delay before
				 * breaks?
				 */
				if (ISSET(cy->cy_flags, CY_F_START_BREAK)) {
					cd_write_reg(sc, cy->cy_chip,
					    CD1400_TDR, 0);
					cd_write_reg(sc, cy->cy_chip,
					    CD1400_TDR, 0x81);
					CLR(cy->cy_flags, CY_F_START_BREAK);
				}
				if (ISSET(cy->cy_flags, CY_F_END_BREAK)) {
					cd_write_reg(sc, cy->cy_chip,
					    CD1400_TDR, 0);
					cd_write_reg(sc, cy->cy_chip,
					    CD1400_TDR, 0x83);
					CLR(cy->cy_flags, CY_F_END_BREAK);
				}
			}

			if (tp->t_outq.c_cc == 0) {
		txdone:
				/*
				 * No data to send or requested to stop.
				 * Disable transmit interrupt
				 */
				cd_write_reg(sc, cy->cy_chip, CD1400_SRER,
				     cd_read_reg(sc, cy->cy_chip, CD1400_SRER)
				     & ~CD1400_SRER_TXRDY);
				CLR(cy->cy_flags, CY_F_STOP);
				CLR(tp->t_state, TS_BUSY);
			}
			if (tp->t_outq.c_cc <= tp->t_lowat) {
				SET(cy->cy_flags, CY_F_START);
				cy_events = 1;
			}
			/* terminate service context */
			cd_write_reg(sc, cy->cy_chip, CD1400_TIR, save_tir & 0x3f);
			cd_write_reg(sc, cy->cy_chip, CD1400_CAR, save_car);
			int_serviced = 1;
		}		/* if(tx_service...) */
	}			/* for(...all CD1400s on a card) */

	/* ensure an edge for next interrupt */
	bus_space_write_1(sc->sc_memt, sc->sc_bsh,
			CY_CLEAR_INTR << sc->sc_bustype, 0);
	return int_serviced;
}

/*
 * subroutine to enable CD1400 transmitter
 */
static void
cy_enable_transmitter(sc, cy)
	struct cy_softc *sc;
	struct cy_port *cy;
{
	int s = spltty();
	cd_write_reg(sc, cy->cy_chip, CD1400_CAR,
	    cy->cy_port_num & CD1400_CAR_CHAN);
	cd_write_reg(sc, cy->cy_chip, CD1400_SRER,
	    cd_read_reg(sc, cy->cy_chip, CD1400_SRER) | CD1400_SRER_TXRDY);
	splx(s);
}

/*
 * Execute a CD1400 channel command
 */
static void
cd1400_channel_cmd(sc, cy, cmd)
	struct cy_softc *sc;
	struct cy_port *cy;
	int cmd;
{
	u_int waitcnt = 5 * 8 * 1024;	/* approx 5 ms */

#ifdef CY_DEBUG
	printf("c1400_channel_cmd cy 0x%x command 0x%x\n", cy, cmd);
#endif

	/* wait until cd1400 is ready to process a new command */
	while (cd_read_reg(sc, cy->cy_chip, CD1400_CCR) != 0 && waitcnt-- > 0);

	if (waitcnt == 0)
		log(LOG_ERR, "%s: channel command timeout\n",
		    sc->sc_dev.dv_xname);

	cd_write_reg(sc, cy->cy_chip, CD1400_CCR, cmd);
}

/*
 * Compute clock option register and baud rate register values
 * for a given speed. Return 0 on success, -1 on failure.
 *
 * The error between requested and actual speed seems
 * to be well within allowed limits (less than 3%)
 * with every speed value between 50 and 150000 bps.
 */
static int
cy_speed(speed, cor, bpr)
    speed_t speed;
    int *cor, *bpr;
{
	int c, co, br;

	if (speed < 50 || speed > 150000)
		return -1;

	for (c = 0, co = 8; co <= 2048; co <<= 2, c++) {
		br = (CY_CLOCK + (co * speed) / 2) / (co * speed);
		if (br < 0x100) {
			*bpr = br;
			*cor = c;
			return 0;
		}
	}

	return -1;
}