[BACK]Return to cy.c CVS log [TXT][DIR] Up to [local] / sys / dev / ic

Annotation of sys/dev/ic/cy.c, Revision 1.1.1.1

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

CVSweb