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