1083 lines
26 KiB
C
1083 lines
26 KiB
C
|
/*
|
||
|
* Copyright (c) 1997, 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_rbch.c - device driver for raw B channel data
|
||
|
* ---------------------------------------------------
|
||
|
*
|
||
|
* $Id: i4b_rbch.c,v 1.1.1.1 2001/01/05 12:49:58 martin Exp $
|
||
|
*
|
||
|
* $FreeBSD$
|
||
|
*
|
||
|
* last edit-date: [Fri Jan 5 11:33:47 2001]
|
||
|
*
|
||
|
*---------------------------------------------------------------------------*/
|
||
|
|
||
|
#include "i4brbch.h"
|
||
|
|
||
|
#if NI4BRBCH > 0
|
||
|
|
||
|
#include <sys/param.h>
|
||
|
#include <sys/systm.h>
|
||
|
|
||
|
#include <sys/conf.h>
|
||
|
#include <sys/uio.h>
|
||
|
#include <sys/kernel.h>
|
||
|
#include <sys/mbuf.h>
|
||
|
#include <sys/socket.h>
|
||
|
#include <net/if.h>
|
||
|
#include <sys/proc.h>
|
||
|
#include <sys/tty.h>
|
||
|
|
||
|
#if defined(__NetBSD__) && __NetBSD_Version__ >= 104230000
|
||
|
#include <sys/callout.h>
|
||
|
#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__
|
||
|
|
||
|
#if defined(__FreeBSD__) && __FreeBSD__ == 3
|
||
|
#include "opt_devfs.h"
|
||
|
#endif
|
||
|
|
||
|
#ifdef DEVFS
|
||
|
#include <sys/devfsext.h>
|
||
|
#endif
|
||
|
|
||
|
#endif /* __FreeBSD__ */
|
||
|
|
||
|
#ifdef __NetBSD__
|
||
|
#include <sys/filio.h>
|
||
|
#endif
|
||
|
|
||
|
#ifdef __FreeBSD__
|
||
|
#include <machine/i4b_ioctl.h>
|
||
|
#include <machine/i4b_rbch_ioctl.h>
|
||
|
#include <machine/i4b_debug.h>
|
||
|
#else
|
||
|
#include <netisdn/i4b_ioctl.h>
|
||
|
#include <netisdn/i4b_rbch_ioctl.h>
|
||
|
#include <netisdn/i4b_debug.h>
|
||
|
#endif
|
||
|
|
||
|
#include <netisdn/i4b_global.h>
|
||
|
#include <netisdn/i4b_mbuf.h>
|
||
|
#include <netisdn/i4b_l3l4.h>
|
||
|
|
||
|
#include <netisdn/i4b_l4.h>
|
||
|
|
||
|
#ifdef __bsdi__
|
||
|
#include <sys/device.h>
|
||
|
#endif
|
||
|
|
||
|
#ifdef OS_USES_POLL
|
||
|
#include <sys/ioccom.h>
|
||
|
#include <sys/poll.h>
|
||
|
#else
|
||
|
#include <sys/fcntl.h>
|
||
|
#include <sys/ioctl.h>
|
||
|
#endif
|
||
|
|
||
|
#if defined(__FreeBSD__) && __FreeBSD__ >= 3
|
||
|
#include <sys/filio.h>
|
||
|
#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 defined(__FreeBSD__) && __FreeBSD__ == 3
|
||
|
#ifdef DEVFS
|
||
|
void *devfs_token; /* device filesystem */
|
||
|
#endif
|
||
|
#endif
|
||
|
|
||
|
#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 proc *p));
|
||
|
int i4brbchclose __P((dev_t dev, int flag, int fmt, struct proc *p));
|
||
|
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 proc* pr));
|
||
|
#ifdef OS_USES_POLL
|
||
|
int i4brbchpoll __P((dev_t dev, int events, struct proc *p));
|
||
|
#else
|
||
|
PDEVSTATIC int i4brbchselect __P((dev_t dev, int rw, struct proc *p));
|
||
|
#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
|
||
|
|
||
|
#if defined(__FreeBSD__) && __FreeBSD__ >= 4
|
||
|
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,
|
||
|
/* bmaj */ -1
|
||
|
};
|
||
|
#else
|
||
|
static struct cdevsw i4brbch_cdevsw = {
|
||
|
i4brbchopen, i4brbchclose, i4brbchread, i4brbchwrite,
|
||
|
i4brbchioctl, nostop, noreset, nodevtotty,
|
||
|
POLLFIELD, nommap, NULL, "i4brbch", NULL, -1
|
||
|
};
|
||
|
#endif
|
||
|
|
||
|
static void i4brbchattach(void *);
|
||
|
PSEUDO_SET(i4brbchattach, i4b_rbch);
|
||
|
|
||
|
/*===========================================================================*
|
||
|
* DEVICE DRIVER ROUTINES
|
||
|
*===========================================================================*/
|
||
|
|
||
|
/*---------------------------------------------------------------------------*
|
||
|
* initialization at kernel load time
|
||
|
*---------------------------------------------------------------------------*/
|
||
|
static void
|
||
|
i4brbchinit(void *unused)
|
||
|
{
|
||
|
#if defined(__FreeBSD__) && __FreeBSD__ >= 4
|
||
|
cdevsw_add(&i4brbch_cdevsw);
|
||
|
#else
|
||
|
dev_t dev = makedev(CDEV_MAJOR, 0);
|
||
|
cdevsw_add(&dev, &i4brbch_cdevsw, NULL);
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
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__)
|
||
|
#if __FreeBSD__ == 3
|
||
|
|
||
|
#ifdef DEVFS
|
||
|
rbch_softc[i].devfs_token =
|
||
|
devfs_add_devswf(&i4brbch_cdevsw, i, DV_CHR,
|
||
|
UID_ROOT, GID_WHEEL, 0600,
|
||
|
"i4brbch%d", i);
|
||
|
#endif
|
||
|
|
||
|
#else
|
||
|
make_dev(&i4brbch_cdevsw, i,
|
||
|
UID_ROOT, GID_WHEEL, 0600, "i4brbch%d", i);
|
||
|
#endif
|
||
|
#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;
|
||
|
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 proc *p)
|
||
|
{
|
||
|
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 proc *p)
|
||
|
{
|
||
|
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(IF_QFULL(isdn_linktab[unit]->tx_queue))
|
||
|
{
|
||
|
m_freem(m);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
IF_ENQUEUE(isdn_linktab[unit]->tx_queue, m);
|
||
|
}
|
||
|
|
||
|
(*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 proc *p)
|
||
|
{
|
||
|
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 proc *p)
|
||
|
{
|
||
|
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(p, &sc->selp);
|
||
|
|
||
|
splx(s);
|
||
|
return(revents);
|
||
|
}
|
||
|
|
||
|
#else /* OS_USES_POLL */
|
||
|
|
||
|
/*---------------------------------------------------------------------------*
|
||
|
* device driver select
|
||
|
*---------------------------------------------------------------------------*/
|
||
|
PDEVSTATIC int
|
||
|
i4brbchselect(dev_t dev, int rw, struct proc *p)
|
||
|
{
|
||
|
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(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);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
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)
|
||
|
{
|
||
|
struct mbuf *m;
|
||
|
CRIT_VAR;
|
||
|
|
||
|
for(;;)
|
||
|
{
|
||
|
CRIT_BEG;
|
||
|
IF_DEQUEUE(&rbch_softc[unit].sc_hdlcq, m);
|
||
|
CRIT_END;
|
||
|
|
||
|
if(m)
|
||
|
m_freem(m);
|
||
|
else
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/*---------------------------------------------------------------------------*
|
||
|
* 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 */
|