?? if_cx.c
字號:
/* * Cronyx-Sigma adapter driver for FreeBSD. * Supports PPP/HDLC and Cisco/HDLC protocol in synchronous mode, * and asyncronous channels with full modem control. * Keepalive protocol implemented in both Cisco and PPP modes. * * Copyright (C) 1994 Cronyx Ltd. * Author: Serge Vakulenko, <vak@zebub.msk.su> * * This software is distributed with NO WARRANTIES, not even the implied * warranties for MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. * * Authors grant any other persons or organisations permission to use * or modify this software as long as this message is kept with the software, * all derivative works or modified versions. * * Version 1.9, Wed Oct 4 18:58:15 MSK 1995 */#undef DEBUG#include "cx.h"#if NCX > 0#include <bpfilter.h>#include <sys/param.h>#include <sys/systm.h>#include <sys/kernel.h>#include <sys/mbuf.h>#include <sys/ioctl.h>#include <sys/socket.h>#include <sys/conf.h>#include <sys/errno.h>#include <net/if.h>#include <net/if_types.h>#if NBPFILTER > 0#include <net/bpf.h>#include <net/bpfdesc.h>#endif#ifdef __FreeBSD__# include <i386/isa/isa_device.h># if __FreeBSD__ < 2# include <machine/pio.h># else# include <machine/cpufunc.h># include <sys/devconf.h># endif# define init_func_t void(*)(int)# define watchdog_func_t void(*)(int)# define start_func_t void(*)(struct ifnet*)#endif#ifdef __bsdi__# if INET# include <netinet/in.h># include <netinet/in_systm.h># include <netinet/ip.h># endif# include <sys/device.h># include <i386/isa/isavar.h># include <i386/isa/icu.h># include <machine/inline.h># include <net/if_slvar.h># include <net/if_p2p.h># define timeout_func_t void(*)()# define init_func_t int(*)()# define watchdog_func_t int(*)()# define start_func_t int(*)()struct cxsoftc { struct device dev; /* base device */ struct isadev isadev; /* ISA device */ struct intrhand intr; /* interrupt vectoring */};#endif#include <net/if_sppp.h>#include <machine/cronyx.h>#include <i386/isa/cxreg.h>#ifdef DEBUG# define print(s) printf s#else# define print(s) {/*void*/}#endif#define TXTIMEOUT 10 /* transmit timeout in seconds */#define DMABUFSZ (6*256) /* buffer size */#define PPP_HEADER_LEN 4 /* size of PPP header *//* * Under BSDI it's possible to use general p2p protocol scheme, * as well as our own one. Switching is done via IFF_ALTPHYS flag. * Our ifnet pointer holds the buffer large enough to contain * any of sppp and p2p structures. */#ifdef __bsdi__# define SPPPSZ (sizeof (struct sppp))# define P2PSZ (sizeof (struct p2pcom))# define IFSTRUCTSZ (SPPPSZ>P2PSZ ? SPPPSZ : P2PSZ)#else# define IFSTRUCTSZ (sizeof (struct sppp))#endif#define IFNETSZ (sizeof (struct ifnet))int cxsioctl (struct ifnet *ifp, int cmd, caddr_t data);void cxinit (int unit);void cxstart (struct ifnet *ifp);void cxwatchdog (int unit);void cxinput (cx_chan_t *c, void *buf, unsigned len);int cxrinta (cx_chan_t *c);void cxtinta (cx_chan_t *c);void cxmint (cx_chan_t *c);void cxtimeout (caddr_t a);void cxdown (cx_chan_t *c);void cxup (cx_chan_t *c);cx_board_t cxboard [NCX]; /* adapter state structures */cx_chan_t *cxchan [NCX*NCHAN]; /* unit to channel struct pointer */static unsigned short irq_valid_values [] = { 3, 5, 7, 10, 11, 12, 15, 0 };static unsigned short drq_valid_values [] = { 5, 6, 7, 0 };static unsigned short port_valid_values [] = { 0x240, 0x260, 0x280, 0x300, 0x320, 0x380, 0x3a0, 0,};#if __FreeBSD__ >= 2static char cxdescription [80];struct kern_devconf kdc_cx [NCX] = { { 0, 0, 0, "cx", 0, { MDDT_ISA, 0, "net" }, isa_generic_externalize, 0, 0, ISA_EXTERNALLEN, &kdc_isa0, 0, DC_IDLE, cxdescription, DC_CLS_SERIAL} };#endif/* * Check that the value is contained in the list of correct values. */static int valid (unsigned short value, unsigned short *list){ while (*list) if (value == *list++) return (1); return (0);}/* * Print the mbuf chain, for debug purposes only. */static void printmbuf (struct mbuf *m){ printf ("mbuf:"); for (; m; m=m->m_next) { if (m->m_flags & M_PKTHDR) printf (" HDR %d:", m->m_pkthdr.len); if (m->m_flags & M_EXT) printf (" EXT:"); printf (" %d", m->m_len); } printf ("\n");}/* * Make an mbuf from data. */static struct mbuf *makembuf (void *buf, unsigned len){ struct mbuf *m, *o, *p; MGETHDR (m, M_DONTWAIT, MT_DATA); if (! m) return (0); if (len >= MINCLSIZE) MCLGET (m, M_DONTWAIT); m->m_pkthdr.len = len; m->m_len = 0; p = m; while (len) { unsigned n = M_TRAILINGSPACE (p); if (n > len) n = len; if (! n) { /* Allocate new mbuf. */ o = p; MGET (p, M_DONTWAIT, MT_DATA); if (! p) { m_freem (m); return (0); } if (len >= MINCLSIZE) MCLGET (p, M_DONTWAIT); p->m_len = 0; o->m_next = p; n = M_TRAILINGSPACE (p); if (n > len) n = len; } bcopy (buf, mtod (p, caddr_t) + p->m_len, n); p->m_len += n; buf += n; len -= n; } return (m);}/* * Test the presence of the adapter on the given i/o port. */#ifdef __FreeBSD__int cxprobe (struct isa_device *id){ int unit = id->id_unit; int iobase = id->id_iobase; int irq = id->id_irq; int drq = id->id_drq; int irqnum;#endif#ifdef __bsdi__int cxprobe (struct device *parent, struct cfdata *cf, void *aux){ int unit = cf->cf_unit; int iobase = ((struct isa_attach_args*)aux)->ia_iobase; int irq = ((struct isa_attach_args*)aux)->ia_irq; int drq = ((struct isa_attach_args*)aux)->ia_drq; int irqnum, i; for (i=0; i<NCX; ++i) if (i != unit && cxboard[i].port == iobase) return (0); if (irq == IRQUNK) { irq = isa_irqalloc (IRQ3|IRQ5|IRQ7|IRQ10|IRQ11|IRQ12|IRQ15); if (! irq) return (0); ((struct isa_attach_args*)aux)->ia_irq = irq; }#endif irqnum = ffs (irq) - 1; print (("cx%d: probe iobase=0x%x irq=%d drq=%d\n", unit, iobase, irqnum, drq)); if (! valid (irqnum, irq_valid_values)) { printf ("cx%d: Incorrect IRQ: %d\n", unit, irqnum); return (0); } if (! valid (iobase, port_valid_values)) { printf ("cx%d: Incorrect port address: 0x%x\n", unit, iobase); return (0); } if (! valid (drq, drq_valid_values)) { printf ("cx%d: Incorrect DMA channel: %d\n", unit, drq); return (0); } if (! cx_probe_board (iobase)) return (0); return (1);}/* * The adapter is present, initialize the driver structures. */#ifdef __FreeBSD__int cxattach (struct isa_device *id){ int unit = id->id_unit; int iobase = id->id_iobase; int irq = id->id_irq; int drq = id->id_drq;#endif#ifdef __bsdi__void cxattach (struct device *parent, struct device *self, void *aux){ int unit = self->dv_unit; int iobase = ((struct isa_attach_args*)aux)->ia_iobase; int irq = ((struct isa_attach_args*)aux)->ia_irq; int drq = ((struct isa_attach_args*)aux)->ia_drq; struct cxsoftc *sc = (struct cxsoftc*) self; void cxintr (cx_board_t *b);#endif cx_board_t *b = cxboard + unit; int i; /* Initialize the board structure. */ cx_init (b, unit, iobase, ffs(irq)-1, drq); for (i=0; i<NCHAN; ++i) { cx_chan_t *c = b->chan + i; int u = b->num*NCHAN + i; cxchan[u] = c; if (c->type == T_NONE) continue; /* Allocate the buffer memory. */ c->arbuf = malloc (DMABUFSZ, M_DEVBUF, M_NOWAIT); c->brbuf = malloc (DMABUFSZ, M_DEVBUF, M_NOWAIT); c->atbuf = malloc (DMABUFSZ, M_DEVBUF, M_NOWAIT); c->btbuf = malloc (DMABUFSZ, M_DEVBUF, M_NOWAIT); /* All buffers should be located in lower 16M of memory! */ if (!c->arbuf || !c->brbuf || !c->atbuf || !c->btbuf) { printf ("cx%d.%d: No memory for channel buffers\n", c->board->num, c->num); c->type = T_NONE; } switch (c->type) { case T_SYNC_RS232: case T_SYNC_V35: case T_SYNC_RS449: case T_UNIV_RS232: case T_UNIV_RS449: case T_UNIV_V35: c->ifp = malloc (IFSTRUCTSZ, M_DEVBUF, M_NOWAIT); if (! c->ifp) { printf ("cx%d.%d: No memory for ifnet buffer\n", c->board->num, c->num); c->type = T_NONE; continue; } bzero (c->ifp, IFSTRUCTSZ); c->master = c->ifp; c->ifp->if_unit = u; c->ifp->if_name = "cx"; c->ifp->if_mtu = PP_MTU; c->ifp->if_flags = IFF_POINTOPOINT | IFF_MULTICAST; c->ifp->if_ioctl = cxsioctl; c->ifp->if_start = (start_func_t) cxstart; c->ifp->if_watchdog = (watchdog_func_t) cxwatchdog; /* Init routine is never called by upper level? */ c->ifp->if_init = (init_func_t) cxinit; sppp_attach (c->ifp); if_attach (c->ifp);#if NBPFILTER > 0 /* If BPF is in the kernel, call the attach for it. */ bpfattach (&c->bpf, c->ifp, DLT_PPP, PPP_HEADER_LEN);#endif } } /* Reset the adapter. */ cx_setup_board (b); /* Activate the timeout routine. */ if (unit == 0) timeout ((timeout_func_t) cxtimeout, 0, hz*5);#if __FreeBSD__ >= 2 if (unit != 0) kdc_cx[unit] = kdc_cx[0]; kdc_cx[unit].kdc_unit = unit; kdc_cx[unit].kdc_isa = id; sprintf (cxdescription, "Cronyx-Sigma-%s sync/async serial adapter", b->name); dev_attach (&kdc_cx[unit]);#endif#ifdef __FreeBSD__ printf ("cx%d: <Cronyx-%s>\n", unit, b->name); return (1);#endif#ifdef __bsdi__ printf (": <Cronyx-%s>\n", b->name); isa_establish (&sc->isadev, &sc->dev); sc->intr.ih_fun = (int(*)()) cxintr; sc->intr.ih_arg = (void*) b; intr_establish (irq, &sc->intr, DV_NET);#endif}#ifdef __FreeBSD__struct isa_driver cxdriver = { cxprobe, cxattach, "cx" };#endif#ifdef __bsdi__struct cfdriver cxcd = { 0, "cx", cxprobe, cxattach, sizeof (struct cxsoftc) };#endif/* * Process an ioctl request. */int cxsioctl (struct ifnet *ifp, int cmd, caddr_t data){ cx_chan_t *q, *c = cxchan[ifp->if_unit]; int error, s, was_up, should_be_up; /* * No socket ioctls while the channel is in async mode. */ if (c->type==T_NONE || c->mode==M_ASYNC) return (EINVAL); /* * Socket ioctls on slave subchannels are not allowed. */ if (c->master != c->ifp) return (EBUSY); was_up = (ifp->if_flags & IFF_RUNNING) != 0;#ifdef __bsdi__ if (c->sopt.ext) error = p2p_ioctl (ifp, cmd, data); else#endif error = sppp_ioctl (ifp, cmd, data); if (error) return (error); print (("cxioctl (%d.%d, ", c->board->num, c->num)); switch (cmd) { default: print (("0x%x)\n", cmd)); return (0); case SIOCADDMULTI: print (("SIOCADDMULTI)\n")); return (0); case SIOCDELMULTI: print (("SIOCDELMULTI)\n")); return (0); case SIOCSIFFLAGS: print (("SIOCSIFFLAGS)\n")); break; case SIOCSIFADDR: print (("SIOCSIFADDR)\n")); break; } /* We get here only in case of SIFFLAGS or SIFADDR. */ s = splimp (); should_be_up = (ifp->if_flags & IFF_RUNNING) != 0; if (!was_up && should_be_up) { /* Interface goes up -- start it. */ cxup (c); /* Start all slave subchannels. */ for (q=c->slaveq; q; q=q->slaveq) cxup (q); cxstart (c->ifp); } else if (was_up && !should_be_up) { /* Interface is going down -- stop it. */ cxdown (c); /* Stop all slave subchannels. */ for (q=c->slaveq; q; q=q->slaveq) cxdown (q); /* Flush the interface output queue */ if (! c->sopt.ext) sppp_flush (c->ifp); } splx (s); return (0);}/* * Stop the interface. Called on splimp(). */void cxdown (cx_chan_t *c){ unsigned short port = c->chip->port; print (("cx%d.%d: cxdown\n", c->board->num, c->num)); /* The interface is down, stop it */ c->ifp->if_flags &= ~IFF_OACTIVE; /* Reset the channel (for sync modes only) */ outb (CAR(port), c->num & 3); outb (STCR(port), STC_ABORTTX | STC_SNDSPC); cx_setup_chan (c);}/* * Start the interface. Called on splimp(). */void cxup (cx_chan_t *c){ unsigned short port = c->chip->port; /* The interface is up, start it */ print (("cx%d.%d: cxup\n", c->board->num, c->num));
?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -