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/cx/if_cx.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-Sigma adapter driver for FreeBSD.
    3  * Supports PPP/HDLC and Cisco/HDLC protocol in synchronous mode,
    4  * and asyncronous channels with full modem control.
    5  * Keepalive protocol implemented in both Cisco and PPP modes.
    6  *
    7  * Copyright (C) 1994-2002 Cronyx Engineering.
    8  * Author: Serge Vakulenko, <vak@cronyx.ru>
    9  *
   10  * Copyright (C) 1999-2004 Cronyx Engineering.
   11  * Rewritten on DDK, ported to NETGRAPH, rewritten for FreeBSD 3.x-5.x by
   12  * Kurakin Roman, <rik@cronyx.ru>
   13  *
   14  * This software is distributed with NO WARRANTIES, not even the implied
   15  * warranties for MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
   16  *
   17  * Authors grant any other persons or organisations a permission to use,
   18  * modify and redistribute this software in source and binary forms,
   19  * as long as this message is kept with the software, all derivative
   20  * works or modified versions.
   21  *
   22  * Cronyx Id: if_cx.c,v 1.1.2.34 2004/06/23 17:09:13 rik Exp $
   23  */
   24 
   25 #include <sys/cdefs.h>
   26 __FBSDID("$FreeBSD$");
   27 
   28 #include <sys/param.h>
   29 
   30 #include <sys/systm.h>
   31 #include <sys/kernel.h>
   32 #include <sys/module.h>
   33 #include <sys/proc.h>
   34 #include <sys/mbuf.h>
   35 #include <sys/sockio.h>
   36 #include <sys/malloc.h>
   37 #include <sys/socket.h>
   38 #include <sys/sysctl.h>
   39 #include <sys/conf.h>
   40 #include <sys/errno.h>
   41 #include <sys/serial.h>
   42 #include <sys/tty.h>
   43 #include <sys/bus.h>
   44 #include <machine/bus.h>
   45 #include <sys/rman.h>
   46 #include <isa/isavar.h>
   47 #include <sys/fcntl.h>
   48 #include <sys/interrupt.h>
   49 #include <vm/vm.h>
   50 #include <vm/pmap.h>
   51 #include <net/if.h>
   52 #include <machine/cpufunc.h>
   53 #include <machine/cserial.h>
   54 #include <machine/clock.h>
   55 #include <machine/resource.h>
   56 #include <dev/cx/machdep.h>
   57 #include <dev/cx/cxddk.h>
   58 #include <dev/cx/cronyxfw.h>
   59 #include "opt_ng_cronyx.h"
   60 #ifdef NETGRAPH_CRONYX
   61 #   include "opt_netgraph.h"
   62 #   include <netgraph/ng_message.h>
   63 #   include <netgraph/netgraph.h>
   64 #   include <dev/cx/ng_cx.h>
   65 #else
   66 #   include <net/if_types.h>
   67 #   include <net/if_sppp.h>
   68 #   define PP_CISCO IFF_LINK2
   69 #   include <net/bpf.h>
   70 #endif
   71 
   72 #define NCX     1
   73 
   74 /* If we don't have Cronyx's sppp version, we don't have fr support via sppp */
   75 #ifndef PP_FR
   76 #define PP_FR 0
   77 #endif
   78 
   79 #define CX_DEBUG(d,s)   ({if (d->chan->debug) {\
   80                                 printf ("%s: ", d->name); printf s;}})
   81 #define CX_DEBUG2(d,s)  ({if (d->chan->debug>1) {\
   82                                 printf ("%s: ", d->name); printf s;}})
   83 
   84 #define CX_LOCK_NAME    "cxX"
   85 
   86 static  int     cx_mpsafenet = 1;
   87 TUNABLE_INT("debug.cx.mpsafenet", &cx_mpsafenet);
   88 SYSCTL_NODE(_debug, OID_AUTO, cx, CTLFLAG_RD, 0, "Cronyx Sigma Adapters");
   89 SYSCTL_INT(_debug_cx, OID_AUTO, mpsafenet, CTLFLAG_RD, &cx_mpsafenet, 0,
   90         "Enable/disable MPSAFE network support for Cronyx Sigma Adapters");
   91 
   92 #define CX_LOCK(_bd)            do { \
   93                                     if (cx_mpsafenet) \
   94                                         mtx_lock (&(_bd)->cx_mtx); \
   95                                 } while (0)
   96 #define CX_UNLOCK(_bd)          do { \
   97                                     if (cx_mpsafenet) \
   98                                         mtx_unlock (&(_bd)->cx_mtx); \
   99                                 } while (0)
  100 #define CX_LOCK_ASSERT(_bd)     do { \
  101                                     if (cx_mpsafenet) \
  102                                         mtx_assert (&(_bd)->cx_mtx, MA_OWNED); \
  103                                 } while (0)
  104 
  105 typedef struct _async_q {
  106         int beg;
  107         int end;
  108         #define BF_SZ 14400
  109         int buf[BF_SZ+1];
  110 } async_q;
  111 
  112 #define AQ_GSZ(q)       ((BF_SZ + (q)->end - (q)->beg)%BF_SZ)
  113 #define AQ_PUSH(q,c)    {*((q)->buf + (q)->end) = c;\
  114                         (q)->end = ((q)->end + 1)%BF_SZ;}
  115 #define AQ_POP(q,c)     {c = *((q)->buf + (q)->beg);\
  116                         (q)->beg = ((q)->beg + 1)%BF_SZ;}
  117 
  118 static void cx_identify         __P((driver_t *, device_t));
  119 static int cx_probe             __P((device_t));
  120 static int cx_attach            __P((device_t));
  121 static int cx_detach            __P((device_t));
  122 static t_open_t                 cx_topen;
  123 static t_modem_t                cx_tmodem;
  124 static t_close_t                cx_tclose;
  125 
  126 static device_method_t cx_isa_methods [] = {
  127         DEVMETHOD(device_identify,      cx_identify),
  128         DEVMETHOD(device_probe,         cx_probe),
  129         DEVMETHOD(device_attach,        cx_attach),
  130         DEVMETHOD(device_detach,        cx_detach),
  131         {0, 0}
  132 };
  133 
  134 typedef struct _cx_dma_mem_t {
  135         unsigned long   phys;
  136         void            *virt;
  137         size_t          size;
  138         bus_dma_tag_t   dmat;
  139         bus_dmamap_t    mapp;
  140 } cx_dma_mem_t;
  141 
  142 typedef struct _drv_t {
  143         char name [8];
  144         cx_chan_t *chan;
  145         cx_board_t *board;
  146         cx_dma_mem_t dmamem;
  147         struct tty *tty;
  148         struct callout dcd_timeout_handle;
  149         unsigned callout;
  150         unsigned lock;
  151         int open_dev;
  152         int cd;
  153         int running;
  154 #ifdef NETGRAPH
  155         char    nodename [NG_NODELEN+1];
  156         hook_p  hook;
  157         hook_p  debug_hook;
  158         node_p  node;
  159         struct  ifqueue lo_queue;
  160         struct  ifqueue hi_queue;
  161         short   timeout;
  162         struct  callout timeout_handle;
  163 #else
  164         struct  ifqueue queue;
  165         struct  ifnet *ifp;
  166 #endif
  167         struct  cdev *devt;
  168         async_q aqueue;
  169 #define CX_READ 1
  170 #define CX_WRITE 2
  171         int intr_action;
  172         short atimeout;
  173 } drv_t;
  174 
  175 typedef struct _bdrv_t {
  176         cx_board_t      *board;
  177         struct resource *base_res;
  178         struct resource *drq_res;
  179         struct resource *irq_res;
  180         int             base_rid;
  181         int             drq_rid;
  182         int             irq_rid;
  183         void            *intrhand;
  184         drv_t           channel [NCHAN];
  185         struct mtx      cx_mtx;
  186 } bdrv_t;
  187 
  188 static driver_t cx_isa_driver = {
  189         "cx",
  190         cx_isa_methods,
  191         sizeof (bdrv_t),
  192 };
  193 
  194 static devclass_t cx_devclass;
  195 
  196 extern long csigma_fw_len;
  197 extern const char *csigma_fw_version;
  198 extern const char *csigma_fw_date;
  199 extern const char *csigma_fw_copyright;
  200 extern const cr_dat_tst_t csigma_fw_tvec[];
  201 extern const u_char csigma_fw_data[];
  202 static void cx_oproc (struct tty *tp);
  203 static int cx_param (struct tty *tp, struct termios *t);
  204 static void cx_stop (struct tty *tp, int flag);
  205 static void cx_receive (cx_chan_t *c, char *data, int len);
  206 static void cx_transmit (cx_chan_t *c, void *attachment, int len);
  207 static void cx_error (cx_chan_t *c, int data);
  208 static void cx_modem (cx_chan_t *c);
  209 static void cx_up (drv_t *d);
  210 static void cx_start (drv_t *d);
  211 static void cx_softintr (void *);
  212 static void *cx_fast_ih;
  213 static void cx_down (drv_t *d);
  214 static void cx_watchdog (drv_t *d);
  215 static void cx_carrier (void *arg);
  216 
  217 #ifdef NETGRAPH
  218 extern struct ng_type typestruct;
  219 #else
  220 static void cx_ifstart (struct ifnet *ifp);
  221 static void cx_tlf (struct sppp *sp);
  222 static void cx_tls (struct sppp *sp);
  223 static void cx_ifwatchdog (struct ifnet *ifp);
  224 static int cx_sioctl (struct ifnet *ifp, u_long cmd, caddr_t data);
  225 static void cx_initialize (void *softc);
  226 #endif
  227 
  228 static cx_board_t *adapter [NCX];
  229 static drv_t *channel [NCX*NCHAN];
  230 static struct callout led_timo [NCX];
  231 static struct callout timeout_handle;
  232 extern struct cdevsw cx_cdevsw;
  233 
  234 static int MY_SOFT_INTR;
  235 
  236 /*
  237  * Print the mbuf chain, for debug purposes only.
  238  */
  239 static void printmbuf (struct mbuf *m)
  240 {
  241         printf ("mbuf:");
  242         for (; m; m=m->m_next) {
  243                 if (m->m_flags & M_PKTHDR)
  244                         printf (" HDR %d:", m->m_pkthdr.len);
  245                 if (m->m_flags & M_EXT)
  246                         printf (" EXT:");
  247                 printf (" %d", m->m_len);
  248         }
  249         printf ("\n");
  250 }
  251 
  252 /*
  253  * Make an mbuf from data.
  254  */
  255 static struct mbuf *makembuf (void *buf, u_int len)
  256 {
  257         struct mbuf *m, *o, *p;
  258 
  259         MGETHDR (m, M_DONTWAIT, MT_DATA);
  260 
  261         if (! m)
  262                 return 0;
  263 
  264         if (len >= MINCLSIZE)
  265                 MCLGET (m, M_DONTWAIT);
  266 
  267         m->m_pkthdr.len = len;
  268         m->m_len = 0;
  269 
  270         p = m;
  271         while (len) {
  272                 u_int n = M_TRAILINGSPACE (p);
  273                 if (n > len)
  274                         n = len;
  275                 if (! n) {
  276                         /* Allocate new mbuf. */
  277                         o = p;
  278                         MGET (p, M_DONTWAIT, MT_DATA);
  279                         if (! p) {
  280                                 m_freem (m);
  281                                 return 0;
  282                         }
  283                         if (len >= MINCLSIZE)
  284                                 MCLGET (p, M_DONTWAIT);
  285                         p->m_len = 0;
  286                         o->m_next = p;
  287 
  288                         n = M_TRAILINGSPACE (p);
  289                         if (n > len)
  290                                 n = len;
  291                 }
  292                 bcopy (buf, mtod (p, caddr_t) + p->m_len, n);
  293 
  294                 p->m_len += n;
  295                 buf = n + (char*) buf;
  296                 len -= n;
  297         }
  298         return m;
  299 }
  300 
  301 /*
  302  * Recover after lost transmit interrupts.
  303  */
  304 static void cx_timeout (void *arg)
  305 {
  306         drv_t *d;
  307         int s, i, k;
  308 
  309         for (i = 0; i < NCX; i++) {
  310                 if (adapter[i] == NULL)
  311                         continue;
  312                 for (k = 0; k < NCHAN; ++k) {
  313                         d = channel[i * NCHAN + k];
  314                         if (! d)
  315                                 continue;
  316                         s = splhigh ();
  317                         CX_LOCK ((bdrv_t *)d->board->sys);
  318                         if (d->atimeout == 1 && d->tty && d->tty->t_state & TS_BUSY) {
  319                                 d->tty->t_state &= ~TS_BUSY;
  320                                 if (d->tty->t_dev) {
  321                                         d->intr_action |= CX_WRITE;
  322                                         MY_SOFT_INTR = 1;
  323                                         swi_sched (cx_fast_ih, 0);
  324                                 }
  325                                 CX_DEBUG (d, ("cx_timeout\n"));
  326                         }
  327                         if (d->atimeout)
  328                                 d->atimeout--;
  329                         CX_UNLOCK ((bdrv_t *)d->board->sys);
  330                         splx (s);
  331                 }
  332         }
  333         callout_reset (&timeout_handle, hz*5, cx_timeout, 0);
  334 }
  335 
  336 static void cx_led_off (void *arg)
  337 {
  338         cx_board_t *b = arg;
  339         bdrv_t *bd = b->sys;
  340         int s;
  341 
  342         s = splhigh ();
  343         CX_LOCK (bd);
  344         cx_led (b, 0);
  345         CX_UNLOCK (bd);
  346         splx (s);
  347 }
  348 
  349 /*
  350  * Activate interupt handler from DDK.
  351  */
  352 static void cx_intr (void *arg)
  353 {
  354         bdrv_t *bd = arg;
  355         cx_board_t *b = bd->board;
  356 #ifndef NETGRAPH
  357         int i;
  358 #endif
  359         int s = splhigh ();
  360 
  361         CX_LOCK (bd);
  362         /* Turn LED on. */
  363         cx_led (b, 1);
  364 
  365         cx_int_handler (b);
  366 
  367         /* Turn LED off 50 msec later. */
  368         callout_reset (&led_timo[b->num], hz/20, cx_led_off, b);
  369         CX_UNLOCK (bd);
  370         splx (s);
  371 
  372 #ifndef NETGRAPH
  373         /* Pass packets in a lock-free state */
  374         for (i = 0; i < NCHAN && b->chan[i].type; i++) {
  375                 drv_t *d = b->chan[i].sys;
  376                 struct mbuf *m;
  377                 if (!d || !d->running)
  378                         continue;
  379                 while (_IF_QLEN(&d->queue)) {
  380                         IF_DEQUEUE (&d->queue,m);
  381                         if (!m)
  382                                 continue;
  383                         sppp_input (d->ifp, m); 
  384                 }
  385         }
  386 #endif
  387 }
  388 
  389 static int probe_irq (cx_board_t *b, int irq)
  390 {
  391         int mask, busy, cnt;
  392 
  393         /* Clear pending irq, if any. */
  394         cx_probe_irq (b, -irq);
  395         DELAY (100);
  396         for (cnt=0; cnt<5; ++cnt) {
  397                 /* Get the mask of pending irqs, assuming they are busy.
  398                  * Activate the adapter on given irq. */
  399                 busy = cx_probe_irq (b, irq);
  400                 DELAY (100);
  401 
  402                 /* Get the mask of active irqs.
  403                  * Deactivate our irq. */
  404                 mask = cx_probe_irq (b, -irq);
  405                 DELAY (100);
  406                 if ((mask & ~busy) == 1 << irq) {
  407                         cx_probe_irq (b, 0);
  408                         /* printf ("cx%d: irq %d ok, mask=0x%04x, busy=0x%04x\n",
  409                                 b->num, irq, mask, busy); */
  410                         return 1;
  411                 }
  412         }
  413         /* printf ("cx%d: irq %d not functional, mask=0x%04x, busy=0x%04x\n",
  414                 b->num, irq, mask, busy); */
  415         cx_probe_irq (b, 0);
  416         return 0;
  417 }
  418 
  419 static short porttab [] = {
  420         0x200, 0x220, 0x240, 0x260, 0x280, 0x2a0, 0x2c0, 0x2e0,
  421         0x300, 0x320, 0x340, 0x360, 0x380, 0x3a0, 0x3c0, 0x3e0, 0
  422 };
  423 static char dmatab [] = { 7, 6, 5, 0 };
  424 static char irqtab [] = { 5, 10, 11, 7, 3, 15, 12, 0 };
  425 
  426 static int cx_is_free_res (device_t dev, int rid, int type, u_long start,
  427         u_long end, u_long count)
  428 {
  429         struct resource *res;
  430         
  431         if (!(res = bus_alloc_resource (dev, type, &rid, start, end, count,
  432             RF_ALLOCATED)))
  433                 return 0;
  434                 
  435         bus_release_resource (dev, type, rid, res);
  436         
  437         return 1;
  438 }
  439 
  440 static void cx_identify (driver_t *driver, device_t dev)
  441 {
  442         u_long iobase, rescount;
  443         int devcount;
  444         device_t *devices;
  445         device_t child;
  446         devclass_t my_devclass;
  447         int i, k;
  448 
  449         if ((my_devclass = devclass_find ("cx")) == NULL)
  450                 return;
  451 
  452         devclass_get_devices (my_devclass, &devices, &devcount);
  453 
  454         if (devcount == 0) {
  455                 /* We should find all devices by our self. We could alter other
  456                  * devices, but we don't have a choise
  457                  */
  458                 for (i = 0; (iobase = porttab [i]) != 0; i++) {
  459                         if (!cx_is_free_res (dev, 0, SYS_RES_IOPORT,
  460                             iobase, iobase + NPORT, NPORT))
  461                                 continue;
  462                         if (cx_probe_board (iobase, -1, -1) == 0)
  463                                 continue;
  464                         
  465                         devcount++;
  466 
  467                         child = BUS_ADD_CHILD (dev, ISA_ORDER_SPECULATIVE, "cx",
  468                             -1);
  469 
  470                         if (child == NULL)
  471                                 return;
  472 
  473                         device_set_desc_copy (child, "Cronyx Sigma");
  474                         device_set_driver (child, driver);
  475                         bus_set_resource (child, SYS_RES_IOPORT, 0,
  476                             iobase, NPORT);
  477 
  478                         if (devcount >= NCX)
  479                                 break;
  480                 }
  481         } else {
  482                 static short porttab [] = {
  483                         0x200, 0x220, 0x240, 0x260, 0x280, 0x2a0, 0x2c0, 0x2e0,
  484                         0x300, 0x320, 0x340, 0x360, 0x380, 0x3a0, 0x3c0, 0x3e0, 0
  485                 };
  486                 /* Lets check user choise.
  487                  */
  488                 for (k = 0; k < devcount; k++) {
  489                         if (bus_get_resource (devices[k], SYS_RES_IOPORT, 0,
  490                             &iobase, &rescount) != 0)
  491                                 continue;
  492 
  493                         for (i = 0; porttab [i] != 0; i++) {
  494                                 if (porttab [i] != iobase)
  495                                         continue;
  496                                 if (!cx_is_free_res (devices[k], 0, SYS_RES_IOPORT,
  497                                     iobase, iobase + NPORT, NPORT))
  498                                         continue;
  499                                 if (cx_probe_board (iobase, -1, -1) == 0)
  500                                         continue;
  501                                 porttab [i] = -1;
  502                                 device_set_desc_copy (devices[k], "Cronyx Sigma");
  503                                 break;
  504                         }
  505 
  506                         if (porttab [i] == 0) {
  507                                 device_delete_child (
  508                                     device_get_parent (devices[k]),
  509                                     devices [k]);
  510                                 devices[k] = 0;
  511                                 continue;
  512                         }
  513                 }
  514                 for (k = 0; k < devcount; k++) {
  515                         if (devices[k] == 0)
  516                                 continue;
  517                         if (bus_get_resource (devices[k], SYS_RES_IOPORT, 0,
  518                             &iobase, &rescount) == 0)
  519                                 continue;
  520                         for (i = 0; (iobase = porttab [i]) != 0; i++) {
  521                                 if (porttab [i] == -1) {
  522                                         continue;
  523                                 }
  524                                 if (!cx_is_free_res (devices[k], 0, SYS_RES_IOPORT,
  525                                     iobase, iobase + NPORT, NPORT))
  526                                         continue;
  527                                 if (cx_probe_board (iobase, -1, -1) == 0)
  528                                         continue;
  529                         
  530                                 bus_set_resource (devices[k], SYS_RES_IOPORT, 0,
  531                                     iobase, NPORT);
  532                                 porttab [i] = -1;
  533                                 device_set_desc_copy (devices[k], "Cronyx Sigma");
  534                                 break;
  535                         }
  536                         if (porttab [i] == 0) {
  537                                 device_delete_child (
  538                                     device_get_parent (devices[k]),
  539                                     devices [k]);
  540                         }
  541                 }               
  542                 free (devices, M_TEMP);
  543         }
  544         
  545         return;
  546 }
  547 
  548 static int cx_probe (device_t dev)
  549 {
  550         int unit = device_get_unit (dev);
  551         int i;
  552         u_long iobase, rescount;
  553 
  554         if (!device_get_desc (dev) ||
  555             strcmp (device_get_desc (dev), "Cronyx Sigma"))
  556                 return ENXIO;
  557         
  558         if (bus_get_resource (dev, SYS_RES_IOPORT, 0, &iobase, &rescount) != 0) {
  559                 printf ("cx%d: Couldn't get IOPORT\n", unit);
  560                 return ENXIO;
  561         }
  562 
  563         if (!cx_is_free_res (dev, 0, SYS_RES_IOPORT,
  564             iobase, iobase + NPORT, NPORT)) {
  565                 printf ("cx%d: Resource IOPORT isn't free %lx\n", unit, iobase);
  566                 return ENXIO;
  567         }
  568                 
  569         for (i = 0; porttab [i] != 0; i++) {
  570                 if (porttab [i] == iobase) {
  571                         porttab [i] = -1;
  572                         break;
  573                 }
  574         }
  575         
  576         if (porttab [i] == 0) {
  577                 return ENXIO;
  578         }
  579         
  580         if (!cx_probe_board (iobase, -1, -1)) {
  581                 printf ("cx%d: probing for Sigma at %lx faild\n", unit, iobase);
  582                 return ENXIO;
  583         }
  584         
  585         return 0;
  586 }
  587 
  588 static void
  589 cx_bus_dmamap_addr (void *arg, bus_dma_segment_t *segs, int nseg, int error)
  590 {
  591         unsigned long *addr;
  592 
  593         if (error)
  594                 return;
  595 
  596         KASSERT(nseg == 1, ("too many DMA segments, %d should be 1", nseg));
  597         addr = arg;
  598         *addr = segs->ds_addr;
  599 }
  600 
  601 static int
  602 cx_bus_dma_mem_alloc (int bnum, int cnum, cx_dma_mem_t *dmem)
  603 {
  604         int error;
  605 
  606         error = bus_dma_tag_create (NULL, 16, 0, BUS_SPACE_MAXADDR_24BIT,
  607                 BUS_SPACE_MAXADDR, NULL, NULL, dmem->size, 1,
  608                 dmem->size, 0, NULL, NULL, &dmem->dmat);
  609         if (error) {
  610                 if (cnum >= 0)  printf ("cx%d-%d: ", bnum, cnum);
  611                 else            printf ("cx%d: ", bnum);
  612                 printf ("couldn't allocate tag for dma memory\n");
  613                 return 0;
  614         }
  615         error = bus_dmamem_alloc (dmem->dmat, (void **)&dmem->virt,
  616                 BUS_DMA_NOWAIT | BUS_DMA_ZERO, &dmem->mapp);
  617         if (error) {
  618                 if (cnum >= 0)  printf ("cx%d-%d: ", bnum, cnum);
  619                 else            printf ("cx%d: ", bnum);
  620                 printf ("couldn't allocate mem for dma memory\n");
  621                 bus_dma_tag_destroy (dmem->dmat);
  622                 return 0;
  623         }
  624         error = bus_dmamap_load (dmem->dmat, dmem->mapp, dmem->virt,
  625                 dmem->size, cx_bus_dmamap_addr, &dmem->phys, 0);
  626         if (error) {
  627                 if (cnum >= 0)  printf ("cx%d-%d: ", bnum, cnum);
  628                 else            printf ("cx%d: ", bnum);
  629                 printf ("couldn't load mem map for dma memory\n");
  630                 bus_dmamem_free (dmem->dmat, dmem->virt, dmem->mapp);
  631                 bus_dma_tag_destroy (dmem->dmat);
  632                 return 0;
  633         }
  634         return 1;
  635 }
  636 
  637 static void
  638 cx_bus_dma_mem_free (cx_dma_mem_t *dmem)
  639 {
  640         bus_dmamap_unload (dmem->dmat, dmem->mapp);
  641         bus_dmamem_free (dmem->dmat, dmem->virt, dmem->mapp);
  642         bus_dma_tag_destroy (dmem->dmat);
  643 }
  644 
  645 /*
  646  * The adapter is present, initialize the driver structures.
  647  */
  648 static int cx_attach (device_t dev)
  649 {
  650         bdrv_t *bd = device_get_softc (dev);
  651         u_long iobase, drq, irq, rescount;
  652         int unit = device_get_unit (dev);
  653         char *cx_ln = CX_LOCK_NAME;
  654         cx_board_t *b;
  655         cx_chan_t *c;
  656         drv_t *d;
  657         int i;
  658         int s;
  659 
  660         KASSERT ((bd != NULL), ("cx%d: NULL device softc\n", unit));
  661         
  662         bus_get_resource (dev, SYS_RES_IOPORT, 0, &iobase, &rescount);
  663         bd->base_rid = 0;
  664         bd->base_res = bus_alloc_resource (dev, SYS_RES_IOPORT, &bd->base_rid,
  665                 iobase, iobase + NPORT, NPORT, RF_ACTIVE);
  666         if (! bd->base_res) {
  667                 printf ("cx%d: cannot allocate base address\n", unit);
  668                 return ENXIO;
  669         }
  670         
  671         if (bus_get_resource (dev, SYS_RES_DRQ, 0, &drq, &rescount) != 0) {
  672                 for (i = 0; (drq = dmatab [i]) != 0; i++) {
  673                         if (!cx_is_free_res (dev, 0, SYS_RES_DRQ,
  674                             drq, drq + 1, 1))
  675                                 continue;
  676                         bus_set_resource (dev, SYS_RES_DRQ, 0, drq, 1);
  677                         break;
  678                 }
  679                 
  680                 if (dmatab[i] == 0) {   
  681                         bus_release_resource (dev, SYS_RES_IOPORT, bd->base_rid,
  682                                 bd->base_res);
  683                         printf ("cx%d: Couldn't get DRQ\n", unit);
  684                         return ENXIO;
  685                 }
  686         }
  687         
  688         bd->drq_rid = 0;
  689         bd->drq_res = bus_alloc_resource (dev, SYS_RES_DRQ, &bd->drq_rid,
  690                 drq, drq + 1, 1, RF_ACTIVE);
  691         if (! bd->drq_res) {
  692                 printf ("cx%d: cannot allocate drq\n", unit);
  693                 bus_release_resource (dev, SYS_RES_IOPORT, bd->base_rid,
  694                         bd->base_res);
  695                 return ENXIO;
  696         }       
  697         
  698         if (bus_get_resource (dev, SYS_RES_IRQ, 0, &irq, &rescount) != 0) {
  699                 for (i = 0; (irq = irqtab [i]) != 0; i++) {
  700                         if (!cx_is_free_res (dev, 0, SYS_RES_IRQ,
  701                             irq, irq + 1, 1))
  702                                 continue;
  703                         bus_set_resource (dev, SYS_RES_IRQ, 0, irq, 1);
  704                         break;
  705                 }
  706                 
  707                 if (irqtab[i] == 0) {   
  708                         bus_release_resource (dev, SYS_RES_DRQ, bd->drq_rid,
  709                                 bd->drq_res);
  710                         bus_release_resource (dev, SYS_RES_IOPORT, bd->base_rid,
  711                                 bd->base_res);
  712                         printf ("cx%d: Couldn't get IRQ\n", unit);
  713                         return ENXIO;
  714                 }
  715         }
  716         
  717         bd->irq_rid = 0;
  718         bd->irq_res = bus_alloc_resource (dev, SYS_RES_IRQ, &bd->irq_rid,
  719                 irq, irq + 1, 1, RF_ACTIVE);
  720         if (! bd->irq_res) {
  721                 printf ("cx%d: Couldn't allocate irq\n", unit);
  722                 bus_release_resource (dev, SYS_RES_DRQ, bd->drq_rid,
  723                         bd->drq_res);
  724                 bus_release_resource (dev, SYS_RES_IOPORT, bd->base_rid,
  725                         bd->base_res);
  726                 return ENXIO;
  727         }
  728         
  729         b = malloc (sizeof (cx_board_t), M_DEVBUF, M_WAITOK);
  730         if (!b) {
  731                 printf ("cx:%d: Couldn't allocate memory\n", unit);
  732                 return (ENXIO);
  733         }
  734         adapter[unit] = b;
  735         bzero (b, sizeof(cx_board_t));
  736         
  737         if (! cx_open_board (b, unit, iobase, irq, drq)) {
  738                 printf ("cx%d: error loading firmware\n", unit);
  739                 free (b, M_DEVBUF);
  740                 bus_release_resource (dev, SYS_RES_IRQ, bd->irq_rid,
  741                         bd->irq_res);
  742                 bus_release_resource (dev, SYS_RES_DRQ, bd->drq_rid,
  743                         bd->drq_res);
  744                 bus_release_resource (dev, SYS_RES_IOPORT, bd->base_rid,
  745                         bd->base_res);
  746                 return ENXIO;
  747         }
  748 
  749         bd->board = b;
  750         
  751         cx_ln[2] = '' + unit;
  752         mtx_init (&bd->cx_mtx, cx_ln, MTX_NETWORK_LOCK, MTX_DEF|MTX_RECURSE);
  753         if (! probe_irq (b, irq)) {
  754                 printf ("cx%d: irq %ld not functional\n", unit, irq);
  755                 bd->board = 0;
  756                 adapter [unit] = 0;
  757                 mtx_destroy (&bd->cx_mtx);
  758                 free (b, M_DEVBUF);
  759                 bus_release_resource (dev, SYS_RES_IRQ, bd->irq_rid,
  760                         bd->irq_res);
  761                 bus_release_resource (dev, SYS_RES_DRQ, bd->drq_rid,
  762                         bd->drq_res);
  763                 bus_release_resource (dev, SYS_RES_IOPORT, bd->base_rid,
  764                         bd->base_res);
  765                 return ENXIO;
  766         }
  767         b->sys = bd;
  768         callout_init (&led_timo[b->num], cx_mpsafenet ? CALLOUT_MPSAFE : 0);
  769         s = splhigh ();
  770         if (bus_setup_intr (dev, bd->irq_res,
  771                            INTR_TYPE_NET|(cx_mpsafenet?INTR_MPSAFE:0),
  772                            cx_intr, bd, &bd->intrhand)) {
  773                 printf ("cx%d: Can't setup irq %ld\n", unit, irq);
  774                 bd->board = 0;
  775                 b->sys = 0;
  776                 adapter [unit] = 0;
  777                 mtx_destroy (&bd->cx_mtx);
  778                 free (b, M_DEVBUF);
  779                 bus_release_resource (dev, SYS_RES_IRQ, bd->irq_rid,
  780                         bd->irq_res);
  781                 bus_release_resource (dev, SYS_RES_DRQ, bd->drq_rid,
  782                         bd->drq_res);
  783                 bus_release_resource (dev, SYS_RES_IOPORT, bd->base_rid,
  784                         bd->base_res);
  785                 splx (s);
  786                 return ENXIO;           
  787         }
  788         
  789         CX_LOCK (bd);
  790         cx_init (b, b->num, b->port, irq, drq);
  791         cx_setup_board (b, 0, 0, 0);
  792         CX_UNLOCK (bd);
  793 
  794         printf ("cx%d: <Cronyx-Sigma-%s>\n", b->num, b->name);
  795 
  796         for (c=b->chan; c<b->chan+NCHAN; ++c) {
  797                 if (c->type == T_NONE)
  798                         continue;
  799                 d = &bd->channel[c->num];
  800                 d->dmamem.size = sizeof(cx_buf_t);
  801                 if (! cx_bus_dma_mem_alloc (unit, c->num, &d->dmamem))
  802                         continue;
  803                 d->board = b;
  804                 d->chan = c;
  805                 d->open_dev = 0;
  806                 c->sys = d;
  807                 channel [b->num*NCHAN + c->num] = d;
  808                 sprintf (d->name, "cx%d.%d", b->num, c->num);
  809 
  810                 switch (c->type) {
  811                 case T_SYNC_RS232:
  812                 case T_SYNC_V35:
  813                 case T_SYNC_RS449:
  814                 case T_UNIV:
  815                 case T_UNIV_RS232:
  816                 case T_UNIV_RS449:
  817                 case T_UNIV_V35:
  818 #ifdef NETGRAPH
  819                 if (ng_make_node_common (&typestruct, &d->node) != 0) {
  820                         printf ("%s: cannot make common node\n", d->name);
  821                         channel [b->num*NCHAN + c->num] = 0;
  822                         c->sys = 0;
  823                         cx_bus_dma_mem_free (&d->dmamem);
  824                         continue;
  825                 }
  826                 NG_NODE_SET_PRIVATE (d->node, d);
  827                 sprintf (d->nodename, "%s%d", NG_CX_NODE_TYPE,
  828                          c->board->num*NCHAN + c->num);
  829                 if (ng_name_node (d->node, d->nodename)) {
  830                         printf ("%s: cannot name node\n", d->nodename);
  831                         NG_NODE_UNREF (d->node);
  832                         channel [b->num*NCHAN + c->num] = 0;
  833                         c->sys = 0;
  834                         cx_bus_dma_mem_free (&d->dmamem);
  835                         continue;
  836                 }
  837                 d->lo_queue.ifq_maxlen = IFQ_MAXLEN;
  838                 d->hi_queue.ifq_maxlen = IFQ_MAXLEN;
  839                 mtx_init (&d->lo_queue.ifq_mtx, "cx_queue_lo", NULL, MTX_DEF);
  840                 mtx_init (&d->hi_queue.ifq_mtx, "cx_queue_hi", NULL, MTX_DEF);
  841                 callout_init (&d->timeout_handle,
  842                              cx_mpsafenet ? CALLOUT_MPSAFE : 0);
  843 #else /*NETGRAPH*/
  844                 d->ifp = if_alloc(IFT_PPP);
  845                 if (d->ifp == NULL) {
  846                         printf ("%s: cannot if_alloc() common interface\n",
  847                             d->name);
  848                         channel [b->num*NCHAN + c->num] = 0;
  849                         c->sys = 0;
  850                         cx_bus_dma_mem_free (&d->dmamem);
  851                         continue;
  852                 }
  853                 d->ifp->if_softc        = d;
  854                 if_initname (d->ifp, "cx", b->num * NCHAN + c->num);
  855                 d->ifp->if_mtu          = PP_MTU;
  856                 d->ifp->if_flags        = IFF_POINTOPOINT | IFF_MULTICAST;
  857                 if (!cx_mpsafenet)
  858                         d->ifp->if_flags |= IFF_NEEDSGIANT;
  859                 d->ifp->if_ioctl        = cx_sioctl;
  860                 d->ifp->if_start        = cx_ifstart;
  861                 d->ifp->if_watchdog     = cx_ifwatchdog;
  862                 d->ifp->if_init         = cx_initialize;
  863                 d->queue.ifq_maxlen     = 2;
  864                 mtx_init (&d->queue.ifq_mtx, "cx_queue", NULL, MTX_DEF);
  865                 sppp_attach (d->ifp);
  866                 if_attach (d->ifp);
  867                 IFP2SP(d->ifp)->pp_tlf  = cx_tlf;
  868                 IFP2SP(d->ifp)->pp_tls  = cx_tls;
  869                 /* If BPF is in the kernel, call the attach for it.
  870                  * Size of PPP header is 4 bytes. */
  871                 bpfattach (d->ifp, DLT_PPP, 4);
  872 #endif /*NETGRAPH*/
  873                 }
  874                 d->tty = ttyalloc ();
  875                 d->tty->t_open  = cx_topen;
  876                 d->tty->t_close = cx_tclose;
  877                 d->tty->t_param = cx_param;
  878                 d->tty->t_stop  = cx_stop;
  879                 d->tty->t_modem = cx_tmodem;
  880                 d->tty->t_oproc = cx_oproc;
  881                 d->tty->t_sc    = d;
  882                 CX_LOCK (bd);
  883                 cx_start_chan (c, d->dmamem.virt, d->dmamem.phys);
  884                 cx_register_receive (c, &cx_receive);
  885                 cx_register_transmit (c, &cx_transmit);
  886                 cx_register_error (c, &cx_error);
  887                 cx_register_modem (c, &cx_modem);
  888                 CX_UNLOCK (bd);
  889 
  890                 ttycreate(d->tty, NULL, 0, MINOR_CALLOUT,
  891                     "x%r%r", b->num, c->num);
  892                 d->devt = make_dev (&cx_cdevsw, b->num*NCHAN + c->num + 64, UID_ROOT, GID_WHEEL, 0600, "cx%d", b->num*NCHAN + c->num);
  893                 d->devt->si_drv1 = d;
  894                 callout_init (&d->dcd_timeout_handle,
  895                              cx_mpsafenet ? CALLOUT_MPSAFE : 0);
  896         }
  897         splx (s);
  898 
  899         return 0;
  900 }
  901 
  902 static int cx_detach (device_t dev)
  903 {
  904         bdrv_t *bd = device_get_softc (dev);
  905         cx_board_t *b = bd->board;
  906         cx_chan_t *c;
  907         int s;
  908         
  909         KASSERT (mtx_initialized (&bd->cx_mtx), ("cx mutex not initialized"));
  910 
  911         s = splhigh ();
  912         CX_LOCK (bd);
  913         /* Check if the device is busy (open). */
  914         for (c = b->chan; c < b->chan + NCHAN; ++c) {
  915                 drv_t *d = (drv_t*) c->sys;
  916 
  917                 if (!d || d->chan->type == T_NONE)
  918                         continue;
  919                 if (d->lock) {
  920                         CX_UNLOCK (bd);
  921                         splx (s);
  922                         return EBUSY;
  923                 }
  924                 if (c->mode == M_ASYNC && d->tty && (d->tty->t_state & TS_ISOPEN) &&
  925                     (d->open_dev|0x2)) {
  926                         CX_UNLOCK (bd);
  927                         splx (s);
  928                         return EBUSY;
  929                 }
  930                 if (d->running) {
  931                         CX_UNLOCK (bd);
  932                         splx (s);
  933                         return EBUSY;
  934                 }
  935         }
  936 
  937         /* Deactivate the timeout routine. And soft interrupt*/
  938         callout_stop (&led_timo[b->num]);
  939 
  940         for (c = b->chan; c < b->chan + NCHAN; ++c) {
  941                 drv_t *d = c->sys;
  942 
  943                 if (!d || d->chan->type == T_NONE)
  944                         continue;
  945 
  946                 callout_stop (&d->dcd_timeout_handle);
  947         }
  948         CX_UNLOCK (bd);
  949         bus_teardown_intr (dev, bd->irq_res, bd->intrhand);
  950         bus_release_resource (dev, SYS_RES_IRQ, bd->irq_rid, bd->irq_res);
  951         
  952         bus_release_resource (dev, SYS_RES_DRQ, bd->drq_rid, bd->drq_res);
  953         
  954         bus_release_resource (dev, SYS_RES_IOPORT, bd->base_rid, bd->base_res);
  955 
  956         CX_LOCK (bd);
  957         cx_close_board (b);
  958 
  959         /* Detach the interfaces, free buffer memory. */
  960         for (c = b->chan; c < b->chan + NCHAN; ++c) {
  961                 drv_t *d = (drv_t*) c->sys;
  962 
  963                 if (!d || d->chan->type == T_NONE)
  964                         continue;
  965                         
  966                 if (d->tty) {
  967                         ttyfree (d->tty);
  968                         d->tty = NULL;
  969                 }
  970 
  971 #ifdef NETGRAPH
  972                 if (d->node) {
  973                         ng_rmnode_self (d->node);
  974                         NG_NODE_UNREF (d->node);
  975                         d->node = NULL;
  976                 }
  977                 mtx_destroy (&d->lo_queue.ifq_mtx);
  978                 mtx_destroy (&d->hi_queue.ifq_mtx);
  979 #else
  980                 /* Detach from the packet filter list of interfaces. */
  981                 bpfdetach (d->ifp);
  982                 /* Detach from the sync PPP list. */
  983                 sppp_detach (d->ifp);
  984 
  985                 if_detach (d->ifp);
  986                 if_free(d->ifp);
  987                 /* XXXRIK: check interconnection with irq handler */
  988                 IF_DRAIN (&d->queue);
  989                 mtx_destroy (&d->queue.ifq_mtx);
  990 #endif          
  991                 destroy_dev (d->devt);
  992         }
  993 
  994         cx_led_off (b);
  995         CX_UNLOCK (bd);
  996         callout_drain (&led_timo[b->num]);
  997         for (c = b->chan; c < b->chan + NCHAN; ++c) {
  998                 drv_t *d = c->sys;
  999 
 1000                 if (!d || d->chan->type == T_NONE)
 1001                         continue;
 1002 
 1003                 callout_drain (&d->dcd_timeout_handle);
 1004         }
 1005         splx (s);
 1006         
 1007         s = splhigh ();
 1008         for (c = b->chan; c < b->chan + NCHAN; ++c) {
 1009                 drv_t *d = (drv_t*) c->sys;
 1010 
 1011                 if (!d || d->chan->type == T_NONE)
 1012                         continue;
 1013                 
 1014                 /* Deallocate buffers. */
 1015                 cx_bus_dma_mem_free (&d->dmamem);
 1016         }
 1017         bd->board = 0;
 1018         adapter [b->num] = 0;
 1019         free (b, M_DEVBUF);
 1020         splx (s);
 1021 
 1022         mtx_destroy (&bd->cx_mtx);
 1023         
 1024         return 0;       
 1025 }
 1026 
 1027 #ifndef NETGRAPH
 1028 static void cx_ifstart (struct ifnet *ifp)
 1029 {
 1030         drv_t *d = ifp->if_softc;
 1031         bdrv_t *bd = d->board->sys;
 1032 
 1033         CX_LOCK (bd);
 1034         cx_start (d);
 1035         CX_UNLOCK (bd);
 1036 }
 1037 
 1038 static void cx_ifwatchdog (struct ifnet *ifp)
 1039 {
 1040         drv_t *d = ifp->if_softc;
 1041 
 1042         cx_watchdog (d);
 1043 }
 1044 
 1045 static void cx_tlf (struct sppp *sp)
 1046 {
 1047         drv_t *d = SP2IFP(sp)->if_softc;
 1048 
 1049         CX_DEBUG (d, ("cx_tlf\n"));
 1050 /*      cx_set_dtr (d->chan, 0);*/
 1051 /*      cx_set_rts (d->chan, 0);*/
 1052         if (!(IFP2SP(d->ifp)->pp_flags & PP_FR) && !(d->ifp->if_flags & PP_CISCO))
 1053                 sp->pp_down (sp);
 1054 }
 1055 
 1056 static void cx_tls (struct sppp *sp)
 1057 {
 1058         drv_t *d = SP2IFP(sp)->if_softc;
 1059 
 1060         CX_DEBUG (d, ("cx_tls\n"));
 1061         if (!(IFP2SP(d->ifp)->pp_flags & PP_FR) && !(d->ifp->if_flags & PP_CISCO))
 1062                 sp->pp_up (sp);
 1063 }
 1064 
 1065 /*
 1066  * Initialization of interface.
 1067  * It seems to be never called by upper level.
 1068  */
 1069 static void cx_initialize (void *softc)
 1070 {
 1071         drv_t *d = softc;
 1072 
 1073         CX_DEBUG (d, ("cx_initialize\n"));
 1074 }
 1075 
 1076 /*
 1077  * Process an ioctl request.
 1078  */
 1079 static int cx_sioctl (struct ifnet *ifp, u_long cmd, caddr_t data)
 1080 {
 1081         drv_t *d = ifp->if_softc;
 1082         bdrv_t *bd = d->board->sys;
 1083         int error, s, was_up, should_be_up;
 1084 
 1085         /* No socket ioctls while the channel is in async mode. */
 1086         if (d->chan->type == T_NONE || d->chan->mode == M_ASYNC)
 1087                 return EBUSY;
 1088 
 1089         /* Socket ioctls on slave subchannels are not allowed. */
 1090         was_up = (ifp->if_drv_flags & IFF_DRV_RUNNING) != 0;
 1091         error = sppp_ioctl (ifp, cmd, data);
 1092         if (error)
 1093                 return error;
 1094 
 1095         if (! (ifp->if_flags & IFF_DEBUG))
 1096                 d->chan->debug = 0;
 1097         else if (! d->chan->debug)
 1098                 d->chan->debug = 1;
 1099 
 1100         switch (cmd) {
 1101         default:           CX_DEBUG2 (d, ("ioctl 0x%lx\n", cmd)); return 0;
 1102         case SIOCADDMULTI: CX_DEBUG2 (d, ("SIOCADDMULTI\n"));     return 0;
 1103         case SIOCDELMULTI: CX_DEBUG2 (d, ("SIOCDELMULTI\n"));     return 0;
 1104         case SIOCSIFFLAGS: CX_DEBUG2 (d, ("SIOCSIFFLAGS\n"));     break;
 1105         case SIOCSIFADDR:  CX_DEBUG2 (d, ("SIOCSIFADDR\n"));      break;
 1106         }
 1107 
 1108         /* We get here only in case of SIFFLAGS or SIFADDR. */
 1109         s = splhigh ();
 1110         CX_LOCK (bd);
 1111         should_be_up = (ifp->if_drv_flags & IFF_DRV_RUNNING) != 0;
 1112         if (!was_up && should_be_up) {
 1113                 /* Interface goes up -- start it. */
 1114                 cx_up (d);
 1115                 cx_start (d);
 1116         } else if (was_up && !should_be_up) {
 1117                 /* Interface is going down -- stop it. */
 1118                 /* if ((IFP2SP(d->ifp)->pp_flags & PP_FR) || (ifp->if_flags & PP_CISCO))*/
 1119                 cx_down (d);
 1120         }
 1121         CX_UNLOCK (bd);
 1122         splx (s);
 1123         return 0;
 1124 }
 1125 #endif /*NETGRAPH*/
 1126 
 1127 /*
 1128  * Stop the interface.  Called on splimp().
 1129  */
 1130 static void cx_down (drv_t *d)
 1131 {
 1132         int s = splhigh ();
 1133         CX_DEBUG (d, ("cx_down\n"));
 1134         cx_set_dtr (d->chan, 0);
 1135         cx_set_rts (d->chan, 0);
 1136         d->running = 0;
 1137         splx (s);
 1138 }
 1139 
 1140 /*
 1141  * Start the interface.  Called on splimp().
 1142  */
 1143 static void cx_up (drv_t *d)
 1144 {
 1145         int s = splhigh ();
 1146         CX_DEBUG (d, ("cx_up\n"));
 1147         cx_set_dtr (d->chan, 1);
 1148         cx_set_rts (d->chan, 1);
 1149         d->running = 1;
 1150         splx (s);
 1151 }
 1152 
 1153 /*
 1154  * Start output on the (slave) interface.  Get another datagram to send
 1155  * off of the interface queue, and copy it to the interface
 1156  * before starting the output.
 1157  */
 1158 static void cx_send (drv_t *d)
 1159 {
 1160         struct mbuf *m;
 1161         u_short len;
 1162 
 1163         CX_DEBUG2 (d, ("cx_send\n"));
 1164 
 1165         /* No output if the interface is down. */
 1166         if (! d->running)
 1167                 return;
 1168 
 1169         /* No output if the modem is off. */
 1170         if (! cx_get_dsr (d->chan) && ! cx_get_loop(d->chan))
 1171                 return;
 1172 
 1173         if (cx_buf_free (d->chan)) {
 1174                 /* Get the packet to send. */
 1175 #ifdef NETGRAPH
 1176                 IF_DEQUEUE (&d->hi_queue, m);
 1177                 if (! m)
 1178                         IF_DEQUEUE (&d->lo_queue, m);
 1179 #else
 1180                 m = sppp_dequeue (d->ifp);
 1181 #endif
 1182                 if (! m)
 1183                         return;
 1184 #ifndef NETGRAPH
 1185                 BPF_MTAP (d->ifp, m);
 1186 #endif
 1187                 len = m_length (m, NULL);
 1188                 if (! m->m_next)
 1189                         cx_send_packet (d->chan, (u_char*)mtod (m, caddr_t),
 1190                                 len, 0);
 1191                 else {
 1192                         u_char buf [DMABUFSZ];
 1193                         m_copydata (m, 0, len, buf);
 1194                         cx_send_packet (d->chan, buf, len, 0);
 1195                 }
 1196                 m_freem (m);
 1197 
 1198                 /* Set up transmit timeout, 10 seconds. */
 1199 #ifdef NETGRAPH
 1200                 d->timeout = 10;
 1201 #else
 1202                 d->ifp->if_timer = 10;
 1203 #endif
 1204         }
 1205 #ifndef NETGRAPH
 1206         d->ifp->if_drv_flags |= IFF_DRV_OACTIVE;
 1207 #endif
 1208 }
 1209 
 1210 /*
 1211  * Start output on the interface.
 1212  * Always called on splimp().
 1213  */
 1214 static void cx_start (drv_t *d)
 1215 {
 1216         int s = splhigh ();
 1217         if (d->running) {
 1218                 if (! d->chan->dtr)
 1219                         cx_set_dtr (d->chan, 1);
 1220                 if (! d->chan->rts)
 1221                         cx_set_rts (d->chan, 1);
 1222                 cx_send (d);
 1223         }
 1224         splx (s);
 1225 }
 1226 
 1227 /*
 1228  * Handle transmit timeouts.
 1229  * Recover after lost transmit interrupts.
 1230  * Always called on splimp().
 1231  */
 1232 static void cx_watchdog (drv_t *d)
 1233 {
 1234         bdrv_t *bd = d->board->sys;
 1235         
 1236         int s = splhigh ();
 1237         CX_LOCK (bd);
 1238         CX_DEBUG (d, ("device timeout\n"));
 1239         if (d->running) {
 1240                 cx_setup_chan (d->chan);
 1241                 cx_start_chan (d->chan, 0, 0);
 1242                 cx_set_dtr (d->chan, 1);
 1243                 cx_set_rts (d->chan, 1);
 1244                 cx_start (d);
 1245         }
 1246         CX_UNLOCK (bd);
 1247         splx (s);
 1248 }
 1249 
 1250 /*
 1251  * Transmit callback function.
 1252  */
 1253 static void cx_transmit (cx_chan_t *c, void *attachment, int len)
 1254 {
 1255         drv_t *d = c->sys;
 1256 
 1257         if (!d)
 1258                 return;
 1259                 
 1260         if (c->mode == M_ASYNC && d->tty) {
 1261                 d->tty->t_state &= ~(TS_BUSY | TS_FLUSH);
 1262                 d->atimeout = 0;
 1263                 if (d->tty->t_dev) {
 1264                         d->intr_action |= CX_WRITE;
 1265                         MY_SOFT_INTR = 1;
 1266                         swi_sched (cx_fast_ih, 0);
 1267                 }
 1268                 return;
 1269         }
 1270 #ifdef NETGRAPH
 1271         d->timeout = 0;
 1272 #else
 1273         ++d->ifp->if_opackets;
 1274         d->ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
 1275         d->ifp->if_timer = 0;
 1276 #endif
 1277         cx_start (d);
 1278 }
 1279 
 1280 /*
 1281  * Process the received packet.
 1282  */
 1283 static void cx_receive (cx_chan_t *c, char *data, int len)
 1284 {
 1285         drv_t *d = c->sys;
 1286         struct mbuf *m;
 1287         char *cc = data;
 1288 #ifdef NETGRAPH
 1289         int error;
 1290 #endif
 1291 
 1292         if (!d)
 1293                 return;
 1294                 
 1295         if (c->mode == M_ASYNC && d->tty) {
 1296                 if (d->tty->t_state & TS_ISOPEN) {
 1297                         async_q *q = &d->aqueue;
 1298                         int size = BF_SZ - 1 - AQ_GSZ (q);
 1299 
 1300                         if (len <= 0 && !size)
 1301                                 return;
 1302 
 1303                         if (len > size) {
 1304                                 c->ierrs++;
 1305                                 cx_error (c, CX_OVERRUN);
 1306                                 len = size - 1;
 1307                         }
 1308 
 1309                         while (len--) {
 1310                                 AQ_PUSH (q, *(unsigned char *)cc);
 1311                                 cc++;
 1312                         }
 1313 
 1314                         d->intr_action |= CX_READ;
 1315                         MY_SOFT_INTR = 1;
 1316                         swi_sched (cx_fast_ih, 0);
 1317                 }
 1318                 return;
 1319         }
 1320         if (! d->running)
 1321                 return;
 1322 
 1323         m = makembuf (data, len);
 1324         if (! m) {
 1325                 CX_DEBUG (d, ("no memory for packet\n"));
 1326 #ifndef NETGRAPH
 1327                 ++d->ifp->if_iqdrops;
 1328 #endif
 1329                 return;
 1330         }
 1331         if (c->debug > 1)
 1332                 printmbuf (m);
 1333 #ifdef NETGRAPH
 1334         m->m_pkthdr.rcvif = 0;
 1335         NG_SEND_DATA_ONLY (error, d->hook, m);
 1336 #else
 1337         ++d->ifp->if_ipackets;
 1338         m->m_pkthdr.rcvif = d->ifp;
 1339         /* Check if there's a BPF listener on this interface.
 1340          * If so, hand off the raw packet to bpf. */
 1341         BPF_TAP (d->ifp, data, len);
 1342         IF_ENQUEUE (&d->queue, m);
 1343 #endif
 1344 }
 1345 
 1346 #define CONDITION(t,tp) (!(t->c_iflag & (ICRNL | IGNCR | IMAXBEL | INLCR | ISTRIP | IXON))\
 1347             && (!(tp->t_iflag & BRKINT) || (tp->t_iflag & IGNBRK))\
 1348             && (!(tp->t_iflag & PARMRK)\
 1349                 || (tp->t_iflag & (IGNPAR | IGNBRK)) == (IGNPAR | IGNBRK))\
 1350             && !(t->c_lflag & (ECHO | ICANON | IEXTEN | ISIG | PENDIN))\
 1351             && linesw[tp->t_line]->l_rint == ttyinput)
 1352 
 1353 /*
 1354  * Error callback function.
 1355  */
 1356 static void cx_error (cx_chan_t *c, int data)
 1357 {
 1358         drv_t *d = c->sys;
 1359         async_q *q;
 1360 
 1361         if (!d)
 1362                 return;
 1363 
 1364         q = &(d->aqueue);
 1365 
 1366         switch (data) {
 1367         case CX_FRAME:
 1368                 CX_DEBUG (d, ("frame error\n"));
 1369                 if (c->mode == M_ASYNC && d->tty && (d->tty->t_state & TS_ISOPEN)
 1370                         && (AQ_GSZ (q) < BF_SZ - 1)
 1371                         && (!CONDITION((&d->tty->t_termios), (d->tty))
 1372                         || !(d->tty->t_iflag & (IGNPAR | PARMRK)))) {
 1373                         AQ_PUSH (q, TTY_FE);
 1374                         d->intr_action |= CX_READ;
 1375                         MY_SOFT_INTR = 1;
 1376                         swi_sched (cx_fast_ih, 0);
 1377                 }
 1378 #ifndef NETGRAPH
 1379                 else
 1380                         ++d->ifp->if_ierrors;
 1381 #endif
 1382                 break;
 1383         case CX_CRC:
 1384                 CX_DEBUG (d, ("crc error\n"));
 1385                 if (c->mode == M_ASYNC && d->tty && (d->tty->t_state & TS_ISOPEN)
 1386                         && (AQ_GSZ (q) < BF_SZ - 1)
 1387                         && (!CONDITION((&d->tty->t_termios), (d->tty))
 1388                         || !(d->tty->t_iflag & INPCK)
 1389                         || !(d->tty->t_iflag & (IGNPAR | PARMRK)))) {
 1390                         AQ_PUSH (q, TTY_PE);
 1391                         d->intr_action |= CX_READ;
 1392                         MY_SOFT_INTR = 1;
 1393                         swi_sched (cx_fast_ih, 0);
 1394                 }
 1395 #ifndef NETGRAPH
 1396                 else
 1397                         ++d->ifp->if_ierrors;
 1398 #endif
 1399                 break;
 1400         case CX_OVERRUN:
 1401                 CX_DEBUG (d, ("overrun error\n"));
 1402 #ifdef TTY_OE
 1403                 if (c->mode == M_ASYNC && d->tty && (d->tty->t_state & TS_ISOPEN)
 1404                         && (AQ_GSZ (q) < BF_SZ - 1)
 1405                         && (!CONDITION((&d->tty->t_termios), (d->tty)))) {
 1406                         AQ_PUSH (q, TTY_OE);
 1407                         d->intr_action |= CX_READ;
 1408                         MY_SOFT_INTR = 1;
 1409                         swi_sched (cx_fast_ih, 0);
 1410                 }
 1411 #endif
 1412 #ifndef NETGRAPH
 1413                 else {
 1414                         ++d->ifp->if_collisions;
 1415                         ++d->ifp->if_ierrors;
 1416                 }
 1417 #endif
 1418                 break;
 1419         case CX_OVERFLOW:
 1420                 CX_DEBUG (d, ("overflow error\n"));
 1421 #ifndef NETGRAPH
 1422                 if (c->mode != M_ASYNC)
 1423                         ++d->ifp->if_ierrors;
 1424 #endif
 1425                 break;
 1426         case CX_UNDERRUN:
 1427                 CX_DEBUG (d, ("underrun error\n"));
 1428                 if (c->mode != M_ASYNC) {
 1429 #ifdef NETGRAPH
 1430                         d->timeout = 0;
 1431 #else
 1432                         ++d->ifp->if_oerrors;
 1433                         d->ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
 1434                         d->ifp->if_timer = 0;
 1435                         cx_start (d);
 1436 #endif
 1437                 }
 1438                 break;
 1439         case CX_BREAK:
 1440                 CX_DEBUG (d, ("break error\n"));
 1441                 if (c->mode == M_ASYNC && d->tty && (d->tty->t_state & TS_ISOPEN)
 1442                         && (AQ_GSZ (q) < BF_SZ - 1)
 1443                         && (!CONDITION((&d->tty->t_termios), (d->tty))
 1444                         || !(d->tty->t_iflag & (IGNBRK | BRKINT | PARMRK)))) {
 1445                         AQ_PUSH (q, TTY_BI);
 1446                         d->intr_action |= CX_READ;
 1447                         MY_SOFT_INTR = 1;
 1448                         swi_sched (cx_fast_ih, 0);
 1449                 }
 1450 #ifndef NETGRAPH
 1451                 else
 1452                         ++d->ifp->if_ierrors;
 1453 #endif
 1454                 break;
 1455         default:
 1456                 CX_DEBUG (d, ("error #%d\n", data));
 1457         }
 1458 }
 1459 
 1460 static int cx_topen (struct tty *tp, struct cdev *dev)
 1461 {
 1462         bdrv_t *bd;
 1463         drv_t *d;
 1464 
 1465         d = tp->t_sc;
 1466         CX_DEBUG2 (d, ("cx_open (serial)\n"));
 1467 
 1468         bd = d->board->sys;
 1469 
 1470         if (d->chan->mode != M_ASYNC)
 1471                 return (EBUSY);
 1472 
 1473         d->open_dev |= 0x2;
 1474         CX_LOCK (bd);
 1475         cx_start_chan (d->chan, 0, 0);
 1476         cx_set_dtr (d->chan, 1);
 1477         cx_set_rts (d->chan, 1);
 1478         d->cd = cx_get_cd (d->chan);
 1479         CX_UNLOCK (bd);
 1480 
 1481         CX_DEBUG2 (d, ("cx_open done\n"));
 1482 
 1483         return 0;
 1484 }
 1485 
 1486 static void cx_tclose (struct tty *tp)
 1487 {
 1488         drv_t *d;
 1489         bdrv_t *bd;
 1490 
 1491         d = tp->t_sc;
 1492         CX_DEBUG2 (d, ("cx_close\n"));
 1493         bd = d->board->sys;
 1494         CX_LOCK (bd);
 1495         /* Disable receiver.
 1496          * Transmitter continues sending the queued data. */
 1497         cx_enable_receive (d->chan, 0);
 1498         CX_UNLOCK (bd);
 1499         d->open_dev &= ~0x2;
 1500 }
 1501 
 1502 static int cx_tmodem (struct tty *tp, int sigon, int sigoff)
 1503 {
 1504         drv_t *d;
 1505         bdrv_t *bd;
 1506 
 1507         d = tp->t_sc;
 1508         bd = d->board->sys;
 1509 
 1510         CX_LOCK (bd);
 1511         if (!sigon && !sigoff) {
 1512                 if (cx_get_dsr (d->chan)) sigon |= SER_DSR;
 1513                 if (cx_get_cd  (d->chan)) sigon |= SER_DCD;
 1514                 if (cx_get_cts (d->chan)) sigon |= SER_CTS;
 1515                 if (d->chan->dtr)         sigon |= SER_DTR;
 1516                 if (d->chan->rts)         sigon |= SER_RTS;
 1517                 CX_UNLOCK (bd);
 1518                 return sigon;
 1519         }
 1520 
 1521         if (sigon & SER_DTR)
 1522                 cx_set_dtr (d->chan, 1);
 1523         if (sigoff & SER_DTR)
 1524                 cx_set_dtr (d->chan, 0);
 1525         if (sigon & SER_RTS)
 1526                 cx_set_rts (d->chan, 1);
 1527         if (sigoff & SER_RTS)
 1528                 cx_set_rts (d->chan, 0);
 1529         CX_UNLOCK (bd);
 1530 
 1531         return (0);
 1532 }
 1533 
 1534 static int cx_open (struct cdev *dev, int flag, int mode, struct thread *td)
 1535 {
 1536         int unit;
 1537         drv_t *d;
 1538 
 1539         d = dev->si_drv1;
 1540         unit = d->chan->num;
 1541 
 1542         CX_DEBUG2 (d, ("cx_open unit=%d, flag=0x%x, mode=0x%x\n",
 1543                     unit, flag, mode));
 1544 
 1545         d->open_dev |= 0x1;
 1546 
 1547         CX_DEBUG2 (d, ("cx_open done\n"));
 1548 
 1549         return 0;
 1550 }
 1551 
 1552 static int cx_close (struct cdev *dev, int flag, int mode, struct thread *td)
 1553 {
 1554         drv_t *d;
 1555 
 1556         d = dev->si_drv1;
 1557         CX_DEBUG2 (d, ("cx_close\n"));
 1558         d->open_dev &= ~0x1;
 1559         return 0;
 1560 }
 1561 
 1562 static int cx_modem_status (drv_t *d)
 1563 {
 1564         bdrv_t *bd = d->board->sys;
 1565         int status = 0, s = splhigh ();
 1566         CX_LOCK (bd);
 1567         /* Already opened by someone or network interface is up? */
 1568         if ((d->chan->mode == M_ASYNC && d->tty && (d->tty->t_state & TS_ISOPEN) &&
 1569             (d->open_dev|0x2)) || (d->chan->mode != M_ASYNC && d->running))
 1570                 status = TIOCM_LE;      /* always enabled while open */
 1571 
 1572         if (cx_get_dsr (d->chan)) status |= TIOCM_DSR;
 1573         if (cx_get_cd  (d->chan)) status |= TIOCM_CD;
 1574         if (cx_get_cts (d->chan)) status |= TIOCM_CTS;
 1575         if (d->chan->dtr)         status |= TIOCM_DTR;
 1576         if (d->chan->rts)         status |= TIOCM_RTS;
 1577         CX_UNLOCK (bd);
 1578         splx (s);
 1579         return status;
 1580 }
 1581 
 1582 static int cx_ioctl (struct cdev *dev, u_long cmd, caddr_t data, int flag, struct thread *td)
 1583 {
 1584         drv_t *d;
 1585         bdrv_t *bd;
 1586         cx_chan_t *c;
 1587         struct serial_statistics *st;
 1588         int error, s;
 1589         char mask[16];
 1590 
 1591         d = dev->si_drv1;
 1592         c = d->chan;
 1593                 
 1594         bd = d->board->sys;
 1595         
 1596         switch (cmd) {
 1597         case SERIAL_GETREGISTERED:
 1598                 CX_DEBUG2 (d, ("ioctl: getregistered\n"));
 1599                 bzero (mask, sizeof(mask));
 1600                 for (s=0; s<NCX*NCHAN; ++s)
 1601                         if (channel [s])
 1602                                 mask [s/8] |= 1 << (s & 7);
 1603                 bcopy (mask, data, sizeof (mask));
 1604                 return 0;
 1605 
 1606         case SERIAL_GETPORT:
 1607                 CX_DEBUG2 (d, ("ioctl: getport\n"));
 1608                 s = splhigh ();
 1609                 CX_LOCK (bd);
 1610                 *(int *)data = cx_get_port (c);
 1611                 CX_UNLOCK (bd);
 1612                 splx (s);
 1613                 if (*(int *)data<0)
 1614                         return (EINVAL);
 1615                 else
 1616                         return 0;
 1617 
 1618         case SERIAL_SETPORT:
 1619                 CX_DEBUG2 (d, ("ioctl: setproto\n"));
 1620                 /* Only for superuser! */
 1621                 error = suser (td);
 1622                 if (error)
 1623                         return error;
 1624 
 1625                 s = splhigh ();
 1626                 CX_LOCK (bd);
 1627                 cx_set_port (c, *(int *)data);
 1628                 CX_UNLOCK (bd);
 1629                 splx (s);
 1630                 return 0;
 1631 
 1632 #ifndef NETGRAPH
 1633         case SERIAL_GETPROTO:
 1634                 CX_DEBUG2 (d, ("ioctl: getproto\n"));
 1635                 s = splhigh ();
 1636                 CX_LOCK (bd);
 1637                 strcpy ((char*)data, (c->mode == M_ASYNC) ? "async" :
 1638                         (IFP2SP(d->ifp)->pp_flags & PP_FR) ? "fr" :
 1639                         (d->ifp->if_flags & PP_CISCO) ? "cisco" : "ppp");
 1640                 CX_UNLOCK (bd);
 1641                 splx (s);
 1642                 return 0;
 1643 
 1644         case SERIAL_SETPROTO:
 1645                 CX_DEBUG2 (d, ("ioctl: setproto\n"));
 1646                 /* Only for superuser! */
 1647                 error = suser (td);
 1648                 if (error)
 1649                         return error;
 1650                 if (c->mode == M_ASYNC)
 1651                         return EBUSY;
 1652                 if (d->ifp->if_drv_flags & IFF_DRV_RUNNING)
 1653                         return EBUSY;
 1654                 if (! strcmp ("cisco", (char*)data)) {
 1655                         IFP2SP(d->ifp)->pp_flags &= ~(PP_FR);
 1656                         IFP2SP(d->ifp)->pp_flags |= PP_KEEPALIVE;
 1657                         d->ifp->if_flags |= PP_CISCO;
 1658                 } else if (! strcmp ("fr", (char*)data)) {
 1659                         d->ifp->if_flags &= ~(PP_CISCO);
 1660                         IFP2SP(d->ifp)->pp_flags |= PP_FR | PP_KEEPALIVE;
 1661                 } else if (! strcmp ("ppp", (char*)data)) {
 1662                         IFP2SP(d->ifp)->pp_flags &= ~(PP_FR | PP_KEEPALIVE);
 1663                         d->ifp->if_flags &= ~(PP_CISCO);
 1664                 } else
 1665                         return EINVAL;
 1666                 return 0;
 1667 
 1668         case SERIAL_GETKEEPALIVE:
 1669                 CX_DEBUG2 (d, ("ioctl: getkeepalive\n"));
 1670                 if ((IFP2SP(d->ifp)->pp_flags & PP_FR) ||
 1671                     (d->ifp->if_flags & PP_CISCO) ||
 1672                     (c->mode == M_ASYNC))
 1673                         return EINVAL;
 1674                 s = splhigh ();
 1675                 CX_LOCK (bd);
 1676                 *(int*)data = (IFP2SP(d->ifp)->pp_flags & PP_KEEPALIVE) ? 1 : 0;
 1677                 CX_UNLOCK (bd);
 1678                 splx (s);
 1679                 return 0;
 1680 
 1681         case SERIAL_SETKEEPALIVE:
 1682                 CX_DEBUG2 (d, ("ioctl: setkeepalive\n"));
 1683                 /* Only for superuser! */
 1684                 error = suser (td);
 1685                 if (error)
 1686                         return error;
 1687                 if ((IFP2SP(d->ifp)->pp_flags & PP_FR) ||
 1688                         (d->ifp->if_flags & PP_CISCO))
 1689                         return EINVAL;
 1690                 s = splhigh ();
 1691                 CX_LOCK (bd);
 1692                 if (*(int*)data)
 1693                         IFP2SP(d->ifp)->pp_flags |= PP_KEEPALIVE;
 1694                 else
 1695                         IFP2SP(d->ifp)->pp_flags &= ~PP_KEEPALIVE;
 1696                 CX_UNLOCK (bd);
 1697                 splx (s);
 1698                 return 0;
 1699 #endif /*NETGRAPH*/
 1700 
 1701         case SERIAL_GETMODE:
 1702                 CX_DEBUG2 (d, ("ioctl: getmode\n"));
 1703                 s = splhigh ();
 1704                 CX_LOCK (bd);
 1705                 *(int*)data = (c->mode == M_ASYNC) ?
 1706                         SERIAL_ASYNC : SERIAL_HDLC;
 1707                 CX_UNLOCK (bd);
 1708                 splx (s);
 1709                 return 0;
 1710 
 1711         case SERIAL_SETMODE:
 1712                 CX_DEBUG2 (d, ("ioctl: setmode\n"));
 1713                 /* Only for superuser! */
 1714                 error = suser (td);
 1715                 if (error)
 1716                         return error;
 1717 
 1718                 /* Somebody is waiting for carrier? */
 1719                 if (d->lock)
 1720                         return EBUSY;
 1721                 /* /dev/ttyXX is already opened by someone? */
 1722                 if (c->mode == M_ASYNC && d->tty && (d->tty->t_state & TS_ISOPEN) &&
 1723                     (d->open_dev|0x2))
 1724                         return EBUSY;
 1725                 /* Network interface is up?
 1726                  * Cannot change to async mode. */
 1727                 if (c->mode != M_ASYNC && d->running &&
 1728                     (*(int*)data == SERIAL_ASYNC))
 1729                         return EBUSY;
 1730 
 1731                 s = splhigh ();
 1732                 CX_LOCK (bd);
 1733                 if (c->mode == M_HDLC && *(int*)data == SERIAL_ASYNC) {
 1734                         cx_set_mode (c, M_ASYNC);
 1735                         cx_enable_receive (c, 0);
 1736                         cx_enable_transmit (c, 0);
 1737                 } else if (c->mode == M_ASYNC && *(int*)data == SERIAL_HDLC) {
 1738                         cx_set_mode (c, M_HDLC);
 1739                         cx_enable_receive (c, 1);
 1740                         cx_enable_transmit (c, 1);
 1741                 }
 1742                 CX_UNLOCK (bd);
 1743                 splx (s);
 1744                 return 0;
 1745 
 1746         case SERIAL_GETSTAT:
 1747                 CX_DEBUG2 (d, ("ioctl: getestat\n"));
 1748                 st = (struct serial_statistics*) data;
 1749                 s = splhigh ();
 1750                 CX_LOCK (bd);
 1751                 st->rintr  = c->rintr;
 1752                 st->tintr  = c->tintr;
 1753                 st->mintr  = c->mintr;
 1754                 st->ibytes = c->ibytes;
 1755                 st->ipkts  = c->ipkts;
 1756                 st->ierrs  = c->ierrs;
 1757                 st->obytes = c->obytes;
 1758                 st->opkts  = c->opkts;
 1759                 st->oerrs  = c->oerrs;
 1760                 CX_UNLOCK (bd);
 1761                 splx (s);
 1762                 return 0;
 1763 
 1764         case SERIAL_CLRSTAT:
 1765                 CX_DEBUG2 (d, ("ioctl: clrstat\n"));
 1766                 /* Only for superuser! */
 1767                 error = suser (td);
 1768                 if (error)
 1769                         return error;
 1770                 s = splhigh ();
 1771                 CX_LOCK (bd);
 1772                 c->rintr = 0;
 1773                 c->tintr = 0;
 1774                 c->mintr = 0;
 1775                 c->ibytes = 0;
 1776                 c->ipkts = 0;
 1777                 c->ierrs = 0;
 1778                 c->obytes = 0;
 1779                 c->opkts = 0;
 1780                 c->oerrs = 0;
 1781                 CX_UNLOCK (bd);
 1782                 splx (s);
 1783                 return 0;
 1784 
 1785         case SERIAL_GETBAUD:
 1786                 CX_DEBUG2 (d, ("ioctl: getbaud\n"));
 1787                 if (c->mode == M_ASYNC)
 1788                         return EINVAL;
 1789                 s = splhigh ();
 1790                 CX_LOCK (bd);
 1791                 *(long*)data = cx_get_baud(c);
 1792                 CX_UNLOCK (bd);
 1793                 splx (s);
 1794                 return 0;
 1795 
 1796         case SERIAL_SETBAUD:
 1797                 CX_DEBUG2 (d, ("ioctl: setbaud\n"));
 1798                 /* Only for superuser! */
 1799                 error = suser (td);
 1800                 if (error)
 1801                         return error;
 1802                 if (c->mode == M_ASYNC)
 1803                         return EINVAL;
 1804                 s = splhigh ();
 1805                 CX_LOCK (bd);
 1806                 cx_set_baud (c, *(long*)data);
 1807                 CX_UNLOCK (bd);
 1808                 splx (s);
 1809                 return 0;
 1810 
 1811         case SERIAL_GETLOOP:
 1812                 CX_DEBUG2 (d, ("ioctl: getloop\n"));
 1813                 if (c->mode == M_ASYNC)
 1814                         return EINVAL;
 1815                 s = splhigh ();
 1816                 CX_LOCK (bd);
 1817                 *(int*)data = cx_get_loop (c);
 1818                 CX_UNLOCK (bd);
 1819                 splx (s);
 1820                 return 0;
 1821 
 1822         case SERIAL_SETLOOP:
 1823                 CX_DEBUG2 (d, ("ioctl: setloop\n"));
 1824                 /* Only for superuser! */
 1825                 error = suser (td);
 1826                 if (error)
 1827                         return error;
 1828                 if (c->mode == M_ASYNC)
 1829                         return EINVAL;
 1830                 s = splhigh ();
 1831                 CX_LOCK (bd);
 1832                 cx_set_loop (c, *(int*)data);
 1833                 CX_UNLOCK (bd);
 1834                 splx (s);
 1835                 return 0;
 1836 
 1837         case SERIAL_GETDPLL:
 1838                 CX_DEBUG2 (d, ("ioctl: getdpll\n"));
 1839                 if (c->mode == M_ASYNC)
 1840                         return EINVAL;
 1841                 s = splhigh ();
 1842                 CX_LOCK (bd);
 1843                 *(int*)data = cx_get_dpll (c);
 1844                 CX_UNLOCK (bd);
 1845                 splx (s);
 1846                 return 0;
 1847 
 1848         case SERIAL_SETDPLL:
 1849                 CX_DEBUG2 (d, ("ioctl: setdpll\n"));
 1850                 /* Only for superuser! */
 1851                 error = suser (td);
 1852                 if (error)
 1853                         return error;
 1854                 if (c->mode == M_ASYNC)
 1855                         return EINVAL;
 1856                 s = splhigh ();
 1857                 CX_LOCK (bd);
 1858                 cx_set_dpll (c, *(int*)data);
 1859                 CX_UNLOCK (bd);
 1860                 splx (s);
 1861                 return 0;
 1862 
 1863         case SERIAL_GETNRZI:
 1864                 CX_DEBUG2 (d, ("ioctl: getnrzi\n"));
 1865                 if (c->mode == M_ASYNC)
 1866                         return EINVAL;
 1867                 s = splhigh ();
 1868                 CX_LOCK (bd);
 1869                 *(int*)data = cx_get_nrzi (c);
 1870                 CX_UNLOCK (bd);
 1871                 splx (s);
 1872                 return 0;
 1873 
 1874         case SERIAL_SETNRZI:
 1875                 CX_DEBUG2 (d, ("ioctl: setnrzi\n"));
 1876                 /* Only for superuser! */
 1877                 error = suser (td);
 1878                 if (error)
 1879                         return error;
 1880                 if (c->mode == M_ASYNC)
 1881                         return EINVAL;
 1882                 s = splhigh ();
 1883                 CX_LOCK (bd);
 1884                 cx_set_nrzi (c, *(int*)data);
 1885                 CX_UNLOCK (bd);
 1886                 splx (s);
 1887                 return 0;
 1888 
 1889         case SERIAL_GETDEBUG:
 1890                 CX_DEBUG2 (d, ("ioctl: getdebug\n"));
 1891                 s = splhigh ();
 1892                 CX_LOCK (bd);
 1893                 *(int*)data = c->debug;
 1894                 CX_UNLOCK (bd);
 1895                 splx (s);
 1896                 return 0;
 1897 
 1898         case SERIAL_SETDEBUG:
 1899                 CX_DEBUG2 (d, ("ioctl: setdebug\n"));
 1900                 /* Only for superuser! */
 1901                 error = suser (td);
 1902                 if (error)
 1903                         return error;
 1904                 s = splhigh ();
 1905                 CX_LOCK (bd);
 1906                 c->debug = *(int*)data;
 1907                 CX_UNLOCK (bd);
 1908                 splx (s);
 1909 #ifndef NETGRAPH
 1910                 if (d->chan->debug)
 1911                         d->ifp->if_flags |= IFF_DEBUG;
 1912                 else
 1913                         d->ifp->if_flags &= (~IFF_DEBUG);
 1914 #endif
 1915                 return 0;
 1916         }
 1917 
 1918         switch (cmd) {
 1919         case TIOCSDTR:  /* Set DTR */
 1920                 CX_DEBUG2 (d, ("ioctl: tiocsdtr\n"));
 1921                 s = splhigh ();
 1922                 CX_LOCK (bd);
 1923                 cx_set_dtr (c, 1);
 1924                 CX_UNLOCK (bd);
 1925                 splx (s);
 1926                 return 0;
 1927 
 1928         case TIOCCDTR:  /* Clear DTR */
 1929                 CX_DEBUG2 (d, ("ioctl: tioccdtr\n"));
 1930                 s = splhigh ();
 1931                 CX_LOCK (bd);
 1932                 cx_set_dtr (c, 0);
 1933                 CX_UNLOCK (bd);
 1934                 splx (s);
 1935                 return 0;
 1936 
 1937         case TIOCMSET:  /* Set DTR/RTS */
 1938                 CX_DEBUG2 (d, ("ioctl: tiocmset\n"));
 1939                 s = splhigh ();
 1940                 CX_LOCK (bd);
 1941                 cx_set_dtr (c, (*(int*)data & TIOCM_DTR) ? 1 : 0);
 1942                 cx_set_rts (c, (*(int*)data & TIOCM_RTS) ? 1 : 0);
 1943                 CX_UNLOCK (bd);
 1944                 splx (s);
 1945                 return 0;
 1946 
 1947         case TIOCMBIS:  /* Add DTR/RTS */
 1948                 CX_DEBUG2 (d, ("ioctl: tiocmbis\n"));
 1949                 s = splhigh ();
 1950                 CX_LOCK (bd);
 1951                 if (*(int*)data & TIOCM_DTR) cx_set_dtr (c, 1);
 1952                 if (*(int*)data & TIOCM_RTS) cx_set_rts (c, 1);
 1953                 CX_UNLOCK (bd);
 1954                 splx (s);
 1955                 return 0;
 1956 
 1957         case TIOCMBIC:  /* Clear DTR/RTS */
 1958                 CX_DEBUG2 (d, ("ioctl: tiocmbic\n"));
 1959                 s = splhigh ();
 1960                 CX_LOCK (bd);
 1961                 if (*(int*)data & TIOCM_DTR) cx_set_dtr (c, 0);
 1962                 if (*(int*)data & TIOCM_RTS) cx_set_rts (c, 0);
 1963                 CX_UNLOCK (bd);
 1964                 splx (s);
 1965                 return 0;
 1966 
 1967         case TIOCMGET:  /* Get modem status */
 1968                 CX_DEBUG2 (d, ("ioctl: tiocmget\n"));
 1969                 *(int*)data = cx_modem_status (d);
 1970                 return 0;
 1971 
 1972         }
 1973 
 1974         CX_DEBUG2 (d, ("ioctl: 0x%lx\n", cmd));
 1975         return ENOTTY;
 1976 }
 1977 
 1978 void cx_softintr (void *unused)
 1979 {
 1980         drv_t *d;
 1981         bdrv_t *bd;
 1982         async_q *q;
 1983         int i, s, ic, k;
 1984         while (MY_SOFT_INTR) {
 1985                 MY_SOFT_INTR = 0;
 1986                 for (i=0; i<NCX*NCHAN; ++i) {
 1987                         d = channel [i];
 1988                         if (!d || !d->chan || d->chan->type == T_NONE
 1989                             || d->chan->mode != M_ASYNC || !d->tty
 1990                             || !d->tty->t_dev)
 1991                                 continue;
 1992                         bd = d->board->sys;
 1993                         s = splhigh ();
 1994                         CX_LOCK (bd);
 1995                         if (d->intr_action & CX_READ) {
 1996                                 q = &(d->aqueue);
 1997                                 if (d->tty->t_state & TS_CAN_BYPASS_L_RINT) {
 1998                                         k = AQ_GSZ(q);
 1999                                         if (d->tty->t_rawq.c_cc + k >
 2000                                                 d->tty->t_ihiwat
 2001                                             && (d->tty->t_cflag & CRTS_IFLOW
 2002                                                 || d->tty->t_iflag & IXOFF)
 2003                                             && !(d->tty->t_state & TS_TBLOCK))
 2004                                                 ttyblock(d->tty);
 2005                                         d->tty->t_rawcc += k;
 2006                                         while (k>0) {
 2007                                                 k--;
 2008                                                 AQ_POP (q, ic);
 2009                                                 CX_UNLOCK (bd);
 2010                                                 splx (s);
 2011                                                 putc (ic, &d->tty->t_rawq);
 2012                                                 s = splhigh ();
 2013                                                 CX_LOCK (bd);
 2014                                         }
 2015                                         ttwakeup(d->tty);
 2016                                         if (d->tty->t_state & TS_TTSTOP
 2017                                             && (d->tty->t_iflag & IXANY
 2018                                                 || d->tty->t_cc[VSTART] ==
 2019                                                 d->tty->t_cc[VSTOP])) {
 2020                                                 d->tty->t_state &= ~TS_TTSTOP;
 2021                                                 d->tty->t_lflag &= ~FLUSHO;
 2022                                                 d->intr_action |= CX_WRITE;
 2023                                         }
 2024                                 } else {
 2025                                         while (q->end != q->beg) {
 2026                                                 AQ_POP (q, ic);
 2027                                                 CX_UNLOCK (bd);
 2028                                                 splx (s);
 2029                                                 ttyld_rint (d->tty, ic);
 2030                                                 s = splhigh ();
 2031                                                 CX_LOCK (bd);
 2032                                         }
 2033                                 }
 2034                                 d->intr_action &= ~CX_READ;
 2035                         }
 2036                         splx (s);
 2037                         CX_UNLOCK (bd);
 2038 
 2039                         s = splhigh ();
 2040                         CX_LOCK (bd);
 2041                         if (d->intr_action & CX_WRITE) {
 2042                                 if (d->tty->t_line)
 2043                                         ttyld_start (d->tty);
 2044                                 else
 2045                                         cx_oproc (d->tty);
 2046                                 d->intr_action &= ~CX_WRITE;
 2047                         }
 2048                         CX_UNLOCK (bd);
 2049                         splx (s);
 2050 
 2051                 }
 2052         }
 2053 }
 2054 
 2055 /*
 2056  * Fill transmitter buffer with data.
 2057  */
 2058 static void cx_oproc (struct tty *tp)
 2059 {
 2060         int s, k;
 2061         drv_t *d;
 2062         bdrv_t *bd;
 2063         static u_char buf[DMABUFSZ];
 2064         u_char *p;
 2065         u_short len = 0, sublen = 0;
 2066 
 2067         d = tp->t_sc;
 2068         bd = d->board->sys;
 2069 
 2070         CX_DEBUG2 (d, ("cx_oproc\n"));
 2071 
 2072         s = splhigh ();
 2073         CX_LOCK (bd);
 2074 
 2075         if (tp->t_cflag & CRTSCTS && (tp->t_state & TS_TBLOCK) && d->chan->rts)
 2076                 cx_set_rts (d->chan, 0);
 2077         else if (tp->t_cflag & CRTSCTS && ! (tp->t_state & TS_TBLOCK) && ! d->chan->rts)
 2078                 cx_set_rts (d->chan, 1);
 2079 
 2080         if (! (tp->t_state & (TS_TIMEOUT | TS_TTSTOP))) {
 2081                 /* Start transmitter. */
 2082                 cx_enable_transmit (d->chan, 1);
 2083 
 2084                 /* Is it busy? */
 2085                 if (! cx_buf_free (d->chan)) {
 2086                         tp->t_state |= TS_BUSY;
 2087                         CX_UNLOCK (bd);
 2088                         splx (s);
 2089                         return;
 2090                 }
 2091                 if (tp->t_iflag & IXOFF) {
 2092                         p = (buf + (DMABUFSZ/2));
 2093                         sublen = q_to_b (&tp->t_outq, p, (DMABUFSZ/2));
 2094                         k = sublen;
 2095                         while (k--) {
 2096                                 /* Send XON/XOFF out of band. */
 2097                                 if (*p == tp->t_cc[VSTOP]) {
 2098                                         cx_xflow_ctl (d->chan, 0);
 2099                                         p++;
 2100                                         continue;
 2101                                 }
 2102                                 if (*p == tp->t_cc[VSTART]) {
 2103                                         cx_xflow_ctl (d->chan, 1);
 2104                                         p++;
 2105                                         continue;
 2106                                 }
 2107                                 buf[len] = *p;
 2108                                 len++;
 2109                                 p++;
 2110                         }
 2111                 } else {
 2112                         p = buf;
 2113                         len = q_to_b (&tp->t_outq, p, (DMABUFSZ/2));
 2114                 }
 2115                 if (len) {
 2116                         cx_send_packet (d->chan, buf, len, 0);
 2117                         tp->t_state |= TS_BUSY;
 2118                         d->atimeout = 10;
 2119                         CX_DEBUG2 (d, ("out %d bytes\n", len));
 2120                 }
 2121         }
 2122         ttwwakeup (tp);
 2123         CX_UNLOCK (bd);
 2124         splx (s);
 2125 }
 2126 
 2127 static int cx_param (struct tty *tp, struct termios *t)
 2128 {
 2129         drv_t *d;
 2130         bdrv_t *bd;
 2131         int s, bits, parity;
 2132 
 2133         d = tp->t_sc;
 2134         bd = d->board->sys;
 2135         
 2136         s = splhigh ();
 2137         CX_LOCK (bd);
 2138         if (t->c_ospeed == 0) {
 2139                 /* Clear DTR and RTS. */
 2140                 cx_set_dtr (d->chan, 0);
 2141                 CX_UNLOCK (bd);
 2142                 splx (s);
 2143                 CX_DEBUG2 (d, ("cx_param (hangup)\n"));
 2144                 return 0;
 2145         }
 2146         CX_DEBUG2 (d, ("cx_param\n"));
 2147 
 2148         /* Check requested parameters. */
 2149         if (t->c_ospeed < 300 || t->c_ospeed > 256*1024) {
 2150                 CX_UNLOCK (bd);
 2151                 splx (s);
 2152                 return EINVAL;
 2153         }
 2154         if (t->c_ispeed && (t->c_ispeed < 300 || t->c_ispeed > 256*1024)) {
 2155                 CX_UNLOCK (bd);
 2156                 splx (s);
 2157                 return EINVAL;
 2158         }
 2159 
 2160         /* And copy them to tty and channel structures. */
 2161         tp->t_ispeed = t->c_ispeed = tp->t_ospeed = t->c_ospeed;
 2162         tp->t_cflag = t->c_cflag;
 2163 
 2164         /* Set character length and parity mode. */
 2165         switch (t->c_cflag & CSIZE) {
 2166         default:
 2167         case CS8: bits = 8; break;
 2168         case CS7: bits = 7; break;
 2169         case CS6: bits = 6; break;
 2170         case CS5: bits = 5; break;
 2171         }
 2172 
 2173         parity = ((t->c_cflag & PARENB) ? 1 : 0) *
 2174                  (1 + ((t->c_cflag & PARODD) ? 0 : 1));
 2175 
 2176         /* Set current channel number. */
 2177         if (! d->chan->dtr)
 2178                 cx_set_dtr (d->chan, 1);
 2179 
 2180         ttyldoptim (tp);
 2181         cx_set_async_param (d->chan, t->c_ospeed, bits, parity, (t->c_cflag & CSTOPB),
 2182                 !(t->c_cflag & PARENB), (t->c_cflag & CRTSCTS),
 2183                 (t->c_iflag & IXON), (t->c_iflag & IXANY),
 2184                 t->c_cc[VSTART], t->c_cc[VSTOP]);
 2185         CX_UNLOCK (bd);
 2186         splx (s);
 2187         return 0;
 2188 }
 2189 
 2190 /*
 2191  * Stop output on a line
 2192  */
 2193 static void cx_stop (struct tty *tp, int flag)
 2194 {
 2195         drv_t *d;
 2196         bdrv_t *bd;
 2197         int s;
 2198 
 2199         d = tp->t_sc;
 2200         bd = d->board->sys;
 2201         
 2202         s = splhigh ();
 2203         CX_LOCK (bd);
 2204         if (tp->t_state & TS_BUSY) {
 2205                 /* Stop transmitter */
 2206                 CX_DEBUG2 (d, ("cx_stop\n"));
 2207                 cx_transmitter_ctl (d->chan, 0);
 2208         }
 2209         CX_UNLOCK (bd);
 2210         splx (s);
 2211 }
 2212 
 2213 /*
 2214  * Process the (delayed) carrier signal setup.
 2215  */
 2216 static void cx_carrier (void *arg)
 2217 {
 2218         drv_t *d = arg;
 2219         bdrv_t *bd = d->board->sys;
 2220         cx_chan_t *c = d->chan;
 2221         int s, cd;
 2222 
 2223         s = splhigh ();
 2224         CX_LOCK (bd);
 2225         cd = cx_get_cd (c);
 2226         if (d->cd != cd) {
 2227                 if (cd) {
 2228                         CX_DEBUG (d, ("carrier on\n"));
 2229                         d->cd = 1;
 2230                         CX_UNLOCK (bd);
 2231                         splx (s);
 2232                         if (d->tty)
 2233                                 ttyld_modem(d->tty, 1);
 2234                 } else {
 2235                         CX_DEBUG (d, ("carrier loss\n"));
 2236                         d->cd = 0;
 2237                         CX_UNLOCK (bd);
 2238                         splx (s);
 2239                         if (d->tty)
 2240                                 ttyld_modem(d->tty, 0);
 2241                 }
 2242         } else {
 2243                 CX_UNLOCK (bd);
 2244                 splx (s);
 2245         }
 2246 }
 2247 
 2248 /*
 2249  * Modem signal callback function.
 2250  */
 2251 static void cx_modem (cx_chan_t *c)
 2252 {
 2253         drv_t *d = c->sys;
 2254 
 2255         if (!d || c->mode != M_ASYNC)
 2256                 return;
 2257         /* Handle carrier detect/loss. */
 2258         /* Carrier changed - delay processing DCD for a while
 2259          * to give both sides some time to initialize. */
 2260         callout_reset (&d->dcd_timeout_handle, hz/2, cx_carrier, d);
 2261 }
 2262 
 2263 static struct cdevsw cx_cdevsw = {
 2264         .d_version  = D_VERSION,
 2265         .d_open     = cx_open,
 2266         .d_close    = cx_close,
 2267         .d_ioctl    = cx_ioctl,
 2268         .d_name     = "cx",
 2269         .d_flags    = D_TTY | D_NEEDGIANT,
 2270 };
 2271 
 2272 #ifdef NETGRAPH
 2273 static int ng_cx_constructor (node_p node)
 2274 {
 2275         drv_t *d = NG_NODE_PRIVATE (node);
 2276         CX_DEBUG (d, ("Constructor\n"));
 2277         return EINVAL;
 2278 }
 2279 
 2280 static int ng_cx_newhook (node_p node, hook_p hook, const char *name)
 2281 {
 2282         int s;
 2283         drv_t *d = NG_NODE_PRIVATE (node);
 2284         bdrv_t *bd = d->board->sys;
 2285 
 2286         if (d->chan->mode == M_ASYNC)
 2287                 return EINVAL;
 2288 
 2289         /* Attach debug hook */
 2290         if (strcmp (name, NG_CX_HOOK_DEBUG) == 0) {
 2291                 NG_HOOK_SET_PRIVATE (hook, NULL);
 2292                 d->debug_hook = hook;
 2293                 return 0;
 2294         }
 2295 
 2296         /* Check for raw hook */
 2297         if (strcmp (name, NG_CX_HOOK_RAW) != 0)
 2298                 return EINVAL;
 2299 
 2300         NG_HOOK_SET_PRIVATE (hook, d);
 2301         d->hook = hook;
 2302         s = splhigh ();
 2303         CX_LOCK (bd);
 2304         cx_up (d);
 2305         CX_UNLOCK (bd);
 2306         splx (s);
 2307         return 0;
 2308 }
 2309 
 2310 static int print_modems (char *s, cx_chan_t *c, int need_header)
 2311 {
 2312         int status = cx_modem_status (c->sys);
 2313         int length = 0;
 2314 
 2315         if (need_header)
 2316                 length += sprintf (s + length, "  LE   DTR  DSR  RTS  CTS  CD\n");
 2317         length += sprintf (s + length, "%4s %4s %4s %4s %4s %4s\n",
 2318                 status & TIOCM_LE  ? "On" : "-",
 2319                 status & TIOCM_DTR ? "On" : "-",
 2320                 status & TIOCM_DSR ? "On" : "-",
 2321                 status & TIOCM_RTS ? "On" : "-",
 2322                 status & TIOCM_CTS ? "On" : "-",
 2323                 status & TIOCM_CD  ? "On" : "-");
 2324         return length;
 2325 }
 2326 
 2327 static int print_stats (char *s, cx_chan_t *c, int need_header)
 2328 {
 2329         int length = 0;
 2330 
 2331         if (need_header)
 2332                 length += sprintf (s + length, "  Rintr   Tintr   Mintr   Ibytes   Ipkts   Ierrs   Obytes   Opkts   Oerrs\n");
 2333         length += sprintf (s + length, "%7ld %7ld %7ld %8ld %7ld %7ld %8ld %7ld %7ld\n",
 2334                 c->rintr, c->tintr, c->mintr, c->ibytes, c->ipkts,
 2335                 c->ierrs, c->obytes, c->opkts, c->oerrs);
 2336         return length;
 2337 }
 2338 
 2339 static int print_chan (char *s, cx_chan_t *c)
 2340 {
 2341         drv_t *d = c->sys;
 2342         int length = 0;
 2343 
 2344         length += sprintf (s + length, "cx%d", c->board->num * NCHAN + c->num);
 2345         if (d->chan->debug)
 2346                 length += sprintf (s + length, " debug=%d", d->chan->debug);
 2347 
 2348         if (cx_get_baud (c))
 2349                 length += sprintf (s + length, " %ld", cx_get_baud (c));
 2350         else
 2351                 length += sprintf (s + length, " extclock");
 2352 
 2353         if (c->mode == M_HDLC) {
 2354                 length += sprintf (s + length, " dpll=%s", cx_get_dpll (c) ? "on" : "off");
 2355                 length += sprintf (s + length, " nrzi=%s", cx_get_nrzi (c) ? "on" : "off");
 2356         }
 2357 
 2358         length += sprintf (s + length, " loop=%s", cx_get_loop (c) ? "on\n" : "off\n");
 2359         return length;
 2360 }
 2361 
 2362 static int ng_cx_rcvmsg (node_p node, item_p item, hook_p lasthook)
 2363 {
 2364         drv_t *d = NG_NODE_PRIVATE (node);
 2365         struct ng_mesg *msg;
 2366         struct ng_mesg *resp = NULL;
 2367         int error = 0;
 2368 
 2369         if (!d)
 2370                 return EINVAL;
 2371                 
 2372         CX_DEBUG (d, ("Rcvmsg\n"));
 2373         NGI_GET_MSG (item, msg);
 2374         switch (msg->header.typecookie) {
 2375         default:
 2376                 error = EINVAL;
 2377                 break;
 2378 
 2379         case NGM_CX_COOKIE:
 2380                 printf ("Don't forget to implement\n");
 2381                 error = EINVAL;
 2382                 break;
 2383 
 2384         case NGM_GENERIC_COOKIE:
 2385                 switch (msg->header.cmd) {
 2386                 default:
 2387                         error = EINVAL;
 2388                         break;
 2389 
 2390                 case NGM_TEXT_STATUS: {
 2391                         char *s;
 2392                         int l = 0;
 2393                         int dl = sizeof (struct ng_mesg) + 730;
 2394 
 2395                         NG_MKRESPONSE (resp, msg, dl, M_NOWAIT);
 2396                         if (! resp) {
 2397                                 error = ENOMEM;
 2398                                 break;
 2399                         }
 2400                         bzero (resp, dl);
 2401                         s = (resp)->data;
 2402                         l += print_chan (s + l, d->chan);
 2403                         l += print_stats (s + l, d->chan, 1);
 2404                         l += print_modems (s + l, d->chan, 1);
 2405                         strncpy ((resp)->header.cmdstr, "status", NG_CMDSTRLEN);
 2406                         }
 2407                         break;
 2408                 }
 2409                 break;
 2410         }
 2411         NG_RESPOND_MSG (error, node, item, resp);
 2412         NG_FREE_MSG (msg);
 2413         return error;
 2414 }
 2415 
 2416 static int ng_cx_rcvdata (hook_p hook, item_p item)
 2417 {
 2418         drv_t *d = NG_NODE_PRIVATE (NG_HOOK_NODE(hook));
 2419         struct mbuf *m;
 2420         struct ng_tag_prio *ptag;
 2421         bdrv_t *bd;
 2422         struct ifqueue *q;
 2423         int s;
 2424 
 2425         NGI_GET_M (item, m);
 2426         NG_FREE_ITEM (item);
 2427         if (! NG_HOOK_PRIVATE (hook) || ! d) {
 2428                 NG_FREE_M (m);
 2429                 return ENETDOWN;
 2430         }
 2431 
 2432         bd = d->board->sys;
 2433         /* Check for high priority data */
 2434         if ((ptag = (struct ng_tag_prio *)m_tag_locate(m, NGM_GENERIC_COOKIE,
 2435             NG_TAG_PRIO, NULL)) != NULL && (ptag->priority > NG_PRIO_CUTOFF) )
 2436                 q = &d->hi_queue;
 2437         else
 2438                 q = &d->lo_queue;
 2439 
 2440         s = splhigh ();
 2441         CX_LOCK (bd);
 2442         IF_LOCK (q);
 2443         if (_IF_QFULL (q)) {
 2444                 _IF_DROP (q);
 2445                 IF_UNLOCK (q);
 2446                 CX_UNLOCK (bd);
 2447                 splx (s);
 2448                 NG_FREE_M (m);
 2449                 return ENOBUFS;
 2450         }
 2451         _IF_ENQUEUE (q, m);
 2452         IF_UNLOCK (q);
 2453         cx_start (d);
 2454         CX_UNLOCK (bd);
 2455         splx (s);
 2456         return 0;
 2457 }
 2458 
 2459 static int ng_cx_rmnode (node_p node)
 2460 {
 2461         drv_t *d = NG_NODE_PRIVATE (node);
 2462         bdrv_t *bd;
 2463 
 2464         CX_DEBUG (d, ("Rmnode\n"));
 2465         if (d && d->running) {
 2466                 int s = splhigh ();
 2467                 bd = d->board->sys;
 2468                 CX_LOCK (bd);
 2469                 cx_down (d);
 2470                 CX_UNLOCK (bd);
 2471                 splx (s);
 2472         }
 2473 #ifdef  KLD_MODULE
 2474         if (node->nd_flags & NGF_REALLY_DIE) {
 2475                 NG_NODE_SET_PRIVATE (node, NULL);
 2476                 NG_NODE_UNREF (node);
 2477         }
 2478         NG_NODE_REVIVE(node);           /* Persistant node */
 2479 #endif
 2480         return 0;
 2481 }
 2482 
 2483 static void ng_cx_watchdog (void *arg)
 2484 {
 2485         drv_t *d = arg;
 2486 
 2487         if (d->timeout == 1)
 2488                 cx_watchdog (d);
 2489         if (d->timeout)
 2490                 d->timeout--;
 2491         callout_reset (&d->timeout_handle, hz, ng_cx_watchdog, d);
 2492 }
 2493 
 2494 static int ng_cx_connect (hook_p hook)
 2495 {
 2496         drv_t *d = NG_NODE_PRIVATE (NG_HOOK_NODE (hook));
 2497 
 2498         callout_reset (&d->timeout_handle, hz, ng_cx_watchdog, d);
 2499         return 0;
 2500 }
 2501 
 2502 static int ng_cx_disconnect (hook_p hook)
 2503 {
 2504         drv_t *d = NG_NODE_PRIVATE (NG_HOOK_NODE (hook));
 2505         bdrv_t *bd = d->board->sys;
 2506         int s;
 2507 
 2508         s = splhigh ();
 2509         CX_LOCK (bd);
 2510         if (NG_HOOK_PRIVATE (hook))
 2511                 cx_down (d);
 2512         CX_UNLOCK (bd);
 2513         splx (s);
 2514         /* If we were wait it than it reasserted now, just stop it. */
 2515         if (!callout_drain (&d->timeout_handle))
 2516                 callout_stop (&d->timeout_handle);
 2517         return 0;
 2518 }
 2519 #endif /*NETGRAPH*/
 2520 
 2521 static int cx_modevent (module_t mod, int type, void *unused)
 2522 {
 2523         static int load_count = 0;
 2524 
 2525         if (!debug_mpsafenet && cx_mpsafenet) {
 2526                 printf ("WORNING! Network stack is not MPSAFE. "
 2527                         "Turning off debug.cx.mpsafenet.\n");
 2528                 cx_mpsafenet = 0;
 2529         }
 2530         if (cx_mpsafenet)
 2531                 cx_cdevsw.d_flags &= ~D_NEEDGIANT;
 2532 
 2533         switch (type) {
 2534         case MOD_LOAD:
 2535 #ifdef NETGRAPH
 2536                 if (ng_newtype (&typestruct))
 2537                         printf ("Failed to register ng_cx\n");
 2538 #endif
 2539                 ++load_count;
 2540 
 2541                 callout_init (&timeout_handle, cx_mpsafenet?CALLOUT_MPSAFE:0);
 2542                 callout_reset (&timeout_handle, hz*5, cx_timeout, 0);
 2543                 /* Software interrupt. */
 2544                 swi_add(&tty_intr_event, "cx", cx_softintr, NULL, SWI_TTY,
 2545                     (cx_mpsafenet?INTR_MPSAFE:0), &cx_fast_ih);
 2546                 break;
 2547         case MOD_UNLOAD:
 2548                 if (load_count == 1) {
 2549                         printf ("Removing device entry for Sigma\n");
 2550 #ifdef NETGRAPH
 2551                         ng_rmtype (&typestruct);
 2552 #endif                  
 2553                 }
 2554                 /* If we were wait it than it reasserted now, just stop it. */
 2555                 if (!callout_drain (&timeout_handle))
 2556                         callout_stop (&timeout_handle);
 2557                 swi_remove (cx_fast_ih);
 2558                 --load_count;
 2559                 break;
 2560         case MOD_SHUTDOWN:
 2561                 break;
 2562         }
 2563         return 0;
 2564 }
 2565 
 2566 #ifdef NETGRAPH
 2567 static struct ng_type typestruct = {
 2568         .version        = NG_ABI_VERSION,
 2569         .name           = NG_CX_NODE_TYPE,
 2570         .constructor    = ng_cx_constructor,
 2571         .rcvmsg         = ng_cx_rcvmsg,
 2572         .shutdown       = ng_cx_rmnode,
 2573         .newhook        = ng_cx_newhook,
 2574         .connect        = ng_cx_connect,
 2575         .rcvdata        = ng_cx_rcvdata,
 2576         .disconnect     = ng_cx_disconnect,
 2577 };
 2578 #endif /*NETGRAPH*/
 2579 
 2580 #ifdef NETGRAPH
 2581 MODULE_DEPEND (ng_cx, netgraph, NG_ABI_VERSION, NG_ABI_VERSION, NG_ABI_VERSION);
 2582 #else
 2583 MODULE_DEPEND (isa_cx, sppp, 1, 1, 1);
 2584 #endif
 2585 DRIVER_MODULE (cx, isa, cx_isa_driver, cx_devclass, cx_modevent, NULL);
 2586 MODULE_VERSION (cx, 1);

Cache object: 62ae0310b17f58d2d183bb27331df8b9


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