if_cx.c revision 138640
1/* 2 * Cronyx-Sigma adapter driver for FreeBSD. 3 * Supports PPP/HDLC and Cisco/HDLC protocol in synchronous mode, 4 * and asyncronous channels with full modem control. 5 * Keepalive protocol implemented in both Cisco and PPP modes. 6 * 7 * Copyright (C) 1994-2002 Cronyx Engineering. 8 * Author: Serge Vakulenko, <vak@cronyx.ru> 9 * 10 * Copyright (C) 1999-2004 Cronyx Engineering. 11 * Rewritten on DDK, ported to NETGRAPH, rewritten for FreeBSD 3.x-5.x by 12 * Kurakin Roman, <rik@cronyx.ru> 13 * 14 * This software is distributed with NO WARRANTIES, not even the implied 15 * warranties for MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. 16 * 17 * Authors grant any other persons or organisations a permission to use, 18 * modify and redistribute this software in source and binary forms, 19 * as long as this message is kept with the software, all derivative 20 * works or modified versions. 21 * 22 * Cronyx Id: if_cx.c,v 1.1.2.34 2004/06/23 17:09:13 rik Exp $ 23 */ 24 25#include <sys/cdefs.h> 26__FBSDID("$FreeBSD: head/sys/dev/cx/if_cx.c 138640 2004-12-09 23:43:03Z rik $"); 27 28#include <sys/param.h> 29 30#include <sys/systm.h> 31#include <sys/kernel.h> 32#include <sys/module.h> 33#include <sys/proc.h> 34#include <sys/mbuf.h> 35#include <sys/sockio.h> 36#include <sys/malloc.h> 37#include <sys/socket.h> 38#include <sys/conf.h> 39#include <sys/errno.h> 40#include <sys/serial.h> 41#include <sys/tty.h> 42#include <sys/bus.h> 43#include <machine/bus.h> 44#include <sys/rman.h> 45#include <isa/isavar.h> 46#include <sys/fcntl.h> 47#include <sys/interrupt.h> 48#include <vm/vm.h> 49#include <vm/pmap.h> 50#include <net/if.h> 51#include <machine/cpufunc.h> 52#include <machine/cserial.h> 53#include <machine/clock.h> 54#include <machine/resource.h> 55#include <dev/cx/machdep.h> 56#include <dev/cx/cxddk.h> 57#include <dev/cx/cronyxfw.h> 58#include "opt_ng_cronyx.h" 59#ifdef NETGRAPH_CRONYX 60# include "opt_netgraph.h" 61# include <netgraph/ng_message.h> 62# include <netgraph/netgraph.h> 63# include <dev/cx/ng_cx.h> 64#else 65# include <net/if_types.h> 66# include <net/if_sppp.h> 67# define PP_CISCO IFF_LINK2 68# include <net/bpf.h> 69#endif 70 71#define NCX 1 72 73/* If we don't have Cronyx's sppp version, we don't have fr support via sppp */ 74#ifndef PP_FR 75#define PP_FR 0 76#endif 77 78#define CX_DEBUG(d,s) ({if (d->chan->debug) {\ 79 printf ("%s: ", d->name); printf s;}}) 80#define CX_DEBUG2(d,s) ({if (d->chan->debug>1) {\ 81 printf ("%s: ", d->name); printf s;}}) 82 83typedef struct _async_q { 84 int beg; 85 int end; 86 #define BF_SZ 14400 87 int buf[BF_SZ+1]; 88} async_q; 89 90#define AQ_GSZ(q) ((BF_SZ + (q)->end - (q)->beg)%BF_SZ) 91#define AQ_PUSH(q,c) {*((q)->buf + (q)->end) = c;\ 92 (q)->end = ((q)->end + 1)%BF_SZ;} 93#define AQ_POP(q,c) {c = *((q)->buf + (q)->beg);\ 94 (q)->beg = ((q)->beg + 1)%BF_SZ;} 95 96static void cx_identify __P((driver_t *, device_t)); 97static int cx_probe __P((device_t)); 98static int cx_attach __P((device_t)); 99static int cx_detach __P((device_t)); 100static t_open_t cx_topen; 101static t_modem_t cx_tmodem; 102static t_close_t cx_tclose; 103 104static device_method_t cx_isa_methods [] = { 105 DEVMETHOD(device_identify, cx_identify), 106 DEVMETHOD(device_probe, cx_probe), 107 DEVMETHOD(device_attach, cx_attach), 108 DEVMETHOD(device_detach, cx_detach), 109 {0, 0} 110}; 111 112typedef struct _cx_dma_mem_t { 113 unsigned long phys; 114 void *virt; 115 size_t size; 116 bus_dma_tag_t dmat; 117 bus_dmamap_t mapp; 118} cx_dma_mem_t; 119 120typedef struct _drv_t { 121 char name [8]; 122 cx_chan_t *chan; 123 cx_board_t *board; 124 cx_dma_mem_t dmamem; 125 struct tty *tty; 126 struct callout_handle dcd_timeout_handle; 127 unsigned callout; 128 unsigned lock; 129 int open_dev; 130 int cd; 131 int running; 132#ifdef NETGRAPH 133 char nodename [NG_NODELEN+1]; 134 hook_p hook; 135 hook_p debug_hook; 136 node_p node; 137 struct ifqueue lo_queue; 138 struct ifqueue hi_queue; 139 short timeout; 140 struct callout_handle timeout_handle; 141#else 142 struct sppp pp; 143#endif 144 struct cdev *devt; 145 async_q aqueue; 146#define CX_READ 1 147#define CX_WRITE 2 148 int intr_action; 149 short atimeout; 150} drv_t; 151 152typedef struct _bdrv_t { 153 cx_board_t *board; 154 struct resource *base_res; 155 struct resource *drq_res; 156 struct resource *irq_res; 157 int base_rid; 158 int drq_rid; 159 int irq_rid; 160 void *intrhand; 161 drv_t channel [NCHAN]; 162} bdrv_t; 163 164static driver_t cx_isa_driver = { 165 "cx", 166 cx_isa_methods, 167 sizeof (bdrv_t), 168}; 169 170static devclass_t cx_devclass; 171 172extern long csigma_fw_len; 173extern const char *csigma_fw_version; 174extern const char *csigma_fw_date; 175extern const char *csigma_fw_copyright; 176extern const cr_dat_tst_t csigma_fw_tvec[]; 177extern const u_char csigma_fw_data[]; 178static void cx_oproc (struct tty *tp); 179static int cx_param (struct tty *tp, struct termios *t); 180static void cx_stop (struct tty *tp, int flag); 181static void cx_receive (cx_chan_t *c, char *data, int len); 182static void cx_transmit (cx_chan_t *c, void *attachment, int len); 183static void cx_error (cx_chan_t *c, int data); 184static void cx_modem (cx_chan_t *c); 185static void cx_up (drv_t *d); 186static void cx_start (drv_t *d); 187static void cx_softintr (void *); 188static void *cx_fast_ih; 189static void cx_down (drv_t *d); 190static void cx_watchdog (drv_t *d); 191static void cx_carrier (void *arg); 192 193#ifdef NETGRAPH 194extern struct ng_type typestruct; 195#else 196static void cx_ifstart (struct ifnet *ifp); 197static void cx_tlf (struct sppp *sp); 198static void cx_tls (struct sppp *sp); 199static void cx_ifwatchdog (struct ifnet *ifp); 200static int cx_sioctl (struct ifnet *ifp, u_long cmd, caddr_t data); 201static void cx_initialize (void *softc); 202#endif 203 204static cx_board_t *adapter [NCX]; 205static drv_t *channel [NCX*NCHAN]; 206static struct callout_handle led_timo [NCX]; 207static struct callout_handle timeout_handle; 208extern struct cdevsw cx_cdevsw; 209 210static int MY_SOFT_INTR; 211 212/* 213 * Print the mbuf chain, for debug purposes only. 214 */ 215static void printmbuf (struct mbuf *m) 216{ 217 printf ("mbuf:"); 218 for (; m; m=m->m_next) { 219 if (m->m_flags & M_PKTHDR) 220 printf (" HDR %d:", m->m_pkthdr.len); 221 if (m->m_flags & M_EXT) 222 printf (" EXT:"); 223 printf (" %d", m->m_len); 224 } 225 printf ("\n"); 226} 227 228/* 229 * Make an mbuf from data. 230 */ 231static struct mbuf *makembuf (void *buf, u_int len) 232{ 233 struct mbuf *m, *o, *p; 234 235 MGETHDR (m, M_DONTWAIT, MT_DATA); 236 237 if (! m) 238 return 0; 239 240 if (len >= MINCLSIZE) 241 MCLGET (m, M_DONTWAIT); 242 243 m->m_pkthdr.len = len; 244 m->m_len = 0; 245 246 p = m; 247 while (len) { 248 u_int n = M_TRAILINGSPACE (p); 249 if (n > len) 250 n = len; 251 if (! n) { 252 /* Allocate new mbuf. */ 253 o = p; 254 MGET (p, M_DONTWAIT, MT_DATA); 255 if (! p) { 256 m_freem (m); 257 return 0; 258 } 259 if (len >= MINCLSIZE) 260 MCLGET (p, M_DONTWAIT); 261 p->m_len = 0; 262 o->m_next = p; 263 264 n = M_TRAILINGSPACE (p); 265 if (n > len) 266 n = len; 267 } 268 bcopy (buf, mtod (p, caddr_t) + p->m_len, n); 269 270 p->m_len += n; 271 buf = n + (char*) buf; 272 len -= n; 273 } 274 return m; 275} 276 277/* 278 * Recover after lost transmit interrupts. 279 */ 280static void cx_timeout (void *arg) 281{ 282 drv_t *d; 283 int s, i; 284 285 for (i=0; i<NCX*NCHAN; ++i) { 286 d = channel[i]; 287 if (! d) 288 continue; 289 s = splhigh (); 290 if (d->atimeout == 1 && d->tty && d->tty->t_state & TS_BUSY) { 291 d->tty->t_state &= ~TS_BUSY; 292 if (d->tty->t_dev) { 293 d->intr_action |= CX_WRITE; 294 MY_SOFT_INTR = 1; 295 swi_sched (cx_fast_ih, 0); 296 } 297 CX_DEBUG (d, ("cx_timeout\n")); 298 } 299 if (d->atimeout) 300 d->atimeout--; 301 splx (s); 302 } 303 timeout_handle = timeout (cx_timeout, 0, hz*5); 304} 305 306static void cx_led_off (void *arg) 307{ 308 cx_board_t *b = arg; 309 int s = splhigh (); 310 311 cx_led (b, 0); 312 led_timo[b->num].callout = 0; 313 splx (s); 314} 315 316/* 317 * Activate interupt handler from DDK. 318 */ 319static void cx_intr (void *arg) 320{ 321 bdrv_t *bd = arg; 322 cx_board_t *b = bd->board; 323 int s = splhigh (); 324 325 /* Turn LED on. */ 326 cx_led (b, 1); 327 328 cx_int_handler (b); 329 330 /* Turn LED off 50 msec later. */ 331 if (! led_timo[b->num].callout) 332 led_timo[b->num] = timeout (cx_led_off, b, hz/20); 333 splx (s); 334} 335 336static int probe_irq (cx_board_t *b, int irq) 337{ 338 int mask, busy, cnt; 339 340 /* Clear pending irq, if any. */ 341 cx_probe_irq (b, -irq); 342 DELAY (100); 343 for (cnt=0; cnt<5; ++cnt) { 344 /* Get the mask of pending irqs, assuming they are busy. 345 * Activate the adapter on given irq. */ 346 busy = cx_probe_irq (b, irq); 347 DELAY (100); 348 349 /* Get the mask of active irqs. 350 * Deactivate our irq. */ 351 mask = cx_probe_irq (b, -irq); 352 DELAY (100); 353 if ((mask & ~busy) == 1 << irq) { 354 cx_probe_irq (b, 0); 355 /* printf ("cx%d: irq %d ok, mask=0x%04x, busy=0x%04x\n", 356 b->num, irq, mask, busy); */ 357 return 1; 358 } 359 } 360 /* printf ("cx%d: irq %d not functional, mask=0x%04x, busy=0x%04x\n", 361 b->num, irq, mask, busy); */ 362 cx_probe_irq (b, 0); 363 return 0; 364} 365 366static short porttab [] = { 367 0x200, 0x220, 0x240, 0x260, 0x280, 0x2a0, 0x2c0, 0x2e0, 368 0x300, 0x320, 0x340, 0x360, 0x380, 0x3a0, 0x3c0, 0x3e0, 0 369}; 370static char dmatab [] = { 7, 6, 5, 0 }; 371static char irqtab [] = { 5, 10, 11, 7, 3, 15, 12, 0 }; 372 373static int cx_is_free_res (device_t dev, int rid, int type, u_long start, 374 u_long end, u_long count) 375{ 376 struct resource *res; 377 378 if (!(res = bus_alloc_resource (dev, type, &rid, start, end, count, 379 RF_ALLOCATED))) 380 return 0; 381 382 bus_release_resource (dev, type, rid, res); 383 384 return 1; 385} 386 387static void cx_identify (driver_t *driver, device_t dev) 388{ 389 u_long iobase, rescount; 390 int devcount; 391 device_t *devices; 392 device_t child; 393 devclass_t my_devclass; 394 int i, k; 395 396 if ((my_devclass = devclass_find ("cx")) == NULL) 397 return; 398 399 devclass_get_devices (my_devclass, &devices, &devcount); 400 401 if (devcount == 0) { 402 /* We should find all devices by our self. We could alter other 403 * devices, but we don't have a choise 404 */ 405 for (i = 0; (iobase = porttab [i]) != 0; i++) { 406 if (!cx_is_free_res (dev, 0, SYS_RES_IOPORT, 407 iobase, iobase + NPORT, NPORT)) 408 continue; 409 if (cx_probe_board (iobase, -1, -1) == 0) 410 continue; 411 412 devcount++; 413 414 child = BUS_ADD_CHILD (dev, ISA_ORDER_SPECULATIVE, "cx", 415 -1); 416 417 if (child == NULL) 418 return; 419 420 device_set_desc_copy (child, "Cronyx Sigma"); 421 device_set_driver (child, driver); 422 bus_set_resource (child, SYS_RES_IOPORT, 0, 423 iobase, NPORT); 424 425 if (devcount >= NCX) 426 break; 427 } 428 } else { 429 static short porttab [] = { 430 0x200, 0x220, 0x240, 0x260, 0x280, 0x2a0, 0x2c0, 0x2e0, 431 0x300, 0x320, 0x340, 0x360, 0x380, 0x3a0, 0x3c0, 0x3e0, 0 432 }; 433 /* Lets check user choise. 434 */ 435 for (k = 0; k < devcount; k++) { 436 if (bus_get_resource (devices[k], SYS_RES_IOPORT, 0, 437 &iobase, &rescount) != 0) 438 continue; 439 440 for (i = 0; porttab [i] != 0; i++) { 441 if (porttab [i] != iobase) 442 continue; 443 if (!cx_is_free_res (devices[k], 0, SYS_RES_IOPORT, 444 iobase, iobase + NPORT, NPORT)) 445 continue; 446 if (cx_probe_board (iobase, -1, -1) == 0) 447 continue; 448 porttab [i] = -1; 449 device_set_desc_copy (devices[k], "Cronyx Sigma"); 450 break; 451 } 452 453 if (porttab [i] == 0) { 454 device_delete_child ( 455 device_get_parent (devices[k]), 456 devices [k]); 457 devices[k] = 0; 458 continue; 459 } 460 } 461 for (k = 0; k < devcount; k++) { 462 if (devices[k] == 0) 463 continue; 464 if (bus_get_resource (devices[k], SYS_RES_IOPORT, 0, 465 &iobase, &rescount) == 0) 466 continue; 467 for (i = 0; (iobase = porttab [i]) != 0; i++) { 468 if (porttab [i] == -1) { 469 continue; 470 } 471 if (!cx_is_free_res (devices[k], 0, SYS_RES_IOPORT, 472 iobase, iobase + NPORT, NPORT)) 473 continue; 474 if (cx_probe_board (iobase, -1, -1) == 0) 475 continue; 476 477 bus_set_resource (devices[k], SYS_RES_IOPORT, 0, 478 iobase, NPORT); 479 porttab [i] = -1; 480 device_set_desc_copy (devices[k], "Cronyx Sigma"); 481 break; 482 } 483 if (porttab [i] == 0) { 484 device_delete_child ( 485 device_get_parent (devices[k]), 486 devices [k]); 487 } 488 } 489 free (devices, M_TEMP); 490 } 491 492 return; 493} 494 495static int cx_probe (device_t dev) 496{ 497 int unit = device_get_unit (dev); 498 int i; 499 u_long iobase, rescount; 500 501 if (!device_get_desc (dev) || 502 strcmp (device_get_desc (dev), "Cronyx Sigma")) 503 return ENXIO; 504 505 if (bus_get_resource (dev, SYS_RES_IOPORT, 0, &iobase, &rescount) != 0) { 506 printf ("cx%d: Couldn't get IOPORT\n", unit); 507 return ENXIO; 508 } 509 510 if (!cx_is_free_res (dev, 0, SYS_RES_IOPORT, 511 iobase, iobase + NPORT, NPORT)) { 512 printf ("cx%d: Resource IOPORT isn't free %lx\n", unit, iobase); 513 return ENXIO; 514 } 515 516 for (i = 0; porttab [i] != 0; i++) { 517 if (porttab [i] == iobase) { 518 porttab [i] = -1; 519 break; 520 } 521 } 522 523 if (porttab [i] == 0) { 524 return ENXIO; 525 } 526 527 if (!cx_probe_board (iobase, -1, -1)) { 528 printf ("cx%d: probing for Sigma at %lx faild\n", unit, iobase); 529 return ENXIO; 530 } 531 532 return 0; 533} 534 535static void 536cx_bus_dmamap_addr (void *arg, bus_dma_segment_t *segs, int nseg, int error) 537{ 538 unsigned long *addr; 539 540 if (error) 541 return; 542 543 KASSERT(nseg == 1, ("too many DMA segments, %d should be 1", nseg)); 544 addr = arg; 545 *addr = segs->ds_addr; 546} 547 548static int 549cx_bus_dma_mem_alloc (int bnum, int cnum, cx_dma_mem_t *dmem) 550{ 551 int error; 552 553 error = bus_dma_tag_create (NULL, 16, 0, BUS_SPACE_MAXADDR_24BIT, 554 BUS_SPACE_MAXADDR, NULL, NULL, dmem->size, 1, 555 dmem->size, 0, NULL, NULL, &dmem->dmat); 556 if (error) { 557 if (cnum >= 0) printf ("cx%d-%d: ", bnum, cnum); 558 else printf ("cx%d: ", bnum); 559 printf ("couldn't allocate tag for dma memory\n"); 560 return 0; 561 } 562 error = bus_dmamem_alloc (dmem->dmat, (void **)&dmem->virt, 563 BUS_DMA_NOWAIT | BUS_DMA_ZERO, &dmem->mapp); 564 if (error) { 565 if (cnum >= 0) printf ("cx%d-%d: ", bnum, cnum); 566 else printf ("cx%d: ", bnum); 567 printf ("couldn't allocate mem for dma memory\n"); 568 bus_dma_tag_destroy (dmem->dmat); 569 return 0; 570 } 571 error = bus_dmamap_load (dmem->dmat, dmem->mapp, dmem->virt, 572 dmem->size, cx_bus_dmamap_addr, &dmem->phys, 0); 573 if (error) { 574 if (cnum >= 0) printf ("cx%d-%d: ", bnum, cnum); 575 else printf ("cx%d: ", bnum); 576 printf ("couldn't load mem map for dma memory\n"); 577 bus_dmamem_free (dmem->dmat, dmem->virt, dmem->mapp); 578 bus_dma_tag_destroy (dmem->dmat); 579 return 0; 580 } 581 return 1; 582} 583 584static void 585cx_bus_dma_mem_free (cx_dma_mem_t *dmem) 586{ 587 bus_dmamap_unload (dmem->dmat, dmem->mapp); 588 bus_dmamem_free (dmem->dmat, dmem->virt, dmem->mapp); 589 bus_dma_tag_destroy (dmem->dmat); 590} 591 592/* 593 * The adapter is present, initialize the driver structures. 594 */ 595static int cx_attach (device_t dev) 596{ 597 bdrv_t *bd = device_get_softc (dev); 598 u_long iobase, drq, irq, rescount; 599 int unit = device_get_unit (dev); 600 cx_board_t *b; 601 cx_chan_t *c; 602 drv_t *d; 603 int i; 604 int s; 605 606 KASSERT ((bd != NULL), ("cx%d: NULL device softc\n", unit)); 607 608 bus_get_resource (dev, SYS_RES_IOPORT, 0, &iobase, &rescount); 609 bd->base_rid = 0; 610 bd->base_res = bus_alloc_resource (dev, SYS_RES_IOPORT, &bd->base_rid, 611 iobase, iobase + NPORT, NPORT, RF_ACTIVE); 612 if (! bd->base_res) { 613 printf ("cx%d: cannot allocate base address\n", unit); 614 return ENXIO; 615 } 616 617 if (bus_get_resource (dev, SYS_RES_DRQ, 0, &drq, &rescount) != 0) { 618 for (i = 0; (drq = dmatab [i]) != 0; i++) { 619 if (!cx_is_free_res (dev, 0, SYS_RES_DRQ, 620 drq, drq + 1, 1)) 621 continue; 622 bus_set_resource (dev, SYS_RES_DRQ, 0, drq, 1); 623 break; 624 } 625 626 if (dmatab[i] == 0) { 627 bus_release_resource (dev, SYS_RES_IOPORT, bd->base_rid, 628 bd->base_res); 629 printf ("cx%d: Couldn't get DRQ\n", unit); 630 return ENXIO; 631 } 632 } 633 634 bd->drq_rid = 0; 635 bd->drq_res = bus_alloc_resource (dev, SYS_RES_DRQ, &bd->drq_rid, 636 drq, drq + 1, 1, RF_ACTIVE); 637 if (! bd->drq_res) { 638 printf ("cx%d: cannot allocate drq\n", unit); 639 bus_release_resource (dev, SYS_RES_IOPORT, bd->base_rid, 640 bd->base_res); 641 return ENXIO; 642 } 643 644 if (bus_get_resource (dev, SYS_RES_IRQ, 0, &irq, &rescount) != 0) { 645 for (i = 0; (irq = irqtab [i]) != 0; i++) { 646 if (!cx_is_free_res (dev, 0, SYS_RES_IRQ, 647 irq, irq + 1, 1)) 648 continue; 649 bus_set_resource (dev, SYS_RES_IRQ, 0, irq, 1); 650 break; 651 } 652 653 if (irqtab[i] == 0) { 654 bus_release_resource (dev, SYS_RES_DRQ, bd->drq_rid, 655 bd->drq_res); 656 bus_release_resource (dev, SYS_RES_IOPORT, bd->base_rid, 657 bd->base_res); 658 printf ("cx%d: Couldn't get IRQ\n", unit); 659 return ENXIO; 660 } 661 } 662 663 bd->irq_rid = 0; 664 bd->irq_res = bus_alloc_resource (dev, SYS_RES_IRQ, &bd->irq_rid, 665 irq, irq + 1, 1, RF_ACTIVE); 666 if (! bd->irq_res) { 667 printf ("cx%d: Couldn't allocate irq\n", unit); 668 bus_release_resource (dev, SYS_RES_DRQ, bd->drq_rid, 669 bd->drq_res); 670 bus_release_resource (dev, SYS_RES_IOPORT, bd->base_rid, 671 bd->base_res); 672 return ENXIO; 673 } 674 675 b = malloc (sizeof (cx_board_t), M_DEVBUF, M_WAITOK); 676 if (!b) { 677 printf ("cx:%d: Couldn't allocate memory\n", unit); 678 return (ENXIO); 679 } 680 adapter[unit] = b; 681 bzero (b, sizeof(cx_board_t)); 682 683 if (! cx_open_board (b, unit, iobase, irq, drq)) { 684 printf ("cx%d: error loading firmware\n", unit); 685 free (b, M_DEVBUF); 686 bus_release_resource (dev, SYS_RES_IRQ, bd->irq_rid, 687 bd->irq_res); 688 bus_release_resource (dev, SYS_RES_DRQ, bd->drq_rid, 689 bd->drq_res); 690 bus_release_resource (dev, SYS_RES_IOPORT, bd->base_rid, 691 bd->base_res); 692 return ENXIO; 693 } 694 695 bd->board = b; 696 697 if (! probe_irq (b, irq)) { 698 printf ("cx%d: irq %ld not functional\n", unit, irq); 699 bd->board = 0; 700 adapter [unit] = 0; 701 free (b, M_DEVBUF); 702 bus_release_resource (dev, SYS_RES_IRQ, bd->irq_rid, 703 bd->irq_res); 704 bus_release_resource (dev, SYS_RES_DRQ, bd->drq_rid, 705 bd->drq_res); 706 bus_release_resource (dev, SYS_RES_IOPORT, bd->base_rid, 707 bd->base_res); 708 return ENXIO; 709 } 710 711 s = splhigh (); 712 if (bus_setup_intr (dev, bd->irq_res, INTR_TYPE_NET, cx_intr, bd, 713 &bd->intrhand)) { 714 printf ("cx%d: Can't setup irq %ld\n", unit, irq); 715 bd->board = 0; 716 adapter [unit] = 0; 717 free (b, M_DEVBUF); 718 bus_release_resource (dev, SYS_RES_IRQ, bd->irq_rid, 719 bd->irq_res); 720 bus_release_resource (dev, SYS_RES_DRQ, bd->drq_rid, 721 bd->drq_res); 722 bus_release_resource (dev, SYS_RES_IOPORT, bd->base_rid, 723 bd->base_res); 724 splx (s); 725 return ENXIO; 726 } 727 728 cx_init (b, b->num, b->port, irq, drq); 729 cx_setup_board (b, 0, 0, 0); 730 731 printf ("cx%d: <Cronyx-Sigma-%s>\n", b->num, b->name); 732 733 for (c=b->chan; c<b->chan+NCHAN; ++c) { 734 if (c->type == T_NONE) 735 continue; 736 d = &bd->channel[c->num]; 737 d->dmamem.size = sizeof(cx_buf_t); 738 if (! cx_bus_dma_mem_alloc (unit, c->num, &d->dmamem)) 739 continue; 740 channel [b->num*NCHAN + c->num] = d; 741 sprintf (d->name, "cx%d.%d", b->num, c->num); 742 d->board = b; 743 d->chan = c; 744 d->open_dev = 0; 745 c->sys = d; 746 747 switch (c->type) { 748 case T_SYNC_RS232: 749 case T_SYNC_V35: 750 case T_SYNC_RS449: 751 case T_UNIV: 752 case T_UNIV_RS232: 753 case T_UNIV_RS449: 754 case T_UNIV_V35: 755#ifdef NETGRAPH 756 if (ng_make_node_common (&typestruct, &d->node) != 0) { 757 printf ("%s: cannot make common node\n", d->name); 758 channel [b->num*NCHAN + c->num] = 0; 759 c->sys = 0; 760 cx_bus_dma_mem_free (&d->dmamem); 761 continue; 762 } 763 NG_NODE_SET_PRIVATE (d->node, d); 764 sprintf (d->nodename, "%s%d", NG_CX_NODE_TYPE, 765 c->board->num*NCHAN + c->num); 766 if (ng_name_node (d->node, d->nodename)) { 767 printf ("%s: cannot name node\n", d->nodename); 768 NG_NODE_UNREF (d->node); 769 channel [b->num*NCHAN + c->num] = 0; 770 c->sys = 0; 771 cx_bus_dma_mem_free (&d->dmamem); 772 continue; 773 } 774 d->lo_queue.ifq_maxlen = IFQ_MAXLEN; 775 d->hi_queue.ifq_maxlen = IFQ_MAXLEN; 776 mtx_init (&d->lo_queue.ifq_mtx, "cx_queue_lo", NULL, MTX_DEF); 777 mtx_init (&d->hi_queue.ifq_mtx, "cx_queue_hi", NULL, MTX_DEF); 778#else /*NETGRAPH*/ 779 d->pp.pp_if.if_softc = d; 780 if_initname (&d->pp.pp_if, "cx", b->num * NCHAN + c->num); 781 d->pp.pp_if.if_mtu = PP_MTU; 782 d->pp.pp_if.if_flags = IFF_POINTOPOINT | IFF_MULTICAST | 783 IFF_NEEDSGIANT; 784 d->pp.pp_if.if_ioctl = cx_sioctl; 785 d->pp.pp_if.if_start = cx_ifstart; 786 d->pp.pp_if.if_watchdog = cx_ifwatchdog; 787 d->pp.pp_if.if_init = cx_initialize; 788 sppp_attach (&d->pp.pp_if); 789 if_attach (&d->pp.pp_if); 790 d->pp.pp_tlf = cx_tlf; 791 d->pp.pp_tls = cx_tls; 792 /* If BPF is in the kernel, call the attach for it. 793 * Size of PPP header is 4 bytes. */ 794 bpfattach (&d->pp.pp_if, DLT_PPP, 4); 795#endif /*NETGRAPH*/ 796 } 797 d->tty = ttyalloc (); 798 d->tty->t_open = cx_topen; 799 d->tty->t_close = cx_tclose; 800 d->tty->t_param = cx_param; 801 d->tty->t_stop = cx_stop; 802 d->tty->t_modem = cx_tmodem; 803 d->tty->t_sc = d; 804 cx_start_chan (c, d->dmamem.virt, d->dmamem.phys); 805 cx_register_receive (c, &cx_receive); 806 cx_register_transmit (c, &cx_transmit); 807 cx_register_error (c, &cx_error); 808 cx_register_modem (c, &cx_modem); 809 810 ttycreate(d->tty, NULL, 0, MINOR_CALLOUT, 811 "x%r%r", b->num, c->num); 812 d->devt = make_dev (&cx_cdevsw, b->num*NCHAN + c->num + 64, UID_ROOT, GID_WHEEL, 0600, "cx%d", b->num*NCHAN + c->num); 813 d->devt->si_drv1 = d; 814 } 815 splx (s); 816 817 return 0; 818} 819 820static int cx_detach (device_t dev) 821{ 822 bdrv_t *bd = device_get_softc (dev); 823 cx_board_t *b = bd->board; 824 cx_chan_t *c; 825 int s = splhigh (); 826 827 /* Check if the device is busy (open). */ 828 for (c = b->chan; c < b->chan + NCHAN; ++c) { 829 drv_t *d = (drv_t*) c->sys; 830 831 if (!d || d->chan->type == T_NONE) 832 continue; 833 if (d->lock) { 834 splx (s); 835 return EBUSY; 836 } 837 if (c->mode == M_ASYNC && d->tty && (d->tty->t_state & TS_ISOPEN) && 838 (d->open_dev|0x2)) { 839 splx (s); 840 return EBUSY; 841 } 842 if (d->running) { 843 splx (s); 844 return EBUSY; 845 } 846 } 847 848 /* Deactivate the timeout routine. And soft interrupt*/ 849 if (led_timo[b->num].callout) 850 untimeout (cx_led_off, b, led_timo[b->num]); 851 852 for (c = b->chan; c < b->chan + NCHAN; ++c) { 853 drv_t *d = c->sys; 854 855 if (!d || d->chan->type == T_NONE) 856 continue; 857 858 if (d->dcd_timeout_handle.callout) 859 untimeout (cx_carrier, c, d->dcd_timeout_handle); 860 } 861 bus_teardown_intr (dev, bd->irq_res, bd->intrhand); 862 bus_deactivate_resource (dev, SYS_RES_IRQ, bd->irq_rid, bd->irq_res); 863 bus_release_resource (dev, SYS_RES_IRQ, bd->irq_rid, bd->irq_res); 864 865 bus_deactivate_resource (dev, SYS_RES_DRQ, bd->drq_rid, bd->drq_res); 866 bus_release_resource (dev, SYS_RES_DRQ, bd->drq_rid, bd->drq_res); 867 868 bus_deactivate_resource (dev, SYS_RES_IOPORT, bd->base_rid, bd->irq_res); 869 bus_release_resource (dev, SYS_RES_IOPORT, bd->base_rid, bd->base_res); 870 871 cx_close_board (b); 872 873 /* Detach the interfaces, free buffer memory. */ 874 for (c = b->chan; c < b->chan + NCHAN; ++c) { 875 drv_t *d = (drv_t*) c->sys; 876 877 if (!d || d->chan->type == T_NONE) 878 continue; 879 880 if (d->tty) { 881 ttyfree (d->tty); 882 d->tty = NULL; 883 } 884 885#ifdef NETGRAPH 886 if (d->node) { 887 ng_rmnode_self (d->node); 888 NG_NODE_UNREF (d->node); 889 d->node = NULL; 890 } 891 mtx_destroy (&d->lo_queue.ifq_mtx); 892 mtx_destroy (&d->hi_queue.ifq_mtx); 893#else 894 /* Detach from the packet filter list of interfaces. */ 895 bpfdetach (&d->pp.pp_if); 896 /* Detach from the sync PPP list. */ 897 sppp_detach (&d->pp.pp_if); 898 899 if_detach (&d->pp.pp_if); 900#endif 901 destroy_dev (d->devt); 902 } 903 904 cx_led_off (b); 905 if (led_timo[b->num].callout) 906 untimeout (cx_led_off, b, led_timo[b->num]); 907 splx (s); 908 909 s = splhigh (); 910 for (c = b->chan; c < b->chan + NCHAN; ++c) { 911 drv_t *d = (drv_t*) c->sys; 912 913 if (!d || d->chan->type == T_NONE) 914 continue; 915 916 /* Deallocate buffers. */ 917 cx_bus_dma_mem_free (&d->dmamem); 918 } 919 bd->board = 0; 920 adapter [b->num] = 0; 921 free (b, M_DEVBUF); 922 splx (s); 923 924 return 0; 925} 926 927#ifndef NETGRAPH 928static void cx_ifstart (struct ifnet *ifp) 929{ 930 drv_t *d = ifp->if_softc; 931 932 cx_start (d); 933} 934 935static void cx_ifwatchdog (struct ifnet *ifp) 936{ 937 drv_t *d = ifp->if_softc; 938 939 cx_watchdog (d); 940} 941 942static void cx_tlf (struct sppp *sp) 943{ 944 drv_t *d = sp->pp_if.if_softc; 945 946 CX_DEBUG (d, ("cx_tlf\n")); 947/* cx_set_dtr (d->chan, 0);*/ 948/* cx_set_rts (d->chan, 0);*/ 949 if (!(d->pp.pp_flags & PP_FR) && !(d->pp.pp_if.if_flags & PP_CISCO)) 950 sp->pp_down (sp); 951} 952 953static void cx_tls (struct sppp *sp) 954{ 955 drv_t *d = sp->pp_if.if_softc; 956 957 CX_DEBUG (d, ("cx_tls\n")); 958 if (!(d->pp.pp_flags & PP_FR) && !(d->pp.pp_if.if_flags & PP_CISCO)) 959 sp->pp_up (sp); 960} 961 962/* 963 * Initialization of interface. 964 * It seems to be never called by upper level. 965 */ 966static void cx_initialize (void *softc) 967{ 968 drv_t *d = softc; 969 970 CX_DEBUG (d, ("cx_initialize\n")); 971} 972 973/* 974 * Process an ioctl request. 975 */ 976static int cx_sioctl (struct ifnet *ifp, u_long cmd, caddr_t data) 977{ 978 drv_t *d = ifp->if_softc; 979 int error, s, was_up, should_be_up; 980 981 /* No socket ioctls while the channel is in async mode. */ 982 if (d->chan->type == T_NONE || d->chan->mode == M_ASYNC) 983 return EBUSY; 984 985 /* Socket ioctls on slave subchannels are not allowed. */ 986 was_up = (ifp->if_flags & IFF_RUNNING) != 0; 987 error = sppp_ioctl (ifp, cmd, data); 988 if (error) 989 return error; 990 991 if (! (ifp->if_flags & IFF_DEBUG)) 992 d->chan->debug = 0; 993 else if (! d->chan->debug) 994 d->chan->debug = 1; 995 996 switch (cmd) { 997 default: CX_DEBUG2 (d, ("ioctl 0x%lx\n", cmd)); return 0; 998 case SIOCADDMULTI: CX_DEBUG2 (d, ("SIOCADDMULTI\n")); return 0; 999 case SIOCDELMULTI: CX_DEBUG2 (d, ("SIOCDELMULTI\n")); return 0; 1000 case SIOCSIFFLAGS: CX_DEBUG2 (d, ("SIOCSIFFLAGS\n")); break; 1001 case SIOCSIFADDR: CX_DEBUG2 (d, ("SIOCSIFADDR\n")); break; 1002 } 1003 1004 /* We get here only in case of SIFFLAGS or SIFADDR. */ 1005 s = splhigh (); 1006 should_be_up = (ifp->if_flags & IFF_RUNNING) != 0; 1007 if (!was_up && should_be_up) { 1008 /* Interface goes up -- start it. */ 1009 cx_up (d); 1010 cx_start (d); 1011 } else if (was_up && !should_be_up) { 1012 /* Interface is going down -- stop it. */ 1013 /* if ((d->pp.pp_flags & PP_FR) || (ifp->if_flags & PP_CISCO))*/ 1014 cx_down (d); 1015 } 1016 splx (s); 1017 return 0; 1018} 1019#endif /*NETGRAPH*/ 1020 1021/* 1022 * Stop the interface. Called on splimp(). 1023 */ 1024static void cx_down (drv_t *d) 1025{ 1026 int s = splhigh (); 1027 CX_DEBUG (d, ("cx_down\n")); 1028 cx_set_dtr (d->chan, 0); 1029 cx_set_rts (d->chan, 0); 1030 d->running = 0; 1031 splx (s); 1032} 1033 1034/* 1035 * Start the interface. Called on splimp(). 1036 */ 1037static void cx_up (drv_t *d) 1038{ 1039 int s = splhigh (); 1040 CX_DEBUG (d, ("cx_up\n")); 1041 cx_set_dtr (d->chan, 1); 1042 cx_set_rts (d->chan, 1); 1043 d->running = 1; 1044 splx (s); 1045} 1046 1047/* 1048 * Start output on the (slave) interface. Get another datagram to send 1049 * off of the interface queue, and copy it to the interface 1050 * before starting the output. 1051 */ 1052static void cx_send (drv_t *d) 1053{ 1054 struct mbuf *m; 1055 u_short len; 1056 1057 CX_DEBUG2 (d, ("cx_send\n")); 1058 1059 /* No output if the interface is down. */ 1060 if (! d->running) 1061 return; 1062 1063 /* No output if the modem is off. */ 1064 if (! cx_get_dsr (d->chan) && ! cx_get_loop(d->chan)) 1065 return; 1066 1067 if (cx_buf_free (d->chan)) { 1068 /* Get the packet to send. */ 1069#ifdef NETGRAPH 1070 IF_DEQUEUE (&d->hi_queue, m); 1071 if (! m) 1072 IF_DEQUEUE (&d->lo_queue, m); 1073#else 1074 m = sppp_dequeue (&d->pp.pp_if); 1075#endif 1076 if (! m) 1077 return; 1078#ifndef NETGRAPH 1079 if (d->pp.pp_if.if_bpf) 1080 BPF_MTAP (&d->pp.pp_if, m); 1081#endif 1082 len = m->m_pkthdr.len; 1083 if (! m->m_next) 1084 cx_send_packet (d->chan, (u_char*)mtod (m, caddr_t), 1085 len, 0); 1086 else { 1087 u_char buf [DMABUFSZ]; 1088 m_copydata (m, 0, len, buf); 1089 cx_send_packet (d->chan, buf, len, 0); 1090 } 1091 m_freem (m); 1092 1093 /* Set up transmit timeout, 10 seconds. */ 1094#ifdef NETGRAPH 1095 d->timeout = 10; 1096#else 1097 d->pp.pp_if.if_timer = 10; 1098#endif 1099 } 1100#ifndef NETGRAPH 1101 d->pp.pp_if.if_flags |= IFF_OACTIVE; 1102#endif 1103} 1104 1105/* 1106 * Start output on the interface. 1107 * Always called on splimp(). 1108 */ 1109static void cx_start (drv_t *d) 1110{ 1111 int s = splhigh (); 1112 if (d->running) { 1113 if (! d->chan->dtr) 1114 cx_set_dtr (d->chan, 1); 1115 if (! d->chan->rts) 1116 cx_set_rts (d->chan, 1); 1117 cx_send (d); 1118 } 1119 splx (s); 1120} 1121 1122/* 1123 * Handle transmit timeouts. 1124 * Recover after lost transmit interrupts. 1125 * Always called on splimp(). 1126 */ 1127static void cx_watchdog (drv_t *d) 1128{ 1129 int s = splhigh (); 1130 CX_DEBUG (d, ("device timeout\n")); 1131 if (d->running) { 1132 cx_setup_chan (d->chan); 1133 cx_start_chan (d->chan, 0, 0); 1134 cx_set_dtr (d->chan, 1); 1135 cx_set_rts (d->chan, 1); 1136 cx_start (d); 1137 } 1138 splx (s); 1139} 1140 1141/* 1142 * Transmit callback function. 1143 */ 1144static void cx_transmit (cx_chan_t *c, void *attachment, int len) 1145{ 1146 drv_t *d = c->sys; 1147 1148 if (!d) 1149 return; 1150 1151 if (c->mode == M_ASYNC && d->tty) { 1152 d->tty->t_state &= ~(TS_BUSY | TS_FLUSH); 1153 d->atimeout = 0; 1154 if (d->tty->t_dev) { 1155 d->intr_action |= CX_WRITE; 1156 MY_SOFT_INTR = 1; 1157 swi_sched (cx_fast_ih, 0); 1158 } 1159 return; 1160 } 1161#ifdef NETGRAPH 1162 d->timeout = 0; 1163#else 1164 ++d->pp.pp_if.if_opackets; 1165 d->pp.pp_if.if_flags &= ~IFF_OACTIVE; 1166 d->pp.pp_if.if_timer = 0; 1167#endif 1168 cx_start (d); 1169} 1170 1171/* 1172 * Process the received packet. 1173 */ 1174static void cx_receive (cx_chan_t *c, char *data, int len) 1175{ 1176 drv_t *d = c->sys; 1177 struct mbuf *m; 1178 char *cc = data; 1179#if defined NETGRAPH 1180 int error; 1181#endif 1182 1183 if (!d) 1184 return; 1185 1186 if (c->mode == M_ASYNC && d->tty) { 1187 if (d->tty->t_state & TS_ISOPEN) { 1188 async_q *q = &d->aqueue; 1189 int size = BF_SZ - 1 - AQ_GSZ (q); 1190 1191 if (len <= 0 && !size) 1192 return; 1193 1194 if (len > size) { 1195 c->ierrs++; 1196 cx_error (c, CX_OVERRUN); 1197 len = size - 1; 1198 } 1199 1200 while (len--) { 1201 AQ_PUSH (q, *(unsigned char *)cc); 1202 cc++; 1203 } 1204 1205 d->intr_action |= CX_READ; 1206 MY_SOFT_INTR = 1; 1207 swi_sched (cx_fast_ih, 0); 1208 } 1209 return; 1210 } 1211 if (! d->running) 1212 return; 1213 1214 m = makembuf (data, len); 1215 if (! m) { 1216 CX_DEBUG (d, ("no memory for packet\n")); 1217#ifndef NETGRAPH 1218 ++d->pp.pp_if.if_iqdrops; 1219#endif 1220 return; 1221 } 1222 if (c->debug > 1) 1223 printmbuf (m); 1224#ifdef NETGRAPH 1225 m->m_pkthdr.rcvif = 0; 1226 NG_SEND_DATA_ONLY (error, d->hook, m); 1227#else 1228 ++d->pp.pp_if.if_ipackets; 1229 m->m_pkthdr.rcvif = &d->pp.pp_if; 1230 /* Check if there's a BPF listener on this interface. 1231 * If so, hand off the raw packet to bpf. */ 1232 if (d->pp.pp_if.if_bpf) 1233 BPF_TAP (&d->pp.pp_if, data, len); 1234 sppp_input (&d->pp.pp_if, m); 1235#endif 1236} 1237 1238#define CONDITION(t,tp) (!(t->c_iflag & (ICRNL | IGNCR | IMAXBEL | INLCR | ISTRIP | IXON))\ 1239 && (!(tp->t_iflag & BRKINT) || (tp->t_iflag & IGNBRK))\ 1240 && (!(tp->t_iflag & PARMRK)\ 1241 || (tp->t_iflag & (IGNPAR | IGNBRK)) == (IGNPAR | IGNBRK))\ 1242 && !(t->c_lflag & (ECHO | ICANON | IEXTEN | ISIG | PENDIN))\ 1243 && linesw[tp->t_line]->l_rint == ttyinput) 1244 1245/* 1246 * Error callback function. 1247 */ 1248static void cx_error (cx_chan_t *c, int data) 1249{ 1250 drv_t *d = c->sys; 1251 async_q *q; 1252 1253 if (!d) 1254 return; 1255 1256 q = &(d->aqueue); 1257 1258 switch (data) { 1259 case CX_FRAME: 1260 CX_DEBUG (d, ("frame error\n")); 1261 if (c->mode == M_ASYNC && d->tty && (d->tty->t_state & TS_ISOPEN) 1262 && (AQ_GSZ (q) < BF_SZ - 1) 1263 && (!CONDITION((&d->tty->t_termios), (d->tty)) 1264 || !(d->tty->t_iflag & (IGNPAR | PARMRK)))) { 1265 AQ_PUSH (q, TTY_FE); 1266 d->intr_action |= CX_READ; 1267 MY_SOFT_INTR = 1; 1268 swi_sched (cx_fast_ih, 0); 1269 } 1270#ifndef NETGRAPH 1271 else 1272 ++d->pp.pp_if.if_ierrors; 1273#endif 1274 break; 1275 case CX_CRC: 1276 CX_DEBUG (d, ("crc error\n")); 1277 if (c->mode == M_ASYNC && d->tty && (d->tty->t_state & TS_ISOPEN) 1278 && (AQ_GSZ (q) < BF_SZ - 1) 1279 && (!CONDITION((&d->tty->t_termios), (d->tty)) 1280 || !(d->tty->t_iflag & INPCK) 1281 || !(d->tty->t_iflag & (IGNPAR | PARMRK)))) { 1282 AQ_PUSH (q, TTY_PE); 1283 d->intr_action |= CX_READ; 1284 MY_SOFT_INTR = 1; 1285 swi_sched (cx_fast_ih, 0); 1286 } 1287#ifndef NETGRAPH 1288 else 1289 ++d->pp.pp_if.if_ierrors; 1290#endif 1291 break; 1292 case CX_OVERRUN: 1293 CX_DEBUG (d, ("overrun error\n")); 1294#ifdef TTY_OE 1295 if (c->mode == M_ASYNC && d->tty && (d->tty->t_state & TS_ISOPEN) 1296 && (AQ_GSZ (q) < BF_SZ - 1) 1297 && (!CONDITION((&d->tty->t_termios), (d->tty)))) { 1298 AQ_PUSH (q, TTY_OE); 1299 d->intr_action |= CX_READ; 1300 MY_SOFT_INTR = 1; 1301 swi_sched (cx_fast_ih, 0); 1302 } 1303#endif 1304#ifndef NETGRAPH 1305 else { 1306 ++d->pp.pp_if.if_collisions; 1307 ++d->pp.pp_if.if_ierrors; 1308 } 1309#endif 1310 break; 1311 case CX_OVERFLOW: 1312 CX_DEBUG (d, ("overflow error\n")); 1313#ifndef NETGRAPH 1314 if (c->mode != M_ASYNC) 1315 ++d->pp.pp_if.if_ierrors; 1316#endif 1317 break; 1318 case CX_UNDERRUN: 1319 CX_DEBUG (d, ("underrun error\n")); 1320 if (c->mode != M_ASYNC) { 1321#ifdef NETGRAPH 1322 d->timeout = 0; 1323#else 1324 ++d->pp.pp_if.if_oerrors; 1325 d->pp.pp_if.if_flags &= ~IFF_OACTIVE; 1326 d->pp.pp_if.if_timer = 0; 1327 cx_start (d); 1328#endif 1329 } 1330 break; 1331 case CX_BREAK: 1332 CX_DEBUG (d, ("break error\n")); 1333 if (c->mode == M_ASYNC && d->tty && (d->tty->t_state & TS_ISOPEN) 1334 && (AQ_GSZ (q) < BF_SZ - 1) 1335 && (!CONDITION((&d->tty->t_termios), (d->tty)) 1336 || !(d->tty->t_iflag & (IGNBRK | BRKINT | PARMRK)))) { 1337 AQ_PUSH (q, TTY_BI); 1338 d->intr_action |= CX_READ; 1339 MY_SOFT_INTR = 1; 1340 swi_sched (cx_fast_ih, 0); 1341 } 1342#ifndef NETGRAPH 1343 else 1344 ++d->pp.pp_if.if_ierrors; 1345#endif 1346 break; 1347 default: 1348 CX_DEBUG (d, ("error #%d\n", data)); 1349 } 1350} 1351 1352static int cx_topen (struct tty *tp, struct cdev *dev) 1353{ 1354 drv_t *d; 1355 1356 d = tp->t_sc; 1357 if (d->chan->mode != M_ASYNC) 1358 return (EBUSY); 1359 d->open_dev |= 0x2; 1360 cx_start_chan (d->chan, 0, 0); 1361 cx_set_dtr (d->chan, 1); 1362 cx_set_rts (d->chan, 1); 1363 d->cd = cx_get_cd (d->chan); 1364 return (0); 1365} 1366 1367static void cx_tclose (struct tty *tp) 1368{ 1369 drv_t *d; 1370 1371 d = tp->t_sc; 1372 /* Disable receiver. 1373 * Transmitter continues sending the queued data. */ 1374 cx_enable_receive (d->chan, 0); 1375 d->open_dev &= ~0x2; 1376} 1377 1378static int cx_tmodem (struct tty *tp, int sigon, int sigoff) 1379{ 1380 drv_t *d; 1381 1382 d = tp->t_sc; 1383 1384 if (!sigon && !sigoff) { 1385 if (cx_get_dsr (d->chan)) sigon |= SER_DSR; 1386 if (cx_get_cd (d->chan)) sigon |= SER_DCD; 1387 if (cx_get_cts (d->chan)) sigon |= SER_CTS; 1388 if (d->chan->dtr) sigon |= SER_DTR; 1389 if (d->chan->rts) sigon |= SER_RTS; 1390 return sigon; 1391 } 1392 1393 if (sigon & SER_DTR) 1394 cx_set_dtr (d->chan, 1); 1395 if (sigoff & SER_DTR) 1396 cx_set_dtr (d->chan, 0); 1397 if (sigon & SER_RTS) 1398 cx_set_rts (d->chan, 1); 1399 if (sigoff & SER_RTS) 1400 cx_set_rts (d->chan, 0); 1401 return (0); 1402} 1403 1404static int cx_open (struct cdev *dev, int flag, int mode, struct thread *td) 1405{ 1406 int unit; 1407 drv_t *d; 1408 1409 d = dev->si_drv1; 1410 unit = d->chan->num; 1411 CX_DEBUG2 (d, ("cx_open unit=%d, flag=0x%x, mode=0x%x\n", 1412 unit, flag, mode)); 1413 1414 d->open_dev |= 0x1; 1415 return 0; 1416} 1417 1418static int cx_close (struct cdev *dev, int flag, int mode, struct thread *td) 1419{ 1420 drv_t *d; 1421 1422 d = dev->si_drv1; 1423 CX_DEBUG2 (d, ("cx_close\n")); 1424 d->open_dev &= ~0x1; 1425 return 0; 1426} 1427 1428static int cx_modem_status (drv_t *d) 1429{ 1430 int status = 0, s = splhigh (); 1431 1432 /* Already opened by someone or network interface is up? */ 1433 if ((d->chan->mode == M_ASYNC && d->tty && (d->tty->t_state & TS_ISOPEN) && 1434 (d->open_dev|0x2)) || (d->chan->mode != M_ASYNC && d->running)) 1435 status = TIOCM_LE; /* always enabled while open */ 1436 1437 if (cx_get_dsr (d->chan)) status |= TIOCM_DSR; 1438 if (cx_get_cd (d->chan)) status |= TIOCM_CD; 1439 if (cx_get_cts (d->chan)) status |= TIOCM_CTS; 1440 if (d->chan->dtr) status |= TIOCM_DTR; 1441 if (d->chan->rts) status |= TIOCM_RTS; 1442 1443 splx (s); 1444 return status; 1445} 1446 1447static int cx_ioctl (struct cdev *dev, u_long cmd, caddr_t data, int flag, struct thread *td) 1448{ 1449 drv_t *d; 1450 cx_chan_t *c; 1451 struct serial_statistics *st; 1452 int error, s; 1453 char mask[16]; 1454 1455 d = dev->si_drv1; 1456 c = d->chan; 1457 1458 switch (cmd) { 1459 case SERIAL_GETREGISTERED: 1460 CX_DEBUG2 (d, ("ioctl: getregistered\n")); 1461 bzero (mask, sizeof(mask)); 1462 for (s=0; s<NCX*NCHAN; ++s) 1463 if (channel [s]) 1464 mask [s/8] |= 1 << (s & 7); 1465 bcopy (mask, data, sizeof (mask)); 1466 return 0; 1467 1468 case SERIAL_GETPORT: 1469 CX_DEBUG2 (d, ("ioctl: getport\n")); 1470 s = splhigh (); 1471 *(int *)data = cx_get_port (c); 1472 splx (s); 1473 if (*(int *)data<0) 1474 return (EINVAL); 1475 else 1476 return 0; 1477 1478 case SERIAL_SETPORT: 1479 CX_DEBUG2 (d, ("ioctl: setproto\n")); 1480 /* Only for superuser! */ 1481 error = suser (td); 1482 if (error) 1483 return error; 1484 1485 s = splhigh (); 1486 cx_set_port (c, *(int *)data); 1487 splx (s); 1488 return 0; 1489 1490#ifndef NETGRAPH 1491 case SERIAL_GETPROTO: 1492 CX_DEBUG2 (d, ("ioctl: getproto\n")); 1493 s = splhigh (); 1494 strcpy ((char*)data, (c->mode == M_ASYNC) ? "async" : 1495 (d->pp.pp_flags & PP_FR) ? "fr" : 1496 (d->pp.pp_if.if_flags & PP_CISCO) ? "cisco" : "ppp"); 1497 splx (s); 1498 return 0; 1499 1500 case SERIAL_SETPROTO: 1501 CX_DEBUG2 (d, ("ioctl: setproto\n")); 1502 /* Only for superuser! */ 1503 error = suser (td); 1504 if (error) 1505 return error; 1506 if (c->mode == M_ASYNC) 1507 return EBUSY; 1508 if (d->pp.pp_if.if_flags & IFF_RUNNING) 1509 return EBUSY; 1510 if (! strcmp ("cisco", (char*)data)) { 1511 d->pp.pp_flags &= ~(PP_FR); 1512 d->pp.pp_flags |= PP_KEEPALIVE; 1513 d->pp.pp_if.if_flags |= PP_CISCO; 1514 } else if (! strcmp ("fr", (char*)data)) { 1515 d->pp.pp_if.if_flags &= ~(PP_CISCO); 1516 d->pp.pp_flags |= PP_FR | PP_KEEPALIVE; 1517 } else if (! strcmp ("ppp", (char*)data)) { 1518 d->pp.pp_flags &= ~(PP_FR | PP_KEEPALIVE); 1519 d->pp.pp_if.if_flags &= ~(PP_CISCO); 1520 } else 1521 return EINVAL; 1522 return 0; 1523 1524 case SERIAL_GETKEEPALIVE: 1525 CX_DEBUG2 (d, ("ioctl: getkeepalive\n")); 1526 if ((d->pp.pp_flags & PP_FR) || 1527 (d->pp.pp_if.if_flags & PP_CISCO) || 1528 (c->mode == M_ASYNC)) 1529 return EINVAL; 1530 s = splhigh (); 1531 *(int*)data = (d->pp.pp_flags & PP_KEEPALIVE) ? 1 : 0; 1532 splx (s); 1533 return 0; 1534 1535 case SERIAL_SETKEEPALIVE: 1536 CX_DEBUG2 (d, ("ioctl: setkeepalive\n")); 1537 /* Only for superuser! */ 1538 error = suser (td); 1539 if (error) 1540 return error; 1541 if ((d->pp.pp_flags & PP_FR) || 1542 (d->pp.pp_if.if_flags & PP_CISCO)) 1543 return EINVAL; 1544 s = splhigh (); 1545 if (*(int*)data) 1546 d->pp.pp_flags |= PP_KEEPALIVE; 1547 else 1548 d->pp.pp_flags &= ~PP_KEEPALIVE; 1549 splx (s); 1550 return 0; 1551#endif /*NETGRAPH*/ 1552 1553 case SERIAL_GETMODE: 1554 CX_DEBUG2 (d, ("ioctl: getmode\n")); 1555 s = splhigh (); 1556 *(int*)data = (c->mode == M_ASYNC) ? 1557 SERIAL_ASYNC : SERIAL_HDLC; 1558 splx (s); 1559 return 0; 1560 1561 case SERIAL_SETMODE: 1562 CX_DEBUG2 (d, ("ioctl: setmode\n")); 1563 /* Only for superuser! */ 1564 error = suser (td); 1565 if (error) 1566 return error; 1567 1568 /* Somebody is waiting for carrier? */ 1569 if (d->lock) 1570 return EBUSY; 1571 /* /dev/ttyXX is already opened by someone? */ 1572 if (c->mode == M_ASYNC && d->tty && (d->tty->t_state & TS_ISOPEN) && 1573 (d->open_dev|0x2)) 1574 return EBUSY; 1575 /* Network interface is up? 1576 * Cannot change to async mode. */ 1577 if (c->mode != M_ASYNC && d->running && 1578 (*(int*)data == SERIAL_ASYNC)) 1579 return EBUSY; 1580 1581 s = splhigh (); 1582 if (c->mode == M_HDLC && *(int*)data == SERIAL_ASYNC) { 1583 cx_set_mode (c, M_ASYNC); 1584 cx_enable_receive (c, 0); 1585 cx_enable_transmit (c, 0); 1586 } else if (c->mode == M_ASYNC && *(int*)data == SERIAL_HDLC) { 1587 cx_set_mode (c, M_HDLC); 1588 cx_enable_receive (c, 1); 1589 cx_enable_transmit (c, 1); 1590 } 1591 splx (s); 1592 return 0; 1593 1594 case SERIAL_GETSTAT: 1595 CX_DEBUG2 (d, ("ioctl: getestat\n")); 1596 st = (struct serial_statistics*) data; 1597 s = splhigh (); 1598 st->rintr = c->rintr; 1599 st->tintr = c->tintr; 1600 st->mintr = c->mintr; 1601 st->ibytes = c->ibytes; 1602 st->ipkts = c->ipkts; 1603 st->ierrs = c->ierrs; 1604 st->obytes = c->obytes; 1605 st->opkts = c->opkts; 1606 st->oerrs = c->oerrs; 1607 splx (s); 1608 return 0; 1609 1610 case SERIAL_CLRSTAT: 1611 CX_DEBUG2 (d, ("ioctl: clrstat\n")); 1612 /* Only for superuser! */ 1613 error = suser (td); 1614 if (error) 1615 return error; 1616 s = splhigh (); 1617 c->rintr = 0; 1618 c->tintr = 0; 1619 c->mintr = 0; 1620 c->ibytes = 0; 1621 c->ipkts = 0; 1622 c->ierrs = 0; 1623 c->obytes = 0; 1624 c->opkts = 0; 1625 c->oerrs = 0; 1626 splx (s); 1627 return 0; 1628 1629 case SERIAL_GETBAUD: 1630 CX_DEBUG2 (d, ("ioctl: getbaud\n")); 1631 if (c->mode == M_ASYNC) 1632 return EINVAL; 1633 s = splhigh (); 1634 *(long*)data = cx_get_baud(c); 1635 splx (s); 1636 return 0; 1637 1638 case SERIAL_SETBAUD: 1639 CX_DEBUG2 (d, ("ioctl: setbaud\n")); 1640 /* Only for superuser! */ 1641 error = suser (td); 1642 if (error) 1643 return error; 1644 if (c->mode == M_ASYNC) 1645 return EINVAL; 1646 s = splhigh (); 1647 cx_set_baud (c, *(long*)data); 1648 splx (s); 1649 return 0; 1650 1651 case SERIAL_GETLOOP: 1652 CX_DEBUG2 (d, ("ioctl: getloop\n")); 1653 if (c->mode == M_ASYNC) 1654 return EINVAL; 1655 s = splhigh (); 1656 *(int*)data = cx_get_loop (c); 1657 splx (s); 1658 return 0; 1659 1660 case SERIAL_SETLOOP: 1661 CX_DEBUG2 (d, ("ioctl: setloop\n")); 1662 /* Only for superuser! */ 1663 error = suser (td); 1664 if (error) 1665 return error; 1666 if (c->mode == M_ASYNC) 1667 return EINVAL; 1668 s = splhigh (); 1669 cx_set_loop (c, *(int*)data); 1670 splx (s); 1671 return 0; 1672 1673 case SERIAL_GETDPLL: 1674 CX_DEBUG2 (d, ("ioctl: getdpll\n")); 1675 if (c->mode == M_ASYNC) 1676 return EINVAL; 1677 s = splhigh (); 1678 *(int*)data = cx_get_dpll (c); 1679 splx (s); 1680 return 0; 1681 1682 case SERIAL_SETDPLL: 1683 CX_DEBUG2 (d, ("ioctl: setdpll\n")); 1684 /* Only for superuser! */ 1685 error = suser (td); 1686 if (error) 1687 return error; 1688 if (c->mode == M_ASYNC) 1689 return EINVAL; 1690 s = splhigh (); 1691 cx_set_dpll (c, *(int*)data); 1692 splx (s); 1693 return 0; 1694 1695 case SERIAL_GETNRZI: 1696 CX_DEBUG2 (d, ("ioctl: getnrzi\n")); 1697 if (c->mode == M_ASYNC) 1698 return EINVAL; 1699 s = splhigh (); 1700 *(int*)data = cx_get_nrzi (c); 1701 splx (s); 1702 return 0; 1703 1704 case SERIAL_SETNRZI: 1705 CX_DEBUG2 (d, ("ioctl: setnrzi\n")); 1706 /* Only for superuser! */ 1707 error = suser (td); 1708 if (error) 1709 return error; 1710 if (c->mode == M_ASYNC) 1711 return EINVAL; 1712 s = splhigh (); 1713 cx_set_nrzi (c, *(int*)data); 1714 splx (s); 1715 return 0; 1716 1717 case SERIAL_GETDEBUG: 1718 CX_DEBUG2 (d, ("ioctl: getdebug\n")); 1719 s = splhigh (); 1720 *(int*)data = c->debug; 1721 splx (s); 1722 return 0; 1723 1724 case SERIAL_SETDEBUG: 1725 CX_DEBUG2 (d, ("ioctl: setdebug\n")); 1726 /* Only for superuser! */ 1727 error = suser (td); 1728 if (error) 1729 return error; 1730 s = splhigh (); 1731 c->debug = *(int*)data; 1732 splx (s); 1733#ifndef NETGRAPH 1734 if (d->chan->debug) 1735 d->pp.pp_if.if_flags |= IFF_DEBUG; 1736 else 1737 d->pp.pp_if.if_flags &= (~IFF_DEBUG); 1738#endif 1739 return 0; 1740 } 1741 1742 switch (cmd) { 1743 case TIOCSDTR: /* Set DTR */ 1744 CX_DEBUG2 (d, ("ioctl: tiocsdtr\n")); 1745 s = splhigh (); 1746 cx_set_dtr (c, 1); 1747 splx (s); 1748 return 0; 1749 1750 case TIOCCDTR: /* Clear DTR */ 1751 CX_DEBUG2 (d, ("ioctl: tioccdtr\n")); 1752 s = splhigh (); 1753 cx_set_dtr (c, 0); 1754 splx (s); 1755 return 0; 1756 1757 case TIOCMSET: /* Set DTR/RTS */ 1758 CX_DEBUG2 (d, ("ioctl: tiocmset\n")); 1759 s = splhigh (); 1760 cx_set_dtr (c, (*(int*)data & TIOCM_DTR) ? 1 : 0); 1761 cx_set_rts (c, (*(int*)data & TIOCM_RTS) ? 1 : 0); 1762 splx (s); 1763 return 0; 1764 1765 case TIOCMBIS: /* Add DTR/RTS */ 1766 CX_DEBUG2 (d, ("ioctl: tiocmbis\n")); 1767 s = splhigh (); 1768 if (*(int*)data & TIOCM_DTR) cx_set_dtr (c, 1); 1769 if (*(int*)data & TIOCM_RTS) cx_set_rts (c, 1); 1770 splx (s); 1771 return 0; 1772 1773 case TIOCMBIC: /* Clear DTR/RTS */ 1774 CX_DEBUG2 (d, ("ioctl: tiocmbic\n")); 1775 s = splhigh (); 1776 if (*(int*)data & TIOCM_DTR) cx_set_dtr (c, 0); 1777 if (*(int*)data & TIOCM_RTS) cx_set_rts (c, 0); 1778 splx (s); 1779 return 0; 1780 1781 case TIOCMGET: /* Get modem status */ 1782 CX_DEBUG2 (d, ("ioctl: tiocmget\n")); 1783 *(int*)data = cx_modem_status (d); 1784 return 0; 1785 1786 } 1787 1788 CX_DEBUG2 (d, ("ioctl: 0x%lx\n", cmd)); 1789 return ENOTTY; 1790} 1791 1792 1793void cx_softintr (void *unused) 1794{ 1795 drv_t *d; 1796 async_q *q; 1797 int i, s, ic, k; 1798 while (MY_SOFT_INTR) { 1799 MY_SOFT_INTR = 0; 1800 for (i=0; i<NCX*NCHAN; ++i) { 1801 d = channel [i]; 1802 if (!d || !d->chan || d->chan->type == T_NONE 1803 || d->chan->mode != M_ASYNC || !d->tty 1804 || !d->tty->t_dev) 1805 continue; 1806 s = splhigh (); 1807 if (d->intr_action & CX_READ) { 1808 q = &(d->aqueue); 1809 if (d->tty->t_state & TS_CAN_BYPASS_L_RINT) { 1810 k = AQ_GSZ(q); 1811 if (d->tty->t_rawq.c_cc + k > 1812 d->tty->t_ihiwat 1813 && (d->tty->t_cflag & CRTS_IFLOW 1814 || d->tty->t_iflag & IXOFF) 1815 && !(d->tty->t_state & TS_TBLOCK)) 1816 ttyblock(d->tty); 1817 d->tty->t_rawcc += k; 1818 while (k>0) { 1819 k--; 1820 AQ_POP (q, ic); 1821 splx (s); 1822 putc (ic, &d->tty->t_rawq); 1823 s = splhigh (); 1824 } 1825 ttwakeup(d->tty); 1826 if (d->tty->t_state & TS_TTSTOP 1827 && (d->tty->t_iflag & IXANY 1828 || d->tty->t_cc[VSTART] == 1829 d->tty->t_cc[VSTOP])) { 1830 d->tty->t_state &= ~TS_TTSTOP; 1831 d->tty->t_lflag &= ~FLUSHO; 1832 d->intr_action |= CX_WRITE; 1833 } 1834 } else { 1835 while (q->end != q->beg) { 1836 AQ_POP (q, ic); 1837 splx (s); 1838 ttyld_rint (d->tty, ic); 1839 s = splhigh (); 1840 } 1841 } 1842 d->intr_action &= ~CX_READ; 1843 } 1844 splx (s); 1845 1846 s = splhigh (); 1847 if (d->intr_action & CX_WRITE) { 1848 if (d->tty->t_line) 1849 ttyld_start (d->tty); 1850 else 1851 cx_oproc (d->tty); 1852 d->intr_action &= ~CX_WRITE; 1853 } 1854 splx (s); 1855 1856 } 1857 } 1858} 1859 1860/* 1861 * Fill transmitter buffer with data. 1862 */ 1863static void cx_oproc (struct tty *tp) 1864{ 1865 int s, k; 1866 drv_t *d; 1867 static u_char buf[DMABUFSZ]; 1868 u_char *p; 1869 u_short len = 0, sublen = 0; 1870 1871 s = splhigh(); 1872 1873 d = tp->t_sc; 1874 1875 CX_DEBUG2 (d, ("cx_oproc\n")); 1876 if (tp->t_cflag & CRTSCTS && (tp->t_state & TS_TBLOCK) && d->chan->rts) 1877 cx_set_rts (d->chan, 0); 1878 else if (tp->t_cflag & CRTSCTS && ! (tp->t_state & TS_TBLOCK) && ! d->chan->rts) 1879 cx_set_rts (d->chan, 1); 1880 1881 if (! (tp->t_state & (TS_TIMEOUT | TS_TTSTOP))) { 1882 /* Start transmitter. */ 1883 cx_enable_transmit (d->chan, 1); 1884 1885 /* Is it busy? */ 1886 if (! cx_buf_free (d->chan)) { 1887 tp->t_state |= TS_BUSY; 1888 splx (s); 1889 return; 1890 } 1891 if (tp->t_iflag & IXOFF) { 1892 p = (buf + (DMABUFSZ/2)); 1893 sublen = q_to_b (&tp->t_outq, p, (DMABUFSZ/2)); 1894 k = sublen; 1895 while (k--) { 1896 /* Send XON/XOFF out of band. */ 1897 if (*p == tp->t_cc[VSTOP]) { 1898 cx_xflow_ctl (d->chan, 0); 1899 p++; 1900 continue; 1901 } 1902 if (*p == tp->t_cc[VSTART]) { 1903 cx_xflow_ctl (d->chan, 1); 1904 p++; 1905 continue; 1906 } 1907 buf[len] = *p; 1908 len++; 1909 p++; 1910 } 1911 } else { 1912 p = buf; 1913 len = q_to_b (&tp->t_outq, p, (DMABUFSZ/2)); 1914 } 1915 if (len) { 1916 cx_send_packet (d->chan, buf, len, 0); 1917 tp->t_state |= TS_BUSY; 1918 d->atimeout = 10; 1919 CX_DEBUG2 (d, ("out %d bytes\n", len)); 1920 } 1921 } 1922 ttwwakeup (tp); 1923 splx (s); 1924} 1925 1926static int cx_param (struct tty *tp, struct termios *t) 1927{ 1928 drv_t *d; 1929 int s, bits, parity; 1930 1931 d = tp->t_sc; 1932 1933 s = splhigh (); 1934 if (t->c_ospeed == 0) { 1935 /* Clear DTR and RTS. */ 1936 cx_set_dtr (d->chan, 0); 1937 splx (s); 1938 CX_DEBUG2 (d, ("cx_param (hangup)\n")); 1939 return 0; 1940 } 1941 CX_DEBUG2 (d, ("cx_param\n")); 1942 1943 /* Check requested parameters. */ 1944 if (t->c_ospeed < 300 || t->c_ospeed > 256*1024) { 1945 splx (s); 1946 return EINVAL; 1947 } 1948 if (t->c_ispeed && (t->c_ispeed < 300 || t->c_ispeed > 256*1024)) { 1949 splx (s); 1950 return EINVAL; 1951 } 1952 1953 /* And copy them to tty and channel structures. */ 1954 tp->t_ispeed = t->c_ispeed = tp->t_ospeed = t->c_ospeed; 1955 tp->t_cflag = t->c_cflag; 1956 1957 /* Set character length and parity mode. */ 1958 switch (t->c_cflag & CSIZE) { 1959 default: 1960 case CS8: bits = 8; break; 1961 case CS7: bits = 7; break; 1962 case CS6: bits = 6; break; 1963 case CS5: bits = 5; break; 1964 } 1965 1966 parity = ((t->c_cflag & PARENB) ? 1 : 0) * 1967 (1 + ((t->c_cflag & PARODD) ? 0 : 1)); 1968 1969 /* Set current channel number. */ 1970 if (! d->chan->dtr) 1971 cx_set_dtr (d->chan, 1); 1972 1973 ttyldoptim (tp); 1974 cx_set_async_param (d->chan, t->c_ospeed, bits, parity, (t->c_cflag & CSTOPB), 1975 !(t->c_cflag & PARENB), (t->c_cflag & CRTSCTS), 1976 (t->c_iflag & IXON), (t->c_iflag & IXANY), 1977 t->c_cc[VSTART], t->c_cc[VSTOP]); 1978 splx (s); 1979 return 0; 1980} 1981 1982/* 1983 * Stop output on a line 1984 */ 1985static void cx_stop (struct tty *tp, int flag) 1986{ 1987 drv_t *d; 1988 int s; 1989 1990 d = tp->t_sc; 1991 s = splhigh (); 1992 1993 if (tp->t_state & TS_BUSY) { 1994 /* Stop transmitter */ 1995 CX_DEBUG2 (d, ("cx_stop\n")); 1996 cx_transmitter_ctl (d->chan, 0); 1997 } 1998 splx (s); 1999} 2000 2001/* 2002 * Process the (delayed) carrier signal setup. 2003 */ 2004static void cx_carrier (void *arg) 2005{ 2006 drv_t *d = arg; 2007 cx_chan_t *c = d->chan; 2008 int s, cd; 2009 2010 s = splhigh (); 2011 cd = cx_get_cd (c); 2012 if (d->cd != cd) { 2013 if (cd) { 2014 CX_DEBUG (d, ("carrier on\n")); 2015 d->cd = 1; 2016 splx (s); 2017 if (d->tty) 2018 ttyld_modem(d->tty, 1); 2019 } else { 2020 CX_DEBUG (d, ("carrier loss\n")); 2021 d->cd = 0; 2022 splx (s); 2023 if (d->tty) 2024 ttyld_modem(d->tty, 0); 2025 } 2026 } 2027} 2028 2029/* 2030 * Modem signal callback function. 2031 */ 2032static void cx_modem (cx_chan_t *c) 2033{ 2034 drv_t *d = c->sys; 2035 2036 if (!d || c->mode != M_ASYNC) 2037 return; 2038 /* Handle carrier detect/loss. */ 2039 untimeout (cx_carrier, c, d->dcd_timeout_handle); 2040 /* Carrier changed - delay processing DCD for a while 2041 * to give both sides some time to initialize. */ 2042 d->dcd_timeout_handle = timeout (cx_carrier, d, hz/2); 2043} 2044 2045static struct cdevsw cx_cdevsw = { 2046 .d_version = D_VERSION, 2047 .d_open = cx_open, 2048 .d_close = cx_close, 2049 .d_ioctl = cx_ioctl, 2050 .d_name = "cx", 2051 .d_flags = D_TTY | D_NEEDGIANT, 2052}; 2053 2054#ifdef NETGRAPH 2055static int ng_cx_constructor (node_p node) 2056{ 2057 drv_t *d = NG_NODE_PRIVATE (node); 2058 CX_DEBUG (d, ("Constructor\n")); 2059 return EINVAL; 2060} 2061 2062static int ng_cx_newhook (node_p node, hook_p hook, const char *name) 2063{ 2064 int s; 2065 drv_t *d = NG_NODE_PRIVATE (node); 2066 2067 if (d->chan->mode == M_ASYNC) 2068 return EINVAL; 2069 2070 /* Attach debug hook */ 2071 if (strcmp (name, NG_CX_HOOK_DEBUG) == 0) { 2072 NG_HOOK_SET_PRIVATE (hook, NULL); 2073 d->debug_hook = hook; 2074 return 0; 2075 } 2076 2077 /* Check for raw hook */ 2078 if (strcmp (name, NG_CX_HOOK_RAW) != 0) 2079 return EINVAL; 2080 2081 NG_HOOK_SET_PRIVATE (hook, d); 2082 d->hook = hook; 2083 s = splhigh (); 2084 cx_up (d); 2085 splx (s); 2086 return 0; 2087} 2088 2089static int print_modems (char *s, cx_chan_t *c, int need_header) 2090{ 2091 int status = cx_modem_status (c->sys); 2092 int length = 0; 2093 2094 if (need_header) 2095 length += sprintf (s + length, " LE DTR DSR RTS CTS CD\n"); 2096 length += sprintf (s + length, "%4s %4s %4s %4s %4s %4s\n", 2097 status & TIOCM_LE ? "On" : "-", 2098 status & TIOCM_DTR ? "On" : "-", 2099 status & TIOCM_DSR ? "On" : "-", 2100 status & TIOCM_RTS ? "On" : "-", 2101 status & TIOCM_CTS ? "On" : "-", 2102 status & TIOCM_CD ? "On" : "-"); 2103 return length; 2104} 2105 2106static int print_stats (char *s, cx_chan_t *c, int need_header) 2107{ 2108 int length = 0; 2109 2110 if (need_header) 2111 length += sprintf (s + length, " Rintr Tintr Mintr Ibytes Ipkts Ierrs Obytes Opkts Oerrs\n"); 2112 length += sprintf (s + length, "%7ld %7ld %7ld %8ld %7ld %7ld %8ld %7ld %7ld\n", 2113 c->rintr, c->tintr, c->mintr, c->ibytes, c->ipkts, 2114 c->ierrs, c->obytes, c->opkts, c->oerrs); 2115 return length; 2116} 2117 2118static int print_chan (char *s, cx_chan_t *c) 2119{ 2120 drv_t *d = c->sys; 2121 int length = 0; 2122 2123 length += sprintf (s + length, "cx%d", c->board->num * NCHAN + c->num); 2124 if (d->chan->debug) 2125 length += sprintf (s + length, " debug=%d", d->chan->debug); 2126 2127 if (cx_get_baud (c)) 2128 length += sprintf (s + length, " %ld", cx_get_baud (c)); 2129 else 2130 length += sprintf (s + length, " extclock"); 2131 2132 if (c->mode == M_HDLC) { 2133 length += sprintf (s + length, " dpll=%s", cx_get_dpll (c) ? "on" : "off"); 2134 length += sprintf (s + length, " nrzi=%s", cx_get_nrzi (c) ? "on" : "off"); 2135 } 2136 2137 length += sprintf (s + length, " loop=%s", cx_get_loop (c) ? "on\n" : "off\n"); 2138 return length; 2139} 2140 2141static int ng_cx_rcvmsg (node_p node, item_p item, hook_p lasthook) 2142{ 2143 drv_t *d = NG_NODE_PRIVATE (node); 2144 struct ng_mesg *msg; 2145 struct ng_mesg *resp = NULL; 2146 int error = 0; 2147 2148 if (!d) 2149 return EINVAL; 2150 2151 CX_DEBUG (d, ("Rcvmsg\n")); 2152 NGI_GET_MSG (item, msg); 2153 switch (msg->header.typecookie) { 2154 default: 2155 error = EINVAL; 2156 break; 2157 2158 case NGM_CX_COOKIE: 2159 printf ("Don't forget to implement\n"); 2160 error = EINVAL; 2161 break; 2162 2163 case NGM_GENERIC_COOKIE: 2164 switch (msg->header.cmd) { 2165 default: 2166 error = EINVAL; 2167 break; 2168 2169 case NGM_TEXT_STATUS: { 2170 char *s; 2171 int l = 0; 2172 int dl = sizeof (struct ng_mesg) + 730; 2173 2174 NG_MKRESPONSE (resp, msg, dl, M_NOWAIT); 2175 if (! resp) { 2176 error = ENOMEM; 2177 break; 2178 } 2179 bzero (resp, dl); 2180 s = (resp)->data; 2181 l += print_chan (s + l, d->chan); 2182 l += print_stats (s + l, d->chan, 1); 2183 l += print_modems (s + l, d->chan, 1); 2184 strncpy ((resp)->header.cmdstr, "status", NG_CMDSTRLEN); 2185 } 2186 break; 2187 } 2188 break; 2189 } 2190 NG_RESPOND_MSG (error, node, item, resp); 2191 NG_FREE_MSG (msg); 2192 return error; 2193} 2194 2195static int ng_cx_rcvdata (hook_p hook, item_p item) 2196{ 2197 drv_t *d = NG_NODE_PRIVATE (NG_HOOK_NODE(hook)); 2198 struct mbuf *m; 2199 struct ng_tag_prio *ptag; 2200 struct ifqueue *q; 2201 int s; 2202 2203 NGI_GET_M (item, m); 2204 NG_FREE_ITEM (item); 2205 if (! NG_HOOK_PRIVATE (hook) || ! d) { 2206 NG_FREE_M (m); 2207 return ENETDOWN; 2208 } 2209 2210 /* Check for high priority data */ 2211 if ((ptag = (struct ng_tag_prio *)m_tag_locate(m, NGM_GENERIC_COOKIE, 2212 NG_TAG_PRIO, NULL)) != NULL && (ptag->priority > NG_PRIO_CUTOFF) ) 2213 q = &d->hi_queue; 2214 else 2215 q = &d->lo_queue; 2216 2217 s = splhigh (); 2218 IF_LOCK (q); 2219 if (_IF_QFULL (q)) { 2220 _IF_DROP (q); 2221 IF_UNLOCK (q); 2222 splx (s); 2223 NG_FREE_M (m); 2224 return ENOBUFS; 2225 } 2226 _IF_ENQUEUE (q, m); 2227 IF_UNLOCK (q); 2228 cx_start (d); 2229 splx (s); 2230 return 0; 2231} 2232 2233static int ng_cx_rmnode (node_p node) 2234{ 2235 drv_t *d = NG_NODE_PRIVATE (node); 2236 2237 CX_DEBUG (d, ("Rmnode\n")); 2238 if (d && d->running) { 2239 int s = splhigh (); 2240 cx_down (d); 2241 splx (s); 2242 } 2243#ifdef KLD_MODULE 2244 if (node->nd_flags & NGF_REALLY_DIE) { 2245 NG_NODE_SET_PRIVATE (node, NULL); 2246 NG_NODE_UNREF (node); 2247 } 2248 NG_NODE_REVIVE(node); /* Persistant node */ 2249#endif 2250 return 0; 2251} 2252 2253static void ng_cx_watchdog (void *arg) 2254{ 2255 drv_t *d = arg; 2256 2257 if (d->timeout == 1) 2258 cx_watchdog (d); 2259 if (d->timeout) 2260 d->timeout--; 2261 d->timeout_handle = timeout (ng_cx_watchdog, d, hz); 2262} 2263 2264static int ng_cx_connect (hook_p hook) 2265{ 2266 drv_t *d = NG_NODE_PRIVATE (NG_HOOK_NODE (hook)); 2267 2268 d->timeout_handle = timeout (ng_cx_watchdog, d, hz); 2269 return 0; 2270} 2271 2272static int ng_cx_disconnect (hook_p hook) 2273{ 2274 drv_t *d = NG_NODE_PRIVATE (NG_HOOK_NODE (hook)); 2275 int s; 2276 2277 s = splhigh (); 2278 if (NG_HOOK_PRIVATE (hook)) 2279 cx_down (d); 2280 splx (s); 2281 untimeout (ng_cx_watchdog, d, d->timeout_handle); 2282 return 0; 2283} 2284#endif /*NETGRAPH*/ 2285 2286static int cx_modevent (module_t mod, int type, void *unused) 2287{ 2288 static int load_count = 0; 2289 2290 switch (type) { 2291 case MOD_LOAD: 2292#if defined NETGRAPH 2293 if (ng_newtype (&typestruct)) 2294 printf ("Failed to register ng_cx\n"); 2295#endif 2296 ++load_count; 2297 timeout_handle = timeout (cx_timeout, 0, hz*5); 2298 /* Software interrupt. */ 2299 swi_add(&tty_ithd, "cx", cx_softintr, NULL, SWI_TTY, 0, 2300 &cx_fast_ih); 2301 break; 2302 case MOD_UNLOAD: 2303 if (load_count == 1) { 2304 printf ("Removing device entry for Sigma\n"); 2305#if defined NETGRAPH 2306 ng_rmtype (&typestruct); 2307#endif 2308 } 2309 if (timeout_handle.callout) 2310 untimeout (cx_timeout, 0, timeout_handle); 2311 ithread_remove_handler (cx_fast_ih); 2312 --load_count; 2313 break; 2314 case MOD_SHUTDOWN: 2315 break; 2316 } 2317 return 0; 2318} 2319 2320#ifdef NETGRAPH 2321static struct ng_type typestruct = { 2322 .version = NG_ABI_VERSION, 2323 .name = NG_CX_NODE_TYPE, 2324 .constructor = ng_cx_constructor, 2325 .rcvmsg = ng_cx_rcvmsg, 2326 .shutdown = ng_cx_rmnode, 2327 .newhook = ng_cx_newhook, 2328 .connect = ng_cx_connect, 2329 .rcvdata = ng_cx_rcvdata, 2330 .disconnect = ng_cx_disconnect, 2331}; 2332#endif /*NETGRAPH*/ 2333 2334#ifdef NETGRAPH 2335MODULE_DEPEND (ng_cx, netgraph, NG_ABI_VERSION, NG_ABI_VERSION, NG_ABI_VERSION); 2336#else 2337MODULE_DEPEND (isa_cx, sppp, 1, 1, 1); 2338#endif 2339#ifdef KLD_MODULE 2340DRIVER_MODULE (cxmod, isa, cx_isa_driver, cx_devclass, cx_modevent, NULL); 2341#else 2342DRIVER_MODULE (cx, isa, cx_isa_driver, cx_devclass, cx_modevent, NULL); 2343#endif 2344