The Design and Implementation of the FreeBSD Operating System, Second Edition
Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

FreeBSD/Linux Kernel Cross Reference
sys/dev/ce/if_ce.c

Version: -  FREEBSD  -  FREEBSD-13-STABLE  -  FREEBSD-13-0  -  FREEBSD-12-STABLE  -  FREEBSD-12-0  -  FREEBSD-11-STABLE  -  FREEBSD-11-0  -  FREEBSD-10-STABLE  -  FREEBSD-10-0  -  FREEBSD-9-STABLE  -  FREEBSD-9-0  -  FREEBSD-8-STABLE  -  FREEBSD-8-0  -  FREEBSD-7-STABLE  -  FREEBSD-7-0  -  FREEBSD-6-STABLE  -  FREEBSD-6-0  -  FREEBSD-5-STABLE  -  FREEBSD-5-0  -  FREEBSD-4-STABLE  -  FREEBSD-3-STABLE  -  FREEBSD22  -  l41  -  OPENBSD  -  linux-2.6  -  MK84  -  PLAN9  -  xnu-8792 
SearchContext: -  none  -  3  -  10 

    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$");
   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 
  134 static  int ce_probe            __P((device_t));
  135 static  int ce_attach           __P((device_t));
  136 static  int ce_detach           __P((device_t));
  137 
  138 static  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 
  147 typedef 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 
  157 typedef 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 
  183 typedef 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 
  195 static  driver_t ce_driver = {
  196         "ce",
  197         ce_methods,
  198         sizeof(bdrv_t),
  199 };
  200 
  201 static  devclass_t ce_devclass;
  202 
  203 static void ce_receive (ce_chan_t *c, unsigned char *data, int len);
  204 static void ce_transmit (ce_chan_t *c, void *attachment, int len);
  205 static void ce_error (ce_chan_t *c, int data);
  206 static void ce_up (drv_t *d);
  207 static void ce_start (drv_t *d);
  208 static void ce_down (drv_t *d);
  209 static void ce_watchdog (drv_t *d);
  210 static void ce_watchdog_timer (void *arg);
  211 #ifdef NETGRAPH
  212 extern struct ng_type typestruct;
  213 #else
  214 static void ce_ifstart (struct ifnet *ifp);
  215 static void ce_tlf (struct sppp *sp);
  216 static void ce_tls (struct sppp *sp);
  217 static int ce_sioctl (struct ifnet *ifp, u_long cmd, caddr_t data);
  218 static void ce_initialize (void *softc);
  219 #endif
  220 
  221 static ce_board_t *adapter [NBRD];
  222 static drv_t *channel [NBRD*NCHAN];
  223 static struct callout led_timo [NBRD];
  224 static struct callout timeout_handle;
  225 
  226 static int ce_destroy = 0;
  227 
  228 #if __FreeBSD_version < 500000
  229 static int ce_open (dev_t dev, int oflags, int devtype, struct proc *p);
  230 static int ce_close (dev_t dev, int fflag, int devtype, struct proc *p);
  231 static int ce_ioctl (dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p);
  232 #else
  233 static int ce_open (struct cdev *dev, int oflags, int devtype, struct thread *td);
  234 static int ce_close (struct cdev *dev, int fflag, int devtype, struct thread *td);
  235 static int ce_ioctl (struct cdev *dev, u_long cmd, caddr_t data, int flag, struct thread *td);
  236 #endif
  237 #if __FreeBSD_version < 500000
  238 static 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
  245 static 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
  252 static 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
  267 static 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
  276 static 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 */
  286 static 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  */
  298 static 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 
  314 static 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 
  324 static 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 
  361 static 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 
  377 static 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
  430 static void
  431 ce_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 
  447 static int
  448 ce_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 
  490 static void
  491 ce_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
  498 static int
  499 ce_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 
  514 static void
  515 ce_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  */
  524 static 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] = '' + 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         gone_in_dev(dev, 14, "sync serial (T1/E1) drivers");
  747         return 0;
  748 }
  749 
  750 static int ce_detach (device_t dev)
  751 {
  752         bdrv_t *bd = device_get_softc (dev);
  753         ce_board_t *b = bd->board;
  754         ce_chan_t *c;
  755         int s;
  756 
  757 #if __FreeBSD_version >= 504000
  758         KASSERT (mtx_initialized (&bd->ce_mtx), ("ce mutex not initialized"));
  759 #endif
  760         s = splimp ();
  761         CE_LOCK (bd);
  762         /* Check if the device is busy (open). */
  763         for (c = b->chan; c < b->chan + NCHAN; ++c) {
  764                 drv_t *d = (drv_t*) c->sys;
  765 
  766                 /* XXX Non existen chan! */
  767                 if (! d || ! d->chan)
  768                         continue;
  769                 if (d->running) {
  770                         CE_UNLOCK (bd);
  771                         splx (s);
  772                         return EBUSY;
  773                 }
  774         }
  775 
  776         /* Ok, we can unload driver */
  777         /* At first we should disable interrupts */
  778         ce_destroy = 1;
  779         TAU32_DisableInterrupts(b->ddk.pControllerObject);
  780 
  781         callout_stop (&led_timo[b->num]);
  782 
  783         for (c = b->chan; c < b->chan + NCHAN; ++c) {
  784                 drv_t *d = (drv_t*) c->sys;
  785 
  786                 if (! d || ! d->chan)
  787                         continue;
  788                 callout_stop (&d->timeout_handle);
  789 #ifndef NETGRAPH
  790                 /* Detach from the packet filter list of interfaces. */
  791                 bpfdetach (d->ifp);
  792 
  793                 /* Detach from the sync PPP list. */
  794                 sppp_detach (d->ifp);
  795 
  796                 /* Detach from the system list of interfaces. */
  797                 if_detach (d->ifp);
  798 #if __FreeBSD_version > 600031
  799                 if_free(d->ifp);
  800 #else
  801                 free (d->ifp, M_DEVBUF);
  802 #endif
  803 
  804                 IF_DRAIN (&d->rqueue);
  805 #if __FreeBSD_version >= 500000
  806                 mtx_destroy (&d->rqueue.ifq_mtx);
  807 #endif
  808 #else
  809 #if __FreeBSD_version >= 500000
  810                 if (d->node) {
  811                         ng_rmnode_self (d->node);
  812                         NG_NODE_UNREF (d->node);
  813                         d->node = NULL;
  814                 }
  815                 IF_DRAIN (&d->rqueue);
  816                 mtx_destroy (&d->queue.ifq_mtx);
  817                 mtx_destroy (&d->hi_queue.ifq_mtx);
  818                 mtx_destroy (&d->rqueue.ifq_mtx);
  819 #else
  820                 ng_rmnode (d->node);
  821                 d->node = 0;
  822 #endif
  823 #endif
  824                 destroy_dev (d->devt);
  825         }
  826 
  827         CE_UNLOCK (bd);
  828         splx (s);
  829 
  830         callout_drain (&led_timo[b->num]);
  831 
  832         /* Disable the interrupt request. */
  833         bus_teardown_intr (dev, bd->ce_irq, bd->ce_intrhand);
  834         bus_release_resource (dev, SYS_RES_IRQ, 0, bd->ce_irq);
  835         TAU32_DestructiveHalt (b->ddk.pControllerObject, 0);
  836         bus_release_resource (dev, SYS_RES_MEMORY, PCIR_BAR(0), bd->ce_res);
  837 
  838         for (c = b->chan; c < b->chan + NCHAN; ++c) {
  839                 drv_t *d = (drv_t*) c->sys;
  840 
  841                 if (! d || ! d->chan)
  842                         continue;
  843                 callout_drain (&d->timeout_handle);
  844                 channel [b->num * NCHAN + c->num] = NULL;
  845                 /* Deallocate buffers. */
  846                 ce_bus_dma_mem_free (&d->dmamem);
  847         }
  848         adapter [b->num] = NULL;
  849         ce_bus_dma_mem_free (&bd->dmamem);
  850         free (b, M_DEVBUF);
  851 #if __FreeBSD_version >= 504000
  852         mtx_destroy (&bd->ce_mtx);
  853 #endif
  854         return 0;
  855 }
  856 
  857 #ifndef NETGRAPH
  858 static void ce_ifstart (struct ifnet *ifp)
  859 {
  860         drv_t *d = ifp->if_softc;
  861         bdrv_t *bd = d->board->sys;
  862 
  863         CE_LOCK (bd);
  864         ce_start (d);
  865         CE_UNLOCK (bd);
  866 }
  867 
  868 static void ce_tlf (struct sppp *sp)
  869 {
  870         drv_t *d = SP2IFP(sp)->if_softc;
  871 
  872         CE_DEBUG2 (d, ("ce_tlf\n"));
  873         sp->pp_down (sp);
  874 }
  875 
  876 static void ce_tls (struct sppp *sp)
  877 {
  878         drv_t *d = SP2IFP(sp)->if_softc;
  879 
  880         CE_DEBUG2 (d, ("ce_tls\n"));
  881         sp->pp_up (sp);
  882 }
  883 
  884 /*
  885  * Process an ioctl request.
  886  */
  887 static int ce_sioctl (struct ifnet *ifp, u_long cmd, caddr_t data)
  888 {
  889         drv_t *d = ifp->if_softc;
  890         bdrv_t *bd = d->board->sys;
  891         int error, s, was_up, should_be_up;
  892 
  893 #if __FreeBSD_version >= 600034
  894         was_up = (ifp->if_drv_flags & IFF_DRV_RUNNING) != 0;
  895 #else
  896         was_up = (ifp->if_flags & IFF_RUNNING) != 0;
  897 #endif
  898         error = sppp_ioctl (ifp, cmd, data);
  899 
  900         if (error)
  901                 return error;
  902 
  903         if (! (ifp->if_flags & IFF_DEBUG))
  904                 d->chan->debug = 0;
  905         else
  906                 d->chan->debug = d->chan->debug_shadow;
  907 
  908         switch (cmd) {
  909         default:           CE_DEBUG2 (d, ("ioctl 0x%lx\n", cmd));   return 0;
  910         case SIOCADDMULTI: CE_DEBUG2 (d, ("ioctl SIOCADDMULTI\n")); return 0;
  911         case SIOCDELMULTI: CE_DEBUG2 (d, ("ioctl SIOCDELMULTI\n")); return 0;
  912         case SIOCSIFFLAGS: CE_DEBUG2 (d, ("ioctl SIOCSIFFLAGS\n")); break;
  913         case SIOCSIFADDR:  CE_DEBUG2 (d, ("ioctl SIOCSIFADDR\n"));  break;
  914         }
  915 
  916         /* We get here only in case of SIFFLAGS or SIFADDR. */
  917         s = splimp ();
  918         CE_LOCK (bd);
  919 #if __FreeBSD_version >= 600034
  920         should_be_up = (ifp->if_drv_flags & IFF_DRV_RUNNING) != 0;
  921 #else
  922         should_be_up = (ifp->if_flags & IFF_RUNNING) != 0;
  923 #endif
  924         if (! was_up && should_be_up) {
  925                 /* Interface goes up -- start it. */
  926                 ce_up (d);
  927                 ce_start (d);
  928         } else if (was_up && ! should_be_up) {
  929                 /* Interface is going down -- stop it. */
  930 /*              if ((IFP2SP(ifp)->pp_flags & PP_FR) || (ifp->if_flags & PP_CISCO))*/
  931                 ce_down (d);
  932         }
  933         CE_DEBUG (d, ("ioctl 0x%lx p4\n", cmd));
  934         CE_UNLOCK (bd);
  935         splx (s);
  936         return 0;
  937 }
  938 
  939 /*
  940  * Initialization of interface.
  941  * It seems to be never called by upper level?
  942  */
  943 static void ce_initialize (void *softc)
  944 {
  945         drv_t *d = softc;
  946 
  947         CE_DEBUG (d, ("ce_initialize\n"));
  948 }
  949 #endif /*NETGRAPH*/
  950 
  951 /*
  952  * Stop the interface.  Called on splimp().
  953  */
  954 static void ce_down (drv_t *d)
  955 {
  956         CE_DEBUG (d, ("ce_down\n"));
  957         /* Interface is going down -- stop it. */
  958         ce_set_dtr (d->chan, 0);
  959         ce_set_rts (d->chan, 0);
  960 
  961         d->running = 0;
  962         callout_stop (&d->timeout_handle);
  963 }
  964 
  965 /*
  966  * Start the interface.  Called on splimp().
  967  */
  968 static void ce_up (drv_t *d)
  969 {
  970         CE_DEBUG (d, ("ce_up\n"));
  971         ce_set_dtr (d->chan, 1);
  972         ce_set_rts (d->chan, 1);
  973 
  974         d->running = 1;
  975 }
  976 
  977 /*
  978  * Start output on the interface.  Get another datagram to send
  979  * off of the interface queue, and copy it to the interface
  980  * before starting the output.
  981  */
  982 static void ce_send (drv_t *d)
  983 {
  984         struct mbuf *m;
  985         u_short len;
  986 
  987         CE_DEBUG2 (d, ("ce_send\n"));
  988 
  989         /* No output if the interface is down. */
  990         if (! d->running)
  991                 return;
  992 
  993         while (ce_transmit_space (d->chan)) {
  994                 /* Get the packet to send. */
  995 #ifdef NETGRAPH
  996                 IF_DEQUEUE (&d->hi_queue, m);
  997                 if (! m)
  998                         IF_DEQUEUE (&d->queue, m);
  999 #else
 1000                 m = sppp_dequeue (d->ifp);
 1001 #endif
 1002                 if (! m)
 1003                         return;
 1004 #ifndef NETGRAPH
 1005 #if __FreeBSD_version >= 500000
 1006                 BPF_MTAP (d->ifp, m);
 1007 #else
 1008                 if (d->ifp->if_bpf)
 1009                         bpf_mtap (d->ifp, m);
 1010 #endif
 1011 #endif
 1012 #if __FreeBSD_version >= 490000
 1013                 len = m_length (m, NULL);
 1014 #else
 1015                 len = m->m_pkthdr.len;
 1016 #endif
 1017                 if (len >= BUFSZ)
 1018                         printf ("%s: too long packet: %d bytes: ",
 1019                                 d->name, len);
 1020                 else if (! m->m_next)
 1021                         ce_send_packet (d->chan, (u_char*) mtod (m, caddr_t), len, 0);
 1022                 else {
 1023                         ce_buf_item_t *item = (ce_buf_item_t*)d->chan->tx_queue;
 1024                         m_copydata (m, 0, len, item->buf);
 1025                         ce_send_packet (d->chan, item->buf, len, 0);
 1026                 }
 1027                 m_freem (m);
 1028                 /* Set up transmit timeout, if the transmit ring is not empty.*/
 1029                 d->timeout = 10;
 1030         }
 1031 #ifndef NETGRAPH
 1032 #if __FreeBSD_version >= 600034
 1033         d->ifp->if_flags |= IFF_DRV_OACTIVE;
 1034 #else
 1035         d->ifp->if_flags |= IFF_OACTIVE;
 1036 #endif
 1037 #endif
 1038 }
 1039 
 1040 /*
 1041  * Start output on the interface.
 1042  * Always called on splimp().
 1043  */
 1044 static void ce_start (drv_t *d)
 1045 {
 1046         if (d->running) {
 1047                 if (! d->chan->dtr)
 1048                         ce_set_dtr (d->chan, 1);
 1049                 if (! d->chan->rts)
 1050                         ce_set_rts (d->chan, 1);
 1051                 ce_send (d);
 1052                 callout_reset (&d->timeout_handle, hz, ce_watchdog_timer, d);
 1053         }
 1054 }
 1055 
 1056 /*
 1057  * Handle transmit timeouts.
 1058  * Recover after lost transmit interrupts.
 1059  * Always called on splimp().
 1060  */
 1061 static void ce_watchdog (drv_t *d)
 1062 {
 1063         CE_DEBUG (d, ("device timeout\n"));
 1064         if (d->running) {
 1065                 ce_set_dtr (d->chan, 0);
 1066                 ce_set_rts (d->chan, 0);
 1067 /*              ce_stop_chan (d->chan);*/
 1068 /*              ce_start_chan (d->chan, 1, 1, 0, 0);*/
 1069                 ce_set_dtr (d->chan, 1);
 1070                 ce_set_rts (d->chan, 1);
 1071                 ce_start (d);
 1072         }
 1073 }
 1074 
 1075 static void ce_watchdog_timer (void *arg)
 1076 {
 1077         drv_t *d = arg;
 1078         bdrv_t *bd = d->board->sys;
 1079 
 1080         CE_LOCK(bd);
 1081         if (d->timeout == 1)
 1082                 ce_watchdog (d);
 1083         if (d->timeout)
 1084                 d->timeout--;
 1085         callout_reset (&d->timeout_handle, hz, ce_watchdog_timer, d);
 1086         CE_UNLOCK(bd);
 1087 }
 1088 
 1089 static void ce_transmit (ce_chan_t *c, void *attachment, int len)
 1090 {
 1091         drv_t *d = c->sys;
 1092 
 1093         d->timeout = 0;
 1094 #ifndef NETGRAPH
 1095         if_inc_counter(d->ifp, IFCOUNTER_OPACKETS, 1);
 1096 #if __FreeBSD_version >=  600034
 1097         d->ifp->if_flags &= ~IFF_DRV_OACTIVE;
 1098 #else
 1099         d->ifp->if_flags &= ~IFF_OACTIVE;
 1100 #endif
 1101 #endif
 1102         ce_start (d);
 1103 }
 1104 
 1105 static void ce_receive (ce_chan_t *c, unsigned char *data, int len)
 1106 {
 1107         drv_t *d = c->sys;
 1108         struct mbuf *m;
 1109 
 1110         if (! d->running)
 1111                 return;
 1112 
 1113         m = makembuf (data, len);
 1114         if (! m) {
 1115                 CE_DEBUG (d, ("no memory for packet\n"));
 1116 #ifndef NETGRAPH
 1117                 if_inc_counter(d->ifp, IFCOUNTER_IQDROPS, 1);
 1118 #endif
 1119                 return;
 1120         }
 1121         if (c->debug > 1)
 1122                 m_print (m, 0);
 1123 #ifdef NETGRAPH
 1124         m->m_pkthdr.rcvif = 0;
 1125         IF_ENQUEUE(&d->rqueue, m);
 1126 #else
 1127         if_inc_counter(d->ifp, IFCOUNTER_IPACKETS, 1);
 1128         m->m_pkthdr.rcvif = d->ifp;
 1129         /* Check if there's a BPF listener on this interface.
 1130          * If so, hand off the raw packet to bpf. */
 1131         BPF_MTAP(d->ifp, m);
 1132         IF_ENQUEUE(&d->rqueue, m);
 1133 #endif
 1134 }
 1135 
 1136 static void ce_error (ce_chan_t *c, int data)
 1137 {
 1138         drv_t *d = c->sys;
 1139 
 1140         switch (data) {
 1141         case CE_FRAME:
 1142                 CE_DEBUG (d, ("frame error\n"));
 1143 #ifndef NETGRAPH
 1144                 if_inc_counter(d->ifp, IFCOUNTER_IERRORS, 1);
 1145 #endif
 1146                 break;
 1147         case CE_CRC:
 1148                 CE_DEBUG (d, ("crc error\n"));
 1149 #ifndef NETGRAPH
 1150                 if_inc_counter(d->ifp, IFCOUNTER_IERRORS, 1);
 1151 #endif
 1152                 break;
 1153         case CE_OVERRUN:
 1154                 CE_DEBUG (d, ("overrun error\n"));
 1155 #ifndef NETGRAPH
 1156                 if_inc_counter(d->ifp, IFCOUNTER_COLLISIONS, 1);
 1157                 if_inc_counter(d->ifp, IFCOUNTER_IERRORS, 1);
 1158 #endif
 1159                 break;
 1160         case CE_OVERFLOW:
 1161                 CE_DEBUG (d, ("overflow error\n"));
 1162 #ifndef NETGRAPH
 1163                 if_inc_counter(d->ifp, IFCOUNTER_IERRORS, 1);
 1164 #endif
 1165                 break;
 1166         case CE_UNDERRUN:
 1167                 CE_DEBUG (d, ("underrun error\n"));
 1168                 d->timeout = 0;
 1169 #ifndef NETGRAPH
 1170                 if_inc_counter(d->ifp, IFCOUNTER_OERRORS, 1);
 1171 #if __FreeBSD_version >= 600034
 1172                 d->ifp->if_flags &= ~IFF_DRV_OACTIVE;
 1173 #else
 1174                 d->ifp->if_flags &= ~IFF_OACTIVE;
 1175 #endif
 1176 #endif
 1177                 ce_start (d);
 1178                 break;
 1179         default:
 1180                 CE_DEBUG (d, ("error #%d\n", data));
 1181                 break;
 1182         }
 1183 }
 1184 
 1185 /*
 1186  * You also need read, write, open, close routines.
 1187  * This should get you started
 1188  */
 1189 #if __FreeBSD_version < 500000
 1190 static int ce_open (dev_t dev, int oflags, int devtype, struct proc *p)
 1191 #else
 1192 static int ce_open (struct cdev *dev, int oflags, int devtype, struct thread *td)
 1193 #endif
 1194 {
 1195         int unit = dev2unit (dev);
 1196         drv_t *d;
 1197 
 1198         if (unit >= NBRD*NCHAN || ! (d = channel[unit]))
 1199                 return ENXIO;
 1200         CE_DEBUG2 (d, ("ce_open\n"));
 1201         return 0;
 1202 }
 1203 
 1204 /*
 1205  * Only called on the LAST close.
 1206  */
 1207 #if __FreeBSD_version < 500000
 1208 static int ce_close (dev_t dev, int fflag, int devtype, struct proc *p)
 1209 #else
 1210 static int ce_close (struct cdev *dev, int fflag, int devtype, struct thread *td)
 1211 #endif
 1212 {
 1213         drv_t *d = channel [dev2unit (dev)];
 1214 
 1215         CE_DEBUG2 (d, ("ce_close\n"));
 1216         return 0;
 1217 }
 1218 
 1219 static int ce_modem_status (ce_chan_t *c)
 1220 {
 1221         drv_t *d = c->sys;
 1222         bdrv_t *bd = d->board->sys;
 1223         int status, s;
 1224 
 1225         status = d->running ? TIOCM_LE : 0;
 1226         s = splimp ();
 1227         CE_LOCK (bd);
 1228         if (ce_get_cd  (c)) status |= TIOCM_CD;
 1229         if (ce_get_cts (c)) status |= TIOCM_CTS;
 1230         if (ce_get_dsr (c)) status |= TIOCM_DSR;
 1231         if (c->dtr)         status |= TIOCM_DTR;
 1232         if (c->rts)         status |= TIOCM_RTS;
 1233         CE_UNLOCK (bd);
 1234         splx (s);
 1235         return status;
 1236 }
 1237 
 1238 #if __FreeBSD_version < 500000
 1239 static int ce_ioctl (dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p)
 1240 #else
 1241 static int ce_ioctl (struct cdev *dev, u_long cmd, caddr_t data, int flag, struct thread *td)
 1242 #endif
 1243 {
 1244         drv_t *d = channel [dev2unit (dev)];
 1245         bdrv_t *bd = d->board->sys;
 1246         ce_chan_t *c = d->chan;
 1247         struct serial_statistics *st;
 1248         struct e1_statistics *opte1;
 1249         int error, s;
 1250         char mask[16];
 1251 
 1252         switch (cmd) {
 1253         case SERIAL_GETREGISTERED:
 1254                 CE_DEBUG2 (d, ("ioctl: getregistered\n"));
 1255                 bzero (mask, sizeof(mask));
 1256                 for (s=0; s<NBRD*NCHAN; ++s)
 1257                         if (channel [s])
 1258                                 mask [s/8] |= 1 << (s & 7);
 1259                 bcopy (mask, data, sizeof (mask));
 1260                 return 0;
 1261 
 1262 #ifndef NETGRAPH
 1263         case SERIAL_GETPROTO:
 1264                 CE_DEBUG2 (d, ("ioctl: getproto\n"));
 1265                 strcpy ((char*)data, (IFP2SP(d->ifp)->pp_flags & PP_FR) ? "fr" :
 1266                         (d->ifp->if_flags & PP_CISCO) ? "cisco" : "ppp");
 1267                 return 0;
 1268 
 1269         case SERIAL_SETPROTO:
 1270                 CE_DEBUG2 (d, ("ioctl: setproto\n"));
 1271                 /* Only for superuser! */
 1272 #if __FreeBSD_version < 500000
 1273                 error = suser (p);
 1274 #elif __FreeBSD_version < 700000
 1275                 error = suser (td);
 1276 #else
 1277                 error = priv_check (td, PRIV_DRIVER);
 1278 #endif
 1279                 if (error)
 1280                         return error;
 1281 #if __FreeBSD_version >= 600034
 1282                 if (d->ifp->if_flags & IFF_DRV_RUNNING)
 1283 #else
 1284                 if (d->ifp->if_flags & IFF_RUNNING)
 1285 #endif
 1286                         return EBUSY;
 1287                 if (! strcmp ("cisco", (char*)data)) {
 1288                         IFP2SP(d->ifp)->pp_flags &= ~(PP_FR);
 1289                         IFP2SP(d->ifp)->pp_flags |= PP_KEEPALIVE;
 1290                         d->ifp->if_flags |= PP_CISCO;
 1291 #if PP_FR != 0
 1292                 } else if (! strcmp ("fr", (char*)data)) {
 1293                         d->ifp->if_flags &= ~(PP_CISCO);
 1294                         IFP2SP(d->ifp)->pp_flags |= PP_FR | PP_KEEPALIVE;
 1295 #endif
 1296                 } else if (! strcmp ("ppp", (char*)data)) {
 1297                         IFP2SP(d->ifp)->pp_flags &= ~PP_FR;
 1298                         IFP2SP(d->ifp)->pp_flags &= ~PP_KEEPALIVE;
 1299                         d->ifp->if_flags &= ~(PP_CISCO);
 1300                 } else
 1301                         return EINVAL;
 1302                 return 0;
 1303 
 1304         case SERIAL_GETKEEPALIVE:
 1305                 CE_DEBUG2 (d, ("ioctl: getkeepalive\n"));
 1306                 if ((IFP2SP(d->ifp)->pp_flags & PP_FR) ||
 1307                         (d->ifp->if_flags & PP_CISCO))
 1308                         return EINVAL;
 1309                 *(int*)data = (IFP2SP(d->ifp)->pp_flags & PP_KEEPALIVE) ? 1 : 0;
 1310                 return 0;
 1311 
 1312         case SERIAL_SETKEEPALIVE:
 1313                 CE_DEBUG2 (d, ("ioctl: setkeepalive\n"));
 1314                 /* Only for superuser! */
 1315 #if __FreeBSD_version < 500000
 1316                 error = suser (p);
 1317 #elif __FreeBSD_version < 700000
 1318                 error = suser (td);
 1319 #else
 1320                 error = priv_check (td, PRIV_DRIVER);
 1321 #endif
 1322                 if (error)
 1323                         return error;
 1324                 if ((IFP2SP(d->ifp)->pp_flags & PP_FR) ||
 1325                         (d->ifp->if_flags & PP_CISCO))
 1326                         return EINVAL;
 1327                 s = splimp ();
 1328                 CE_LOCK (bd);
 1329                 if (*(int*)data)
 1330                         IFP2SP(d->ifp)->pp_flags |= PP_KEEPALIVE;
 1331                 else
 1332                         IFP2SP(d->ifp)->pp_flags &= ~PP_KEEPALIVE;
 1333                 CE_UNLOCK (bd);
 1334                 splx (s);
 1335                 return 0;
 1336 #endif /*NETGRAPH*/
 1337 
 1338         case SERIAL_GETMODE:
 1339                 CE_DEBUG2 (d, ("ioctl: getmode\n"));
 1340                 *(int*)data = SERIAL_HDLC;
 1341                 return 0;
 1342 
 1343         case SERIAL_SETMODE:
 1344                 /* Only for superuser! */
 1345 #if __FreeBSD_version < 500000
 1346                 error = suser (p);
 1347 #elif __FreeBSD_version < 700000
 1348                 error = suser (td);
 1349 #else
 1350                 error = priv_check (td, PRIV_DRIVER);
 1351 #endif
 1352                 if (error)
 1353                         return error;
 1354                 if (*(int*)data != SERIAL_HDLC)
 1355                         return EINVAL;
 1356                 return 0;
 1357 
 1358         case SERIAL_GETCFG:
 1359                 CE_DEBUG2 (d, ("ioctl: getcfg\n"));
 1360                 *(char*)data = 'c';
 1361                 return 0;
 1362 
 1363         case SERIAL_SETCFG:
 1364                 CE_DEBUG2 (d, ("ioctl: setcfg\n"));
 1365 #if __FreeBSD_version < 500000
 1366                 error = suser (p);
 1367 #elif __FreeBSD_version < 700000
 1368                 error = suser (td);
 1369 #else
 1370                 error = priv_check (td, PRIV_DRIVER);
 1371 #endif
 1372                 if (error)
 1373                         return error;
 1374                 if (*((char*)data) != 'c')
 1375                         return EINVAL;
 1376                 return 0;
 1377 
 1378         case SERIAL_GETSTAT:
 1379                 CE_DEBUG2 (d, ("ioctl: getstat\n"));
 1380                 st = (struct serial_statistics*) data;
 1381                 st->rintr  = c->rintr;
 1382                 st->tintr  = c->tintr;
 1383                 st->mintr  = 0;
 1384                 st->ibytes = c->ibytes;
 1385                 st->ipkts  = c->ipkts;
 1386                 st->obytes = c->obytes;
 1387                 st->opkts  = c->opkts;
 1388                 st->ierrs  = c->overrun + c->frame + c->crc;
 1389                 st->oerrs  = c->underrun;
 1390                 return 0;
 1391 
 1392         case SERIAL_GETESTAT:
 1393                 CE_DEBUG2 (d, ("ioctl: getestat\n"));
 1394                 if (c->type != T_E1)
 1395                         return EINVAL;
 1396                 opte1 = (struct e1_statistics*) data;
 1397 
 1398                 opte1->status      = 0;
 1399                 if (c->status & ESTS_NOALARM)
 1400                         opte1->status |= E1_NOALARM;
 1401                 if (c->status & ESTS_LOS)
 1402                         opte1->status |= E1_LOS;
 1403                 if (c->status & ESTS_LOF)
 1404                         opte1->status |= E1_LOF;
 1405                 if (c->status & ESTS_AIS)
 1406                         opte1->status |= E1_AIS;
 1407                 if (c->status & ESTS_LOMF)
 1408                         opte1->status |= E1_LOMF;
 1409                 if (c->status & ESTS_AIS16)
 1410                         opte1->status |= E1_AIS16;
 1411                 if (c->status & ESTS_FARLOF)
 1412                         opte1->status |= E1_FARLOF;
 1413                 if (c->status & ESTS_FARLOMF)
 1414                         opte1->status |= E1_FARLOMF;
 1415                 if (c->status & ESTS_TSTREQ)
 1416                         opte1->status |= E1_TSTREQ;
 1417                 if (c->status & ESTS_TSTERR)
 1418                         opte1->status |= E1_TSTERR;
 1419 
 1420                 opte1->cursec       = c->cursec;
 1421                 opte1->totsec       = c->totsec + c->cursec;
 1422 
 1423                 opte1->currnt.bpv   = c->currnt.bpv;
 1424                 opte1->currnt.fse   = c->currnt.fse;
 1425                 opte1->currnt.crce  = c->currnt.crce;
 1426                 opte1->currnt.rcrce = c->currnt.rcrce;
 1427                 opte1->currnt.uas   = c->currnt.uas;
 1428                 opte1->currnt.les   = c->currnt.les;
 1429                 opte1->currnt.es    = c->currnt.es;
 1430                 opte1->currnt.bes   = c->currnt.bes;
 1431                 opte1->currnt.ses   = c->currnt.ses;
 1432                 opte1->currnt.oofs  = c->currnt.oofs;
 1433                 opte1->currnt.css   = c->currnt.css;
 1434                 opte1->currnt.dm    = c->currnt.dm;
 1435 
 1436                 opte1->total.bpv    = c->total.bpv   + c->currnt.bpv;
 1437                 opte1->total.fse    = c->total.fse   + c->currnt.fse;
 1438                 opte1->total.crce   = c->total.crce  + c->currnt.crce;
 1439                 opte1->total.rcrce  = c->total.rcrce + c->currnt.rcrce;
 1440                 opte1->total.uas    = c->total.uas   + c->currnt.uas;
 1441                 opte1->total.les    = c->total.les   + c->currnt.les;
 1442                 opte1->total.es     = c->total.es    + c->currnt.es;
 1443                 opte1->total.bes    = c->total.bes   + c->currnt.bes;
 1444                 opte1->total.ses    = c->total.ses   + c->currnt.ses;
 1445                 opte1->total.oofs   = c->total.oofs  + c->currnt.oofs;
 1446                 opte1->total.css    = c->total.css   + c->currnt.css;
 1447                 opte1->total.dm     = c->total.dm    + c->currnt.dm;
 1448                 for (s=0; s<48; ++s) {
 1449                         opte1->interval[s].bpv   = c->interval[s].bpv;
 1450                         opte1->interval[s].fse   = c->interval[s].fse;
 1451                         opte1->interval[s].crce  = c->interval[s].crce;
 1452                         opte1->interval[s].rcrce = c->interval[s].rcrce;
 1453                         opte1->interval[s].uas   = c->interval[s].uas;
 1454                         opte1->interval[s].les   = c->interval[s].les;
 1455                         opte1->interval[s].es    = c->interval[s].es;
 1456                         opte1->interval[s].bes   = c->interval[s].bes;
 1457                         opte1->interval[s].ses   = c->interval[s].ses;
 1458                         opte1->interval[s].oofs  = c->interval[s].oofs;
 1459                         opte1->interval[s].css   = c->interval[s].css;
 1460                         opte1->interval[s].dm    = c->interval[s].dm;
 1461                 }
 1462                 return 0;
 1463 
 1464         case SERIAL_CLRSTAT:
 1465                 CE_DEBUG2 (d, ("ioctl: clrstat\n"));
 1466                 /* Only for superuser! */
 1467 #if __FreeBSD_version < 500000
 1468                 error = suser (p);
 1469 #elif __FreeBSD_version < 700000
 1470                 error = suser (td);
 1471 #else
 1472                 error = priv_check (td, PRIV_DRIVER);
 1473 #endif
 1474                 if (error)
 1475                         return error;
 1476                 c->rintr    = 0;
 1477                 c->tintr    = 0;
 1478                 c->ibytes   = 0;
 1479                 c->obytes   = 0;
 1480                 c->ipkts    = 0;
 1481                 c->opkts    = 0;
 1482                 c->overrun  = 0;
 1483                 c->frame    = 0;
 1484                 c->crc      = 0;
 1485                 c->underrun = 0;
 1486                 bzero (&c->currnt, sizeof (c->currnt));
 1487                 bzero (&c->total, sizeof (c->total));
 1488                 bzero (c->interval, sizeof (c->interval));
 1489                 return 0;
 1490 
 1491         case SERIAL_GETLOOP:
 1492                 CE_DEBUG2 (d, ("ioctl: getloop\n"));
 1493                 if (c->type != T_E1)
 1494                         return EINVAL;
 1495                 *(int*)data = c->lloop;
 1496                 return 0;
 1497 
 1498         case SERIAL_SETLOOP:
 1499                 CE_DEBUG2 (d, ("ioctl: setloop\n"));
 1500                 if (c->type != T_E1)
 1501                         return EINVAL;
 1502                 /* Only for superuser! */
 1503 #if __FreeBSD_version < 500000
 1504                 error = suser (p);
 1505 #elif __FreeBSD_version < 700000
 1506                 error = suser (td);
 1507 #else
 1508                 error = priv_check (td, PRIV_DRIVER);
 1509 #endif
 1510                 if (error)
 1511                         return error;
 1512                 s = splimp ();
 1513                 CE_LOCK (bd);
 1514                 ce_set_lloop (c, *(int*)data);
 1515                 CE_UNLOCK (bd);
 1516                 splx (s);
 1517                 return 0;
 1518 
 1519         case SERIAL_GETRLOOP:
 1520                 CE_DEBUG2 (d, ("ioctl: getrloop\n"));
 1521                 if (c->type != T_E1)
 1522                         return EINVAL;
 1523                 *(int*)data = c->rloop;
 1524                 return 0;
 1525 
 1526         case SERIAL_SETRLOOP:
 1527                 CE_DEBUG2 (d, ("ioctl: setloop\n"));
 1528                 if (c->type != T_E1)
 1529                         return EINVAL;
 1530                 /* Only for superuser! */
 1531 #if __FreeBSD_version < 500000
 1532                 error = suser (p);
 1533 #elif __FreeBSD_version < 700000
 1534                 error = suser (td);
 1535 #else
 1536                 error = priv_check (td, PRIV_DRIVER);
 1537 #endif
 1538                 if (error)
 1539                         return error;
 1540                 s = splimp ();
 1541                 CE_LOCK (bd);
 1542                 ce_set_rloop (c, *(int*)data);
 1543                 CE_UNLOCK (bd);
 1544                 splx (s);
 1545                 return 0;
 1546 
 1547         case SERIAL_GETDEBUG:
 1548                 CE_DEBUG2 (d, ("ioctl: getdebug\n"));
 1549                 *(int*)data = d->chan->debug;
 1550                 return 0;
 1551 
 1552         case SERIAL_SETDEBUG:
 1553                 CE_DEBUG2 (d, ("ioctl: setdebug\n"));
 1554                 /* Only for superuser! */
 1555 #if __FreeBSD_version < 500000
 1556                 error = suser (p);
 1557 #elif __FreeBSD_version < 700000
 1558                 error = suser (td);
 1559 #else
 1560                 error = priv_check (td, PRIV_DRIVER);
 1561 #endif
 1562                 if (error)
 1563                         return error;
 1564 #ifndef NETGRAPH
 1565                 /*
 1566                  * The debug_shadow is always greater than zero for logic 
 1567                  * simplicity.  For switching debug off the IFF_DEBUG is
 1568                  * responsible.
 1569                  */
 1570                 d->chan->debug_shadow = (*(int*)data) ? (*(int*)data) : 1;
 1571                 if (d->ifp->if_flags & IFF_DEBUG)
 1572                         d->chan->debug = d->chan->debug_shadow;
 1573 #else
 1574                 d->chan->debug = *(int*)data;
 1575 #endif
 1576                 return 0;
 1577 
 1578         case SERIAL_GETBAUD:
 1579                 CE_DEBUG2 (d, ("ioctl: getbaud\n"));
 1580                 *(long*)data = c->baud;
 1581                 return 0;
 1582 
 1583         case SERIAL_SETBAUD:
 1584                 CE_DEBUG2 (d, ("ioctl: setbaud\n"));
 1585                 if (c->type != T_E1 || !c->unfram)
 1586                         return EINVAL;
 1587                 /* Only for superuser! */
 1588 #if __FreeBSD_version < 500000
 1589                 error = suser (p);
 1590 #elif __FreeBSD_version < 700000
 1591                 error = suser (td);
 1592 #else
 1593                 error = priv_check (td, PRIV_DRIVER);
 1594 #endif
 1595                 if (error)
 1596                         return error;
 1597                 s = splimp ();
 1598                 CE_LOCK (bd);
 1599                 ce_set_baud (c, *(long*)data);
 1600                 CE_UNLOCK (bd);
 1601                 splx (s);
 1602                 return 0;
 1603 
 1604         case SERIAL_GETTIMESLOTS:
 1605                 CE_DEBUG2 (d, ("ioctl: gettimeslots\n"));
 1606                 if ((c->type != T_E1 || c->unfram) && c->type != T_DATA)
 1607                         return EINVAL;
 1608                 *(u_long*)data = c->ts;
 1609                 return 0;
 1610 
 1611         case SERIAL_SETTIMESLOTS:
 1612                 CE_DEBUG2 (d, ("ioctl: settimeslots\n"));
 1613                 /* Only for superuser! */
 1614 #if __FreeBSD_version < 500000
 1615                 error = suser (p);
 1616 #elif __FreeBSD_version < 700000
 1617                 error = suser (td);
 1618 #else
 1619                 error = priv_check (td, PRIV_DRIVER);
 1620 #endif
 1621                 if (error)
 1622                         return error;
 1623                 if ((c->type != T_E1 || c->unfram) && c->type != T_DATA)
 1624                         return EINVAL;
 1625                 s = splimp ();
 1626                 CE_LOCK (bd);
 1627                 ce_set_ts (c, *(u_long*)data);
 1628                 CE_UNLOCK (bd);
 1629                 splx (s);
 1630                 return 0;
 1631 
 1632         case SERIAL_GETHIGAIN:
 1633                 CE_DEBUG2 (d, ("ioctl: gethigain\n"));
 1634                 if (c->type != T_E1)
 1635                         return EINVAL;
 1636                 *(int*)data = c->higain;
 1637                 return 0;
 1638 
 1639         case SERIAL_SETHIGAIN:
 1640                 CE_DEBUG2 (d, ("ioctl: sethigain\n"));
 1641                 if (c->type != T_E1)
 1642                         return EINVAL;
 1643                 /* Only for superuser! */
 1644 #if __FreeBSD_version < 500000
 1645                 error = suser (p);
 1646 #elif __FreeBSD_version < 700000
 1647                 error = suser (td);
 1648 #else
 1649                 error = priv_check (td, PRIV_DRIVER);
 1650 #endif
 1651                 if (error)
 1652                         return error;
 1653                 s = splimp ();
 1654                 CE_LOCK (bd);
 1655                 ce_set_higain (c, *(int*)data);
 1656                 CE_UNLOCK (bd);
 1657                 splx (s);
 1658                 return 0;
 1659 
 1660         case SERIAL_GETPHONY:
 1661                 CE_DEBUG2 (d, ("ioctl: getphony\n"));
 1662                 *(int*)data = c->phony;
 1663                 return 0;
 1664 
 1665         case SERIAL_SETPHONY:
 1666                 CE_DEBUG2 (d, ("ioctl: setphony\n"));
 1667                 /* Only for superuser! */
 1668 #if __FreeBSD_version < 500000
 1669                 error = suser (p);
 1670 #elif __FreeBSD_version < 700000
 1671                 error = suser (td);
 1672 #else
 1673                 error = priv_check (td, PRIV_DRIVER);
 1674 #endif
 1675                 if (error)
 1676                         return error;
 1677                 s = splimp ();
 1678                 CE_LOCK (bd);
 1679                 ce_set_phony (c, *(int*)data);
 1680                 CE_UNLOCK (bd);
 1681                 splx (s);
 1682                 return 0;
 1683 
 1684         case SERIAL_GETUNFRAM:
 1685                 CE_DEBUG2 (d, ("ioctl: getunfram\n"));
 1686                 if (c->type != T_E1 || c->num != 0)
 1687                         return EINVAL;
 1688                 *(int*)data = c->unfram;
 1689                 return 0;
 1690 
 1691         case SERIAL_SETUNFRAM:
 1692                 CE_DEBUG2 (d, ("ioctl: setunfram\n"));
 1693                 if (c->type != T_E1 || c->num != 0)
 1694                         return EINVAL;
 1695                 /* Only for superuser! */
 1696 #if __FreeBSD_version < 500000
 1697                 error = suser (p);
 1698 #elif __FreeBSD_version < 700000
 1699                 error = suser (td);
 1700 #else
 1701                 error = priv_check (td, PRIV_DRIVER);
 1702 #endif
 1703                 if (error)
 1704                         return error;
 1705                 s = splimp ();
 1706                 CE_LOCK (bd);
 1707                 ce_set_unfram (c, *(int*)data);
 1708                 CE_UNLOCK (bd);
 1709                 splx (s);
 1710                 return 0;
 1711 
 1712         case SERIAL_GETSCRAMBLER:
 1713                 CE_DEBUG2 (d, ("ioctl: getscrambler\n"));
 1714                 if (!c->unfram)
 1715                         return EINVAL;
 1716                 *(int*)data = c->scrambler;
 1717                 return 0;
 1718 
 1719         case SERIAL_SETSCRAMBLER:
 1720                 CE_DEBUG2 (d, ("ioctl: setscrambler\n"));
 1721                 /* Only for superuser! */
 1722 #if __FreeBSD_version < 500000
 1723                 error = suser (p);
 1724 #elif __FreeBSD_version < 700000
 1725                 error = suser (td);
 1726 #else
 1727                 error = priv_check (td, PRIV_DRIVER);
 1728 #endif
 1729                 if (error)
 1730                         return error;
 1731                 if (!c->unfram)
 1732                         return EINVAL;
 1733                 s = splimp ();
 1734                 CE_LOCK (bd);
 1735                 ce_set_scrambler (c, *(int*)data);
 1736                 CE_UNLOCK (bd);
 1737                 splx (s);
 1738                 return 0;
 1739 
 1740         case SERIAL_GETMONITOR:
 1741                 CE_DEBUG2 (d, ("ioctl: getmonitor\n"));
 1742                 if (c->type != T_E1)
 1743                         return EINVAL;
 1744                 *(int*)data = c->monitor;
 1745                 return 0;
 1746 
 1747         case SERIAL_SETMONITOR:
 1748                 CE_DEBUG2 (d, ("ioctl: setmonitor\n"));
 1749                 /* Only for superuser! */
 1750 #if __FreeBSD_version < 500000
 1751                 error = suser (p);
 1752 #elif __FreeBSD_version < 700000
 1753                 error = suser (td);
 1754 #else
 1755                 error = priv_check (td, PRIV_DRIVER);
 1756 #endif
 1757                 if (error)
 1758                         return error;
 1759                 if (c->type != T_E1)
 1760                         return EINVAL;
 1761                 s = splimp ();
 1762                 CE_LOCK (bd);
 1763                 ce_set_monitor (c, *(int*)data);
 1764                 CE_UNLOCK (bd);
 1765                 splx (s);
 1766                 return 0;
 1767 
 1768         case SERIAL_GETUSE16:
 1769                 CE_DEBUG2 (d, ("ioctl: getuse16\n"));
 1770                 if (c->type != T_E1 || c->unfram)
 1771                         return EINVAL;
 1772                 *(int*)data = c->use16;
 1773                 return 0;
 1774 
 1775         case SERIAL_SETUSE16:
 1776                 CE_DEBUG2 (d, ("ioctl: setuse16\n"));
 1777                 /* Only for superuser! */
 1778 #if __FreeBSD_version < 500000
 1779                 error = suser (p);
 1780 #elif __FreeBSD_version < 700000
 1781                 error = suser (td);
 1782 #else
 1783                 error = priv_check (td, PRIV_DRIVER);
 1784 #endif
 1785                 if (error)
 1786                         return error;
 1787                 if (c->type != T_E1)
 1788                         return EINVAL;
 1789                 s = splimp ();
 1790                 CE_LOCK (bd);
 1791                 ce_set_use16 (c, *(int*)data);
 1792                 CE_UNLOCK (bd);
 1793                 splx (s);
 1794                 return 0;
 1795 
 1796         case SERIAL_GETCRC4:
 1797                 CE_DEBUG2 (d, ("ioctl: getcrc4\n"));
 1798                 if (c->type != T_E1 || c->unfram)
 1799                         return EINVAL;
 1800                 *(int*)data = c->crc4;
 1801                 return 0;
 1802 
 1803         case SERIAL_SETCRC4:
 1804                 CE_DEBUG2 (d, ("ioctl: setcrc4\n"));
 1805                 /* Only for superuser! */
 1806 #if __FreeBSD_version < 500000
 1807                 error = suser (p);
 1808 #elif __FreeBSD_version < 700000
 1809                 error = suser (td);
 1810 #else
 1811                 error = priv_check (td, PRIV_DRIVER);
 1812 #endif
 1813                 if (error)
 1814                         return error;
 1815                 if (c->type != T_E1 || c->unfram)
 1816                         return EINVAL;
 1817                 s = splimp ();
 1818                 CE_LOCK (bd);
 1819                 ce_set_crc4 (c, *(int*)data);
 1820                 CE_UNLOCK (bd);
 1821                 splx (s);
 1822                 return 0;
 1823 
 1824         case SERIAL_GETCLK:
 1825                 CE_DEBUG2 (d, ("ioctl: getclk\n"));
 1826                 if (c->type != T_E1)
 1827                         return EINVAL;
 1828                 switch (c->gsyn) {
 1829                 default:        *(int*)data = E1CLK_INTERNAL;           break;
 1830                 case GSYN_RCV:  *(int*)data = E1CLK_RECEIVE;            break;
 1831                 case GSYN_RCV0: *(int*)data = E1CLK_RECEIVE_CHAN0;      break;
 1832                 case GSYN_RCV1: *(int*)data = E1CLK_RECEIVE_CHAN1;      break;
 1833                 }
 1834                 return 0;
 1835 
 1836         case SERIAL_SETCLK:
 1837                 CE_DEBUG2 (d, ("ioctl: setclk\n"));
 1838                 /* Only for superuser! */
 1839 #if __FreeBSD_version < 500000
 1840                 error = suser (p);
 1841 #elif __FreeBSD_version < 700000
 1842                 error = suser (td);
 1843 #else
 1844                 error = priv_check (td, PRIV_DRIVER);
 1845 #endif
 1846                 if (error)
 1847                         return error;
 1848                 if (c->type != T_E1)
 1849                         return EINVAL;
 1850                 s = splimp ();
 1851                 CE_LOCK (bd);
 1852                 switch (*(int*)data) {
 1853                 default:                  ce_set_gsyn (c, GSYN_INT);  break;
 1854                 case E1CLK_RECEIVE:       ce_set_gsyn (c, GSYN_RCV);  break;
 1855                 case E1CLK_RECEIVE_CHAN0: ce_set_gsyn (c, GSYN_RCV0); break;
 1856                 case E1CLK_RECEIVE_CHAN1: ce_set_gsyn (c, GSYN_RCV1); break;
 1857                 }
 1858                 CE_UNLOCK (bd);
 1859                 splx (s);
 1860                 return 0;
 1861 
 1862 #if 0
 1863         case SERIAL_RESET:
 1864                 CE_DEBUG2 (d, ("ioctl: reset\n"));
 1865                 /* Only for superuser! */
 1866 #if __FreeBSD_version < 500000
 1867                 error = suser (p);
 1868 #elif __FreeBSD_version < 700000
 1869                 error = suser (td);
 1870 #else
 1871                 error = priv_check (td, PRIV_DRIVER);
 1872 #endif
 1873                 if (error)
 1874                         return error;
 1875                 s = splimp ();
 1876                 CE_LOCK (bd);
 1877 /*              ce_reset (c->board, 0, 0);*/
 1878                 CE_UNLOCK (bd);
 1879                 splx (s);
 1880                 return 0;
 1881 
 1882         case SERIAL_HARDRESET:
 1883                 CE_DEBUG2 (d, ("ioctl: hardreset\n"));
 1884                 /* Only for superuser! */
 1885 #if __FreeBSD_version < 500000
 1886                 error = suser (p);
 1887 #elif __FreeBSD_version < 700000
 1888                 error = suser (td);
 1889 #else
 1890                 error = priv_check (td, PRIV_DRIVER);
 1891 #endif
 1892                 if (error)
 1893                         return error;
 1894                 s = splimp ();
 1895                 CE_LOCK (bd);
 1896                 /* hard_reset (c->board); */
 1897                 CE_UNLOCK (bd);
 1898                 splx (s);
 1899                 return 0;
 1900 #endif
 1901 
 1902         case SERIAL_GETCABLE:
 1903                 CE_DEBUG2 (d, ("ioctl: getcable\n"));
 1904                 if (c->type != T_E1)
 1905                         return EINVAL;
 1906                 s = splimp ();
 1907                 CE_LOCK (bd);
 1908                 *(int*)data = CABLE_TP;
 1909                 CE_UNLOCK (bd);
 1910                 splx (s);
 1911                 return 0;
 1912 
 1913         case SERIAL_GETDIR:
 1914                 CE_DEBUG2 (d, ("ioctl: getdir\n"));
 1915                 if (c->type != T_E1 && c->type != T_DATA)
 1916                         return EINVAL;
 1917                 *(int*)data = c->dir;
 1918                 return 0;
 1919 
 1920         case SERIAL_SETDIR:
 1921                 CE_DEBUG2 (d, ("ioctl: setdir\n"));
 1922                 /* Only for superuser! */
 1923 #if __FreeBSD_version < 500000
 1924                 error = suser (p);
 1925 #elif __FreeBSD_version < 700000
 1926                 error = suser (td);
 1927 #else
 1928                 error = priv_check (td, PRIV_DRIVER);
 1929 #endif
 1930                 if (error)
 1931                         return error;
 1932                 s = splimp ();
 1933                 CE_LOCK (bd);
 1934                 ce_set_dir (c, *(int*)data);
 1935                 CE_UNLOCK (bd);
 1936                 splx (s);
 1937                 return 0;
 1938 
 1939         case TIOCSDTR:          /* Set DTR */
 1940                 s = splimp ();
 1941                 CE_LOCK (bd);
 1942                 ce_set_dtr (c, 1);
 1943                 CE_UNLOCK (bd);
 1944                 splx (s);
 1945                 return 0;
 1946 
 1947         case TIOCCDTR:          /* Clear DTR */
 1948                 s = splimp ();
 1949                 CE_LOCK (bd);
 1950                 ce_set_dtr (c, 0);
 1951                 CE_UNLOCK (bd);
 1952                 splx (s);
 1953                 return 0;
 1954 
 1955         case TIOCMSET:          /* Set DTR/RTS */
 1956                 s = splimp ();
 1957                 CE_LOCK (bd);
 1958                 ce_set_dtr (c, (*(int*)data & TIOCM_DTR) ? 1 : 0);
 1959                 ce_set_rts (c, (*(int*)data & TIOCM_RTS) ? 1 : 0);
 1960                 CE_UNLOCK (bd);
 1961                 splx (s);
 1962                 return 0;
 1963 
 1964         case TIOCMBIS:          /* Add DTR/RTS */
 1965                 s = splimp ();
 1966                 CE_LOCK (bd);
 1967                 if (*(int*)data & TIOCM_DTR) ce_set_dtr (c, 1);
 1968                 if (*(int*)data & TIOCM_RTS) ce_set_rts (c, 1);
 1969                 CE_UNLOCK (bd);
 1970                 splx (s);
 1971                 return 0;
 1972 
 1973         case TIOCMBIC:          /* Clear DTR/RTS */
 1974                 s = splimp ();
 1975                 CE_LOCK (bd);
 1976                 if (*(int*)data & TIOCM_DTR) ce_set_dtr (c, 0);
 1977                 if (*(int*)data & TIOCM_RTS) ce_set_rts (c, 0);
 1978                 CE_UNLOCK (bd);
 1979                 splx (s);
 1980                 return 0;
 1981 
 1982         case TIOCMGET:          /* Get modem status */
 1983                 *(int*)data = ce_modem_status (c);
 1984                 return 0;
 1985         }
 1986         return ENOTTY;
 1987 }
 1988 
 1989 #ifdef NETGRAPH
 1990 #if __FreeBSD_version >= 500000
 1991 static int ng_ce_constructor (node_p node)
 1992 {
 1993         drv_t *d = NG_NODE_PRIVATE (node);
 1994 #else
 1995 static int ng_ce_constructor (node_p *node)
 1996 {
 1997         drv_t *d = (*node)->private;
 1998 #endif
 1999         CE_DEBUG (d, ("Constructor\n"));
 2000         return EINVAL;
 2001 }
 2002 
 2003 static int ng_ce_newhook (node_p node, hook_p hook, const char *name)
 2004 {
 2005         int s;
 2006 #if __FreeBSD_version >= 500000
 2007         drv_t *d = NG_NODE_PRIVATE (node);
 2008 #else
 2009         drv_t *d = node->private;
 2010 #endif
 2011         bdrv_t *bd = d->board->sys;
 2012 
 2013         CE_DEBUG (d, ("Newhook\n"));
 2014         /* Attach debug hook */
 2015         if (strcmp (name, NG_CE_HOOK_DEBUG) == 0) {
 2016 #if __FreeBSD_version >= 500000
 2017                 NG_HOOK_SET_PRIVATE (hook, NULL);
 2018 #else
 2019                 hook->private = 0;
 2020 #endif
 2021                 d->debug_hook = hook;
 2022                 return 0;
 2023         }
 2024 
 2025         /* Check for raw hook */
 2026         if (strcmp (name, NG_CE_HOOK_RAW) != 0)
 2027                 return EINVAL;
 2028 
 2029 #if __FreeBSD_version >= 500000
 2030         NG_HOOK_SET_PRIVATE (hook, d);
 2031 #else
 2032         hook->private = d;
 2033 #endif
 2034         d->hook = hook;
 2035         s = splimp ();
 2036         CE_LOCK (bd);
 2037         ce_up (d);
 2038         CE_UNLOCK (bd);
 2039         splx (s);
 2040         return 0;
 2041 }
 2042 
 2043 static char *format_timeslots (u_long s)
 2044 {
 2045         static char buf [100];
 2046         char *p = buf;
 2047         int i;
 2048 
 2049         for (i=1; i<32; ++i)
 2050                 if ((s >> i) & 1) {
 2051                         int prev = (i > 1)  & (s >> (i-1));
 2052                         int next = (i < 31) & (s >> (i+1));
 2053 
 2054                         if (prev) {
 2055                                 if (next)
 2056                                         continue;
 2057                                 *p++ = '-';
 2058                         } else if (p > buf)
 2059                                 *p++ = ',';
 2060 
 2061                         if (i >= 10)
 2062                                 *p++ = '' + i / 10;
 2063                         *p++ = '' + i % 10;
 2064                 }
 2065         *p = 0;
 2066         return buf;
 2067 }
 2068 
 2069 static int print_modems (char *s, ce_chan_t *c, int need_header)
 2070 {
 2071         int status = ce_modem_status (c);
 2072         int length = 0;
 2073 
 2074         if (need_header)
 2075                 length += sprintf (s + length, "  LE   DTR  DSR  RTS  CTS  CD\n");
 2076         length += sprintf (s + length, "%4s %4s %4s %4s %4s %4s\n",
 2077                 status & TIOCM_LE  ? "On" : "-",
 2078                 status & TIOCM_DTR ? "On" : "-",
 2079                 status & TIOCM_DSR ? "On" : "-",
 2080                 status & TIOCM_RTS ? "On" : "-",
 2081                 status & TIOCM_CTS ? "On" : "-",
 2082                 status & TIOCM_CD  ? "On" : "-");
 2083         return length;
 2084 }
 2085 
 2086 static int print_stats (char *s, ce_chan_t *c, int need_header)
 2087 {
 2088         int length = 0;
 2089 
 2090         if (need_header)
 2091                 length += sprintf (s + length, "  Rintr   Tintr   Mintr   Ibytes   Ipkts   Ierrs   Obytes   Opkts   Oerrs\n");
 2092         length += sprintf (s + length, "%7ld %7ld %7ld %8lu %7ld %7ld %8lu %7ld %7ld\n",
 2093                 c->rintr, c->tintr, 0l, (unsigned long) c->ibytes,
 2094                 c->ipkts, c->overrun + c->frame + c->crc,
 2095                 (unsigned long) c->obytes, c->opkts, c->underrun);
 2096         return length;
 2097 }
 2098 
 2099 static char *format_e1_status (u_char status)
 2100 {
 2101         static char buf [80];
 2102 
 2103         if (status & E1_NOALARM)
 2104                 return "Ok";
 2105         buf[0] = 0;
 2106         if (status & E1_LOS)     strcat (buf, ",LOS");
 2107         if (status & E1_AIS)     strcat (buf, ",AIS");
 2108         if (status & E1_LOF)     strcat (buf, ",LOF");
 2109         if (status & E1_LOMF)    strcat (buf, ",LOMF");
 2110         if (status & E1_FARLOF)  strcat (buf, ",FARLOF");
 2111         if (status & E1_AIS16)   strcat (buf, ",AIS16");
 2112         if (status & E1_FARLOMF) strcat (buf, ",FARLOMF");
 2113         if (status & E1_TSTREQ)  strcat (buf, ",TSTREQ");
 2114         if (status & E1_TSTERR)  strcat (buf, ",TSTERR");
 2115         if (buf[0] == ',')
 2116                 return buf+1;
 2117         return "Unknown";
 2118 }
 2119 
 2120 static int print_frac (char *s, int leftalign, u_long numerator, u_long divider)
 2121 {
 2122         int n, length = 0;
 2123 
 2124         if (numerator < 1 || divider < 1) {
 2125                 length += sprintf (s+length, leftalign ? "/-   " : "    -");
 2126                 return length;
 2127         }
 2128         n = (int) (0.5 + 1000.0 * numerator / divider);
 2129         if (n < 1000) {
 2130                 length += sprintf (s+length, leftalign ? "/.%-3d" : " .%03d", n);
 2131                 return length;
 2132         }
 2133         *(s + length) = leftalign ? '/' : ' ';
 2134         length ++;
 2135 
 2136         if      (n >= 1000000) n = (n+500) / 1000 * 1000;
 2137         else if (n >= 100000)  n = (n+50)  / 100 * 100;
 2138         else if (n >= 10000)   n = (n+5)   / 10 * 10;
 2139 
 2140         switch (n) {
 2141         case 1000:    length += printf (s+length, ".999"); return length;
 2142         case 10000:   n = 9990;   break;
 2143         case 100000:  n = 99900;  break;
 2144         case 1000000: n = 999000; break;
 2145         }
 2146         if (n < 10000)        length += sprintf (s+length, "%d.%d", n/1000, n/10%100);
 2147         else if (n < 100000)  length += sprintf (s+length, "%d.%d", n/1000, n/100%10);
 2148         else if (n < 1000000) length += sprintf (s+length, "%d.", n/1000);
 2149         else                  length += sprintf (s+length, "%d", n/1000);
 2150 
 2151         return length;
 2152 }
 2153 
 2154 static int print_e1_stats (char *s, ce_chan_t *c)
 2155 {
 2156         struct e1_counters total;
 2157         u_long totsec;
 2158         int length = 0;
 2159 
 2160         totsec          = c->totsec + c->cursec;
 2161         total.bpv       = c->total.bpv   + c->currnt.bpv;
 2162         total.fse       = c->total.fse   + c->currnt.fse;
 2163         total.crce      = c->total.crce  + c->currnt.crce;
 2164         total.rcrce     = c->total.rcrce + c->currnt.rcrce;
 2165         total.uas       = c->total.uas   + c->currnt.uas;
 2166         total.les       = c->total.les   + c->currnt.les;
 2167         total.es        = c->total.es    + c->currnt.es;
 2168         total.bes       = c->total.bes   + c->currnt.bes;
 2169         total.ses       = c->total.ses   + c->currnt.ses;
 2170         total.oofs      = c->total.oofs  + c->currnt.oofs;
 2171         total.css       = c->total.css   + c->currnt.css;
 2172         total.dm        = c->total.dm    + c->currnt.dm;
 2173 
 2174         length += sprintf (s + length, " Unav/Degr  Bpv/Fsyn  CRC/RCRC  Err/Lerr  Sev/Bur   Oof/Slp  Status\n");
 2175 
 2176         /* Unavailable seconds, degraded minutes */
 2177         length += print_frac (s + length, 0, c->currnt.uas, c->cursec);
 2178         length += print_frac (s + length, 1, 60 * c->currnt.dm, c->cursec);
 2179 
 2180         /* Bipolar violations, frame sync errors */
 2181         length += print_frac (s + length, 0, c->currnt.bpv, c->cursec);
 2182         length += print_frac (s + length, 1, c->currnt.fse, c->cursec);
 2183 
 2184         /* CRC errors, remote CRC errors (E-bit) */
 2185         length += print_frac (s + length, 0, c->currnt.crce, c->cursec);
 2186         length += print_frac (s + length, 1, c->currnt.rcrce, c->cursec);
 2187 
 2188         /* Errored seconds, line errored seconds */
 2189         length += print_frac (s + length, 0, c->currnt.es, c->cursec);
 2190         length += print_frac (s + length, 1, c->currnt.les, c->cursec);
 2191 
 2192         /* Severely errored seconds, burst errored seconds */
 2193         length += print_frac (s + length, 0, c->currnt.ses, c->cursec);
 2194         length += print_frac (s + length, 1, c->currnt.bes, c->cursec);
 2195 
 2196         /* Out of frame seconds, controlled slip seconds */
 2197         length += print_frac (s + length, 0, c->currnt.oofs, c->cursec);
 2198         length += print_frac (s + length, 1, c->currnt.css, c->cursec);
 2199 
 2200         length += sprintf (s + length, " %s\n", format_e1_status (c->status));
 2201 
 2202         /* Print total statistics. */
 2203         length += print_frac (s + length, 0, total.uas, totsec);
 2204         length += print_frac (s + length, 1, 60 * total.dm, totsec);
 2205 
 2206         length += print_frac (s + length, 0, total.bpv, totsec);
 2207         length += print_frac (s + length, 1, total.fse, totsec);
 2208 
 2209         length += print_frac (s + length, 0, total.crce, totsec);
 2210         length += print_frac (s + length, 1, total.rcrce, totsec);
 2211 
 2212         length += print_frac (s + length, 0, total.es, totsec);
 2213         length += print_frac (s + length, 1, total.les, totsec);
 2214 
 2215         length += print_frac (s + length, 0, total.ses, totsec);
 2216         length += print_frac (s + length, 1, total.bes, totsec);
 2217 
 2218         length += print_frac (s + length, 0, total.oofs, totsec);
 2219         length += print_frac (s + length, 1, total.css, totsec);
 2220 
 2221         length += sprintf (s + length, " -- Total\n");
 2222         return length;
 2223 }
 2224 
 2225 static int print_chan (char *s, ce_chan_t *c)
 2226 {
 2227         drv_t *d = c->sys;
 2228         int length = 0;
 2229 
 2230         length += sprintf (s + length, "ce%d", c->board->num * NCHAN + c->num);
 2231         if (d->chan->debug)
 2232                 length += sprintf (s + length, " debug=%d", d->chan->debug);
 2233 
 2234         if (c->board->mux) {
 2235                 length += sprintf (s + length, " cfg=C");
 2236         } else {
 2237                 length += sprintf (s + length, " cfg=A");
 2238         }
 2239 
 2240         if (c->baud)
 2241                 length += sprintf (s + length, " %ld", c->baud);
 2242         else
 2243                 length += sprintf (s + length, " extclock");
 2244 
 2245         if (c->type == T_E1)
 2246                 switch (c->gsyn) {
 2247                 case GSYN_INT   : length += sprintf (s + length, " syn=int");     break;
 2248                 case GSYN_RCV   : length += sprintf (s + length, " syn=rcv");     break;
 2249                 case GSYN_RCV0  : length += sprintf (s + length, " syn=rcv0");    break;
 2250                 case GSYN_RCV1  : length += sprintf (s + length, " syn=rcv1");    break;
 2251                 }
 2252         if (c->type == T_E1)
 2253                 length += sprintf (s + length, " higain=%s", c->higain ? "on" : "off");
 2254 
 2255         length += sprintf (s + length, " loop=%s", c->lloop ? "on" : "off");
 2256 
 2257         if (c->type == T_E1)
 2258                 length += sprintf (s + length, " ts=%s", format_timeslots (c->ts));
 2259         length += sprintf (s + length, "\n");
 2260         return length;
 2261 }
 2262 
 2263 #if __FreeBSD_version >= 500000
 2264 static int ng_ce_rcvmsg (node_p node, item_p item, hook_p lasthook)
 2265 {
 2266         drv_t *d = NG_NODE_PRIVATE (node);
 2267         struct ng_mesg *msg;
 2268 #else
 2269 static int ng_ce_rcvmsg (node_p node, struct ng_mesg *msg,
 2270         const char *retaddr, struct ng_mesg **rptr)
 2271 {
 2272         drv_t *d = node->private;
 2273 #endif
 2274         struct ng_mesg *resp = NULL;
 2275         int error = 0;
 2276 
 2277         CE_DEBUG (d, ("Rcvmsg\n"));
 2278 #if __FreeBSD_version >= 500000
 2279         NGI_GET_MSG (item, msg);
 2280 #endif
 2281         switch (msg->header.typecookie) {
 2282         default:
 2283                 error = EINVAL;
 2284                 break;
 2285 
 2286         case NGM_CE_COOKIE:
 2287                 printf ("Not implemented yet\n");
 2288                 error = EINVAL;
 2289                 break;
 2290 
 2291         case NGM_GENERIC_COOKIE:
 2292                 switch (msg->header.cmd) {
 2293                 default:
 2294                         error = EINVAL;
 2295                         break;
 2296 
 2297                 case NGM_TEXT_STATUS: {
 2298                         char *s;
 2299                         int l = 0;
 2300                         int dl = sizeof (struct ng_mesg) + 730;
 2301 
 2302 #if __FreeBSD_version >= 500000 
 2303                         NG_MKRESPONSE (resp, msg, dl, M_NOWAIT);
 2304                         if (! resp) {
 2305                                 error = ENOMEM;
 2306                                 break;
 2307                         }
 2308 #else
 2309                         resp = malloc (M_NETGRAPH, M_NOWAIT);
 2310                         if (! resp) {
 2311                                 error = ENOMEM;
 2312                                 break;
 2313                         }
 2314                         bzero (resp, dl);
 2315 #endif
 2316                         s = (resp)->data;
 2317                         if (d) {
 2318                         l += print_chan (s + l, d->chan);
 2319                         l += print_stats (s + l, d->chan, 1);
 2320                         l += print_modems (s + l, d->chan, 1);
 2321                         l += print_e1_stats (s + l, d->chan);
 2322                         } else
 2323                                 l += sprintf (s + l, "Error: node not connect to channel");
 2324 #if __FreeBSD_version < 500000
 2325                         (resp)->header.version = NG_VERSION;
 2326                         (resp)->header.arglen = strlen (s) + 1;
 2327                         (resp)->header.token = msg->header.token;
 2328                         (resp)->header.typecookie = NGM_CE_COOKIE;
 2329                         (resp)->header.cmd = msg->header.cmd;
 2330 #endif
 2331                         strncpy ((resp)->header.cmdstr, "status", NG_CMDSTRSIZ);
 2332                         }
 2333                         break;
 2334                 }
 2335                 break;
 2336         }
 2337 #if __FreeBSD_version >= 500000
 2338         NG_RESPOND_MSG (error, node, item, resp);
 2339         NG_FREE_MSG (msg);
 2340 #else
 2341         *rptr = resp;
 2342         free (msg, M_NETGRAPH);
 2343 #endif
 2344         return error;
 2345 }
 2346 
 2347 #if __FreeBSD_version >= 500000
 2348 static int ng_ce_rcvdata (hook_p hook, item_p item)
 2349 {
 2350         drv_t *d = NG_NODE_PRIVATE (NG_HOOK_NODE(hook));
 2351         struct mbuf *m;
 2352 #if __FreeBSD_version < 502120
 2353         meta_p meta;
 2354 #else
 2355         struct ng_tag_prio *ptag;
 2356 #endif
 2357 #else
 2358 static int ng_ce_rcvdata (hook_p hook, struct mbuf *m, meta_p meta)
 2359 {
 2360         drv_t *d = hook->node->private;
 2361 #endif
 2362         bdrv_t *bd = d->board->sys;
 2363         struct ifqueue *q;
 2364         int s;
 2365 
 2366         CE_DEBUG2 (d, ("Rcvdata\n"));
 2367 #if __FreeBSD_version >= 500000
 2368         NGI_GET_M (item, m);
 2369 #if __FreeBSD_version < 502120
 2370         NGI_GET_META (item, meta);
 2371 #endif
 2372         NG_FREE_ITEM (item);
 2373         if (! NG_HOOK_PRIVATE (hook) || ! d) {
 2374                 NG_FREE_M (m);
 2375 #if __FreeBSD_version < 502120
 2376                 NG_FREE_META (meta);
 2377 #endif
 2378 #else
 2379         if (! hook->private || ! d) {
 2380                 NG_FREE_DATA (m,meta);
 2381 #endif
 2382                 return ENETDOWN;
 2383         }
 2384 
 2385 #if __FreeBSD_version >= 502120
 2386         /* Check for high priority data */
 2387         if ((ptag = (struct ng_tag_prio *)m_tag_locate(m, NGM_GENERIC_COOKIE,
 2388             NG_TAG_PRIO, NULL)) != NULL && (ptag->priority > NG_PRIO_CUTOFF) )
 2389                 q = &d->hi_queue;
 2390         else
 2391                 q = &d->queue;
 2392 #else
 2393         q = (meta && meta->priority > 0) ? &d->hi_queue : &d->queue;
 2394 #endif
 2395 
 2396         s = splimp ();
 2397         CE_LOCK (bd);
 2398 #if __FreeBSD_version >= 500000
 2399         IF_LOCK (q);
 2400         if (_IF_QFULL (q)) {
 2401                 IF_UNLOCK (q);
 2402                 CE_UNLOCK (bd);
 2403                 splx (s);
 2404                 NG_FREE_M (m);
 2405 #if __FreeBSD_version < 502120
 2406                 NG_FREE_META (meta);
 2407 #endif
 2408                 return ENOBUFS;
 2409         }
 2410         _IF_ENQUEUE (q, m);
 2411         IF_UNLOCK (q);
 2412 #else
 2413         if (IF_QFULL (q)) {
 2414                 IF_DROP (q);
 2415                 CE_UNLOCK (bd);
 2416                 splx (s);
 2417                 NG_FREE_DATA (m, meta);
 2418                 return ENOBUFS;
 2419         }
 2420         IF_ENQUEUE (q, m);
 2421 #endif
 2422         ce_start (d);
 2423         CE_UNLOCK (bd);
 2424         splx (s);
 2425         return 0;
 2426 }
 2427 
 2428 static int ng_ce_rmnode (node_p node)
 2429 {
 2430 #if __FreeBSD_version >= 500000
 2431         drv_t *d = NG_NODE_PRIVATE (node);
 2432 
 2433         CE_DEBUG (d, ("Rmnode\n"));
 2434         if (d && d->running) {
 2435                 bdrv_t *bd = d->board->sys;
 2436                 int s = splimp ();
 2437                 CE_LOCK (bd);
 2438                 ce_down (d);
 2439                 CE_UNLOCK (bd);
 2440                 splx (s);
 2441         }
 2442 #ifdef  KLD_MODULE
 2443 #if __FreeBSD_version >= 502120
 2444         if (node->nd_flags & NGF_REALLY_DIE) {
 2445 #else
 2446         if (node->nd_flags & NG_REALLY_DIE) {
 2447 #endif
 2448                 NG_NODE_SET_PRIVATE (node, NULL);
 2449                 NG_NODE_UNREF (node);
 2450         }
 2451 #if __FreeBSD_version >= 502120
 2452         NG_NODE_REVIVE(node);           /* Persistent node */
 2453 #else
 2454         node->nd_flags &= ~NG_INVALID;
 2455 #endif
 2456 #endif
 2457 #else /* __FreeBSD_version < 500000 */
 2458         drv_t *d = node->private;
 2459 
 2460         if (d && d->running) {
 2461                 bdrv_t *bd = d->board->sys;
 2462                 int s = splimp ();
 2463                 CE_LOCK (bd);
 2464                 ce_down (d);
 2465                 CE_UNLOCK (bd);
 2466                 splx (s);
 2467         }
 2468 
 2469         node->flags |= NG_INVALID;
 2470         ng_cutlinks (node);
 2471 #ifdef  KLD_MODULE
 2472         ng_unname (node);
 2473         ng_unref (node);
 2474 #endif
 2475 #endif
 2476         return 0;
 2477 }
 2478 
 2479 static int ng_ce_connect (hook_p hook)
 2480 {
 2481 #if __FreeBSD_version >= 500000
 2482         drv_t *d = NG_NODE_PRIVATE (NG_HOOK_NODE (hook));
 2483 #else
 2484         drv_t *d = hook->node->private;
 2485 #endif
 2486 
 2487         if (d) {
 2488                 CE_DEBUG (d, ("Connect\n"));
 2489                 callout_reset (&d->timeout_handle, hz, ce_watchdog_timer, d);
 2490         }
 2491         
 2492         return 0;
 2493 }
 2494 
 2495 static int ng_ce_disconnect (hook_p hook)
 2496 {
 2497 #if __FreeBSD_version >= 500000
 2498         drv_t *d = NG_NODE_PRIVATE (NG_HOOK_NODE (hook));
 2499 #else
 2500         drv_t *d = hook->node->private;
 2501 #endif
 2502 
 2503         if (d) {
 2504                 CE_DEBUG (d, ("Disconnect\n"));
 2505 #if __FreeBSD_version >= 500000
 2506                 if (NG_HOOK_PRIVATE (hook))
 2507 #else
 2508                 if (hook->private)
 2509 #endif
 2510                 {
 2511                         bdrv_t *bd = d->board->sys;
 2512                         int s = splimp ();
 2513                         CE_LOCK (bd);
 2514                         ce_down (d);
 2515                         CE_UNLOCK (bd);
 2516                         splx (s);
 2517                 }
 2518                 /* If we were wait it than it reasserted now, just stop it. */
 2519                 if (!callout_drain (&d->timeout_handle))
 2520                         callout_stop (&d->timeout_handle);
 2521         }
 2522         return 0;
 2523 }
 2524 #endif
 2525 
 2526 static int ce_modevent (module_t mod, int type, void *unused)
 2527 {
 2528 #if __FreeBSD_version < 500000
 2529         dev_t dev;
 2530         struct cdevsw *cdsw;
 2531 #endif
 2532         static int load_count = 0;
 2533 
 2534 #if __FreeBSD_version < 500000
 2535         dev = makedev (CDEV_MAJOR, 0);
 2536 #endif
 2537 
 2538         switch (type) {
 2539         case MOD_LOAD:
 2540 #if __FreeBSD_version < 500000
 2541                 if (dev != NODEV &&
 2542                     (cdsw = devsw (dev)) &&
 2543                     cdsw->d_maj == CDEV_MAJOR) {
 2544                         printf ("Tau32-PCI driver is already in system\n");
 2545                         return (ENXIO);
 2546                 }
 2547 #endif
 2548 #if __FreeBSD_version >= 500000 && defined NETGRAPH
 2549                 if (ng_newtype (&typestruct))
 2550                         printf ("Failed to register ng_ce\n");
 2551 #endif
 2552                 ++load_count;
 2553 #if __FreeBSD_version <= 500000
 2554                 cdevsw_add (&ce_cdevsw);
 2555 #endif
 2556 #if __FreeBSD_version >= 500000
 2557                 callout_init (&timeout_handle, 1);
 2558 #else
 2559                 callout_init (&timeout_handle);
 2560 #endif
 2561                 callout_reset (&timeout_handle, hz*5, ce_timeout, 0);
 2562                 break;
 2563         case MOD_UNLOAD:
 2564                 if (load_count == 1) {
 2565                         printf ("Removing device entry for Tau32-PCI\n");
 2566 #if __FreeBSD_version <= 500000
 2567                         cdevsw_remove (&ce_cdevsw);
 2568 #endif
 2569 #if __FreeBSD_version >= 500000 && defined NETGRAPH
 2570                         ng_rmtype (&typestruct);
 2571 #endif                  
 2572                 }
 2573                 /* If we were wait it than it reasserted now, just stop it.
 2574                  * Actually we shouldn't get this condition. But code could be
 2575                  * changed in the future, so just be a litle paranoid.
 2576                  */
 2577                 if (!callout_drain (&timeout_handle))
 2578                         callout_stop (&timeout_handle);
 2579                 --load_count;
 2580                 break;
 2581         case MOD_SHUTDOWN:
 2582                 break;
 2583         }
 2584         return 0;
 2585 }
 2586 
 2587 #ifdef NETGRAPH
 2588 #if __FreeBSD_version >= 502100
 2589 static struct ng_type typestruct = {
 2590         .version        = NG_ABI_VERSION,
 2591         .name           = NG_CE_NODE_TYPE,
 2592         .constructor    = ng_ce_constructor,
 2593         .rcvmsg         = ng_ce_rcvmsg,
 2594         .shutdown       = ng_ce_rmnode,
 2595         .newhook        = ng_ce_newhook,
 2596         .connect        = ng_ce_connect,
 2597         .rcvdata        = ng_ce_rcvdata,
 2598         .disconnect     = ng_ce_disconnect,
 2599 };
 2600 #else /* __FreeBSD_version < 502100 */
 2601 static struct ng_type typestruct = {
 2602 #if __FreeBSD_version >= 500000
 2603         NG_ABI_VERSION,
 2604 #else
 2605         NG_VERSION,
 2606 #endif
 2607         NG_CE_NODE_TYPE,
 2608         ce_modevent,
 2609         ng_ce_constructor,
 2610         ng_ce_rcvmsg,
 2611         ng_ce_rmnode,
 2612         ng_ce_newhook,
 2613         NULL,
 2614         ng_ce_connect,
 2615         ng_ce_rcvdata,
 2616 #if __FreeBSD_version < 500000
 2617         NULL,
 2618 #endif
 2619         ng_ce_disconnect,
 2620         NULL
 2621 };
 2622 #endif /* __FreeBSD_version < 502100 */
 2623 
 2624 #endif /*NETGRAPH*/
 2625 
 2626 #if __FreeBSD_version >= 500000
 2627 #ifdef NETGRAPH
 2628 MODULE_DEPEND (ng_ce, netgraph, NG_ABI_VERSION, NG_ABI_VERSION, NG_ABI_VERSION);
 2629 #else
 2630 MODULE_DEPEND (ce, sppp, 1, 1, 1);
 2631 #endif
 2632 #ifdef KLD_MODULE
 2633 DRIVER_MODULE (cemod, pci, ce_driver, ce_devclass, ce_modevent, NULL);
 2634 #else
 2635 DRIVER_MODULE (ce, pci, ce_driver, ce_devclass, ce_modevent, NULL);
 2636 #endif
 2637 #else /* if __FreeBSD_version < 500000*/
 2638 #ifdef NETGRAPH
 2639 DRIVER_MODULE (ce, pci, ce_driver, ce_devclass, ng_mod_event, &typestruct);
 2640 #else
 2641 DRIVER_MODULE (ce, pci, ce_driver, ce_devclass, ce_modevent, NULL);
 2642 #endif
 2643 #endif /* __FreeBSD_version < 500000 */
 2644 #endif /* NPCI */

Cache object: dd1c867dd0777d98f0e4063c22b78c0f


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]


This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.