summaryrefslogtreecommitdiffstats
path: root/sys/i4b/layer1/iwic/i4b_iwic_bchan.c
diff options
context:
space:
mode:
Diffstat (limited to 'sys/i4b/layer1/iwic/i4b_iwic_bchan.c')
-rw-r--r--sys/i4b/layer1/iwic/i4b_iwic_bchan.c749
1 files changed, 749 insertions, 0 deletions
diff --git a/sys/i4b/layer1/iwic/i4b_iwic_bchan.c b/sys/i4b/layer1/iwic/i4b_iwic_bchan.c
new file mode 100644
index 0000000..e6bbaca
--- /dev/null
+++ b/sys/i4b/layer1/iwic/i4b_iwic_bchan.c
@@ -0,0 +1,749 @@
+/*
+ * Copyright (c) 1999, 2000 Dave Boyce. All rights reserved.
+ *
+ * Copyright (c) 2000 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_iwic - isdn4bsd Winbond W6692 driver
+ * ----------------------------------------
+ *
+ * $Id: i4b_iwic_bchan.c,v 1.8 2000/05/29 15:41:42 hm Exp $
+ *
+ * $FreeBSD$
+ *
+ * last edit-date: [Mon May 29 16:48:56 2000]
+ *
+ *---------------------------------------------------------------------------*/
+
+#include "iwic.h"
+#include "opt_i4b.h"
+#include "pci.h"
+
+#if (NIWIC > 0) && (NPCI > 0)
+
+#include <sys/param.h>
+#include <sys/kernel.h>
+#include <sys/systm.h>
+#include <sys/mbuf.h>
+#include <sys/socket.h>
+
+#include <net/if.h>
+
+#include <machine/clock.h>
+
+#include <machine/i4b_debug.h>
+#include <machine/i4b_ioctl.h>
+#include <machine/i4b_trace.h>
+
+#include <i4b/layer1/i4b_l1.h>
+
+#include <i4b/layer1/iwic/i4b_iwic.h>
+#include <i4b/layer1/iwic/i4b_w6692.h>
+
+#include <i4b/include/i4b_global.h>
+#include <i4b/include/i4b_mbuf.h>
+
+static void iwic_bchan_init(struct iwic_softc *sc, int chan_no, int activate);
+
+/*---------------------------------------------------------------------------*
+ * B-channel interrupt handler
+ *---------------------------------------------------------------------------*/
+void
+iwic_bchan_xirq(struct iwic_softc *sc, int chan_no)
+{
+ int irq_stat;
+ struct iwic_bchan *chan;
+ int cmd = 0;
+ int activity = 0;
+
+ chan = &sc->sc_bchan[chan_no];
+
+ irq_stat = IWIC_READ(sc, chan->offset + B_EXIR);
+
+ NDBGL1(L1_H_IRQ, "irq_stat = 0x%x", irq_stat);
+
+ if((irq_stat & (B_EXIR_RMR | B_EXIR_RME | B_EXIR_RDOV | B_EXIR_XFR | B_EXIR_XDUN)) == 0)
+ {
+ NDBGL1(L1_H_XFRERR, "spurious IRQ!");
+ return;
+ }
+
+ if (irq_stat & B_EXIR_RDOV)
+ {
+ NDBGL1(L1_H_XFRERR, "RDOV");
+ }
+
+ if (irq_stat & B_EXIR_XDUN)
+ {
+ NDBGL1(L1_H_XFRERR, "XDUN");
+ }
+
+/* RX message end interrupt */
+
+ if(irq_stat & B_EXIR_RME)
+ {
+/* XXXX */ int error = 0;
+ register int fifo_data_len;
+
+ NDBGL1(L1_H_IRQ, "B_EXIR_RME");
+
+ fifo_data_len = ((IWIC_READ(sc,chan->offset+B_RBCL)) &
+ ((IWIC_BCHAN_FIFO_LEN)-1));
+
+ if(fifo_data_len == 0)
+ fifo_data_len = IWIC_BCHAN_FIFO_LEN;
+
+ /* all error conditions checked, now decide and take action */
+
+ if(error == 0)
+ {
+ if(chan->in_mbuf == NULL)
+ {
+ if((chan->in_mbuf = i4b_Bgetmbuf(BCH_MAX_DATALEN)) == NULL)
+ panic("L1 iwic_bchan_irq: RME, cannot allocate mbuf!\n");
+ chan->in_cbptr = chan->in_mbuf->m_data;
+ chan->in_len = 0;
+ }
+
+ if((chan->in_len + fifo_data_len) <= BCH_MAX_DATALEN)
+ {
+ /* read data from fifo */
+
+ NDBGL1(L1_H_IRQ, "B_EXIR_RME, rd fifo, len = %d", fifo_data_len);
+
+ IWIC_RDBFIFO(sc, chan, chan->in_cbptr, fifo_data_len);
+
+ cmd |= (B_CMDR_RACK | B_CMDR_RACT);
+ IWIC_WRITE(sc, chan->offset + B_CMDR, cmd);
+ cmd = 0;
+
+ chan->in_len += fifo_data_len;
+ chan->rxcount += fifo_data_len;
+
+ /* setup mbuf data length */
+
+ chan->in_mbuf->m_len = chan->in_len;
+ chan->in_mbuf->m_pkthdr.len = chan->in_len;
+
+ if(sc->sc_trace & TRACE_B_RX)
+ {
+ i4b_trace_hdr_t hdr;
+ hdr.unit = L0IWICUNIT(sc->sc_unit);
+ hdr.type = (chan_no == IWIC_BCH_A ? TRC_CH_B1 : TRC_CH_B2);
+ hdr.dir = FROM_NT;
+ hdr.count = ++sc->sc_bchan[chan_no].sc_trace_bcount;
+ MICROTIME(hdr.time);
+ i4b_l1_trace_ind(&hdr, chan->in_mbuf->m_len, chan->in_mbuf->m_data);
+ }
+
+ (*chan->iwic_drvr_linktab->bch_rx_data_ready)(chan->iwic_drvr_linktab->unit);
+
+ activity = ACT_RX;
+
+ /* mark buffer ptr as unused */
+
+ chan->in_mbuf = NULL;
+ chan->in_cbptr = NULL;
+ chan->in_len = 0;
+ }
+ else
+ {
+ NDBGL1(L1_H_XFRERR, "RAWHDLC rx buffer overflow in RME, in_len=%d, fifolen=%d", chan->in_len, fifo_data_len);
+ chan->in_cbptr = chan->in_mbuf->m_data;
+ chan->in_len = 0;
+ cmd |= (B_CMDR_RRST | B_CMDR_RACK);
+ }
+ }
+ else
+ {
+ if (chan->in_mbuf != NULL)
+ {
+ i4b_Bfreembuf(chan->in_mbuf);
+ chan->in_mbuf = NULL;
+ chan->in_cbptr = NULL;
+ chan->in_len = 0;
+ }
+ cmd |= (B_CMDR_RRST | B_CMDR_RACK);
+ }
+ }
+
+/* RX fifo full interrupt */
+
+ if(irq_stat & B_EXIR_RMR)
+ {
+ NDBGL1(L1_H_IRQ, "B_EXIR_RMR");
+
+ if(chan->in_mbuf == NULL)
+ {
+ if((chan->in_mbuf = i4b_Bgetmbuf(BCH_MAX_DATALEN)) == NULL)
+ panic("L1 iwic_bchan_irq: RMR, cannot allocate mbuf!\n");
+ chan->in_cbptr = chan->in_mbuf->m_data;
+ chan->in_len = 0;
+ }
+
+ chan->rxcount += IWIC_BCHAN_FIFO_LEN;
+
+ if((chan->in_len + IWIC_BCHAN_FIFO_LEN) <= BCH_MAX_DATALEN)
+ {
+ /* read data from fifo */
+
+ NDBGL1(L1_H_IRQ, "B_EXIR_RMR, rd fifo, len = max (64)");
+
+ IWIC_RDBFIFO(sc, chan, chan->in_cbptr, IWIC_BCHAN_FIFO_LEN);
+
+ chan->in_cbptr += IWIC_BCHAN_FIFO_LEN;
+ chan->in_len += IWIC_BCHAN_FIFO_LEN;
+ }
+ else
+ {
+ if(chan->bprot == BPROT_NONE)
+ {
+ /* setup mbuf data length */
+
+ chan->in_mbuf->m_len = chan->in_len;
+ chan->in_mbuf->m_pkthdr.len = chan->in_len;
+
+ if(sc->sc_trace & TRACE_B_RX)
+ {
+ i4b_trace_hdr_t hdr;
+ hdr.unit = L0IWICUNIT(sc->sc_unit);
+ hdr.type = (chan_no == IWIC_BCH_A ? TRC_CH_B1 : TRC_CH_B2);
+ hdr.dir = FROM_NT;
+ hdr.count = ++sc->sc_bchan[chan_no].sc_trace_bcount;
+ MICROTIME(hdr.time);
+ i4b_l1_trace_ind(&hdr, chan->in_mbuf->m_len, chan->in_mbuf->m_data);
+ }
+
+ /* silence detection */
+
+ if(!(i4b_l1_bchan_tel_silence(chan->in_mbuf->m_data, chan->in_mbuf->m_len)))
+ activity = ACT_RX;
+
+ if(!(IF_QFULL(&chan->rx_queue)))
+ {
+ IF_ENQUEUE(&chan->rx_queue, chan->in_mbuf);
+ }
+ else
+ {
+ i4b_Bfreembuf(chan->in_mbuf);
+ }
+
+ /* signal upper driver that data is available */
+
+ (*chan->iwic_drvr_linktab->bch_rx_data_ready)(chan->iwic_drvr_linktab->unit);
+
+ /* alloc new buffer */
+
+ if((chan->in_mbuf = i4b_Bgetmbuf(BCH_MAX_DATALEN)) == NULL)
+ panic("L1 iwic_bchan_irq: RMR, cannot allocate new mbuf!\n");
+
+ /* setup new data ptr */
+
+ chan->in_cbptr = chan->in_mbuf->m_data;
+
+ /* read data from fifo */
+
+ NDBGL1(L1_H_IRQ, "B_EXIR_RMR, rd fifo1, len = max (64)");
+
+ IWIC_RDBFIFO(sc, chan, chan->in_cbptr, IWIC_BCHAN_FIFO_LEN);
+
+ chan->in_cbptr += IWIC_BCHAN_FIFO_LEN;
+ chan->in_len = IWIC_BCHAN_FIFO_LEN;
+
+ chan->rxcount += IWIC_BCHAN_FIFO_LEN;
+ }
+ else
+ {
+ NDBGL1(L1_H_XFRERR, "RAWHDLC rx buffer overflow in RPF, in_len=%d", chan->in_len);
+ chan->in_cbptr = chan->in_mbuf->m_data;
+ chan->in_len = 0;
+ cmd |= (B_CMDR_RRST | B_CMDR_RACK);
+ }
+ }
+
+ /* command to release fifo space */
+
+ cmd |= B_CMDR_RACK;
+ }
+
+/* TX interrupt */
+
+ if (irq_stat & B_EXIR_XFR)
+ {
+ /* transmit fifo empty, new data can be written to fifo */
+
+ int activity = -1;
+ int len;
+ int nextlen;
+
+ NDBGL1(L1_H_IRQ, "B_EXIR_XFR");
+
+ if(chan->out_mbuf_cur == NULL) /* last frame is transmitted */
+ {
+ IF_DEQUEUE(&chan->tx_queue, chan->out_mbuf_head);
+
+ if(chan->out_mbuf_head == NULL)
+ {
+ chan->state &= ~ST_TX_ACTIVE;
+ (*chan->iwic_drvr_linktab->bch_tx_queue_empty)(chan->iwic_drvr_linktab->unit);
+ }
+ else
+ {
+ chan->state |= ST_TX_ACTIVE;
+ chan->out_mbuf_cur = chan->out_mbuf_head;
+ chan->out_mbuf_cur_ptr = chan->out_mbuf_cur->m_data;
+ chan->out_mbuf_cur_len = chan->out_mbuf_cur->m_len;
+
+ if(sc->sc_trace & TRACE_B_TX)
+ {
+ i4b_trace_hdr_t hdr;
+ hdr.unit = L0IWICUNIT(sc->sc_unit);
+ hdr.type = (chan_no == IWIC_BCH_A ? TRC_CH_B1 : TRC_CH_B2);
+ hdr.dir = FROM_TE;
+ hdr.count = ++sc->sc_bchan[chan_no].sc_trace_bcount;
+ MICROTIME(hdr.time);
+ i4b_l1_trace_ind(&hdr, chan->out_mbuf_cur->m_len, chan->out_mbuf_cur->m_data);
+ }
+
+ if(chan->bprot == BPROT_NONE)
+ {
+ if(!(i4b_l1_bchan_tel_silence(chan->out_mbuf_cur->m_data, chan->out_mbuf_cur->m_len)))
+ activity = ACT_TX;
+ }
+ else
+ {
+ activity = ACT_TX;
+ }
+ }
+ }
+
+ len = 0;
+
+ while(chan->out_mbuf_cur && len != IWIC_BCHAN_FIFO_LEN)
+ {
+ nextlen = min(chan->out_mbuf_cur_len, IWIC_BCHAN_FIFO_LEN - len);
+
+ NDBGL1(L1_H_IRQ, "B_EXIR_XFR, wr fifo, len = %d", nextlen);
+
+ IWIC_WRBFIFO(sc, chan, chan->out_mbuf_cur_ptr, nextlen);
+
+ cmd |= B_CMDR_XMS;
+
+ len += nextlen;
+ chan->txcount += nextlen;
+
+ chan->out_mbuf_cur_ptr += nextlen;
+ chan->out_mbuf_cur_len -= nextlen;
+
+ if(chan->out_mbuf_cur_len == 0)
+ {
+ if((chan->out_mbuf_cur = chan->out_mbuf_cur->m_next) != NULL)
+ {
+ chan->out_mbuf_cur_ptr = chan->out_mbuf_cur->m_data;
+ chan->out_mbuf_cur_len = chan->out_mbuf_cur->m_len;
+
+ if(sc->sc_trace & TRACE_B_TX)
+ {
+ i4b_trace_hdr_t hdr;
+ hdr.unit = L0IWICUNIT(sc->sc_unit);
+ hdr.type = (chan_no == IWIC_BCH_A ? TRC_CH_B1 : TRC_CH_B2);
+ hdr.dir = FROM_TE;
+ hdr.count = ++sc->sc_bchan[chan_no].sc_trace_bcount;
+ MICROTIME(hdr.time);
+ i4b_l1_trace_ind(&hdr, chan->out_mbuf_cur->m_len, chan->out_mbuf_cur->m_data);
+ }
+ }
+ else
+ {
+ if (chan->bprot != BPROT_NONE)
+ cmd |= B_CMDR_XME;
+ i4b_Bfreembuf(chan->out_mbuf_head);
+ chan->out_mbuf_head = NULL;
+ }
+ }
+ }
+ }
+ if(cmd)
+ {
+ cmd |= B_CMDR_RACT;
+ IWIC_WRITE(sc, chan->offset + B_CMDR, cmd);
+ }
+}
+
+/*---------------------------------------------------------------------------*
+ * initialize one B channels rx/tx data structures
+ *---------------------------------------------------------------------------*/
+void
+iwic_bchannel_setup(int unit, int chan_no, int bprot, int activate)
+{
+ struct iwic_softc *sc = &iwic_sc[unit];
+ struct iwic_bchan *chan = &sc->sc_bchan[chan_no];
+
+ int s = SPLI4B();
+
+ NDBGL1(L1_BCHAN, "unit %d, chan %d, bprot %d, activate %d", unit, chan_no, bprot, activate);
+
+ /* general part */
+
+ chan->bprot = bprot; /* B channel protocol */
+ chan->state = ST_IDLE; /* B channel state */
+
+ if(activate == 0)
+ {
+ /* deactivation */
+ iwic_bchan_init(sc, chan_no, activate);
+ }
+
+ /* receiver part */
+
+ i4b_Bcleanifq(&chan->rx_queue); /* clean rx queue */
+
+ chan->rx_queue.ifq_maxlen = IFQ_MAXLEN;
+
+ chan->rxcount = 0; /* reset rx counter */
+
+ i4b_Bfreembuf(chan->in_mbuf); /* clean rx mbuf */
+
+ chan->in_mbuf = NULL; /* reset mbuf ptr */
+ chan->in_cbptr = NULL; /* reset mbuf curr ptr */
+ chan->in_len = 0; /* reset mbuf data len */
+
+ /* transmitter part */
+
+ i4b_Bcleanifq(&chan->tx_queue); /* clean tx queue */
+
+ chan->tx_queue.ifq_maxlen = IFQ_MAXLEN;
+
+ chan->txcount = 0; /* reset tx counter */
+
+ i4b_Bfreembuf(chan->out_mbuf_head); /* clean tx mbuf */
+
+ chan->out_mbuf_head = NULL; /* reset head mbuf ptr */
+ chan->out_mbuf_cur = NULL; /* reset current mbuf ptr */
+ chan->out_mbuf_cur_ptr = NULL; /* reset current mbuf data ptr */
+ chan->out_mbuf_cur_len = 0; /* reset current mbuf data cnt */
+
+ if(activate != 0)
+ {
+ /* activation */
+ iwic_bchan_init(sc, chan_no, activate);
+ }
+
+ splx(s);
+}
+
+/*---------------------------------------------------------------------------*
+ * initalize / deinitialize B-channel hardware
+ *---------------------------------------------------------------------------*/
+static void
+iwic_bchan_init(struct iwic_softc *sc, int chan_no, int activate)
+{
+ struct iwic_bchan *bchan = &sc->sc_bchan[chan_no];
+
+ NDBGL1(L1_BCHAN, "chan %d, activate %d", chan_no, activate);
+
+ if(activate)
+ {
+ if(bchan->bprot == BPROT_NONE)
+ {
+ /* Extended transparent mode */
+ IWIC_WRITE(sc, bchan->offset + B_MODE, B_MODE_MMS);
+ }
+ else
+ {
+ /* Transparent mode */
+ IWIC_WRITE(sc, bchan->offset + B_MODE, 0);
+ /* disable address comparation */
+ IWIC_WRITE (sc, bchan->offset+B_ADM1, 0xff);
+ IWIC_WRITE (sc, bchan->offset+B_ADM2, 0xff);
+ }
+
+ /* reset & start receiver */
+ IWIC_WRITE(sc, bchan->offset + B_CMDR, B_CMDR_RRST|B_CMDR_RACT);
+
+ /* clear irq mask */
+ IWIC_WRITE(sc, bchan->offset + B_EXIM, 0);
+ }
+ else
+ {
+ /* mask all irqs */
+ IWIC_WRITE(sc, bchan->offset + B_EXIM, 0xff);
+
+ /* reset mode */
+ IWIC_WRITE(sc, bchan->offset + B_MODE, 0);
+
+ /* Bring interface down */
+ IWIC_WRITE(sc, bchan->offset + B_CMDR, B_CMDR_RRST | B_CMDR_XRST);
+
+ /* Flush pending interrupts */
+ IWIC_READ(sc, bchan->offset + B_EXIR);
+ }
+}
+
+/*---------------------------------------------------------------------------*
+ * start transmission on a b channel
+ *---------------------------------------------------------------------------*/
+static void
+iwic_bchannel_start(int unit, int chan_no)
+{
+ struct iwic_softc *sc = &iwic_sc[unit];
+ register struct iwic_bchan *chan = &sc->sc_bchan[chan_no];
+ register int next_len;
+ register int len;
+
+ int s;
+ int activity = -1;
+ int cmd = 0;
+
+ s = SPLI4B(); /* enter critical section */
+
+ NDBGL1(L1_BCHAN, "unit %d, channel %d", unit, chan_no);
+
+ if(chan->state & ST_TX_ACTIVE) /* already running ? */
+ {
+ splx(s);
+ return; /* yes, leave */
+ }
+
+ /* get next mbuf from queue */
+
+ IF_DEQUEUE(&chan->tx_queue, chan->out_mbuf_head);
+
+ if(chan->out_mbuf_head == NULL) /* queue empty ? */
+ {
+ splx(s); /* leave critical section */
+ return; /* yes, exit */
+ }
+
+ /* init current mbuf values */
+
+ chan->out_mbuf_cur = chan->out_mbuf_head;
+ chan->out_mbuf_cur_len = chan->out_mbuf_cur->m_len;
+ chan->out_mbuf_cur_ptr = chan->out_mbuf_cur->m_data;
+
+ /* activity indicator for timeout handling */
+
+ if(chan->bprot == BPROT_NONE)
+ {
+ if(!(i4b_l1_bchan_tel_silence(chan->out_mbuf_cur->m_data, chan->out_mbuf_cur->m_len)))
+ activity = ACT_TX;
+ }
+ else
+ {
+ activity = ACT_TX;
+ }
+
+ chan->state |= ST_TX_ACTIVE; /* we start transmitting */
+
+ if(sc->sc_trace & TRACE_B_TX) /* if trace, send mbuf to trace dev */
+ {
+ i4b_trace_hdr_t hdr;
+ hdr.unit = L0IWICUNIT(unit);
+ hdr.type = (chan_no == IWIC_BCH_A ? TRC_CH_B1 : TRC_CH_B2);
+ hdr.dir = FROM_TE;
+ hdr.count = ++sc->sc_bchan[chan_no].sc_trace_bcount;
+ MICROTIME(hdr.time);
+ i4b_l1_trace_ind(&hdr, chan->out_mbuf_cur->m_len, chan->out_mbuf_cur->m_data);
+ }
+
+ len = 0; /* # of chars put into tx fifo this time */
+
+ /*
+ * fill the tx fifo with data from the current mbuf. if
+ * current mbuf holds less data than fifo length, try to
+ * get the next mbuf from (a possible) mbuf chain. if there is
+ * not enough data in a single mbuf or in a chain, then this
+ * is the last mbuf and we tell the chip that it has to send
+ * CRC and closing flag
+ */
+
+ while((len < IWIC_BCHAN_FIFO_LEN) && chan->out_mbuf_cur)
+ {
+ /*
+ * put as much data into the fifo as is
+ * available from the current mbuf
+ */
+
+ if((len + chan->out_mbuf_cur_len) >= IWIC_BCHAN_FIFO_LEN)
+ next_len = IWIC_BCHAN_FIFO_LEN - len;
+ else
+ next_len = chan->out_mbuf_cur_len;
+
+ /* write what we have from current mbuf to fifo */
+
+ IWIC_WRBFIFO(sc, chan, chan->out_mbuf_cur_ptr, next_len);
+
+ len += next_len; /* update # of bytes written */
+ chan->txcount += next_len; /* statistics */
+ chan->out_mbuf_cur_ptr += next_len; /* data ptr */
+ chan->out_mbuf_cur_len -= next_len; /* data len */
+
+ /*
+ * in case the current mbuf (of a possible chain) data
+ * has been put into the fifo, check if there is a next
+ * mbuf in the chain. If there is one, get ptr to it
+ * and update the data ptr and the length
+ */
+
+ if((chan->out_mbuf_cur_len <= 0) &&
+ ((chan->out_mbuf_cur = chan->out_mbuf_cur->m_next) != NULL))
+ {
+ chan->out_mbuf_cur_ptr = chan->out_mbuf_cur->m_data;
+ chan->out_mbuf_cur_len = chan->out_mbuf_cur->m_len;
+
+ if(sc->sc_trace & TRACE_B_TX)
+ {
+ i4b_trace_hdr_t hdr;
+ hdr.unit = L0IWICUNIT(unit);
+ hdr.type = (chan_no == IWIC_BCH_A ? TRC_CH_B1 : TRC_CH_B2);
+ hdr.dir = FROM_TE;
+ hdr.count = ++sc->sc_bchan[chan_no].sc_trace_bcount;
+ MICROTIME(hdr.time);
+ i4b_l1_trace_ind(&hdr, chan->out_mbuf_cur->m_len, chan->out_mbuf_cur->m_data);
+ }
+ }
+ }
+
+ /*
+ * if there is either still data in the current mbuf and/or
+ * there is a successor on the chain available issue just
+ * a XTF (transmit) command to teh chip. if ther is no more
+ * data available from the current mbuf (-chain), issue
+ * an XTF and an XME (message end) command which will then
+ * send the CRC and the closing HDLC flag sequence
+ */
+
+ if(chan->out_mbuf_cur && (chan->out_mbuf_cur_len > 0))
+ {
+ /*
+ * more data available, send current fifo out.
+ * next xfer to tx fifo is done in the
+ * interrupt routine.
+ */
+
+ cmd |= B_CMDR_XMS;
+ }
+ else
+ {
+ /* end of mbuf chain */
+
+ if(chan->bprot == BPROT_NONE)
+ cmd |= B_CMDR_XMS;
+ else
+ cmd |= (B_CMDR_XMS | B_CMDR_XME);
+
+ i4b_Bfreembuf(chan->out_mbuf_head); /* free mbuf chain */
+
+ chan->out_mbuf_head = NULL;
+ chan->out_mbuf_cur = NULL;
+ chan->out_mbuf_cur_ptr = NULL;
+ chan->out_mbuf_cur_len = 0;
+ }
+
+ /* call timeout handling routine */
+
+ if(activity == ACT_RX || activity == ACT_TX)
+ (*chan->iwic_drvr_linktab->bch_activity)(chan->iwic_drvr_linktab->unit, activity);
+
+ if(cmd)
+ {
+ cmd |= B_CMDR_RACT;
+ IWIC_WRITE(sc, chan->offset + B_CMDR, cmd);
+ }
+
+ splx(s);
+}
+
+/*---------------------------------------------------------------------------*
+ *
+ *---------------------------------------------------------------------------*/
+static void
+iwic_bchannel_stat(int unit, int chan_no, bchan_statistics_t *bsp)
+{
+ struct iwic_softc *sc = iwic_find_sc(unit);
+ struct iwic_bchan *bchan = &sc->sc_bchan[chan_no];
+
+ int s = SPLI4B();
+
+ bsp->outbytes = bchan->txcount;
+ bsp->inbytes = bchan->rxcount;
+
+ bchan->txcount = 0;
+ bchan->rxcount = 0;
+
+ splx(s);
+}
+
+/*---------------------------------------------------------------------------*
+ * initialize our local linktab
+ *---------------------------------------------------------------------------*/
+void
+iwic_init_linktab(struct iwic_softc *sc)
+{
+ struct iwic_bchan *chan;
+ isdn_link_t *lt;
+
+ /* make sure the hardware driver is known to layer 4 */
+ ctrl_types[CTRL_PASSIVE].set_linktab = i4b_l1_set_linktab;
+ ctrl_types[CTRL_PASSIVE].get_linktab = i4b_l1_ret_linktab;
+
+ /* channel A */
+
+ chan = &sc->sc_bchan[IWIC_BCH_A];
+ lt = &chan->iwic_isdn_linktab;
+
+ lt->unit = sc->sc_unit;
+ lt->channel = IWIC_BCH_A;
+ lt->bch_config = iwic_bchannel_setup;
+ lt->bch_tx_start = iwic_bchannel_start;
+ lt->bch_stat = iwic_bchannel_stat;
+ lt->tx_queue = &chan->tx_queue;
+
+ /* used by non-HDLC data transfers, i.e. telephony drivers */
+ lt->rx_queue = &chan->rx_queue;
+
+ /* used by HDLC data transfers, i.e. ipr and isp drivers */
+ lt->rx_mbuf = &chan->in_mbuf;
+
+ /* channel B */
+
+ chan = &sc->sc_bchan[IWIC_BCH_B];
+ lt = &chan->iwic_isdn_linktab;
+
+ lt->unit = sc->sc_unit;
+ lt->channel = IWIC_BCH_B;
+ lt->bch_config = iwic_bchannel_setup;
+ lt->bch_tx_start = iwic_bchannel_start;
+ lt->bch_stat = iwic_bchannel_stat;
+ lt->tx_queue = &chan->tx_queue;
+
+ /* used by non-HDLC data transfers, i.e. telephony drivers */
+ lt->rx_queue = &chan->rx_queue;
+
+ /* used by HDLC data transfers, i.e. ipr and isp drivers */
+ lt->rx_mbuf = &chan->in_mbuf;
+}
+
+#endif /* NIWIC > 0 */
OpenPOWER on IntegriCloud