/* * Copyright (c) 1997, 2001 Hellmuth Michaelis. All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. * *--------------------------------------------------------------------------- * * i4b_rbch.c - device driver for raw B channel data * --------------------------------------------------- * * $FreeBSD$ * * last edit-date: [Fri Jan 12 14:32:16 2001] * *---------------------------------------------------------------------------*/ #include "i4brbch.h" #if NI4BRBCH > 0 #include #include #include #include #include #include #include #include #include #if defined(__NetBSD__) && __NetBSD_Version__ >= 104230000 #include #endif #if defined (__NetBSD__) || defined (__OpenBSD__) extern cc_t ttydefchars; #define termioschars(t) memcpy((t)->c_cc, &ttydefchars, sizeof((t)->c_cc)) #endif #ifdef __FreeBSD__ #ifdef DEVFS #include #endif #endif /* __FreeBSD__ */ #ifdef __NetBSD__ #include #endif #ifdef __FreeBSD__ #include #include #include #else #include #include #include #endif #include #include #include #include #ifdef __bsdi__ #include #endif #ifdef OS_USES_POLL #include #include #else #include #include #endif #if defined(__FreeBSD__) #include #endif static drvr_link_t rbch_drvr_linktab[NI4BRBCH]; static isdn_link_t *isdn_linktab[NI4BRBCH]; #define I4BRBCHACCT 1 /* enable accounting messages */ #define I4BRBCHACCTINTVL 2 /* accounting msg interval in secs */ static struct rbch_softc { int sc_unit; /* unit number */ int sc_devstate; /* state of driver */ #define ST_IDLE 0x00 #define ST_CONNECTED 0x01 #define ST_ISOPEN 0x02 #define ST_RDWAITDATA 0x04 #define ST_WRWAITEMPTY 0x08 #define ST_NOBLOCK 0x10 int sc_bprot; /* B-ch protocol used */ call_desc_t *sc_cd; /* Call Descriptor */ struct termios it_in; struct ifqueue sc_hdlcq; /* hdlc read queue */ #define I4BRBCHMAXQLEN 10 struct selinfo selp; /* select / poll */ #if I4BRBCHACCT #if defined(__FreeBSD__) struct callout_handle sc_callout; #endif #if defined(__NetBSD__) && __NetBSD_Version__ >= 104230000 struct callout sc_callout; #endif int sc_iinb; /* isdn driver # of inbytes */ int sc_ioutb; /* isdn driver # of outbytes */ int sc_linb; /* last # of bytes rx'd */ int sc_loutb; /* last # of bytes tx'd */ int sc_fn; /* flag, first null acct */ #endif } rbch_softc[NI4BRBCH]; static void rbch_rx_data_rdy(int unit); static void rbch_tx_queue_empty(int unit); static void rbch_connect(int unit, void *cdp); static void rbch_disconnect(int unit, void *cdp); static void rbch_init_linktab(int unit); static void rbch_clrq(int unit); #ifndef __FreeBSD__ #define PDEVSTATIC /* - not static - */ #define IOCTL_CMD_T u_long void i4brbchattach __P((void)); int i4brbchopen __P((dev_t dev, int flag, int fmt, struct thread *td)); int i4brbchclose __P((dev_t dev, int flag, int fmt, struct thread *td)); int i4brbchread __P((dev_t dev, struct uio *uio, int ioflag)); int i4brbchwrite __P((dev_t dev, struct uio *uio, int ioflag)); int i4brbchioctl __P((dev_t dev, IOCTL_CMD_T cmd, caddr_t arg, int flag, struct thread *td)); #ifdef OS_USES_POLL int i4brbchpoll __P((dev_t dev, int events, struct thread *td)); #else PDEVSTATIC int i4brbchselect __P((dev_t dev, int rw, struct thread *td)); #endif #endif #if BSD > 199306 && defined(__FreeBSD__) #define PDEVSTATIC static #define IOCTL_CMD_T u_long PDEVSTATIC d_open_t i4brbchopen; PDEVSTATIC d_close_t i4brbchclose; PDEVSTATIC d_read_t i4brbchread; PDEVSTATIC d_read_t i4brbchwrite; PDEVSTATIC d_ioctl_t i4brbchioctl; #ifdef OS_USES_POLL PDEVSTATIC d_poll_t i4brbchpoll; #define POLLFIELD i4brbchpoll #else PDEVSTATIC d_select_t i4brbchselect; #define POLLFIELD i4brbchselect #endif #define CDEV_MAJOR 57 static struct cdevsw i4brbch_cdevsw = { /* open */ i4brbchopen, /* close */ i4brbchclose, /* read */ i4brbchread, /* write */ i4brbchwrite, /* ioctl */ i4brbchioctl, /* poll */ POLLFIELD, /* mmap */ nommap, /* strategy */ nostrategy, /* name */ "i4brbch", /* maj */ CDEV_MAJOR, /* dump */ nodump, /* psize */ nopsize, /* flags */ 0, }; static void i4brbchattach(void *); PSEUDO_SET(i4brbchattach, i4b_rbch); /*===========================================================================* * DEVICE DRIVER ROUTINES *===========================================================================*/ /*---------------------------------------------------------------------------* * initialization at kernel load time *---------------------------------------------------------------------------*/ static void i4brbchinit(void *unused) { cdevsw_add(&i4brbch_cdevsw); } SYSINIT(i4brbchdev, SI_SUB_DRIVERS, SI_ORDER_MIDDLE+CDEV_MAJOR, &i4brbchinit, NULL); #endif /* BSD > 199306 && defined(__FreeBSD__) */ #ifdef __bsdi__ int i4brbchmatch(struct device *parent, struct cfdata *cf, void *aux); void dummy_i4brbchattach(struct device*, struct device *, void *); #define CDEV_MAJOR 61 static struct cfdriver i4brbchcd = { NULL, "i4brbch", i4brbchmatch, dummy_i4brbchattach, DV_DULL, sizeof(struct cfdriver) }; struct devsw i4brbchsw = { &i4brbchcd, i4brbchopen, i4brbchclose, i4brbchread, i4brbchwrite, i4brbchioctl, seltrue, nommap, nostrat, nodump, nopsize, 0, nostop }; int i4brbchmatch(struct device *parent, struct cfdata *cf, void *aux) { printf("i4brbchmatch: aux=0x%x\n", aux); return 1; } void dummy_i4brbchattach(struct device *parent, struct device *self, void *aux) { printf("dummy_i4brbchattach: aux=0x%x\n", aux); } #endif /* __bsdi__ */ /*---------------------------------------------------------------------------* * interface attach routine *---------------------------------------------------------------------------*/ PDEVSTATIC void #ifdef __FreeBSD__ i4brbchattach(void *dummy) #else i4brbchattach() #endif { int i; #ifndef HACK_NO_PSEUDO_ATTACH_MSG printf("i4brbch: %d raw B channel access device(s) attached\n", NI4BRBCH); #endif for(i=0; i < NI4BRBCH; i++) { #if defined(__FreeBSD__) make_dev(&i4brbch_cdevsw, i, UID_ROOT, GID_WHEEL, 0600, "i4brbch%d", i); #endif #if I4BRBCHACCT #if defined(__FreeBSD__) callout_handle_init(&rbch_softc[i].sc_callout); #endif #if defined(__NetBSD__) && __NetBSD_Version__ >= 104230000 callout_init(&rbch_softc[i].sc_callout); #endif rbch_softc[i].sc_fn = 1; #endif rbch_softc[i].sc_unit = i; rbch_softc[i].sc_devstate = ST_IDLE; rbch_softc[i].sc_hdlcq.ifq_maxlen = I4BRBCHMAXQLEN; #if defined(__FreeBSD__) && __FreeBSD__ > 4 if(!mtx_initialized(&rbch_softc[i].sc_hdlcq.ifq_mtx)) mtx_init(&rbch_softc[i].sc_hdlcq.ifq_mtx, "i4b_rbch", MTX_DEF); #endif rbch_softc[i].it_in.c_ispeed = rbch_softc[i].it_in.c_ospeed = 64000; termioschars(&rbch_softc[i].it_in); rbch_init_linktab(i); } } /*---------------------------------------------------------------------------* * open rbch device *---------------------------------------------------------------------------*/ PDEVSTATIC int i4brbchopen(dev_t dev, int flag, int fmt, struct thread *td) { int unit = minor(dev); if(unit >= NI4BRBCH) return(ENXIO); if(rbch_softc[unit].sc_devstate & ST_ISOPEN) return(EBUSY); #if 0 rbch_clrq(unit); #endif rbch_softc[unit].sc_devstate |= ST_ISOPEN; NDBGL4(L4_RBCHDBG, "unit %d, open", unit); return(0); } /*---------------------------------------------------------------------------* * close rbch device *---------------------------------------------------------------------------*/ PDEVSTATIC int i4brbchclose(dev_t dev, int flag, int fmt, struct thread *td) { int unit = minor(dev); struct rbch_softc *sc = &rbch_softc[unit]; if(sc->sc_devstate & ST_CONNECTED) i4b_l4_drvrdisc(BDRV_RBCH, unit); sc->sc_devstate &= ~ST_ISOPEN; rbch_clrq(unit); NDBGL4(L4_RBCHDBG, "unit %d, closed", unit); return(0); } /*---------------------------------------------------------------------------* * read from rbch device *---------------------------------------------------------------------------*/ PDEVSTATIC int i4brbchread(dev_t dev, struct uio *uio, int ioflag) { struct mbuf *m; int error = 0; int unit = minor(dev); struct ifqueue *iqp; struct rbch_softc *sc = &rbch_softc[unit]; CRIT_VAR; NDBGL4(L4_RBCHDBG, "unit %d, enter read", unit); CRIT_BEG; if(!(sc->sc_devstate & ST_ISOPEN)) { CRIT_END; NDBGL4(L4_RBCHDBG, "unit %d, read while not open", unit); return(EIO); } if((sc->sc_devstate & ST_NOBLOCK)) { if(!(sc->sc_devstate & ST_CONNECTED)) { CRIT_END; return(EWOULDBLOCK); } if(sc->sc_bprot == BPROT_RHDLC) iqp = &sc->sc_hdlcq; else iqp = isdn_linktab[unit]->rx_queue; if(IF_QEMPTY(iqp) && (sc->sc_devstate & ST_ISOPEN)) { CRIT_END; return(EWOULDBLOCK); } } else { while(!(sc->sc_devstate & ST_CONNECTED)) { NDBGL4(L4_RBCHDBG, "unit %d, wait read init", unit); if((error = tsleep((caddr_t) &rbch_softc[unit], TTIPRI | PCATCH, "rrrbch", 0 )) != 0) { CRIT_END; NDBGL4(L4_RBCHDBG, "unit %d, error %d tsleep", unit, error); return(error); } } if(sc->sc_bprot == BPROT_RHDLC) iqp = &sc->sc_hdlcq; else iqp = isdn_linktab[unit]->rx_queue; while(IF_QEMPTY(iqp) && (sc->sc_devstate & ST_ISOPEN)) { sc->sc_devstate |= ST_RDWAITDATA; NDBGL4(L4_RBCHDBG, "unit %d, wait read data", unit); if((error = tsleep((caddr_t) &isdn_linktab[unit]->rx_queue, TTIPRI | PCATCH, "rrbch", 0 )) != 0) { CRIT_END; NDBGL4(L4_RBCHDBG, "unit %d, error %d tsleep read", unit, error); sc->sc_devstate &= ~ST_RDWAITDATA; return(error); } } } IF_DEQUEUE(iqp, m); NDBGL4(L4_RBCHDBG, "unit %d, read %d bytes", unit, m->m_len); if(m && m->m_len) { error = uiomove(m->m_data, m->m_len, uio); } else { NDBGL4(L4_RBCHDBG, "unit %d, error %d uiomove", unit, error); error = EIO; } if(m) i4b_Bfreembuf(m); CRIT_END; return(error); } /*---------------------------------------------------------------------------* * write to rbch device *---------------------------------------------------------------------------*/ PDEVSTATIC int i4brbchwrite(dev_t dev, struct uio * uio, int ioflag) { struct mbuf *m; int error = 0; int unit = minor(dev); struct rbch_softc *sc = &rbch_softc[unit]; CRIT_VAR; NDBGL4(L4_RBCHDBG, "unit %d, write", unit); CRIT_BEG; if(!(sc->sc_devstate & ST_ISOPEN)) { NDBGL4(L4_RBCHDBG, "unit %d, write while not open", unit); CRIT_END; return(EIO); } if((sc->sc_devstate & ST_NOBLOCK)) { if(!(sc->sc_devstate & ST_CONNECTED)) { CRIT_END; return(EWOULDBLOCK); } if(_IF_QFULL(isdn_linktab[unit]->tx_queue) && (sc->sc_devstate & ST_ISOPEN)) { CRIT_END; return(EWOULDBLOCK); } } else { while(!(sc->sc_devstate & ST_CONNECTED)) { NDBGL4(L4_RBCHDBG, "unit %d, write wait init", unit); error = tsleep((caddr_t) &rbch_softc[unit], TTIPRI | PCATCH, "wrrbch", 0 ); if(error == ERESTART) { CRIT_END; return (ERESTART); } else if(error == EINTR) { CRIT_END; NDBGL4(L4_RBCHDBG, "unit %d, EINTR during wait init", unit); return(EINTR); } else if(error) { CRIT_END; NDBGL4(L4_RBCHDBG, "unit %d, error %d tsleep init", unit, error); return(error); } tsleep((caddr_t) &rbch_softc[unit], TTIPRI | PCATCH, "xrbch", (hz*1)); } while(_IF_QFULL(isdn_linktab[unit]->tx_queue) && (sc->sc_devstate & ST_ISOPEN)) { sc->sc_devstate |= ST_WRWAITEMPTY; NDBGL4(L4_RBCHDBG, "unit %d, write queue full", unit); if ((error = tsleep((caddr_t) &isdn_linktab[unit]->tx_queue, TTIPRI | PCATCH, "wrbch", 0)) != 0) { sc->sc_devstate &= ~ST_WRWAITEMPTY; if(error == ERESTART) { CRIT_END; return(ERESTART); } else if(error == EINTR) { CRIT_END; NDBGL4(L4_RBCHDBG, "unit %d, EINTR during wait write", unit); return(error); } else if(error) { CRIT_END; NDBGL4(L4_RBCHDBG, "unit %d, error %d tsleep write", unit, error); return(error); } } } } if(!(sc->sc_devstate & ST_ISOPEN)) { NDBGL4(L4_RBCHDBG, "unit %d, not open anymore", unit); CRIT_END; return(EIO); } if((m = i4b_Bgetmbuf(BCH_MAX_DATALEN)) != NULL) { m->m_len = min(BCH_MAX_DATALEN, uio->uio_resid); NDBGL4(L4_RBCHDBG, "unit %d, write %d bytes", unit, m->m_len); error = uiomove(m->m_data, m->m_len, uio); #if defined (__FreeBSD__) && __FreeBSD__ > 4 (void) IF_HANDOFF(isdn_linktab[unit]->tx_queue, m, NULL); #else if(IF_QFULL(isdn_linktab[unit]->tx_queue)) m_freem(m); else IF_ENQUEUE(isdn_linktab[unit]->tx_queue, m); #endif (*isdn_linktab[unit]->bch_tx_start)(isdn_linktab[unit]->unit, isdn_linktab[unit]->channel); } CRIT_END; return(error); } /*---------------------------------------------------------------------------* * rbch device ioctl handlibg *---------------------------------------------------------------------------*/ PDEVSTATIC int i4brbchioctl(dev_t dev, IOCTL_CMD_T cmd, caddr_t data, int flag, struct thread *td) { int error = 0; int unit = minor(dev); struct rbch_softc *sc = &rbch_softc[unit]; switch(cmd) { case FIOASYNC: /* Set async mode */ if (*(int *)data) { NDBGL4(L4_RBCHDBG, "unit %d, setting async mode", unit); } else { NDBGL4(L4_RBCHDBG, "unit %d, clearing async mode", unit); } break; case FIONBIO: if (*(int *)data) { NDBGL4(L4_RBCHDBG, "unit %d, setting non-blocking mode", unit); sc->sc_devstate |= ST_NOBLOCK; } else { NDBGL4(L4_RBCHDBG, "unit %d, clearing non-blocking mode", unit); sc->sc_devstate &= ~ST_NOBLOCK; } break; case TIOCCDTR: /* Clear DTR */ if(sc->sc_devstate & ST_CONNECTED) { NDBGL4(L4_RBCHDBG, "unit %d, disconnecting for DTR down", unit); i4b_l4_drvrdisc(BDRV_RBCH, unit); } break; case I4B_RBCH_DIALOUT: { size_t l; for (l = 0; l < TELNO_MAX && ((char *)data)[l]; l++) ; if (l) { NDBGL4(L4_RBCHDBG, "unit %d, attempting dialout to %s", unit, (char *)data); i4b_l4_dialoutnumber(BDRV_RBCH, unit, l, (char *)data); break; } /* fall through to SDTR */ } case TIOCSDTR: /* Set DTR */ NDBGL4(L4_RBCHDBG, "unit %d, attempting dialout (DTR)", unit); i4b_l4_dialout(BDRV_RBCH, unit); break; case TIOCSETA: /* Set termios struct */ break; case TIOCGETA: /* Get termios struct */ *(struct termios *)data = sc->it_in; break; case TIOCMGET: *(int *)data = TIOCM_LE|TIOCM_DTR|TIOCM_RTS|TIOCM_CTS|TIOCM_DSR; if (sc->sc_devstate & ST_CONNECTED) *(int *)data |= TIOCM_CD; break; case I4B_RBCH_VR_REQ: { msg_vr_req_t *mvr; mvr = (msg_vr_req_t *)data; mvr->version = VERSION; mvr->release = REL; mvr->step = STEP; break; } default: /* Unknown stuff */ NDBGL4(L4_RBCHDBG, "unit %d, ioctl, unknown cmd %lx", unit, (u_long)cmd); error = EINVAL; break; } return(error); } #ifdef OS_USES_POLL /*---------------------------------------------------------------------------* * device driver poll *---------------------------------------------------------------------------*/ PDEVSTATIC int i4brbchpoll(dev_t dev, int events, struct thread *td) { int revents = 0; /* Events we found */ int s; int unit = minor(dev); struct rbch_softc *sc = &rbch_softc[unit]; /* We can't check for anything but IN or OUT */ s = splhigh(); if(!(sc->sc_devstate & ST_ISOPEN)) { splx(s); return(POLLNVAL); } /* * Writes are OK if we are connected and the * transmit queue can take them */ if((events & (POLLOUT|POLLWRNORM)) && (sc->sc_devstate & ST_CONNECTED) && !_IF_QFULL(isdn_linktab[unit]->tx_queue)) { revents |= (events & (POLLOUT|POLLWRNORM)); } /* ... while reads are OK if we have any data */ if((events & (POLLIN|POLLRDNORM)) && (sc->sc_devstate & ST_CONNECTED)) { struct ifqueue *iqp; if(sc->sc_bprot == BPROT_RHDLC) iqp = &sc->sc_hdlcq; else iqp = isdn_linktab[unit]->rx_queue; if(!IF_QEMPTY(iqp)) revents |= (events & (POLLIN|POLLRDNORM)); } if(revents == 0) selrecord(td, &sc->selp); splx(s); return(revents); } #else /* OS_USES_POLL */ /*---------------------------------------------------------------------------* * device driver select *---------------------------------------------------------------------------*/ PDEVSTATIC int i4brbchselect(dev_t dev, int rw, struct thread *td) { int unit = minor(dev); struct rbch_softc *sc = &rbch_softc[unit]; int s; s = splhigh(); if(!(sc->sc_devstate & ST_ISOPEN)) { splx(s); NDBGL4(L4_RBCHDBG, "unit %d, not open anymore", unit); return(1); } if(sc->sc_devstate & ST_CONNECTED) { struct ifqueue *iqp; switch(rw) { case FREAD: if(sc->sc_bprot == BPROT_RHDLC) iqp = &sc->sc_hdlcq; else iqp = isdn_linktab[unit]->rx_queue; if(!IF_QEMPTY(iqp)) { splx(s); return(1); } break; case FWRITE: if(!_IF_QFULL(isdn_linktab[unit]->rx_queue)) { splx(s); return(1); } break; default: splx(s); return 0; } } selrecord(p, &sc->selp); splx(s); return(0); } #endif /* OS_USES_POLL */ #if I4BRBCHACCT /*---------------------------------------------------------------------------* * watchdog routine *---------------------------------------------------------------------------*/ static void rbch_timeout(struct rbch_softc *sc) { bchan_statistics_t bs; int unit = sc->sc_unit; /* get # of bytes in and out from the HSCX driver */ (*isdn_linktab[unit]->bch_stat) (isdn_linktab[unit]->unit, isdn_linktab[unit]->channel, &bs); sc->sc_ioutb += bs.outbytes; sc->sc_iinb += bs.inbytes; if((sc->sc_iinb != sc->sc_linb) || (sc->sc_ioutb != sc->sc_loutb) || sc->sc_fn) { int ri = (sc->sc_iinb - sc->sc_linb)/I4BRBCHACCTINTVL; int ro = (sc->sc_ioutb - sc->sc_loutb)/I4BRBCHACCTINTVL; if((sc->sc_iinb == sc->sc_linb) && (sc->sc_ioutb == sc->sc_loutb)) sc->sc_fn = 0; else sc->sc_fn = 1; sc->sc_linb = sc->sc_iinb; sc->sc_loutb = sc->sc_ioutb; i4b_l4_accounting(BDRV_RBCH, unit, ACCT_DURING, sc->sc_ioutb, sc->sc_iinb, ro, ri, sc->sc_ioutb, sc->sc_iinb); } START_TIMER(sc->sc_callout, rbch_timeout, sc, I4BRBCHACCTINTVL*hz); } #endif /* I4BRBCHACCT */ /*===========================================================================* * ISDN INTERFACE ROUTINES *===========================================================================*/ /*---------------------------------------------------------------------------* * this routine is called from L4 handler at connect time *---------------------------------------------------------------------------*/ static void rbch_connect(int unit, void *cdp) { call_desc_t *cd = (call_desc_t *)cdp; struct rbch_softc *sc = &rbch_softc[unit]; sc->sc_bprot = cd->bprot; #if I4BRBCHACCT if(sc->sc_bprot == BPROT_RHDLC) { sc->sc_iinb = 0; sc->sc_ioutb = 0; sc->sc_linb = 0; sc->sc_loutb = 0; START_TIMER(sc->sc_callout, rbch_timeout, sc, I4BRBCHACCTINTVL*hz); } #endif if(!(sc->sc_devstate & ST_CONNECTED)) { NDBGL4(L4_RBCHDBG, "unit %d, wakeup", unit); sc->sc_devstate |= ST_CONNECTED; sc->sc_cd = cdp; wakeup((caddr_t)sc); } } /*---------------------------------------------------------------------------* * this routine is called from L4 handler at disconnect time *---------------------------------------------------------------------------*/ static void rbch_disconnect(int unit, void *cdp) { call_desc_t *cd = (call_desc_t *)cdp; struct rbch_softc *sc = &rbch_softc[unit]; CRIT_VAR; if(cd != sc->sc_cd) { NDBGL4(L4_RBCHDBG, "rbch%d: channel %d not active", cd->driver_unit, cd->channelid); return; } CRIT_BEG; NDBGL4(L4_RBCHDBG, "unit %d, disconnect", unit); sc->sc_devstate &= ~ST_CONNECTED; sc->sc_cd = NULL; #if I4BRBCHACCT i4b_l4_accounting(BDRV_RBCH, unit, ACCT_FINAL, sc->sc_ioutb, sc->sc_iinb, 0, 0, sc->sc_ioutb, sc->sc_iinb); STOP_TIMER(sc->sc_callout, rbch_timeout, sc); #endif CRIT_END; } /*---------------------------------------------------------------------------* * feedback from daemon in case of dial problems *---------------------------------------------------------------------------*/ static void rbch_dialresponse(int unit, int status, cause_t cause) { } /*---------------------------------------------------------------------------* * interface up/down *---------------------------------------------------------------------------*/ static void rbch_updown(int unit, int updown) { } /*---------------------------------------------------------------------------* * this routine is called from the HSCX interrupt handler * when a new frame (mbuf) has been received and is to be put on * the rx queue. *---------------------------------------------------------------------------*/ static void rbch_rx_data_rdy(int unit) { if(rbch_softc[unit].sc_bprot == BPROT_RHDLC) { register struct mbuf *m; if((m = *isdn_linktab[unit]->rx_mbuf) == NULL) return; m->m_pkthdr.len = m->m_len; #if defined (__FreeBSD__) && __FreeBSD__ > 4 if (! IF_HANDOFF(&(rbch_softc[unit].sc_hdlcq), m, NULL)) { NDBGL4(L4_RBCHDBG, "unit %d: hdlc rx queue full!", unit); } #else if(IF_QFULL(&(rbch_softc[unit].sc_hdlcq))) { NDBGL4(L4_RBCHDBG, "unit %d: hdlc rx queue full!", unit); m_freem(m); } else { IF_ENQUEUE(&(rbch_softc[unit].sc_hdlcq), m); } #endif } if(rbch_softc[unit].sc_devstate & ST_RDWAITDATA) { NDBGL4(L4_RBCHDBG, "unit %d, wakeup", unit); rbch_softc[unit].sc_devstate &= ~ST_RDWAITDATA; wakeup((caddr_t) &isdn_linktab[unit]->rx_queue); } else { NDBGL4(L4_RBCHDBG, "unit %d, NO wakeup", unit); } selwakeup(&rbch_softc[unit].selp); } /*---------------------------------------------------------------------------* * this routine is called from the HSCX interrupt handler * when the last frame has been sent out and there is no * further frame (mbuf) in the tx queue. *---------------------------------------------------------------------------*/ static void rbch_tx_queue_empty(int unit) { if(rbch_softc[unit].sc_devstate & ST_WRWAITEMPTY) { NDBGL4(L4_RBCHDBG, "unit %d, wakeup", unit); rbch_softc[unit].sc_devstate &= ~ST_WRWAITEMPTY; wakeup((caddr_t) &isdn_linktab[unit]->tx_queue); } else { NDBGL4(L4_RBCHDBG, "unit %d, NO wakeup", unit); } selwakeup(&rbch_softc[unit].selp); } /*---------------------------------------------------------------------------* * this routine is called from the HSCX interrupt handler * each time a packet is received or transmitted *---------------------------------------------------------------------------*/ static void rbch_activity(int unit, int rxtx) { if (rbch_softc[unit].sc_cd) rbch_softc[unit].sc_cd->last_active_time = SECOND; selwakeup(&rbch_softc[unit].selp); } /*---------------------------------------------------------------------------* * clear an hdlc rx queue for a rbch unit *---------------------------------------------------------------------------*/ static void rbch_clrq(int unit) { CRIT_VAR; #if defined (__FreeBSD__) && __FreeBSD__ > 4 CRIT_BEG; IF_DRAIN(&rbch_softc[unit].sc_hdlcq); CRIT_END; #else struct mbuf *m; for(;;) { CRIT_BEG; IF_DEQUEUE(&rbch_softc[unit].sc_hdlcq, m); CRIT_END; if(m) m_freem(m); else break; } #endif } /*---------------------------------------------------------------------------* * return this drivers linktab address *---------------------------------------------------------------------------*/ drvr_link_t * rbch_ret_linktab(int unit) { rbch_init_linktab(unit); return(&rbch_drvr_linktab[unit]); } /*---------------------------------------------------------------------------* * setup the isdn_linktab for this driver *---------------------------------------------------------------------------*/ void rbch_set_linktab(int unit, isdn_link_t *ilt) { isdn_linktab[unit] = ilt; } /*---------------------------------------------------------------------------* * initialize this drivers linktab *---------------------------------------------------------------------------*/ static void rbch_init_linktab(int unit) { rbch_drvr_linktab[unit].unit = unit; rbch_drvr_linktab[unit].bch_rx_data_ready = rbch_rx_data_rdy; rbch_drvr_linktab[unit].bch_tx_queue_empty = rbch_tx_queue_empty; rbch_drvr_linktab[unit].bch_activity = rbch_activity; rbch_drvr_linktab[unit].line_connected = rbch_connect; rbch_drvr_linktab[unit].line_disconnected = rbch_disconnect; rbch_drvr_linktab[unit].dial_response = rbch_dialresponse; rbch_drvr_linktab[unit].updown_ind = rbch_updown; } /*===========================================================================*/ #endif /* NI4BRBCH > 0 */