freebsd-dev/sys/i4b/driver/i4b_tel.c
Poul-Henning Kamp d6a0e38a1b Remove five now unused fields from struct cdevsw. They should never
have been there in the first place.  A GENERIC kernel shrinks almost 1k.

Add a slightly different safetybelt under nostop for tty drivers.

Add some missing FreeBSD tags
1999-09-25 18:24:47 +00:00

1177 lines
31 KiB
C

/*
* Copyright (c) 1997, 1999 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_tel.c - device driver for ISDN telephony
* --------------------------------------------
*
* $FreeBSD$
*
* last edit-date: [Sat Aug 28 22:28:25 1999]
*
*---------------------------------------------------------------------------*/
#include "i4btel.h"
#if NI4BTEL > 0
#undef I4BTELDEBUG
#include <sys/param.h>
#include <sys/systm.h>
#if defined(__FreeBSD_version) && __FreeBSD_version >= 300001 || defined(__NetBSD__)
#include <sys/ioccom.h>
#include <sys/poll.h>
#else
#include <sys/ioctl.h>
#include <sys/fcntl.h>
#endif
#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>
#ifdef __bsdi__
#include <sys/device.h>
#endif
#ifdef __FreeBSD__
#include <machine/i4b_ioctl.h>
#include <machine/i4b_tel_ioctl.h>
#include <machine/i4b_debug.h>
#else
#include <i4b/i4b_ioctl.h>
#include <i4b/i4b_tel_ioctl.h>
#include <i4b/i4b_debug.h>
#endif
#include <i4b/include/i4b_global.h>
#include <i4b/include/i4b_mbuf.h>
#include <i4b/include/i4b_l3l4.h>
#include <i4b/layer4/i4b_l4.h>
/* minor number: lower 6 bits = unit number */
#include <i4b/layer4/i4b_l4.h>
#define UNITBITS 6
#define UNITMASK 0x3f
#define UNIT(n) (minor(n) & UNITMASK)
/* minor number: upper 2 bits = function number */
#define FUNCMASK 0x03
#define FUNC(n) (((minor(n)) >> UNITBITS) & FUNCMASK)
#define FUNCTEL 0 /* 0 = normal i4btel device */
#define FUNCDIAL 1 /* 1 = i4bteld dialout device */
#define NOFUNCS 2 /* number of device classes */
typedef struct {
/* used only in func = FUNCTEL */
drvr_link_t drvr_linktab; /* driver linktab */
isdn_link_t *isdn_linktab; /* isdn linktab */
int audiofmt; /* audio format conversion */
u_char *rcvttab; /* conversion table on read */
u_char *wcvttab; /* conversion table on write */
call_desc_t *cdp; /* call descriptor pointer */
/* used only in func = FUNCDIAL */
char result; /* result code for dial dev */
/* used in func = FUNCDIAL and func = FUNCTEL*/
int devstate; /* state of this unit */
#define ST_IDLE 0x00 /* idle */
#define ST_CONNECTED 0x01 /* isdn connected state */
#define ST_ISOPEN 0x02 /* userland opened */
#define ST_RDWAITDATA 0x04 /* userland read waiting */
#define ST_WRWAITEMPTY 0x08 /* userland write waiting */
struct selinfo selp; /* select / poll */
} tel_sc_t;
static tel_sc_t tel_sc[NI4BTEL][NOFUNCS];
/* forward decl */
static void tel_rx_data_rdy(int unit);
static void tel_tx_queue_empty(int unit);
static void tel_init_linktab(int unit);
static void tel_connect(int unit, void *cdp);
static void tel_disconnect(int unit, void *cdp);
/* audio format conversion tables */
static unsigned char a2u_tab[];
static unsigned char u2a_tab[];
static unsigned char bitreverse[];
#ifndef __FreeBSD__
#define PDEVSTATIC /* - not static - */
PDEVSTATIC void i4btelattach __P((void));
#ifdef __bsdi__
PDEVSTATIC int i4btelioctl __P((dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p));
#else
PDEVSTATIC int i4btelioctl __P((dev_t dev, int cmd, caddr_t data, int flag, struct proc *p));
#endif
int i4btelopen __P((dev_t dev, int flag, int fmt, struct proc *p));
int i4btelclose __P((dev_t dev, int flag, int fmt, struct proc *p));
int i4btelread __P((dev_t dev, struct uio *uio, int ioflag));
int i4btelwrite __P((dev_t dev, struct uio * uio, int ioflag));
#ifdef OS_USES_POLL
int i4btelpoll __P((dev_t dev, int events, struct proc *p));
#else
int i4btelsel __P((dev_t dev, int rw, struct proc *p));
#endif
#endif /* __FreeBSD__ */
#if BSD > 199306 && defined(__FreeBSD__)
#define PDEVSTATIC static
PDEVSTATIC d_open_t i4btelopen;
PDEVSTATIC d_close_t i4btelclose;
PDEVSTATIC d_read_t i4btelread;
PDEVSTATIC d_read_t i4btelwrite;
PDEVSTATIC d_ioctl_t i4btelioctl;
#ifdef OS_USES_POLL
PDEVSTATIC d_poll_t i4btelpoll;
#define POLLFIELD i4btelpoll
#else
PDEVSTATIC d_select_t i4btelsel;
#define POLLFIELD i4btelsel
#endif
#define CDEV_MAJOR 56
#if defined (__FreeBSD_version) && __FreeBSD_version >= 400006
static struct cdevsw i4btel_cdevsw = {
/* open */ i4btelopen,
/* close */ i4btelclose,
/* read */ i4btelread,
/* write */ i4btelwrite,
/* ioctl */ i4btelioctl,
/* poll */ POLLFIELD,
/* mmap */ nommap,
/* strategy */ nostrategy,
/* name */ "i4btel",
/* maj */ CDEV_MAJOR,
/* dump */ nodump,
/* psize */ nopsize,
/* flags */ 0,
/* bmaj */ -1
};
#else
static struct cdevsw i4btel_cdevsw = {
i4btelopen, i4btelclose, i4btelread, i4btelwrite,
i4btelioctl, nostop, noreset, nodevtotty,
POLLFIELD, nommap, NULL, "i4btel", NULL, -1
};
#endif
PDEVSTATIC void i4btelinit(void *unused);
PDEVSTATIC void i4btelattach(void *);
PSEUDO_SET(i4btelattach, i4b_tel);
/*===========================================================================*
* DEVICE DRIVER ROUTINES
*===========================================================================*/
/*---------------------------------------------------------------------------*
* initialization at kernel load time
*---------------------------------------------------------------------------*/
PDEVSTATIC void
i4btelinit(void *unused)
{
#if defined (__FreeBSD_version) && __FreeBSD_version >= 400006
cdevsw_add(&i4btel_cdevsw);
#else
dev_t dev = makedev(CDEV_MAJOR, 0);
cdevsw_add(&dev, &i4btel_cdevsw, NULL);
#endif
}
SYSINIT(i4bteldev, SI_SUB_DRIVERS,
SI_ORDER_MIDDLE+CDEV_MAJOR, &i4btelinit, NULL);
#endif /* BSD > 199306 && defined(__FreeBSD__) */
#ifdef __bsdi__
int i4btelsel(dev_t dev, int rw, struct proc *p);
int i4btelmatch(struct device *parent, struct cfdata *cf, void *aux);
void dummy_i4btelattach(struct device*, struct device *, void *);
#define CDEV_MAJOR 62
static struct cfdriver i4btelcd =
{ NULL, "i4btel", i4btelmatch, dummy_i4btelattach, DV_DULL,
sizeof(struct cfdriver) };
struct devsw i4btelsw =
{ &i4btelcd,
i4btelopen, i4btelclose, i4btelread, i4btelwrite,
i4btelioctl, i4btelsel, nommap, nostrat,
nodump, nopsize, 0, nostop
};
int
i4btelmatch(struct device *parent, struct cfdata *cf, void *aux)
{
DBGL4(L4_TELDBG, "i4btelmatch", ("aux=0x%x\n", aux));
return 1;
}
void
dummy_i4btelattach(struct device *parent, struct device *self, void *aux)
{
DBGL4(L4_TELDBG, "dummy_i4btelattach", ("aux=0x%x\n", aux));
}
#endif /* __bsdi__ */
/*---------------------------------------------------------------------------*
* interface attach routine
*---------------------------------------------------------------------------*/
PDEVSTATIC void
#ifdef __FreeBSD__
i4btelattach(void *dummy)
#else
i4btelattach()
#endif
{
int i, j;
#ifndef HACK_NO_PSEUDO_ATTACH_MSG
printf("i4btel: %d ISDN telephony interface device(s) attached\n", NI4BTEL);
#endif
for(i=0; i < NI4BTEL; i++)
{
for(j=0; j < NOFUNCS; j++)
{
tel_sc[i][j].devstate = ST_IDLE;
tel_sc[i][j].audiofmt = CVT_NONE;
tel_sc[i][j].rcvttab = 0;
tel_sc[i][j].wcvttab = 0;
tel_sc[i][j].result = 0;
switch(j)
{
case FUNCTEL: /* normal i4btel device */
make_dev(&i4btel_cdevsw, i,
UID_ROOT, GID_WHEEL,
0600, "i4btel%d", i);
break;
case FUNCDIAL: /* i4bteld dialout device */
make_dev(&i4btel_cdevsw, i+(1<<UNITBITS),
UID_ROOT, GID_WHEEL,
0600, "i4bteld%d", i);
break;
}
}
tel_init_linktab(i);
}
}
/*---------------------------------------------------------------------------*
* open tel device
*---------------------------------------------------------------------------*/
PDEVSTATIC int
i4btelopen(dev_t dev, int flag, int fmt, struct proc *p)
{
int unit = UNIT(dev);
int func = FUNC(dev);
tel_sc_t *sc;
if(unit > NI4BTEL)
return(ENXIO);
sc = &tel_sc[unit][func];
if(sc->devstate & ST_ISOPEN)
return(EBUSY);
sc->devstate |= ST_ISOPEN;
if(func == FUNCDIAL)
{
sc->result = 0;
}
return(0);
}
/*---------------------------------------------------------------------------*
* close tel device
*---------------------------------------------------------------------------*/
PDEVSTATIC int
i4btelclose(dev_t dev, int flag, int fmt, struct proc *p)
{
int unit = UNIT(dev);
int func = FUNC(dev);
tel_sc_t *sc;
int error = 0;
if(unit > NI4BTEL)
return(ENXIO);
sc = &tel_sc[unit][func];
if((func == FUNCTEL) &&
(sc->isdn_linktab != NULL && sc->isdn_linktab->tx_queue != NULL))
{
while(!(IF_QEMPTY(sc->isdn_linktab->tx_queue)))
{
sc->devstate |= ST_WRWAITEMPTY;
if((error = tsleep((caddr_t) &sc->isdn_linktab->tx_queue,
TTIPRI | PCATCH, "wtcl", 0)) != 0)
{
break;
}
}
sc->devstate &= ~ST_WRWAITEMPTY;
}
sc->devstate &= ~ST_ISOPEN;
return(error);
}
/*---------------------------------------------------------------------------*
* i4btelioctl - device driver ioctl routine
*---------------------------------------------------------------------------*/
PDEVSTATIC int
#if defined(__FreeBSD_version) && __FreeBSD_version >= 300003
i4btelioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p)
#elif defined(__bsdi__)
i4btelioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p)
#else
i4btelioctl(dev_t dev, int cmd, caddr_t data, int flag, struct proc *p)
#endif
{
int unit = UNIT(dev);
int func = FUNC(dev);
int error = 0;
struct mbuf *m;
int s;
tel_sc_t *sc = &tel_sc[unit][func];
if(func == FUNCTEL)
{
switch(cmd)
{
case I4B_TEL_GETAUDIOFMT:
*(int *)data = sc->audiofmt;
break;
case I4B_TEL_SETAUDIOFMT:
switch (*(int *)data)
{
case CVT_NONE:
sc->rcvttab = 0;
sc->wcvttab = 0;
break;
case CVT_ALAW2ULAW:
/* ISDN: a-law */
/* user: u-law */
sc->rcvttab = a2u_tab;
sc->wcvttab = u2a_tab;
break;
case CVT_ULAW2ALAW:
/* ISDN: u-law */
/* user: a-law */
sc->rcvttab = u2a_tab;
sc->wcvttab = a2u_tab;
break;
default:
error = ENODEV;
break;
}
if(error == 0)
sc->audiofmt = *(int *)data;
break;
case I4B_TEL_EMPTYINPUTQUEUE:
s = splimp();
while((sc->devstate & ST_CONNECTED) &&
(sc->devstate & ST_ISOPEN) &&
!IF_QEMPTY(sc->isdn_linktab->rx_queue))
{
IF_DEQUEUE(sc->isdn_linktab->rx_queue, m);
if(m)
i4b_Bfreembuf(m);
}
splx(s);
break;
case I4B_TEL_VR_REQ:
{
msg_vr_req_t *mvr;
mvr = (msg_vr_req_t *)data;
mvr->version = VERSION;
mvr->release = REL;
mvr->step = STEP;
break;
}
default:
error = ENOTTY;
break;
}
}
else if(func == FUNCDIAL)
{
switch(cmd)
{
default:
error = ENOTTY;
break;
}
}
return(error);
}
/*---------------------------------------------------------------------------*
* read from tel device
*---------------------------------------------------------------------------*/
PDEVSTATIC int
i4btelread(dev_t dev, struct uio *uio, int ioflag)
{
int unit = UNIT(dev);
int func = FUNC(dev);
struct mbuf *m;
int s;
int error = 0;
tel_sc_t *sc = &tel_sc[unit][func];
if(!(sc->devstate & ST_ISOPEN))
return(EIO);
if(func == FUNCTEL)
{
while(IF_QEMPTY(sc->isdn_linktab->rx_queue) &&
(sc->devstate & ST_ISOPEN) &&
(sc->devstate & ST_CONNECTED))
{
sc->devstate |= ST_RDWAITDATA;
DBGL4(L4_TELDBG, "i4btelread", ("i4btel%d, queue empty!\n", unit));
if((error = tsleep((caddr_t) &sc->isdn_linktab->rx_queue,
TTIPRI | PCATCH,
"rtel", 0 )) != 0)
{
sc->devstate &= ~ST_RDWAITDATA;
return(error);
}
}
if(!(sc->devstate & ST_ISOPEN))
{
return(EIO);
}
if(!(sc->devstate & ST_CONNECTED))
{
return(EIO);
}
s = splimp();
IF_DEQUEUE(sc->isdn_linktab->rx_queue, m);
if(m && m->m_len > 0)
{
register int i;
for(i = 0; i < m->m_len; i++)
{
/* always reverse bit order from line */
mtod(m,u_char *)[i] = bitreverse[mtod(m,u_char *)[i]];
/* convert if necessary */
if(sc->rcvttab)
mtod(m,u_char *)[i] = sc->rcvttab[mtod(m,u_char *)[i]];
}
error = uiomove(m->m_data, m->m_len, uio);
DBGL4(L4_TELDBG, "i4btelread", ("i4btel%d, mbuf (%d bytes), uiomove %d!\n", unit, m->m_len, error));
}
else
{
DBGL4(L4_TELDBG, "i4btelread", ("i4btel%d, empty mbuf from queue!\n", unit));
error = EIO;
}
if(m)
i4b_Bfreembuf(m);
splx(s);
}
else if(func == FUNCDIAL)
{
while((sc->result == 0) && (sc->devstate & ST_ISOPEN))
{
sc->devstate |= ST_RDWAITDATA;
if((error = tsleep((caddr_t) &sc->result,
TTIPRI | PCATCH,
"rtel1", 0 )) != 0)
{
sc->devstate &= ~ST_RDWAITDATA;
return(error);
}
}
if(!(sc->devstate & ST_ISOPEN))
{
return(EIO);
}
s = splimp();
if(sc->result != 0)
{
error = uiomove(&sc->result, 1, uio);
sc->result = 0;
}
else
{
error = EIO;
}
splx(s);
}
return(error);
}
/*---------------------------------------------------------------------------*
* write to tel device
*---------------------------------------------------------------------------*/
PDEVSTATIC int
i4btelwrite(dev_t dev, struct uio * uio, int ioflag)
{
int unit = UNIT(dev);
int func = FUNC(dev);
struct mbuf *m;
int s;
int error = 0;
tel_sc_t *sc = &tel_sc[unit][func];
if(!(sc->devstate & ST_ISOPEN))
{
return(EIO);
}
if(func == FUNCTEL)
{
if(!(sc->devstate & ST_CONNECTED))
return(EIO);
while((IF_QFULL(sc->isdn_linktab->tx_queue)) &&
(sc->devstate & ST_ISOPEN))
{
sc->devstate |= ST_WRWAITEMPTY;
if((error = tsleep((caddr_t) &sc->isdn_linktab->tx_queue,
TTIPRI | PCATCH, "wtel", 0)) != 0)
{
sc->devstate &= ~ST_WRWAITEMPTY;
return(error);
}
}
if(!(sc->devstate & ST_ISOPEN))
{
return(EIO);
}
if(!(sc->devstate & ST_CONNECTED))
{
return(EIO);
}
s = splimp();
if((m = i4b_Bgetmbuf(BCH_MAX_DATALEN)) != NULL)
{
register int i;
m->m_len = min(BCH_MAX_DATALEN, uio->uio_resid);
error = uiomove(m->m_data, m->m_len, uio);
for(i = 0; i < m->m_len; i++)
{
/* convert if necessary */
if(sc->wcvttab)
mtod(m,u_char *)[i] = sc->wcvttab[mtod(m,u_char *)[i]];
/* always reverse bitorder to line */
mtod(m,u_char *)[i] = bitreverse[mtod(m,u_char *)[i]];
}
if(IF_QFULL(sc->isdn_linktab->tx_queue))
{
m_freem(m);
}
else
{
IF_ENQUEUE(sc->isdn_linktab->tx_queue, m);
}
(*sc->isdn_linktab->bch_tx_start)(sc->isdn_linktab->unit, sc->isdn_linktab->channel);
}
splx(s);
}
else if(func == FUNCDIAL)
{
#define CMDBUFSIZ 80
char cmdbuf[CMDBUFSIZ];
int len = min(CMDBUFSIZ-1, uio->uio_resid);
error = uiomove(cmdbuf, len, uio);
if(cmdbuf[0] == CMD_DIAL)
{
i4b_l4_dialoutnumber(BDRV_TEL, unit, len-1, &cmdbuf[1]);
}
else if(cmdbuf[0] == CMD_HUP)
{
i4b_l4_drvrdisc(BDRV_TEL, unit);
}
}
else
{
error = EIO;
}
return(error);
}
#ifdef OS_USES_POLL
/*---------------------------------------------------------------------------*
* device driver poll
*---------------------------------------------------------------------------*/
PDEVSTATIC int
i4btelpoll(dev_t dev, int events, struct proc *p)
{
int revents = 0; /* Events we found */
int s;
int unit = UNIT(dev);
int func = FUNC(dev);
tel_sc_t *sc = &tel_sc[unit][func];
s = splhigh();
if(!(sc->devstate & ST_ISOPEN))
{
DBGL4(L4_TELDBG, "i4btelpoll", ("i4btel%d, !ST_ISOPEN\n", unit));
splx(s);
return(0);
}
if(func == FUNCTEL)
{
/*
* Writes are OK if we are connected and the
* transmit queue can take them
*/
if((events & (POLLOUT|POLLWRNORM)) &&
(sc->devstate & ST_CONNECTED) &&
(sc->isdn_linktab != NULL) &&
(!IF_QFULL(sc->isdn_linktab->tx_queue)))
{
DBGL4(L4_TELDBG, "i4btelpoll", ("i4btel%d, POLLOUT\n", unit));
revents |= (events & (POLLOUT|POLLWRNORM));
}
/* ... while reads are OK if we have any data */
if((events & (POLLIN|POLLRDNORM)) &&
(sc->devstate & ST_CONNECTED) &&
(sc->isdn_linktab != NULL) &&
(!IF_QEMPTY(sc->isdn_linktab->rx_queue)))
{
DBGL4(L4_TELDBG, "i4btelpoll", ("i4btel%d, POLLIN\n", unit));
revents |= (events & (POLLIN|POLLRDNORM));
}
if(revents == 0)
{
DBGL4(L4_TELDBG, "i4btelpoll", ("i4btel%d, selrecord\n", unit));
selrecord(p, &sc->selp);
}
}
else if(func == FUNCDIAL)
{
if(events & (POLLOUT|POLLWRNORM))
{
DBGL4(L4_TELDBG, "i4btelpoll", ("i4bteld%d, POLLOUT\n", unit));
revents |= (events & (POLLOUT|POLLWRNORM));
}
if(events & (POLLIN|POLLRDNORM))
{
DBGL4(L4_TELDBG, "i4btelpoll", ("i4bteld%d, POLLIN, result = %d\n", unit, sc->result));
if(sc->result != 0)
revents |= (events & (POLLIN|POLLRDNORM));
}
if(revents == 0)
{
DBGL4(L4_TELDBG, "i4btelpoll", ("i4bteld%d, selrecord\n", unit));
selrecord(p, &sc->selp);
}
}
splx(s);
return(revents);
}
#else /* OS_USES_POLL */
/*---------------------------------------------------------------------------*
* device driver select
*---------------------------------------------------------------------------*/
PDEVSTATIC int
i4btelsel(dev_t dev, int rw, struct proc *p)
{
int s;
int unit = UNIT(dev);
int func = FUNC(dev);
tel_sc_t *sc = &tel_sc[unit][func];
s = splhigh();
if (!(sc->devstate & ST_ISOPEN))
{
DBGL4(L4_TELDBG, "i4btelsel", ("i4btel%d, !ST_ISOPEN\n", unit));
splx(s);
return(0);
}
if (func == FUNCTEL)
{
/* Don't even bother if we're not connected */
if (!(sc->devstate & ST_CONNECTED) || sc->isdn_linktab == NULL)
{
splx(s);
return 0;
}
if (rw == FREAD)
{
if (!IF_QEMPTY(sc->isdn_linktab->rx_queue))
{
DBGL4(L4_TELDBG, "i4btelsel", ("i4btel%d, FREAD\n", unit));
splx(s);
return 1;
}
}
else if (rw == FWRITE)
{
if (!IF_QFULL(sc->isdn_linktab->tx_queue))
{
DBGL4(L4_TELDBG, "i4btelsel", ("i4btel%d, FWRITE\n", unit));
splx(s);
return 1;
}
}
}
else if (func == FUNCDIAL)
{
if (rw == FWRITE)
{
DBGL4(L4_TELDBG, "i4btelsel", ("i4bteld%d, FWRITE\n", unit));
splx(s);
return 1;
}
if (rw == FREAD)
{
DBGL4(L4_TELDBG, "i4btelsel", ("i4bteld%d, FREAD, result = %d\n", unit, sc->result));
if (sc->result != 0)
{
splx(s);
return 1;
}
}
}
DBGL4(L4_TELDBG, "i4btelsel", ("i4bteld%d, selrecord\n", unit));
selrecord(p, &sc->selp);
splx(s);
return 0;
}
#endif /* OS_USES_POLL */
/*===========================================================================*
* ISDN INTERFACE ROUTINES
*===========================================================================*/
/*---------------------------------------------------------------------------*
* this routine is called from L4 handler at connect time
*---------------------------------------------------------------------------*/
static void
tel_connect(int unit, void *cdp)
{
tel_sc_t *sc = &tel_sc[unit][FUNCTEL];
/* audio device */
sc->cdp = (call_desc_t *)cdp;
sc->devstate |= ST_CONNECTED;
/* dialer device */
sc = &tel_sc[unit][FUNCDIAL];
if(sc->devstate == ST_ISOPEN)
{
sc->result = RSP_CONN;
if(sc->devstate & ST_RDWAITDATA)
{
sc->devstate &= ~ST_RDWAITDATA;
wakeup((caddr_t) &sc->result);
}
selwakeup(&sc->selp);
}
}
/*---------------------------------------------------------------------------*
* this routine is called from L4 handler at disconnect time
*---------------------------------------------------------------------------*/
static void
tel_disconnect(int unit, void *cdp)
{
/* call_desc_t *cd = (call_desc_t *)cdp; */
tel_sc_t *sc = &tel_sc[unit][FUNCTEL];
/* audio device */
sc->devstate &= ~ST_CONNECTED;
if(sc->devstate & ST_RDWAITDATA)
{
sc->devstate &= ~ST_RDWAITDATA;
wakeup((caddr_t) &sc->isdn_linktab->rx_queue);
}
if(sc->devstate & ST_WRWAITEMPTY)
{
sc->devstate &= ~ST_WRWAITEMPTY;
wakeup((caddr_t) &sc->isdn_linktab->tx_queue);
}
/* dialer device */
sc = &tel_sc[unit][FUNCDIAL];
if(sc->devstate == ST_ISOPEN)
{
sc->result = RSP_HUP;
if(sc->devstate & ST_RDWAITDATA)
{
sc->devstate &= ~ST_RDWAITDATA;
wakeup((caddr_t) &sc->result);
}
selwakeup(&sc->selp);
}
}
/*---------------------------------------------------------------------------*
* feedback from daemon in case of dial problems
*---------------------------------------------------------------------------*/
static void
tel_dialresponse(int unit, int status, cause_t cause)
{
tel_sc_t *sc = &tel_sc[unit][FUNCDIAL];
DBGL4(L4_TELDBG, "tel_dialresponse", ("i4btel%d, status=%d, cause=0x%4x\n", unit, status, cause));
if((sc->devstate == ST_ISOPEN) && status)
{
sc->result = RSP_NOA;
if(sc->devstate & ST_RDWAITDATA)
{
sc->devstate &= ~ST_RDWAITDATA;
wakeup((caddr_t) &sc->result);
}
selwakeup(&sc->selp);
}
}
/*---------------------------------------------------------------------------*
* interface up/down
*---------------------------------------------------------------------------*/
static void
tel_updown(int unit, int updown)
{
}
/*---------------------------------------------------------------------------*
* this routine is called from the HSCX interrupt handler
* when a new frame (mbuf) has been received and was put on
* the rx queue.
*---------------------------------------------------------------------------*/
static void
tel_rx_data_rdy(int unit)
{
tel_sc_t *sc = &tel_sc[unit][FUNCTEL];
if(sc->devstate & ST_RDWAITDATA)
{
sc->devstate &= ~ST_RDWAITDATA;
wakeup((caddr_t) &sc->isdn_linktab->rx_queue);
}
selwakeup(&sc->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
tel_tx_queue_empty(int unit)
{
tel_sc_t *sc = &tel_sc[unit][FUNCTEL];
if(sc->devstate & ST_WRWAITEMPTY)
{
sc->devstate &= ~ST_WRWAITEMPTY;
wakeup((caddr_t) &sc->isdn_linktab->tx_queue);
}
selwakeup(&sc->selp);
}
/*---------------------------------------------------------------------------*
* this routine is called from the HSCX interrupt handler
* each time a packet is received or transmitted.
*---------------------------------------------------------------------------*/
static void
tel_activity(int unit, int rxtx)
{
if(tel_sc[unit][FUNCTEL].cdp)
tel_sc[unit][FUNCTEL].cdp->last_active_time = SECOND;
}
/*---------------------------------------------------------------------------*
* return this drivers linktab address
*---------------------------------------------------------------------------*/
drvr_link_t *
tel_ret_linktab(int unit)
{
tel_sc_t *sc = &tel_sc[unit][FUNCTEL];
tel_init_linktab(unit);
return(&sc->drvr_linktab);
}
/*---------------------------------------------------------------------------*
* setup the isdn_linktab for this driver
*---------------------------------------------------------------------------*/
void
tel_set_linktab(int unit, isdn_link_t *ilt)
{
tel_sc_t *sc = &tel_sc[unit][FUNCTEL];
sc->isdn_linktab = ilt;
}
/*---------------------------------------------------------------------------*
* initialize this drivers linktab
*---------------------------------------------------------------------------*/
static void
tel_init_linktab(int unit)
{
tel_sc_t *sc = &tel_sc[unit][FUNCTEL];
sc->drvr_linktab.unit = unit;
sc->drvr_linktab.bch_rx_data_ready = tel_rx_data_rdy;
sc->drvr_linktab.bch_tx_queue_empty = tel_tx_queue_empty;
sc->drvr_linktab.bch_activity = tel_activity;
sc->drvr_linktab.line_connected = tel_connect;
sc->drvr_linktab.line_disconnected = tel_disconnect;
sc->drvr_linktab.dial_response = tel_dialresponse;
sc->drvr_linktab.updown_ind = tel_updown;
}
/*===========================================================================*
* AUDIO FORMAT CONVERSION (produced by running g711conv)
*===========================================================================*/
/*---------------------------------------------------------------------------*
* A-law to u-law conversion
*---------------------------------------------------------------------------*/
static unsigned char a2u_tab[256] = {
/* 00 */ 0x2a, 0x2b, 0x28, 0x29, 0x2e, 0x2f, 0x2c, 0x2d,
/* 08 */ 0x22, 0x23, 0x20, 0x21, 0x26, 0x27, 0x24, 0x25,
/* 10 */ 0x39, 0x3a, 0x37, 0x38, 0x3d, 0x3e, 0x3b, 0x3c,
/* 18 */ 0x31, 0x32, 0x30, 0x30, 0x35, 0x36, 0x33, 0x34,
/* 20 */ 0x0a, 0x0b, 0x08, 0x09, 0x0e, 0x0f, 0x0c, 0x0d,
/* 28 */ 0x02, 0x03, 0x00, 0x01, 0x06, 0x07, 0x04, 0x05,
/* 30 */ 0x1a, 0x1b, 0x18, 0x19, 0x1e, 0x1f, 0x1c, 0x1d,
/* 38 */ 0x12, 0x13, 0x10, 0x11, 0x16, 0x17, 0x14, 0x15,
/* 40 */ 0x62, 0x63, 0x60, 0x61, 0x66, 0x67, 0x64, 0x65,
/* 48 */ 0x5d, 0x5d, 0x5c, 0x5c, 0x5f, 0x5f, 0x5e, 0x5e,
/* 50 */ 0x74, 0x76, 0x70, 0x72, 0x7c, 0x7e, 0x78, 0x7a,
/* 58 */ 0x6a, 0x6b, 0x68, 0x69, 0x6e, 0x6f, 0x6c, 0x6d,
/* 60 */ 0x48, 0x49, 0x46, 0x47, 0x4c, 0x4d, 0x4a, 0x4b,
/* 68 */ 0x40, 0x41, 0x3f, 0x3f, 0x44, 0x45, 0x42, 0x43,
/* 70 */ 0x56, 0x57, 0x54, 0x55, 0x5a, 0x5b, 0x58, 0x59,
/* 78 */ 0x4f, 0x4f, 0x4e, 0x4e, 0x52, 0x53, 0x50, 0x51,
/* 80 */ 0xaa, 0xab, 0xa8, 0xa9, 0xae, 0xaf, 0xac, 0xad,
/* 88 */ 0xa2, 0xa3, 0xa0, 0xa1, 0xa6, 0xa7, 0xa4, 0xa5,
/* 90 */ 0xb9, 0xba, 0xb7, 0xb8, 0xbd, 0xbe, 0xbb, 0xbc,
/* 98 */ 0xb1, 0xb2, 0xb0, 0xb0, 0xb5, 0xb6, 0xb3, 0xb4,
/* a0 */ 0x8a, 0x8b, 0x88, 0x89, 0x8e, 0x8f, 0x8c, 0x8d,
/* a8 */ 0x82, 0x83, 0x80, 0x81, 0x86, 0x87, 0x84, 0x85,
/* b0 */ 0x9a, 0x9b, 0x98, 0x99, 0x9e, 0x9f, 0x9c, 0x9d,
/* b8 */ 0x92, 0x93, 0x90, 0x91, 0x96, 0x97, 0x94, 0x95,
/* c0 */ 0xe2, 0xe3, 0xe0, 0xe1, 0xe6, 0xe7, 0xe4, 0xe5,
/* c8 */ 0xdd, 0xdd, 0xdc, 0xdc, 0xdf, 0xdf, 0xde, 0xde,
/* d0 */ 0xf4, 0xf6, 0xf0, 0xf2, 0xfc, 0xfe, 0xf8, 0xfa,
/* d8 */ 0xea, 0xeb, 0xe8, 0xe9, 0xee, 0xef, 0xec, 0xed,
/* e0 */ 0xc8, 0xc9, 0xc6, 0xc7, 0xcc, 0xcd, 0xca, 0xcb,
/* e8 */ 0xc0, 0xc1, 0xbf, 0xbf, 0xc4, 0xc5, 0xc2, 0xc3,
/* f0 */ 0xd6, 0xd7, 0xd4, 0xd5, 0xda, 0xdb, 0xd8, 0xd9,
/* f8 */ 0xcf, 0xcf, 0xce, 0xce, 0xd2, 0xd3, 0xd0, 0xd1
};
/*---------------------------------------------------------------------------*
* u-law to A-law conversion
*---------------------------------------------------------------------------*/
static unsigned char u2a_tab[256] = {
/* 00 */ 0x2a, 0x2b, 0x28, 0x29, 0x2e, 0x2f, 0x2c, 0x2d,
/* 08 */ 0x22, 0x23, 0x20, 0x21, 0x26, 0x27, 0x24, 0x25,
/* 10 */ 0x3a, 0x3b, 0x38, 0x39, 0x3e, 0x3f, 0x3c, 0x3d,
/* 18 */ 0x32, 0x33, 0x30, 0x31, 0x36, 0x37, 0x34, 0x35,
/* 20 */ 0x0a, 0x0b, 0x08, 0x09, 0x0e, 0x0f, 0x0c, 0x0d,
/* 28 */ 0x02, 0x03, 0x00, 0x01, 0x06, 0x07, 0x04, 0x05,
/* 30 */ 0x1b, 0x18, 0x19, 0x1e, 0x1f, 0x1c, 0x1d, 0x12,
/* 38 */ 0x13, 0x10, 0x11, 0x16, 0x17, 0x14, 0x15, 0x6a,
/* 40 */ 0x68, 0x69, 0x6e, 0x6f, 0x6c, 0x6d, 0x62, 0x63,
/* 48 */ 0x60, 0x61, 0x66, 0x67, 0x64, 0x65, 0x7a, 0x78,
/* 50 */ 0x7e, 0x7f, 0x7c, 0x7d, 0x72, 0x73, 0x70, 0x71,
/* 58 */ 0x76, 0x77, 0x74, 0x75, 0x4b, 0x49, 0x4f, 0x4d,
/* 60 */ 0x42, 0x43, 0x40, 0x41, 0x46, 0x47, 0x44, 0x45,
/* 68 */ 0x5a, 0x5b, 0x58, 0x59, 0x5e, 0x5f, 0x5c, 0x5d,
/* 70 */ 0x52, 0x52, 0x53, 0x53, 0x50, 0x50, 0x51, 0x51,
/* 78 */ 0x56, 0x56, 0x57, 0x57, 0x54, 0x54, 0x55, 0x55,
/* 80 */ 0xaa, 0xab, 0xa8, 0xa9, 0xae, 0xaf, 0xac, 0xad,
/* 88 */ 0xa2, 0xa3, 0xa0, 0xa1, 0xa6, 0xa7, 0xa4, 0xa5,
/* 90 */ 0xba, 0xbb, 0xb8, 0xb9, 0xbe, 0xbf, 0xbc, 0xbd,
/* 98 */ 0xb2, 0xb3, 0xb0, 0xb1, 0xb6, 0xb7, 0xb4, 0xb5,
/* a0 */ 0x8a, 0x8b, 0x88, 0x89, 0x8e, 0x8f, 0x8c, 0x8d,
/* a8 */ 0x82, 0x83, 0x80, 0x81, 0x86, 0x87, 0x84, 0x85,
/* b0 */ 0x9b, 0x98, 0x99, 0x9e, 0x9f, 0x9c, 0x9d, 0x92,
/* b8 */ 0x93, 0x90, 0x91, 0x96, 0x97, 0x94, 0x95, 0xea,
/* c0 */ 0xe8, 0xe9, 0xee, 0xef, 0xec, 0xed, 0xe2, 0xe3,
/* c8 */ 0xe0, 0xe1, 0xe6, 0xe7, 0xe4, 0xe5, 0xfa, 0xf8,
/* d0 */ 0xfe, 0xff, 0xfc, 0xfd, 0xf2, 0xf3, 0xf0, 0xf1,
/* d8 */ 0xf6, 0xf7, 0xf4, 0xf5, 0xcb, 0xc9, 0xcf, 0xcd,
/* e0 */ 0xc2, 0xc3, 0xc0, 0xc1, 0xc6, 0xc7, 0xc4, 0xc5,
/* e8 */ 0xda, 0xdb, 0xd8, 0xd9, 0xde, 0xdf, 0xdc, 0xdd,
/* f0 */ 0xd2, 0xd2, 0xd3, 0xd3, 0xd0, 0xd0, 0xd1, 0xd1,
/* f8 */ 0xd6, 0xd6, 0xd7, 0xd7, 0xd4, 0xd4, 0xd5, 0xd5
};
/*---------------------------------------------------------------------------*
* reverse bits in a byte
*---------------------------------------------------------------------------*/
static unsigned char bitreverse[256] = {
/* 00 */ 0x00, 0x80, 0x40, 0xc0, 0x20, 0xa0, 0x60, 0xe0,
/* 08 */ 0x10, 0x90, 0x50, 0xd0, 0x30, 0xb0, 0x70, 0xf0,
/* 10 */ 0x08, 0x88, 0x48, 0xc8, 0x28, 0xa8, 0x68, 0xe8,
/* 18 */ 0x18, 0x98, 0x58, 0xd8, 0x38, 0xb8, 0x78, 0xf8,
/* 20 */ 0x04, 0x84, 0x44, 0xc4, 0x24, 0xa4, 0x64, 0xe4,
/* 28 */ 0x14, 0x94, 0x54, 0xd4, 0x34, 0xb4, 0x74, 0xf4,
/* 30 */ 0x0c, 0x8c, 0x4c, 0xcc, 0x2c, 0xac, 0x6c, 0xec,
/* 38 */ 0x1c, 0x9c, 0x5c, 0xdc, 0x3c, 0xbc, 0x7c, 0xfc,
/* 40 */ 0x02, 0x82, 0x42, 0xc2, 0x22, 0xa2, 0x62, 0xe2,
/* 48 */ 0x12, 0x92, 0x52, 0xd2, 0x32, 0xb2, 0x72, 0xf2,
/* 50 */ 0x0a, 0x8a, 0x4a, 0xca, 0x2a, 0xaa, 0x6a, 0xea,
/* 58 */ 0x1a, 0x9a, 0x5a, 0xda, 0x3a, 0xba, 0x7a, 0xfa,
/* 60 */ 0x06, 0x86, 0x46, 0xc6, 0x26, 0xa6, 0x66, 0xe6,
/* 68 */ 0x16, 0x96, 0x56, 0xd6, 0x36, 0xb6, 0x76, 0xf6,
/* 70 */ 0x0e, 0x8e, 0x4e, 0xce, 0x2e, 0xae, 0x6e, 0xee,
/* 78 */ 0x1e, 0x9e, 0x5e, 0xde, 0x3e, 0xbe, 0x7e, 0xfe,
/* 80 */ 0x01, 0x81, 0x41, 0xc1, 0x21, 0xa1, 0x61, 0xe1,
/* 88 */ 0x11, 0x91, 0x51, 0xd1, 0x31, 0xb1, 0x71, 0xf1,
/* 90 */ 0x09, 0x89, 0x49, 0xc9, 0x29, 0xa9, 0x69, 0xe9,
/* 98 */ 0x19, 0x99, 0x59, 0xd9, 0x39, 0xb9, 0x79, 0xf9,
/* a0 */ 0x05, 0x85, 0x45, 0xc5, 0x25, 0xa5, 0x65, 0xe5,
/* a8 */ 0x15, 0x95, 0x55, 0xd5, 0x35, 0xb5, 0x75, 0xf5,
/* b0 */ 0x0d, 0x8d, 0x4d, 0xcd, 0x2d, 0xad, 0x6d, 0xed,
/* b8 */ 0x1d, 0x9d, 0x5d, 0xdd, 0x3d, 0xbd, 0x7d, 0xfd,
/* c0 */ 0x03, 0x83, 0x43, 0xc3, 0x23, 0xa3, 0x63, 0xe3,
/* c8 */ 0x13, 0x93, 0x53, 0xd3, 0x33, 0xb3, 0x73, 0xf3,
/* d0 */ 0x0b, 0x8b, 0x4b, 0xcb, 0x2b, 0xab, 0x6b, 0xeb,
/* d8 */ 0x1b, 0x9b, 0x5b, 0xdb, 0x3b, 0xbb, 0x7b, 0xfb,
/* e0 */ 0x07, 0x87, 0x47, 0xc7, 0x27, 0xa7, 0x67, 0xe7,
/* e8 */ 0x17, 0x97, 0x57, 0xd7, 0x37, 0xb7, 0x77, 0xf7,
/* f0 */ 0x0f, 0x8f, 0x4f, 0xcf, 0x2f, 0xaf, 0x6f, 0xef,
/* f8 */ 0x1f, 0x9f, 0x5f, 0xdf, 0x3f, 0xbf, 0x7f, 0xff
};
/*===========================================================================*/
#endif /* NI4BTEL > 0 */