if_cx.c revision 138352
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 138352 2004-12-03 16:57:15Z 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_ioctl (struct cdev *dev, u_long cmd, caddr_t data, int flag, struct thread *td) 1429{ 1430 drv_t *d; 1431 cx_chan_t *c; 1432 struct serial_statistics *st; 1433 int error, s; 1434 char mask[16]; 1435 1436 d = dev->si_drv1; 1437 c = d->chan; 1438 1439 switch (cmd) { 1440 case SERIAL_GETREGISTERED: 1441 CX_DEBUG2 (d, ("ioctl: getregistered\n")); 1442 bzero (mask, sizeof(mask)); 1443 for (s=0; s<NCX*NCHAN; ++s) 1444 if (channel [s]) 1445 mask [s/8] |= 1 << (s & 7); 1446 bcopy (mask, data, sizeof (mask)); 1447 return 0; 1448 1449 case SERIAL_GETPORT: 1450 CX_DEBUG2 (d, ("ioctl: getport\n")); 1451 s = splhigh (); 1452 *(int *)data = cx_get_port (c); 1453 splx (s); 1454 if (*(int *)data<0) 1455 return (EINVAL); 1456 else 1457 return 0; 1458 1459 case SERIAL_SETPORT: 1460 CX_DEBUG2 (d, ("ioctl: setproto\n")); 1461 /* Only for superuser! */ 1462 error = suser (td); 1463 if (error) 1464 return error; 1465 1466 s = splhigh (); 1467 cx_set_port (c, *(int *)data); 1468 splx (s); 1469 return 0; 1470 1471#ifndef NETGRAPH 1472 case SERIAL_GETPROTO: 1473 CX_DEBUG2 (d, ("ioctl: getproto\n")); 1474 s = splhigh (); 1475 strcpy ((char*)data, (c->mode == M_ASYNC) ? "async" : 1476 (d->pp.pp_flags & PP_FR) ? "fr" : 1477 (d->pp.pp_if.if_flags & PP_CISCO) ? "cisco" : "ppp"); 1478 splx (s); 1479 return 0; 1480 1481 case SERIAL_SETPROTO: 1482 CX_DEBUG2 (d, ("ioctl: setproto\n")); 1483 /* Only for superuser! */ 1484 error = suser (td); 1485 if (error) 1486 return error; 1487 if (c->mode == M_ASYNC) 1488 return EBUSY; 1489 if (d->pp.pp_if.if_flags & IFF_RUNNING) 1490 return EBUSY; 1491 if (! strcmp ("cisco", (char*)data)) { 1492 d->pp.pp_flags &= ~(PP_FR); 1493 d->pp.pp_flags |= PP_KEEPALIVE; 1494 d->pp.pp_if.if_flags |= PP_CISCO; 1495 } else if (! strcmp ("fr", (char*)data)) { 1496 d->pp.pp_if.if_flags &= ~(PP_CISCO); 1497 d->pp.pp_flags |= PP_FR | PP_KEEPALIVE; 1498 } else if (! strcmp ("ppp", (char*)data)) { 1499 d->pp.pp_flags &= ~(PP_FR | PP_KEEPALIVE); 1500 d->pp.pp_if.if_flags &= ~(PP_CISCO); 1501 } else 1502 return EINVAL; 1503 return 0; 1504 1505 case SERIAL_GETKEEPALIVE: 1506 CX_DEBUG2 (d, ("ioctl: getkeepalive\n")); 1507 if ((d->pp.pp_flags & PP_FR) || 1508 (d->pp.pp_if.if_flags & PP_CISCO) || 1509 (c->mode == M_ASYNC)) 1510 return EINVAL; 1511 s = splhigh (); 1512 *(int*)data = (d->pp.pp_flags & PP_KEEPALIVE) ? 1 : 0; 1513 splx (s); 1514 return 0; 1515 1516 case SERIAL_SETKEEPALIVE: 1517 CX_DEBUG2 (d, ("ioctl: setkeepalive\n")); 1518 /* Only for superuser! */ 1519 error = suser (td); 1520 if (error) 1521 return error; 1522 if ((d->pp.pp_flags & PP_FR) || 1523 (d->pp.pp_if.if_flags & PP_CISCO)) 1524 return EINVAL; 1525 s = splhigh (); 1526 if (*(int*)data) 1527 d->pp.pp_flags |= PP_KEEPALIVE; 1528 else 1529 d->pp.pp_flags &= ~PP_KEEPALIVE; 1530 splx (s); 1531 return 0; 1532#endif /*NETGRAPH*/ 1533 1534 case SERIAL_GETMODE: 1535 CX_DEBUG2 (d, ("ioctl: getmode\n")); 1536 s = splhigh (); 1537 *(int*)data = (c->mode == M_ASYNC) ? 1538 SERIAL_ASYNC : SERIAL_HDLC; 1539 splx (s); 1540 return 0; 1541 1542 case SERIAL_SETMODE: 1543 CX_DEBUG2 (d, ("ioctl: setmode\n")); 1544 /* Only for superuser! */ 1545 error = suser (td); 1546 if (error) 1547 return error; 1548 1549 /* Somebody is waiting for carrier? */ 1550 if (d->lock) 1551 return EBUSY; 1552 /* /dev/ttyXX is already opened by someone? */ 1553 if (c->mode == M_ASYNC && d->tty && (d->tty->t_state & TS_ISOPEN) && 1554 (d->open_dev|0x2)) 1555 return EBUSY; 1556 /* Network interface is up? 1557 * Cannot change to async mode. */ 1558 if (c->mode != M_ASYNC && d->running && 1559 (*(int*)data == SERIAL_ASYNC)) 1560 return EBUSY; 1561 1562 s = splhigh (); 1563 if (c->mode == M_HDLC && *(int*)data == SERIAL_ASYNC) { 1564 cx_set_mode (c, M_ASYNC); 1565 cx_enable_receive (c, 0); 1566 cx_enable_transmit (c, 0); 1567 } else if (c->mode == M_ASYNC && *(int*)data == SERIAL_HDLC) { 1568 cx_set_mode (c, M_HDLC); 1569 cx_enable_receive (c, 1); 1570 cx_enable_transmit (c, 1); 1571 } 1572 splx (s); 1573 return 0; 1574 1575 case SERIAL_GETSTAT: 1576 CX_DEBUG2 (d, ("ioctl: getestat\n")); 1577 st = (struct serial_statistics*) data; 1578 s = splhigh (); 1579 st->rintr = c->rintr; 1580 st->tintr = c->tintr; 1581 st->mintr = c->mintr; 1582 st->ibytes = c->ibytes; 1583 st->ipkts = c->ipkts; 1584 st->ierrs = c->ierrs; 1585 st->obytes = c->obytes; 1586 st->opkts = c->opkts; 1587 st->oerrs = c->oerrs; 1588 splx (s); 1589 return 0; 1590 1591 case SERIAL_CLRSTAT: 1592 CX_DEBUG2 (d, ("ioctl: clrstat\n")); 1593 /* Only for superuser! */ 1594 error = suser (td); 1595 if (error) 1596 return error; 1597 s = splhigh (); 1598 c->rintr = 0; 1599 c->tintr = 0; 1600 c->mintr = 0; 1601 c->ibytes = 0; 1602 c->ipkts = 0; 1603 c->ierrs = 0; 1604 c->obytes = 0; 1605 c->opkts = 0; 1606 c->oerrs = 0; 1607 splx (s); 1608 return 0; 1609 1610 case SERIAL_GETBAUD: 1611 CX_DEBUG2 (d, ("ioctl: getbaud\n")); 1612 if (c->mode == M_ASYNC) 1613 return EINVAL; 1614 s = splhigh (); 1615 *(long*)data = cx_get_baud(c); 1616 splx (s); 1617 return 0; 1618 1619 case SERIAL_SETBAUD: 1620 CX_DEBUG2 (d, ("ioctl: setbaud\n")); 1621 /* Only for superuser! */ 1622 error = suser (td); 1623 if (error) 1624 return error; 1625 if (c->mode == M_ASYNC) 1626 return EINVAL; 1627 s = splhigh (); 1628 cx_set_baud (c, *(long*)data); 1629 splx (s); 1630 return 0; 1631 1632 case SERIAL_GETLOOP: 1633 CX_DEBUG2 (d, ("ioctl: getloop\n")); 1634 if (c->mode == M_ASYNC) 1635 return EINVAL; 1636 s = splhigh (); 1637 *(int*)data = cx_get_loop (c); 1638 splx (s); 1639 return 0; 1640 1641 case SERIAL_SETLOOP: 1642 CX_DEBUG2 (d, ("ioctl: setloop\n")); 1643 /* Only for superuser! */ 1644 error = suser (td); 1645 if (error) 1646 return error; 1647 if (c->mode == M_ASYNC) 1648 return EINVAL; 1649 s = splhigh (); 1650 cx_set_loop (c, *(int*)data); 1651 splx (s); 1652 return 0; 1653 1654 case SERIAL_GETDPLL: 1655 CX_DEBUG2 (d, ("ioctl: getdpll\n")); 1656 if (c->mode == M_ASYNC) 1657 return EINVAL; 1658 s = splhigh (); 1659 *(int*)data = cx_get_dpll (c); 1660 splx (s); 1661 return 0; 1662 1663 case SERIAL_SETDPLL: 1664 CX_DEBUG2 (d, ("ioctl: setdpll\n")); 1665 /* Only for superuser! */ 1666 error = suser (td); 1667 if (error) 1668 return error; 1669 if (c->mode == M_ASYNC) 1670 return EINVAL; 1671 s = splhigh (); 1672 cx_set_dpll (c, *(int*)data); 1673 splx (s); 1674 return 0; 1675 1676 case SERIAL_GETNRZI: 1677 CX_DEBUG2 (d, ("ioctl: getnrzi\n")); 1678 if (c->mode == M_ASYNC) 1679 return EINVAL; 1680 s = splhigh (); 1681 *(int*)data = cx_get_nrzi (c); 1682 splx (s); 1683 return 0; 1684 1685 case SERIAL_SETNRZI: 1686 CX_DEBUG2 (d, ("ioctl: setnrzi\n")); 1687 /* Only for superuser! */ 1688 error = suser (td); 1689 if (error) 1690 return error; 1691 if (c->mode == M_ASYNC) 1692 return EINVAL; 1693 s = splhigh (); 1694 cx_set_nrzi (c, *(int*)data); 1695 splx (s); 1696 return 0; 1697 1698 case SERIAL_GETDEBUG: 1699 CX_DEBUG2 (d, ("ioctl: getdebug\n")); 1700 s = splhigh (); 1701 *(int*)data = c->debug; 1702 splx (s); 1703 return 0; 1704 1705 case SERIAL_SETDEBUG: 1706 CX_DEBUG2 (d, ("ioctl: setdebug\n")); 1707 /* Only for superuser! */ 1708 error = suser (td); 1709 if (error) 1710 return error; 1711 s = splhigh (); 1712 c->debug = *(int*)data; 1713 splx (s); 1714#ifndef NETGRAPH 1715 if (d->chan->debug) 1716 d->pp.pp_if.if_flags |= IFF_DEBUG; 1717 else 1718 d->pp.pp_if.if_flags &= (~IFF_DEBUG); 1719#endif 1720 return 0; 1721 } 1722 1723 CX_DEBUG2 (d, ("ioctl: 0x%lx\n", cmd)); 1724 return ENOTTY; 1725} 1726 1727 1728void cx_softintr (void *unused) 1729{ 1730 drv_t *d; 1731 async_q *q; 1732 int i, s, ic, k; 1733 while (MY_SOFT_INTR) { 1734 MY_SOFT_INTR = 0; 1735 for (i=0; i<NCX*NCHAN; ++i) { 1736 d = channel [i]; 1737 if (!d || !d->chan || d->chan->type == T_NONE 1738 || d->chan->mode != M_ASYNC || !d->tty 1739 || !d->tty->t_dev) 1740 continue; 1741 s = splhigh (); 1742 if (d->intr_action & CX_READ) { 1743 q = &(d->aqueue); 1744 if (d->tty->t_state & TS_CAN_BYPASS_L_RINT) { 1745 k = AQ_GSZ(q); 1746 if (d->tty->t_rawq.c_cc + k > 1747 d->tty->t_ihiwat 1748 && (d->tty->t_cflag & CRTS_IFLOW 1749 || d->tty->t_iflag & IXOFF) 1750 && !(d->tty->t_state & TS_TBLOCK)) 1751 ttyblock(d->tty); 1752 d->tty->t_rawcc += k; 1753 while (k>0) { 1754 k--; 1755 AQ_POP (q, ic); 1756 splx (s); 1757 putc (ic, &d->tty->t_rawq); 1758 s = splhigh (); 1759 } 1760 ttwakeup(d->tty); 1761 if (d->tty->t_state & TS_TTSTOP 1762 && (d->tty->t_iflag & IXANY 1763 || d->tty->t_cc[VSTART] == 1764 d->tty->t_cc[VSTOP])) { 1765 d->tty->t_state &= ~TS_TTSTOP; 1766 d->tty->t_lflag &= ~FLUSHO; 1767 d->intr_action |= CX_WRITE; 1768 } 1769 } else { 1770 while (q->end != q->beg) { 1771 AQ_POP (q, ic); 1772 splx (s); 1773 ttyld_rint (d->tty, ic); 1774 s = splhigh (); 1775 } 1776 } 1777 d->intr_action &= ~CX_READ; 1778 } 1779 splx (s); 1780 1781 s = splhigh (); 1782 if (d->intr_action & CX_WRITE) { 1783 if (d->tty->t_line) 1784 ttyld_start (d->tty); 1785 else 1786 cx_oproc (d->tty); 1787 d->intr_action &= ~CX_WRITE; 1788 } 1789 splx (s); 1790 1791 } 1792 } 1793} 1794 1795/* 1796 * Fill transmitter buffer with data. 1797 */ 1798static void cx_oproc (struct tty *tp) 1799{ 1800 int s, k; 1801 drv_t *d; 1802 static u_char buf[DMABUFSZ]; 1803 u_char *p; 1804 u_short len = 0, sublen = 0; 1805 1806 s = splhigh(); 1807 1808 d = tp->t_sc; 1809 1810 CX_DEBUG2 (d, ("cx_oproc\n")); 1811 if (tp->t_cflag & CRTSCTS && (tp->t_state & TS_TBLOCK) && d->chan->rts) 1812 cx_set_rts (d->chan, 0); 1813 else if (tp->t_cflag & CRTSCTS && ! (tp->t_state & TS_TBLOCK) && ! d->chan->rts) 1814 cx_set_rts (d->chan, 1); 1815 1816 if (! (tp->t_state & (TS_TIMEOUT | TS_TTSTOP))) { 1817 /* Start transmitter. */ 1818 cx_enable_transmit (d->chan, 1); 1819 1820 /* Is it busy? */ 1821 if (! cx_buf_free (d->chan)) { 1822 tp->t_state |= TS_BUSY; 1823 splx (s); 1824 return; 1825 } 1826 if (tp->t_iflag & IXOFF) { 1827 p = (buf + (DMABUFSZ/2)); 1828 sublen = q_to_b (&tp->t_outq, p, (DMABUFSZ/2)); 1829 k = sublen; 1830 while (k--) { 1831 /* Send XON/XOFF out of band. */ 1832 if (*p == tp->t_cc[VSTOP]) { 1833 cx_xflow_ctl (d->chan, 0); 1834 p++; 1835 continue; 1836 } 1837 if (*p == tp->t_cc[VSTART]) { 1838 cx_xflow_ctl (d->chan, 1); 1839 p++; 1840 continue; 1841 } 1842 buf[len] = *p; 1843 len++; 1844 p++; 1845 } 1846 } else { 1847 p = buf; 1848 len = q_to_b (&tp->t_outq, p, (DMABUFSZ/2)); 1849 } 1850 if (len) { 1851 cx_send_packet (d->chan, buf, len, 0); 1852 tp->t_state |= TS_BUSY; 1853 d->atimeout = 10; 1854 CX_DEBUG2 (d, ("out %d bytes\n", len)); 1855 } 1856 } 1857 ttwwakeup (tp); 1858 splx (s); 1859} 1860 1861static int cx_param (struct tty *tp, struct termios *t) 1862{ 1863 drv_t *d; 1864 int s, bits, parity; 1865 1866 d = tp->t_sc; 1867 1868 s = splhigh (); 1869 if (t->c_ospeed == 0) { 1870 /* Clear DTR and RTS. */ 1871 cx_set_dtr (d->chan, 0); 1872 splx (s); 1873 CX_DEBUG2 (d, ("cx_param (hangup)\n")); 1874 return 0; 1875 } 1876 CX_DEBUG2 (d, ("cx_param\n")); 1877 1878 /* Check requested parameters. */ 1879 if (t->c_ospeed < 300 || t->c_ospeed > 256*1024) { 1880 splx (s); 1881 return EINVAL; 1882 } 1883 if (t->c_ispeed && (t->c_ispeed < 300 || t->c_ispeed > 256*1024)) { 1884 splx (s); 1885 return EINVAL; 1886 } 1887 1888 /* And copy them to tty and channel structures. */ 1889 tp->t_ispeed = t->c_ispeed = tp->t_ospeed = t->c_ospeed; 1890 tp->t_cflag = t->c_cflag; 1891 1892 /* Set character length and parity mode. */ 1893 switch (t->c_cflag & CSIZE) { 1894 default: 1895 case CS8: bits = 8; break; 1896 case CS7: bits = 7; break; 1897 case CS6: bits = 6; break; 1898 case CS5: bits = 5; break; 1899 } 1900 1901 parity = ((t->c_cflag & PARENB) ? 1 : 0) * 1902 (1 + ((t->c_cflag & PARODD) ? 0 : 1)); 1903 1904 /* Set current channel number. */ 1905 if (! d->chan->dtr) 1906 cx_set_dtr (d->chan, 1); 1907 1908 ttyldoptim (tp); 1909 cx_set_async_param (d->chan, t->c_ospeed, bits, parity, (t->c_cflag & CSTOPB), 1910 !(t->c_cflag & PARENB), (t->c_cflag & CRTSCTS), 1911 (t->c_iflag & IXON), (t->c_iflag & IXANY), 1912 t->c_cc[VSTART], t->c_cc[VSTOP]); 1913 splx (s); 1914 return 0; 1915} 1916 1917/* 1918 * Stop output on a line 1919 */ 1920static void cx_stop (struct tty *tp, int flag) 1921{ 1922 drv_t *d; 1923 int s; 1924 1925 d = tp->t_sc; 1926 s = splhigh (); 1927 1928 if (tp->t_state & TS_BUSY) { 1929 /* Stop transmitter */ 1930 CX_DEBUG2 (d, ("cx_stop\n")); 1931 cx_transmitter_ctl (d->chan, 0); 1932 } 1933 splx (s); 1934} 1935 1936/* 1937 * Process the (delayed) carrier signal setup. 1938 */ 1939static void cx_carrier (void *arg) 1940{ 1941 drv_t *d = arg; 1942 cx_chan_t *c = d->chan; 1943 int s, cd; 1944 1945 s = splhigh (); 1946 cd = cx_get_cd (c); 1947 if (d->cd != cd) { 1948 if (cd) { 1949 CX_DEBUG (d, ("carrier on\n")); 1950 d->cd = 1; 1951 splx (s); 1952 if (d->tty) 1953 ttyld_modem(d->tty, 1); 1954 } else { 1955 CX_DEBUG (d, ("carrier loss\n")); 1956 d->cd = 0; 1957 splx (s); 1958 if (d->tty) 1959 ttyld_modem(d->tty, 0); 1960 } 1961 } 1962} 1963 1964/* 1965 * Modem signal callback function. 1966 */ 1967static void cx_modem (cx_chan_t *c) 1968{ 1969 drv_t *d = c->sys; 1970 1971 if (!d || c->mode != M_ASYNC) 1972 return; 1973 /* Handle carrier detect/loss. */ 1974 untimeout (cx_carrier, c, d->dcd_timeout_handle); 1975 /* Carrier changed - delay processing DCD for a while 1976 * to give both sides some time to initialize. */ 1977 d->dcd_timeout_handle = timeout (cx_carrier, d, hz/2); 1978} 1979 1980static struct cdevsw cx_cdevsw = { 1981 .d_version = D_VERSION, 1982 .d_open = cx_open, 1983 .d_close = cx_close, 1984 .d_ioctl = cx_ioctl, 1985 .d_name = "cx", 1986 .d_flags = D_TTY | D_NEEDGIANT, 1987}; 1988 1989#ifdef NETGRAPH 1990static int ng_cx_constructor (node_p node) 1991{ 1992 drv_t *d = NG_NODE_PRIVATE (node); 1993 CX_DEBUG (d, ("Constructor\n")); 1994 return EINVAL; 1995} 1996 1997static int ng_cx_newhook (node_p node, hook_p hook, const char *name) 1998{ 1999 int s; 2000 drv_t *d = NG_NODE_PRIVATE (node); 2001 2002 if (d->chan->mode == M_ASYNC) 2003 return EINVAL; 2004 2005 /* Attach debug hook */ 2006 if (strcmp (name, NG_CX_HOOK_DEBUG) == 0) { 2007 NG_HOOK_SET_PRIVATE (hook, NULL); 2008 d->debug_hook = hook; 2009 return 0; 2010 } 2011 2012 /* Check for raw hook */ 2013 if (strcmp (name, NG_CX_HOOK_RAW) != 0) 2014 return EINVAL; 2015 2016 NG_HOOK_SET_PRIVATE (hook, d); 2017 d->hook = hook; 2018 s = splhigh (); 2019 cx_up (d); 2020 splx (s); 2021 return 0; 2022} 2023 2024static int print_modems (char *s, cx_chan_t *c, int need_header) 2025{ 2026 int status = cx_modem_status (c->sys); 2027 int length = 0; 2028 2029 if (need_header) 2030 length += sprintf (s + length, " LE DTR DSR RTS CTS CD\n"); 2031 length += sprintf (s + length, "%4s %4s %4s %4s %4s %4s\n", 2032 status & TIOCM_LE ? "On" : "-", 2033 status & TIOCM_DTR ? "On" : "-", 2034 status & TIOCM_DSR ? "On" : "-", 2035 status & TIOCM_RTS ? "On" : "-", 2036 status & TIOCM_CTS ? "On" : "-", 2037 status & TIOCM_CD ? "On" : "-"); 2038 return length; 2039} 2040 2041static int print_stats (char *s, cx_chan_t *c, int need_header) 2042{ 2043 int length = 0; 2044 2045 if (need_header) 2046 length += sprintf (s + length, " Rintr Tintr Mintr Ibytes Ipkts Ierrs Obytes Opkts Oerrs\n"); 2047 length += sprintf (s + length, "%7ld %7ld %7ld %8ld %7ld %7ld %8ld %7ld %7ld\n", 2048 c->rintr, c->tintr, c->mintr, c->ibytes, c->ipkts, 2049 c->ierrs, c->obytes, c->opkts, c->oerrs); 2050 return length; 2051} 2052 2053static int print_chan (char *s, cx_chan_t *c) 2054{ 2055 drv_t *d = c->sys; 2056 int length = 0; 2057 2058 length += sprintf (s + length, "cx%d", c->board->num * NCHAN + c->num); 2059 if (d->chan->debug) 2060 length += sprintf (s + length, " debug=%d", d->chan->debug); 2061 2062 if (cx_get_baud (c)) 2063 length += sprintf (s + length, " %ld", cx_get_baud (c)); 2064 else 2065 length += sprintf (s + length, " extclock"); 2066 2067 if (c->mode == M_HDLC) { 2068 length += sprintf (s + length, " dpll=%s", cx_get_dpll (c) ? "on" : "off"); 2069 length += sprintf (s + length, " nrzi=%s", cx_get_nrzi (c) ? "on" : "off"); 2070 } 2071 2072 length += sprintf (s + length, " loop=%s", cx_get_loop (c) ? "on\n" : "off\n"); 2073 return length; 2074} 2075 2076static int ng_cx_rcvmsg (node_p node, item_p item, hook_p lasthook) 2077{ 2078 drv_t *d = NG_NODE_PRIVATE (node); 2079 struct ng_mesg *msg; 2080 struct ng_mesg *resp = NULL; 2081 int error = 0; 2082 2083 if (!d) 2084 return EINVAL; 2085 2086 CX_DEBUG (d, ("Rcvmsg\n")); 2087 NGI_GET_MSG (item, msg); 2088 switch (msg->header.typecookie) { 2089 default: 2090 error = EINVAL; 2091 break; 2092 2093 case NGM_CX_COOKIE: 2094 printf ("Don't forget to implement\n"); 2095 error = EINVAL; 2096 break; 2097 2098 case NGM_GENERIC_COOKIE: 2099 switch (msg->header.cmd) { 2100 default: 2101 error = EINVAL; 2102 break; 2103 2104 case NGM_TEXT_STATUS: { 2105 char *s; 2106 int l = 0; 2107 int dl = sizeof (struct ng_mesg) + 730; 2108 2109 NG_MKRESPONSE (resp, msg, dl, M_NOWAIT); 2110 if (! resp) { 2111 error = ENOMEM; 2112 break; 2113 } 2114 bzero (resp, dl); 2115 s = (resp)->data; 2116 l += print_chan (s + l, d->chan); 2117 l += print_stats (s + l, d->chan, 1); 2118 l += print_modems (s + l, d->chan, 1); 2119 strncpy ((resp)->header.cmdstr, "status", NG_CMDSTRLEN); 2120 } 2121 break; 2122 } 2123 break; 2124 } 2125 NG_RESPOND_MSG (error, node, item, resp); 2126 NG_FREE_MSG (msg); 2127 return error; 2128} 2129 2130static int ng_cx_rcvdata (hook_p hook, item_p item) 2131{ 2132 drv_t *d = NG_NODE_PRIVATE (NG_HOOK_NODE(hook)); 2133 struct mbuf *m; 2134 struct ng_tag_prio *ptag; 2135 struct ifqueue *q; 2136 int s; 2137 2138 NGI_GET_M (item, m); 2139 NG_FREE_ITEM (item); 2140 if (! NG_HOOK_PRIVATE (hook) || ! d) { 2141 NG_FREE_M (m); 2142 return ENETDOWN; 2143 } 2144 2145 /* Check for high priority data */ 2146 if ((ptag = (struct ng_tag_prio *)m_tag_locate(m, NGM_GENERIC_COOKIE, 2147 NG_TAG_PRIO, NULL)) != NULL && (ptag->priority > NG_PRIO_CUTOFF) ) 2148 q = &d->hi_queue; 2149 else 2150 q = &d->lo_queue; 2151 2152 s = splhigh (); 2153 IF_LOCK (q); 2154 if (_IF_QFULL (q)) { 2155 _IF_DROP (q); 2156 IF_UNLOCK (q); 2157 splx (s); 2158 NG_FREE_M (m); 2159 return ENOBUFS; 2160 } 2161 _IF_ENQUEUE (q, m); 2162 IF_UNLOCK (q); 2163 cx_start (d); 2164 splx (s); 2165 return 0; 2166} 2167 2168static int ng_cx_rmnode (node_p node) 2169{ 2170 drv_t *d = NG_NODE_PRIVATE (node); 2171 2172 CX_DEBUG (d, ("Rmnode\n")); 2173 if (d && d->running) { 2174 int s = splhigh (); 2175 cx_down (d); 2176 splx (s); 2177 } 2178#ifdef KLD_MODULE 2179 if (node->nd_flags & NGF_REALLY_DIE) { 2180 NG_NODE_SET_PRIVATE (node, NULL); 2181 NG_NODE_UNREF (node); 2182 } 2183 NG_NODE_REVIVE(node); /* Persistant node */ 2184#endif 2185 return 0; 2186} 2187 2188static void ng_cx_watchdog (void *arg) 2189{ 2190 drv_t *d = arg; 2191 2192 if (d->timeout == 1) 2193 cx_watchdog (d); 2194 if (d->timeout) 2195 d->timeout--; 2196 d->timeout_handle = timeout (ng_cx_watchdog, d, hz); 2197} 2198 2199static int ng_cx_connect (hook_p hook) 2200{ 2201 drv_t *d = NG_NODE_PRIVATE (NG_HOOK_NODE (hook)); 2202 2203 d->timeout_handle = timeout (ng_cx_watchdog, d, hz); 2204 return 0; 2205} 2206 2207static int ng_cx_disconnect (hook_p hook) 2208{ 2209 drv_t *d = NG_NODE_PRIVATE (NG_HOOK_NODE (hook)); 2210 int s; 2211 2212 s = splhigh (); 2213 if (NG_HOOK_PRIVATE (hook)) 2214 cx_down (d); 2215 splx (s); 2216 untimeout (ng_cx_watchdog, d, d->timeout_handle); 2217 return 0; 2218} 2219#endif /*NETGRAPH*/ 2220 2221static int cx_modevent (module_t mod, int type, void *unused) 2222{ 2223 static int load_count = 0; 2224 2225 switch (type) { 2226 case MOD_LOAD: 2227#if defined NETGRAPH 2228 if (ng_newtype (&typestruct)) 2229 printf ("Failed to register ng_cx\n"); 2230#endif 2231 ++load_count; 2232 timeout_handle = timeout (cx_timeout, 0, hz*5); 2233 /* Software interrupt. */ 2234 swi_add(&tty_ithd, "cx", cx_softintr, NULL, SWI_TTY, 0, 2235 &cx_fast_ih); 2236 break; 2237 case MOD_UNLOAD: 2238 if (load_count == 1) { 2239 printf ("Removing device entry for Sigma\n"); 2240#if defined NETGRAPH 2241 ng_rmtype (&typestruct); 2242#endif 2243 } 2244 if (timeout_handle.callout) 2245 untimeout (cx_timeout, 0, timeout_handle); 2246 ithread_remove_handler (cx_fast_ih); 2247 --load_count; 2248 break; 2249 case MOD_SHUTDOWN: 2250 break; 2251 } 2252 return 0; 2253} 2254 2255#ifdef NETGRAPH 2256static struct ng_type typestruct = { 2257 .version = NG_ABI_VERSION, 2258 .name = NG_CX_NODE_TYPE, 2259 .constructor = ng_cx_constructor, 2260 .rcvmsg = ng_cx_rcvmsg, 2261 .shutdown = ng_cx_rmnode, 2262 .newhook = ng_cx_newhook, 2263 .connect = ng_cx_connect, 2264 .rcvdata = ng_cx_rcvdata, 2265 .disconnect = ng_cx_disconnect, 2266}; 2267#endif /*NETGRAPH*/ 2268 2269#ifdef NETGRAPH 2270MODULE_DEPEND (ng_cx, netgraph, NG_ABI_VERSION, NG_ABI_VERSION, NG_ABI_VERSION); 2271#else 2272MODULE_DEPEND (isa_cx, sppp, 1, 1, 1); 2273#endif 2274#ifdef KLD_MODULE 2275DRIVER_MODULE (cxmod, isa, cx_isa_driver, cx_devclass, cx_modevent, NULL); 2276#else 2277DRIVER_MODULE (cx, isa, cx_isa_driver, cx_devclass, cx_modevent, NULL); 2278#endif 2279