linux_dsm_epyc7002/drivers/isdn/hisax/callc.c

1793 lines
47 KiB
C
Raw Normal View History

/* $Id: callc.c,v 2.59.2.4 2004/02/11 13:21:32 keil Exp $
*
* Author Karsten Keil
* Copyright by Karsten Keil <keil@isdn4linux.de>
*
* This software may be used and distributed according to the terms
* of the GNU General Public License, incorporated herein by reference.
*
* For changes and modifications please read
* Documentation/isdn/HiSax.cert
*
* based on the teles driver from Jan den Ouden
*
* Thanks to Jan den Ouden
* Fritz Elfert
*
*/
#include <linux/module.h>
include cleanup: Update gfp.h and slab.h includes to prepare for breaking implicit slab.h inclusion from percpu.h percpu.h is included by sched.h and module.h and thus ends up being included when building most .c files. percpu.h includes slab.h which in turn includes gfp.h making everything defined by the two files universally available and complicating inclusion dependencies. percpu.h -> slab.h dependency is about to be removed. Prepare for this change by updating users of gfp and slab facilities include those headers directly instead of assuming availability. As this conversion needs to touch large number of source files, the following script is used as the basis of conversion. http://userweb.kernel.org/~tj/misc/slabh-sweep.py The script does the followings. * Scan files for gfp and slab usages and update includes such that only the necessary includes are there. ie. if only gfp is used, gfp.h, if slab is used, slab.h. * When the script inserts a new include, it looks at the include blocks and try to put the new include such that its order conforms to its surrounding. It's put in the include block which contains core kernel includes, in the same order that the rest are ordered - alphabetical, Christmas tree, rev-Xmas-tree or at the end if there doesn't seem to be any matching order. * If the script can't find a place to put a new include (mostly because the file doesn't have fitting include block), it prints out an error message indicating which .h file needs to be added to the file. The conversion was done in the following steps. 1. The initial automatic conversion of all .c files updated slightly over 4000 files, deleting around 700 includes and adding ~480 gfp.h and ~3000 slab.h inclusions. The script emitted errors for ~400 files. 2. Each error was manually checked. Some didn't need the inclusion, some needed manual addition while adding it to implementation .h or embedding .c file was more appropriate for others. This step added inclusions to around 150 files. 3. The script was run again and the output was compared to the edits from #2 to make sure no file was left behind. 4. Several build tests were done and a couple of problems were fixed. e.g. lib/decompress_*.c used malloc/free() wrappers around slab APIs requiring slab.h to be added manually. 5. The script was run on all .h files but without automatically editing them as sprinkling gfp.h and slab.h inclusions around .h files could easily lead to inclusion dependency hell. Most gfp.h inclusion directives were ignored as stuff from gfp.h was usually wildly available and often used in preprocessor macros. Each slab.h inclusion directive was examined and added manually as necessary. 6. percpu.h was updated not to include slab.h. 7. Build test were done on the following configurations and failures were fixed. CONFIG_GCOV_KERNEL was turned off for all tests (as my distributed build env didn't work with gcov compiles) and a few more options had to be turned off depending on archs to make things build (like ipr on powerpc/64 which failed due to missing writeq). * x86 and x86_64 UP and SMP allmodconfig and a custom test config. * powerpc and powerpc64 SMP allmodconfig * sparc and sparc64 SMP allmodconfig * ia64 SMP allmodconfig * s390 SMP allmodconfig * alpha SMP allmodconfig * um on x86_64 SMP allmodconfig 8. percpu.h modifications were reverted so that it could be applied as a separate patch and serve as bisection point. Given the fact that I had only a couple of failures from tests on step 6, I'm fairly confident about the coverage of this conversion patch. If there is a breakage, it's likely to be something in one of the arch headers which should be easily discoverable easily on most builds of the specific arch. Signed-off-by: Tejun Heo <tj@kernel.org> Guess-its-ok-by: Christoph Lameter <cl@linux-foundation.org> Cc: Ingo Molnar <mingo@redhat.com> Cc: Lee Schermerhorn <Lee.Schermerhorn@hp.com>
2010-03-24 15:04:11 +07:00
#include <linux/slab.h>
#include <linux/init.h>
#include "hisax.h"
#include <linux/isdn/capicmd.h>
const char *lli_revision = "$Revision: 2.59.2.4 $";
extern struct IsdnCard cards[];
static int init_b_st(struct Channel *chanp, int incoming);
static void release_b_st(struct Channel *chanp);
static struct Fsm callcfsm;
static int chancount;
/* experimental REJECT after ALERTING for CALLBACK to beat the 4s delay */
#define ALERT_REJECT 0
/* Value to delay the sending of the first B-channel packet after CONNECT
* here is no value given by ITU, but experience shows that 300 ms will
* work on many networks, if you or your other side is behind local exchanges
* a greater value may be recommented. If the delay is to short the first paket
* will be lost and autodetect on many comercial routers goes wrong !
* You can adjust this value on runtime with
* hisaxctrl <id> 2 <value>
* value is in milliseconds
*/
#define DEFAULT_B_DELAY 300
/* Flags for remembering action done in lli */
#define FLG_START_B 0
/*
* Find card with given driverId
*/
static inline struct IsdnCardState *
hisax_findcard(int driverid)
{
int i;
for (i = 0; i < nrcards; i++)
if (cards[i].cs)
if (cards[i].cs->myid == driverid)
return (cards[i].cs);
return (struct IsdnCardState *) 0;
}
static __printf(3, 4) void
link_debug(struct Channel *chanp, int direction, char *fmt, ...)
{
va_list args;
char tmp[16];
va_start(args, fmt);
sprintf(tmp, "Ch%d %s ", chanp->chan,
direction ? "LL->HL" : "HL->LL");
VHiSax_putstatus(chanp->cs, tmp, fmt, args);
va_end(args);
}
enum {
ST_NULL, /* 0 inactive */
ST_OUT_DIAL, /* 1 outgoing, SETUP send; awaiting confirm */
ST_IN_WAIT_LL, /* 2 incoming call received; wait for LL confirm */
ST_IN_ALERT_SENT, /* 3 incoming call received; ALERT send */
ST_IN_WAIT_CONN_ACK, /* 4 incoming CONNECT send; awaiting CONN_ACK */
ST_WAIT_BCONN, /* 5 CONNECT/CONN_ACK received, awaiting b-channel prot. estbl. */
ST_ACTIVE, /* 6 active, b channel prot. established */
ST_WAIT_BRELEASE, /* 7 call clear. (initiator), awaiting b channel prot. rel. */
ST_WAIT_BREL_DISC, /* 8 call clear. (receiver), DISCONNECT req. received */
ST_WAIT_DCOMMAND, /* 9 call clear. (receiver), awaiting DCHANNEL message */
ST_WAIT_DRELEASE, /* 10 DISCONNECT sent, awaiting RELEASE */
ST_WAIT_D_REL_CNF, /* 11 RELEASE sent, awaiting RELEASE confirm */
ST_IN_PROCEED_SEND, /* 12 incoming call, proceeding send */
};
#define STATE_COUNT (ST_IN_PROCEED_SEND + 1)
static char *strState[] =
{
"ST_NULL",
"ST_OUT_DIAL",
"ST_IN_WAIT_LL",
"ST_IN_ALERT_SENT",
"ST_IN_WAIT_CONN_ACK",
"ST_WAIT_BCONN",
"ST_ACTIVE",
"ST_WAIT_BRELEASE",
"ST_WAIT_BREL_DISC",
"ST_WAIT_DCOMMAND",
"ST_WAIT_DRELEASE",
"ST_WAIT_D_REL_CNF",
"ST_IN_PROCEED_SEND",
};
enum {
EV_DIAL, /* 0 */
EV_SETUP_CNF, /* 1 */
EV_ACCEPTB, /* 2 */
EV_DISCONNECT_IND, /* 3 */
EV_RELEASE, /* 4 */
EV_LEASED, /* 5 */
EV_LEASED_REL, /* 6 */
EV_SETUP_IND, /* 7 */
EV_ACCEPTD, /* 8 */
EV_SETUP_CMPL_IND, /* 9 */
EV_BC_EST, /* 10 */
EV_WRITEBUF, /* 11 */
EV_HANGUP, /* 12 */
EV_BC_REL, /* 13 */
EV_CINF, /* 14 */
EV_SUSPEND, /* 15 */
EV_RESUME, /* 16 */
EV_NOSETUP_RSP, /* 17 */
EV_SETUP_ERR, /* 18 */
EV_CONNECT_ERR, /* 19 */
EV_PROCEED, /* 20 */
EV_ALERT, /* 21 */
EV_REDIR, /* 22 */
};
#define EVENT_COUNT (EV_REDIR + 1)
static char *strEvent[] =
{
"EV_DIAL",
"EV_SETUP_CNF",
"EV_ACCEPTB",
"EV_DISCONNECT_IND",
"EV_RELEASE",
"EV_LEASED",
"EV_LEASED_REL",
"EV_SETUP_IND",
"EV_ACCEPTD",
"EV_SETUP_CMPL_IND",
"EV_BC_EST",
"EV_WRITEBUF",
"EV_HANGUP",
"EV_BC_REL",
"EV_CINF",
"EV_SUSPEND",
"EV_RESUME",
"EV_NOSETUP_RSP",
"EV_SETUP_ERR",
"EV_CONNECT_ERR",
"EV_PROCEED",
"EV_ALERT",
"EV_REDIR",
};
static inline void
HL_LL(struct Channel *chanp, int command)
{
isdn_ctrl ic;
ic.driver = chanp->cs->myid;
ic.command = command;
ic.arg = chanp->chan;
chanp->cs->iif.statcallb(&ic);
}
static inline void
lli_deliver_cause(struct Channel *chanp)
{
isdn_ctrl ic;
if (!chanp->proc)
return;
if (chanp->proc->para.cause == NO_CAUSE)
return;
ic.driver = chanp->cs->myid;
ic.command = ISDN_STAT_CAUSE;
ic.arg = chanp->chan;
if (chanp->cs->protocol == ISDN_PTYPE_EURO)
sprintf(ic.parm.num, "E%02X%02X", chanp->proc->para.loc & 0x7f,
chanp->proc->para.cause & 0x7f);
else
sprintf(ic.parm.num, "%02X%02X", chanp->proc->para.loc & 0x7f,
chanp->proc->para.cause & 0x7f);
chanp->cs->iif.statcallb(&ic);
}
static inline void
lli_close(struct FsmInst *fi)
{
struct Channel *chanp = fi->userdata;
FsmChangeState(fi, ST_NULL);
chanp->Flags = 0;
chanp->cs->cardmsg(chanp->cs, MDL_INFO_REL, (void *) (long)chanp->chan);
}
static void
lli_leased_in(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
isdn_ctrl ic;
int ret;
if (!chanp->leased)
return;
chanp->cs->cardmsg(chanp->cs, MDL_INFO_SETUP, (void *) (long)chanp->chan);
FsmChangeState(fi, ST_IN_WAIT_LL);
if (chanp->debug & 1)
link_debug(chanp, 0, "STAT_ICALL_LEASED");
ic.driver = chanp->cs->myid;
ic.command = ((chanp->chan < 2) ? ISDN_STAT_ICALL : ISDN_STAT_ICALLW);
ic.arg = chanp->chan;
ic.parm.setup.si1 = 7;
ic.parm.setup.si2 = 0;
ic.parm.setup.plan = 0;
ic.parm.setup.screen = 0;
sprintf(ic.parm.setup.eazmsn, "%d", chanp->chan + 1);
sprintf(ic.parm.setup.phone, "LEASED%d", chanp->cs->myid);
ret = chanp->cs->iif.statcallb(&ic);
if (chanp->debug & 1)
link_debug(chanp, 1, "statcallb ret=%d", ret);
if (!ret) {
chanp->cs->cardmsg(chanp->cs, MDL_INFO_REL, (void *) (long)chanp->chan);
FsmChangeState(fi, ST_NULL);
}
}
/*
* Dial out
*/
static void
lli_init_bchan_out(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
FsmChangeState(fi, ST_WAIT_BCONN);
if (chanp->debug & 1)
link_debug(chanp, 0, "STAT_DCONN");
HL_LL(chanp, ISDN_STAT_DCONN);
init_b_st(chanp, 0);
chanp->b_st->lli.l4l3(chanp->b_st, DL_ESTABLISH | REQUEST, NULL);
}
static void
lli_prep_dialout(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
FsmDelTimer(&chanp->drel_timer, 60);
FsmDelTimer(&chanp->dial_timer, 73);
chanp->l2_active_protocol = chanp->l2_protocol;
chanp->incoming = 0;
chanp->cs->cardmsg(chanp->cs, MDL_INFO_SETUP, (void *) (long)chanp->chan);
if (chanp->leased) {
lli_init_bchan_out(fi, event, arg);
} else {
FsmChangeState(fi, ST_OUT_DIAL);
chanp->d_st->lli.l4l3(chanp->d_st, CC_SETUP | REQUEST, chanp);
}
}
static void
lli_resume(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
FsmDelTimer(&chanp->drel_timer, 60);
FsmDelTimer(&chanp->dial_timer, 73);
chanp->l2_active_protocol = chanp->l2_protocol;
chanp->incoming = 0;
chanp->cs->cardmsg(chanp->cs, MDL_INFO_SETUP, (void *) (long)chanp->chan);
if (chanp->leased) {
lli_init_bchan_out(fi, event, arg);
} else {
FsmChangeState(fi, ST_OUT_DIAL);
chanp->d_st->lli.l4l3(chanp->d_st, CC_RESUME | REQUEST, chanp);
}
}
static void
lli_go_active(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
isdn_ctrl ic;
FsmChangeState(fi, ST_ACTIVE);
chanp->data_open = !0;
if (chanp->bcs->conmsg)
strcpy(ic.parm.num, chanp->bcs->conmsg);
else
ic.parm.num[0] = 0;
if (chanp->debug & 1)
link_debug(chanp, 0, "STAT_BCONN %s", ic.parm.num);
ic.driver = chanp->cs->myid;
ic.command = ISDN_STAT_BCONN;
ic.arg = chanp->chan;
chanp->cs->iif.statcallb(&ic);
chanp->cs->cardmsg(chanp->cs, MDL_INFO_CONN, (void *) (long)chanp->chan);
}
/*
* RESUME
*/
/* incoming call */
static void
lli_deliver_call(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
isdn_ctrl ic;
int ret;
chanp->cs->cardmsg(chanp->cs, MDL_INFO_SETUP, (void *) (long)chanp->chan);
/*
* Report incoming calls only once to linklevel, use CallFlags
* which is set to 3 with each broadcast message in isdnl1.c
* and resetted if a interface answered the STAT_ICALL.
*/
if (1) { /* for only one TEI */
FsmChangeState(fi, ST_IN_WAIT_LL);
if (chanp->debug & 1)
link_debug(chanp, 0, (chanp->chan < 2) ? "STAT_ICALL" : "STAT_ICALLW");
ic.driver = chanp->cs->myid;
ic.command = ((chanp->chan < 2) ? ISDN_STAT_ICALL : ISDN_STAT_ICALLW);
ic.arg = chanp->chan;
/*
* No need to return "unknown" for calls without OAD,
* cause that's handled in linklevel now (replaced by '0')
*/
memcpy(&ic.parm.setup, &chanp->proc->para.setup, sizeof(setup_parm));
ret = chanp->cs->iif.statcallb(&ic);
if (chanp->debug & 1)
link_debug(chanp, 1, "statcallb ret=%d", ret);
switch (ret) {
case 1: /* OK, someone likes this call */
FsmDelTimer(&chanp->drel_timer, 61);
FsmChangeState(fi, ST_IN_ALERT_SENT);
chanp->d_st->lli.l4l3(chanp->d_st, CC_ALERTING | REQUEST, chanp->proc);
break;
case 5: /* direct redirect */
case 4: /* Proceeding desired */
FsmDelTimer(&chanp->drel_timer, 61);
FsmChangeState(fi, ST_IN_PROCEED_SEND);
chanp->d_st->lli.l4l3(chanp->d_st, CC_PROCEED_SEND | REQUEST, chanp->proc);
if (ret == 5) {
memcpy(&chanp->setup, &ic.parm.setup, sizeof(setup_parm));
chanp->d_st->lli.l4l3(chanp->d_st, CC_REDIR | REQUEST, chanp->proc);
}
break;
case 2: /* Rejecting Call */
break;
case 3: /* incomplete number */
FsmDelTimer(&chanp->drel_timer, 61);
chanp->d_st->lli.l4l3(chanp->d_st, CC_MORE_INFO | REQUEST, chanp->proc);
break;
case 0: /* OK, nobody likes this call */
default: /* statcallb problems */
chanp->d_st->lli.l4l3(chanp->d_st, CC_IGNORE | REQUEST, chanp->proc);
chanp->cs->cardmsg(chanp->cs, MDL_INFO_REL, (void *) (long)chanp->chan);
FsmChangeState(fi, ST_NULL);
break;
}
} else {
chanp->d_st->lli.l4l3(chanp->d_st, CC_IGNORE | REQUEST, chanp->proc);
chanp->cs->cardmsg(chanp->cs, MDL_INFO_REL, (void *) (long)chanp->chan);
}
}
static void
lli_send_dconnect(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
FsmChangeState(fi, ST_IN_WAIT_CONN_ACK);
chanp->d_st->lli.l4l3(chanp->d_st, CC_SETUP | RESPONSE, chanp->proc);
}
static void
lli_send_alert(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
FsmChangeState(fi, ST_IN_ALERT_SENT);
chanp->d_st->lli.l4l3(chanp->d_st, CC_ALERTING | REQUEST, chanp->proc);
}
static void
lli_send_redir(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
chanp->d_st->lli.l4l3(chanp->d_st, CC_REDIR | REQUEST, chanp->proc);
}
static void
lli_init_bchan_in(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
FsmChangeState(fi, ST_WAIT_BCONN);
if (chanp->debug & 1)
link_debug(chanp, 0, "STAT_DCONN");
HL_LL(chanp, ISDN_STAT_DCONN);
chanp->l2_active_protocol = chanp->l2_protocol;
chanp->incoming = !0;
init_b_st(chanp, !0);
chanp->b_st->lli.l4l3(chanp->b_st, DL_ESTABLISH | REQUEST, NULL);
}
static void
lli_setup_rsp(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
if (chanp->leased) {
lli_init_bchan_in(fi, event, arg);
} else {
FsmChangeState(fi, ST_IN_WAIT_CONN_ACK);
#ifdef WANT_ALERT
chanp->d_st->lli.l4l3(chanp->d_st, CC_ALERTING | REQUEST, chanp->proc);
#endif
chanp->d_st->lli.l4l3(chanp->d_st, CC_SETUP | RESPONSE, chanp->proc);
}
}
/* Call suspend */
static void
lli_suspend(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
chanp->d_st->lli.l4l3(chanp->d_st, CC_SUSPEND | REQUEST, chanp->proc);
}
/* Call clearing */
static void
lli_leased_hup(struct FsmInst *fi, struct Channel *chanp)
{
isdn_ctrl ic;
ic.driver = chanp->cs->myid;
ic.command = ISDN_STAT_CAUSE;
ic.arg = chanp->chan;
sprintf(ic.parm.num, "L0010");
chanp->cs->iif.statcallb(&ic);
if (chanp->debug & 1)
link_debug(chanp, 0, "STAT_DHUP");
HL_LL(chanp, ISDN_STAT_DHUP);
lli_close(fi);
}
static void
lli_disconnect_req(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
if (chanp->leased) {
lli_leased_hup(fi, chanp);
} else {
FsmChangeState(fi, ST_WAIT_DRELEASE);
if (chanp->proc)
chanp->proc->para.cause = 0x10; /* Normal Call Clearing */
chanp->d_st->lli.l4l3(chanp->d_st, CC_DISCONNECT | REQUEST,
chanp->proc);
}
}
static void
lli_disconnect_reject(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
if (chanp->leased) {
lli_leased_hup(fi, chanp);
} else {
FsmChangeState(fi, ST_WAIT_DRELEASE);
if (chanp->proc)
chanp->proc->para.cause = 0x15; /* Call Rejected */
chanp->d_st->lli.l4l3(chanp->d_st, CC_DISCONNECT | REQUEST,
chanp->proc);
}
}
static void
lli_dhup_close(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
if (chanp->leased) {
lli_leased_hup(fi, chanp);
} else {
if (chanp->debug & 1)
link_debug(chanp, 0, "STAT_DHUP");
lli_deliver_cause(chanp);
HL_LL(chanp, ISDN_STAT_DHUP);
lli_close(fi);
}
}
static void
lli_reject_req(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
if (chanp->leased) {
lli_leased_hup(fi, chanp);
return;
}
#ifndef ALERT_REJECT
if (chanp->proc)
chanp->proc->para.cause = 0x15; /* Call Rejected */
chanp->d_st->lli.l4l3(chanp->d_st, CC_REJECT | REQUEST, chanp->proc);
lli_dhup_close(fi, event, arg);
#else
FsmRestartTimer(&chanp->drel_timer, 40, EV_HANGUP, NULL, 63);
FsmChangeState(fi, ST_IN_ALERT_SENT);
chanp->d_st->lli.l4l3(chanp->d_st, CC_ALERTING | REQUEST, chanp->proc);
#endif
}
static void
lli_disconn_bchan(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
chanp->data_open = 0;
FsmChangeState(fi, ST_WAIT_BRELEASE);
chanp->b_st->lli.l4l3(chanp->b_st, DL_RELEASE | REQUEST, NULL);
}
static void
lli_start_disc(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
if (chanp->leased) {
lli_leased_hup(fi, chanp);
} else {
lli_disconnect_req(fi, event, arg);
}
}
static void
lli_rel_b_disc(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
release_b_st(chanp);
lli_start_disc(fi, event, arg);
}
static void
lli_bhup_disc(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
if (chanp->debug & 1)
link_debug(chanp, 0, "STAT_BHUP");
HL_LL(chanp, ISDN_STAT_BHUP);
lli_rel_b_disc(fi, event, arg);
}
static void
lli_bhup_rel_b(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
FsmChangeState(fi, ST_WAIT_DCOMMAND);
chanp->data_open = 0;
if (chanp->debug & 1)
link_debug(chanp, 0, "STAT_BHUP");
HL_LL(chanp, ISDN_STAT_BHUP);
release_b_st(chanp);
}
static void
lli_release_bchan(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
chanp->data_open = 0;
FsmChangeState(fi, ST_WAIT_BREL_DISC);
chanp->b_st->lli.l4l3(chanp->b_st, DL_RELEASE | REQUEST, NULL);
}
static void
lli_rel_b_dhup(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
release_b_st(chanp);
lli_dhup_close(fi, event, arg);
}
static void
lli_bhup_dhup(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
if (chanp->debug & 1)
link_debug(chanp, 0, "STAT_BHUP");
HL_LL(chanp, ISDN_STAT_BHUP);
lli_rel_b_dhup(fi, event, arg);
}
static void
lli_abort(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
chanp->data_open = 0;
chanp->b_st->lli.l4l3(chanp->b_st, DL_RELEASE | REQUEST, NULL);
lli_bhup_dhup(fi, event, arg);
}
static void
lli_release_req(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
if (chanp->leased) {
lli_leased_hup(fi, chanp);
} else {
FsmChangeState(fi, ST_WAIT_D_REL_CNF);
chanp->d_st->lli.l4l3(chanp->d_st, CC_RELEASE | REQUEST,
chanp->proc);
}
}
static void
lli_rel_b_release_req(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
release_b_st(chanp);
lli_release_req(fi, event, arg);
}
static void
lli_bhup_release_req(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
if (chanp->debug & 1)
link_debug(chanp, 0, "STAT_BHUP");
HL_LL(chanp, ISDN_STAT_BHUP);
lli_rel_b_release_req(fi, event, arg);
}
/* processing charge info */
static void
lli_charge_info(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
isdn_ctrl ic;
ic.driver = chanp->cs->myid;
ic.command = ISDN_STAT_CINF;
ic.arg = chanp->chan;
sprintf(ic.parm.num, "%d", chanp->proc->para.chargeinfo);
chanp->cs->iif.statcallb(&ic);
}
/* error procedures */
static void
lli_dchan_not_ready(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
if (chanp->debug & 1)
link_debug(chanp, 0, "STAT_DHUP");
HL_LL(chanp, ISDN_STAT_DHUP);
}
static void
lli_no_setup_rsp(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
if (chanp->debug & 1)
link_debug(chanp, 0, "STAT_DHUP");
HL_LL(chanp, ISDN_STAT_DHUP);
lli_close(fi);
}
static void
lli_error(struct FsmInst *fi, int event, void *arg)
{
FsmChangeState(fi, ST_WAIT_DRELEASE);
}
static void
lli_failure_l(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
isdn_ctrl ic;
FsmChangeState(fi, ST_NULL);
ic.driver = chanp->cs->myid;
ic.command = ISDN_STAT_CAUSE;
ic.arg = chanp->chan;
sprintf(ic.parm.num, "L%02X%02X", 0, 0x2f);
chanp->cs->iif.statcallb(&ic);
HL_LL(chanp, ISDN_STAT_DHUP);
chanp->Flags = 0;
chanp->cs->cardmsg(chanp->cs, MDL_INFO_REL, (void *) (long)chanp->chan);
}
static void
lli_rel_b_fail(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
release_b_st(chanp);
lli_failure_l(fi, event, arg);
}
static void
lli_bhup_fail(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
if (chanp->debug & 1)
link_debug(chanp, 0, "STAT_BHUP");
HL_LL(chanp, ISDN_STAT_BHUP);
lli_rel_b_fail(fi, event, arg);
}
static void
lli_failure_a(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
chanp->data_open = 0;
chanp->b_st->lli.l4l3(chanp->b_st, DL_RELEASE | REQUEST, NULL);
lli_bhup_fail(fi, event, arg);
}
/* *INDENT-OFF* */
static struct FsmNode fnlist[] __initdata =
{
{ST_NULL, EV_DIAL, lli_prep_dialout},
{ST_NULL, EV_RESUME, lli_resume},
{ST_NULL, EV_SETUP_IND, lli_deliver_call},
{ST_NULL, EV_LEASED, lli_leased_in},
{ST_OUT_DIAL, EV_SETUP_CNF, lli_init_bchan_out},
{ST_OUT_DIAL, EV_HANGUP, lli_disconnect_req},
{ST_OUT_DIAL, EV_DISCONNECT_IND, lli_release_req},
{ST_OUT_DIAL, EV_RELEASE, lli_dhup_close},
{ST_OUT_DIAL, EV_NOSETUP_RSP, lli_no_setup_rsp},
{ST_OUT_DIAL, EV_SETUP_ERR, lli_error},
{ST_IN_WAIT_LL, EV_LEASED_REL, lli_failure_l},
{ST_IN_WAIT_LL, EV_ACCEPTD, lli_setup_rsp},
{ST_IN_WAIT_LL, EV_HANGUP, lli_reject_req},
{ST_IN_WAIT_LL, EV_DISCONNECT_IND, lli_release_req},
{ST_IN_WAIT_LL, EV_RELEASE, lli_dhup_close},
{ST_IN_WAIT_LL, EV_SETUP_IND, lli_deliver_call},
{ST_IN_WAIT_LL, EV_SETUP_ERR, lli_error},
{ST_IN_ALERT_SENT, EV_SETUP_CMPL_IND, lli_init_bchan_in},
{ST_IN_ALERT_SENT, EV_ACCEPTD, lli_send_dconnect},
{ST_IN_ALERT_SENT, EV_HANGUP, lli_disconnect_reject},
{ST_IN_ALERT_SENT, EV_DISCONNECT_IND, lli_release_req},
{ST_IN_ALERT_SENT, EV_RELEASE, lli_dhup_close},
{ST_IN_ALERT_SENT, EV_REDIR, lli_send_redir},
{ST_IN_PROCEED_SEND, EV_REDIR, lli_send_redir},
{ST_IN_PROCEED_SEND, EV_ALERT, lli_send_alert},
{ST_IN_PROCEED_SEND, EV_ACCEPTD, lli_send_dconnect},
{ST_IN_PROCEED_SEND, EV_HANGUP, lli_disconnect_reject},
{ST_IN_PROCEED_SEND, EV_DISCONNECT_IND, lli_dhup_close},
{ST_IN_ALERT_SENT, EV_RELEASE, lli_dhup_close},
{ST_IN_WAIT_CONN_ACK, EV_SETUP_CMPL_IND, lli_init_bchan_in},
{ST_IN_WAIT_CONN_ACK, EV_HANGUP, lli_disconnect_req},
{ST_IN_WAIT_CONN_ACK, EV_DISCONNECT_IND, lli_release_req},
{ST_IN_WAIT_CONN_ACK, EV_RELEASE, lli_dhup_close},
{ST_IN_WAIT_CONN_ACK, EV_CONNECT_ERR, lli_error},
{ST_WAIT_BCONN, EV_BC_EST, lli_go_active},
{ST_WAIT_BCONN, EV_BC_REL, lli_rel_b_disc},
{ST_WAIT_BCONN, EV_HANGUP, lli_rel_b_disc},
{ST_WAIT_BCONN, EV_DISCONNECT_IND, lli_rel_b_release_req},
{ST_WAIT_BCONN, EV_RELEASE, lli_rel_b_dhup},
{ST_WAIT_BCONN, EV_LEASED_REL, lli_rel_b_fail},
{ST_WAIT_BCONN, EV_CINF, lli_charge_info},
{ST_ACTIVE, EV_CINF, lli_charge_info},
{ST_ACTIVE, EV_BC_REL, lli_bhup_rel_b},
{ST_ACTIVE, EV_SUSPEND, lli_suspend},
{ST_ACTIVE, EV_HANGUP, lli_disconn_bchan},
{ST_ACTIVE, EV_DISCONNECT_IND, lli_release_bchan},
{ST_ACTIVE, EV_RELEASE, lli_abort},
{ST_ACTIVE, EV_LEASED_REL, lli_failure_a},
{ST_WAIT_BRELEASE, EV_BC_REL, lli_bhup_disc},
{ST_WAIT_BRELEASE, EV_DISCONNECT_IND, lli_bhup_release_req},
{ST_WAIT_BRELEASE, EV_RELEASE, lli_bhup_dhup},
{ST_WAIT_BRELEASE, EV_LEASED_REL, lli_bhup_fail},
{ST_WAIT_BREL_DISC, EV_BC_REL, lli_bhup_release_req},
{ST_WAIT_BREL_DISC, EV_RELEASE, lli_bhup_dhup},
{ST_WAIT_DCOMMAND, EV_HANGUP, lli_start_disc},
{ST_WAIT_DCOMMAND, EV_DISCONNECT_IND, lli_release_req},
{ST_WAIT_DCOMMAND, EV_RELEASE, lli_dhup_close},
{ST_WAIT_DCOMMAND, EV_LEASED_REL, lli_failure_l},
{ST_WAIT_DRELEASE, EV_RELEASE, lli_dhup_close},
{ST_WAIT_DRELEASE, EV_DIAL, lli_dchan_not_ready},
/* ETS 300-104 16.1 */
{ST_WAIT_D_REL_CNF, EV_RELEASE, lli_dhup_close},
{ST_WAIT_D_REL_CNF, EV_DIAL, lli_dchan_not_ready},
};
/* *INDENT-ON* */
int __init
CallcNew(void)
{
callcfsm.state_count = STATE_COUNT;
callcfsm.event_count = EVENT_COUNT;
callcfsm.strEvent = strEvent;
callcfsm.strState = strState;
return FsmNew(&callcfsm, fnlist, ARRAY_SIZE(fnlist));
}
void
CallcFree(void)
{
FsmFree(&callcfsm);
}
static void
release_b_st(struct Channel *chanp)
{
struct PStack *st = chanp->b_st;
if (test_and_clear_bit(FLG_START_B, &chanp->Flags)) {
chanp->bcs->BC_Close(chanp->bcs);
switch (chanp->l2_active_protocol) {
case (ISDN_PROTO_L2_X75I):
releasestack_isdnl2(st);
break;
case (ISDN_PROTO_L2_HDLC):
case (ISDN_PROTO_L2_HDLC_56K):
case (ISDN_PROTO_L2_TRANS):
case (ISDN_PROTO_L2_MODEM):
case (ISDN_PROTO_L2_FAX):
releasestack_transl2(st);
break;
}
}
}
static struct Channel
*selectfreechannel(struct PStack *st, int bch)
{
struct IsdnCardState *cs = st->l1.hardware;
struct Channel *chanp = st->lli.userdata;
int i;
if (test_bit(FLG_TWO_DCHAN, &cs->HW_Flags))
i = 1;
else
i = 0;
if (!bch) {
i = 2; /* virtual channel */
chanp += 2;
}
while (i < ((bch) ? cs->chanlimit : (2 + MAX_WAITING_CALLS))) {
if (chanp->fi.state == ST_NULL)
return (chanp);
chanp++;
i++;
}
if (bch) /* number of channels is limited */ {
i = 2; /* virtual channel */
chanp = st->lli.userdata;
chanp += i;
while (i < (2 + MAX_WAITING_CALLS)) {
if (chanp->fi.state == ST_NULL)
return (chanp);
chanp++;
i++;
}
}
return (NULL);
}
static void stat_redir_result(struct IsdnCardState *cs, int chan, ulong result)
{ isdn_ctrl ic;
ic.driver = cs->myid;
ic.command = ISDN_STAT_REDIR;
ic.arg = chan;
ic.parm.num[0] = result;
cs->iif.statcallb(&ic);
} /* stat_redir_result */
static void
dchan_l3l4(struct PStack *st, int pr, void *arg)
{
struct l3_process *pc = arg;
struct IsdnCardState *cs = st->l1.hardware;
struct Channel *chanp;
if (!pc)
return;
if (pr == (CC_SETUP | INDICATION)) {
if (!(chanp = selectfreechannel(pc->st, pc->para.bchannel))) {
pc->para.cause = 0x11; /* User busy */
pc->st->lli.l4l3(pc->st, CC_REJECT | REQUEST, pc);
} else {
chanp->proc = pc;
pc->chan = chanp;
FsmEvent(&chanp->fi, EV_SETUP_IND, NULL);
}
return;
}
if (!(chanp = pc->chan))
return;
switch (pr) {
case (CC_MORE_INFO | INDICATION):
FsmEvent(&chanp->fi, EV_SETUP_IND, NULL);
break;
case (CC_DISCONNECT | INDICATION):
FsmEvent(&chanp->fi, EV_DISCONNECT_IND, NULL);
break;
case (CC_RELEASE | CONFIRM):
FsmEvent(&chanp->fi, EV_RELEASE, NULL);
break;
case (CC_SUSPEND | CONFIRM):
FsmEvent(&chanp->fi, EV_RELEASE, NULL);
break;
case (CC_RESUME | CONFIRM):
FsmEvent(&chanp->fi, EV_SETUP_CNF, NULL);
break;
case (CC_RESUME_ERR):
FsmEvent(&chanp->fi, EV_RELEASE, NULL);
break;
case (CC_RELEASE | INDICATION):
FsmEvent(&chanp->fi, EV_RELEASE, NULL);
break;
case (CC_SETUP_COMPL | INDICATION):
FsmEvent(&chanp->fi, EV_SETUP_CMPL_IND, NULL);
break;
case (CC_SETUP | CONFIRM):
FsmEvent(&chanp->fi, EV_SETUP_CNF, NULL);
break;
case (CC_CHARGE | INDICATION):
FsmEvent(&chanp->fi, EV_CINF, NULL);
break;
case (CC_NOSETUP_RSP):
FsmEvent(&chanp->fi, EV_NOSETUP_RSP, NULL);
break;
case (CC_SETUP_ERR):
FsmEvent(&chanp->fi, EV_SETUP_ERR, NULL);
break;
case (CC_CONNECT_ERR):
FsmEvent(&chanp->fi, EV_CONNECT_ERR, NULL);
break;
case (CC_RELEASE_ERR):
FsmEvent(&chanp->fi, EV_RELEASE, NULL);
break;
case (CC_PROCEED_SEND | INDICATION):
case (CC_PROCEEDING | INDICATION):
case (CC_ALERTING | INDICATION):
case (CC_PROGRESS | INDICATION):
case (CC_NOTIFY | INDICATION):
break;
case (CC_REDIR | INDICATION):
stat_redir_result(cs, chanp->chan, pc->redir_result);
break;
default:
if (chanp->debug & 0x800) {
HiSax_putstatus(chanp->cs, "Ch",
"%d L3->L4 unknown primitiv %#x",
chanp->chan, pr);
}
}
}
static void
dummy_pstack(struct PStack *st, int pr, void *arg) {
printk(KERN_WARNING"call to dummy_pstack pr=%04x arg %lx\n", pr, (long)arg);
}
static int
init_PStack(struct PStack **stp) {
*stp = kmalloc(sizeof(struct PStack), GFP_KERNEL);
if (!*stp)
return -ENOMEM;
(*stp)->next = NULL;
(*stp)->l1.l1l2 = dummy_pstack;
(*stp)->l1.l1hw = dummy_pstack;
(*stp)->l1.l1tei = dummy_pstack;
(*stp)->l2.l2tei = dummy_pstack;
(*stp)->l2.l2l1 = dummy_pstack;
(*stp)->l2.l2l3 = dummy_pstack;
(*stp)->l3.l3l2 = dummy_pstack;
(*stp)->l3.l3ml3 = dummy_pstack;
(*stp)->l3.l3l4 = dummy_pstack;
(*stp)->lli.l4l3 = dummy_pstack;
(*stp)->ma.layer = dummy_pstack;
return 0;
}
static int
init_d_st(struct Channel *chanp)
{
struct PStack *st;
struct IsdnCardState *cs = chanp->cs;
char tmp[16];
int err;
err = init_PStack(&chanp->d_st);
if (err)
return err;
st = chanp->d_st;
st->next = NULL;
HiSax_addlist(cs, st);
setstack_HiSax(st, cs);
st->l2.sap = 0;
st->l2.tei = -1;
st->l2.flag = 0;
test_and_set_bit(FLG_MOD128, &st->l2.flag);
test_and_set_bit(FLG_LAPD, &st->l2.flag);
test_and_set_bit(FLG_ORIG, &st->l2.flag);
st->l2.maxlen = MAX_DFRAME_LEN;
st->l2.window = 1;
st->l2.T200 = 1000; /* 1000 milliseconds */
st->l2.N200 = 3; /* try 3 times */
st->l2.T203 = 10000; /* 10000 milliseconds */
if (test_bit(FLG_TWO_DCHAN, &cs->HW_Flags))
sprintf(tmp, "DCh%d Q.921 ", chanp->chan);
else
sprintf(tmp, "DCh Q.921 ");
setstack_isdnl2(st, tmp);
setstack_l3dc(st, chanp);
st->lli.userdata = chanp;
st->l3.l3l4 = dchan_l3l4;
return 0;
}
static __printf(2, 3) void
callc_debug(struct FsmInst *fi, char *fmt, ...)
{
va_list args;
struct Channel *chanp = fi->userdata;
char tmp[16];
va_start(args, fmt);
sprintf(tmp, "Ch%d callc ", chanp->chan);
VHiSax_putstatus(chanp->cs, tmp, fmt, args);
va_end(args);
}
static int
init_chan(int chan, struct IsdnCardState *csta)
{
struct Channel *chanp = csta->channel + chan;
int err;
chanp->cs = csta;
chanp->bcs = csta->bcs + chan;
chanp->chan = chan;
chanp->incoming = 0;
chanp->debug = 0;
chanp->Flags = 0;
chanp->leased = 0;
err = init_PStack(&chanp->b_st);
if (err)
return err;
chanp->b_st->l1.delay = DEFAULT_B_DELAY;
chanp->fi.fsm = &callcfsm;
chanp->fi.state = ST_NULL;
chanp->fi.debug = 0;
chanp->fi.userdata = chanp;
chanp->fi.printdebug = callc_debug;
FsmInitTimer(&chanp->fi, &chanp->dial_timer);
FsmInitTimer(&chanp->fi, &chanp->drel_timer);
if (!chan || (test_bit(FLG_TWO_DCHAN, &csta->HW_Flags) && chan < 2)) {
err = init_d_st(chanp);
if (err)
return err;
} else {
chanp->d_st = csta->channel->d_st;
}
chanp->data_open = 0;
return 0;
}
int
CallcNewChan(struct IsdnCardState *csta) {
int i, err;
chancount += 2;
err = init_chan(0, csta);
if (err)
return err;
err = init_chan(1, csta);
if (err)
return err;
printk(KERN_INFO "HiSax: 2 channels added\n");
for (i = 0; i < MAX_WAITING_CALLS; i++) {
err = init_chan(i + 2, csta);
if (err)
return err;
}
printk(KERN_INFO "HiSax: MAX_WAITING_CALLS added\n");
if (test_bit(FLG_PTP, &csta->channel->d_st->l2.flag)) {
printk(KERN_INFO "LAYER2 WATCHING ESTABLISH\n");
csta->channel->d_st->lli.l4l3(csta->channel->d_st,
DL_ESTABLISH | REQUEST, NULL);
}
return (0);
}
static void
release_d_st(struct Channel *chanp)
{
struct PStack *st = chanp->d_st;
if (!st)
return;
releasestack_isdnl2(st);
releasestack_isdnl3(st);
HiSax_rmlist(st->l1.hardware, st);
kfree(st);
chanp->d_st = NULL;
}
void
CallcFreeChan(struct IsdnCardState *csta)
{
int i;
for (i = 0; i < 2; i++) {
FsmDelTimer(&csta->channel[i].drel_timer, 74);
FsmDelTimer(&csta->channel[i].dial_timer, 75);
if (i || test_bit(FLG_TWO_DCHAN, &csta->HW_Flags))
release_d_st(csta->channel + i);
if (csta->channel[i].b_st) {
release_b_st(csta->channel + i);
kfree(csta->channel[i].b_st);
csta->channel[i].b_st = NULL;
} else
printk(KERN_WARNING "CallcFreeChan b_st ch%d already freed\n", i);
if (i || test_bit(FLG_TWO_DCHAN, &csta->HW_Flags)) {
release_d_st(csta->channel + i);
} else
csta->channel[i].d_st = NULL;
}
}
static void
lldata_handler(struct PStack *st, int pr, void *arg)
{
struct Channel *chanp = (struct Channel *) st->lli.userdata;
struct sk_buff *skb = arg;
switch (pr) {
case (DL_DATA | INDICATION):
if (chanp->data_open) {
if (chanp->debug & 0x800)
link_debug(chanp, 0, "lldata: %d", skb->len);
chanp->cs->iif.rcvcallb_skb(chanp->cs->myid, chanp->chan, skb);
} else {
link_debug(chanp, 0, "lldata: channel not open");
dev_kfree_skb(skb);
}
break;
case (DL_ESTABLISH | INDICATION):
case (DL_ESTABLISH | CONFIRM):
FsmEvent(&chanp->fi, EV_BC_EST, NULL);
break;
case (DL_RELEASE | INDICATION):
case (DL_RELEASE | CONFIRM):
FsmEvent(&chanp->fi, EV_BC_REL, NULL);
break;
default:
printk(KERN_WARNING "lldata_handler unknown primitive %#x\n",
pr);
break;
}
}
static void
lltrans_handler(struct PStack *st, int pr, void *arg)
{
struct Channel *chanp = (struct Channel *) st->lli.userdata;
struct sk_buff *skb = arg;
switch (pr) {
case (PH_DATA | INDICATION):
if (chanp->data_open) {
if (chanp->debug & 0x800)
link_debug(chanp, 0, "lltrans: %d", skb->len);
chanp->cs->iif.rcvcallb_skb(chanp->cs->myid, chanp->chan, skb);
} else {
link_debug(chanp, 0, "lltrans: channel not open");
dev_kfree_skb(skb);
}
break;
case (PH_ACTIVATE | INDICATION):
case (PH_ACTIVATE | CONFIRM):
FsmEvent(&chanp->fi, EV_BC_EST, NULL);
break;
case (PH_DEACTIVATE | INDICATION):
case (PH_DEACTIVATE | CONFIRM):
FsmEvent(&chanp->fi, EV_BC_REL, NULL);
break;
default:
printk(KERN_WARNING "lltrans_handler unknown primitive %#x\n",
pr);
break;
}
}
void
lli_writewakeup(struct PStack *st, int len)
{
struct Channel *chanp = st->lli.userdata;
isdn_ctrl ic;
if (chanp->debug & 0x800)
link_debug(chanp, 0, "llwakeup: %d", len);
ic.driver = chanp->cs->myid;
ic.command = ISDN_STAT_BSENT;
ic.arg = chanp->chan;
ic.parm.length = len;
chanp->cs->iif.statcallb(&ic);
}
static int
init_b_st(struct Channel *chanp, int incoming)
{
struct PStack *st = chanp->b_st;
struct IsdnCardState *cs = chanp->cs;
char tmp[16];
st->l1.hardware = cs;
if (chanp->leased)
st->l1.bc = chanp->chan & 1;
else
st->l1.bc = chanp->proc->para.bchannel - 1;
switch (chanp->l2_active_protocol) {
case (ISDN_PROTO_L2_X75I):
case (ISDN_PROTO_L2_HDLC):
st->l1.mode = L1_MODE_HDLC;
break;
case (ISDN_PROTO_L2_HDLC_56K):
st->l1.mode = L1_MODE_HDLC_56K;
break;
case (ISDN_PROTO_L2_TRANS):
st->l1.mode = L1_MODE_TRANS;
break;
case (ISDN_PROTO_L2_MODEM):
st->l1.mode = L1_MODE_V32;
break;
case (ISDN_PROTO_L2_FAX):
st->l1.mode = L1_MODE_FAX;
break;
}
chanp->bcs->conmsg = NULL;
if (chanp->bcs->BC_SetStack(st, chanp->bcs))
return (-1);
st->l2.flag = 0;
test_and_set_bit(FLG_LAPB, &st->l2.flag);
st->l2.maxlen = MAX_DATA_SIZE;
if (!incoming)
test_and_set_bit(FLG_ORIG, &st->l2.flag);
st->l2.T200 = 1000; /* 1000 milliseconds */
st->l2.window = 7;
st->l2.N200 = 4; /* try 4 times */
st->l2.T203 = 5000; /* 5000 milliseconds */
st->l3.debug = 0;
switch (chanp->l2_active_protocol) {
case (ISDN_PROTO_L2_X75I):
sprintf(tmp, "Ch%d X.75", chanp->chan);
setstack_isdnl2(st, tmp);
setstack_l3bc(st, chanp);
st->l2.l2l3 = lldata_handler;
st->lli.userdata = chanp;
test_and_clear_bit(FLG_LLI_L1WAKEUP, &st->lli.flag);
test_and_set_bit(FLG_LLI_L2WAKEUP, &st->lli.flag);
st->l2.l2m.debug = chanp->debug & 16;
st->l2.debug = chanp->debug & 64;
break;
case (ISDN_PROTO_L2_HDLC):
case (ISDN_PROTO_L2_HDLC_56K):
case (ISDN_PROTO_L2_TRANS):
case (ISDN_PROTO_L2_MODEM):
case (ISDN_PROTO_L2_FAX):
st->l1.l1l2 = lltrans_handler;
st->lli.userdata = chanp;
test_and_set_bit(FLG_LLI_L1WAKEUP, &st->lli.flag);
test_and_clear_bit(FLG_LLI_L2WAKEUP, &st->lli.flag);
setstack_transl2(st);
setstack_l3bc(st, chanp);
break;
}
test_and_set_bit(FLG_START_B, &chanp->Flags);
return (0);
}
static void
leased_l4l3(struct PStack *st, int pr, void *arg)
{
struct Channel *chanp = (struct Channel *) st->lli.userdata;
struct sk_buff *skb = arg;
switch (pr) {
case (DL_DATA | REQUEST):
link_debug(chanp, 0, "leased line d-channel DATA");
dev_kfree_skb(skb);
break;
case (DL_ESTABLISH | REQUEST):
st->l2.l2l1(st, PH_ACTIVATE | REQUEST, NULL);
break;
case (DL_RELEASE | REQUEST):
break;
default:
printk(KERN_WARNING "transd_l4l3 unknown primitive %#x\n",
pr);
break;
}
}
static void
leased_l1l2(struct PStack *st, int pr, void *arg)
{
struct Channel *chanp = (struct Channel *) st->lli.userdata;
struct sk_buff *skb = arg;
int i, event = EV_LEASED_REL;
switch (pr) {
case (PH_DATA | INDICATION):
link_debug(chanp, 0, "leased line d-channel DATA");
dev_kfree_skb(skb);
break;
case (PH_ACTIVATE | INDICATION):
case (PH_ACTIVATE | CONFIRM):
event = EV_LEASED;
/* fall through */
case (PH_DEACTIVATE | INDICATION):
case (PH_DEACTIVATE | CONFIRM):
if (test_bit(FLG_TWO_DCHAN, &chanp->cs->HW_Flags))
i = 1;
else
i = 0;
while (i < 2) {
FsmEvent(&chanp->fi, event, NULL);
chanp++;
i++;
}
break;
default:
printk(KERN_WARNING
"transd_l1l2 unknown primitive %#x\n", pr);
break;
}
}
static void
distr_debug(struct IsdnCardState *csta, int debugflags)
{
int i;
struct Channel *chanp = csta->channel;
for (i = 0; i < (2 + MAX_WAITING_CALLS); i++) {
chanp[i].debug = debugflags;
chanp[i].fi.debug = debugflags & 2;
chanp[i].d_st->l2.l2m.debug = debugflags & 8;
chanp[i].b_st->l2.l2m.debug = debugflags & 0x10;
chanp[i].d_st->l2.debug = debugflags & 0x20;
chanp[i].b_st->l2.debug = debugflags & 0x40;
chanp[i].d_st->l3.l3m.debug = debugflags & 0x80;
chanp[i].b_st->l3.l3m.debug = debugflags & 0x100;
chanp[i].b_st->ma.tei_m.debug = debugflags & 0x200;
chanp[i].b_st->ma.debug = debugflags & 0x200;
chanp[i].d_st->l1.l1m.debug = debugflags & 0x1000;
chanp[i].b_st->l1.l1m.debug = debugflags & 0x2000;
}
if (debugflags & 4)
csta->debug |= DEB_DLOG_HEX;
else
csta->debug &= ~DEB_DLOG_HEX;
}
static char tmpbuf[256];
static void
capi_debug(struct Channel *chanp, capi_msg *cm)
{
char *t = tmpbuf;
t += QuickHex(t, (u_char *)cm, (cm->Length > 50) ? 50 : cm->Length);
t--;
*t = 0;
HiSax_putstatus(chanp->cs, "Ch", "%d CAPIMSG %s", chanp->chan, tmpbuf);
}
static void
lli_got_fac_req(struct Channel *chanp, capi_msg *cm) {
if ((cm->para[0] != 3) || (cm->para[1] != 0))
return;
if (cm->para[2] < 3)
return;
if (cm->para[4] != 0)
return;
switch (cm->para[3]) {
case 4: /* Suspend */
strncpy(chanp->setup.phone, &cm->para[5], cm->para[5] + 1);
FsmEvent(&chanp->fi, EV_SUSPEND, cm);
break;
case 5: /* Resume */
strncpy(chanp->setup.phone, &cm->para[5], cm->para[5] + 1);
if (chanp->fi.state == ST_NULL) {
FsmEvent(&chanp->fi, EV_RESUME, cm);
} else {
FsmDelTimer(&chanp->dial_timer, 72);
FsmAddTimer(&chanp->dial_timer, 80, EV_RESUME, cm, 73);
}
break;
}
}
static void
lli_got_manufacturer(struct Channel *chanp, struct IsdnCardState *cs, capi_msg *cm) {
if ((cs->typ == ISDN_CTYPE_ELSA) || (cs->typ == ISDN_CTYPE_ELSA_PNP) ||
(cs->typ == ISDN_CTYPE_ELSA_PCI)) {
if (cs->hw.elsa.MFlag) {
cs->cardmsg(cs, CARD_AUX_IND, cm->para);
}
}
}
/***************************************************************/
/* Limit the available number of channels for the current card */
/***************************************************************/
static int
set_channel_limit(struct IsdnCardState *cs, int chanmax)
{
isdn_ctrl ic;
int i, ii;
if ((chanmax < 0) || (chanmax > 2))
return (-EINVAL);
cs->chanlimit = 0;
for (ii = 0; ii < 2; ii++) {
ic.driver = cs->myid;
ic.command = ISDN_STAT_DISCH;
ic.arg = ii;
if (ii >= chanmax)
ic.parm.num[0] = 0; /* disabled */
else
ic.parm.num[0] = 1; /* enabled */
i = cs->iif.statcallb(&ic);
if (i) return (-EINVAL);
if (ii < chanmax)
cs->chanlimit++;
}
return (0);
} /* set_channel_limit */
int
HiSax_command(isdn_ctrl *ic)
{
struct IsdnCardState *csta = hisax_findcard(ic->driver);
struct PStack *st;
struct Channel *chanp;
int i;
u_int num;
if (!csta) {
printk(KERN_ERR
"HiSax: if_command %d called with invalid driverId %d!\n",
ic->command, ic->driver);
return -ENODEV;
}
switch (ic->command) {
case (ISDN_CMD_SETEAZ):
chanp = csta->channel + ic->arg;
break;
case (ISDN_CMD_SETL2):
chanp = csta->channel + (ic->arg & 0xff);
if (chanp->debug & 1)
link_debug(chanp, 1, "SETL2 card %d %ld",
csta->cardnr + 1, ic->arg >> 8);
chanp->l2_protocol = ic->arg >> 8;
break;
case (ISDN_CMD_SETL3):
chanp = csta->channel + (ic->arg & 0xff);
if (chanp->debug & 1)
link_debug(chanp, 1, "SETL3 card %d %ld",
csta->cardnr + 1, ic->arg >> 8);
chanp->l3_protocol = ic->arg >> 8;
break;
case (ISDN_CMD_DIAL):
chanp = csta->channel + (ic->arg & 0xff);
if (chanp->debug & 1)
link_debug(chanp, 1, "DIAL %s -> %s (%d,%d)",
ic->parm.setup.eazmsn, ic->parm.setup.phone,
ic->parm.setup.si1, ic->parm.setup.si2);
memcpy(&chanp->setup, &ic->parm.setup, sizeof(setup_parm));
if (!strcmp(chanp->setup.eazmsn, "0"))
chanp->setup.eazmsn[0] = '\0';
/* this solution is dirty and may be change, if
* we make a callreference based callmanager */
if (chanp->fi.state == ST_NULL) {
FsmEvent(&chanp->fi, EV_DIAL, NULL);
} else {
FsmDelTimer(&chanp->dial_timer, 70);
FsmAddTimer(&chanp->dial_timer, 50, EV_DIAL, NULL, 71);
}
break;
case (ISDN_CMD_ACCEPTB):
chanp = csta->channel + ic->arg;
if (chanp->debug & 1)
link_debug(chanp, 1, "ACCEPTB");
FsmEvent(&chanp->fi, EV_ACCEPTB, NULL);
break;
case (ISDN_CMD_ACCEPTD):
chanp = csta->channel + ic->arg;
memcpy(&chanp->setup, &ic->parm.setup, sizeof(setup_parm));
if (chanp->debug & 1)
link_debug(chanp, 1, "ACCEPTD");
FsmEvent(&chanp->fi, EV_ACCEPTD, NULL);
break;
case (ISDN_CMD_HANGUP):
chanp = csta->channel + ic->arg;
if (chanp->debug & 1)
link_debug(chanp, 1, "HANGUP");
FsmEvent(&chanp->fi, EV_HANGUP, NULL);
break;
case (CAPI_PUT_MESSAGE):
chanp = csta->channel + ic->arg;
if (chanp->debug & 1)
capi_debug(chanp, &ic->parm.cmsg);
if (ic->parm.cmsg.Length < 8)
break;
switch (ic->parm.cmsg.Command) {
case CAPI_FACILITY:
if (ic->parm.cmsg.Subcommand == CAPI_REQ)
lli_got_fac_req(chanp, &ic->parm.cmsg);
break;
case CAPI_MANUFACTURER:
if (ic->parm.cmsg.Subcommand == CAPI_REQ)
lli_got_manufacturer(chanp, csta, &ic->parm.cmsg);
break;
default:
break;
}
break;
case (ISDN_CMD_IOCTL):
switch (ic->arg) {
case (0):
num = *(unsigned int *) ic->parm.num;
HiSax_reportcard(csta->cardnr, num);
break;
case (1):
num = *(unsigned int *) ic->parm.num;
distr_debug(csta, num);
printk(KERN_DEBUG "HiSax: debugging flags card %d set to %x\n",
csta->cardnr + 1, num);
HiSax_putstatus(csta, "debugging flags ",
"card %d set to %x", csta->cardnr + 1, num);
break;
case (2):
num = *(unsigned int *) ic->parm.num;
csta->channel[0].b_st->l1.delay = num;
csta->channel[1].b_st->l1.delay = num;
HiSax_putstatus(csta, "delay ", "card %d set to %d ms",
csta->cardnr + 1, num);
printk(KERN_DEBUG "HiSax: delay card %d set to %d ms\n",
csta->cardnr + 1, num);
break;
case (5): /* set card in leased mode */
num = *(unsigned int *) ic->parm.num;
if ((num < 1) || (num > 2)) {
HiSax_putstatus(csta, "Set LEASED ",
"wrong channel %d", num);
printk(KERN_WARNING "HiSax: Set LEASED wrong channel %d\n",
num);
} else {
num--;
chanp = csta->channel + num;
chanp->leased = 1;
HiSax_putstatus(csta, "Card",
"%d channel %d set leased mode\n",
csta->cardnr + 1, num + 1);
chanp->d_st->l1.l1l2 = leased_l1l2;
chanp->d_st->lli.l4l3 = leased_l4l3;
chanp->d_st->lli.l4l3(chanp->d_st,
DL_ESTABLISH | REQUEST, NULL);
}
break;
case (6): /* set B-channel test loop */
num = *(unsigned int *) ic->parm.num;
if (csta->stlist)
csta->stlist->l2.l2l1(csta->stlist,
PH_TESTLOOP | REQUEST, (void *) (long)num);
break;
case (7): /* set card in PTP mode */
num = *(unsigned int *) ic->parm.num;
if (test_bit(FLG_TWO_DCHAN, &csta->HW_Flags)) {
printk(KERN_ERR "HiSax PTP mode only with one TEI possible\n");
} else if (num) {
test_and_set_bit(FLG_PTP, &csta->channel[0].d_st->l2.flag);
test_and_set_bit(FLG_FIXED_TEI, &csta->channel[0].d_st->l2.flag);
csta->channel[0].d_st->l2.tei = 0;
HiSax_putstatus(csta, "set card ", "in PTP mode");
printk(KERN_DEBUG "HiSax: set card in PTP mode\n");
printk(KERN_INFO "LAYER2 WATCHING ESTABLISH\n");
csta->channel[0].d_st->lli.l4l3(csta->channel[0].d_st,
DL_ESTABLISH | REQUEST, NULL);
} else {
test_and_clear_bit(FLG_PTP, &csta->channel[0].d_st->l2.flag);
test_and_clear_bit(FLG_FIXED_TEI, &csta->channel[0].d_st->l2.flag);
HiSax_putstatus(csta, "set card ", "in PTMP mode");
printk(KERN_DEBUG "HiSax: set card in PTMP mode\n");
}
break;
case (8): /* set card in FIXED TEI mode */
num = *(unsigned int *)ic->parm.num;
chanp = csta->channel + (num & 1);
num = num >> 1;
if (num == 127) {
test_and_clear_bit(FLG_FIXED_TEI, &chanp->d_st->l2.flag);
chanp->d_st->l2.tei = -1;
HiSax_putstatus(csta, "set card ", "in VAR TEI mode");
printk(KERN_DEBUG "HiSax: set card in VAR TEI mode\n");
} else {
test_and_set_bit(FLG_FIXED_TEI, &chanp->d_st->l2.flag);
chanp->d_st->l2.tei = num;
HiSax_putstatus(csta, "set card ", "in FIXED TEI (%d) mode", num);
printk(KERN_DEBUG "HiSax: set card in FIXED TEI (%d) mode\n",
num);
}
chanp->d_st->lli.l4l3(chanp->d_st,
DL_ESTABLISH | REQUEST, NULL);
break;
case (11):
num = csta->debug & DEB_DLOG_HEX;
csta->debug = *(unsigned int *) ic->parm.num;
csta->debug |= num;
HiSax_putstatus(cards[0].cs, "l1 debugging ",
"flags card %d set to %x",
csta->cardnr + 1, csta->debug);
printk(KERN_DEBUG "HiSax: l1 debugging flags card %d set to %x\n",
csta->cardnr + 1, csta->debug);
break;
case (13):
csta->channel[0].d_st->l3.debug = *(unsigned int *) ic->parm.num;
csta->channel[1].d_st->l3.debug = *(unsigned int *) ic->parm.num;
HiSax_putstatus(cards[0].cs, "l3 debugging ",
"flags card %d set to %x\n", csta->cardnr + 1,
*(unsigned int *) ic->parm.num);
printk(KERN_DEBUG "HiSax: l3 debugging flags card %d set to %x\n",
csta->cardnr + 1, *(unsigned int *) ic->parm.num);
break;
case (10):
i = *(unsigned int *) ic->parm.num;
return (set_channel_limit(csta, i));
default:
if (csta->auxcmd)
return (csta->auxcmd(csta, ic));
printk(KERN_DEBUG "HiSax: invalid ioctl %d\n",
(int) ic->arg);
return (-EINVAL);
}
break;
case (ISDN_CMD_PROCEED):
chanp = csta->channel + ic->arg;
if (chanp->debug & 1)
link_debug(chanp, 1, "PROCEED");
FsmEvent(&chanp->fi, EV_PROCEED, NULL);
break;
case (ISDN_CMD_ALERT):
chanp = csta->channel + ic->arg;
if (chanp->debug & 1)
link_debug(chanp, 1, "ALERT");
FsmEvent(&chanp->fi, EV_ALERT, NULL);
break;
case (ISDN_CMD_REDIR):
chanp = csta->channel + ic->arg;
if (chanp->debug & 1)
link_debug(chanp, 1, "REDIR");
memcpy(&chanp->setup, &ic->parm.setup, sizeof(setup_parm));
FsmEvent(&chanp->fi, EV_REDIR, NULL);
break;
/* protocol specific io commands */
case (ISDN_CMD_PROT_IO):
for (st = csta->stlist; st; st = st->next)
if (st->protocol == (ic->arg & 0xFF))
return (st->lli.l4l3_proto(st, ic));
return (-EINVAL);
break;
default:
if (csta->auxcmd)
return (csta->auxcmd(csta, ic));
return (-EINVAL);
}
return (0);
}
int
HiSax_writebuf_skb(int id, int chan, int ack, struct sk_buff *skb)
{
struct IsdnCardState *csta = hisax_findcard(id);
struct Channel *chanp;
struct PStack *st;
int len = skb->len;
struct sk_buff *nskb;
if (!csta) {
printk(KERN_ERR
"HiSax: if_sendbuf called with invalid driverId!\n");
return -ENODEV;
}
chanp = csta->channel + chan;
st = chanp->b_st;
if (!chanp->data_open) {
link_debug(chanp, 1, "writebuf: channel not open");
return -EIO;
}
if (len > MAX_DATA_SIZE) {
link_debug(chanp, 1, "writebuf: packet too large (%d bytes)", len);
printk(KERN_WARNING "HiSax_writebuf: packet too large (%d bytes) !\n",
len);
return -EINVAL;
}
if (len) {
if ((len + chanp->bcs->tx_cnt) > MAX_DATA_MEM) {
/* Must return 0 here, since this is not an error
* but a temporary lack of resources.
*/
if (chanp->debug & 0x800)
link_debug(chanp, 1, "writebuf: no buffers for %d bytes", len);
return 0;
} else if (chanp->debug & 0x800)
link_debug(chanp, 1, "writebuf %d/%d/%d", len, chanp->bcs->tx_cnt, MAX_DATA_MEM);
nskb = skb_clone(skb, GFP_ATOMIC);
if (nskb) {
nskb->truesize = nskb->len;
if (!ack)
nskb->pkt_type = PACKET_NOACK;
if (chanp->l2_active_protocol == ISDN_PROTO_L2_X75I)
st->l3.l3l2(st, DL_DATA | REQUEST, nskb);
else {
chanp->bcs->tx_cnt += len;
st->l2.l2l1(st, PH_DATA | REQUEST, nskb);
}
dev_kfree_skb(skb);
} else
len = 0;
}
return (len);
}