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

Cache object: 4c3b12a0d6ff6bde36f7a80b2a53e251


[ 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.