if_ce.c revision 228963
1/* 2 * Cronyx-Tau32-PCI adapter driver for FreeBSD. 3 * 4 * Copyright (C) 2003-2005 Cronyx Engineering. 5 * Copyright (C) 2003-2005 Kurakin Roman, <rik@FreeBSD.org> 6 * 7 * This software is distributed with NO WARRANTIES, not even the implied 8 * warranties for MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. 9 * 10 * Authors grant any other persons or organisations a permission to use, 11 * modify and redistribute this software in source and binary forms, 12 * as long as this message is kept with the software, all derivative 13 * works or modified versions. 14 * 15 * $Cronyx: if_ce.c,v 1.9.2.8 2005/11/21 14:17:44 rik Exp $ 16 */ 17 18#include <sys/cdefs.h> 19__FBSDID("$FreeBSD: head/sys/dev/ce/if_ce.c 228963 2011-12-29 17:46:24Z dim $"); 20 21#include <sys/param.h> 22 23#if __FreeBSD_version >= 500000 24# define NPCI 1 25#else 26# include "pci.h" 27#endif 28 29#if NPCI > 0 30 31#include <sys/ucred.h> 32#include <sys/priv.h> 33#include <sys/proc.h> 34#include <sys/systm.h> 35#include <sys/mbuf.h> 36#include <sys/kernel.h> 37#include <sys/module.h> 38#include <sys/conf.h> 39#include <sys/malloc.h> 40#include <sys/socket.h> 41#include <sys/sockio.h> 42#if __FreeBSD_version >= 504000 43#include <sys/sysctl.h> 44#endif 45#include <sys/tty.h> 46#include <sys/bus.h> 47#include <vm/vm.h> 48#include <vm/pmap.h> 49#include <net/if.h> 50#if __FreeBSD_version > 501000 51# include <dev/pci/pcivar.h> 52# include <dev/pci/pcireg.h> 53#else 54# include <pci/pcivar.h> 55# include <pci/pcireg.h> 56#endif 57#include <machine/bus.h> 58#include <sys/rman.h> 59#include "opt_ng_cronyx.h" 60#ifdef NETGRAPH_CRONYX 61# include "opt_netgraph.h" 62# ifndef NETGRAPH 63# error #option NETGRAPH missed from configuration 64# endif 65# include <netgraph/ng_message.h> 66# include <netgraph/netgraph.h> 67# include <dev/ce/ng_ce.h> 68#else 69# include <net/if_types.h> 70# include <net/if_sppp.h> 71# define PP_CISCO IFF_LINK2 72# include <net/bpf.h> 73#endif 74#include <dev/cx/machdep.h> 75#include <dev/ce/ceddk.h> 76#include <machine/cserial.h> 77#include <machine/resource.h> 78#include <machine/pmap.h> 79 80/* If we don't have Cronyx's sppp version, we don't have fr support via sppp */ 81#ifndef PP_FR 82#define PP_FR 0 83#endif 84 85#ifndef IFP2SP 86#define IFP2SP(ifp) ((struct sppp*)ifp) 87#endif 88#ifndef SP2IFP 89#define SP2IFP(sp) ((struct ifnet*)sp) 90#endif 91 92#ifndef PCIR_BAR 93#define PCIR_BAR(x) (PCIR_MAPS + (x) * 4) 94#endif 95 96/* define as our previous return value */ 97#ifndef BUS_PROBE_DEFAULT 98#define BUS_PROBE_DEFAULT 0 99#endif 100 101#define CE_DEBUG(d,s) ({if (d->chan->debug) {\ 102 printf ("%s: ", d->name); printf s;}}) 103#define CE_DEBUG2(d,s) ({if (d->chan->debug>1) {\ 104 printf ("%s: ", d->name); printf s;}}) 105 106#ifndef CALLOUT_MPSAFE 107#define CALLOUT_MPSAFE 0 108#endif 109 110#ifndef IF_DRAIN 111#define IF_DRAIN(ifq) do { \ 112 struct mbuf *m; \ 113 for (;;) { \ 114 IF_DEQUEUE(ifq, m); \ 115 if (m == NULL) \ 116 break; \ 117 m_freem(m); \ 118 } \ 119} while (0) 120#endif 121 122#ifndef _IF_QLEN 123#define _IF_QLEN(ifq) ((ifq)->ifq_len) 124#endif 125 126#ifndef callout_drain 127#define callout_drain callout_stop 128#endif 129 130#define CE_LOCK_NAME "ceX" 131 132#define CE_LOCK(_bd) mtx_lock (&(_bd)->ce_mtx) 133#define CE_UNLOCK(_bd) mtx_unlock (&(_bd)->ce_mtx) 134#define CE_LOCK_ASSERT(_bd) mtx_assert (&(_bd)->ce_mtx, MA_OWNED) 135 136#define CDEV_MAJOR 185 137 138static int ce_probe __P((device_t)); 139static int ce_attach __P((device_t)); 140static int ce_detach __P((device_t)); 141 142static device_method_t ce_methods[] = { 143 /* Device interface */ 144 DEVMETHOD(device_probe, ce_probe), 145 DEVMETHOD(device_attach, ce_attach), 146 DEVMETHOD(device_detach, ce_detach), 147 148 {0, 0} 149}; 150 151typedef struct _ce_dma_mem_t { 152 unsigned long phys; 153 void *virt; 154 size_t size; 155#if __FreeBSD_version >= 500000 156 bus_dma_tag_t dmat; 157 bus_dmamap_t mapp; 158#endif 159} ce_dma_mem_t; 160 161typedef struct _drv_t { 162 char name [8]; 163 int running; 164 ce_board_t *board; 165 ce_chan_t *chan; 166 struct ifqueue rqueue; 167#ifdef NETGRAPH 168 char nodename [NG_NODESIZE]; 169 hook_p hook; 170 hook_p debug_hook; 171 node_p node; 172 struct ifqueue queue; 173 struct ifqueue hi_queue; 174#else 175 struct ifnet *ifp; 176#endif 177 short timeout; 178 struct callout timeout_handle; 179#if __FreeBSD_version >= 500000 180 struct cdev *devt; 181#else /* __FreeBSD_version < 500000 */ 182 dev_t devt; 183#endif 184 ce_dma_mem_t dmamem; 185} drv_t; 186 187typedef struct _bdrv_t { 188 ce_board_t *board; 189 struct resource *ce_res; 190 struct resource *ce_irq; 191 void *ce_intrhand; 192 ce_dma_mem_t dmamem; 193 drv_t channel [NCHAN]; 194#if __FreeBSD_version >= 504000 195 struct mtx ce_mtx; 196#endif 197} bdrv_t; 198 199static driver_t ce_driver = { 200 "ce", 201 ce_methods, 202 sizeof(bdrv_t), 203}; 204 205static devclass_t ce_devclass; 206 207static void ce_receive (ce_chan_t *c, unsigned char *data, int len); 208static void ce_transmit (ce_chan_t *c, void *attachment, int len); 209static void ce_error (ce_chan_t *c, int data); 210static void ce_up (drv_t *d); 211static void ce_start (drv_t *d); 212static void ce_down (drv_t *d); 213static void ce_watchdog (drv_t *d); 214static void ce_watchdog_timer (void *arg); 215#ifdef NETGRAPH 216extern struct ng_type typestruct; 217#else 218static void ce_ifstart (struct ifnet *ifp); 219static void ce_tlf (struct sppp *sp); 220static void ce_tls (struct sppp *sp); 221static int ce_sioctl (struct ifnet *ifp, u_long cmd, caddr_t data); 222static void ce_initialize (void *softc); 223#endif 224 225static ce_board_t *adapter [NBRD]; 226static drv_t *channel [NBRD*NCHAN]; 227static struct callout led_timo [NBRD]; 228static struct callout timeout_handle; 229 230static int ce_destroy = 0; 231 232#if __FreeBSD_version < 500000 233static int ce_open (dev_t dev, int oflags, int devtype, struct proc *p); 234static int ce_close (dev_t dev, int fflag, int devtype, struct proc *p); 235static int ce_ioctl (dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p); 236#else 237static int ce_open (struct cdev *dev, int oflags, int devtype, struct thread *td); 238static int ce_close (struct cdev *dev, int fflag, int devtype, struct thread *td); 239static int ce_ioctl (struct cdev *dev, u_long cmd, caddr_t data, int flag, struct thread *td); 240#endif 241#if __FreeBSD_version < 500000 242static struct cdevsw ce_cdevsw = { 243 ce_open, ce_close, noread, nowrite, 244 ce_ioctl, nopoll, nommap, nostrategy, 245 "ce", CDEV_MAJOR, nodump, nopsize, 246 D_NAGGED, -1 247 }; 248#elif __FreeBSD_version == 500000 249static struct cdevsw ce_cdevsw = { 250 ce_open, ce_close, noread, nowrite, 251 ce_ioctl, nopoll, nommap, nostrategy, 252 "ce", CDEV_MAJOR, nodump, nopsize, 253 D_NAGGED, 254 }; 255#elif __FreeBSD_version <= 501000 256static struct cdevsw ce_cdevsw = { 257 .d_open = ce_open, 258 .d_close = ce_close, 259 .d_read = noread, 260 .d_write = nowrite, 261 .d_ioctl = ce_ioctl, 262 .d_poll = nopoll, 263 .d_mmap = nommap, 264 .d_strategy = nostrategy, 265 .d_name = "ce", 266 .d_maj = CDEV_MAJOR, 267 .d_dump = nodump, 268 .d_flags = D_NAGGED, 269}; 270#elif __FreeBSD_version < 502103 271static struct cdevsw ce_cdevsw = { 272 .d_open = ce_open, 273 .d_close = ce_close, 274 .d_ioctl = ce_ioctl, 275 .d_name = "ce", 276 .d_maj = CDEV_MAJOR, 277 .d_flags = D_NAGGED, 278}; 279#elif __FreeBSD_version < 600000 280static struct cdevsw ce_cdevsw = { 281 .d_version = D_VERSION, 282 .d_open = ce_open, 283 .d_close = ce_close, 284 .d_ioctl = ce_ioctl, 285 .d_name = "ce", 286 .d_maj = CDEV_MAJOR, 287 .d_flags = D_NEEDGIANT, 288}; 289#else /* __FreeBSD_version >= 600000 */ 290static struct cdevsw ce_cdevsw = { 291 .d_version = D_VERSION, 292 .d_open = ce_open, 293 .d_close = ce_close, 294 .d_ioctl = ce_ioctl, 295 .d_name = "ce", 296}; 297#endif 298 299/* 300 * Print the mbuf chain, for debug purposes only. 301 */ 302static void printmbuf (struct mbuf *m) 303{ 304 printf ("mbuf:"); 305 for (; m; m=m->m_next) { 306 if (m->m_flags & M_PKTHDR) 307 printf (" HDR %d:", m->m_pkthdr.len); 308 if (m->m_flags & M_EXT) 309 printf (" EXT:"); 310 printf (" %d", m->m_len); 311 } 312 printf ("\n"); 313} 314 315/* 316 * Make an mbuf from data. 317 */ 318static struct mbuf *makembuf (void *buf, unsigned len) 319{ 320 struct mbuf *m; 321 322 MGETHDR (m, M_DONTWAIT, MT_DATA); 323 if (! m) 324 return 0; 325 MCLGET (m, M_DONTWAIT); 326 if (! (m->m_flags & M_EXT)) { 327 m_freem (m); 328 return 0; 329 } 330 m->m_pkthdr.len = m->m_len = len; 331 bcopy (buf, mtod (m, caddr_t), len); 332 return m; 333} 334 335static int ce_probe (device_t dev) 336{ 337 if ((pci_get_vendor (dev) == TAU32_PCI_VENDOR_ID) && 338 (pci_get_device (dev) == TAU32_PCI_DEVICE_ID)) { 339 device_set_desc (dev, "Cronyx-Tau32-PCI serial adapter"); 340 return BUS_PROBE_DEFAULT; 341 } 342 return ENXIO; 343} 344 345static void ce_timeout (void *arg) 346{ 347 drv_t *d; 348 int s, i, k; 349 350 for (i = 0; i < NBRD; ++i) { 351 if (adapter[i] == NULL) 352 continue; 353 for (k = 0; k < NCHAN; ++k) { 354 s = splimp (); 355 if (ce_destroy) { 356 splx (s); 357 return; 358 } 359 d = channel[i * NCHAN + k]; 360 if (!d) { 361 splx (s); 362 continue; 363 } 364 CE_LOCK ((bdrv_t *)d->board->sys); 365 switch (d->chan->type) { 366 case T_E1: 367 ce_e1_timer (d->chan); 368 break; 369 default: 370 break; 371 } 372 CE_UNLOCK ((bdrv_t *)d->board->sys); 373 splx (s); 374 } 375 } 376 s = splimp (); 377 if (!ce_destroy) 378 callout_reset (&timeout_handle, hz, ce_timeout, 0); 379 splx (s); 380} 381 382static void ce_led_off (void *arg) 383{ 384 ce_board_t *b = arg; 385 bdrv_t *bd = (bdrv_t *) b->sys; 386 int s; 387 s = splimp (); 388 if (ce_destroy) { 389 splx (s); 390 return; 391 } 392 CE_LOCK (bd); 393 TAU32_LedSet (b->ddk.pControllerObject, 0); 394 CE_UNLOCK (bd); 395 splx (s); 396} 397 398static void ce_intr (void *arg) 399{ 400 bdrv_t *bd = arg; 401 ce_board_t *b = bd->board; 402 int s; 403 int i; 404#if __FreeBSD_version >= 500000 && defined NETGRAPH 405 int error; 406#endif 407 s = splimp (); 408 if (ce_destroy) { 409 splx (s); 410 return; 411 } 412 CE_LOCK (bd); 413 /* Turn LED on. */ 414 TAU32_LedSet (b->ddk.pControllerObject, 1); 415 416 TAU32_HandleInterrupt (b->ddk.pControllerObject); 417 418 /* Turn LED off 50 msec later. */ 419 callout_reset (&led_timo[b->num], hz/20, ce_led_off, b); 420 CE_UNLOCK (bd); 421 splx (s); 422 423 /* Pass packets in a lock-free state */ 424 for (i = 0; i < NCHAN && b->chan[i].type; i++) { 425 drv_t *d = b->chan[i].sys; 426 struct mbuf *m; 427 if (!d || !d->running) 428 continue; 429 while (_IF_QLEN(&d->rqueue)) { 430 IF_DEQUEUE (&d->rqueue,m); 431 if (!m) 432 continue; 433#ifdef NETGRAPH 434 if (d->hook) { 435#if __FreeBSD_version >= 500000 436 NG_SEND_DATA_ONLY (error, d->hook, m); 437#else 438 ng_queue_data (d->hook, m, 0); 439#endif 440 } else { 441 IF_DRAIN (&d->rqueue); 442 } 443#else 444 sppp_input (d->ifp, m); 445#endif 446 } 447 } 448} 449 450#if __FreeBSD_version >= 500000 451static void 452ce_bus_dmamap_addr (void *arg, bus_dma_segment_t *segs, int nseg, int error) 453{ 454 unsigned long *addr; 455 456 if (error) 457 return; 458 459 KASSERT(nseg == 1, ("too many DMA segments, %d should be 1", nseg)); 460 addr = arg; 461 *addr = segs->ds_addr; 462} 463 464#ifndef BUS_DMA_ZERO 465#define BUS_DMA_ZERO 0 466#endif 467 468static int 469ce_bus_dma_mem_alloc (int bnum, int cnum, ce_dma_mem_t *dmem) 470{ 471 int error; 472 473 error = bus_dma_tag_create (NULL, 16, 0, BUS_SPACE_MAXADDR_32BIT, 474 BUS_SPACE_MAXADDR, NULL, NULL, dmem->size, 1, 475 dmem->size, 0, 476#if __FreeBSD_version >= 502000 477 NULL, NULL, 478#endif 479 &dmem->dmat); 480 if (error) { 481 if (cnum >= 0) printf ("ce%d-%d: ", bnum, cnum); 482 else printf ("ce%d: ", bnum); 483 printf ("couldn't allocate tag for dma memory\n"); 484 return 0; 485 } 486 error = bus_dmamem_alloc (dmem->dmat, (void **)&dmem->virt, 487 BUS_DMA_NOWAIT | BUS_DMA_ZERO, &dmem->mapp); 488 if (error) { 489 if (cnum >= 0) printf ("ce%d-%d: ", bnum, cnum); 490 else printf ("ce%d: ", bnum); 491 printf ("couldn't allocate mem for dma memory\n"); 492 bus_dma_tag_destroy (dmem->dmat); 493 return 0; 494 } 495 error = bus_dmamap_load (dmem->dmat, dmem->mapp, dmem->virt, 496 dmem->size, ce_bus_dmamap_addr, &dmem->phys, 0); 497 if (error) { 498 if (cnum >= 0) printf ("ce%d-%d: ", bnum, cnum); 499 else printf ("ce%d: ", bnum); 500 printf ("couldn't load mem map for dma memory\n"); 501 bus_dmamem_free (dmem->dmat, dmem->virt, dmem->mapp); 502 bus_dma_tag_destroy (dmem->dmat); 503 return 0; 504 } 505#if __FreeBSD_version >= 502000 506 bzero (dmem->virt, dmem->size); 507#endif 508 return 1; 509} 510 511static void 512ce_bus_dma_mem_free (ce_dma_mem_t *dmem) 513{ 514 bus_dmamap_unload (dmem->dmat, dmem->mapp); 515 bus_dmamem_free (dmem->dmat, dmem->virt, dmem->mapp); 516 bus_dma_tag_destroy (dmem->dmat); 517} 518#else 519static int 520ce_bus_dma_mem_alloc (int bnum, int cnum, ce_dma_mem_t *dmem) 521{ 522 dmem->virt = contigmalloc (dmem->size, M_DEVBUF, M_WAITOK, 523 0x100000, 0xffffffff, 16, 0); 524 if (dmem->virt == NULL) { 525 if (cnum >= 0) printf ("ce%d-%d: ", bnum, cnum); 526 else printf ("ce%d: ", bnum); 527 printf ("couldn't allocate dma memory\n"); 528 return 0; 529 } 530 dmem->phys = vtophys (dmem->virt); 531 bzero (dmem->virt, dmem->size); 532 return 1; 533} 534 535static void 536ce_bus_dma_mem_free (ce_dma_mem_t *dmem) 537{ 538 contigfree (dmem->virt, dmem->size, M_DEVBUF); 539} 540#endif 541 542/* 543 * Called if the probe succeeded. 544 */ 545static int ce_attach (device_t dev) 546{ 547 bdrv_t *bd = device_get_softc (dev); 548 int unit = device_get_unit (dev); 549#if __FreeBSD_version >= 504000 550 char *ce_ln = CE_LOCK_NAME; 551#endif 552 vm_offset_t vbase; 553 int rid, error; 554 ce_board_t *b; 555 ce_chan_t *c; 556 drv_t *d; 557 int s; 558 559 b = malloc (sizeof(ce_board_t), M_DEVBUF, M_WAITOK); 560 if (!b) { 561 printf ("ce%d: couldn't allocate memory\n", unit); 562 return (ENXIO); 563 } 564 bzero (b, sizeof(ce_board_t)); 565 566 b->ddk.sys = &b; 567 568#if __FreeBSD_version >= 440000 569 pci_enable_busmaster (dev); 570#endif 571 572 bd->dmamem.size = TAU32_ControllerObjectSize; 573 if (! ce_bus_dma_mem_alloc (unit, -1, &bd->dmamem)) { 574 free (b, M_DEVBUF); 575 return (ENXIO); 576 } 577 b->ddk.pControllerObject = bd->dmamem.virt; 578 579 bd->board = b; 580 b->sys = bd; 581 rid = PCIR_BAR(0); 582 bd->ce_res = bus_alloc_resource (dev, SYS_RES_MEMORY, &rid, 583 0, ~0, 1, RF_ACTIVE); 584 if (! bd->ce_res) { 585 printf ("ce%d: cannot map memory\n", unit); 586 ce_bus_dma_mem_free (&bd->dmamem); 587 free (b, M_DEVBUF); 588 return (ENXIO); 589 } 590 vbase = (vm_offset_t) rman_get_virtual (bd->ce_res); 591 592 b->ddk.PciBar1VirtualAddress = (void *)vbase; 593 b->ddk.ControllerObjectPhysicalAddress = bd->dmamem.phys; 594 b->ddk.pErrorNotifyCallback = ce_error_callback; 595 b->ddk.pStatusNotifyCallback = ce_status_callback; 596 b->num = unit; 597 598 TAU32_BeforeReset(&b->ddk); 599 pci_write_config (dev, TAU32_PCI_RESET_ADDRESS, TAU32_PCI_RESET_ON, 4); 600 pci_write_config (dev, TAU32_PCI_RESET_ADDRESS, TAU32_PCI_RESET_OFF, 4); 601 602 if(!TAU32_Initialize(&b->ddk, 0)) 603 { 604 printf ("ce%d: init adapter error 0x%08x, bus dead bits 0x%08lx\n", 605 unit, b->ddk.InitErrors, b->ddk.DeadBits); 606 bus_release_resource (dev, SYS_RES_MEMORY, PCIR_BAR(0), bd->ce_res); 607 ce_bus_dma_mem_free (&bd->dmamem); 608 free (b, M_DEVBUF); 609 return (ENXIO); 610 } 611 612 s = splimp (); 613 614 ce_init_board (b); 615 616 rid = 0; 617 bd->ce_irq = bus_alloc_resource (dev, SYS_RES_IRQ, &rid, 0, ~0, 1, 618 RF_SHAREABLE | RF_ACTIVE); 619 if (! bd->ce_irq) { 620 printf ("ce%d: cannot map interrupt\n", unit); 621 bus_release_resource (dev, SYS_RES_MEMORY, PCIR_BAR(0), bd->ce_res); 622 ce_bus_dma_mem_free (&bd->dmamem); 623 free (b, M_DEVBUF); 624 splx (s); 625 return (ENXIO); 626 } 627#if __FreeBSD_version >= 500000 628 callout_init (&led_timo[unit], CALLOUT_MPSAFE); 629#else 630 callout_init (&led_timo[unit]); 631#endif 632 error = bus_setup_intr (dev, bd->ce_irq, 633#if __FreeBSD_version >= 500013 634 INTR_TYPE_NET|INTR_MPSAFE, 635#else 636 INTR_TYPE_NET, 637#endif 638 NULL, ce_intr, bd, &bd->ce_intrhand); 639 if (error) { 640 printf ("ce%d: cannot set up irq\n", unit); 641 bus_release_resource (dev, SYS_RES_IRQ, 0, bd->ce_irq); 642 bus_release_resource (dev, SYS_RES_MEMORY, 643 PCIR_BAR(0), bd->ce_res); 644 ce_bus_dma_mem_free (&bd->dmamem); 645 free (b, M_DEVBUF); 646 splx (s); 647 return (ENXIO); 648 } 649 650 switch (b->ddk.Model) { 651 case 1: strcpy (b->name, TAU32_BASE_NAME); break; 652 case 2: strcpy (b->name, TAU32_LITE_NAME); break; 653 case 3: strcpy (b->name, TAU32_ADPCM_NAME); break; 654 default: strcpy (b->name, TAU32_UNKNOWN_NAME); break; 655 } 656 657 printf ("ce%d: %s\n", unit, b->name); 658 659 for (c = b->chan; c < b->chan + NCHAN; ++c) { 660 c->num = (c - b->chan); 661 c->board = b; 662 663 d = &bd->channel[c->num]; 664 d->dmamem.size = sizeof(ce_buf_t); 665 if (! ce_bus_dma_mem_alloc (unit, c->num, &d->dmamem)) 666 continue; 667 668 channel [b->num * NCHAN + c->num] = d; 669 sprintf (d->name, "ce%d.%d", b->num, c->num); 670 d->board = b; 671 d->chan = c; 672 c->sys = d; 673 } 674 675 for (c = b->chan; c < b->chan + NCHAN; ++c) { 676 if (c->sys == NULL) 677 continue; 678 d = c->sys; 679 680 callout_init (&d->timeout_handle, CALLOUT_MPSAFE); 681#ifdef NETGRAPH 682 if (ng_make_node_common (&typestruct, &d->node) != 0) { 683 printf ("%s: cannot make common node\n", d->name); 684 d->node = NULL; 685 continue; 686 } 687#if __FreeBSD_version >= 500000 688 NG_NODE_SET_PRIVATE (d->node, d); 689#else 690 d->node->private = d; 691#endif 692 sprintf (d->nodename, "%s%d", NG_CE_NODE_TYPE, 693 c->board->num * NCHAN + c->num); 694 if (ng_name_node (d->node, d->nodename)) { 695 printf ("%s: cannot name node\n", d->nodename); 696#if __FreeBSD_version >= 500000 697 NG_NODE_UNREF (d->node); 698#else 699 ng_rmnode (d->node); 700 ng_unref (d->node); 701#endif 702 continue; 703 } 704 d->queue.ifq_maxlen = ifqmaxlen; 705 d->hi_queue.ifq_maxlen = ifqmaxlen; 706 d->rqueue.ifq_maxlen = ifqmaxlen; 707#if __FreeBSD_version >= 500000 708 mtx_init (&d->queue.ifq_mtx, "ce_queue", NULL, MTX_DEF); 709 mtx_init (&d->hi_queue.ifq_mtx, "ce_queue_hi", NULL, MTX_DEF); 710 mtx_init (&d->rqueue.ifq_mtx, "ce_rqueue", NULL, MTX_DEF); 711#endif 712#else /*NETGRAPH*/ 713#if __FreeBSD_version >= 600031 714 d->ifp = if_alloc(IFT_PPP); 715#else 716 d->ifp = malloc (sizeof(struct sppp), M_DEVBUF, M_WAITOK); 717 bzero (d->ifp, sizeof(struct sppp)); 718#endif 719 if (!d->ifp) { 720 printf ("%s: cannot if_alloc() interface\n", d->name); 721 continue; 722 } 723 d->ifp->if_softc = d; 724#if __FreeBSD_version > 501000 725 if_initname (d->ifp, "ce", b->num * NCHAN + c->num); 726#else 727 d->ifp->if_unit = b->num * NCHAN + c->num; 728 d->ifp->if_name = "ce"; 729#endif 730 d->ifp->if_mtu = PP_MTU; 731 d->ifp->if_flags = IFF_POINTOPOINT | IFF_MULTICAST; 732 d->ifp->if_ioctl = ce_sioctl; 733 d->ifp->if_start = ce_ifstart; 734 d->ifp->if_init = ce_initialize; 735 d->rqueue.ifq_maxlen = ifqmaxlen; 736#if __FreeBSD_version >= 500000 737 mtx_init (&d->rqueue.ifq_mtx, "ce_rqueue", NULL, MTX_DEF); 738#endif 739 sppp_attach (d->ifp); 740 if_attach (d->ifp); 741 IFP2SP(d->ifp)->pp_tlf = ce_tlf; 742 IFP2SP(d->ifp)->pp_tls = ce_tls; 743 /* If BPF is in the kernel, call the attach for it. 744 * The header size of PPP or Cisco/HDLC is 4 bytes. */ 745 bpfattach (d->ifp, DLT_PPP, 4); 746#endif /*NETGRAPH*/ 747 ce_start_chan (c, 1, 1, d->dmamem.virt, d->dmamem.phys); 748 749 /* Register callback functions. */ 750 ce_register_transmit (c, &ce_transmit); 751 ce_register_receive (c, &ce_receive); 752 ce_register_error (c, &ce_error); 753 d->devt = make_dev (&ce_cdevsw, b->num*NCHAN+c->num, UID_ROOT, 754 GID_WHEEL, 0600, "ce%d", b->num*NCHAN+c->num); 755 } 756 757#if __FreeBSD_version >= 504000 758 ce_ln[2] = '0' + unit; 759 mtx_init (&bd->ce_mtx, ce_ln, MTX_NETWORK_LOCK, MTX_DEF|MTX_RECURSE); 760#endif 761 CE_LOCK (bd); 762 TAU32_EnableInterrupts(b->ddk.pControllerObject); 763 adapter[unit] = b; 764 CE_UNLOCK (bd); 765 splx (s); 766 767 return 0; 768} 769 770static int ce_detach (device_t dev) 771{ 772 bdrv_t *bd = device_get_softc (dev); 773 ce_board_t *b = bd->board; 774 ce_chan_t *c; 775 int s; 776 777#if __FreeBSD_version >= 504000 778 KASSERT (mtx_initialized (&bd->ce_mtx), ("ce mutex not initialized")); 779#endif 780 s = splimp (); 781 CE_LOCK (bd); 782 /* Check if the device is busy (open). */ 783 for (c = b->chan; c < b->chan + NCHAN; ++c) { 784 drv_t *d = (drv_t*) c->sys; 785 786 /* XXX Non existen chan! */ 787 if (! d || ! d->chan) 788 continue; 789 if (d->running) { 790 CE_UNLOCK (bd); 791 splx (s); 792 return EBUSY; 793 } 794 } 795 796 /* Ok, we can unload driver */ 797 /* At first we should disable interrupts */ 798 ce_destroy = 1; 799 TAU32_DisableInterrupts(b->ddk.pControllerObject); 800 801 callout_stop (&led_timo[b->num]); 802 803 for (c = b->chan; c < b->chan + NCHAN; ++c) { 804 drv_t *d = (drv_t*) c->sys; 805 806 if (! d || ! d->chan) 807 continue; 808 callout_stop (&d->timeout_handle); 809#ifndef NETGRAPH 810 /* Detach from the packet filter list of interfaces. */ 811 bpfdetach (d->ifp); 812 813 /* Detach from the sync PPP list. */ 814 sppp_detach (d->ifp); 815 816 /* Detach from the system list of interfaces. */ 817 if_detach (d->ifp); 818#if __FreeBSD_version > 600031 819 if_free(d->ifp); 820#else 821 free (d->ifp, M_DEVBUF); 822#endif 823 824 IF_DRAIN (&d->rqueue); 825#if __FreeBSD_version >= 500000 826 mtx_destroy (&d->rqueue.ifq_mtx); 827#endif 828#else 829#if __FreeBSD_version >= 500000 830 if (d->node) { 831 ng_rmnode_self (d->node); 832 NG_NODE_UNREF (d->node); 833 d->node = NULL; 834 } 835 IF_DRAIN (&d->rqueue); 836 mtx_destroy (&d->queue.ifq_mtx); 837 mtx_destroy (&d->hi_queue.ifq_mtx); 838 mtx_destroy (&d->rqueue.ifq_mtx); 839#else 840 ng_rmnode (d->node); 841 d->node = 0; 842#endif 843#endif 844 destroy_dev (d->devt); 845 } 846 847 CE_UNLOCK (bd); 848 splx (s); 849 850 callout_drain (&led_timo[b->num]); 851 852 /* Disable the interrupt request. */ 853 bus_teardown_intr (dev, bd->ce_irq, bd->ce_intrhand); 854 bus_release_resource (dev, SYS_RES_IRQ, 0, bd->ce_irq); 855 TAU32_DestructiveHalt (b->ddk.pControllerObject, 0); 856 bus_release_resource (dev, SYS_RES_MEMORY, PCIR_BAR(0), bd->ce_res); 857 858 for (c = b->chan; c < b->chan + NCHAN; ++c) { 859 drv_t *d = (drv_t*) c->sys; 860 861 if (! d || ! d->chan) 862 continue; 863 callout_drain (&d->timeout_handle); 864 channel [b->num * NCHAN + c->num] = 0; 865 /* Deallocate buffers. */ 866 ce_bus_dma_mem_free (&d->dmamem); 867 } 868 adapter [b->num] = 0; 869 ce_bus_dma_mem_free (&bd->dmamem); 870 free (b, M_DEVBUF); 871#if __FreeBSD_version >= 504000 872 mtx_destroy (&bd->ce_mtx); 873#endif 874 return 0; 875} 876 877#ifndef NETGRAPH 878static void ce_ifstart (struct ifnet *ifp) 879{ 880 drv_t *d = ifp->if_softc; 881 bdrv_t *bd = d->board->sys; 882 883 CE_LOCK (bd); 884 ce_start (d); 885 CE_UNLOCK (bd); 886} 887 888static void ce_tlf (struct sppp *sp) 889{ 890 drv_t *d = SP2IFP(sp)->if_softc; 891 892 CE_DEBUG2 (d, ("ce_tlf\n")); 893 sp->pp_down (sp); 894} 895 896static void ce_tls (struct sppp *sp) 897{ 898 drv_t *d = SP2IFP(sp)->if_softc; 899 900 CE_DEBUG2 (d, ("ce_tls\n")); 901 sp->pp_up (sp); 902} 903 904/* 905 * Process an ioctl request. 906 */ 907static int ce_sioctl (struct ifnet *ifp, u_long cmd, caddr_t data) 908{ 909 drv_t *d = ifp->if_softc; 910 bdrv_t *bd = d->board->sys; 911 int error, s, was_up, should_be_up; 912 913#if __FreeBSD_version >= 600034 914 was_up = (ifp->if_drv_flags & IFF_DRV_RUNNING) != 0; 915#else 916 was_up = (ifp->if_flags & IFF_RUNNING) != 0; 917#endif 918 error = sppp_ioctl (ifp, cmd, data); 919 920 if (error) 921 return error; 922 923 if (! (ifp->if_flags & IFF_DEBUG)) 924 d->chan->debug = 0; 925 else 926 d->chan->debug = d->chan->debug_shadow; 927 928 switch (cmd) { 929 default: CE_DEBUG2 (d, ("ioctl 0x%lx\n", cmd)); return 0; 930 case SIOCADDMULTI: CE_DEBUG2 (d, ("ioctl SIOCADDMULTI\n")); return 0; 931 case SIOCDELMULTI: CE_DEBUG2 (d, ("ioctl SIOCDELMULTI\n")); return 0; 932 case SIOCSIFFLAGS: CE_DEBUG2 (d, ("ioctl SIOCSIFFLAGS\n")); break; 933 case SIOCSIFADDR: CE_DEBUG2 (d, ("ioctl SIOCSIFADDR\n")); break; 934 } 935 936 /* We get here only in case of SIFFLAGS or SIFADDR. */ 937 s = splimp (); 938 CE_LOCK (bd); 939#if __FreeBSD_version >= 600034 940 should_be_up = (ifp->if_drv_flags & IFF_DRV_RUNNING) != 0; 941#else 942 should_be_up = (ifp->if_flags & IFF_RUNNING) != 0; 943#endif 944 if (! was_up && should_be_up) { 945 /* Interface goes up -- start it. */ 946 ce_up (d); 947 ce_start (d); 948 } else if (was_up && ! should_be_up) { 949 /* Interface is going down -- stop it. */ 950/* if ((IFP2SP(ifp)->pp_flags & PP_FR) || (ifp->if_flags & PP_CISCO))*/ 951 ce_down (d); 952 } 953 CE_DEBUG (d, ("ioctl 0x%lx p4\n", cmd)); 954 CE_UNLOCK (bd); 955 splx (s); 956 return 0; 957} 958 959/* 960 * Initialization of interface. 961 * It seems to be never called by upper level? 962 */ 963static void ce_initialize (void *softc) 964{ 965 drv_t *d = softc; 966 967 CE_DEBUG (d, ("ce_initialize\n")); 968} 969#endif /*NETGRAPH*/ 970 971/* 972 * Stop the interface. Called on splimp(). 973 */ 974static void ce_down (drv_t *d) 975{ 976 CE_DEBUG (d, ("ce_down\n")); 977 /* Interface is going down -- stop it. */ 978 ce_set_dtr (d->chan, 0); 979 ce_set_rts (d->chan, 0); 980 981 d->running = 0; 982 callout_stop (&d->timeout_handle); 983} 984 985/* 986 * Start the interface. Called on splimp(). 987 */ 988static void ce_up (drv_t *d) 989{ 990 CE_DEBUG (d, ("ce_up\n")); 991 ce_set_dtr (d->chan, 1); 992 ce_set_rts (d->chan, 1); 993 994 d->running = 1; 995} 996 997/* 998 * Start output on the interface. Get another datagram to send 999 * off of the interface queue, and copy it to the interface 1000 * before starting the output. 1001 */ 1002static void ce_send (drv_t *d) 1003{ 1004 struct mbuf *m; 1005 u_short len; 1006 1007 CE_DEBUG2 (d, ("ce_send\n")); 1008 1009 /* No output if the interface is down. */ 1010 if (! d->running) 1011 return; 1012 1013 while (ce_transmit_space (d->chan)) { 1014 /* Get the packet to send. */ 1015#ifdef NETGRAPH 1016 IF_DEQUEUE (&d->hi_queue, m); 1017 if (! m) 1018 IF_DEQUEUE (&d->queue, m); 1019#else 1020 m = sppp_dequeue (d->ifp); 1021#endif 1022 if (! m) 1023 return; 1024#ifndef NETGRAPH 1025#if __FreeBSD_version >= 500000 1026 BPF_MTAP (d->ifp, m); 1027#else 1028 if (d->ifp->if_bpf) 1029 bpf_mtap (d->ifp, m); 1030#endif 1031#endif 1032#if __FreeBSD_version >= 490000 1033 len = m_length (m, NULL); 1034#else 1035 len = m->m_pkthdr.len; 1036#endif 1037 if (len >= BUFSZ) 1038 printf ("%s: too long packet: %d bytes: ", 1039 d->name, len); 1040 else if (! m->m_next) 1041 ce_send_packet (d->chan, (u_char*) mtod (m, caddr_t), len, 0); 1042 else { 1043 ce_buf_item_t *item = (ce_buf_item_t*)d->chan->tx_queue; 1044 m_copydata (m, 0, len, item->buf); 1045 ce_send_packet (d->chan, item->buf, len, 0); 1046 } 1047 m_freem (m); 1048 /* Set up transmit timeout, if the transmit ring is not empty.*/ 1049 d->timeout = 10; 1050 } 1051#ifndef NETGRAPH 1052#if __FreeBSD_version >= 600034 1053 d->ifp->if_flags |= IFF_DRV_OACTIVE; 1054#else 1055 d->ifp->if_flags |= IFF_OACTIVE; 1056#endif 1057#endif 1058} 1059 1060/* 1061 * Start output on the interface. 1062 * Always called on splimp(). 1063 */ 1064static void ce_start (drv_t *d) 1065{ 1066 if (d->running) { 1067 if (! d->chan->dtr) 1068 ce_set_dtr (d->chan, 1); 1069 if (! d->chan->rts) 1070 ce_set_rts (d->chan, 1); 1071 ce_send (d); 1072 callout_reset (&d->timeout_handle, hz, ce_watchdog_timer, d); 1073 } 1074} 1075 1076/* 1077 * Handle transmit timeouts. 1078 * Recover after lost transmit interrupts. 1079 * Always called on splimp(). 1080 */ 1081static void ce_watchdog (drv_t *d) 1082{ 1083 CE_DEBUG (d, ("device timeout\n")); 1084 if (d->running) { 1085 ce_set_dtr (d->chan, 0); 1086 ce_set_rts (d->chan, 0); 1087/* ce_stop_chan (d->chan);*/ 1088/* ce_start_chan (d->chan, 1, 1, 0, 0);*/ 1089 ce_set_dtr (d->chan, 1); 1090 ce_set_rts (d->chan, 1); 1091 ce_start (d); 1092 } 1093} 1094 1095static void ce_watchdog_timer (void *arg) 1096{ 1097 drv_t *d = arg; 1098 bdrv_t *bd = d->board->sys; 1099 1100 CE_LOCK(bd); 1101 if (d->timeout == 1) 1102 ce_watchdog (d); 1103 if (d->timeout) 1104 d->timeout--; 1105 callout_reset (&d->timeout_handle, hz, ce_watchdog_timer, d); 1106 CE_UNLOCK(bd); 1107} 1108 1109static void ce_transmit (ce_chan_t *c, void *attachment, int len) 1110{ 1111 drv_t *d = c->sys; 1112 1113 d->timeout = 0; 1114#ifndef NETGRAPH 1115 ++d->ifp->if_opackets; 1116#if __FreeBSD_version >= 600034 1117 d->ifp->if_flags &= ~IFF_DRV_OACTIVE; 1118#else 1119 d->ifp->if_flags &= ~IFF_OACTIVE; 1120#endif 1121#endif 1122 ce_start (d); 1123} 1124 1125static void ce_receive (ce_chan_t *c, unsigned char *data, int len) 1126{ 1127 drv_t *d = c->sys; 1128 struct mbuf *m; 1129 1130 if (! d->running) 1131 return; 1132 1133 m = makembuf (data, len); 1134 if (! m) { 1135 CE_DEBUG (d, ("no memory for packet\n")); 1136#ifndef NETGRAPH 1137 ++d->ifp->if_iqdrops; 1138#endif 1139 return; 1140 } 1141 if (c->debug > 1) 1142 printmbuf (m); 1143#ifdef NETGRAPH 1144 m->m_pkthdr.rcvif = 0; 1145 IF_ENQUEUE(&d->rqueue, m); 1146#else 1147 ++d->ifp->if_ipackets; 1148 m->m_pkthdr.rcvif = d->ifp; 1149 /* Check if there's a BPF listener on this interface. 1150 * If so, hand off the raw packet to bpf. */ 1151#if __FreeBSD_version >= 500000 1152 BPF_TAP (d->ifp, data, len); 1153#else 1154 if (d->ifp->if_bpf) 1155 bpf_tap (d->ifp, data, len); 1156#endif 1157 IF_ENQUEUE(&d->rqueue, m); 1158#endif 1159} 1160 1161static void ce_error (ce_chan_t *c, int data) 1162{ 1163 drv_t *d = c->sys; 1164 1165 switch (data) { 1166 case CE_FRAME: 1167 CE_DEBUG (d, ("frame error\n")); 1168#ifndef NETGRAPH 1169 ++d->ifp->if_ierrors; 1170#endif 1171 break; 1172 case CE_CRC: 1173 CE_DEBUG (d, ("crc error\n")); 1174#ifndef NETGRAPH 1175 ++d->ifp->if_ierrors; 1176#endif 1177 break; 1178 case CE_OVERRUN: 1179 CE_DEBUG (d, ("overrun error\n")); 1180#ifndef NETGRAPH 1181 ++d->ifp->if_collisions; 1182 ++d->ifp->if_ierrors; 1183#endif 1184 break; 1185 case CE_OVERFLOW: 1186 CE_DEBUG (d, ("overflow error\n")); 1187#ifndef NETGRAPH 1188 ++d->ifp->if_ierrors; 1189#endif 1190 break; 1191 case CE_UNDERRUN: 1192 CE_DEBUG (d, ("underrun error\n")); 1193 d->timeout = 0; 1194#ifndef NETGRAPH 1195 ++d->ifp->if_oerrors; 1196#if __FreeBSD_version >= 600034 1197 d->ifp->if_flags &= ~IFF_DRV_OACTIVE; 1198#else 1199 d->ifp->if_flags &= ~IFF_OACTIVE; 1200#endif 1201#endif 1202 ce_start (d); 1203 break; 1204 default: 1205 CE_DEBUG (d, ("error #%d\n", data)); 1206 break; 1207 } 1208} 1209 1210/* 1211 * You also need read, write, open, close routines. 1212 * This should get you started 1213 */ 1214#if __FreeBSD_version < 500000 1215static int ce_open (dev_t dev, int oflags, int devtype, struct proc *p) 1216#else 1217static int ce_open (struct cdev *dev, int oflags, int devtype, struct thread *td) 1218#endif 1219{ 1220 int unit = dev2unit (dev); 1221 drv_t *d; 1222 1223 if (unit >= NBRD*NCHAN || ! (d = channel[unit])) 1224 return ENXIO; 1225 CE_DEBUG2 (d, ("ce_open\n")); 1226 return 0; 1227} 1228 1229/* 1230 * Only called on the LAST close. 1231 */ 1232#if __FreeBSD_version < 500000 1233static int ce_close (dev_t dev, int fflag, int devtype, struct proc *p) 1234#else 1235static int ce_close (struct cdev *dev, int fflag, int devtype, struct thread *td) 1236#endif 1237{ 1238 drv_t *d = channel [dev2unit (dev)]; 1239 1240 CE_DEBUG2 (d, ("ce_close\n")); 1241 return 0; 1242} 1243 1244static int ce_modem_status (ce_chan_t *c) 1245{ 1246 drv_t *d = c->sys; 1247 bdrv_t *bd = d->board->sys; 1248 int status, s; 1249 1250 status = d->running ? TIOCM_LE : 0; 1251 s = splimp (); 1252 CE_LOCK (bd); 1253 if (ce_get_cd (c)) status |= TIOCM_CD; 1254 if (ce_get_cts (c)) status |= TIOCM_CTS; 1255 if (ce_get_dsr (c)) status |= TIOCM_DSR; 1256 if (c->dtr) status |= TIOCM_DTR; 1257 if (c->rts) status |= TIOCM_RTS; 1258 CE_UNLOCK (bd); 1259 splx (s); 1260 return status; 1261} 1262 1263#if __FreeBSD_version < 500000 1264static int ce_ioctl (dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p) 1265#else 1266static int ce_ioctl (struct cdev *dev, u_long cmd, caddr_t data, int flag, struct thread *td) 1267#endif 1268{ 1269 drv_t *d = channel [dev2unit (dev)]; 1270 bdrv_t *bd = d->board->sys; 1271 ce_chan_t *c = d->chan; 1272 struct serial_statistics *st; 1273 struct e1_statistics *opte1; 1274 int error, s; 1275 char mask[16]; 1276 1277 switch (cmd) { 1278 case SERIAL_GETREGISTERED: 1279 CE_DEBUG2 (d, ("ioctl: getregistered\n")); 1280 bzero (mask, sizeof(mask)); 1281 for (s=0; s<NBRD*NCHAN; ++s) 1282 if (channel [s]) 1283 mask [s/8] |= 1 << (s & 7); 1284 bcopy (mask, data, sizeof (mask)); 1285 return 0; 1286 1287#ifndef NETGRAPH 1288 case SERIAL_GETPROTO: 1289 CE_DEBUG2 (d, ("ioctl: getproto\n")); 1290 strcpy ((char*)data, (IFP2SP(d->ifp)->pp_flags & PP_FR) ? "fr" : 1291 (d->ifp->if_flags & PP_CISCO) ? "cisco" : "ppp"); 1292 return 0; 1293 1294 case SERIAL_SETPROTO: 1295 CE_DEBUG2 (d, ("ioctl: setproto\n")); 1296 /* Only for superuser! */ 1297#if __FreeBSD_version < 500000 1298 error = suser (p); 1299#elif __FreeBSD_version < 700000 1300 error = suser (td); 1301#else 1302 error = priv_check (td, PRIV_DRIVER); 1303#endif 1304 if (error) 1305 return error; 1306#if __FreeBSD_version >= 600034 1307 if (d->ifp->if_flags & IFF_DRV_RUNNING) 1308#else 1309 if (d->ifp->if_flags & IFF_RUNNING) 1310#endif 1311 return EBUSY; 1312 if (! strcmp ("cisco", (char*)data)) { 1313 IFP2SP(d->ifp)->pp_flags &= ~(PP_FR); 1314 IFP2SP(d->ifp)->pp_flags |= PP_KEEPALIVE; 1315 d->ifp->if_flags |= PP_CISCO; 1316#if PP_FR != 0 1317 } else if (! strcmp ("fr", (char*)data)) { 1318 d->ifp->if_flags &= ~(PP_CISCO); 1319 IFP2SP(d->ifp)->pp_flags |= PP_FR | PP_KEEPALIVE; 1320#endif 1321 } else if (! strcmp ("ppp", (char*)data)) { 1322 IFP2SP(d->ifp)->pp_flags &= ~PP_FR; 1323 IFP2SP(d->ifp)->pp_flags &= ~PP_KEEPALIVE; 1324 d->ifp->if_flags &= ~(PP_CISCO); 1325 } else 1326 return EINVAL; 1327 return 0; 1328 1329 case SERIAL_GETKEEPALIVE: 1330 CE_DEBUG2 (d, ("ioctl: getkeepalive\n")); 1331 if ((IFP2SP(d->ifp)->pp_flags & PP_FR) || 1332 (d->ifp->if_flags & PP_CISCO)) 1333 return EINVAL; 1334 *(int*)data = (IFP2SP(d->ifp)->pp_flags & PP_KEEPALIVE) ? 1 : 0; 1335 return 0; 1336 1337 case SERIAL_SETKEEPALIVE: 1338 CE_DEBUG2 (d, ("ioctl: setkeepalive\n")); 1339 /* Only for superuser! */ 1340#if __FreeBSD_version < 500000 1341 error = suser (p); 1342#elif __FreeBSD_version < 700000 1343 error = suser (td); 1344#else 1345 error = priv_check (td, PRIV_DRIVER); 1346#endif 1347 if (error) 1348 return error; 1349 if ((IFP2SP(d->ifp)->pp_flags & PP_FR) || 1350 (d->ifp->if_flags & PP_CISCO)) 1351 return EINVAL; 1352 s = splimp (); 1353 CE_LOCK (bd); 1354 if (*(int*)data) 1355 IFP2SP(d->ifp)->pp_flags |= PP_KEEPALIVE; 1356 else 1357 IFP2SP(d->ifp)->pp_flags &= ~PP_KEEPALIVE; 1358 CE_UNLOCK (bd); 1359 splx (s); 1360 return 0; 1361#endif /*NETGRAPH*/ 1362 1363 case SERIAL_GETMODE: 1364 CE_DEBUG2 (d, ("ioctl: getmode\n")); 1365 *(int*)data = SERIAL_HDLC; 1366 return 0; 1367 1368 case SERIAL_SETMODE: 1369 /* Only for superuser! */ 1370#if __FreeBSD_version < 500000 1371 error = suser (p); 1372#elif __FreeBSD_version < 700000 1373 error = suser (td); 1374#else 1375 error = priv_check (td, PRIV_DRIVER); 1376#endif 1377 if (error) 1378 return error; 1379 if (*(int*)data != SERIAL_HDLC) 1380 return EINVAL; 1381 return 0; 1382 1383 case SERIAL_GETCFG: 1384 CE_DEBUG2 (d, ("ioctl: getcfg\n")); 1385 *(char*)data = 'c'; 1386 return 0; 1387 1388 case SERIAL_SETCFG: 1389 CE_DEBUG2 (d, ("ioctl: setcfg\n")); 1390#if __FreeBSD_version < 500000 1391 error = suser (p); 1392#elif __FreeBSD_version < 700000 1393 error = suser (td); 1394#else 1395 error = priv_check (td, PRIV_DRIVER); 1396#endif 1397 if (error) 1398 return error; 1399 if (*((char*)data) != 'c') 1400 return EINVAL; 1401 return 0; 1402 1403 case SERIAL_GETSTAT: 1404 CE_DEBUG2 (d, ("ioctl: getstat\n")); 1405 st = (struct serial_statistics*) data; 1406 st->rintr = c->rintr; 1407 st->tintr = c->tintr; 1408 st->mintr = 0; 1409 st->ibytes = c->ibytes; 1410 st->ipkts = c->ipkts; 1411 st->obytes = c->obytes; 1412 st->opkts = c->opkts; 1413 st->ierrs = c->overrun + c->frame + c->crc; 1414 st->oerrs = c->underrun; 1415 return 0; 1416 1417 case SERIAL_GETESTAT: 1418 CE_DEBUG2 (d, ("ioctl: getestat\n")); 1419 if (c->type != T_E1) 1420 return EINVAL; 1421 opte1 = (struct e1_statistics*) data; 1422 1423 opte1->status = 0; 1424 if (c->status & ESTS_NOALARM) 1425 opte1->status |= E1_NOALARM; 1426 if (c->status & ESTS_LOS) 1427 opte1->status |= E1_LOS; 1428 if (c->status & ESTS_LOF) 1429 opte1->status |= E1_LOF; 1430 if (c->status & ESTS_AIS) 1431 opte1->status |= E1_AIS; 1432 if (c->status & ESTS_LOMF) 1433 opte1->status |= E1_LOMF; 1434 if (c->status & ESTS_AIS16) 1435 opte1->status |= E1_AIS16; 1436 if (c->status & ESTS_FARLOF) 1437 opte1->status |= E1_FARLOF; 1438 if (c->status & ESTS_FARLOMF) 1439 opte1->status |= E1_FARLOMF; 1440 if (c->status & ESTS_TSTREQ) 1441 opte1->status |= E1_TSTREQ; 1442 if (c->status & ESTS_TSTERR) 1443 opte1->status |= E1_TSTERR; 1444 1445 opte1->cursec = c->cursec; 1446 opte1->totsec = c->totsec + c->cursec; 1447 1448 opte1->currnt.bpv = c->currnt.bpv; 1449 opte1->currnt.fse = c->currnt.fse; 1450 opte1->currnt.crce = c->currnt.crce; 1451 opte1->currnt.rcrce = c->currnt.rcrce; 1452 opte1->currnt.uas = c->currnt.uas; 1453 opte1->currnt.les = c->currnt.les; 1454 opte1->currnt.es = c->currnt.es; 1455 opte1->currnt.bes = c->currnt.bes; 1456 opte1->currnt.ses = c->currnt.ses; 1457 opte1->currnt.oofs = c->currnt.oofs; 1458 opte1->currnt.css = c->currnt.css; 1459 opte1->currnt.dm = c->currnt.dm; 1460 1461 opte1->total.bpv = c->total.bpv + c->currnt.bpv; 1462 opte1->total.fse = c->total.fse + c->currnt.fse; 1463 opte1->total.crce = c->total.crce + c->currnt.crce; 1464 opte1->total.rcrce = c->total.rcrce + c->currnt.rcrce; 1465 opte1->total.uas = c->total.uas + c->currnt.uas; 1466 opte1->total.les = c->total.les + c->currnt.les; 1467 opte1->total.es = c->total.es + c->currnt.es; 1468 opte1->total.bes = c->total.bes + c->currnt.bes; 1469 opte1->total.ses = c->total.ses + c->currnt.ses; 1470 opte1->total.oofs = c->total.oofs + c->currnt.oofs; 1471 opte1->total.css = c->total.css + c->currnt.css; 1472 opte1->total.dm = c->total.dm + c->currnt.dm; 1473 for (s=0; s<48; ++s) { 1474 opte1->interval[s].bpv = c->interval[s].bpv; 1475 opte1->interval[s].fse = c->interval[s].fse; 1476 opte1->interval[s].crce = c->interval[s].crce; 1477 opte1->interval[s].rcrce = c->interval[s].rcrce; 1478 opte1->interval[s].uas = c->interval[s].uas; 1479 opte1->interval[s].les = c->interval[s].les; 1480 opte1->interval[s].es = c->interval[s].es; 1481 opte1->interval[s].bes = c->interval[s].bes; 1482 opte1->interval[s].ses = c->interval[s].ses; 1483 opte1->interval[s].oofs = c->interval[s].oofs; 1484 opte1->interval[s].css = c->interval[s].css; 1485 opte1->interval[s].dm = c->interval[s].dm; 1486 } 1487 return 0; 1488 1489 case SERIAL_CLRSTAT: 1490 CE_DEBUG2 (d, ("ioctl: clrstat\n")); 1491 /* Only for superuser! */ 1492#if __FreeBSD_version < 500000 1493 error = suser (p); 1494#elif __FreeBSD_version < 700000 1495 error = suser (td); 1496#else 1497 error = priv_check (td, PRIV_DRIVER); 1498#endif 1499 if (error) 1500 return error; 1501 c->rintr = 0; 1502 c->tintr = 0; 1503 c->ibytes = 0; 1504 c->obytes = 0; 1505 c->ipkts = 0; 1506 c->opkts = 0; 1507 c->overrun = 0; 1508 c->frame = 0; 1509 c->crc = 0; 1510 c->underrun = 0; 1511 bzero (&c->currnt, sizeof (c->currnt)); 1512 bzero (&c->total, sizeof (c->total)); 1513 bzero (c->interval, sizeof (c->interval)); 1514 return 0; 1515 1516 case SERIAL_GETLOOP: 1517 CE_DEBUG2 (d, ("ioctl: getloop\n")); 1518 if (c->type != T_E1) 1519 return EINVAL; 1520 *(int*)data = c->lloop; 1521 return 0; 1522 1523 case SERIAL_SETLOOP: 1524 CE_DEBUG2 (d, ("ioctl: setloop\n")); 1525 if (c->type != T_E1) 1526 return EINVAL; 1527 /* Only for superuser! */ 1528#if __FreeBSD_version < 500000 1529 error = suser (p); 1530#elif __FreeBSD_version < 700000 1531 error = suser (td); 1532#else 1533 error = priv_check (td, PRIV_DRIVER); 1534#endif 1535 if (error) 1536 return error; 1537 s = splimp (); 1538 CE_LOCK (bd); 1539 ce_set_lloop (c, *(int*)data); 1540 CE_UNLOCK (bd); 1541 splx (s); 1542 return 0; 1543 1544 case SERIAL_GETRLOOP: 1545 CE_DEBUG2 (d, ("ioctl: getrloop\n")); 1546 if (c->type != T_E1) 1547 return EINVAL; 1548 *(int*)data = c->rloop; 1549 return 0; 1550 1551 case SERIAL_SETRLOOP: 1552 CE_DEBUG2 (d, ("ioctl: setloop\n")); 1553 if (c->type != T_E1) 1554 return EINVAL; 1555 /* Only for superuser! */ 1556#if __FreeBSD_version < 500000 1557 error = suser (p); 1558#elif __FreeBSD_version < 700000 1559 error = suser (td); 1560#else 1561 error = priv_check (td, PRIV_DRIVER); 1562#endif 1563 if (error) 1564 return error; 1565 s = splimp (); 1566 CE_LOCK (bd); 1567 ce_set_rloop (c, *(int*)data); 1568 CE_UNLOCK (bd); 1569 splx (s); 1570 return 0; 1571 1572 case SERIAL_GETDEBUG: 1573 CE_DEBUG2 (d, ("ioctl: getdebug\n")); 1574 *(int*)data = d->chan->debug; 1575 return 0; 1576 1577 case SERIAL_SETDEBUG: 1578 CE_DEBUG2 (d, ("ioctl: setdebug\n")); 1579 /* Only for superuser! */ 1580#if __FreeBSD_version < 500000 1581 error = suser (p); 1582#elif __FreeBSD_version < 700000 1583 error = suser (td); 1584#else 1585 error = priv_check (td, PRIV_DRIVER); 1586#endif 1587 if (error) 1588 return error; 1589#ifndef NETGRAPH 1590 /* 1591 * The debug_shadow is always greater than zero for logic 1592 * simplicity. For switching debug off the IFF_DEBUG is 1593 * responsible. 1594 */ 1595 d->chan->debug_shadow = (*(int*)data) ? (*(int*)data) : 1; 1596 if (d->ifp->if_flags & IFF_DEBUG) 1597 d->chan->debug = d->chan->debug_shadow; 1598#else 1599 d->chan->debug = *(int*)data; 1600#endif 1601 return 0; 1602 1603 case SERIAL_GETBAUD: 1604 CE_DEBUG2 (d, ("ioctl: getbaud\n")); 1605 *(long*)data = c->baud; 1606 return 0; 1607 1608 case SERIAL_SETBAUD: 1609 CE_DEBUG2 (d, ("ioctl: setbaud\n")); 1610 if (c->type != T_E1 || !c->unfram) 1611 return EINVAL; 1612 /* Only for superuser! */ 1613#if __FreeBSD_version < 500000 1614 error = suser (p); 1615#elif __FreeBSD_version < 700000 1616 error = suser (td); 1617#else 1618 error = priv_check (td, PRIV_DRIVER); 1619#endif 1620 if (error) 1621 return error; 1622 s = splimp (); 1623 CE_LOCK (bd); 1624 ce_set_baud (c, *(long*)data); 1625 CE_UNLOCK (bd); 1626 splx (s); 1627 return 0; 1628 1629 case SERIAL_GETTIMESLOTS: 1630 CE_DEBUG2 (d, ("ioctl: gettimeslots\n")); 1631 if ((c->type != T_E1 || c->unfram) && c->type != T_DATA) 1632 return EINVAL; 1633 *(u_long*)data = c->ts; 1634 return 0; 1635 1636 case SERIAL_SETTIMESLOTS: 1637 CE_DEBUG2 (d, ("ioctl: settimeslots\n")); 1638 /* Only for superuser! */ 1639#if __FreeBSD_version < 500000 1640 error = suser (p); 1641#elif __FreeBSD_version < 700000 1642 error = suser (td); 1643#else 1644 error = priv_check (td, PRIV_DRIVER); 1645#endif 1646 if (error) 1647 return error; 1648 if ((c->type != T_E1 || c->unfram) && c->type != T_DATA) 1649 return EINVAL; 1650 s = splimp (); 1651 CE_LOCK (bd); 1652 ce_set_ts (c, *(u_long*)data); 1653 CE_UNLOCK (bd); 1654 splx (s); 1655 return 0; 1656 1657 case SERIAL_GETHIGAIN: 1658 CE_DEBUG2 (d, ("ioctl: gethigain\n")); 1659 if (c->type != T_E1) 1660 return EINVAL; 1661 *(int*)data = c->higain; 1662 return 0; 1663 1664 case SERIAL_SETHIGAIN: 1665 CE_DEBUG2 (d, ("ioctl: sethigain\n")); 1666 if (c->type != T_E1) 1667 return EINVAL; 1668 /* Only for superuser! */ 1669#if __FreeBSD_version < 500000 1670 error = suser (p); 1671#elif __FreeBSD_version < 700000 1672 error = suser (td); 1673#else 1674 error = priv_check (td, PRIV_DRIVER); 1675#endif 1676 if (error) 1677 return error; 1678 s = splimp (); 1679 CE_LOCK (bd); 1680 ce_set_higain (c, *(int*)data); 1681 CE_UNLOCK (bd); 1682 splx (s); 1683 return 0; 1684 1685 case SERIAL_GETPHONY: 1686 CE_DEBUG2 (d, ("ioctl: getphony\n")); 1687 *(int*)data = c->phony; 1688 return 0; 1689 1690 case SERIAL_SETPHONY: 1691 CE_DEBUG2 (d, ("ioctl: setphony\n")); 1692 /* Only for superuser! */ 1693#if __FreeBSD_version < 500000 1694 error = suser (p); 1695#elif __FreeBSD_version < 700000 1696 error = suser (td); 1697#else 1698 error = priv_check (td, PRIV_DRIVER); 1699#endif 1700 if (error) 1701 return error; 1702 s = splimp (); 1703 CE_LOCK (bd); 1704 ce_set_phony (c, *(int*)data); 1705 CE_UNLOCK (bd); 1706 splx (s); 1707 return 0; 1708 1709 case SERIAL_GETUNFRAM: 1710 CE_DEBUG2 (d, ("ioctl: getunfram\n")); 1711 if (c->type != T_E1 || c->num != 0) 1712 return EINVAL; 1713 *(int*)data = c->unfram; 1714 return 0; 1715 1716 case SERIAL_SETUNFRAM: 1717 CE_DEBUG2 (d, ("ioctl: setunfram\n")); 1718 if (c->type != T_E1 || c->num != 0) 1719 return EINVAL; 1720 /* Only for superuser! */ 1721#if __FreeBSD_version < 500000 1722 error = suser (p); 1723#elif __FreeBSD_version < 700000 1724 error = suser (td); 1725#else 1726 error = priv_check (td, PRIV_DRIVER); 1727#endif 1728 if (error) 1729 return error; 1730 s = splimp (); 1731 CE_LOCK (bd); 1732 ce_set_unfram (c, *(int*)data); 1733 CE_UNLOCK (bd); 1734 splx (s); 1735 return 0; 1736 1737 case SERIAL_GETSCRAMBLER: 1738 CE_DEBUG2 (d, ("ioctl: getscrambler\n")); 1739 if (!c->unfram) 1740 return EINVAL; 1741 *(int*)data = c->scrambler; 1742 return 0; 1743 1744 case SERIAL_SETSCRAMBLER: 1745 CE_DEBUG2 (d, ("ioctl: setscrambler\n")); 1746 /* Only for superuser! */ 1747#if __FreeBSD_version < 500000 1748 error = suser (p); 1749#elif __FreeBSD_version < 700000 1750 error = suser (td); 1751#else 1752 error = priv_check (td, PRIV_DRIVER); 1753#endif 1754 if (error) 1755 return error; 1756 if (!c->unfram) 1757 return EINVAL; 1758 s = splimp (); 1759 CE_LOCK (bd); 1760 ce_set_scrambler (c, *(int*)data); 1761 CE_UNLOCK (bd); 1762 splx (s); 1763 return 0; 1764 1765 case SERIAL_GETMONITOR: 1766 CE_DEBUG2 (d, ("ioctl: getmonitor\n")); 1767 if (c->type != T_E1) 1768 return EINVAL; 1769 *(int*)data = c->monitor; 1770 return 0; 1771 1772 case SERIAL_SETMONITOR: 1773 CE_DEBUG2 (d, ("ioctl: setmonitor\n")); 1774 /* Only for superuser! */ 1775#if __FreeBSD_version < 500000 1776 error = suser (p); 1777#elif __FreeBSD_version < 700000 1778 error = suser (td); 1779#else 1780 error = priv_check (td, PRIV_DRIVER); 1781#endif 1782 if (error) 1783 return error; 1784 if (c->type != T_E1) 1785 return EINVAL; 1786 s = splimp (); 1787 CE_LOCK (bd); 1788 ce_set_monitor (c, *(int*)data); 1789 CE_UNLOCK (bd); 1790 splx (s); 1791 return 0; 1792 1793 case SERIAL_GETUSE16: 1794 CE_DEBUG2 (d, ("ioctl: getuse16\n")); 1795 if (c->type != T_E1 || c->unfram) 1796 return EINVAL; 1797 *(int*)data = c->use16; 1798 return 0; 1799 1800 case SERIAL_SETUSE16: 1801 CE_DEBUG2 (d, ("ioctl: setuse16\n")); 1802 /* Only for superuser! */ 1803#if __FreeBSD_version < 500000 1804 error = suser (p); 1805#elif __FreeBSD_version < 700000 1806 error = suser (td); 1807#else 1808 error = priv_check (td, PRIV_DRIVER); 1809#endif 1810 if (error) 1811 return error; 1812 if (c->type != T_E1) 1813 return EINVAL; 1814 s = splimp (); 1815 CE_LOCK (bd); 1816 ce_set_use16 (c, *(int*)data); 1817 CE_UNLOCK (bd); 1818 splx (s); 1819 return 0; 1820 1821 case SERIAL_GETCRC4: 1822 CE_DEBUG2 (d, ("ioctl: getcrc4\n")); 1823 if (c->type != T_E1 || c->unfram) 1824 return EINVAL; 1825 *(int*)data = c->crc4; 1826 return 0; 1827 1828 case SERIAL_SETCRC4: 1829 CE_DEBUG2 (d, ("ioctl: setcrc4\n")); 1830 /* Only for superuser! */ 1831#if __FreeBSD_version < 500000 1832 error = suser (p); 1833#elif __FreeBSD_version < 700000 1834 error = suser (td); 1835#else 1836 error = priv_check (td, PRIV_DRIVER); 1837#endif 1838 if (error) 1839 return error; 1840 if (c->type != T_E1 || c->unfram) 1841 return EINVAL; 1842 s = splimp (); 1843 CE_LOCK (bd); 1844 ce_set_crc4 (c, *(int*)data); 1845 CE_UNLOCK (bd); 1846 splx (s); 1847 return 0; 1848 1849 case SERIAL_GETCLK: 1850 CE_DEBUG2 (d, ("ioctl: getclk\n")); 1851 if (c->type != T_E1) 1852 return EINVAL; 1853 switch (c->gsyn) { 1854 default: *(int*)data = E1CLK_INTERNAL; break; 1855 case GSYN_RCV: *(int*)data = E1CLK_RECEIVE; break; 1856 case GSYN_RCV0: *(int*)data = E1CLK_RECEIVE_CHAN0; break; 1857 case GSYN_RCV1: *(int*)data = E1CLK_RECEIVE_CHAN1; break; 1858 } 1859 return 0; 1860 1861 case SERIAL_SETCLK: 1862 CE_DEBUG2 (d, ("ioctl: setclk\n")); 1863 /* Only for superuser! */ 1864#if __FreeBSD_version < 500000 1865 error = suser (p); 1866#elif __FreeBSD_version < 700000 1867 error = suser (td); 1868#else 1869 error = priv_check (td, PRIV_DRIVER); 1870#endif 1871 if (error) 1872 return error; 1873 if (c->type != T_E1) 1874 return EINVAL; 1875 s = splimp (); 1876 CE_LOCK (bd); 1877 switch (*(int*)data) { 1878 default: ce_set_gsyn (c, GSYN_INT); break; 1879 case E1CLK_RECEIVE: ce_set_gsyn (c, GSYN_RCV); break; 1880 case E1CLK_RECEIVE_CHAN0: ce_set_gsyn (c, GSYN_RCV0); break; 1881 case E1CLK_RECEIVE_CHAN1: ce_set_gsyn (c, GSYN_RCV1); break; 1882 } 1883 CE_UNLOCK (bd); 1884 splx (s); 1885 return 0; 1886 1887#if 0 1888 case SERIAL_RESET: 1889 CE_DEBUG2 (d, ("ioctl: reset\n")); 1890 /* Only for superuser! */ 1891#if __FreeBSD_version < 500000 1892 error = suser (p); 1893#elif __FreeBSD_version < 700000 1894 error = suser (td); 1895#else 1896 error = priv_check (td, PRIV_DRIVER); 1897#endif 1898 if (error) 1899 return error; 1900 s = splimp (); 1901 CE_LOCK (bd); 1902/* ce_reset (c->board, 0, 0);*/ 1903 CE_UNLOCK (bd); 1904 splx (s); 1905 return 0; 1906 1907 case SERIAL_HARDRESET: 1908 CE_DEBUG2 (d, ("ioctl: hardreset\n")); 1909 /* Only for superuser! */ 1910#if __FreeBSD_version < 500000 1911 error = suser (p); 1912#elif __FreeBSD_version < 700000 1913 error = suser (td); 1914#else 1915 error = priv_check (td, PRIV_DRIVER); 1916#endif 1917 if (error) 1918 return error; 1919 s = splimp (); 1920 CE_LOCK (bd); 1921 /* hard_reset (c->board); */ 1922 CE_UNLOCK (bd); 1923 splx (s); 1924 return 0; 1925#endif 1926 1927 case SERIAL_GETCABLE: 1928 CE_DEBUG2 (d, ("ioctl: getcable\n")); 1929 if (c->type != T_E1) 1930 return EINVAL; 1931 s = splimp (); 1932 CE_LOCK (bd); 1933 *(int*)data = CABLE_TP; 1934 CE_UNLOCK (bd); 1935 splx (s); 1936 return 0; 1937 1938 case SERIAL_GETDIR: 1939 CE_DEBUG2 (d, ("ioctl: getdir\n")); 1940 if (c->type != T_E1 && c->type != T_DATA) 1941 return EINVAL; 1942 *(int*)data = c->dir; 1943 return 0; 1944 1945 case SERIAL_SETDIR: 1946 CE_DEBUG2 (d, ("ioctl: setdir\n")); 1947 /* Only for superuser! */ 1948#if __FreeBSD_version < 500000 1949 error = suser (p); 1950#elif __FreeBSD_version < 700000 1951 error = suser (td); 1952#else 1953 error = priv_check (td, PRIV_DRIVER); 1954#endif 1955 if (error) 1956 return error; 1957 s = splimp (); 1958 CE_LOCK (bd); 1959 ce_set_dir (c, *(int*)data); 1960 CE_UNLOCK (bd); 1961 splx (s); 1962 return 0; 1963 1964 case TIOCSDTR: /* Set DTR */ 1965 s = splimp (); 1966 CE_LOCK (bd); 1967 ce_set_dtr (c, 1); 1968 CE_UNLOCK (bd); 1969 splx (s); 1970 return 0; 1971 1972 case TIOCCDTR: /* Clear DTR */ 1973 s = splimp (); 1974 CE_LOCK (bd); 1975 ce_set_dtr (c, 0); 1976 CE_UNLOCK (bd); 1977 splx (s); 1978 return 0; 1979 1980 case TIOCMSET: /* Set DTR/RTS */ 1981 s = splimp (); 1982 CE_LOCK (bd); 1983 ce_set_dtr (c, (*(int*)data & TIOCM_DTR) ? 1 : 0); 1984 ce_set_rts (c, (*(int*)data & TIOCM_RTS) ? 1 : 0); 1985 CE_UNLOCK (bd); 1986 splx (s); 1987 return 0; 1988 1989 case TIOCMBIS: /* Add DTR/RTS */ 1990 s = splimp (); 1991 CE_LOCK (bd); 1992 if (*(int*)data & TIOCM_DTR) ce_set_dtr (c, 1); 1993 if (*(int*)data & TIOCM_RTS) ce_set_rts (c, 1); 1994 CE_UNLOCK (bd); 1995 splx (s); 1996 return 0; 1997 1998 case TIOCMBIC: /* Clear DTR/RTS */ 1999 s = splimp (); 2000 CE_LOCK (bd); 2001 if (*(int*)data & TIOCM_DTR) ce_set_dtr (c, 0); 2002 if (*(int*)data & TIOCM_RTS) ce_set_rts (c, 0); 2003 CE_UNLOCK (bd); 2004 splx (s); 2005 return 0; 2006 2007 case TIOCMGET: /* Get modem status */ 2008 *(int*)data = ce_modem_status (c); 2009 return 0; 2010 } 2011 return ENOTTY; 2012} 2013 2014#ifdef NETGRAPH 2015#if __FreeBSD_version >= 500000 2016static int ng_ce_constructor (node_p node) 2017{ 2018 drv_t *d = NG_NODE_PRIVATE (node); 2019#else 2020static int ng_ce_constructor (node_p *node) 2021{ 2022 drv_t *d = (*node)->private; 2023#endif 2024 CE_DEBUG (d, ("Constructor\n")); 2025 return EINVAL; 2026} 2027 2028static int ng_ce_newhook (node_p node, hook_p hook, const char *name) 2029{ 2030 int s; 2031#if __FreeBSD_version >= 500000 2032 drv_t *d = NG_NODE_PRIVATE (node); 2033#else 2034 drv_t *d = node->private; 2035#endif 2036 bdrv_t *bd = d->board->sys; 2037 2038 CE_DEBUG (d, ("Newhook\n")); 2039 /* Attach debug hook */ 2040 if (strcmp (name, NG_CE_HOOK_DEBUG) == 0) { 2041#if __FreeBSD_version >= 500000 2042 NG_HOOK_SET_PRIVATE (hook, NULL); 2043#else 2044 hook->private = 0; 2045#endif 2046 d->debug_hook = hook; 2047 return 0; 2048 } 2049 2050 /* Check for raw hook */ 2051 if (strcmp (name, NG_CE_HOOK_RAW) != 0) 2052 return EINVAL; 2053 2054#if __FreeBSD_version >= 500000 2055 NG_HOOK_SET_PRIVATE (hook, d); 2056#else 2057 hook->private = d; 2058#endif 2059 d->hook = hook; 2060 s = splimp (); 2061 CE_LOCK (bd); 2062 ce_up (d); 2063 CE_UNLOCK (bd); 2064 splx (s); 2065 return 0; 2066} 2067 2068static char *format_timeslots (u_long s) 2069{ 2070 static char buf [100]; 2071 char *p = buf; 2072 int i; 2073 2074 for (i=1; i<32; ++i) 2075 if ((s >> i) & 1) { 2076 int prev = (i > 1) & (s >> (i-1)); 2077 int next = (i < 31) & (s >> (i+1)); 2078 2079 if (prev) { 2080 if (next) 2081 continue; 2082 *p++ = '-'; 2083 } else if (p > buf) 2084 *p++ = ','; 2085 2086 if (i >= 10) 2087 *p++ = '0' + i / 10; 2088 *p++ = '0' + i % 10; 2089 } 2090 *p = 0; 2091 return buf; 2092} 2093 2094static int print_modems (char *s, ce_chan_t *c, int need_header) 2095{ 2096 int status = ce_modem_status (c); 2097 int length = 0; 2098 2099 if (need_header) 2100 length += sprintf (s + length, " LE DTR DSR RTS CTS CD\n"); 2101 length += sprintf (s + length, "%4s %4s %4s %4s %4s %4s\n", 2102 status & TIOCM_LE ? "On" : "-", 2103 status & TIOCM_DTR ? "On" : "-", 2104 status & TIOCM_DSR ? "On" : "-", 2105 status & TIOCM_RTS ? "On" : "-", 2106 status & TIOCM_CTS ? "On" : "-", 2107 status & TIOCM_CD ? "On" : "-"); 2108 return length; 2109} 2110 2111static int print_stats (char *s, ce_chan_t *c, int need_header) 2112{ 2113 int length = 0; 2114 2115 if (need_header) 2116 length += sprintf (s + length, " Rintr Tintr Mintr Ibytes Ipkts Ierrs Obytes Opkts Oerrs\n"); 2117 length += sprintf (s + length, "%7ld %7ld %7ld %8lu %7ld %7ld %8lu %7ld %7ld\n", 2118 c->rintr, c->tintr, 0l, (unsigned long) c->ibytes, 2119 c->ipkts, c->overrun + c->frame + c->crc, 2120 (unsigned long) c->obytes, c->opkts, c->underrun); 2121 return length; 2122} 2123 2124static char *format_e1_status (u_char status) 2125{ 2126 static char buf [80]; 2127 2128 if (status & E1_NOALARM) 2129 return "Ok"; 2130 buf[0] = 0; 2131 if (status & E1_LOS) strcat (buf, ",LOS"); 2132 if (status & E1_AIS) strcat (buf, ",AIS"); 2133 if (status & E1_LOF) strcat (buf, ",LOF"); 2134 if (status & E1_LOMF) strcat (buf, ",LOMF"); 2135 if (status & E1_FARLOF) strcat (buf, ",FARLOF"); 2136 if (status & E1_AIS16) strcat (buf, ",AIS16"); 2137 if (status & E1_FARLOMF) strcat (buf, ",FARLOMF"); 2138 if (status & E1_TSTREQ) strcat (buf, ",TSTREQ"); 2139 if (status & E1_TSTERR) strcat (buf, ",TSTERR"); 2140 if (buf[0] == ',') 2141 return buf+1; 2142 return "Unknown"; 2143} 2144 2145static int print_frac (char *s, int leftalign, u_long numerator, u_long divider) 2146{ 2147 int n, length = 0; 2148 2149 if (numerator < 1 || divider < 1) { 2150 length += sprintf (s+length, leftalign ? "/- " : " -"); 2151 return length; 2152 } 2153 n = (int) (0.5 + 1000.0 * numerator / divider); 2154 if (n < 1000) { 2155 length += sprintf (s+length, leftalign ? "/.%-3d" : " .%03d", n); 2156 return length; 2157 } 2158 *(s + length) = leftalign ? '/' : ' '; 2159 length ++; 2160 2161 if (n >= 1000000) n = (n+500) / 1000 * 1000; 2162 else if (n >= 100000) n = (n+50) / 100 * 100; 2163 else if (n >= 10000) n = (n+5) / 10 * 10; 2164 2165 switch (n) { 2166 case 1000: length += printf (s+length, ".999"); return length; 2167 case 10000: n = 9990; break; 2168 case 100000: n = 99900; break; 2169 case 1000000: n = 999000; break; 2170 } 2171 if (n < 10000) length += sprintf (s+length, "%d.%d", n/1000, n/10%100); 2172 else if (n < 100000) length += sprintf (s+length, "%d.%d", n/1000, n/100%10); 2173 else if (n < 1000000) length += sprintf (s+length, "%d.", n/1000); 2174 else length += sprintf (s+length, "%d", n/1000); 2175 2176 return length; 2177} 2178 2179static int print_e1_stats (char *s, ce_chan_t *c) 2180{ 2181 struct e1_counters total; 2182 u_long totsec; 2183 int length = 0; 2184 2185 totsec = c->totsec + c->cursec; 2186 total.bpv = c->total.bpv + c->currnt.bpv; 2187 total.fse = c->total.fse + c->currnt.fse; 2188 total.crce = c->total.crce + c->currnt.crce; 2189 total.rcrce = c->total.rcrce + c->currnt.rcrce; 2190 total.uas = c->total.uas + c->currnt.uas; 2191 total.les = c->total.les + c->currnt.les; 2192 total.es = c->total.es + c->currnt.es; 2193 total.bes = c->total.bes + c->currnt.bes; 2194 total.ses = c->total.ses + c->currnt.ses; 2195 total.oofs = c->total.oofs + c->currnt.oofs; 2196 total.css = c->total.css + c->currnt.css; 2197 total.dm = c->total.dm + c->currnt.dm; 2198 2199 length += sprintf (s + length, " Unav/Degr Bpv/Fsyn CRC/RCRC Err/Lerr Sev/Bur Oof/Slp Status\n"); 2200 2201 /* Unavailable seconds, degraded minutes */ 2202 length += print_frac (s + length, 0, c->currnt.uas, c->cursec); 2203 length += print_frac (s + length, 1, 60 * c->currnt.dm, c->cursec); 2204 2205 /* Bipolar violations, frame sync errors */ 2206 length += print_frac (s + length, 0, c->currnt.bpv, c->cursec); 2207 length += print_frac (s + length, 1, c->currnt.fse, c->cursec); 2208 2209 /* CRC errors, remote CRC errors (E-bit) */ 2210 length += print_frac (s + length, 0, c->currnt.crce, c->cursec); 2211 length += print_frac (s + length, 1, c->currnt.rcrce, c->cursec); 2212 2213 /* Errored seconds, line errored seconds */ 2214 length += print_frac (s + length, 0, c->currnt.es, c->cursec); 2215 length += print_frac (s + length, 1, c->currnt.les, c->cursec); 2216 2217 /* Severely errored seconds, burst errored seconds */ 2218 length += print_frac (s + length, 0, c->currnt.ses, c->cursec); 2219 length += print_frac (s + length, 1, c->currnt.bes, c->cursec); 2220 2221 /* Out of frame seconds, controlled slip seconds */ 2222 length += print_frac (s + length, 0, c->currnt.oofs, c->cursec); 2223 length += print_frac (s + length, 1, c->currnt.css, c->cursec); 2224 2225 length += sprintf (s + length, " %s\n", format_e1_status (c->status)); 2226 2227 /* Print total statistics. */ 2228 length += print_frac (s + length, 0, total.uas, totsec); 2229 length += print_frac (s + length, 1, 60 * total.dm, totsec); 2230 2231 length += print_frac (s + length, 0, total.bpv, totsec); 2232 length += print_frac (s + length, 1, total.fse, totsec); 2233 2234 length += print_frac (s + length, 0, total.crce, totsec); 2235 length += print_frac (s + length, 1, total.rcrce, totsec); 2236 2237 length += print_frac (s + length, 0, total.es, totsec); 2238 length += print_frac (s + length, 1, total.les, totsec); 2239 2240 length += print_frac (s + length, 0, total.ses, totsec); 2241 length += print_frac (s + length, 1, total.bes, totsec); 2242 2243 length += print_frac (s + length, 0, total.oofs, totsec); 2244 length += print_frac (s + length, 1, total.css, totsec); 2245 2246 length += sprintf (s + length, " -- Total\n"); 2247 return length; 2248} 2249 2250static int print_chan (char *s, ce_chan_t *c) 2251{ 2252 drv_t *d = c->sys; 2253 int length = 0; 2254 2255 length += sprintf (s + length, "ce%d", c->board->num * NCHAN + c->num); 2256 if (d->chan->debug) 2257 length += sprintf (s + length, " debug=%d", d->chan->debug); 2258 2259 if (c->board->mux) { 2260 length += sprintf (s + length, " cfg=C"); 2261 } else { 2262 length += sprintf (s + length, " cfg=A"); 2263 } 2264 2265 if (c->baud) 2266 length += sprintf (s + length, " %ld", c->baud); 2267 else 2268 length += sprintf (s + length, " extclock"); 2269 2270 if (c->type == T_E1) 2271 switch (c->gsyn) { 2272 case GSYN_INT : length += sprintf (s + length, " syn=int"); break; 2273 case GSYN_RCV : length += sprintf (s + length, " syn=rcv"); break; 2274 case GSYN_RCV0 : length += sprintf (s + length, " syn=rcv0"); break; 2275 case GSYN_RCV1 : length += sprintf (s + length, " syn=rcv1"); break; 2276 } 2277 if (c->type == T_E1) 2278 length += sprintf (s + length, " higain=%s", c->higain ? "on" : "off"); 2279 2280 length += sprintf (s + length, " loop=%s", c->lloop ? "on" : "off"); 2281 2282 if (c->type == T_E1) 2283 length += sprintf (s + length, " ts=%s", format_timeslots (c->ts)); 2284 length += sprintf (s + length, "\n"); 2285 return length; 2286} 2287 2288#if __FreeBSD_version >= 500000 2289static int ng_ce_rcvmsg (node_p node, item_p item, hook_p lasthook) 2290{ 2291 drv_t *d = NG_NODE_PRIVATE (node); 2292 struct ng_mesg *msg; 2293#else 2294static int ng_ce_rcvmsg (node_p node, struct ng_mesg *msg, 2295 const char *retaddr, struct ng_mesg **rptr) 2296{ 2297 drv_t *d = node->private; 2298#endif 2299 struct ng_mesg *resp = NULL; 2300 int error = 0; 2301 2302 CE_DEBUG (d, ("Rcvmsg\n")); 2303#if __FreeBSD_version >= 500000 2304 NGI_GET_MSG (item, msg); 2305#endif 2306 switch (msg->header.typecookie) { 2307 default: 2308 error = EINVAL; 2309 break; 2310 2311 case NGM_CE_COOKIE: 2312 printf ("Not implemented yet\n"); 2313 error = EINVAL; 2314 break; 2315 2316 case NGM_GENERIC_COOKIE: 2317 switch (msg->header.cmd) { 2318 default: 2319 error = EINVAL; 2320 break; 2321 2322 case NGM_TEXT_STATUS: { 2323 char *s; 2324 int l = 0; 2325 int dl = sizeof (struct ng_mesg) + 730; 2326 2327#if __FreeBSD_version >= 500000 2328 NG_MKRESPONSE (resp, msg, dl, M_NOWAIT); 2329 if (! resp) { 2330 error = ENOMEM; 2331 break; 2332 } 2333#else 2334 resp = malloc (M_NETGRAPH, M_NOWAIT); 2335 if (! resp) { 2336 error = ENOMEM; 2337 break; 2338 } 2339 bzero (resp, dl); 2340#endif 2341 s = (resp)->data; 2342 if (d) { 2343 l += print_chan (s + l, d->chan); 2344 l += print_stats (s + l, d->chan, 1); 2345 l += print_modems (s + l, d->chan, 1); 2346 l += print_e1_stats (s + l, d->chan); 2347 } else 2348 l += sprintf (s + l, "Error: node not connect to channel"); 2349#if __FreeBSD_version < 500000 2350 (resp)->header.version = NG_VERSION; 2351 (resp)->header.arglen = strlen (s) + 1; 2352 (resp)->header.token = msg->header.token; 2353 (resp)->header.typecookie = NGM_CE_COOKIE; 2354 (resp)->header.cmd = msg->header.cmd; 2355#endif 2356 strncpy ((resp)->header.cmdstr, "status", NG_CMDSTRSIZ); 2357 } 2358 break; 2359 } 2360 break; 2361 } 2362#if __FreeBSD_version >= 500000 2363 NG_RESPOND_MSG (error, node, item, resp); 2364 NG_FREE_MSG (msg); 2365#else 2366 *rptr = resp; 2367 free (msg, M_NETGRAPH); 2368#endif 2369 return error; 2370} 2371 2372#if __FreeBSD_version >= 500000 2373static int ng_ce_rcvdata (hook_p hook, item_p item) 2374{ 2375 drv_t *d = NG_NODE_PRIVATE (NG_HOOK_NODE(hook)); 2376 struct mbuf *m; 2377#if __FreeBSD_version < 502120 2378 meta_p meta; 2379#else 2380 struct ng_tag_prio *ptag; 2381#endif 2382#else 2383static int ng_ce_rcvdata (hook_p hook, struct mbuf *m, meta_p meta) 2384{ 2385 drv_t *d = hook->node->private; 2386#endif 2387 bdrv_t *bd = d->board->sys; 2388 struct ifqueue *q; 2389 int s; 2390 2391 CE_DEBUG2 (d, ("Rcvdata\n")); 2392#if __FreeBSD_version >= 500000 2393 NGI_GET_M (item, m); 2394#if __FreeBSD_version < 502120 2395 NGI_GET_META (item, meta); 2396#endif 2397 NG_FREE_ITEM (item); 2398 if (! NG_HOOK_PRIVATE (hook) || ! d) { 2399 NG_FREE_M (m); 2400#if __FreeBSD_version < 502120 2401 NG_FREE_META (meta); 2402#endif 2403#else 2404 if (! hook->private || ! d) { 2405 NG_FREE_DATA (m,meta); 2406#endif 2407 return ENETDOWN; 2408 } 2409 2410#if __FreeBSD_version >= 502120 2411 /* Check for high priority data */ 2412 if ((ptag = (struct ng_tag_prio *)m_tag_locate(m, NGM_GENERIC_COOKIE, 2413 NG_TAG_PRIO, NULL)) != NULL && (ptag->priority > NG_PRIO_CUTOFF) ) 2414 q = &d->hi_queue; 2415 else 2416 q = &d->queue; 2417#else 2418 q = (meta && meta->priority > 0) ? &d->hi_queue : &d->queue; 2419#endif 2420 2421 s = splimp (); 2422 CE_LOCK (bd); 2423#if __FreeBSD_version >= 500000 2424 IF_LOCK (q); 2425 if (_IF_QFULL (q)) { 2426 _IF_DROP (q); 2427 IF_UNLOCK (q); 2428 CE_UNLOCK (bd); 2429 splx (s); 2430 NG_FREE_M (m); 2431#if __FreeBSD_version < 502120 2432 NG_FREE_META (meta); 2433#endif 2434 return ENOBUFS; 2435 } 2436 _IF_ENQUEUE (q, m); 2437 IF_UNLOCK (q); 2438#else 2439 if (IF_QFULL (q)) { 2440 IF_DROP (q); 2441 CE_UNLOCK (bd); 2442 splx (s); 2443 NG_FREE_DATA (m, meta); 2444 return ENOBUFS; 2445 } 2446 IF_ENQUEUE (q, m); 2447#endif 2448 ce_start (d); 2449 CE_UNLOCK (bd); 2450 splx (s); 2451 return 0; 2452} 2453 2454static int ng_ce_rmnode (node_p node) 2455{ 2456#if __FreeBSD_version >= 500000 2457 drv_t *d = NG_NODE_PRIVATE (node); 2458 2459 CE_DEBUG (d, ("Rmnode\n")); 2460 if (d && d->running) { 2461 bdrv_t *bd = d->board->sys; 2462 int s = splimp (); 2463 CE_LOCK (bd); 2464 ce_down (d); 2465 CE_UNLOCK (bd); 2466 splx (s); 2467 } 2468#ifdef KLD_MODULE 2469#if __FreeBSD_version >= 502120 2470 if (node->nd_flags & NGF_REALLY_DIE) { 2471#else 2472 if (node->nd_flags & NG_REALLY_DIE) { 2473#endif 2474 NG_NODE_SET_PRIVATE (node, NULL); 2475 NG_NODE_UNREF (node); 2476 } 2477#if __FreeBSD_version >= 502120 2478 NG_NODE_REVIVE(node); /* Persistant node */ 2479#else 2480 node->nd_flags &= ~NG_INVALID; 2481#endif 2482#endif 2483#else /* __FreeBSD_version < 500000 */ 2484 drv_t *d = node->private; 2485 2486 if (d && d->running) { 2487 bdrv_t *bd = d->board->sys; 2488 int s = splimp (); 2489 CE_LOCK (bd); 2490 ce_down (d); 2491 CE_UNLOCK (bd); 2492 splx (s); 2493 } 2494 2495 node->flags |= NG_INVALID; 2496 ng_cutlinks (node); 2497#ifdef KLD_MODULE 2498 ng_unname (node); 2499 ng_unref (node); 2500#endif 2501#endif 2502 return 0; 2503} 2504 2505static int ng_ce_connect (hook_p hook) 2506{ 2507#if __FreeBSD_version >= 500000 2508 drv_t *d = NG_NODE_PRIVATE (NG_HOOK_NODE (hook)); 2509#else 2510 drv_t *d = hook->node->private; 2511#endif 2512 2513 if (d) { 2514 CE_DEBUG (d, ("Connect\n")); 2515 callout_reset (&d->timeout_handle, hz, ce_watchdog_timer, d); 2516 } 2517 2518 return 0; 2519} 2520 2521static int ng_ce_disconnect (hook_p hook) 2522{ 2523#if __FreeBSD_version >= 500000 2524 drv_t *d = NG_NODE_PRIVATE (NG_HOOK_NODE (hook)); 2525#else 2526 drv_t *d = hook->node->private; 2527#endif 2528 2529 if (d) { 2530 CE_DEBUG (d, ("Disconnect\n")); 2531#if __FreeBSD_version >= 500000 2532 if (NG_HOOK_PRIVATE (hook)) 2533#else 2534 if (hook->private) 2535#endif 2536 { 2537 bdrv_t *bd = d->board->sys; 2538 int s = splimp (); 2539 CE_LOCK (bd); 2540 ce_down (d); 2541 CE_UNLOCK (bd); 2542 splx (s); 2543 } 2544 /* If we were wait it than it reasserted now, just stop it. */ 2545 if (!callout_drain (&d->timeout_handle)) 2546 callout_stop (&d->timeout_handle); 2547 } 2548 return 0; 2549} 2550#endif 2551 2552static int ce_modevent (module_t mod, int type, void *unused) 2553{ 2554#if __FreeBSD_version < 500000 2555 dev_t dev; 2556 struct cdevsw *cdsw; 2557#endif 2558 static int load_count = 0; 2559 2560#if __FreeBSD_version < 500000 2561 dev = makedev (CDEV_MAJOR, 0); 2562#endif 2563 2564 switch (type) { 2565 case MOD_LOAD: 2566#if __FreeBSD_version < 500000 2567 if (dev != NODEV && 2568 (cdsw = devsw (dev)) && 2569 cdsw->d_maj == CDEV_MAJOR) { 2570 printf ("Tau32-PCI driver is already in system\n"); 2571 return (ENXIO); 2572 } 2573#endif 2574#if __FreeBSD_version >= 500000 && defined NETGRAPH 2575 if (ng_newtype (&typestruct)) 2576 printf ("Failed to register ng_ce\n"); 2577#endif 2578 ++load_count; 2579#if __FreeBSD_version <= 500000 2580 cdevsw_add (&ce_cdevsw); 2581#endif 2582#if __FreeBSD_version >= 500000 2583 callout_init (&timeout_handle, CALLOUT_MPSAFE); 2584#else 2585 callout_init (&timeout_handle); 2586#endif 2587 callout_reset (&timeout_handle, hz*5, ce_timeout, 0); 2588 break; 2589 case MOD_UNLOAD: 2590 if (load_count == 1) { 2591 printf ("Removing device entry for Tau32-PCI\n"); 2592#if __FreeBSD_version <= 500000 2593 cdevsw_remove (&ce_cdevsw); 2594#endif 2595#if __FreeBSD_version >= 500000 && defined NETGRAPH 2596 ng_rmtype (&typestruct); 2597#endif 2598 } 2599 /* If we were wait it than it reasserted now, just stop it. 2600 * Actually we shouldn't get this condition. But code could be 2601 * changed in the future, so just be a litle paranoid. 2602 */ 2603 if (!callout_drain (&timeout_handle)) 2604 callout_stop (&timeout_handle); 2605 --load_count; 2606 break; 2607 case MOD_SHUTDOWN: 2608 break; 2609 } 2610 return 0; 2611} 2612 2613#ifdef NETGRAPH 2614#if __FreeBSD_version >= 502100 2615static struct ng_type typestruct = { 2616 .version = NG_ABI_VERSION, 2617 .name = NG_CE_NODE_TYPE, 2618 .constructor = ng_ce_constructor, 2619 .rcvmsg = ng_ce_rcvmsg, 2620 .shutdown = ng_ce_rmnode, 2621 .newhook = ng_ce_newhook, 2622 .connect = ng_ce_connect, 2623 .rcvdata = ng_ce_rcvdata, 2624 .disconnect = ng_ce_disconnect, 2625}; 2626#else /* __FreeBSD_version < 502100 */ 2627static struct ng_type typestruct = { 2628#if __FreeBSD_version >= 500000 2629 NG_ABI_VERSION, 2630#else 2631 NG_VERSION, 2632#endif 2633 NG_CE_NODE_TYPE, 2634 ce_modevent, 2635 ng_ce_constructor, 2636 ng_ce_rcvmsg, 2637 ng_ce_rmnode, 2638 ng_ce_newhook, 2639 NULL, 2640 ng_ce_connect, 2641 ng_ce_rcvdata, 2642#if __FreeBSD_version < 500000 2643 NULL, 2644#endif 2645 ng_ce_disconnect, 2646 NULL 2647}; 2648#endif /* __FreeBSD_version < 502100 */ 2649 2650#endif /*NETGRAPH*/ 2651 2652#if __FreeBSD_version >= 500000 2653#ifdef NETGRAPH 2654MODULE_DEPEND (ng_ce, netgraph, NG_ABI_VERSION, NG_ABI_VERSION, NG_ABI_VERSION); 2655#else 2656MODULE_DEPEND (ce, sppp, 1, 1, 1); 2657#endif 2658#ifdef KLD_MODULE 2659DRIVER_MODULE (cemod, pci, ce_driver, ce_devclass, ce_modevent, NULL); 2660#else 2661DRIVER_MODULE (ce, pci, ce_driver, ce_devclass, ce_modevent, NULL); 2662#endif 2663#else /* if __FreeBSD_version < 500000*/ 2664#ifdef NETGRAPH 2665DRIVER_MODULE (ce, pci, ce_driver, ce_devclass, ng_mod_event, &typestruct); 2666#else 2667DRIVER_MODULE (ce, pci, ce_driver, ce_devclass, ce_modevent, NULL); 2668#endif 2669#endif /* __FreeBSD_version < 500000 */ 2670#endif /* NPCI */ 2671