digi.c revision 159804
1/*- 2 * Copyright (c) 2001 Brian Somers <brian@Awfulhak.org> 3 * based on work by Slawa Olhovchenkov 4 * John Prince <johnp@knight-trosoft.com> 5 * Eric Hernes 6 * All rights reserved. 7 * 8 * Redistribution and use in source and binary forms, with or without 9 * modification, are permitted provided that the following conditions 10 * are met: 11 * 1. Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in the 15 * documentation and/or other materials provided with the distribution. 16 * 17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 20 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 27 * SUCH DAMAGE. 28 * 29 * $FreeBSD: head/sys/dev/digi/digi.c 159804 2006-06-20 20:54:13Z jhb $ 30 */ 31 32/*- 33 * TODO: 34 * Figure out what the con bios stuff is supposed to do 35 * Test with *LOTS* more cards - I only have a PCI8r and an ISA Xem. 36 */ 37 38#include "opt_compat.h" 39 40#include <sys/param.h> 41#include <sys/systm.h> 42#include <sys/proc.h> 43#include <sys/conf.h> 44#include <sys/linker.h> 45#include <sys/kernel.h> 46#include <sys/mbuf.h> 47#include <sys/malloc.h> 48#include <sys/module.h> 49#include <sys/tty.h> 50#include <sys/syslog.h> 51#include <sys/fcntl.h> 52#include <sys/serial.h> 53#include <sys/bus.h> 54#include <machine/resource.h> 55 56#include <sys/digiio.h> 57#include <dev/digi/digireg.h> 58#include <dev/digi/digi.h> 59#include <dev/digi/digi_mod.h> 60#include <dev/digi/digi_pci.h> 61 62static t_open_t digiopen; 63static d_open_t digicopen; 64static d_close_t digicclose; 65static t_ioctl_t digiioctl; 66static d_ioctl_t digisioctl; 67static d_ioctl_t digicioctl; 68 69static void digistop(struct tty *tp, int rw); 70static void digibreak(struct tty *tp, int brk); 71static int digimodem(struct tty *tp, int sigon, int sigoff); 72static void digi_poll(void *ptr); 73static void digi_freemoduledata(struct digi_softc *); 74static void fepcmd(struct digi_p *port, int cmd, int op, int ncmds); 75static void digistart(struct tty *tp); 76static int digiparam(struct tty *tp, struct termios *t); 77static void digiclose(struct tty *tp); 78static void digi_intr(void *); 79static int digi_init(struct digi_softc *_sc); 80static int digi_loadmoduledata(struct digi_softc *); 81static int digi_inuse(struct digi_softc *); 82static void digi_free_state(struct digi_softc *); 83 84#define fepcmd_b(port, cmd, op1, op2, ncmds) \ 85 fepcmd(port, cmd, (op2 << 8) | op1, ncmds) 86#define fepcmd_w fepcmd 87 88struct con_bios { 89 struct con_bios *next; 90 u_char *bios; 91 size_t size; 92}; 93 94static struct con_bios *con_bios_list; 95devclass_t digi_devclass; 96static char driver_name[] = "digi"; 97unsigned digi_debug = 0; 98 99static struct speedtab digispeedtab[] = { 100 { 0, 0}, /* old (sysV-like) Bx codes */ 101 { 50, 1}, 102 { 75, 2}, 103 { 110, 3}, 104 { 134, 4}, 105 { 150, 5}, 106 { 200, 6}, 107 { 300, 7}, 108 { 600, 8}, 109 { 1200, 9}, 110 { 1800, 10}, 111 { 2400, 11}, 112 { 4800, 12}, 113 { 9600, 13}, 114 { 19200, 14}, 115 { 38400, 15}, 116 { 57600, (02000 | 1)}, 117 { 76800, (02000 | 2)}, 118 { 115200, (02000 | 3)}, 119 { 230400, (02000 | 6)}, 120 { -1, -1} 121}; 122 123const struct digi_control_signals digi_xixe_signals = { 124 0x02, 0x08, 0x10, 0x20, 0x40, 0x80 125}; 126 127const struct digi_control_signals digi_normal_signals = { 128 0x02, 0x80, 0x20, 0x10, 0x40, 0x01 129}; 130 131static struct cdevsw digi_csw = { 132 .d_version = D_VERSION, 133 .d_open = digicopen, 134 .d_close = digicclose, 135 .d_ioctl = digicioctl, 136 .d_name = driver_name, 137 .d_flags = D_TTY | D_NEEDGIANT, 138}; 139 140static void 141digi_poll(void *ptr) 142{ 143 struct digi_softc *sc; 144 145 sc = (struct digi_softc *)ptr; 146 callout_handle_init(&sc->callout); 147 digi_intr(sc); 148 sc->callout = timeout(digi_poll, sc, (hz >= 200) ? hz / 100 : 1); 149} 150 151static void 152digi_int_test(void *v) 153{ 154 struct digi_softc *sc = v; 155 156 callout_handle_init(&sc->inttest); 157#ifdef DIGI_INTERRUPT 158 if (sc->intr_timestamp.tv_sec || sc->intr_timestamp.tv_usec) { 159 /* interrupt OK! */ 160 return; 161 } 162 log(LOG_ERR, "digi%d: Interrupt didn't work, use polled mode\n", unit); 163#endif 164 sc->callout = timeout(digi_poll, sc, (hz >= 200) ? hz / 100 : 1); 165} 166 167static void 168digi_freemoduledata(struct digi_softc *sc) 169{ 170 if (sc->fep.data != NULL) { 171 free(sc->fep.data, M_TTYS); 172 sc->fep.data = NULL; 173 } 174 if (sc->link.data != NULL) { 175 free(sc->link.data, M_TTYS); 176 sc->link.data = NULL; 177 } 178 if (sc->bios.data != NULL) { 179 free(sc->bios.data, M_TTYS); 180 sc->bios.data = NULL; 181 } 182} 183 184static int 185digi_bcopy(const void *vfrom, void *vto, size_t sz) 186{ 187 volatile const char *from = (volatile const char *)vfrom; 188 volatile char *to = (volatile char *)vto; 189 size_t i; 190 191 for (i = 0; i < sz; i++) 192 *to++ = *from++; 193 194 from = (const volatile char *)vfrom; 195 to = (volatile char *)vto; 196 for (i = 0; i < sz; i++) 197 if (*to++ != *from++) 198 return (0); 199 return (1); 200} 201 202void 203digi_delay(struct digi_softc *sc, const char *txt, u_long timo) 204{ 205 if (cold) 206 DELAY(timo * 1000000 / hz); 207 else 208 tsleep(sc, PUSER | PCATCH, txt, timo); 209} 210 211static int 212digi_init(struct digi_softc *sc) 213{ 214 int i, cnt, resp; 215 u_char *ptr; 216 int lowwater; 217 struct digi_p *port; 218 volatile struct board_chan *bc; 219 struct tty *tp; 220 221 ptr = NULL; 222 223 if (sc->status == DIGI_STATUS_DISABLED) { 224 log(LOG_ERR, "digi%d: Cannot init a disabled card\n", 225 sc->res.unit); 226 return (EIO); 227 } 228 if (sc->bios.data == NULL) { 229 log(LOG_ERR, "digi%d: Cannot init without BIOS\n", 230 sc->res.unit); 231 return (EIO); 232 } 233#if 0 234 if (sc->link.data == NULL && sc->model >= PCCX) { 235 log(LOG_ERR, "digi%d: Cannot init without link info\n", 236 sc->res.unit); 237 return (EIO); 238 } 239#endif 240 if (sc->fep.data == NULL) { 241 log(LOG_ERR, "digi%d: Cannot init without fep code\n", 242 sc->res.unit); 243 return (EIO); 244 } 245 sc->status = DIGI_STATUS_NOTINIT; 246 247 if (sc->numports) { 248 /* 249 * We're re-initialising - maybe because someone's attached 250 * another port module. For now, we just re-initialise 251 * everything. 252 */ 253 if (digi_inuse(sc)) 254 return (EBUSY); 255 256 digi_free_state(sc); 257 } 258 259 ptr = sc->setwin(sc, MISCGLOBAL); 260 for (i = 0; i < 16; i += 2) 261 vW(ptr + i) = 0; 262 263 switch (sc->model) { 264 case PCXEVE: 265 outb(sc->wport, 0xff); /* window 7 */ 266 ptr = sc->vmem + (BIOSCODE & 0x1fff); 267 268 if (!digi_bcopy(sc->bios.data, ptr, sc->bios.size)) { 269 device_printf(sc->dev, "BIOS upload failed\n"); 270 return (EIO); 271 } 272 273 outb(sc->port, FEPCLR); 274 break; 275 276 case PCXE: 277 case PCXI: 278 case PCCX: 279 ptr = sc->setwin(sc, BIOSCODE + ((0xf000 - sc->mem_seg) << 4)); 280 if (!digi_bcopy(sc->bios.data, ptr, sc->bios.size)) { 281 device_printf(sc->dev, "BIOS upload failed\n"); 282 return (EIO); 283 } 284 break; 285 286 case PCXEM: 287 case PCIEPCX: 288 case PCIXR: 289 if (sc->pcibus) 290 PCIPORT = FEPRST; 291 else 292 outb(sc->port, FEPRST | FEPMEM); 293 294 for (i = 0; ((sc->pcibus ? PCIPORT : inb(sc->port)) & 295 FEPMASK) != FEPRST; i++) { 296 if (i > hz) { 297 log(LOG_ERR, "digi%d: %s init reset failed\n", 298 sc->res.unit, sc->name); 299 return (EIO); 300 } 301 digi_delay(sc, "digiinit0", 5); 302 } 303 DLOG(DIGIDB_INIT, (sc->dev, "Got init reset after %d us\n", i)); 304 305 /* Now upload the BIOS */ 306 cnt = (sc->bios.size < sc->win_size - BIOSOFFSET) ? 307 sc->bios.size : sc->win_size - BIOSOFFSET; 308 309 ptr = sc->setwin(sc, BIOSOFFSET); 310 if (!digi_bcopy(sc->bios.data, ptr, cnt)) { 311 device_printf(sc->dev, "BIOS upload (1) failed\n"); 312 return (EIO); 313 } 314 315 if (cnt != sc->bios.size) { 316 /* and the second part */ 317 ptr = sc->setwin(sc, sc->win_size); 318 if (!digi_bcopy(sc->bios.data + cnt, ptr, 319 sc->bios.size - cnt)) { 320 device_printf(sc->dev, "BIOS upload failed\n"); 321 return (EIO); 322 } 323 } 324 325 ptr = sc->setwin(sc, 0); 326 vW(ptr + 0) = 0x0401; 327 vW(ptr + 2) = 0x0bf0; 328 vW(ptr + 4) = 0x0000; 329 vW(ptr + 6) = 0x0000; 330 331 break; 332 } 333 334 DLOG(DIGIDB_INIT, (sc->dev, "BIOS uploaded\n")); 335 336 ptr = sc->setwin(sc, MISCGLOBAL); 337 W(ptr) = 0; 338 339 if (sc->pcibus) { 340 PCIPORT = FEPCLR; 341 resp = FEPRST; 342 } else if (sc->model == PCXEVE) { 343 outb(sc->port, FEPCLR); 344 resp = FEPRST; 345 } else { 346 outb(sc->port, FEPCLR | FEPMEM); 347 resp = FEPRST | FEPMEM; 348 } 349 350 for (i = 0; ((sc->pcibus ? PCIPORT : inb(sc->port)) & FEPMASK) 351 == resp; i++) { 352 if (i > hz) { 353 log(LOG_ERR, "digi%d: BIOS start failed\n", 354 sc->res.unit); 355 return (EIO); 356 } 357 digi_delay(sc, "digibios0", 5); 358 } 359 360 DLOG(DIGIDB_INIT, (sc->dev, "BIOS started after %d us\n", i)); 361 362 for (i = 0; vW(ptr) != *(u_short *)"GD"; i++) { 363 if (i > 5*hz) { 364 log(LOG_ERR, "digi%d: BIOS boot failed " 365 "(0x%02x != 0x%02x)\n", 366 sc->res.unit, vW(ptr), *(u_short *)"GD"); 367 return (EIO); 368 } 369 digi_delay(sc, "digibios1", 5); 370 } 371 372 DLOG(DIGIDB_INIT, (sc->dev, "BIOS booted after %d iterations\n", i)); 373 374 if (sc->link.data != NULL) { 375 DLOG(DIGIDB_INIT, (sc->dev, "Loading link data\n")); 376 ptr = sc->setwin(sc, 0xcd0); 377 digi_bcopy(sc->link.data, ptr, 21); /* XXX 21 ? */ 378 } 379 380 /* load FEP/OS */ 381 382 switch (sc->model) { 383 case PCXE: 384 case PCXEVE: 385 case PCXI: 386 ptr = sc->setwin(sc, sc->model == PCXI ? 0x2000 : 0x0); 387 digi_bcopy(sc->fep.data, ptr, sc->fep.size); 388 389 /* A BIOS request to move our data to 0x2000 */ 390 ptr = sc->setwin(sc, MBOX); 391 vW(ptr + 0) = 2; 392 vW(ptr + 2) = sc->mem_seg + FEPCODESEG; 393 vW(ptr + 4) = 0; 394 vW(ptr + 6) = FEPCODESEG; 395 vW(ptr + 8) = 0; 396 vW(ptr + 10) = sc->fep.size; 397 398 /* Run the BIOS request */ 399 outb(sc->port, FEPREQ | FEPMEM); 400 outb(sc->port, FEPCLR | FEPMEM); 401 402 for (i = 0; W(ptr); i++) { 403 if (i > hz) { 404 log(LOG_ERR, "digi%d: FEP/OS move failed\n", 405 sc->res.unit); 406 sc->hidewin(sc); 407 return (EIO); 408 } 409 digi_delay(sc, "digifep0", 5); 410 } 411 DLOG(DIGIDB_INIT, 412 (sc->dev, "FEP/OS moved after %d iterations\n", i)); 413 414 /* Clear the confirm word */ 415 ptr = sc->setwin(sc, FEPSTAT); 416 vW(ptr + 0) = 0; 417 418 /* A BIOS request to execute the FEP/OS */ 419 ptr = sc->setwin(sc, MBOX); 420 vW(ptr + 0) = 0x01; 421 vW(ptr + 2) = FEPCODESEG; 422 vW(ptr + 4) = 0x04; 423 424 /* Run the BIOS request */ 425 outb(sc->port, FEPREQ); 426 outb(sc->port, FEPCLR); 427 428 ptr = sc->setwin(sc, FEPSTAT); 429 430 break; 431 432 case PCXEM: 433 case PCIEPCX: 434 case PCIXR: 435 DLOG(DIGIDB_INIT, (sc->dev, "Loading FEP/OS\n")); 436 437 cnt = (sc->fep.size < sc->win_size - BIOSOFFSET) ? 438 sc->fep.size : sc->win_size - BIOSOFFSET; 439 440 ptr = sc->setwin(sc, BIOSOFFSET); 441 digi_bcopy(sc->fep.data, ptr, cnt); 442 443 if (cnt != sc->fep.size) { 444 ptr = sc->setwin(sc, BIOSOFFSET + cnt); 445 digi_bcopy(sc->fep.data + cnt, ptr, 446 sc->fep.size - cnt); 447 } 448 449 DLOG(DIGIDB_INIT, (sc->dev, "FEP/OS loaded\n")); 450 451 ptr = sc->setwin(sc, 0xc30); 452 W(ptr + 4) = 0x1004; 453 W(ptr + 6) = 0xbfc0; 454 W(ptr + 0) = 0x03; 455 W(ptr + 2) = 0x00; 456 457 /* Clear the confirm word */ 458 ptr = sc->setwin(sc, FEPSTAT); 459 W(ptr + 0) = 0; 460 461 if (sc->port) 462 outb(sc->port, 0); /* XXX necessary ? */ 463 464 break; 465 466 case PCCX: 467 ptr = sc->setwin(sc, 0xd000); 468 digi_bcopy(sc->fep.data, ptr, sc->fep.size); 469 470 /* A BIOS request to execute the FEP/OS */ 471 ptr = sc->setwin(sc, 0xc40); 472 W(ptr + 0) = 1; 473 W(ptr + 2) = FEPCODE >> 4; 474 W(ptr + 4) = 4; 475 476 /* Clear the confirm word */ 477 ptr = sc->setwin(sc, FEPSTAT); 478 W(ptr + 0) = 0; 479 480 /* Run the BIOS request */ 481 outb(sc->port, FEPREQ | FEPMEM); /* send interrupt to BIOS */ 482 outb(sc->port, FEPCLR | FEPMEM); 483 break; 484 } 485 486 /* Now wait 'till the FEP/OS has booted */ 487 for (i = 0; vW(ptr) != *(u_short *)"OS"; i++) { 488 if (i > 2*hz) { 489 log(LOG_ERR, "digi%d: FEP/OS start failed " 490 "(0x%02x != 0x%02x)\n", 491 sc->res.unit, vW(ptr), *(u_short *)"OS"); 492 sc->hidewin(sc); 493 return (EIO); 494 } 495 digi_delay(sc, "digifep1", 5); 496 } 497 498 DLOG(DIGIDB_INIT, (sc->dev, "FEP/OS started after %d iterations\n", i)); 499 500 if (sc->model >= PCXEM) { 501 ptr = sc->setwin(sc, 0xe04); 502 vW(ptr) = 2; 503 ptr = sc->setwin(sc, 0xc02); 504 sc->numports = vW(ptr); 505 } else { 506 ptr = sc->setwin(sc, 0xc22); 507 sc->numports = vW(ptr); 508 } 509 510 if (sc->numports == 0) { 511 device_printf(sc->dev, "%s, 0 ports found\n", sc->name); 512 sc->hidewin(sc); 513 return (0); 514 } 515 516 device_printf(sc->dev, "%s, %d ports found\n", sc->name, sc->numports); 517 518 if (sc->ports) 519 free(sc->ports, M_TTYS); 520 sc->ports = malloc(sizeof(struct digi_p) * sc->numports, 521 M_TTYS, M_WAITOK | M_ZERO); 522 523 /* 524 * XXX Should read port 0xc90 for an array of 2byte values, 1 per 525 * port. If the value is 0, the port is broken.... 526 */ 527 528 ptr = sc->setwin(sc, 0); 529 530 /* We should now init per-port structures */ 531 bc = (volatile struct board_chan *)(ptr + CHANSTRUCT); 532 sc->gdata = (volatile struct global_data *)(ptr + FEP_GLOBAL); 533 534 sc->memcmd = ptr + sc->gdata->cstart; 535 sc->memevent = ptr + sc->gdata->istart; 536 537 for (i = 0; i < sc->numports; i++, bc++) { 538 port = sc->ports + i; 539 port->pnum = i; 540 port->sc = sc; 541 port->status = ENABLED; 542 port->bc = bc; 543 tp = port->tp = ttyalloc(); 544 tp->t_oproc = digistart; 545 tp->t_param = digiparam; 546 tp->t_modem = digimodem; 547 tp->t_break = digibreak; 548 tp->t_stop = digistop; 549 tp->t_cioctl = digisioctl; 550 tp->t_ioctl = digiioctl; 551 tp->t_open = digiopen; 552 tp->t_close = digiclose; 553 tp->t_sc = port; 554 555 if (sc->model == PCXEVE) { 556 port->txbuf = ptr + 557 (((bc->tseg - sc->mem_seg) << 4) & 0x1fff); 558 port->rxbuf = ptr + 559 (((bc->rseg - sc->mem_seg) << 4) & 0x1fff); 560 port->txwin = FEPWIN | ((bc->tseg - sc->mem_seg) >> 9); 561 port->rxwin = FEPWIN | ((bc->rseg - sc->mem_seg) >> 9); 562 } else if (sc->model == PCXI || sc->model == PCXE) { 563 port->txbuf = ptr + ((bc->tseg - sc->mem_seg) << 4); 564 port->rxbuf = ptr + ((bc->rseg - sc->mem_seg) << 4); 565 port->txwin = port->rxwin = 0; 566 } else { 567 port->txbuf = ptr + 568 (((bc->tseg - sc->mem_seg) << 4) % sc->win_size); 569 port->rxbuf = ptr + 570 (((bc->rseg - sc->mem_seg) << 4) % sc->win_size); 571 port->txwin = FEPWIN | 572 (((bc->tseg - sc->mem_seg) << 4) / sc->win_size); 573 port->rxwin = FEPWIN | 574 (((bc->rseg - sc->mem_seg) << 4) / sc->win_size); 575 } 576 port->txbufsize = bc->tmax + 1; 577 port->rxbufsize = bc->rmax + 1; 578 579 lowwater = port->txbufsize >> 2; 580 if (lowwater > 1024) 581 lowwater = 1024; 582 sc->setwin(sc, 0); 583 fepcmd_w(port, STXLWATER, lowwater, 10); 584 fepcmd_w(port, SRXLWATER, port->rxbufsize >> 2, 10); 585 fepcmd_w(port, SRXHWATER, (3 * port->rxbufsize) >> 2, 10); 586 587 bc->edelay = 100; 588 589 ttyinitmode(tp, 0, 0); 590 port->send_ring = 1; /* Default action on signal RI */ 591 ttycreate(tp, TS_CALLOUT, "D%r%r", sc->res.unit, i); 592 } 593 594 sc->hidewin(sc); 595 sc->inttest = timeout(digi_int_test, sc, hz); 596 /* fepcmd_w(&sc->ports[0], 0xff, 0, 0); */ 597 sc->status = DIGI_STATUS_ENABLED; 598 599 return (0); 600} 601 602static int 603digimodem(struct tty *tp, int sigon, int sigoff) 604{ 605 struct digi_softc *sc; 606 struct digi_p *port; 607 int bitand, bitor, mstat; 608 609 port = tp->t_sc; 610 sc = port->sc; 611 612 if (sigon == 0 && sigoff == 0) { 613 port->sc->setwin(port->sc, 0); 614 mstat = port->bc->mstat; 615 port->sc->hidewin(port->sc); 616 if (mstat & port->sc->csigs->rts) 617 sigon |= SER_RTS; 618 if (mstat & port->cd) 619 sigon |= SER_DCD; 620 if (mstat & port->dsr) 621 sigon |= SER_DSR; 622 if (mstat & port->sc->csigs->cts) 623 sigon |= SER_CTS; 624 if (mstat & port->sc->csigs->ri) 625 sigon |= SER_RI; 626 if (mstat & port->sc->csigs->dtr) 627 sigon |= SER_DTR; 628 return (sigon); 629 } 630 631 bitand = 0; 632 bitor = 0; 633 634 if (sigoff & SER_DTR) 635 bitand |= port->sc->csigs->dtr; 636 if (sigoff & SER_RTS) 637 bitand |= port->sc->csigs->rts; 638 if (sigon & SER_DTR) 639 bitor |= port->sc->csigs->dtr; 640 if (sigon & SER_RTS) 641 bitor |= port->sc->csigs->rts; 642 fepcmd_b(port, SETMODEM, bitor, ~bitand, 0); 643 return (0); 644} 645 646static int 647digicopen(struct cdev *dev, int flag, int mode, struct thread *td) 648{ 649 struct digi_softc *sc; 650 651 sc = dev->si_drv1; 652 if (sc->status != DIGI_STATUS_ENABLED) { 653 DLOG(DIGIDB_OPEN, (sc->dev, "Cannot open a disabled card\n")); 654 return (ENXIO); 655 } 656 sc->opencnt++; 657 return (0); 658} 659 660static int 661digiopen(struct tty *tp, struct cdev *dev) 662{ 663 int error; 664 struct digi_softc *sc; 665 struct digi_p *port; 666 volatile struct board_chan *bc; 667 668 port = tp->t_sc; 669 sc = port->sc; 670 671 if (sc->status != DIGI_STATUS_ENABLED) { 672 DLOG(DIGIDB_OPEN, (sc->dev, "Cannot open a disabled card\n")); 673 return (ENXIO); 674 } 675 bc = port->bc; 676 677 /* 678 * The device isn't open, so there are no conflicts. 679 * Initialize it. Initialization is done twice in many 680 * cases: to preempt sleeping callin opens if we are callout, 681 * and to complete a callin open after DCD rises. 682 */ 683 sc->setwin(sc, 0); 684 685 bc->rout = bc->rin; /* clear input queue */ 686 bc->idata = 1; 687 bc->iempty = 1; 688 bc->ilow = 1; 689 bc->mint = port->cd | port->sc->csigs->ri; 690 bc->tin = bc->tout; 691 if (port->ialtpin) { 692 port->cd = sc->csigs->dsr; 693 port->dsr = sc->csigs->cd; 694 } else { 695 port->cd = sc->csigs->cd; 696 port->dsr = sc->csigs->dsr; 697 } 698 tp->t_wopeners++; /* XXX required ? */ 699 error = digiparam(tp, &tp->t_termios); 700 tp->t_wopeners--; 701 702 return (error); 703} 704 705static int 706digicclose(struct cdev *dev, int flag, int mode, struct thread *td) 707{ 708 struct digi_softc *sc; 709 710 sc = dev->si_drv1; 711 sc->opencnt--; 712 return (0); 713} 714 715static void 716digidtrwakeup(void *chan) 717{ 718 struct digi_p *port = chan; 719 720 port->status &= ~DIGI_DTR_OFF; 721 wakeup(&port->tp->t_dtr_wait); 722 port->tp->t_wopeners--; 723} 724 725static void 726digiclose(struct tty *tp) 727{ 728 volatile struct board_chan *bc; 729 struct digi_p *port; 730 int s; 731 732 port = tp->t_sc; 733 bc = port->bc; 734 735 s = spltty(); 736 port->sc->setwin(port->sc, 0); 737 bc->idata = 0; 738 bc->iempty = 0; 739 bc->ilow = 0; 740 bc->mint = 0; 741 if ((tp->t_cflag & HUPCL) || 742 (!tp->t_actout && !(bc->mstat & port->cd) && 743 !(tp->t_init_in.c_cflag & CLOCAL)) || 744 !(tp->t_state & TS_ISOPEN)) { 745 digimodem(tp, 0, SER_DTR | SER_RTS); 746 if (tp->t_dtr_wait != 0) { 747 /* Schedule a wakeup of any callin devices */ 748 tp->t_wopeners++; 749 timeout(&digidtrwakeup, port, tp->t_dtr_wait); 750 port->status |= DIGI_DTR_OFF; 751 } 752 } 753 tp->t_actout = FALSE; 754 wakeup(&tp->t_actout); 755 wakeup(TSA_CARR_ON(tp)); 756 splx(s); 757} 758 759/* 760 * Load module "digi_<mod>.ko" and look for a symbol called digi_mod_<mod>. 761 * 762 * Populate sc->bios, sc->fep, and sc->link from this data. 763 * 764 * sc->fep.data, sc->bios.data and sc->link.data are malloc()d according 765 * to their respective sizes. 766 * 767 * The module is unloaded when we're done. 768 */ 769static int 770digi_loadmoduledata(struct digi_softc *sc) 771{ 772 struct digi_mod *digi_mod; 773 linker_file_t lf; 774 char *modfile, *sym; 775 caddr_t symptr; 776 int modlen, res; 777 778 KASSERT(sc->bios.data == NULL, ("Uninitialised BIOS variable")); 779 KASSERT(sc->fep.data == NULL, ("Uninitialised FEP variable")); 780 KASSERT(sc->link.data == NULL, ("Uninitialised LINK variable")); 781 KASSERT(sc->module != NULL, ("Uninitialised module name")); 782 783 modlen = strlen(sc->module); 784 modfile = malloc(modlen + 6, M_TEMP, M_WAITOK); 785 snprintf(modfile, modlen + 6, "digi_%s", sc->module); 786 if ((res = linker_reference_module(modfile, NULL, &lf)) != 0) 787 printf("%s: Failed %d to autoload module\n", modfile, res); 788 free(modfile, M_TEMP); 789 if (res != 0) 790 return (res); 791 792 sym = malloc(modlen + 10, M_TEMP, M_WAITOK); 793 snprintf(sym, modlen + 10, "digi_mod_%s", sc->module); 794 symptr = linker_file_lookup_symbol(lf, sym, 0); 795 free(sym, M_TEMP); 796 if (symptr == NULL) { 797 printf("digi_%s.ko: Symbol `%s' not found\n", sc->module, sym); 798 linker_release_module(NULL, NULL, lf); 799 return (EINVAL); 800 } 801 802 digi_mod = (struct digi_mod *)symptr; 803 if (digi_mod->dm_version != DIGI_MOD_VERSION) { 804 printf("digi_%s.ko: Invalid version %d (need %d)\n", 805 sc->module, digi_mod->dm_version, DIGI_MOD_VERSION); 806 linker_release_module(NULL, NULL, lf); 807 return (EINVAL); 808 } 809 810 sc->bios.size = digi_mod->dm_bios.size; 811 if (sc->bios.size != 0 && digi_mod->dm_bios.data != NULL) { 812 sc->bios.data = malloc(sc->bios.size, M_TTYS, M_WAITOK); 813 bcopy(digi_mod->dm_bios.data, sc->bios.data, sc->bios.size); 814 } 815 816 sc->fep.size = digi_mod->dm_fep.size; 817 if (sc->fep.size != 0 && digi_mod->dm_fep.data != NULL) { 818 sc->fep.data = malloc(sc->fep.size, M_TTYS, M_WAITOK); 819 bcopy(digi_mod->dm_fep.data, sc->fep.data, sc->fep.size); 820 } 821 822 sc->link.size = digi_mod->dm_link.size; 823 if (sc->link.size != 0 && digi_mod->dm_link.data != NULL) { 824 sc->link.data = malloc(sc->link.size, M_TTYS, M_WAITOK); 825 bcopy(digi_mod->dm_link.data, sc->link.data, sc->link.size); 826 } 827 828 linker_release_module(NULL, NULL, lf); 829 830 return (0); 831} 832 833static int 834digisioctl(struct cdev *dev, u_long cmd, caddr_t data, int fflag, struct thread *td) 835{ 836 struct digi_p *port; 837 struct digi_softc *sc; 838 839 port = dev->si_drv1; 840 sc = port->sc; 841 842 switch (cmd) { 843 case DIGIIO_GETALTPIN: 844 if (ISINIT(dev)) 845 *(int *)data = port->ialtpin; 846 else if (ISLOCK(dev)) 847 *(int *)data = port->laltpin; 848 else 849 return (ENOTTY); 850 break; 851 case DIGIIO_SETALTPIN: 852 if (ISINIT(dev)) { 853 if (!port->laltpin) { 854 port->ialtpin = !!*(int *)data; 855 DLOG(DIGIDB_SET, (sc->dev, 856 "port%d: initial ALTPIN %s\n", port->pnum, 857 port->ialtpin ? "set" : "cleared")); 858 } 859 } else if (ISLOCK(dev)) { 860 port->laltpin = !!*(int *)data; 861 DLOG(DIGIDB_SET, (sc->dev, 862 "port%d: ALTPIN %slocked\n", 863 port->pnum, port->laltpin ? "" : "un")); 864 } else 865 return (ENOTTY); 866 break; 867 default: 868 return (ENOTTY); 869 } 870 return (0); 871} 872 873static int 874digicioctl(struct cdev *dev, u_long cmd, caddr_t data, int flag, struct thread *td) 875{ 876 int error; 877 struct digi_softc *sc; 878 879 sc = dev->si_drv1; 880 881 if (sc->status == DIGI_STATUS_DISABLED) 882 return (ENXIO); 883 884 switch (cmd) { 885 case DIGIIO_DEBUG: 886#ifdef DEBUG 887 digi_debug = *(int *)data; 888 return (0); 889#else 890 device_printf(sc->dev, "DEBUG not defined\n"); 891 return (ENXIO); 892#endif 893 case DIGIIO_REINIT: 894 digi_loadmoduledata(sc); 895 error = digi_init(sc); 896 digi_freemoduledata(sc); 897 return (error); 898 899 case DIGIIO_MODEL: 900 *(enum digi_model *)data = sc->model; 901 return (0); 902 903 case DIGIIO_IDENT: 904 return (copyout(sc->name, *(char **)data, 905 strlen(sc->name) + 1)); 906 default: 907 return (ENOIOCTL); 908 } 909} 910 911static int 912digiioctl(struct tty *tp, u_long cmd, void *data, int flag, struct thread *td) 913{ 914 struct digi_softc *sc; 915 struct digi_p *port; 916 917 port = tp->t_sc; 918 sc = port->sc; 919 if (sc->status == DIGI_STATUS_DISABLED) 920 return (ENXIO); 921 922 if (!(port->status & ENABLED)) 923 return (ENXIO); 924 925 switch (cmd) { 926 case DIGIIO_GETALTPIN: 927 *(int *)data = !!(port->dsr == sc->csigs->cd); 928 return (0); 929 930 case DIGIIO_SETALTPIN: 931 if (!port->laltpin) { 932 if (*(int *)data) { 933 DLOG(DIGIDB_SET, (sc->dev, 934 "port%d: ALTPIN set\n", port->pnum)); 935 port->cd = sc->csigs->dsr; 936 port->dsr = sc->csigs->cd; 937 } else { 938 DLOG(DIGIDB_SET, (sc->dev, 939 "port%d: ALTPIN cleared\n", port->pnum)); 940 port->cd = sc->csigs->cd; 941 port->dsr = sc->csigs->dsr; 942 } 943 } 944 return (0); 945 case DIGIIO_RING: 946 port->send_ring = *(u_char *)data; 947 break; 948 default: 949 return (ENOTTY); 950 } 951 return (0); 952} 953 954static void 955digibreak(struct tty *tp, int brk) 956{ 957 struct digi_p *port; 958 959 port = tp->t_sc; 960 961 /* 962 * now it sends 400 millisecond break because I don't know 963 * how to send an infinite break 964 */ 965 if (brk) 966 fepcmd_w(port, SENDBREAK, 400, 10); 967} 968 969static int 970digiparam(struct tty *tp, struct termios *t) 971{ 972 struct digi_softc *sc; 973 struct digi_p *port; 974 int cflag; 975 int iflag; 976 int hflow; 977 int s; 978 int window; 979 980 port = tp->t_sc; 981 sc = port->sc; 982 DLOG(DIGIDB_SET, (sc->dev, "port%d: setting parameters\n", port->pnum)); 983 984 if (t->c_ispeed == 0) 985 t->c_ispeed = t->c_ospeed; 986 987 cflag = ttspeedtab(t->c_ospeed, digispeedtab); 988 989 if (cflag < 0 || (cflag > 0 && t->c_ispeed != t->c_ospeed)) 990 return (EINVAL); 991 992 s = splclock(); 993 994 window = sc->window; 995 sc->setwin(sc, 0); 996 997 if (cflag == 0) { /* hangup */ 998 DLOG(DIGIDB_SET, (sc->dev, "port%d: hangup\n", port->pnum)); 999 digimodem(port->tp, 0, SER_DTR | SER_RTS); 1000 } else { 1001 digimodem(port->tp, SER_DTR | SER_RTS, 0); 1002 1003 DLOG(DIGIDB_SET, (sc->dev, "port%d: CBAUD = %d\n", port->pnum, 1004 cflag)); 1005 1006#if 0 1007 /* convert flags to sysV-style values */ 1008 if (t->c_cflag & PARODD) 1009 cflag |= 0x0200; 1010 if (t->c_cflag & PARENB) 1011 cflag |= 0x0100; 1012 if (t->c_cflag & CSTOPB) 1013 cflag |= 0x0080; 1014#else 1015 /* convert flags to sysV-style values */ 1016 if (t->c_cflag & PARODD) 1017 cflag |= FEP_PARODD; 1018 if (t->c_cflag & PARENB) 1019 cflag |= FEP_PARENB; 1020 if (t->c_cflag & CSTOPB) 1021 cflag |= FEP_CSTOPB; 1022 if (t->c_cflag & CLOCAL) 1023 cflag |= FEP_CLOCAL; 1024#endif 1025 1026 cflag |= (t->c_cflag & CSIZE) >> 4; 1027 DLOG(DIGIDB_SET, (sc->dev, "port%d: CFLAG = 0x%x\n", port->pnum, 1028 cflag)); 1029 fepcmd_w(port, SETCFLAGS, (unsigned)cflag, 0); 1030 } 1031 1032 iflag = 1033 t->c_iflag & (IGNBRK | BRKINT | IGNPAR | PARMRK | INPCK | ISTRIP); 1034 if (port->c_iflag & IXON) 1035 iflag |= 0x400; 1036 if (port->c_iflag & IXANY) 1037 iflag |= 0x800; 1038 if (port->c_iflag & IXOFF) 1039 iflag |= 0x1000; 1040 1041 DLOG(DIGIDB_SET, (sc->dev, "port%d: set iflag = 0x%x\n", port->pnum, iflag)); 1042 fepcmd_w(port, SETIFLAGS, (unsigned)iflag, 0); 1043 1044 hflow = 0; 1045 if (t->c_cflag & CDTR_IFLOW) 1046 hflow |= sc->csigs->dtr; 1047 if (t->c_cflag & CRTS_IFLOW) 1048 hflow |= sc->csigs->rts; 1049 if (t->c_cflag & CCTS_OFLOW) 1050 hflow |= sc->csigs->cts; 1051 if (t->c_cflag & CDSR_OFLOW) 1052 hflow |= port->dsr; 1053 if (t->c_cflag & CCAR_OFLOW) 1054 hflow |= port->cd; 1055 1056 DLOG(DIGIDB_SET, (sc->dev, "port%d: set hflow = 0x%x\n", port->pnum, hflow)); 1057 fepcmd_w(port, SETHFLOW, 0xff00 | (unsigned)hflow, 0); 1058 1059 DLOG(DIGIDB_SET, (sc->dev, "port%d: set startc(0x%x), stopc(0x%x)\n", 1060 port->pnum, t->c_cc[VSTART], t->c_cc[VSTOP])); 1061 fepcmd_b(port, SONOFFC, t->c_cc[VSTART], t->c_cc[VSTOP], 0); 1062 1063 if (sc->window != 0) 1064 sc->towin(sc, 0); 1065 if (window != 0) 1066 sc->towin(sc, window); 1067 splx(s); 1068 1069 return (0); 1070} 1071 1072static void 1073digi_intr(void *vp) 1074{ 1075 struct digi_p *port; 1076 char *cxcon; 1077 struct digi_softc *sc; 1078 int ehead, etail; 1079 volatile struct board_chan *bc; 1080 struct tty *tp; 1081 int head, tail; 1082 int wrapmask; 1083 int size, window; 1084 struct event { 1085 u_char pnum; 1086 u_char event; 1087 u_char mstat; 1088 u_char lstat; 1089 } event; 1090 1091 sc = vp; 1092 1093 if (sc->status != DIGI_STATUS_ENABLED) { 1094 DLOG(DIGIDB_IRQ, (sc->dev, "interrupt on disabled board !\n")); 1095 return; 1096 } 1097 1098#ifdef DIGI_INTERRUPT 1099 microtime(&sc->intr_timestamp); 1100#endif 1101 1102 window = sc->window; 1103 sc->setwin(sc, 0); 1104 1105 if (sc->model >= PCXEM && W(sc->vmem + 0xd00)) { 1106 struct con_bios *con = con_bios_list; 1107 register u_char *ptr; 1108 1109 ptr = sc->vmem + W(sc->vmem + 0xd00); 1110 while (con) { 1111 if (ptr[1] && W(ptr + 2) == W(con->bios + 2)) 1112 /* Not first block -- exact match */ 1113 break; 1114 1115 if (W(ptr + 4) >= W(con->bios + 4) && 1116 W(ptr + 4) <= W(con->bios + 6)) 1117 /* Initial search concetrator BIOS */ 1118 break; 1119 } 1120 1121 if (con == NULL) { 1122 log(LOG_ERR, "digi%d: wanted bios LREV = 0x%04x" 1123 " not found!\n", sc->res.unit, W(ptr + 4)); 1124 W(ptr + 10) = 0; 1125 W(sc->vmem + 0xd00) = 0; 1126 goto eoi; 1127 } 1128 cxcon = con->bios; 1129 W(ptr + 4) = W(cxcon + 4); 1130 W(ptr + 6) = W(cxcon + 6); 1131 if (ptr[1] == 0) 1132 W(ptr + 2) = W(cxcon + 2); 1133 W(ptr + 8) = (ptr[1] << 6) + W(cxcon + 8); 1134 size = W(cxcon + 10) - (ptr[1] << 10); 1135 if (size <= 0) { 1136 W(ptr + 8) = W(cxcon + 8); 1137 W(ptr + 10) = 0; 1138 } else { 1139 if (size > 1024) 1140 size = 1024; 1141 W(ptr + 10) = size; 1142 bcopy(cxcon + (ptr[1] << 10), ptr + 12, size); 1143 } 1144 W(sc->vmem + 0xd00) = 0; 1145 goto eoi; 1146 } 1147 1148 ehead = sc->gdata->ein; 1149 etail = sc->gdata->eout; 1150 if (ehead == etail) { 1151#ifdef DEBUG 1152 sc->intr_count++; 1153 if (sc->intr_count % 6000 == 0) { 1154 DLOG(DIGIDB_IRQ, (sc->dev, 1155 "6000 useless polls %x %x\n", ehead, etail)); 1156 sc->intr_count = 0; 1157 } 1158#endif 1159 goto eoi; 1160 } 1161 while (ehead != etail) { 1162 event = *(volatile struct event *)(sc->memevent + etail); 1163 1164 etail = (etail + 4) & sc->gdata->imax; 1165 1166 if (event.pnum >= sc->numports) { 1167 log(LOG_ERR, "digi%d: port %d: got event" 1168 " on nonexisting port\n", sc->res.unit, 1169 event.pnum); 1170 continue; 1171 } 1172 port = &sc->ports[event.pnum]; 1173 bc = port->bc; 1174 tp = port->tp; 1175 1176 if (!(tp->t_state & TS_ISOPEN) && !tp->t_wopeners) { 1177 DLOG(DIGIDB_IRQ, (sc->dev, 1178 "port %d: event 0x%x on closed port\n", 1179 event.pnum, event.event)); 1180 bc->rout = bc->rin; 1181 bc->idata = 0; 1182 bc->iempty = 0; 1183 bc->ilow = 0; 1184 bc->mint = 0; 1185 continue; 1186 } 1187 if (event.event & ~ALL_IND) 1188 log(LOG_ERR, "digi%d: port%d: ? event 0x%x mstat 0x%x" 1189 " lstat 0x%x\n", sc->res.unit, event.pnum, 1190 event.event, event.mstat, event.lstat); 1191 1192 if (event.event & DATA_IND) { 1193 DLOG(DIGIDB_IRQ, (sc->dev, "port %d: DATA_IND\n", 1194 event.pnum)); 1195 wrapmask = port->rxbufsize - 1; 1196 head = bc->rin; 1197 tail = bc->rout; 1198 1199 size = 0; 1200 if (!(tp->t_state & TS_ISOPEN)) { 1201 bc->rout = head; 1202 goto end_of_data; 1203 } 1204 while (head != tail) { 1205 int top; 1206 1207 DLOG(DIGIDB_INT, (sc->dev, 1208 "port %d: p rx head = %d tail = %d\n", 1209 event.pnum, head, tail)); 1210 top = (head > tail) ? head : wrapmask + 1; 1211 sc->towin(sc, port->rxwin); 1212 size = top - tail; 1213 if (tp->t_state & TS_CAN_BYPASS_L_RINT) { 1214 size = b_to_q((char *)port->rxbuf + 1215 tail, size, &tp->t_rawq); 1216 tail = top - size; 1217 ttwakeup(tp); 1218 } else for (; tail < top;) { 1219 ttyld_rint(tp, port->rxbuf[tail]); 1220 sc->towin(sc, port->rxwin); 1221 size--; 1222 tail++; 1223 if (tp->t_state & TS_TBLOCK) 1224 break; 1225 } 1226 tail &= wrapmask; 1227 sc->setwin(sc, 0); 1228 bc->rout = tail; 1229 head = bc->rin; 1230 if (size) 1231 break; 1232 } 1233 1234 if (bc->orun) { 1235 CE_RECORD(port, CE_OVERRUN); 1236 log(LOG_ERR, "digi%d: port%d: %s\n", 1237 sc->res.unit, event.pnum, 1238 digi_errortxt(CE_OVERRUN)); 1239 bc->orun = 0; 1240 } 1241end_of_data: 1242 if (size) { 1243 tp->t_state |= TS_TBLOCK; 1244 port->status |= PAUSE_RX; 1245 DLOG(DIGIDB_RX, (sc->dev, "port %d: pause RX\n", 1246 event.pnum)); 1247 } else { 1248 bc->idata = 1; 1249 } 1250 } 1251 1252 if (event.event & MODEMCHG_IND) { 1253 DLOG(DIGIDB_MODEM, (sc->dev, "port %d: MODEMCHG_IND\n", 1254 event.pnum)); 1255 1256 if ((event.mstat ^ event.lstat) & port->cd) { 1257 sc->hidewin(sc); 1258 ttyld_modem(tp, event.mstat & port->cd); 1259 sc->setwin(sc, 0); 1260 wakeup(TSA_CARR_ON(tp)); 1261 } 1262 1263 if (event.mstat & sc->csigs->ri) { 1264 DLOG(DIGIDB_RI, (sc->dev, "port %d: RING\n", 1265 event.pnum)); 1266 if (port->send_ring) { 1267 ttyld_rint(tp, 'R'); 1268 ttyld_rint(tp, 'I'); 1269 ttyld_rint(tp, 'N'); 1270 ttyld_rint(tp, 'G'); 1271 ttyld_rint(tp, '\r'); 1272 ttyld_rint(tp, '\n'); 1273 } 1274 } 1275 } 1276 if (event.event & BREAK_IND) { 1277 DLOG(DIGIDB_MODEM, (sc->dev, "port %d: BREAK_IND\n", 1278 event.pnum)); 1279 ttyld_rint(tp, TTY_BI); 1280 } 1281 if (event.event & (LOWTX_IND | EMPTYTX_IND)) { 1282 DLOG(DIGIDB_IRQ, (sc->dev, "port %d:%s%s\n", 1283 event.pnum, 1284 event.event & LOWTX_IND ? " LOWTX" : "", 1285 event.event & EMPTYTX_IND ? " EMPTYTX" : "")); 1286 ttyld_start(tp); 1287 } 1288 } 1289 sc->gdata->eout = etail; 1290eoi: 1291 if (sc->window != 0) 1292 sc->towin(sc, 0); 1293 if (window != 0) 1294 sc->towin(sc, window); 1295} 1296 1297static void 1298digistart(struct tty *tp) 1299{ 1300 struct digi_p *port; 1301 struct digi_softc *sc; 1302 volatile struct board_chan *bc; 1303 int head, tail; 1304 int size, ocount, totcnt = 0; 1305 int s; 1306 int wmask; 1307 1308 port = tp->t_sc; 1309 sc = port->sc; 1310 bc = port->bc; 1311 1312 wmask = port->txbufsize - 1; 1313 1314 s = spltty(); 1315 port->lcc = tp->t_outq.c_cc; 1316 sc->setwin(sc, 0); 1317 if (!(tp->t_state & TS_TBLOCK)) { 1318 if (port->status & PAUSE_RX) { 1319 DLOG(DIGIDB_RX, (sc->dev, "port %d: resume RX\n", 1320 port->pnum)); 1321 /* 1322 * CAREFUL - braces are needed here if the DLOG is 1323 * optimised out! 1324 */ 1325 } 1326 port->status &= ~PAUSE_RX; 1327 bc->idata = 1; 1328 } 1329 if (!(tp->t_state & TS_TTSTOP) && port->status & PAUSE_TX) { 1330 DLOG(DIGIDB_TX, (sc->dev, "port %d: resume TX\n", port->pnum)); 1331 port->status &= ~PAUSE_TX; 1332 fepcmd_w(port, RESUMETX, 0, 10); 1333 } 1334 if (tp->t_outq.c_cc == 0) 1335 tp->t_state &= ~TS_BUSY; 1336 else 1337 tp->t_state |= TS_BUSY; 1338 1339 head = bc->tin; 1340 while (tp->t_outq.c_cc != 0) { 1341 tail = bc->tout; 1342 DLOG(DIGIDB_INT, (sc->dev, "port%d: s tx head = %d tail = %d\n", 1343 port->pnum, head, tail)); 1344 1345 if (head < tail) 1346 size = tail - head - 1; 1347 else { 1348 size = port->txbufsize - head; 1349 if (tail == 0) 1350 size--; 1351 } 1352 1353 if (size == 0) 1354 break; 1355 sc->towin(sc, port->txwin); 1356 ocount = q_to_b(&tp->t_outq, port->txbuf + head, size); 1357 totcnt += ocount; 1358 head += ocount; 1359 head &= wmask; 1360 sc->setwin(sc, 0); 1361 bc->tin = head; 1362 bc->iempty = 1; 1363 bc->ilow = 1; 1364 } 1365 port->lostcc = tp->t_outq.c_cc; 1366 tail = bc->tout; 1367 if (head < tail) 1368 size = port->txbufsize - tail + head; 1369 else 1370 size = head - tail; 1371 1372 port->lbuf = size; 1373 DLOG(DIGIDB_INT, (sc->dev, "port%d: s total cnt = %d\n", port->pnum, totcnt)); 1374 ttwwakeup(tp); 1375 splx(s); 1376} 1377 1378static void 1379digistop(struct tty *tp, int rw) 1380{ 1381 struct digi_softc *sc; 1382 struct digi_p *port; 1383 1384 port = tp->t_sc; 1385 sc = port->sc; 1386 1387 DLOG(DIGIDB_TX, (sc->dev, "port %d: pause TX\n", port->pnum)); 1388 port->status |= PAUSE_TX; 1389 fepcmd_w(port, PAUSETX, 0, 10); 1390} 1391 1392static void 1393fepcmd(struct digi_p *port, int cmd, int op1, int ncmds) 1394{ 1395 u_char *mem; 1396 unsigned tail, head; 1397 int count, n; 1398 1399 mem = port->sc->memcmd; 1400 1401 port->sc->setwin(port->sc, 0); 1402 1403 head = port->sc->gdata->cin; 1404 mem[head + 0] = cmd; 1405 mem[head + 1] = port->pnum; 1406 *(u_short *)(mem + head + 2) = op1; 1407 1408 head = (head + 4) & port->sc->gdata->cmax; 1409 port->sc->gdata->cin = head; 1410 1411 for (count = FEPTIMEOUT; count > 0; count--) { 1412 head = port->sc->gdata->cin; 1413 tail = port->sc->gdata->cout; 1414 n = (head - tail) & port->sc->gdata->cmax; 1415 1416 if (n <= ncmds * sizeof(short) * 4) 1417 break; 1418 } 1419 if (count == 0) 1420 log(LOG_ERR, "digi%d: port%d: timeout on FEP command\n", 1421 port->sc->res.unit, port->pnum); 1422} 1423 1424const char * 1425digi_errortxt(int id) 1426{ 1427 static const char *error_desc[] = { 1428 "silo overflow", 1429 "interrupt-level buffer overflow", 1430 "tty-level buffer overflow", 1431 }; 1432 1433 KASSERT(id >= 0 && id < sizeof(error_desc) / sizeof(error_desc[0]), 1434 ("Unexpected digi error id %d\n", id)); 1435 1436 return (error_desc[id]); 1437} 1438 1439int 1440digi_attach(struct digi_softc *sc) 1441{ 1442 sc->res.ctldev = make_dev(&digi_csw, 1443 sc->res.unit << 16, UID_ROOT, GID_WHEEL, 1444 0600, "digi%r.ctl", sc->res.unit); 1445 sc->res.ctldev->si_drv1 = sc; 1446 1447 digi_loadmoduledata(sc); 1448 digi_init(sc); 1449 digi_freemoduledata(sc); 1450 1451 return (0); 1452} 1453 1454static int 1455digi_inuse(struct digi_softc *sc) 1456{ 1457 int i; 1458 struct digi_p *port; 1459 1460 port = &sc->ports[0]; 1461 for (i = 0; i < sc->numports; i++, port++) 1462 if (port->tp->t_state & TS_ISOPEN) { 1463 DLOG(DIGIDB_INIT, (sc->dev, "port%d: busy\n", i)); 1464 return (1); 1465 } else if (port->tp->t_wopeners || port->opencnt) { 1466 DLOG(DIGIDB_INIT, (sc->dev, "port%d: blocked in open\n", 1467 i)); 1468 return (1); 1469 } 1470 return (0); 1471} 1472 1473static void 1474digi_free_state(struct digi_softc *sc) 1475{ 1476 int i; 1477 1478 /* Blow it all away */ 1479 1480 for (i = 0; i < sc->numports; i++) 1481 ttygone(sc->ports[i].tp); 1482 1483 /* XXX: this might be better done as a ttypurge method */ 1484 untimeout(digi_poll, sc, sc->callout); 1485 callout_handle_init(&sc->callout); 1486 untimeout(digi_int_test, sc, sc->inttest); 1487 callout_handle_init(&sc->inttest); 1488 1489 for (i = 0; i < sc->numports; i++) 1490 ttyfree(sc->ports[i].tp); 1491 1492 bus_teardown_intr(sc->dev, sc->res.irq, sc->res.irqHandler); 1493#ifdef DIGI_INTERRUPT 1494 if (sc->res.irq != NULL) { 1495 bus_release_resource(dev, SYS_RES_IRQ, sc->res.irqrid, 1496 sc->res.irq); 1497 sc->res.irq = NULL; 1498 } 1499#endif 1500 if (sc->numports) { 1501 KASSERT(sc->ports, ("digi%d: Lost my ports ?", sc->res.unit)); 1502 free(sc->ports, M_TTYS); 1503 sc->ports = NULL; 1504 sc->numports = 0; 1505 } 1506 1507 sc->status = DIGI_STATUS_NOTINIT; 1508} 1509 1510int 1511digi_detach(device_t dev) 1512{ 1513 struct digi_softc *sc = device_get_softc(dev); 1514 1515 DLOG(DIGIDB_INIT, (sc->dev, "detaching\n")); 1516 1517 /* If we're INIT'd, numports must be 0 */ 1518 KASSERT(sc->numports == 0 || sc->status != DIGI_STATUS_NOTINIT, 1519 ("digi%d: numports(%d) & status(%d) are out of sync", 1520 sc->res.unit, sc->numports, (int)sc->status)); 1521 1522 if (digi_inuse(sc)) 1523 return (EBUSY); 1524 1525 digi_free_state(sc); 1526 1527 destroy_dev(sc->res.ctldev); 1528 1529 if (sc->res.mem != NULL) { 1530 bus_release_resource(dev, SYS_RES_MEMORY, sc->res.mrid, 1531 sc->res.mem); 1532 sc->res.mem = NULL; 1533 } 1534 if (sc->res.io != NULL) { 1535 bus_release_resource(dev, SYS_RES_IOPORT, sc->res.iorid, 1536 sc->res.io); 1537 sc->res.io = NULL; 1538 } 1539 1540 return (0); 1541} 1542 1543int 1544digi_shutdown(device_t dev) 1545{ 1546 return (0); 1547} 1548 1549MODULE_VERSION(digi, 1); 1550