if_ce.c revision 207554
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 207554 2010-05-03 07:32:50Z sobomax $"); 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 } else if (! strcmp ("fr", (char*)data) && PP_FR) { 1317 d->ifp->if_flags &= ~(PP_CISCO); 1318 IFP2SP(d->ifp)->pp_flags |= PP_FR | PP_KEEPALIVE; 1319 } else if (! strcmp ("ppp", (char*)data)) { 1320 IFP2SP(d->ifp)->pp_flags &= ~PP_FR; 1321 IFP2SP(d->ifp)->pp_flags &= ~PP_KEEPALIVE; 1322 d->ifp->if_flags &= ~(PP_CISCO); 1323 } else 1324 return EINVAL; 1325 return 0; 1326 1327 case SERIAL_GETKEEPALIVE: 1328 CE_DEBUG2 (d, ("ioctl: getkeepalive\n")); 1329 if ((IFP2SP(d->ifp)->pp_flags & PP_FR) || 1330 (d->ifp->if_flags & PP_CISCO)) 1331 return EINVAL; 1332 *(int*)data = (IFP2SP(d->ifp)->pp_flags & PP_KEEPALIVE) ? 1 : 0; 1333 return 0; 1334 1335 case SERIAL_SETKEEPALIVE: 1336 CE_DEBUG2 (d, ("ioctl: setkeepalive\n")); 1337 /* Only for superuser! */ 1338#if __FreeBSD_version < 500000 1339 error = suser (p); 1340#elif __FreeBSD_version < 700000 1341 error = suser (td); 1342#else 1343 error = priv_check (td, PRIV_DRIVER); 1344#endif 1345 if (error) 1346 return error; 1347 if ((IFP2SP(d->ifp)->pp_flags & PP_FR) || 1348 (d->ifp->if_flags & PP_CISCO)) 1349 return EINVAL; 1350 s = splimp (); 1351 CE_LOCK (bd); 1352 if (*(int*)data) 1353 IFP2SP(d->ifp)->pp_flags |= PP_KEEPALIVE; 1354 else 1355 IFP2SP(d->ifp)->pp_flags &= ~PP_KEEPALIVE; 1356 CE_UNLOCK (bd); 1357 splx (s); 1358 return 0; 1359#endif /*NETGRAPH*/ 1360 1361 case SERIAL_GETMODE: 1362 CE_DEBUG2 (d, ("ioctl: getmode\n")); 1363 *(int*)data = SERIAL_HDLC; 1364 return 0; 1365 1366 case SERIAL_SETMODE: 1367 /* Only for superuser! */ 1368#if __FreeBSD_version < 500000 1369 error = suser (p); 1370#elif __FreeBSD_version < 700000 1371 error = suser (td); 1372#else 1373 error = priv_check (td, PRIV_DRIVER); 1374#endif 1375 if (error) 1376 return error; 1377 if (*(int*)data != SERIAL_HDLC) 1378 return EINVAL; 1379 return 0; 1380 1381 case SERIAL_GETCFG: 1382 CE_DEBUG2 (d, ("ioctl: getcfg\n")); 1383 *(char*)data = 'c'; 1384 return 0; 1385 1386 case SERIAL_SETCFG: 1387 CE_DEBUG2 (d, ("ioctl: setcfg\n")); 1388#if __FreeBSD_version < 500000 1389 error = suser (p); 1390#elif __FreeBSD_version < 700000 1391 error = suser (td); 1392#else 1393 error = priv_check (td, PRIV_DRIVER); 1394#endif 1395 if (error) 1396 return error; 1397 if (*((char*)data) != 'c') 1398 return EINVAL; 1399 return 0; 1400 1401 case SERIAL_GETSTAT: 1402 CE_DEBUG2 (d, ("ioctl: getstat\n")); 1403 st = (struct serial_statistics*) data; 1404 st->rintr = c->rintr; 1405 st->tintr = c->tintr; 1406 st->mintr = 0; 1407 st->ibytes = c->ibytes; 1408 st->ipkts = c->ipkts; 1409 st->obytes = c->obytes; 1410 st->opkts = c->opkts; 1411 st->ierrs = c->overrun + c->frame + c->crc; 1412 st->oerrs = c->underrun; 1413 return 0; 1414 1415 case SERIAL_GETESTAT: 1416 CE_DEBUG2 (d, ("ioctl: getestat\n")); 1417 if (c->type != T_E1) 1418 return EINVAL; 1419 opte1 = (struct e1_statistics*) data; 1420 1421 opte1->status = 0; 1422 if (c->status & ESTS_NOALARM) 1423 opte1->status |= E1_NOALARM; 1424 if (c->status & ESTS_LOS) 1425 opte1->status |= E1_LOS; 1426 if (c->status & ESTS_LOF) 1427 opte1->status |= E1_LOF; 1428 if (c->status & ESTS_AIS) 1429 opte1->status |= E1_AIS; 1430 if (c->status & ESTS_LOMF) 1431 opte1->status |= E1_LOMF; 1432 if (c->status & ESTS_AIS16) 1433 opte1->status |= E1_AIS16; 1434 if (c->status & ESTS_FARLOF) 1435 opte1->status |= E1_FARLOF; 1436 if (c->status & ESTS_FARLOMF) 1437 opte1->status |= E1_FARLOMF; 1438 if (c->status & ESTS_TSTREQ) 1439 opte1->status |= E1_TSTREQ; 1440 if (c->status & ESTS_TSTERR) 1441 opte1->status |= E1_TSTERR; 1442 1443 opte1->cursec = c->cursec; 1444 opte1->totsec = c->totsec + c->cursec; 1445 1446 opte1->currnt.bpv = c->currnt.bpv; 1447 opte1->currnt.fse = c->currnt.fse; 1448 opte1->currnt.crce = c->currnt.crce; 1449 opte1->currnt.rcrce = c->currnt.rcrce; 1450 opte1->currnt.uas = c->currnt.uas; 1451 opte1->currnt.les = c->currnt.les; 1452 opte1->currnt.es = c->currnt.es; 1453 opte1->currnt.bes = c->currnt.bes; 1454 opte1->currnt.ses = c->currnt.ses; 1455 opte1->currnt.oofs = c->currnt.oofs; 1456 opte1->currnt.css = c->currnt.css; 1457 opte1->currnt.dm = c->currnt.dm; 1458 1459 opte1->total.bpv = c->total.bpv + c->currnt.bpv; 1460 opte1->total.fse = c->total.fse + c->currnt.fse; 1461 opte1->total.crce = c->total.crce + c->currnt.crce; 1462 opte1->total.rcrce = c->total.rcrce + c->currnt.rcrce; 1463 opte1->total.uas = c->total.uas + c->currnt.uas; 1464 opte1->total.les = c->total.les + c->currnt.les; 1465 opte1->total.es = c->total.es + c->currnt.es; 1466 opte1->total.bes = c->total.bes + c->currnt.bes; 1467 opte1->total.ses = c->total.ses + c->currnt.ses; 1468 opte1->total.oofs = c->total.oofs + c->currnt.oofs; 1469 opte1->total.css = c->total.css + c->currnt.css; 1470 opte1->total.dm = c->total.dm + c->currnt.dm; 1471 for (s=0; s<48; ++s) { 1472 opte1->interval[s].bpv = c->interval[s].bpv; 1473 opte1->interval[s].fse = c->interval[s].fse; 1474 opte1->interval[s].crce = c->interval[s].crce; 1475 opte1->interval[s].rcrce = c->interval[s].rcrce; 1476 opte1->interval[s].uas = c->interval[s].uas; 1477 opte1->interval[s].les = c->interval[s].les; 1478 opte1->interval[s].es = c->interval[s].es; 1479 opte1->interval[s].bes = c->interval[s].bes; 1480 opte1->interval[s].ses = c->interval[s].ses; 1481 opte1->interval[s].oofs = c->interval[s].oofs; 1482 opte1->interval[s].css = c->interval[s].css; 1483 opte1->interval[s].dm = c->interval[s].dm; 1484 } 1485 return 0; 1486 1487 case SERIAL_CLRSTAT: 1488 CE_DEBUG2 (d, ("ioctl: clrstat\n")); 1489 /* Only for superuser! */ 1490#if __FreeBSD_version < 500000 1491 error = suser (p); 1492#elif __FreeBSD_version < 700000 1493 error = suser (td); 1494#else 1495 error = priv_check (td, PRIV_DRIVER); 1496#endif 1497 if (error) 1498 return error; 1499 c->rintr = 0; 1500 c->tintr = 0; 1501 c->ibytes = 0; 1502 c->obytes = 0; 1503 c->ipkts = 0; 1504 c->opkts = 0; 1505 c->overrun = 0; 1506 c->frame = 0; 1507 c->crc = 0; 1508 c->underrun = 0; 1509 bzero (&c->currnt, sizeof (c->currnt)); 1510 bzero (&c->total, sizeof (c->total)); 1511 bzero (c->interval, sizeof (c->interval)); 1512 return 0; 1513 1514 case SERIAL_GETLOOP: 1515 CE_DEBUG2 (d, ("ioctl: getloop\n")); 1516 if (c->type != T_E1) 1517 return EINVAL; 1518 *(int*)data = c->lloop; 1519 return 0; 1520 1521 case SERIAL_SETLOOP: 1522 CE_DEBUG2 (d, ("ioctl: setloop\n")); 1523 if (c->type != T_E1) 1524 return EINVAL; 1525 /* Only for superuser! */ 1526#if __FreeBSD_version < 500000 1527 error = suser (p); 1528#elif __FreeBSD_version < 700000 1529 error = suser (td); 1530#else 1531 error = priv_check (td, PRIV_DRIVER); 1532#endif 1533 if (error) 1534 return error; 1535 s = splimp (); 1536 CE_LOCK (bd); 1537 ce_set_lloop (c, *(int*)data); 1538 CE_UNLOCK (bd); 1539 splx (s); 1540 return 0; 1541 1542 case SERIAL_GETRLOOP: 1543 CE_DEBUG2 (d, ("ioctl: getrloop\n")); 1544 if (c->type != T_E1) 1545 return EINVAL; 1546 *(int*)data = c->rloop; 1547 return 0; 1548 1549 case SERIAL_SETRLOOP: 1550 CE_DEBUG2 (d, ("ioctl: setloop\n")); 1551 if (c->type != T_E1) 1552 return EINVAL; 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 s = splimp (); 1564 CE_LOCK (bd); 1565 ce_set_rloop (c, *(int*)data); 1566 CE_UNLOCK (bd); 1567 splx (s); 1568 return 0; 1569 1570 case SERIAL_GETDEBUG: 1571 CE_DEBUG2 (d, ("ioctl: getdebug\n")); 1572 *(int*)data = d->chan->debug; 1573 return 0; 1574 1575 case SERIAL_SETDEBUG: 1576 CE_DEBUG2 (d, ("ioctl: setdebug\n")); 1577 /* Only for superuser! */ 1578#if __FreeBSD_version < 500000 1579 error = suser (p); 1580#elif __FreeBSD_version < 700000 1581 error = suser (td); 1582#else 1583 error = priv_check (td, PRIV_DRIVER); 1584#endif 1585 if (error) 1586 return error; 1587#ifndef NETGRAPH 1588 /* 1589 * The debug_shadow is always greater than zero for logic 1590 * simplicity. For switching debug off the IFF_DEBUG is 1591 * responsible. 1592 */ 1593 d->chan->debug_shadow = (*(int*)data) ? (*(int*)data) : 1; 1594 if (d->ifp->if_flags & IFF_DEBUG) 1595 d->chan->debug = d->chan->debug_shadow; 1596#else 1597 d->chan->debug = *(int*)data; 1598#endif 1599 return 0; 1600 1601 case SERIAL_GETBAUD: 1602 CE_DEBUG2 (d, ("ioctl: getbaud\n")); 1603 *(long*)data = c->baud; 1604 return 0; 1605 1606 case SERIAL_SETBAUD: 1607 CE_DEBUG2 (d, ("ioctl: setbaud\n")); 1608 if (c->type != T_E1 || !c->unfram) 1609 return EINVAL; 1610 /* Only for superuser! */ 1611#if __FreeBSD_version < 500000 1612 error = suser (p); 1613#elif __FreeBSD_version < 700000 1614 error = suser (td); 1615#else 1616 error = priv_check (td, PRIV_DRIVER); 1617#endif 1618 if (error) 1619 return error; 1620 s = splimp (); 1621 CE_LOCK (bd); 1622 ce_set_baud (c, *(long*)data); 1623 CE_UNLOCK (bd); 1624 splx (s); 1625 return 0; 1626 1627 case SERIAL_GETTIMESLOTS: 1628 CE_DEBUG2 (d, ("ioctl: gettimeslots\n")); 1629 if ((c->type != T_E1 || c->unfram) && c->type != T_DATA) 1630 return EINVAL; 1631 *(u_long*)data = c->ts; 1632 return 0; 1633 1634 case SERIAL_SETTIMESLOTS: 1635 CE_DEBUG2 (d, ("ioctl: settimeslots\n")); 1636 /* Only for superuser! */ 1637#if __FreeBSD_version < 500000 1638 error = suser (p); 1639#elif __FreeBSD_version < 700000 1640 error = suser (td); 1641#else 1642 error = priv_check (td, PRIV_DRIVER); 1643#endif 1644 if (error) 1645 return error; 1646 if ((c->type != T_E1 || c->unfram) && c->type != T_DATA) 1647 return EINVAL; 1648 s = splimp (); 1649 CE_LOCK (bd); 1650 ce_set_ts (c, *(u_long*)data); 1651 CE_UNLOCK (bd); 1652 splx (s); 1653 return 0; 1654 1655 case SERIAL_GETHIGAIN: 1656 CE_DEBUG2 (d, ("ioctl: gethigain\n")); 1657 if (c->type != T_E1) 1658 return EINVAL; 1659 *(int*)data = c->higain; 1660 return 0; 1661 1662 case SERIAL_SETHIGAIN: 1663 CE_DEBUG2 (d, ("ioctl: sethigain\n")); 1664 if (c->type != T_E1) 1665 return EINVAL; 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_higain (c, *(int*)data); 1679 CE_UNLOCK (bd); 1680 splx (s); 1681 return 0; 1682 1683 case SERIAL_GETPHONY: 1684 CE_DEBUG2 (d, ("ioctl: getphony\n")); 1685 *(int*)data = c->phony; 1686 return 0; 1687 1688 case SERIAL_SETPHONY: 1689 CE_DEBUG2 (d, ("ioctl: setphony\n")); 1690 /* Only for superuser! */ 1691#if __FreeBSD_version < 500000 1692 error = suser (p); 1693#elif __FreeBSD_version < 700000 1694 error = suser (td); 1695#else 1696 error = priv_check (td, PRIV_DRIVER); 1697#endif 1698 if (error) 1699 return error; 1700 s = splimp (); 1701 CE_LOCK (bd); 1702 ce_set_phony (c, *(int*)data); 1703 CE_UNLOCK (bd); 1704 splx (s); 1705 return 0; 1706 1707 case SERIAL_GETUNFRAM: 1708 CE_DEBUG2 (d, ("ioctl: getunfram\n")); 1709 if (c->type != T_E1 || c->num != 0) 1710 return EINVAL; 1711 *(int*)data = c->unfram; 1712 return 0; 1713 1714 case SERIAL_SETUNFRAM: 1715 CE_DEBUG2 (d, ("ioctl: setunfram\n")); 1716 if (c->type != T_E1 || c->num != 0) 1717 return EINVAL; 1718 /* Only for superuser! */ 1719#if __FreeBSD_version < 500000 1720 error = suser (p); 1721#elif __FreeBSD_version < 700000 1722 error = suser (td); 1723#else 1724 error = priv_check (td, PRIV_DRIVER); 1725#endif 1726 if (error) 1727 return error; 1728 s = splimp (); 1729 CE_LOCK (bd); 1730 ce_set_unfram (c, *(int*)data); 1731 CE_UNLOCK (bd); 1732 splx (s); 1733 return 0; 1734 1735 case SERIAL_GETSCRAMBLER: 1736 CE_DEBUG2 (d, ("ioctl: getscrambler\n")); 1737 if (!c->unfram) 1738 return EINVAL; 1739 *(int*)data = c->scrambler; 1740 return 0; 1741 1742 case SERIAL_SETSCRAMBLER: 1743 CE_DEBUG2 (d, ("ioctl: setscrambler\n")); 1744 /* Only for superuser! */ 1745#if __FreeBSD_version < 500000 1746 error = suser (p); 1747#elif __FreeBSD_version < 700000 1748 error = suser (td); 1749#else 1750 error = priv_check (td, PRIV_DRIVER); 1751#endif 1752 if (error) 1753 return error; 1754 if (!c->unfram) 1755 return EINVAL; 1756 s = splimp (); 1757 CE_LOCK (bd); 1758 ce_set_scrambler (c, *(int*)data); 1759 CE_UNLOCK (bd); 1760 splx (s); 1761 return 0; 1762 1763 case SERIAL_GETMONITOR: 1764 CE_DEBUG2 (d, ("ioctl: getmonitor\n")); 1765 if (c->type != T_E1) 1766 return EINVAL; 1767 *(int*)data = c->monitor; 1768 return 0; 1769 1770 case SERIAL_SETMONITOR: 1771 CE_DEBUG2 (d, ("ioctl: setmonitor\n")); 1772 /* Only for superuser! */ 1773#if __FreeBSD_version < 500000 1774 error = suser (p); 1775#elif __FreeBSD_version < 700000 1776 error = suser (td); 1777#else 1778 error = priv_check (td, PRIV_DRIVER); 1779#endif 1780 if (error) 1781 return error; 1782 if (c->type != T_E1) 1783 return EINVAL; 1784 s = splimp (); 1785 CE_LOCK (bd); 1786 ce_set_monitor (c, *(int*)data); 1787 CE_UNLOCK (bd); 1788 splx (s); 1789 return 0; 1790 1791 case SERIAL_GETUSE16: 1792 CE_DEBUG2 (d, ("ioctl: getuse16\n")); 1793 if (c->type != T_E1 || c->unfram) 1794 return EINVAL; 1795 *(int*)data = c->use16; 1796 return 0; 1797 1798 case SERIAL_SETUSE16: 1799 CE_DEBUG2 (d, ("ioctl: setuse16\n")); 1800 /* Only for superuser! */ 1801#if __FreeBSD_version < 500000 1802 error = suser (p); 1803#elif __FreeBSD_version < 700000 1804 error = suser (td); 1805#else 1806 error = priv_check (td, PRIV_DRIVER); 1807#endif 1808 if (error) 1809 return error; 1810 if (c->type != T_E1) 1811 return EINVAL; 1812 s = splimp (); 1813 CE_LOCK (bd); 1814 ce_set_use16 (c, *(int*)data); 1815 CE_UNLOCK (bd); 1816 splx (s); 1817 return 0; 1818 1819 case SERIAL_GETCRC4: 1820 CE_DEBUG2 (d, ("ioctl: getcrc4\n")); 1821 if (c->type != T_E1 || c->unfram) 1822 return EINVAL; 1823 *(int*)data = c->crc4; 1824 return 0; 1825 1826 case SERIAL_SETCRC4: 1827 CE_DEBUG2 (d, ("ioctl: setcrc4\n")); 1828 /* Only for superuser! */ 1829#if __FreeBSD_version < 500000 1830 error = suser (p); 1831#elif __FreeBSD_version < 700000 1832 error = suser (td); 1833#else 1834 error = priv_check (td, PRIV_DRIVER); 1835#endif 1836 if (error) 1837 return error; 1838 if (c->type != T_E1 || c->unfram) 1839 return EINVAL; 1840 s = splimp (); 1841 CE_LOCK (bd); 1842 ce_set_crc4 (c, *(int*)data); 1843 CE_UNLOCK (bd); 1844 splx (s); 1845 return 0; 1846 1847 case SERIAL_GETCLK: 1848 CE_DEBUG2 (d, ("ioctl: getclk\n")); 1849 if (c->type != T_E1) 1850 return EINVAL; 1851 switch (c->gsyn) { 1852 default: *(int*)data = E1CLK_INTERNAL; break; 1853 case GSYN_RCV: *(int*)data = E1CLK_RECEIVE; break; 1854 case GSYN_RCV0: *(int*)data = E1CLK_RECEIVE_CHAN0; break; 1855 case GSYN_RCV1: *(int*)data = E1CLK_RECEIVE_CHAN1; break; 1856 } 1857 return 0; 1858 1859 case SERIAL_SETCLK: 1860 CE_DEBUG2 (d, ("ioctl: setclk\n")); 1861 /* Only for superuser! */ 1862#if __FreeBSD_version < 500000 1863 error = suser (p); 1864#elif __FreeBSD_version < 700000 1865 error = suser (td); 1866#else 1867 error = priv_check (td, PRIV_DRIVER); 1868#endif 1869 if (error) 1870 return error; 1871 if (c->type != T_E1) 1872 return EINVAL; 1873 s = splimp (); 1874 CE_LOCK (bd); 1875 switch (*(int*)data) { 1876 default: ce_set_gsyn (c, GSYN_INT); break; 1877 case E1CLK_RECEIVE: ce_set_gsyn (c, GSYN_RCV); break; 1878 case E1CLK_RECEIVE_CHAN0: ce_set_gsyn (c, GSYN_RCV0); break; 1879 case E1CLK_RECEIVE_CHAN1: ce_set_gsyn (c, GSYN_RCV1); break; 1880 } 1881 CE_UNLOCK (bd); 1882 splx (s); 1883 return 0; 1884 1885#if 0 1886 case SERIAL_RESET: 1887 CE_DEBUG2 (d, ("ioctl: reset\n")); 1888 /* Only for superuser! */ 1889#if __FreeBSD_version < 500000 1890 error = suser (p); 1891#elif __FreeBSD_version < 700000 1892 error = suser (td); 1893#else 1894 error = priv_check (td, PRIV_DRIVER); 1895#endif 1896 if (error) 1897 return error; 1898 s = splimp (); 1899 CE_LOCK (bd); 1900/* ce_reset (c->board, 0, 0);*/ 1901 CE_UNLOCK (bd); 1902 splx (s); 1903 return 0; 1904 1905 case SERIAL_HARDRESET: 1906 CE_DEBUG2 (d, ("ioctl: hardreset\n")); 1907 /* Only for superuser! */ 1908#if __FreeBSD_version < 500000 1909 error = suser (p); 1910#elif __FreeBSD_version < 700000 1911 error = suser (td); 1912#else 1913 error = priv_check (td, PRIV_DRIVER); 1914#endif 1915 if (error) 1916 return error; 1917 s = splimp (); 1918 CE_LOCK (bd); 1919 /* hard_reset (c->board); */ 1920 CE_UNLOCK (bd); 1921 splx (s); 1922 return 0; 1923#endif 1924 1925 case SERIAL_GETCABLE: 1926 CE_DEBUG2 (d, ("ioctl: getcable\n")); 1927 if (c->type != T_E1) 1928 return EINVAL; 1929 s = splimp (); 1930 CE_LOCK (bd); 1931 *(int*)data = CABLE_TP; 1932 CE_UNLOCK (bd); 1933 splx (s); 1934 return 0; 1935 1936 case SERIAL_GETDIR: 1937 CE_DEBUG2 (d, ("ioctl: getdir\n")); 1938 if (c->type != T_E1 && c->type != T_DATA) 1939 return EINVAL; 1940 *(int*)data = c->dir; 1941 return 0; 1942 1943 case SERIAL_SETDIR: 1944 CE_DEBUG2 (d, ("ioctl: setdir\n")); 1945 /* Only for superuser! */ 1946#if __FreeBSD_version < 500000 1947 error = suser (p); 1948#elif __FreeBSD_version < 700000 1949 error = suser (td); 1950#else 1951 error = priv_check (td, PRIV_DRIVER); 1952#endif 1953 if (error) 1954 return error; 1955 s = splimp (); 1956 CE_LOCK (bd); 1957 ce_set_dir (c, *(int*)data); 1958 CE_UNLOCK (bd); 1959 splx (s); 1960 return 0; 1961 1962 case TIOCSDTR: /* Set DTR */ 1963 s = splimp (); 1964 CE_LOCK (bd); 1965 ce_set_dtr (c, 1); 1966 CE_UNLOCK (bd); 1967 splx (s); 1968 return 0; 1969 1970 case TIOCCDTR: /* Clear DTR */ 1971 s = splimp (); 1972 CE_LOCK (bd); 1973 ce_set_dtr (c, 0); 1974 CE_UNLOCK (bd); 1975 splx (s); 1976 return 0; 1977 1978 case TIOCMSET: /* Set DTR/RTS */ 1979 s = splimp (); 1980 CE_LOCK (bd); 1981 ce_set_dtr (c, (*(int*)data & TIOCM_DTR) ? 1 : 0); 1982 ce_set_rts (c, (*(int*)data & TIOCM_RTS) ? 1 : 0); 1983 CE_UNLOCK (bd); 1984 splx (s); 1985 return 0; 1986 1987 case TIOCMBIS: /* Add DTR/RTS */ 1988 s = splimp (); 1989 CE_LOCK (bd); 1990 if (*(int*)data & TIOCM_DTR) ce_set_dtr (c, 1); 1991 if (*(int*)data & TIOCM_RTS) ce_set_rts (c, 1); 1992 CE_UNLOCK (bd); 1993 splx (s); 1994 return 0; 1995 1996 case TIOCMBIC: /* Clear DTR/RTS */ 1997 s = splimp (); 1998 CE_LOCK (bd); 1999 if (*(int*)data & TIOCM_DTR) ce_set_dtr (c, 0); 2000 if (*(int*)data & TIOCM_RTS) ce_set_rts (c, 0); 2001 CE_UNLOCK (bd); 2002 splx (s); 2003 return 0; 2004 2005 case TIOCMGET: /* Get modem status */ 2006 *(int*)data = ce_modem_status (c); 2007 return 0; 2008 } 2009 return ENOTTY; 2010} 2011 2012#ifdef NETGRAPH 2013#if __FreeBSD_version >= 500000 2014static int ng_ce_constructor (node_p node) 2015{ 2016 drv_t *d = NG_NODE_PRIVATE (node); 2017#else 2018static int ng_ce_constructor (node_p *node) 2019{ 2020 drv_t *d = (*node)->private; 2021#endif 2022 CE_DEBUG (d, ("Constructor\n")); 2023 return EINVAL; 2024} 2025 2026static int ng_ce_newhook (node_p node, hook_p hook, const char *name) 2027{ 2028 int s; 2029#if __FreeBSD_version >= 500000 2030 drv_t *d = NG_NODE_PRIVATE (node); 2031#else 2032 drv_t *d = node->private; 2033#endif 2034 bdrv_t *bd = d->board->sys; 2035 2036 CE_DEBUG (d, ("Newhook\n")); 2037 /* Attach debug hook */ 2038 if (strcmp (name, NG_CE_HOOK_DEBUG) == 0) { 2039#if __FreeBSD_version >= 500000 2040 NG_HOOK_SET_PRIVATE (hook, NULL); 2041#else 2042 hook->private = 0; 2043#endif 2044 d->debug_hook = hook; 2045 return 0; 2046 } 2047 2048 /* Check for raw hook */ 2049 if (strcmp (name, NG_CE_HOOK_RAW) != 0) 2050 return EINVAL; 2051 2052#if __FreeBSD_version >= 500000 2053 NG_HOOK_SET_PRIVATE (hook, d); 2054#else 2055 hook->private = d; 2056#endif 2057 d->hook = hook; 2058 s = splimp (); 2059 CE_LOCK (bd); 2060 ce_up (d); 2061 CE_UNLOCK (bd); 2062 splx (s); 2063 return 0; 2064} 2065 2066static char *format_timeslots (u_long s) 2067{ 2068 static char buf [100]; 2069 char *p = buf; 2070 int i; 2071 2072 for (i=1; i<32; ++i) 2073 if ((s >> i) & 1) { 2074 int prev = (i > 1) & (s >> (i-1)); 2075 int next = (i < 31) & (s >> (i+1)); 2076 2077 if (prev) { 2078 if (next) 2079 continue; 2080 *p++ = '-'; 2081 } else if (p > buf) 2082 *p++ = ','; 2083 2084 if (i >= 10) 2085 *p++ = '0' + i / 10; 2086 *p++ = '0' + i % 10; 2087 } 2088 *p = 0; 2089 return buf; 2090} 2091 2092static int print_modems (char *s, ce_chan_t *c, int need_header) 2093{ 2094 int status = ce_modem_status (c); 2095 int length = 0; 2096 2097 if (need_header) 2098 length += sprintf (s + length, " LE DTR DSR RTS CTS CD\n"); 2099 length += sprintf (s + length, "%4s %4s %4s %4s %4s %4s\n", 2100 status & TIOCM_LE ? "On" : "-", 2101 status & TIOCM_DTR ? "On" : "-", 2102 status & TIOCM_DSR ? "On" : "-", 2103 status & TIOCM_RTS ? "On" : "-", 2104 status & TIOCM_CTS ? "On" : "-", 2105 status & TIOCM_CD ? "On" : "-"); 2106 return length; 2107} 2108 2109static int print_stats (char *s, ce_chan_t *c, int need_header) 2110{ 2111 int length = 0; 2112 2113 if (need_header) 2114 length += sprintf (s + length, " Rintr Tintr Mintr Ibytes Ipkts Ierrs Obytes Opkts Oerrs\n"); 2115 length += sprintf (s + length, "%7ld %7ld %7ld %8lu %7ld %7ld %8lu %7ld %7ld\n", 2116 c->rintr, c->tintr, 0l, (unsigned long) c->ibytes, 2117 c->ipkts, c->overrun + c->frame + c->crc, 2118 (unsigned long) c->obytes, c->opkts, c->underrun); 2119 return length; 2120} 2121 2122static char *format_e1_status (u_char status) 2123{ 2124 static char buf [80]; 2125 2126 if (status & E1_NOALARM) 2127 return "Ok"; 2128 buf[0] = 0; 2129 if (status & E1_LOS) strcat (buf, ",LOS"); 2130 if (status & E1_AIS) strcat (buf, ",AIS"); 2131 if (status & E1_LOF) strcat (buf, ",LOF"); 2132 if (status & E1_LOMF) strcat (buf, ",LOMF"); 2133 if (status & E1_FARLOF) strcat (buf, ",FARLOF"); 2134 if (status & E1_AIS16) strcat (buf, ",AIS16"); 2135 if (status & E1_FARLOMF) strcat (buf, ",FARLOMF"); 2136 if (status & E1_TSTREQ) strcat (buf, ",TSTREQ"); 2137 if (status & E1_TSTERR) strcat (buf, ",TSTERR"); 2138 if (buf[0] == ',') 2139 return buf+1; 2140 return "Unknown"; 2141} 2142 2143static int print_frac (char *s, int leftalign, u_long numerator, u_long divider) 2144{ 2145 int n, length = 0; 2146 2147 if (numerator < 1 || divider < 1) { 2148 length += sprintf (s+length, leftalign ? "/- " : " -"); 2149 return length; 2150 } 2151 n = (int) (0.5 + 1000.0 * numerator / divider); 2152 if (n < 1000) { 2153 length += sprintf (s+length, leftalign ? "/.%-3d" : " .%03d", n); 2154 return length; 2155 } 2156 *(s + length) = leftalign ? '/' : ' '; 2157 length ++; 2158 2159 if (n >= 1000000) n = (n+500) / 1000 * 1000; 2160 else if (n >= 100000) n = (n+50) / 100 * 100; 2161 else if (n >= 10000) n = (n+5) / 10 * 10; 2162 2163 switch (n) { 2164 case 1000: length += printf (s+length, ".999"); return length; 2165 case 10000: n = 9990; break; 2166 case 100000: n = 99900; break; 2167 case 1000000: n = 999000; break; 2168 } 2169 if (n < 10000) length += sprintf (s+length, "%d.%d", n/1000, n/10%100); 2170 else if (n < 100000) length += sprintf (s+length, "%d.%d", n/1000, n/100%10); 2171 else if (n < 1000000) length += sprintf (s+length, "%d.", n/1000); 2172 else length += sprintf (s+length, "%d", n/1000); 2173 2174 return length; 2175} 2176 2177static int print_e1_stats (char *s, ce_chan_t *c) 2178{ 2179 struct e1_counters total; 2180 u_long totsec; 2181 int length = 0; 2182 2183 totsec = c->totsec + c->cursec; 2184 total.bpv = c->total.bpv + c->currnt.bpv; 2185 total.fse = c->total.fse + c->currnt.fse; 2186 total.crce = c->total.crce + c->currnt.crce; 2187 total.rcrce = c->total.rcrce + c->currnt.rcrce; 2188 total.uas = c->total.uas + c->currnt.uas; 2189 total.les = c->total.les + c->currnt.les; 2190 total.es = c->total.es + c->currnt.es; 2191 total.bes = c->total.bes + c->currnt.bes; 2192 total.ses = c->total.ses + c->currnt.ses; 2193 total.oofs = c->total.oofs + c->currnt.oofs; 2194 total.css = c->total.css + c->currnt.css; 2195 total.dm = c->total.dm + c->currnt.dm; 2196 2197 length += sprintf (s + length, " Unav/Degr Bpv/Fsyn CRC/RCRC Err/Lerr Sev/Bur Oof/Slp Status\n"); 2198 2199 /* Unavailable seconds, degraded minutes */ 2200 length += print_frac (s + length, 0, c->currnt.uas, c->cursec); 2201 length += print_frac (s + length, 1, 60 * c->currnt.dm, c->cursec); 2202 2203 /* Bipolar violations, frame sync errors */ 2204 length += print_frac (s + length, 0, c->currnt.bpv, c->cursec); 2205 length += print_frac (s + length, 1, c->currnt.fse, c->cursec); 2206 2207 /* CRC errors, remote CRC errors (E-bit) */ 2208 length += print_frac (s + length, 0, c->currnt.crce, c->cursec); 2209 length += print_frac (s + length, 1, c->currnt.rcrce, c->cursec); 2210 2211 /* Errored seconds, line errored seconds */ 2212 length += print_frac (s + length, 0, c->currnt.es, c->cursec); 2213 length += print_frac (s + length, 1, c->currnt.les, c->cursec); 2214 2215 /* Severely errored seconds, burst errored seconds */ 2216 length += print_frac (s + length, 0, c->currnt.ses, c->cursec); 2217 length += print_frac (s + length, 1, c->currnt.bes, c->cursec); 2218 2219 /* Out of frame seconds, controlled slip seconds */ 2220 length += print_frac (s + length, 0, c->currnt.oofs, c->cursec); 2221 length += print_frac (s + length, 1, c->currnt.css, c->cursec); 2222 2223 length += sprintf (s + length, " %s\n", format_e1_status (c->status)); 2224 2225 /* Print total statistics. */ 2226 length += print_frac (s + length, 0, total.uas, totsec); 2227 length += print_frac (s + length, 1, 60 * total.dm, totsec); 2228 2229 length += print_frac (s + length, 0, total.bpv, totsec); 2230 length += print_frac (s + length, 1, total.fse, totsec); 2231 2232 length += print_frac (s + length, 0, total.crce, totsec); 2233 length += print_frac (s + length, 1, total.rcrce, totsec); 2234 2235 length += print_frac (s + length, 0, total.es, totsec); 2236 length += print_frac (s + length, 1, total.les, totsec); 2237 2238 length += print_frac (s + length, 0, total.ses, totsec); 2239 length += print_frac (s + length, 1, total.bes, totsec); 2240 2241 length += print_frac (s + length, 0, total.oofs, totsec); 2242 length += print_frac (s + length, 1, total.css, totsec); 2243 2244 length += sprintf (s + length, " -- Total\n"); 2245 return length; 2246} 2247 2248static int print_chan (char *s, ce_chan_t *c) 2249{ 2250 drv_t *d = c->sys; 2251 int length = 0; 2252 2253 length += sprintf (s + length, "ce%d", c->board->num * NCHAN + c->num); 2254 if (d->chan->debug) 2255 length += sprintf (s + length, " debug=%d", d->chan->debug); 2256 2257 if (c->board->mux) { 2258 length += sprintf (s + length, " cfg=C"); 2259 } else { 2260 length += sprintf (s + length, " cfg=A"); 2261 } 2262 2263 if (c->baud) 2264 length += sprintf (s + length, " %ld", c->baud); 2265 else 2266 length += sprintf (s + length, " extclock"); 2267 2268 if (c->type == T_E1) 2269 switch (c->gsyn) { 2270 case GSYN_INT : length += sprintf (s + length, " syn=int"); break; 2271 case GSYN_RCV : length += sprintf (s + length, " syn=rcv"); break; 2272 case GSYN_RCV0 : length += sprintf (s + length, " syn=rcv0"); break; 2273 case GSYN_RCV1 : length += sprintf (s + length, " syn=rcv1"); break; 2274 } 2275 if (c->type == T_E1) 2276 length += sprintf (s + length, " higain=%s", c->higain ? "on" : "off"); 2277 2278 length += sprintf (s + length, " loop=%s", c->lloop ? "on" : "off"); 2279 2280 if (c->type == T_E1) 2281 length += sprintf (s + length, " ts=%s", format_timeslots (c->ts)); 2282 length += sprintf (s + length, "\n"); 2283 return length; 2284} 2285 2286#if __FreeBSD_version >= 500000 2287static int ng_ce_rcvmsg (node_p node, item_p item, hook_p lasthook) 2288{ 2289 drv_t *d = NG_NODE_PRIVATE (node); 2290 struct ng_mesg *msg; 2291#else 2292static int ng_ce_rcvmsg (node_p node, struct ng_mesg *msg, 2293 const char *retaddr, struct ng_mesg **rptr) 2294{ 2295 drv_t *d = node->private; 2296#endif 2297 struct ng_mesg *resp = NULL; 2298 int error = 0; 2299 2300 CE_DEBUG (d, ("Rcvmsg\n")); 2301#if __FreeBSD_version >= 500000 2302 NGI_GET_MSG (item, msg); 2303#endif 2304 switch (msg->header.typecookie) { 2305 default: 2306 error = EINVAL; 2307 break; 2308 2309 case NGM_CE_COOKIE: 2310 printf ("Not implemented yet\n"); 2311 error = EINVAL; 2312 break; 2313 2314 case NGM_GENERIC_COOKIE: 2315 switch (msg->header.cmd) { 2316 default: 2317 error = EINVAL; 2318 break; 2319 2320 case NGM_TEXT_STATUS: { 2321 char *s; 2322 int l = 0; 2323 int dl = sizeof (struct ng_mesg) + 730; 2324 2325#if __FreeBSD_version >= 500000 2326 NG_MKRESPONSE (resp, msg, dl, M_NOWAIT); 2327 if (! resp) { 2328 error = ENOMEM; 2329 break; 2330 } 2331#else 2332 resp = malloc (M_NETGRAPH, M_NOWAIT); 2333 if (! resp) { 2334 error = ENOMEM; 2335 break; 2336 } 2337 bzero (resp, dl); 2338#endif 2339 s = (resp)->data; 2340 if (d) { 2341 l += print_chan (s + l, d->chan); 2342 l += print_stats (s + l, d->chan, 1); 2343 l += print_modems (s + l, d->chan, 1); 2344 l += print_e1_stats (s + l, d->chan); 2345 } else 2346 l += sprintf (s + l, "Error: node not connect to channel"); 2347#if __FreeBSD_version < 500000 2348 (resp)->header.version = NG_VERSION; 2349 (resp)->header.arglen = strlen (s) + 1; 2350 (resp)->header.token = msg->header.token; 2351 (resp)->header.typecookie = NGM_CE_COOKIE; 2352 (resp)->header.cmd = msg->header.cmd; 2353#endif 2354 strncpy ((resp)->header.cmdstr, "status", NG_CMDSTRSIZ); 2355 } 2356 break; 2357 } 2358 break; 2359 } 2360#if __FreeBSD_version >= 500000 2361 NG_RESPOND_MSG (error, node, item, resp); 2362 NG_FREE_MSG (msg); 2363#else 2364 *rptr = resp; 2365 free (msg, M_NETGRAPH); 2366#endif 2367 return error; 2368} 2369 2370#if __FreeBSD_version >= 500000 2371static int ng_ce_rcvdata (hook_p hook, item_p item) 2372{ 2373 drv_t *d = NG_NODE_PRIVATE (NG_HOOK_NODE(hook)); 2374 struct mbuf *m; 2375#if __FreeBSD_version < 502120 2376 meta_p meta; 2377#else 2378 struct ng_tag_prio *ptag; 2379#endif 2380#else 2381static int ng_ce_rcvdata (hook_p hook, struct mbuf *m, meta_p meta) 2382{ 2383 drv_t *d = hook->node->private; 2384#endif 2385 bdrv_t *bd = d->board->sys; 2386 struct ifqueue *q; 2387 int s; 2388 2389 CE_DEBUG2 (d, ("Rcvdata\n")); 2390#if __FreeBSD_version >= 500000 2391 NGI_GET_M (item, m); 2392#if __FreeBSD_version < 502120 2393 NGI_GET_META (item, meta); 2394#endif 2395 NG_FREE_ITEM (item); 2396 if (! NG_HOOK_PRIVATE (hook) || ! d) { 2397 NG_FREE_M (m); 2398#if __FreeBSD_version < 502120 2399 NG_FREE_META (meta); 2400#endif 2401#else 2402 if (! hook->private || ! d) { 2403 NG_FREE_DATA (m,meta); 2404#endif 2405 return ENETDOWN; 2406 } 2407 2408#if __FreeBSD_version >= 502120 2409 /* Check for high priority data */ 2410 if ((ptag = (struct ng_tag_prio *)m_tag_locate(m, NGM_GENERIC_COOKIE, 2411 NG_TAG_PRIO, NULL)) != NULL && (ptag->priority > NG_PRIO_CUTOFF) ) 2412 q = &d->hi_queue; 2413 else 2414 q = &d->queue; 2415#else 2416 q = (meta && meta->priority > 0) ? &d->hi_queue : &d->queue; 2417#endif 2418 2419 s = splimp (); 2420 CE_LOCK (bd); 2421#if __FreeBSD_version >= 500000 2422 IF_LOCK (q); 2423 if (_IF_QFULL (q)) { 2424 _IF_DROP (q); 2425 IF_UNLOCK (q); 2426 CE_UNLOCK (bd); 2427 splx (s); 2428 NG_FREE_M (m); 2429#if __FreeBSD_version < 502120 2430 NG_FREE_META (meta); 2431#endif 2432 return ENOBUFS; 2433 } 2434 _IF_ENQUEUE (q, m); 2435 IF_UNLOCK (q); 2436#else 2437 if (IF_QFULL (q)) { 2438 IF_DROP (q); 2439 CE_UNLOCK (bd); 2440 splx (s); 2441 NG_FREE_DATA (m, meta); 2442 return ENOBUFS; 2443 } 2444 IF_ENQUEUE (q, m); 2445#endif 2446 ce_start (d); 2447 CE_UNLOCK (bd); 2448 splx (s); 2449 return 0; 2450} 2451 2452static int ng_ce_rmnode (node_p node) 2453{ 2454#if __FreeBSD_version >= 500000 2455 drv_t *d = NG_NODE_PRIVATE (node); 2456 2457 CE_DEBUG (d, ("Rmnode\n")); 2458 if (d && d->running) { 2459 bdrv_t *bd = d->board->sys; 2460 int s = splimp (); 2461 CE_LOCK (bd); 2462 ce_down (d); 2463 CE_UNLOCK (bd); 2464 splx (s); 2465 } 2466#ifdef KLD_MODULE 2467#if __FreeBSD_version >= 502120 2468 if (node->nd_flags & NGF_REALLY_DIE) { 2469#else 2470 if (node->nd_flags & NG_REALLY_DIE) { 2471#endif 2472 NG_NODE_SET_PRIVATE (node, NULL); 2473 NG_NODE_UNREF (node); 2474 } 2475#if __FreeBSD_version >= 502120 2476 NG_NODE_REVIVE(node); /* Persistant node */ 2477#else 2478 node->nd_flags &= ~NG_INVALID; 2479#endif 2480#endif 2481#else /* __FreeBSD_version < 500000 */ 2482 drv_t *d = node->private; 2483 2484 if (d && d->running) { 2485 bdrv_t *bd = d->board->sys; 2486 int s = splimp (); 2487 CE_LOCK (bd); 2488 ce_down (d); 2489 CE_UNLOCK (bd); 2490 splx (s); 2491 } 2492 2493 node->flags |= NG_INVALID; 2494 ng_cutlinks (node); 2495#ifdef KLD_MODULE 2496 ng_unname (node); 2497 ng_unref (node); 2498#endif 2499#endif 2500 return 0; 2501} 2502 2503static int ng_ce_connect (hook_p hook) 2504{ 2505#if __FreeBSD_version >= 500000 2506 drv_t *d = NG_NODE_PRIVATE (NG_HOOK_NODE (hook)); 2507#else 2508 drv_t *d = hook->node->private; 2509#endif 2510 2511 if (d) { 2512 CE_DEBUG (d, ("Connect\n")); 2513 callout_reset (&d->timeout_handle, hz, ce_watchdog_timer, d); 2514 } 2515 2516 return 0; 2517} 2518 2519static int ng_ce_disconnect (hook_p hook) 2520{ 2521#if __FreeBSD_version >= 500000 2522 drv_t *d = NG_NODE_PRIVATE (NG_HOOK_NODE (hook)); 2523#else 2524 drv_t *d = hook->node->private; 2525#endif 2526 2527 if (d) { 2528 CE_DEBUG (d, ("Disconnect\n")); 2529#if __FreeBSD_version >= 500000 2530 if (NG_HOOK_PRIVATE (hook)) 2531#else 2532 if (hook->private) 2533#endif 2534 { 2535 bdrv_t *bd = d->board->sys; 2536 int s = splimp (); 2537 CE_LOCK (bd); 2538 ce_down (d); 2539 CE_UNLOCK (bd); 2540 splx (s); 2541 } 2542 /* If we were wait it than it reasserted now, just stop it. */ 2543 if (!callout_drain (&d->timeout_handle)) 2544 callout_stop (&d->timeout_handle); 2545 } 2546 return 0; 2547} 2548#endif 2549 2550static int ce_modevent (module_t mod, int type, void *unused) 2551{ 2552#if __FreeBSD_version < 500000 2553 dev_t dev; 2554 struct cdevsw *cdsw; 2555#endif 2556 static int load_count = 0; 2557 2558#if __FreeBSD_version < 500000 2559 dev = makedev (CDEV_MAJOR, 0); 2560#endif 2561 2562 switch (type) { 2563 case MOD_LOAD: 2564#if __FreeBSD_version < 500000 2565 if (dev != NODEV && 2566 (cdsw = devsw (dev)) && 2567 cdsw->d_maj == CDEV_MAJOR) { 2568 printf ("Tau32-PCI driver is already in system\n"); 2569 return (ENXIO); 2570 } 2571#endif 2572#if __FreeBSD_version >= 500000 && defined NETGRAPH 2573 if (ng_newtype (&typestruct)) 2574 printf ("Failed to register ng_ce\n"); 2575#endif 2576 ++load_count; 2577#if __FreeBSD_version <= 500000 2578 cdevsw_add (&ce_cdevsw); 2579#endif 2580#if __FreeBSD_version >= 500000 2581 callout_init (&timeout_handle, CALLOUT_MPSAFE); 2582#else 2583 callout_init (&timeout_handle); 2584#endif 2585 callout_reset (&timeout_handle, hz*5, ce_timeout, 0); 2586 break; 2587 case MOD_UNLOAD: 2588 if (load_count == 1) { 2589 printf ("Removing device entry for Tau32-PCI\n"); 2590#if __FreeBSD_version <= 500000 2591 cdevsw_remove (&ce_cdevsw); 2592#endif 2593#if __FreeBSD_version >= 500000 && defined NETGRAPH 2594 ng_rmtype (&typestruct); 2595#endif 2596 } 2597 /* If we were wait it than it reasserted now, just stop it. 2598 * Actually we shouldn't get this condition. But code could be 2599 * changed in the future, so just be a litle paranoid. 2600 */ 2601 if (!callout_drain (&timeout_handle)) 2602 callout_stop (&timeout_handle); 2603 --load_count; 2604 break; 2605 case MOD_SHUTDOWN: 2606 break; 2607 } 2608 return 0; 2609} 2610 2611#ifdef NETGRAPH 2612#if __FreeBSD_version >= 502100 2613static struct ng_type typestruct = { 2614 .version = NG_ABI_VERSION, 2615 .name = NG_CE_NODE_TYPE, 2616 .constructor = ng_ce_constructor, 2617 .rcvmsg = ng_ce_rcvmsg, 2618 .shutdown = ng_ce_rmnode, 2619 .newhook = ng_ce_newhook, 2620 .connect = ng_ce_connect, 2621 .rcvdata = ng_ce_rcvdata, 2622 .disconnect = ng_ce_disconnect, 2623}; 2624#else /* __FreeBSD_version < 502100 */ 2625static struct ng_type typestruct = { 2626#if __FreeBSD_version >= 500000 2627 NG_ABI_VERSION, 2628#else 2629 NG_VERSION, 2630#endif 2631 NG_CE_NODE_TYPE, 2632 ce_modevent, 2633 ng_ce_constructor, 2634 ng_ce_rcvmsg, 2635 ng_ce_rmnode, 2636 ng_ce_newhook, 2637 NULL, 2638 ng_ce_connect, 2639 ng_ce_rcvdata, 2640#if __FreeBSD_version < 500000 2641 NULL, 2642#endif 2643 ng_ce_disconnect, 2644 NULL 2645}; 2646#endif /* __FreeBSD_version < 502100 */ 2647 2648#endif /*NETGRAPH*/ 2649 2650#if __FreeBSD_version >= 500000 2651#ifdef NETGRAPH 2652MODULE_DEPEND (ng_ce, netgraph, NG_ABI_VERSION, NG_ABI_VERSION, NG_ABI_VERSION); 2653#else 2654MODULE_DEPEND (ce, sppp, 1, 1, 1); 2655#endif 2656#ifdef KLD_MODULE 2657DRIVER_MODULE (cemod, pci, ce_driver, ce_devclass, ce_modevent, NULL); 2658#else 2659DRIVER_MODULE (ce, pci, ce_driver, ce_devclass, ce_modevent, NULL); 2660#endif 2661#else /* if __FreeBSD_version < 500000*/ 2662#ifdef NETGRAPH 2663DRIVER_MODULE (ce, pci, ce_driver, ce_devclass, ng_mod_event, &typestruct); 2664#else 2665DRIVER_MODULE (ce, pci, ce_driver, ce_devclass, ce_modevent, NULL); 2666#endif 2667#endif /* __FreeBSD_version < 500000 */ 2668#endif /* NPCI */ 2669