sys/dev/cx/if_cx.c

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