5906e69ac2
i4bq931, i4b, isic, iwic, ifpi, ifpi2, ifpnp, ihfc, and itjc are no longer count devices. Also remove a few other instances of N<DEVICE> being used to control compilation of whole files. Reviewed by: hm
949 lines
26 KiB
C
949 lines
26 KiB
C
/*
|
|
* Copyright (c) 2001 Cubical Solutions Ltd. 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.
|
|
*
|
|
* capi/capi_msgs.c The CAPI i4b message handlers.
|
|
*
|
|
* $FreeBSD$
|
|
*/
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/mbuf.h>
|
|
#include <sys/socket.h>
|
|
#include <net/if.h>
|
|
|
|
#include <machine/i4b_debug.h>
|
|
#include <machine/i4b_ioctl.h>
|
|
#include <machine/i4b_cause.h>
|
|
|
|
#include <i4b/include/i4b_l3l4.h>
|
|
#include <i4b/include/i4b_mbuf.h>
|
|
#include <i4b/include/i4b_global.h>
|
|
|
|
#include <i4b/layer4/i4b_l4.h>
|
|
|
|
#include <i4b/capi/capi.h>
|
|
#include <i4b/capi/capi_msgs.h>
|
|
|
|
/*
|
|
// Administrative messages:
|
|
// ------------------------
|
|
*/
|
|
|
|
void capi_listen_req(capi_softc_t *sc, u_int32_t CIP)
|
|
{
|
|
struct mbuf *m = i4b_Dgetmbuf(8 + 18);
|
|
u_int8_t *msg;
|
|
u_int16_t msgid;
|
|
|
|
if (!m) {
|
|
printf("capi%d: can't get mbuf for listen_req\n", sc->sc_unit);
|
|
return;
|
|
}
|
|
|
|
msgid = sc->sc_msgid++;
|
|
|
|
msg = capimsg_setu16(mtod(m, u_int8_t*), m->m_len);
|
|
msg = capimsg_setu16(msg, I4BCAPI_APPLID);
|
|
msg = capimsg_setu16(msg, CAPI_LISTEN_REQ);
|
|
msg = capimsg_setu16(msg, msgid);
|
|
|
|
msg = capimsg_setu32(msg, 1); /* Controller */
|
|
msg = capimsg_setu32(msg, 0); /* Info mask */
|
|
msg = capimsg_setu32(msg, CIP);
|
|
msg = capimsg_setu32(msg, 0);
|
|
msg = capimsg_setu8(msg, 0);
|
|
msg = capimsg_setu8(msg, 0);
|
|
|
|
sc->send(sc, m);
|
|
}
|
|
|
|
void capi_listen_conf(capi_softc_t *sc, struct mbuf *m_in)
|
|
{
|
|
u_int8_t *msg = mtod(m_in, u_int8_t*);
|
|
u_int16_t Info;
|
|
|
|
capimsg_getu16(msg + 12, &Info);
|
|
|
|
if (Info == 0) {
|
|
/* We are now listening. */
|
|
|
|
sc->sc_state = C_UP;
|
|
ctrl_desc[sc->ctrl_unit].dl_est = DL_UP;
|
|
|
|
i4b_l4_l12stat(sc->ctrl_unit, 1, 1);
|
|
i4b_l4_l12stat(sc->ctrl_unit, 2, 1);
|
|
|
|
} else {
|
|
/* XXX sc->sc_state = C_DOWN ? XXX */
|
|
printf("capi%d: can't listen, info=%04x\n", sc->sc_unit, Info);
|
|
}
|
|
}
|
|
|
|
void capi_info_ind(capi_softc_t *sc, struct mbuf *m_in)
|
|
{
|
|
struct mbuf *m = i4b_Dgetmbuf(8 + 4);
|
|
u_int8_t *msg = mtod(m_in, u_int8_t*);
|
|
u_int16_t applid, msgid;
|
|
u_int32_t PLCI;
|
|
|
|
if (!m) {
|
|
printf("capi%d: can't get mbuf for info_resp\n", sc->sc_unit);
|
|
return;
|
|
}
|
|
|
|
msg = capimsg_getu16(msg + 2, &applid);
|
|
msg = capimsg_getu16(msg + 2, &msgid);
|
|
msg = capimsg_getu32(msg, &PLCI);
|
|
|
|
/* i4b_l4_info_ind() */
|
|
|
|
msg = capimsg_setu16(mtod(m, u_int8_t*), m->m_len);
|
|
msg = capimsg_setu16(msg, applid);
|
|
msg = capimsg_setu16(msg, CAPI_INFO_RESP);
|
|
msg = capimsg_setu16(msg, msgid);
|
|
|
|
msg = capimsg_setu32(msg, PLCI);
|
|
|
|
sc->send(sc, m);
|
|
}
|
|
|
|
void capi_alert_req(capi_softc_t *sc, call_desc_t *cd)
|
|
{
|
|
struct mbuf *m = i4b_Dgetmbuf(8 + 5);
|
|
u_int8_t *msg;
|
|
u_int16_t msgid;
|
|
u_int32_t PLCI;
|
|
|
|
if (!m) {
|
|
printf("capi%d: can't get mbuf for alert_req\n", sc->sc_unit);
|
|
return;
|
|
}
|
|
|
|
msgid = sc->sc_bchan[cd->channelid].msgid = sc->sc_msgid++;
|
|
PLCI = (sc->sc_bchan[cd->channelid].ncci & CAPI_PLCI_MASK);
|
|
|
|
msg = capimsg_setu16(mtod(m, u_int8_t*), m->m_len);
|
|
msg = capimsg_setu16(msg, I4BCAPI_APPLID);
|
|
msg = capimsg_setu16(msg, CAPI_ALERT_REQ);
|
|
msg = capimsg_setu16(msg, msgid);
|
|
|
|
msg = capimsg_setu32(msg, PLCI);
|
|
msg = capimsg_setu8(msg, 0);
|
|
|
|
sc->send(sc, m);
|
|
}
|
|
|
|
void capi_alert_conf(capi_softc_t *sc, struct mbuf *m_in)
|
|
{
|
|
u_int8_t *msg = mtod(m_in, u_int8_t*);
|
|
u_int16_t Info;
|
|
|
|
msg = capimsg_getu16(msg + 12, &Info);
|
|
|
|
if (Info) {
|
|
printf("capi%d: can't alert, info=%04x\n", sc->sc_unit, Info);
|
|
}
|
|
}
|
|
|
|
/*
|
|
// Outgoing call setup:
|
|
// --------------------
|
|
//
|
|
// CAPI_CONNECT_REQ -->
|
|
// <-- CAPI_CONNECT_CONF
|
|
// (notify Layer 4)
|
|
// <-- CAPI_CONNECT_ACTIVE_IND
|
|
// CAPI_CONNECT_ACTIVE_RESP -->
|
|
// CAPI_CONNECT_B3_REQ -->
|
|
// <-- CAPI_CONNECT_B3_CONF
|
|
// <-- CAPI_CONNECT_B3_ACTIVE_IND
|
|
// CAPI_CONNECT_B3_ACTIVE_RESP -->
|
|
// (notify Layer 4)
|
|
*/
|
|
|
|
void capi_connect_req(capi_softc_t *sc, call_desc_t *cd)
|
|
{
|
|
struct mbuf *m;
|
|
u_int8_t *msg;
|
|
u_int16_t msgid;
|
|
int slen = strlen(cd->src_telno);
|
|
int dlen = strlen(cd->dst_telno);
|
|
|
|
m = i4b_Dgetmbuf(8 + 27 + slen + dlen);
|
|
if (!m) {
|
|
printf("capi%d: can't get mbuf for connect_req\n", sc->sc_unit);
|
|
return;
|
|
}
|
|
|
|
cd->crflag = CRF_ORIG;
|
|
|
|
sc->sc_bchan[cd->channelid].cdid = cd->cdid;
|
|
sc->sc_bchan[cd->channelid].bprot = cd->bprot;
|
|
sc->sc_bchan[cd->channelid].state = B_CONNECT_CONF;
|
|
msgid = sc->sc_bchan[cd->channelid].msgid = sc->sc_msgid++;
|
|
ctrl_desc[sc->ctrl_unit].bch_state[cd->channelid] = BCH_ST_RSVD;
|
|
|
|
msg = capimsg_setu16(mtod(m, u_int8_t*), m->m_len);
|
|
msg = capimsg_setu16(msg, I4BCAPI_APPLID);
|
|
msg = capimsg_setu16(msg, CAPI_CONNECT_REQ);
|
|
msg = capimsg_setu16(msg, msgid);
|
|
|
|
msg = capimsg_setu32(msg, 1); /* Controller */
|
|
|
|
switch (cd->bprot) {
|
|
case BPROT_NONE:
|
|
msg = capimsg_setu16(msg, 0x0010); /* Telephony */
|
|
break;
|
|
|
|
case BPROT_RHDLC:
|
|
msg = capimsg_setu16(msg, 0x0002); /* Unrestricted digital */
|
|
break;
|
|
|
|
default:
|
|
msg = capimsg_setu16(msg, 0x0002); /* Unrestricted digital */
|
|
}
|
|
|
|
msg = capimsg_setu8(msg, 1 + dlen);
|
|
msg = capimsg_setu8(msg, 0x80);
|
|
strncpy(msg, cd->dst_telno, dlen);
|
|
|
|
msg = capimsg_setu8(msg + dlen, 2 + slen);
|
|
msg = capimsg_setu8(msg, 0x00);
|
|
msg = capimsg_setu8(msg, 0x80); /* Presentation and screening indicator */
|
|
strncpy(msg, cd->src_telno, slen);
|
|
|
|
msg = capimsg_setu8(msg + slen, 0); /* Called & */
|
|
msg = capimsg_setu8(msg, 0); /* Calling party subaddress */
|
|
|
|
msg = capimsg_setu8(msg, 15); /* B protocol */
|
|
if (cd->bprot == BPROT_NONE)
|
|
msg = capimsg_setu16(msg, 1); /* B1 protocol = transparent */
|
|
else
|
|
msg = capimsg_setu16(msg, 0); /* B1 protocol = HDLC */
|
|
msg = capimsg_setu16(msg, 1); /* B2 protocol = transparent */
|
|
msg = capimsg_setu16(msg, 0); /* B3 protocol = transparent */
|
|
msg = capimsg_setu8(msg, 0); /* B1 parameters */
|
|
msg = capimsg_setu8(msg, 0); /* B2 parameters */
|
|
msg = capimsg_setu8(msg, 0); /* B3 parameters */
|
|
|
|
msg = capimsg_setu8(msg, 0); /* Bearer Capability */
|
|
msg = capimsg_setu8(msg, 0); /* Low Layer Compatibility */
|
|
msg = capimsg_setu8(msg, 0); /* High Layer Compatibility */
|
|
msg = capimsg_setu8(msg, 0); /* Additional Info */
|
|
|
|
sc->send(sc, m);
|
|
}
|
|
|
|
void capi_connect_conf(capi_softc_t *sc, struct mbuf *m_in)
|
|
{
|
|
u_int8_t *msg = mtod(m_in, u_int8_t*);
|
|
call_desc_t *cd;
|
|
u_int16_t msgid;
|
|
u_int32_t PLCI;
|
|
u_int16_t Info;
|
|
int bch;
|
|
|
|
msg = capimsg_getu16(msg + 6, &msgid);
|
|
msg = capimsg_getu32(msg, &PLCI);
|
|
msg = capimsg_getu16(msg, &Info);
|
|
|
|
for (bch = 0; bch < sc->sc_nbch; bch++)
|
|
if ((sc->sc_bchan[bch].state == B_CONNECT_CONF) &&
|
|
(sc->sc_bchan[bch].msgid == msgid))
|
|
break;
|
|
|
|
if ((bch == sc->sc_nbch) ||
|
|
(cd = cd_by_cdid(sc->sc_bchan[bch].cdid)) == NULL) {
|
|
printf("capi%d: can't find channel for connect_conf PLCI %x\n",
|
|
sc->sc_unit, PLCI);
|
|
return;
|
|
}
|
|
|
|
if (Info == 0) {
|
|
sc->sc_bchan[bch].state = B_CONNECT_ACTIVE_IND;
|
|
sc->sc_bchan[bch].ncci = PLCI;
|
|
|
|
i4b_l4_proceeding_ind(cd);
|
|
|
|
} else {
|
|
SET_CAUSE_TV(cd->cause_out, CAUSET_I4B, CAUSE_I4B_L1ERROR);
|
|
i4b_l4_disconnect_ind(cd);
|
|
freecd_by_cd(cd);
|
|
|
|
sc->sc_bchan[bch].state = B_FREE;
|
|
ctrl_desc[sc->ctrl_unit].bch_state[bch] = BCH_ST_FREE;
|
|
|
|
printf("capi%d: can't connect out, info=%04x\n", sc->sc_unit, Info);
|
|
}
|
|
}
|
|
|
|
void capi_connect_active_ind(capi_softc_t *sc, struct mbuf *m_in)
|
|
{
|
|
struct mbuf *m = i4b_Dgetmbuf(8 + 4);
|
|
u_int8_t *msg = mtod(m_in, u_int8_t*);
|
|
call_desc_t *cd;
|
|
u_int16_t applid, msgid;
|
|
u_int32_t PLCI;
|
|
int bch;
|
|
|
|
if (!m) {
|
|
printf("capi%d: can't get mbuf for active_ind\n", sc->sc_unit);
|
|
return;
|
|
}
|
|
|
|
msg = capimsg_getu16(msg + 2, &applid);
|
|
msg = capimsg_getu16(msg + 2, &msgid);
|
|
msg = capimsg_getu32(msg, &PLCI);
|
|
|
|
for (bch = 0; bch < sc->sc_nbch; bch++)
|
|
if ((sc->sc_bchan[bch].state == B_CONNECT_ACTIVE_IND) &&
|
|
(sc->sc_bchan[bch].ncci == PLCI))
|
|
break;
|
|
|
|
if ((bch == sc->sc_nbch) ||
|
|
(cd = cd_by_cdid(sc->sc_bchan[bch].cdid)) == NULL) {
|
|
printf("capi%d: can't find channel for active_resp, PLCI %x\n",
|
|
sc->sc_unit, PLCI);
|
|
return;
|
|
}
|
|
|
|
msg = capimsg_setu16(mtod(m, u_int8_t*), m->m_len);
|
|
msg = capimsg_setu16(msg, applid);
|
|
msg = capimsg_setu16(msg, CAPI_CONNECT_ACTIVE_RESP);
|
|
msg = capimsg_setu16(msg, msgid);
|
|
|
|
msg = capimsg_setu32(msg, PLCI);
|
|
|
|
sc->send(sc, m);
|
|
|
|
if (cd->crflag == CRF_ORIG) {
|
|
capi_connect_b3_req(sc, cd);
|
|
|
|
} else {
|
|
sc->sc_bchan[bch].state = B_CONNECT_B3_IND;
|
|
}
|
|
}
|
|
|
|
void capi_connect_b3_req(capi_softc_t *sc, call_desc_t *cd)
|
|
{
|
|
struct mbuf *m = i4b_Dgetmbuf(8 + 5);
|
|
u_int8_t *msg;
|
|
u_int16_t msgid;
|
|
u_int32_t PLCI;
|
|
|
|
if (!m) {
|
|
printf("capi%d: can't get mbuf for connect_b3_req\n", sc->sc_unit);
|
|
return;
|
|
}
|
|
|
|
sc->sc_bchan[cd->channelid].state = B_CONNECT_B3_CONF;
|
|
msgid = sc->sc_bchan[cd->channelid].msgid = sc->sc_msgid++;
|
|
PLCI = (sc->sc_bchan[cd->channelid].ncci & CAPI_PLCI_MASK);
|
|
|
|
msg = capimsg_setu16(mtod(m, u_int8_t*), m->m_len);
|
|
msg = capimsg_setu16(msg, I4BCAPI_APPLID);
|
|
msg = capimsg_setu16(msg, CAPI_CONNECT_B3_REQ);
|
|
msg = capimsg_setu16(msg, msgid);
|
|
|
|
msg = capimsg_setu32(msg, PLCI);
|
|
msg = capimsg_setu8(msg, 0); /* NCPI */
|
|
|
|
sc->send(sc, m);
|
|
}
|
|
|
|
void capi_connect_b3_conf(capi_softc_t *sc, struct mbuf *m_in)
|
|
{
|
|
u_int8_t *msg = mtod(m_in, u_int8_t*);
|
|
call_desc_t *cd;
|
|
u_int16_t msgid;
|
|
u_int32_t NCCI;
|
|
u_int16_t Info;
|
|
int bch;
|
|
|
|
msg = capimsg_getu16(msg + 6, &msgid);
|
|
msg = capimsg_getu32(msg, &NCCI);
|
|
msg = capimsg_getu16(msg, &Info);
|
|
|
|
for (bch = 0; bch < sc->sc_nbch; bch++)
|
|
if ((sc->sc_bchan[bch].state == B_CONNECT_B3_CONF) &&
|
|
(sc->sc_bchan[bch].ncci == (NCCI & CAPI_PLCI_MASK)))
|
|
break;
|
|
|
|
if ((bch == sc->sc_nbch) ||
|
|
(cd = cd_by_cdid(sc->sc_bchan[bch].cdid)) == NULL) {
|
|
printf("capi%d: can't find channel for connect_b3_conf NCCI %x\n",
|
|
sc->sc_unit, NCCI);
|
|
return;
|
|
}
|
|
|
|
if (Info == 0) {
|
|
sc->sc_bchan[bch].ncci = NCCI;
|
|
sc->sc_bchan[bch].state = B_CONNECT_B3_ACTIVE_IND;
|
|
|
|
} else {
|
|
SET_CAUSE_TV(cd->cause_in, CAUSET_I4B, CAUSE_I4B_OOO); /* XXX */
|
|
i4b_l4_disconnect_ind(cd);
|
|
freecd_by_cd(cd);
|
|
|
|
ctrl_desc[sc->ctrl_unit].bch_state[bch] = BCH_ST_RSVD;
|
|
|
|
printf("capi%d: can't connect_b3 out, info=%04x\n", sc->sc_unit, Info);
|
|
|
|
capi_disconnect_req(sc, cd);
|
|
}
|
|
}
|
|
|
|
void capi_connect_b3_active_ind(capi_softc_t *sc, struct mbuf *m_in)
|
|
{
|
|
struct mbuf *m = i4b_Dgetmbuf(8 + 4);
|
|
u_int8_t *msg = mtod(m_in, u_int8_t*);
|
|
call_desc_t *cd;
|
|
u_int16_t applid, msgid;
|
|
u_int32_t NCCI;
|
|
int bch;
|
|
|
|
if (!m) {
|
|
printf("capi%d: can't get mbuf for b3_active_ind\n", sc->sc_unit);
|
|
return;
|
|
}
|
|
|
|
msg = capimsg_getu16(msg + 2, &applid);
|
|
msg = capimsg_getu16(msg + 2, &msgid);
|
|
msg = capimsg_getu32(msg, &NCCI);
|
|
|
|
for (bch = 0; bch < sc->sc_nbch; bch++)
|
|
if ((sc->sc_bchan[bch].state == B_CONNECT_B3_ACTIVE_IND) &&
|
|
(sc->sc_bchan[bch].ncci == NCCI))
|
|
break;
|
|
|
|
if ((bch == sc->sc_nbch) ||
|
|
(cd = cd_by_cdid(sc->sc_bchan[bch].cdid)) == NULL) {
|
|
printf("capi%d: can't find channel for b3_active_resp NCCI %x\n",
|
|
sc->sc_unit, NCCI);
|
|
return;
|
|
}
|
|
|
|
msg = capimsg_setu16(mtod(m, u_int8_t*), m->m_len);
|
|
msg = capimsg_setu16(msg, I4BCAPI_APPLID);
|
|
msg = capimsg_setu16(msg, CAPI_CONNECT_B3_ACTIVE_RESP);
|
|
msg = capimsg_setu16(msg, msgid);
|
|
|
|
msg = capimsg_setu32(msg, NCCI);
|
|
|
|
sc->send(sc, m);
|
|
|
|
sc->sc_bchan[bch].state = B_CONNECTED;
|
|
i4b_l4_connect_active_ind(cd);
|
|
}
|
|
|
|
/*
|
|
// Incoming call setup:
|
|
// --------------------
|
|
//
|
|
// <-- CAPI_CONNECT_IND
|
|
// (consult Layer 4)
|
|
// CAPI_CONNECT_RESP -->
|
|
// <-- CAPI_CONNECT_ACTIVE_IND
|
|
// CAPI_CONNECT_ACTIVE_RESP -->
|
|
// <-- CAPI_CONNECT_B3_IND
|
|
// CAPI_CONNECT_B3_RESP -->
|
|
// <-- CAPI_CONNECT_B3_ACTIVE_IND
|
|
// CAPI_CONNECT_B3_ACTIVE_RESP -->
|
|
// (notify Layer 4)
|
|
*/
|
|
|
|
void capi_connect_ind(capi_softc_t *sc, struct mbuf *m_in)
|
|
{
|
|
u_int8_t *msg = mtod(m_in, u_int8_t*);
|
|
call_desc_t *cd;
|
|
u_int16_t applid, msgid;
|
|
u_int32_t PLCI;
|
|
u_int16_t CIP;
|
|
u_int8_t x, y, z;
|
|
int bch;
|
|
|
|
if ((cd = reserve_cd()) == NULL) {
|
|
printf("capi%d: can't get cd for connect_ind\n", sc->sc_unit);
|
|
return;
|
|
}
|
|
|
|
cd->controller = sc->ctrl_unit;
|
|
cd->channelexcl = FALSE;
|
|
|
|
for (bch = 0; bch < sc->sc_nbch; bch++)
|
|
if (sc->sc_bchan[bch].state == B_FREE) break;
|
|
sc->sc_bchan[bch].state = B_CONNECT_IND;
|
|
cd->channelid = bch; /* XXX CHAN_ANY XXX */
|
|
|
|
cd->crflag = CRF_DEST;
|
|
cd->cr = get_rand_cr(sc->sc_unit);
|
|
cd->scr_ind = SCR_NONE;
|
|
cd->prs_ind = PRS_NONE;
|
|
cd->bprot = BPROT_NONE;
|
|
cd->ilt = NULL;
|
|
cd->dlt = NULL;
|
|
cd->display[0] = '\0';
|
|
cd->datetime[0] = '\0';
|
|
|
|
msg = capimsg_getu16(msg + 2, &applid);
|
|
msg = capimsg_getu16(msg + 2, &msgid);
|
|
msg = capimsg_getu32(msg, &PLCI);
|
|
msg = capimsg_getu16(msg, &CIP);
|
|
|
|
cd->event = (int) msgid; /* XXX overload */
|
|
cd->Q931state = (int) PLCI; /* XXX overload */
|
|
|
|
switch (CIP) {
|
|
case 0x0010:
|
|
case 0x0001: cd->bprot = BPROT_NONE; break;
|
|
case 0x0002: cd->bprot = BPROT_RHDLC; break;
|
|
default:
|
|
NDBGL4(L4_CAPIDBG, "capi%d: unknown CIP = %d", sc->sc_unit, CIP);
|
|
cd->bprot = BPROT_NONE;
|
|
}
|
|
|
|
msg = capimsg_getu8(msg, &x); /* Called party struct len */
|
|
if (x) {
|
|
msg = capimsg_getu8(msg, &y); /* Numbering plan */
|
|
z = x - 1;
|
|
if (z >= TELNO_MAX) z = (TELNO_MAX-1);
|
|
strncpy(cd->dst_telno, msg, z);
|
|
msg += x;
|
|
x = z;
|
|
}
|
|
cd->dst_telno[x] = '\0';
|
|
|
|
msg = capimsg_getu8(msg, &x); /* Calling party struct len */
|
|
if (x) {
|
|
msg = capimsg_getu8(msg, &y); /* Numbering plan */
|
|
msg = capimsg_getu8(msg, &y); /* Screening/Presentation */
|
|
if ((y & 0x80) == 0) { /* screening used */
|
|
cd->scr_ind = (y & 3) + SCR_USR_NOSC;
|
|
cd->prs_ind = ((y >> 5) & 3) + PRS_ALLOWED;
|
|
}
|
|
z = x - 2;
|
|
if (z >= TELNO_MAX) z = (TELNO_MAX-1);
|
|
strncpy(cd->src_telno, msg, z);
|
|
msg += x;
|
|
x = z;
|
|
}
|
|
cd->src_telno[x] = '\0';
|
|
|
|
i4b_l4_connect_ind(cd);
|
|
}
|
|
|
|
void capi_connect_resp(capi_softc_t *sc, call_desc_t *cd)
|
|
{
|
|
struct mbuf *m;
|
|
u_int8_t *msg;
|
|
u_int16_t msgid;
|
|
u_int32_t PLCI;
|
|
int dlen = strlen(cd->dst_telno);
|
|
|
|
m = i4b_Dgetmbuf(8 + 21 + dlen);
|
|
if (!m) {
|
|
printf("capi%d: can't get mbuf for connect_resp\n", sc->sc_unit);
|
|
return;
|
|
}
|
|
|
|
msgid = (u_int16_t) cd->event;
|
|
PLCI = (u_int32_t) cd->Q931state;
|
|
|
|
msg = capimsg_setu16(mtod(m, u_int8_t*), m->m_len);
|
|
msg = capimsg_setu16(msg, I4BCAPI_APPLID);
|
|
msg = capimsg_setu16(msg, CAPI_CONNECT_RESP);
|
|
msg = capimsg_setu16(msg, msgid);
|
|
|
|
msg = capimsg_setu32(msg, PLCI);
|
|
|
|
switch (cd->response) {
|
|
case SETUP_RESP_ACCEPT:
|
|
sc->sc_bchan[cd->channelid].cdid = cd->cdid;
|
|
sc->sc_bchan[cd->channelid].ncci = PLCI;
|
|
sc->sc_bchan[cd->channelid].state = B_CONNECT_ACTIVE_IND;
|
|
ctrl_desc[sc->ctrl_unit].bch_state[cd->channelid] = BCH_ST_USED;
|
|
msg = capimsg_setu16(msg, 0); /* Accept the call */
|
|
break;
|
|
|
|
case SETUP_RESP_REJECT:
|
|
sc->sc_bchan[cd->channelid].state = B_FREE;
|
|
ctrl_desc[sc->ctrl_unit].bch_state[cd->channelid] = BCH_ST_FREE;
|
|
msg = capimsg_setu16(msg, 2); /* Reject, normal call clearing */
|
|
break;
|
|
|
|
case SETUP_RESP_DNTCRE:
|
|
sc->sc_bchan[cd->channelid].state = B_FREE;
|
|
ctrl_desc[sc->ctrl_unit].bch_state[cd->channelid] = BCH_ST_FREE;
|
|
if (sc->sc_nbch == 30) {
|
|
/* With PRI, we can't really ignore calls -- normal clearing */
|
|
msg = capimsg_setu16(msg, (0x3480|CAUSE_Q850_NCCLR));
|
|
} else {
|
|
msg = capimsg_setu16(msg, 1); /* Ignore */
|
|
}
|
|
break;
|
|
|
|
default:
|
|
sc->sc_bchan[cd->channelid].state = B_FREE;
|
|
ctrl_desc[sc->ctrl_unit].bch_state[cd->channelid] = BCH_ST_FREE;
|
|
msg = capimsg_setu16(msg, (0x3480|CAUSE_Q850_CALLREJ));
|
|
}
|
|
|
|
msg = capimsg_setu8(msg, 15); /* B protocol */
|
|
if (cd->bprot == BPROT_NONE)
|
|
msg = capimsg_setu16(msg, 1); /* B1 protocol = transparent */
|
|
else
|
|
msg = capimsg_setu16(msg, 0); /* B1 protocol = HDLC */
|
|
msg = capimsg_setu16(msg, 1); /* B2 protocol = transparent */
|
|
msg = capimsg_setu16(msg, 0); /* B3 protocol = transparent */
|
|
msg = capimsg_setu8(msg, 0); /* B1 parameters */
|
|
msg = capimsg_setu8(msg, 0); /* B2 parameters */
|
|
msg = capimsg_setu8(msg, 0); /* B3 parameters */
|
|
|
|
msg = capimsg_setu8(msg, 1 + dlen);
|
|
msg = capimsg_setu8(msg, 0x80); /* Numbering plan */
|
|
strncpy(msg, cd->dst_telno, dlen);
|
|
msg = capimsg_setu8(msg + dlen, 0); /* Connected subaddress */
|
|
msg = capimsg_setu8(msg, 0); /* Low Layer Compatibility */
|
|
msg = capimsg_setu8(msg, 0); /* Additional Info */
|
|
|
|
sc->send(sc, m);
|
|
}
|
|
|
|
void capi_connect_b3_ind(capi_softc_t *sc, struct mbuf *m_in)
|
|
{
|
|
struct mbuf *m = i4b_Dgetmbuf(8 + 7);
|
|
u_int8_t *msg = mtod(m_in, u_int8_t*);
|
|
u_int16_t applid, msgid;
|
|
u_int32_t NCCI;
|
|
int bch;
|
|
|
|
if (!m) {
|
|
printf("capi%d: can't get mbuf for connect_b3_resp\n", sc->sc_unit);
|
|
return;
|
|
}
|
|
|
|
msg = capimsg_getu16(msg + 2, &applid);
|
|
msg = capimsg_getu16(msg + 2, &msgid);
|
|
msg = capimsg_getu32(msg, &NCCI);
|
|
|
|
for (bch = 0; bch < sc->sc_nbch; bch++)
|
|
if ((sc->sc_bchan[bch].state == B_CONNECT_B3_IND) &&
|
|
(sc->sc_bchan[bch].ncci == (NCCI & CAPI_PLCI_MASK)))
|
|
break;
|
|
|
|
msg = capimsg_setu16(mtod(m, u_int8_t*), m->m_len);
|
|
msg = capimsg_setu16(msg, applid);
|
|
msg = capimsg_setu16(msg, CAPI_CONNECT_B3_RESP);
|
|
msg = capimsg_setu16(msg, msgid);
|
|
|
|
msg = capimsg_setu32(msg, NCCI);
|
|
|
|
if (bch == sc->sc_nbch) {
|
|
printf("capi%d: can't get cd for connect_b3_resp NCCI %x\n",
|
|
sc->sc_unit, NCCI);
|
|
msg = capimsg_setu16(msg, 8); /* Reject, destination OOO */
|
|
|
|
} else {
|
|
sc->sc_bchan[bch].ncci = NCCI;
|
|
sc->sc_bchan[bch].state = B_CONNECT_B3_ACTIVE_IND;
|
|
msg = capimsg_setu16(msg, 0); /* Accept */
|
|
}
|
|
|
|
msg = capimsg_setu8(msg, 0); /* NCPI */
|
|
|
|
sc->send(sc, m);
|
|
}
|
|
|
|
/*
|
|
// Data transfer:
|
|
// --------------
|
|
*/
|
|
|
|
void capi_data_b3_req(capi_softc_t *sc, int chan, struct mbuf *m_b3)
|
|
{
|
|
struct mbuf *m = i4b_Dgetmbuf(8 + 14);
|
|
u_int8_t *msg;
|
|
u_int16_t msgid;
|
|
|
|
if (!m) {
|
|
printf("capi%d: can't get mbuf for data_b3_req\n", sc->sc_unit);
|
|
return;
|
|
}
|
|
|
|
msgid = sc->sc_bchan[chan].msgid = sc->sc_msgid++;
|
|
sc->sc_bchan[chan].busy = 1;
|
|
|
|
msg = capimsg_setu16(mtod(m, u_int8_t*), m->m_len);
|
|
msg = capimsg_setu16(msg, I4BCAPI_APPLID);
|
|
msg = capimsg_setu16(msg, CAPI_DATA_B3_REQ);
|
|
msg = capimsg_setu16(msg, msgid);
|
|
|
|
msg = capimsg_setu32(msg, sc->sc_bchan[chan].ncci);
|
|
msg = capimsg_setu32(msg, (u_int32_t) m_b3->m_data); /* Pointer */
|
|
msg = capimsg_setu16(msg, m_b3->m_len);
|
|
msg = capimsg_setu16(msg, chan);
|
|
msg = capimsg_setu16(msg, 0); /* Flags */
|
|
|
|
m->m_next = m_b3;
|
|
|
|
sc->send(sc, m);
|
|
}
|
|
|
|
void capi_data_b3_conf(capi_softc_t *sc, struct mbuf *m_in)
|
|
{
|
|
u_int8_t *msg = mtod(m_in, u_int8_t*);
|
|
u_int32_t NCCI;
|
|
u_int16_t handle;
|
|
u_int16_t Info;
|
|
|
|
msg = capimsg_getu32(msg + 8, &NCCI);
|
|
msg = capimsg_getu16(msg, &handle);
|
|
msg = capimsg_getu16(msg, &Info);
|
|
|
|
if (Info == 0) {
|
|
sc->sc_bchan[handle].busy = 0;
|
|
capi_start_tx(sc, handle);
|
|
|
|
} else {
|
|
printf("capi%d: data_b3_conf NCCI %x handle %x info=%04x\n",
|
|
sc->sc_unit, NCCI, handle, Info);
|
|
}
|
|
}
|
|
|
|
void capi_data_b3_ind(capi_softc_t *sc, struct mbuf *m_in)
|
|
{
|
|
struct mbuf *m = i4b_Dgetmbuf(8 + 6);
|
|
u_int8_t *msg = mtod(m_in, u_int8_t*);
|
|
u_int16_t applid, msgid;
|
|
u_int32_t NCCI;
|
|
u_int16_t handle;
|
|
int bch;
|
|
|
|
if (!m) {
|
|
printf("capi%d: can't get mbuf for data_b3_resp\n", sc->sc_unit);
|
|
return;
|
|
}
|
|
|
|
msg = capimsg_getu16(msg + 2, &applid);
|
|
msg = capimsg_getu16(msg + 2, &msgid);
|
|
msg = capimsg_getu32(msg, &NCCI);
|
|
msg = capimsg_getu16(msg + 6, &handle);
|
|
|
|
for (bch = 0; bch < sc->sc_nbch; bch++)
|
|
if ((sc->sc_bchan[bch].state == B_CONNECTED) &&
|
|
(sc->sc_bchan[bch].ncci == NCCI))
|
|
break;
|
|
|
|
if (bch == sc->sc_nbch) {
|
|
printf("capi%d: can't find channel for data_b3_ind NCCI %x\n",
|
|
sc->sc_unit, NCCI);
|
|
|
|
} else {
|
|
if (sc->sc_bchan[bch].bprot == BPROT_RHDLC) {
|
|
/* HDLC drivers use rx_mbuf */
|
|
|
|
sc->sc_bchan[bch].in_mbuf = m_in->m_next;
|
|
sc->sc_bchan[bch].rxcount += m_in->m_next->m_len;
|
|
m_in->m_next = NULL; /* driver frees */
|
|
|
|
(*sc->sc_bchan[bch].capi_drvr_linktab->bch_rx_data_ready)(
|
|
sc->sc_bchan[bch].capi_drvr_linktab->unit);
|
|
|
|
} else {
|
|
/* Telephony drivers use rx_queue */
|
|
|
|
if (!_IF_QFULL(&sc->sc_bchan[bch].rx_queue)) {
|
|
_IF_ENQUEUE(&sc->sc_bchan[bch].rx_queue, m_in->m_next);
|
|
sc->sc_bchan[bch].rxcount += m_in->m_next->m_len;
|
|
m_in->m_next = NULL; /* driver frees */
|
|
}
|
|
|
|
(*sc->sc_bchan[bch].capi_drvr_linktab->bch_rx_data_ready)(
|
|
sc->sc_bchan[bch].capi_drvr_linktab->unit);
|
|
}
|
|
}
|
|
|
|
msg = capimsg_setu16(mtod(m, u_int8_t*), m->m_len);
|
|
msg = capimsg_setu16(msg, I4BCAPI_APPLID);
|
|
msg = capimsg_setu16(msg, CAPI_DATA_B3_RESP);
|
|
msg = capimsg_setu16(msg, msgid);
|
|
|
|
msg = capimsg_setu32(msg, NCCI);
|
|
msg = capimsg_setu16(msg, handle);
|
|
|
|
sc->send(sc, m);
|
|
}
|
|
|
|
/*
|
|
// Connection teardown:
|
|
// --------------------
|
|
*/
|
|
|
|
void capi_disconnect_req(capi_softc_t *sc, call_desc_t *cd)
|
|
{
|
|
struct mbuf *m = i4b_Dgetmbuf(8 + 5);
|
|
u_int8_t *msg;
|
|
u_int16_t msgid;
|
|
u_int32_t PLCI;
|
|
|
|
if (!m) {
|
|
printf("capi%d: can't get mbuf for disconnect_req\n", sc->sc_unit);
|
|
return;
|
|
}
|
|
|
|
sc->sc_bchan[cd->channelid].state = B_DISCONNECT_CONF;
|
|
ctrl_desc[sc->ctrl_unit].bch_state[cd->channelid] = BCH_ST_RSVD;
|
|
msgid = sc->sc_bchan[cd->channelid].msgid = sc->sc_msgid++;
|
|
PLCI = (sc->sc_bchan[cd->channelid].ncci & CAPI_PLCI_MASK);
|
|
|
|
msg = capimsg_setu16(mtod(m, u_int8_t*), m->m_len);
|
|
msg = capimsg_setu16(msg, I4BCAPI_APPLID);
|
|
msg = capimsg_setu16(msg, CAPI_DISCONNECT_REQ);
|
|
msg = capimsg_setu16(msg, msgid);
|
|
|
|
msg = capimsg_setu32(msg, PLCI);
|
|
msg = capimsg_setu8(msg, 0); /* Additional Info */
|
|
|
|
sc->send(sc, m);
|
|
}
|
|
|
|
void capi_disconnect_conf(capi_softc_t *sc, struct mbuf *m_in)
|
|
{
|
|
u_int8_t *msg = mtod(m_in, u_int8_t*);
|
|
call_desc_t *cd;
|
|
u_int32_t PLCI;
|
|
int bch;
|
|
|
|
msg = capimsg_getu32(msg + 8, &PLCI);
|
|
|
|
for (bch = 0; bch < sc->sc_nbch; bch++)
|
|
if ((sc->sc_bchan[bch].state == B_DISCONNECT_CONF) &&
|
|
((sc->sc_bchan[bch].ncci & CAPI_PLCI_MASK) == PLCI))
|
|
break;
|
|
|
|
if (bch == sc->sc_nbch) {
|
|
printf("capi%d: can't find channel for disconnect_conf PLCI %x\n",
|
|
sc->sc_unit, PLCI);
|
|
return;
|
|
}
|
|
|
|
cd = cd_by_cdid(sc->sc_bchan[bch].cdid);
|
|
if (!cd) {
|
|
printf("capi%d: can't find cd for disconnect_conf PLCI %x\n",
|
|
sc->sc_unit, PLCI);
|
|
} else {
|
|
i4b_l4_disconnect_ind(cd);
|
|
freecd_by_cd(cd);
|
|
}
|
|
|
|
sc->sc_bchan[bch].state = B_FREE;
|
|
ctrl_desc[sc->ctrl_unit].bch_state[bch] = BCH_ST_FREE;
|
|
}
|
|
|
|
void capi_disconnect_b3_ind(capi_softc_t *sc, struct mbuf *m_in)
|
|
{
|
|
struct mbuf *m = i4b_Dgetmbuf(8 + 4);
|
|
u_int8_t *msg = mtod(m_in, u_int8_t*);
|
|
u_int16_t applid, msgid;
|
|
u_int32_t NCCI;
|
|
|
|
if (!m) {
|
|
printf("capi%d: can't get mbuf for disconnect_b3_resp\n", sc->sc_unit);
|
|
return;
|
|
}
|
|
|
|
msg = capimsg_getu16(msg + 2, &applid);
|
|
msg = capimsg_getu16(msg + 2, &msgid);
|
|
msg = capimsg_getu32(msg, &NCCI);
|
|
|
|
/* XXX update bchan state? XXX */
|
|
|
|
msg = capimsg_setu16(mtod(m, u_int8_t*), m->m_len);
|
|
msg = capimsg_setu16(msg, applid);
|
|
msg = capimsg_setu16(msg, CAPI_DISCONNECT_B3_RESP);
|
|
msg = capimsg_setu16(msg, msgid);
|
|
|
|
msg = capimsg_setu32(msg, NCCI);
|
|
|
|
sc->send(sc, m);
|
|
}
|
|
|
|
void capi_disconnect_ind(capi_softc_t *sc, struct mbuf *m_in)
|
|
{
|
|
struct mbuf *m = i4b_Dgetmbuf(8 + 4);
|
|
u_int8_t *msg = mtod(m_in, u_int8_t*);
|
|
call_desc_t *cd;
|
|
u_int16_t applid, msgid;
|
|
u_int32_t PLCI;
|
|
u_int16_t Reason;
|
|
int bch;
|
|
|
|
if (!m) {
|
|
printf("capi%d: can't get mbuf for disconnect_resp\n", sc->sc_unit);
|
|
return;
|
|
}
|
|
|
|
msg = capimsg_getu16(msg + 2, &applid);
|
|
msg = capimsg_getu16(msg + 2, &msgid);
|
|
msg = capimsg_getu32(msg, &PLCI);
|
|
msg = capimsg_getu16(msg, &Reason);
|
|
|
|
for (bch = 0; bch < sc->sc_nbch; bch++)
|
|
if ((sc->sc_bchan[bch].state != B_FREE) &&
|
|
((sc->sc_bchan[bch].ncci & CAPI_PLCI_MASK) == PLCI))
|
|
break;
|
|
|
|
if (bch < sc->sc_nbch) {
|
|
/* We may not have a bchan assigned if call was ignored. */
|
|
|
|
cd = cd_by_cdid(sc->sc_bchan[bch].cdid);
|
|
sc->sc_bchan[bch].state = B_DISCONNECT_IND;
|
|
} else cd = NULL;
|
|
|
|
if (cd) {
|
|
if ((Reason & 0xff00) == 0x3400) {
|
|
SET_CAUSE_TV(cd->cause_in, CAUSET_Q850, (Reason & 0x7f));
|
|
} else {
|
|
SET_CAUSE_TV(cd->cause_in, CAUSET_I4B, CAUSE_I4B_NORMAL);
|
|
}
|
|
|
|
i4b_l4_disconnect_ind(cd);
|
|
freecd_by_cd(cd);
|
|
|
|
sc->sc_bchan[bch].state = B_FREE;
|
|
ctrl_desc[sc->ctrl_unit].bch_state[bch] = BCH_ST_FREE;
|
|
}
|
|
|
|
msg = capimsg_setu16(mtod(m, u_int8_t*), m->m_len);
|
|
msg = capimsg_setu16(msg, applid);
|
|
msg = capimsg_setu16(msg, CAPI_DISCONNECT_RESP);
|
|
msg = capimsg_setu16(msg, msgid);
|
|
|
|
msg = capimsg_setu32(msg, PLCI);
|
|
|
|
sc->send(sc, m);
|
|
}
|