2 * Copyright (c) 1997, 2001 Hellmuth Michaelis. All rights reserved.
4 * Redistribution and use in source and binary forms, with or without
5 * modification, are permitted provided that the following conditions
7 * 1. Redistributions of source code must retain the above copyright
8 * notice, this list of conditions and the following disclaimer.
9 * 2. Redistributions in binary form must reproduce the above copyright
10 * notice, this list of conditions and the following disclaimer in the
11 * documentation and/or other materials provided with the distribution.
13 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
14 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
15 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
16 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
17 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
18 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
19 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
20 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
21 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
22 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25 *---------------------------------------------------------------------------
27 * i4b_rbch.c - device driver for raw B channel data
28 * ---------------------------------------------------
30 * $FreeBSD: src/sys/i4b/driver/i4b_rbch.c,v 1.10.2.3 2001/08/12 16:22:48 hm Exp $
31 * $DragonFly: src/sys/net/i4b/driver/i4b_rbch.c,v 1.22 2006/12/22 23:44:55 swildner Exp $
33 * last edit-date: [Sat Aug 11 18:06:57 2001]
35 *---------------------------------------------------------------------------*/
37 #include "use_i4brbch.h"
41 #include <sys/param.h>
42 #include <sys/systm.h>
46 #include <sys/kernel.h>
48 #include <sys/socket.h>
51 #include <sys/thread2.h>
52 #include <sys/vnode.h>
54 #include <net/i4b/include/machine/i4b_ioctl.h>
55 #include <net/i4b/include/machine/i4b_rbch_ioctl.h>
56 #include <net/i4b/include/machine/i4b_debug.h>
58 #include "../include/i4b_global.h"
59 #include "../include/i4b_mbuf.h"
60 #include "../include/i4b_l3l4.h"
61 #include "../layer4/i4b_l4.h"
64 #include <sys/filio.h>
66 static drvr_link_t rbch_drvr_linktab[NI4BRBCH];
67 static isdn_link_t *isdn_linktab[NI4BRBCH];
69 #define I4BRBCHACCT 1 /* enable accounting messages */
70 #define I4BRBCHACCTINTVL 2 /* accounting msg interval in secs */
72 static struct rbch_softc {
74 int sc_unit; /* unit number */
76 int sc_devstate; /* state of driver */
78 #define ST_CONNECTED 0x01
79 #define ST_ISOPEN 0x02
80 #define ST_RDWAITDATA 0x04
81 #define ST_WRWAITEMPTY 0x08
82 #define ST_NOBLOCK 0x10
84 int sc_bprot; /* B-ch protocol used */
86 call_desc_t *sc_cd; /* Call Descriptor */
90 struct ifqueue sc_hdlcq; /* hdlc read queue */
91 #define I4BRBCHMAXQLEN 10
93 struct selinfo selp; /* select / poll */
96 struct callout sc_timeout;
98 int sc_iinb; /* isdn driver # of inbytes */
99 int sc_ioutb; /* isdn driver # of outbytes */
100 int sc_linb; /* last # of bytes rx'd */
101 int sc_loutb; /* last # of bytes tx'd */
102 int sc_fn; /* flag, first null acct */
104 } rbch_softc[NI4BRBCH];
106 static void rbch_rx_data_rdy(int unit);
107 static void rbch_tx_queue_empty(int unit);
108 static void rbch_connect(int unit, void *cdp);
109 static void rbch_disconnect(int unit, void *cdp);
110 static void rbch_init_linktab(int unit);
111 static void rbch_clrq(int unit);
113 #define PDEVSTATIC static
114 #define IOCTL_CMD_T u_long
116 PDEVSTATIC d_open_t i4brbchopen;
117 PDEVSTATIC d_close_t i4brbchclose;
118 PDEVSTATIC d_read_t i4brbchread;
119 PDEVSTATIC d_write_t i4brbchwrite;
120 PDEVSTATIC d_ioctl_t i4brbchioctl;
122 PDEVSTATIC d_poll_t i4brbchpoll;
123 #define POLLFIELD i4brbchpoll
125 #define CDEV_MAJOR 57
127 static struct dev_ops i4brbch_ops = {
128 { "i4brbch", CDEV_MAJOR, 0 },
129 .d_open = i4brbchopen,
130 .d_close = i4brbchclose,
131 .d_read = i4brbchread,
132 .d_write = i4brbchwrite,
133 .d_ioctl = i4brbchioctl,
137 static void i4brbchattach(void *);
138 PSEUDO_SET(i4brbchattach, i4b_rbch);
140 /*===========================================================================*
141 * DEVICE DRIVER ROUTINES
142 *===========================================================================*/
144 /*---------------------------------------------------------------------------*
145 * interface attach routine
146 *---------------------------------------------------------------------------*/
148 i4brbchattach(void *dummy)
152 #ifndef HACK_NO_PSEUDO_ATTACH_MSG
153 kprintf("i4brbch: %d raw B channel access device(s) attached\n", NI4BRBCH);
156 for(i=0; i < NI4BRBCH; i++)
158 make_dev(&i4brbch_ops, i,
159 UID_ROOT, GID_WHEEL, 0600, "i4brbch%d", i);
162 callout_init(&rbch_softc[i].sc_timeout);
163 rbch_softc[i].sc_fn = 1;
165 rbch_softc[i].sc_unit = i;
166 rbch_softc[i].sc_devstate = ST_IDLE;
167 rbch_softc[i].sc_hdlcq.ifq_maxlen = I4BRBCHMAXQLEN;
168 rbch_softc[i].it_in.c_ispeed = rbch_softc[i].it_in.c_ospeed = 64000;
169 termioschars(&rbch_softc[i].it_in);
170 rbch_init_linktab(i);
174 /*---------------------------------------------------------------------------*
176 *---------------------------------------------------------------------------*/
178 i4brbchopen(struct dev_open_args *ap)
180 cdev_t dev = ap->a_head.a_dev;
181 int unit = minor(dev);
186 if(rbch_softc[unit].sc_devstate & ST_ISOPEN)
193 rbch_softc[unit].sc_devstate |= ST_ISOPEN;
195 NDBGL4(L4_RBCHDBG, "unit %d, open", unit);
200 /*---------------------------------------------------------------------------*
202 *---------------------------------------------------------------------------*/
204 i4brbchclose(struct dev_close_args *ap)
206 cdev_t dev = ap->a_head.a_dev;
207 int unit = minor(dev);
208 struct rbch_softc *sc = &rbch_softc[unit];
210 if(sc->sc_devstate & ST_CONNECTED)
211 i4b_l4_drvrdisc(BDRV_RBCH, unit);
213 sc->sc_devstate &= ~ST_ISOPEN;
217 NDBGL4(L4_RBCHDBG, "unit %d, closed", unit);
222 /*---------------------------------------------------------------------------*
223 * read from rbch device
224 *---------------------------------------------------------------------------*/
226 i4brbchread(struct dev_read_args *ap)
228 cdev_t dev = ap->a_head.a_dev;
229 struct uio *uio = ap->a_uio;
232 int unit = minor(dev);
234 struct rbch_softc *sc = &rbch_softc[unit];
238 NDBGL4(L4_RBCHDBG, "unit %d, enter read", unit);
241 if(!(sc->sc_devstate & ST_ISOPEN))
244 NDBGL4(L4_RBCHDBG, "unit %d, read while not open", unit);
248 if((sc->sc_devstate & ST_NOBLOCK) || (ap->a_ioflag & IO_NDELAY))
250 if(!(sc->sc_devstate & ST_CONNECTED)) {
255 if(sc->sc_bprot == BPROT_RHDLC)
258 iqp = isdn_linktab[unit]->rx_queue;
260 if(IF_QEMPTY(iqp) && (sc->sc_devstate & ST_ISOPEN)) {
267 while(!(sc->sc_devstate & ST_CONNECTED))
269 NDBGL4(L4_RBCHDBG, "unit %d, wait read init", unit);
271 if((error = tsleep((caddr_t) &rbch_softc[unit],
272 PCATCH, "rrrbch", 0 )) != 0)
275 NDBGL4(L4_RBCHDBG, "unit %d, error %d tsleep", unit, error);
280 if(sc->sc_bprot == BPROT_RHDLC)
283 iqp = isdn_linktab[unit]->rx_queue;
285 while(IF_QEMPTY(iqp) && (sc->sc_devstate & ST_ISOPEN))
287 sc->sc_devstate |= ST_RDWAITDATA;
289 NDBGL4(L4_RBCHDBG, "unit %d, wait read data", unit);
291 if((error = tsleep((caddr_t) &isdn_linktab[unit]->rx_queue,
292 PCATCH, "rrbch", 0 )) != 0)
295 NDBGL4(L4_RBCHDBG, "unit %d, error %d tsleep read", unit, error);
296 sc->sc_devstate &= ~ST_RDWAITDATA;
304 NDBGL4(L4_RBCHDBG, "unit %d, read %d bytes", unit, m->m_len);
308 error = uiomove(m->m_data, m->m_len, uio);
312 NDBGL4(L4_RBCHDBG, "unit %d, error %d uiomove", unit, error);
324 /*---------------------------------------------------------------------------*
325 * write to rbch device
326 *---------------------------------------------------------------------------*/
328 i4brbchwrite(struct dev_write_args *ap)
330 cdev_t dev = ap->a_head.a_dev;
331 struct uio *uio = ap->a_uio;
334 int unit = minor(dev);
335 struct rbch_softc *sc = &rbch_softc[unit];
339 NDBGL4(L4_RBCHDBG, "unit %d, write", unit);
342 if(!(sc->sc_devstate & ST_ISOPEN))
344 NDBGL4(L4_RBCHDBG, "unit %d, write while not open", unit);
349 if((sc->sc_devstate & ST_NOBLOCK) || (ap->a_ioflag & IO_NDELAY))
351 if(!(sc->sc_devstate & ST_CONNECTED)) {
355 if(IF_QFULL(isdn_linktab[unit]->tx_queue) && (sc->sc_devstate & ST_ISOPEN)) {
362 while(!(sc->sc_devstate & ST_CONNECTED))
364 NDBGL4(L4_RBCHDBG, "unit %d, write wait init", unit);
366 error = tsleep((caddr_t) &rbch_softc[unit],
367 PCATCH, "wrrbch", 0 );
368 if(error == ERESTART) {
372 else if(error == EINTR)
375 NDBGL4(L4_RBCHDBG, "unit %d, EINTR during wait init", unit);
381 NDBGL4(L4_RBCHDBG, "unit %d, error %d tsleep init", unit, error);
384 tsleep((caddr_t) &rbch_softc[unit], PCATCH, "xrbch", (hz*1));
387 while(IF_QFULL(isdn_linktab[unit]->tx_queue) && (sc->sc_devstate & ST_ISOPEN))
389 sc->sc_devstate |= ST_WRWAITEMPTY;
391 NDBGL4(L4_RBCHDBG, "unit %d, write queue full", unit);
393 if ((error = tsleep((caddr_t) &isdn_linktab[unit]->tx_queue,
394 PCATCH, "wrbch", 0)) != 0) {
395 sc->sc_devstate &= ~ST_WRWAITEMPTY;
396 if(error == ERESTART)
401 else if(error == EINTR)
404 NDBGL4(L4_RBCHDBG, "unit %d, EINTR during wait write", unit);
410 NDBGL4(L4_RBCHDBG, "unit %d, error %d tsleep write", unit, error);
417 if(!(sc->sc_devstate & ST_ISOPEN))
419 NDBGL4(L4_RBCHDBG, "unit %d, not open anymore", unit);
424 if((m = i4b_Bgetmbuf(BCH_MAX_DATALEN)) != NULL)
426 m->m_len = (int)szmin(BCH_MAX_DATALEN, uio->uio_resid);
428 NDBGL4(L4_RBCHDBG, "unit %d, write %d bytes", unit, m->m_len);
430 error = uiomove(m->m_data, (size_t)m->m_len, uio);
432 if(IF_QFULL(isdn_linktab[unit]->tx_queue))
435 IF_ENQUEUE(isdn_linktab[unit]->tx_queue, m);
436 (*isdn_linktab[unit]->bch_tx_start)(isdn_linktab[unit]->unit, isdn_linktab[unit]->channel);
444 /*---------------------------------------------------------------------------*
445 * rbch device ioctl handlibg
446 *---------------------------------------------------------------------------*/
448 i4brbchioctl(struct dev_ioctl_args *ap)
450 cdev_t dev = ap->a_head.a_dev;
452 int unit = minor(dev);
453 struct rbch_softc *sc = &rbch_softc[unit];
457 case FIOASYNC: /* Set async mode */
458 if (*(int *)ap->a_data)
460 NDBGL4(L4_RBCHDBG, "unit %d, setting async mode", unit);
464 NDBGL4(L4_RBCHDBG, "unit %d, clearing async mode", unit);
468 case TIOCCDTR: /* Clear DTR */
469 if(sc->sc_devstate & ST_CONNECTED)
471 NDBGL4(L4_RBCHDBG, "unit %d, disconnecting for DTR down", unit);
472 i4b_l4_drvrdisc(BDRV_RBCH, unit);
476 case I4B_RBCH_DIALOUT:
480 for (l = 0; l < TELNO_MAX && ((char *)ap->a_data)[l]; l++)
484 NDBGL4(L4_RBCHDBG, "unit %d, attempting dialout to %s", unit, (char *)ap->a_data);
485 i4b_l4_dialoutnumber(BDRV_RBCH, unit, l, (char *)ap->a_data);
488 /* fall through to SDTR */
491 case TIOCSDTR: /* Set DTR */
492 NDBGL4(L4_RBCHDBG, "unit %d, attempting dialout (DTR)", unit);
493 i4b_l4_dialout(BDRV_RBCH, unit);
496 case TIOCSETA: /* Set termios struct */
499 case TIOCGETA: /* Get termios struct */
500 *(struct termios *)ap->a_data = sc->it_in;
504 *(int *)ap->a_data = TIOCM_LE|TIOCM_DTR|TIOCM_RTS|TIOCM_CTS|TIOCM_DSR;
505 if (sc->sc_devstate & ST_CONNECTED)
506 *(int *)ap->a_data |= TIOCM_CD;
509 case I4B_RBCH_VR_REQ:
513 mvr = (msg_vr_req_t *)ap->a_data;
515 mvr->version = VERSION;
521 default: /* Unknown stuff */
522 NDBGL4(L4_RBCHDBG, "unit %d, ioctl, unknown cmd %lx", unit, ap->a_cmd);
529 /*---------------------------------------------------------------------------*
531 *---------------------------------------------------------------------------*/
533 i4brbchpoll(struct dev_poll_args *ap)
535 cdev_t dev = ap->a_head.a_dev;
536 int revents = 0; /* Events we found */
537 int unit = minor(dev);
538 struct rbch_softc *sc = &rbch_softc[unit];
540 /* We can't check for anything but IN or OUT */
543 if(!(sc->sc_devstate & ST_ISOPEN))
550 * Writes are OK if we are connected and the
551 * transmit queue can take them
554 if((ap->a_events & (POLLOUT|POLLWRNORM)) &&
555 (sc->sc_devstate & ST_CONNECTED) &&
556 !IF_QFULL(isdn_linktab[unit]->tx_queue))
558 revents |= (ap->a_events & (POLLOUT|POLLWRNORM));
561 /* ... while reads are OK if we have any data */
563 if((ap->a_events & (POLLIN|POLLRDNORM)) &&
564 (sc->sc_devstate & ST_CONNECTED))
568 if(sc->sc_bprot == BPROT_RHDLC)
571 iqp = isdn_linktab[unit]->rx_queue;
574 revents |= (ap->a_events & (POLLIN|POLLRDNORM));
578 selrecord(curthread, &sc->selp);
581 ap->a_events = revents;
586 /*---------------------------------------------------------------------------*
588 *---------------------------------------------------------------------------*/
590 rbch_timeout(struct rbch_softc *sc)
592 bchan_statistics_t bs;
593 int unit = sc->sc_unit;
595 /* get # of bytes in and out from the HSCX driver */
597 (*isdn_linktab[unit]->bch_stat)
598 (isdn_linktab[unit]->unit, isdn_linktab[unit]->channel, &bs);
600 sc->sc_ioutb += bs.outbytes;
601 sc->sc_iinb += bs.inbytes;
603 if((sc->sc_iinb != sc->sc_linb) || (sc->sc_ioutb != sc->sc_loutb) || sc->sc_fn)
605 int ri = (sc->sc_iinb - sc->sc_linb)/I4BRBCHACCTINTVL;
606 int ro = (sc->sc_ioutb - sc->sc_loutb)/I4BRBCHACCTINTVL;
608 if((sc->sc_iinb == sc->sc_linb) && (sc->sc_ioutb == sc->sc_loutb))
613 sc->sc_linb = sc->sc_iinb;
614 sc->sc_loutb = sc->sc_ioutb;
616 i4b_l4_accounting(BDRV_RBCH, unit, ACCT_DURING,
617 sc->sc_ioutb, sc->sc_iinb, ro, ri, sc->sc_ioutb, sc->sc_iinb);
619 callout_reset(&sc->sc_timeout, I4BRBCHACCTINTVL * hz,
620 (void *)rbch_timeout, sc);
622 #endif /* I4BRBCHACCT */
624 /*===========================================================================*
625 * ISDN INTERFACE ROUTINES
626 *===========================================================================*/
628 /*---------------------------------------------------------------------------*
629 * this routine is called from L4 handler at connect time
630 *---------------------------------------------------------------------------*/
632 rbch_connect(int unit, void *cdp)
634 call_desc_t *cd = (call_desc_t *)cdp;
635 struct rbch_softc *sc = &rbch_softc[unit];
637 sc->sc_bprot = cd->bprot;
640 if(sc->sc_bprot == BPROT_RHDLC)
647 callout_reset(&sc->sc_timeout, I4BRBCHACCTINTVL * hz,
648 (void *)rbch_timeout, sc);
651 if(!(sc->sc_devstate & ST_CONNECTED))
653 NDBGL4(L4_RBCHDBG, "unit %d, wakeup", unit);
654 sc->sc_devstate |= ST_CONNECTED;
660 /*---------------------------------------------------------------------------*
661 * this routine is called from L4 handler at disconnect time
662 *---------------------------------------------------------------------------*/
664 rbch_disconnect(int unit, void *cdp)
666 call_desc_t *cd = (call_desc_t *)cdp;
667 struct rbch_softc *sc = &rbch_softc[unit];
673 NDBGL4(L4_RBCHDBG, "rbch%d: channel %d not active",
674 cd->driver_unit, cd->channelid);
680 NDBGL4(L4_RBCHDBG, "unit %d, disconnect", unit);
682 sc->sc_devstate &= ~ST_CONNECTED;
687 i4b_l4_accounting(BDRV_RBCH, unit, ACCT_FINAL,
688 sc->sc_ioutb, sc->sc_iinb, 0, 0, sc->sc_ioutb, sc->sc_iinb);
689 callout_stop(&sc->sc_timeout);
694 /*---------------------------------------------------------------------------*
695 * feedback from daemon in case of dial problems
696 *---------------------------------------------------------------------------*/
698 rbch_dialresponse(int unit, int status, cause_t cause)
702 /*---------------------------------------------------------------------------*
704 *---------------------------------------------------------------------------*/
706 rbch_updown(int unit, int updown)
710 /*---------------------------------------------------------------------------*
711 * this routine is called from the HSCX interrupt handler
712 * when a new frame (mbuf) has been received and is to be put on
714 *---------------------------------------------------------------------------*/
716 rbch_rx_data_rdy(int unit)
718 if(rbch_softc[unit].sc_bprot == BPROT_RHDLC)
722 if((m = *isdn_linktab[unit]->rx_mbuf) == NULL)
725 m->m_pkthdr.len = m->m_len;
727 if(IF_QFULL(&(rbch_softc[unit].sc_hdlcq)))
729 NDBGL4(L4_RBCHDBG, "unit %d: hdlc rx queue full!", unit);
734 IF_ENQUEUE(&(rbch_softc[unit].sc_hdlcq), m);
738 if(rbch_softc[unit].sc_devstate & ST_RDWAITDATA)
740 NDBGL4(L4_RBCHDBG, "unit %d, wakeup", unit);
741 rbch_softc[unit].sc_devstate &= ~ST_RDWAITDATA;
742 wakeup((caddr_t) &isdn_linktab[unit]->rx_queue);
746 NDBGL4(L4_RBCHDBG, "unit %d, NO wakeup", unit);
748 selwakeup(&rbch_softc[unit].selp);
751 /*---------------------------------------------------------------------------*
752 * this routine is called from the HSCX interrupt handler
753 * when the last frame has been sent out and there is no
754 * further frame (mbuf) in the tx queue.
755 *---------------------------------------------------------------------------*/
757 rbch_tx_queue_empty(int unit)
759 if(rbch_softc[unit].sc_devstate & ST_WRWAITEMPTY)
761 NDBGL4(L4_RBCHDBG, "unit %d, wakeup", unit);
762 rbch_softc[unit].sc_devstate &= ~ST_WRWAITEMPTY;
763 wakeup((caddr_t) &isdn_linktab[unit]->tx_queue);
767 NDBGL4(L4_RBCHDBG, "unit %d, NO wakeup", unit);
769 selwakeup(&rbch_softc[unit].selp);
772 /*---------------------------------------------------------------------------*
773 * this routine is called from the HSCX interrupt handler
774 * each time a packet is received or transmitted
775 *---------------------------------------------------------------------------*/
777 rbch_activity(int unit, int rxtx)
779 if (rbch_softc[unit].sc_cd)
780 rbch_softc[unit].sc_cd->last_active_time = SECOND;
781 selwakeup(&rbch_softc[unit].selp);
784 /*---------------------------------------------------------------------------*
785 * clear an hdlc rx queue for a rbch unit
786 *---------------------------------------------------------------------------*/
793 IF_DRAIN(&rbch_softc[unit].sc_hdlcq);
797 /*---------------------------------------------------------------------------*
798 * return this drivers linktab address
799 *---------------------------------------------------------------------------*/
801 rbch_ret_linktab(int unit)
803 rbch_init_linktab(unit);
804 return(&rbch_drvr_linktab[unit]);
807 /*---------------------------------------------------------------------------*
808 * setup the isdn_linktab for this driver
809 *---------------------------------------------------------------------------*/
811 rbch_set_linktab(int unit, isdn_link_t *ilt)
813 isdn_linktab[unit] = ilt;
816 /*---------------------------------------------------------------------------*
817 * initialize this drivers linktab
818 *---------------------------------------------------------------------------*/
820 rbch_init_linktab(int unit)
822 rbch_drvr_linktab[unit].unit = unit;
823 rbch_drvr_linktab[unit].bch_rx_data_ready = rbch_rx_data_rdy;
824 rbch_drvr_linktab[unit].bch_tx_queue_empty = rbch_tx_queue_empty;
825 rbch_drvr_linktab[unit].bch_activity = rbch_activity;
826 rbch_drvr_linktab[unit].line_connected = rbch_connect;
827 rbch_drvr_linktab[unit].line_disconnected = rbch_disconnect;
828 rbch_drvr_linktab[unit].dial_response = rbch_dialresponse;
829 rbch_drvr_linktab[unit].updown_ind = rbch_updown;
832 /*===========================================================================*/
834 #endif /* NI4BRBCH > 0 */