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