........ r369001 | kpfleming | 2012-06-15 10:56:08 -0500 (Fri, 15 Jun 2012) | 11 lines Add support-level indications to many more source files. Since we now have tools that scan through the source tree looking for files with specific support levels, we need to ensure that every file that is a component of a 'core' or 'extended' module (or the main Asterisk binary) is explicitly marked with its support level. This patch adds support-level indications to many more source files in tree, but avoids adding them to third-party libraries that are included in the tree and to source files that don't end up involved in Asterisk itself. ........ r369002 | kpfleming | 2012-06-15 10:57:14 -0500 (Fri, 15 Jun 2012) | 3 lines Add a script to enable finding source files without support-levels defined. ........ Merged revisions 369001-369002 from http://svn.asterisk.org/svn/asterisk/branches/1.8 ........ Merged revisions 369005 from http://svn.asterisk.org/svn/asterisk/branches/10 git-svn-id: https://origsvn.digium.com/svn/asterisk/trunk@369013 65c4cc65-6c06-0410-ace0-fbb531ad65f3
1416 lines
32 KiB
C
1416 lines
32 KiB
C
/*
|
|
* Chan_Misdn -- Channel Driver for Asterisk
|
|
*
|
|
* Interface to mISDN
|
|
*
|
|
* Copyright (C) 2005, Christian Richter
|
|
*
|
|
* Christian Richter <crich@beronet.com>
|
|
*
|
|
* heaviliy patched from jollys ie.cpp, jolly gave me ALL
|
|
* rights for this code, i can even have my own copyright on it.
|
|
*
|
|
* This program is free software, distributed under the terms of
|
|
* the GNU General Public License
|
|
*/
|
|
|
|
/*! \file
|
|
* \brief Interface to mISDN
|
|
* \author Christian Richter <crich@beronet.com>
|
|
*/
|
|
|
|
/*
|
|
the pointer of enc_ie_* always points to the IE itself
|
|
if qi is not NULL (TE-mode), offset is set
|
|
*/
|
|
|
|
/*** MODULEINFO
|
|
<support_level>extended</support_level>
|
|
***/
|
|
|
|
#include "asterisk.h"
|
|
|
|
#include <string.h>
|
|
|
|
#include <mISDNuser/mISDNlib.h>
|
|
#include <mISDNuser/isdn_net.h>
|
|
#include <mISDNuser/l3dss1.h>
|
|
#include <mISDNuser/net_l3.h>
|
|
#include "asterisk/localtime.h"
|
|
|
|
|
|
|
|
#define MISDN_IE_DEBG 0
|
|
|
|
/* support stuff */
|
|
static void strnncpy(char *dest, const char *src, size_t len, size_t dst_len)
|
|
{
|
|
if (len > dst_len-1)
|
|
len = dst_len-1;
|
|
strncpy(dest, src, len);
|
|
dest[len] = '\0';
|
|
}
|
|
|
|
|
|
/* IE_COMPLETE */
|
|
static void enc_ie_complete(unsigned char **ntmode, msg_t *msg, int complete, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
unsigned char *p;
|
|
Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
|
|
|
|
if (complete<0 || complete>1)
|
|
{
|
|
printf("%s: ERROR: complete(%d) is out of range.\n", __FUNCTION__, complete);
|
|
return;
|
|
}
|
|
|
|
if (complete)
|
|
if (MISDN_IE_DEBG) printf(" complete=%d\n", complete);
|
|
|
|
if (complete)
|
|
{
|
|
p = msg_put(msg, 1);
|
|
if (nt)
|
|
{
|
|
*ntmode = p;
|
|
} else
|
|
qi->QI_ELEMENT(sending_complete) = p - (unsigned char *)qi - sizeof(Q931_info_t);
|
|
|
|
p[0] = IE_COMPLETE;
|
|
}
|
|
}
|
|
|
|
static void dec_ie_complete(unsigned char *p, Q931_info_t *qi, int *complete, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
*complete = 0;
|
|
if (!nt)
|
|
{
|
|
if (qi->QI_ELEMENT(sending_complete))
|
|
*complete = 1;
|
|
} else
|
|
if (p)
|
|
*complete = 1;
|
|
|
|
if (*complete)
|
|
if (MISDN_IE_DEBG) printf(" complete=%d\n", *complete);
|
|
}
|
|
|
|
|
|
/* IE_BEARER */
|
|
static void enc_ie_bearer(unsigned char **ntmode, msg_t *msg, int coding, int capability, int mode, int rate, int multi, int user, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
unsigned char *p;
|
|
Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
|
|
int l;
|
|
|
|
if (coding<0 || coding>3)
|
|
{
|
|
printf("%s: ERROR: coding(%d) is out of range.\n", __FUNCTION__, coding);
|
|
return;
|
|
}
|
|
if (capability<0 || capability>31)
|
|
{
|
|
printf("%s: ERROR: capability(%d) is out of range.\n", __FUNCTION__, capability);
|
|
return;
|
|
}
|
|
if (mode<0 || mode>3)
|
|
{
|
|
printf("%s: ERROR: mode(%d) is out of range.\n", __FUNCTION__, mode);
|
|
return;
|
|
}
|
|
if (rate<0 || rate>31)
|
|
{
|
|
printf("%s: ERROR: rate(%d) is out of range.\n", __FUNCTION__, rate);
|
|
return;
|
|
}
|
|
if (multi>127)
|
|
{
|
|
printf("%s: ERROR: multi(%d) is out of range.\n", __FUNCTION__, multi);
|
|
return;
|
|
}
|
|
if (user>31)
|
|
{
|
|
printf("%s: ERROR: user L1(%d) is out of range.\n", __FUNCTION__, rate);
|
|
return;
|
|
}
|
|
if (rate!=24 && multi>=0)
|
|
{
|
|
printf("%s: WARNING: multi(%d) is only possible if rate(%d) would be 24.\n", __FUNCTION__, multi, rate);
|
|
multi = -1;
|
|
}
|
|
|
|
if (MISDN_IE_DEBG) printf(" coding=%d capability=%d mode=%d rate=%d multi=%d user=%d\n", coding, capability, mode, rate, multi, user);
|
|
|
|
l = 2 + (multi>=0) + (user>=0);
|
|
p = msg_put(msg, l+2);
|
|
if (nt)
|
|
*ntmode = p+1;
|
|
else
|
|
qi->QI_ELEMENT(bearer_capability) = p - (unsigned char *)qi - sizeof(Q931_info_t);
|
|
p[0] = IE_BEARER;
|
|
p[1] = l;
|
|
p[2] = 0x80 + (coding<<5) + capability;
|
|
p[3] = 0x80 + (mode<<5) + rate;
|
|
if (multi >= 0)
|
|
p[4] = 0x80 + multi;
|
|
if (user >= 0)
|
|
p[4+(multi>=0)] = 0xa0 + user;
|
|
}
|
|
|
|
static void dec_ie_bearer(unsigned char *p, Q931_info_t *qi, int *coding, int *capability, int *mode, int *rate, int *multi, int *user,
|
|
int *async, int *urate, int *stopbits, int *dbits, int *parity, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
int octet;
|
|
*coding = -1;
|
|
*capability = -1;
|
|
*mode = -1;
|
|
*rate = -1;
|
|
*multi = -1;
|
|
*user = -1;
|
|
*async = -1;
|
|
*urate = -1;
|
|
*stopbits = -1;
|
|
*dbits = -1;
|
|
*parity = -1;
|
|
|
|
if (!nt)
|
|
{
|
|
p = NULL;
|
|
#ifdef LLC_SUPPORT
|
|
if (qi->QI_ELEMENT(llc)) {
|
|
|
|
p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->QI_ELEMENT(llc) + 1;
|
|
}
|
|
#endif
|
|
if (qi->QI_ELEMENT(bearer_capability))
|
|
p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->QI_ELEMENT(bearer_capability) + 1;
|
|
}
|
|
if (!p)
|
|
return;
|
|
|
|
if (p[0] < 2)
|
|
{
|
|
printf("%s: ERROR: IE too short (%d).\n", __FUNCTION__, p[0]);
|
|
return;
|
|
}
|
|
|
|
*coding = (p[1]&0x60) >> 5;
|
|
*capability = p[1] & 0x1f;
|
|
octet = 2;
|
|
if (!(p[1] & 0x80))
|
|
octet++;
|
|
|
|
if (p[0] < octet)
|
|
goto done;
|
|
|
|
*mode = (p[octet]&0x60) >> 5;
|
|
*rate = p[octet] & 0x1f;
|
|
|
|
octet++;
|
|
|
|
if (p[0] < octet)
|
|
goto done;
|
|
|
|
if (*rate == 0x18) {
|
|
/* Rate multiplier only present if 64Kb/s base rate */
|
|
*multi = p[octet++] & 0x7f;
|
|
}
|
|
|
|
if (p[0] < octet)
|
|
goto done;
|
|
|
|
/* Start L1 info */
|
|
if ((p[octet] & 0x60) == 0x20) {
|
|
*user = p[octet] & 0x1f;
|
|
|
|
if (p[0] <= octet)
|
|
goto done;
|
|
|
|
if (p[octet++] & 0x80)
|
|
goto l2;
|
|
|
|
*async = !!(p[octet] & 0x40);
|
|
/* 0x20 is inband negotiation */
|
|
*urate = p[octet] & 0x1f;
|
|
|
|
if (p[0] <= octet)
|
|
goto done;
|
|
|
|
if (p[octet++] & 0x80)
|
|
goto l2;
|
|
|
|
/* Ignore next byte for now: Intermediate rate, NIC, flow control */
|
|
|
|
if (p[0] <= octet)
|
|
goto done;
|
|
|
|
if (p[octet++] & 0x80)
|
|
goto l2;
|
|
|
|
/* And the next one. Header, multiframe, mode, assignor/ee, negotiation */
|
|
|
|
if (p[0] <= octet)
|
|
goto done;
|
|
|
|
if (~p[octet++] & 0x80)
|
|
goto l2;
|
|
|
|
/* Wheee. V.110 speed information */
|
|
|
|
*stopbits = (p[octet] & 0x60) >> 5;
|
|
*dbits = (p[octet] & 0x18) >> 3;
|
|
*parity = p[octet] & 7;
|
|
|
|
octet++;
|
|
}
|
|
l2: /* Nobody seems to want the rest so we don't bother (yet) */
|
|
done:
|
|
if (MISDN_IE_DEBG) printf(" coding=%d capability=%d mode=%d rate=%d multi=%d user=%d async=%d urate=%d stopbits=%d dbits=%d parity=%d\n", *coding, *capability, *mode, *rate, *multi, *user, *async, *urate, *stopbits, *dbits, *parity);
|
|
}
|
|
|
|
|
|
/* IE_CALL_ID */
|
|
#if 0
|
|
static void enc_ie_call_id(unsigned char **ntmode, msg_t *msg, char *callid, int callid_len, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
unsigned char *p;
|
|
Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
|
|
int l;
|
|
|
|
char debug[25];
|
|
int i;
|
|
|
|
if (!callid || callid_len<=0)
|
|
{
|
|
return;
|
|
}
|
|
if (callid_len>8)
|
|
{
|
|
printf("%s: ERROR: callid_len(%d) is out of range.\n", __FUNCTION__, callid_len);
|
|
return;
|
|
}
|
|
|
|
i = 0;
|
|
while(i < callid_len)
|
|
{
|
|
if (MISDN_IE_DEBG) printf(debug+(i*3), " %02x", callid[i]);
|
|
i++;
|
|
}
|
|
|
|
if (MISDN_IE_DEBG) printf(" callid%s\n", debug);
|
|
|
|
l = callid_len;
|
|
p = msg_put(msg, l+2);
|
|
if (nt)
|
|
*ntmode = p+1;
|
|
else
|
|
qi->QI_ELEMENT(call_id) = p - (unsigned char *)qi - sizeof(Q931_info_t);
|
|
p[0] = IE_CALL_ID;
|
|
p[1] = l;
|
|
memcpy(p+2, callid, callid_len);
|
|
}
|
|
#endif
|
|
|
|
#if 0
|
|
static void dec_ie_call_id(unsigned char *p, Q931_info_t *qi, char *callid, int *callid_len, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
char debug[25];
|
|
int i;
|
|
|
|
*callid_len = -1;
|
|
|
|
if (!nt)
|
|
{
|
|
p = NULL;
|
|
if (qi->QI_ELEMENT(call_id))
|
|
p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->QI_ELEMENT(call_id) + 1;
|
|
}
|
|
if (!p)
|
|
return;
|
|
if (p[0] > 8)
|
|
{
|
|
printf("%s: ERROR: IE too long (%d).\n", __FUNCTION__, p[0]);
|
|
return;
|
|
}
|
|
|
|
*callid_len = p[0];
|
|
memcpy(callid, p+1, *callid_len);
|
|
|
|
i = 0;
|
|
while(i < *callid_len)
|
|
{
|
|
if (MISDN_IE_DEBG) printf(debug+(i*3), " %02x", callid[i]);
|
|
i++;
|
|
}
|
|
|
|
if (MISDN_IE_DEBG) printf(" callid%s\n", debug);
|
|
}
|
|
#endif
|
|
|
|
/* IE_CALLED_PN */
|
|
static void enc_ie_called_pn(unsigned char **ntmode, msg_t *msg, int type, int plan, char *number, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
unsigned char *p;
|
|
Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
|
|
int l;
|
|
|
|
if (type<0 || type>7)
|
|
{
|
|
printf("%s: ERROR: type(%d) is out of range.\n", __FUNCTION__, type);
|
|
return;
|
|
}
|
|
if (plan<0 || plan>15)
|
|
{
|
|
printf("%s: ERROR: plan(%d) is out of range.\n", __FUNCTION__, plan);
|
|
return;
|
|
}
|
|
if (!number[0])
|
|
{
|
|
printf("%s: ERROR: number is not given.\n", __FUNCTION__);
|
|
return;
|
|
}
|
|
|
|
if (MISDN_IE_DEBG) printf(" type=%d plan=%d number='%s'\n", type, plan, number);
|
|
|
|
l = 1+strlen((char *)number);
|
|
p = msg_put(msg, l+2);
|
|
if (nt)
|
|
*ntmode = p+1;
|
|
else
|
|
qi->QI_ELEMENT(called_nr) = p - (unsigned char *)qi - sizeof(Q931_info_t);
|
|
p[0] = IE_CALLED_PN;
|
|
p[1] = l;
|
|
p[2] = 0x80 + (type<<4) + plan;
|
|
strncpy((char *)p+3, (char *)number, strlen((char *)number));
|
|
}
|
|
|
|
static void dec_ie_called_pn(unsigned char *p, Q931_info_t *qi, int *type, int *plan, char *number, size_t number_len, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
*type = -1;
|
|
*plan = -1;
|
|
*number = '\0';
|
|
|
|
if (!nt)
|
|
{
|
|
p = NULL;
|
|
if (qi->QI_ELEMENT(called_nr))
|
|
p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->QI_ELEMENT(called_nr) + 1;
|
|
}
|
|
if (!p)
|
|
return;
|
|
if (p[0] < 2)
|
|
{
|
|
printf("%s: ERROR: IE too short (%d).\n", __FUNCTION__, p[0]);
|
|
return;
|
|
}
|
|
|
|
*type = (p[1]&0x70) >> 4;
|
|
*plan = p[1] & 0xf;
|
|
strnncpy(number, (char *)p+2, p[0]-1, number_len);
|
|
|
|
if (MISDN_IE_DEBG) printf(" type=%d plan=%d number='%s'\n", *type, *plan, number);
|
|
}
|
|
|
|
|
|
/* IE_CALLING_PN */
|
|
static void enc_ie_calling_pn(unsigned char **ntmode, msg_t *msg, int type, int plan, int present, int screen, char *number, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
unsigned char *p;
|
|
Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
|
|
int l;
|
|
|
|
if (type<0 || type>7)
|
|
{
|
|
printf("%s: ERROR: type(%d) is out of range.\n", __FUNCTION__, type);
|
|
return;
|
|
}
|
|
if (plan<0 || plan>15)
|
|
{
|
|
printf("%s: ERROR: plan(%d) is out of range.\n", __FUNCTION__, plan);
|
|
return;
|
|
}
|
|
if (present>3)
|
|
{
|
|
printf("%s: ERROR: present(%d) is out of range.\n", __FUNCTION__, present);
|
|
return;
|
|
}
|
|
if (present >= 0) if (screen<0 || screen>3)
|
|
{
|
|
printf("%s: ERROR: screen(%d) is out of range.\n", __FUNCTION__, screen);
|
|
return;
|
|
}
|
|
|
|
if (MISDN_IE_DEBG) printf(" type=%d plan=%d present=%d screen=%d number='%s'\n", type, plan, present, screen, number);
|
|
|
|
l = 1;
|
|
if (number) if (number[0])
|
|
l += strlen((char *)number);
|
|
if (present >= 0)
|
|
l += 1;
|
|
p = msg_put(msg, l+2);
|
|
if (nt)
|
|
*ntmode = p+1;
|
|
else
|
|
qi->QI_ELEMENT(calling_nr) = p - (unsigned char *)qi - sizeof(Q931_info_t);
|
|
p[0] = IE_CALLING_PN;
|
|
p[1] = l;
|
|
if (present >= 0)
|
|
{
|
|
p[2] = 0x00 + (type<<4) + plan;
|
|
p[3] = 0x80 + (present<<5) + screen;
|
|
if (number) if (number[0])
|
|
strncpy((char *)p+4, (char *)number, strlen((char *)number));
|
|
} else
|
|
{
|
|
p[2] = 0x80 + (type<<4) + plan;
|
|
if (number) if (number[0])
|
|
strncpy((char *)p+3, (char *)number, strlen((char *)number));
|
|
}
|
|
}
|
|
|
|
static void dec_ie_calling_pn(unsigned char *p, Q931_info_t *qi, int *type, int *plan, int *present, int *screen, char *number, size_t number_len, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
*type = -1;
|
|
*plan = -1;
|
|
*present = -1;
|
|
*screen = -1;
|
|
*number = '\0';
|
|
|
|
if (!nt)
|
|
{
|
|
p = NULL;
|
|
if (qi->QI_ELEMENT(calling_nr))
|
|
p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->QI_ELEMENT(calling_nr) + 1;
|
|
}
|
|
if (!p)
|
|
return;
|
|
if (p[0] < 1)
|
|
{
|
|
printf("%s: ERROR: IE too short (%d).\n", __FUNCTION__, p[0]);
|
|
return;
|
|
}
|
|
|
|
*type = (p[1]&0x70) >> 4;
|
|
*plan = p[1] & 0xf;
|
|
if (!(p[1] & 0x80))
|
|
{
|
|
if (p[0] < 2)
|
|
{
|
|
printf("%s: ERROR: IE too short (%d).\n", __FUNCTION__, p[0]);
|
|
return;
|
|
}
|
|
*present = (p[2]&0x60) >> 5;
|
|
*screen = p[2] & 0x3;
|
|
strnncpy(number, (char *)p+3, p[0]-2, number_len);
|
|
} else
|
|
{
|
|
strnncpy(number, (char *)p+2, p[0]-1, number_len);
|
|
/* SPECIAL workarround for IBT software bug */
|
|
/* if (number[0]==0x80) */
|
|
/* strcpy((char *)number, (char *)number+1); */
|
|
}
|
|
|
|
if (MISDN_IE_DEBG) printf(" type=%d plan=%d present=%d screen=%d number='%s'\n", *type, *plan, *present, *screen, number);
|
|
}
|
|
|
|
|
|
/* IE_CONNECTED_PN */
|
|
static void enc_ie_connected_pn(unsigned char **ntmode, msg_t *msg, int type, int plan, int present, int screen, char *number, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
unsigned char *p;
|
|
Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
|
|
int l;
|
|
|
|
if (type<0 || type>7)
|
|
{
|
|
printf("%s: ERROR: type(%d) is out of range.\n", __FUNCTION__, type);
|
|
return;
|
|
}
|
|
if (plan<0 || plan>15)
|
|
{
|
|
printf("%s: ERROR: plan(%d) is out of range.\n", __FUNCTION__, plan);
|
|
return;
|
|
}
|
|
if (present>3)
|
|
{
|
|
printf("%s: ERROR: present(%d) is out of range.\n", __FUNCTION__, present);
|
|
return;
|
|
}
|
|
if (present >= 0) if (screen<0 || screen>3)
|
|
{
|
|
printf("%s: ERROR: screen(%d) is out of range.\n", __FUNCTION__, screen);
|
|
return;
|
|
}
|
|
|
|
if (MISDN_IE_DEBG) printf(" type=%d plan=%d present=%d screen=%d number='%s'\n", type, plan, present, screen, number);
|
|
|
|
l = 1;
|
|
if (number) if (number[0])
|
|
l += strlen((char *)number);
|
|
if (present >= 0)
|
|
l += 1;
|
|
p = msg_put(msg, l+2);
|
|
if (nt)
|
|
*ntmode = p+1;
|
|
else
|
|
qi->QI_ELEMENT(connected_nr) = p - (unsigned char *)qi - sizeof(Q931_info_t);
|
|
p[0] = IE_CONNECT_PN;
|
|
p[1] = l;
|
|
if (present >= 0)
|
|
{
|
|
p[2] = 0x00 + (type<<4) + plan;
|
|
p[3] = 0x80 + (present<<5) + screen;
|
|
if (number) if (number[0])
|
|
strncpy((char *)p+4, (char *)number, strlen((char *)number));
|
|
} else
|
|
{
|
|
p[2] = 0x80 + (type<<4) + plan;
|
|
if (number) if (number[0])
|
|
strncpy((char *)p+3, (char *)number, strlen((char *)number));
|
|
}
|
|
}
|
|
|
|
static void dec_ie_connected_pn(unsigned char *p, Q931_info_t *qi, int *type, int *plan, int *present, int *screen, char *number, size_t number_len, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
*type = -1;
|
|
*plan = -1;
|
|
*present = -1;
|
|
*screen = -1;
|
|
*number = '\0';
|
|
|
|
if (!nt)
|
|
{
|
|
p = NULL;
|
|
if (qi->QI_ELEMENT(connected_nr))
|
|
p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->QI_ELEMENT(connected_nr) + 1;
|
|
}
|
|
if (!p)
|
|
return;
|
|
if (p[0] < 1)
|
|
{
|
|
printf("%s: ERROR: IE too short (%d).\n", __FUNCTION__, p[0]);
|
|
return;
|
|
}
|
|
|
|
*type = (p[1]&0x70) >> 4;
|
|
*plan = p[1] & 0xf;
|
|
if (!(p[1] & 0x80))
|
|
{
|
|
if (p[0] < 2)
|
|
{
|
|
printf("%s: ERROR: IE too short (%d).\n", __FUNCTION__, p[0]);
|
|
return;
|
|
}
|
|
*present = (p[2]&0x60) >> 5;
|
|
*screen = p[2] & 0x3;
|
|
strnncpy(number, (char *)p+3, p[0]-2, number_len);
|
|
} else
|
|
{
|
|
strnncpy(number, (char *)p+2, p[0]-1, number_len);
|
|
}
|
|
|
|
if (MISDN_IE_DEBG) printf(" type=%d plan=%d present=%d screen=%d number='%s'\n", *type, *plan, *present, *screen, number);
|
|
}
|
|
|
|
|
|
/* IE_CAUSE */
|
|
static void enc_ie_cause(unsigned char **ntmode, msg_t *msg, int location, int cause, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
unsigned char *p;
|
|
Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
|
|
int l;
|
|
|
|
if (location<0 || location>7)
|
|
{
|
|
printf("%s: ERROR: location(%d) is out of range.\n", __FUNCTION__, location);
|
|
return;
|
|
}
|
|
if (cause<0 || cause>127)
|
|
{
|
|
printf("%s: ERROR: cause(%d) is out of range.\n", __FUNCTION__, cause);
|
|
return;
|
|
}
|
|
|
|
if (MISDN_IE_DEBG) printf(" location=%d cause=%d\n", location, cause);
|
|
|
|
l = 2;
|
|
p = msg_put(msg, l+2);
|
|
if (nt)
|
|
*ntmode = p+1;
|
|
else
|
|
qi->QI_ELEMENT(cause) = p - (unsigned char *)qi - sizeof(Q931_info_t);
|
|
p[0] = IE_CAUSE;
|
|
p[1] = l;
|
|
p[2] = 0x80 + location;
|
|
p[3] = 0x80 + cause;
|
|
}
|
|
|
|
#if 0
|
|
static void enc_ie_cause_standalone(unsigned char **ntmode, msg_t *msg, int location, int cause, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
unsigned char *p = msg_put(msg, 4);
|
|
Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
|
|
if (ntmode)
|
|
*ntmode = p+1;
|
|
else
|
|
qi->QI_ELEMENT(cause) = p - (unsigned char *)qi - sizeof(Q931_info_t);
|
|
p[0] = IE_CAUSE;
|
|
p[1] = 2;
|
|
p[2] = 0x80 + location;
|
|
p[3] = 0x80 + cause;
|
|
}
|
|
#endif
|
|
|
|
static void dec_ie_cause(unsigned char *p, Q931_info_t *qi, int *location, int *cause, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
*location = -1;
|
|
*cause = -1;
|
|
|
|
if (!nt)
|
|
{
|
|
p = NULL;
|
|
if (qi->QI_ELEMENT(cause))
|
|
p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->QI_ELEMENT(cause) + 1;
|
|
}
|
|
if (!p)
|
|
return;
|
|
if (p[0] < 2)
|
|
{
|
|
printf("%s: ERROR: IE too short (%d).\n", __FUNCTION__, p[0]);
|
|
return;
|
|
}
|
|
|
|
*location = p[1] & 0x0f;
|
|
*cause = p[2] & 0x7f;
|
|
|
|
if (MISDN_IE_DEBG) printf(" location=%d cause=%d\n", *location, *cause);
|
|
}
|
|
|
|
|
|
/* IE_CHANNEL_ID */
|
|
static void enc_ie_channel_id(unsigned char **ntmode, msg_t *msg, int exclusive, int channel, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
unsigned char *p;
|
|
Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
|
|
int l;
|
|
struct misdn_stack *stack=get_stack_by_bc(bc);
|
|
int pri = stack->pri;
|
|
|
|
if (exclusive<0 || exclusive>1)
|
|
{
|
|
printf("%s: ERROR: exclusive(%d) is out of range.\n", __FUNCTION__, exclusive);
|
|
return;
|
|
}
|
|
if ((channel<0 || channel>0xff)
|
|
|| (!pri && (channel>2 && channel<0xff))
|
|
|| (pri && (channel>31 && channel<0xff))
|
|
|| (pri && channel==16))
|
|
{
|
|
printf("%s: ERROR: channel(%d) is out of range.\n", __FUNCTION__, channel);
|
|
return;
|
|
}
|
|
|
|
/* if (MISDN_IE_DEBG) printf(" exclusive=%d channel=%d\n", exclusive, channel); */
|
|
|
|
|
|
if (!pri)
|
|
{
|
|
/* BRI */
|
|
l = 1;
|
|
p = msg_put(msg, l+2);
|
|
if (nt)
|
|
*ntmode = p+1;
|
|
else
|
|
qi->QI_ELEMENT(channel_id) = p - (unsigned char *)qi - sizeof(Q931_info_t);
|
|
p[0] = IE_CHANNEL_ID;
|
|
p[1] = l;
|
|
if (channel == 0xff)
|
|
channel = 3;
|
|
p[2] = 0x80 + (exclusive<<3) + channel;
|
|
/* printf(" exclusive=%d channel=%d\n", exclusive, channel); */
|
|
} else
|
|
{
|
|
/* PRI */
|
|
if (channel == 0) /* no channel */
|
|
return; /* IE not present */
|
|
/* if (MISDN_IE_DEBG) printf("channel = %d\n", channel); */
|
|
if (channel == 0xff) /* any channel */
|
|
{
|
|
l = 1;
|
|
p = msg_put(msg, l+2);
|
|
if (nt)
|
|
*ntmode = p+1;
|
|
else
|
|
qi->QI_ELEMENT(channel_id) = p - (unsigned char *)qi - sizeof(Q931_info_t);
|
|
p[0] = IE_CHANNEL_ID;
|
|
p[1] = l;
|
|
p[2] = 0x80 + 0x20 + 0x03;
|
|
/* if (MISDN_IE_DEBG) printf("%02x\n", p[2]); */
|
|
return; /* end */
|
|
}
|
|
l = 3;
|
|
p = msg_put(msg, l+2);
|
|
if (nt)
|
|
*ntmode = p+1;
|
|
else
|
|
qi->QI_ELEMENT(channel_id) = p - (unsigned char *)qi - sizeof(Q931_info_t);
|
|
p[0] = IE_CHANNEL_ID;
|
|
p[1] = l;
|
|
p[2] = 0x80 + 0x20 + (exclusive<<3) + 0x01;
|
|
p[3] = 0x80 + 3; /* CCITT, Number, B-type */
|
|
p[4] = 0x80 + channel;
|
|
/* if (MISDN_IE_DEBG) printf("%02x %02x %02x\n", p[2], p[3], p[4]); */
|
|
}
|
|
}
|
|
|
|
static void dec_ie_channel_id(unsigned char *p, Q931_info_t *qi, int *exclusive, int *channel, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
struct misdn_stack *stack=get_stack_by_bc(bc);
|
|
int pri =stack->pri;
|
|
|
|
*exclusive = -1;
|
|
*channel = -1;
|
|
|
|
if (!nt)
|
|
{
|
|
p = NULL;
|
|
if (qi->QI_ELEMENT(channel_id))
|
|
p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->QI_ELEMENT(channel_id) + 1;
|
|
}
|
|
if (!p)
|
|
return;
|
|
if (p[0] < 1)
|
|
{
|
|
printf("%s: ERROR: IE too short (%d).\n", __FUNCTION__, p[0]);
|
|
return;
|
|
}
|
|
|
|
if (p[1] & 0x40)
|
|
{
|
|
printf("%s: ERROR: refering to channels of other interfaces is not supported.\n", __FUNCTION__);
|
|
return;
|
|
}
|
|
if (p[1] & 0x04)
|
|
{
|
|
printf("%s: ERROR: using d-channel is not supported.\n", __FUNCTION__);
|
|
return;
|
|
}
|
|
|
|
*exclusive = (p[1]&0x08) >> 3;
|
|
if (!pri)
|
|
{
|
|
/* BRI */
|
|
if (p[1] & 0x20)
|
|
{
|
|
printf("%s: ERROR: extended channel ID with non PRI interface.\n", __FUNCTION__);
|
|
return;
|
|
}
|
|
*channel = p[1] & 0x03;
|
|
if (*channel == 3)
|
|
*channel = 0xff;
|
|
} else
|
|
{
|
|
/* PRI */
|
|
if (p[0] < 1)
|
|
{
|
|
printf("%s: ERROR: IE too short for PRI (%d).\n", __FUNCTION__, p[0]);
|
|
return;
|
|
}
|
|
if (!(p[1] & 0x20))
|
|
{
|
|
printf("%s: ERROR: basic channel ID with PRI interface.\n", __FUNCTION__);
|
|
return;
|
|
}
|
|
if ((p[1]&0x03) == 0x00)
|
|
{
|
|
/* no channel */
|
|
*channel = 0;
|
|
return;
|
|
}
|
|
if ((p[1]&0x03) == 0x03)
|
|
{
|
|
/* any channel */
|
|
*channel = 0xff;
|
|
return;
|
|
}
|
|
if (p[0] < 3)
|
|
{
|
|
printf("%s: ERROR: IE too short for PRI with channel(%d).\n", __FUNCTION__, p[0]);
|
|
return;
|
|
}
|
|
if (p[2] & 0x10)
|
|
{
|
|
printf("%s: ERROR: channel map not supported.\n", __FUNCTION__);
|
|
return;
|
|
}
|
|
*channel = p[3] & 0x7f;
|
|
if ( (*channel<1) | (*channel==16) | (*channel>31))
|
|
{
|
|
printf("%s: ERROR: PRI interface channel out of range (%d).\n", __FUNCTION__, *channel);
|
|
return;
|
|
}
|
|
/* if (MISDN_IE_DEBG) printf("%02x %02x %02x\n", p[1], p[2], p[3]); */
|
|
}
|
|
|
|
if (MISDN_IE_DEBG) printf(" exclusive=%d channel=%d\n", *exclusive, *channel);
|
|
}
|
|
|
|
|
|
/* IE_DATE */
|
|
static void enc_ie_date(unsigned char **ntmode, msg_t *msg, time_t ti, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
unsigned char *p;
|
|
Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
|
|
int l;
|
|
struct timeval tv = { ti, 0 };
|
|
struct ast_tm tm;
|
|
|
|
ast_localtime(&tv, &tm, NULL);
|
|
if (MISDN_IE_DEBG) printf(" year=%d month=%d day=%d hour=%d minute=%d\n", tm.tm_year%100, tm.tm_mon+1, tm.tm_mday, tm.tm_hour, tm.tm_min);
|
|
|
|
l = 5;
|
|
p = msg_put(msg, l+2);
|
|
if (nt)
|
|
*ntmode = p+1;
|
|
else
|
|
qi->QI_ELEMENT(date) = p - (unsigned char *)qi - sizeof(Q931_info_t);
|
|
p[0] = IE_DATE;
|
|
p[1] = l;
|
|
p[2] = tm.tm_year % 100;
|
|
p[3] = tm.tm_mon + 1;
|
|
p[4] = tm.tm_mday;
|
|
p[5] = tm.tm_hour;
|
|
p[6] = tm.tm_min;
|
|
}
|
|
|
|
|
|
/* IE_DISPLAY */
|
|
static void enc_ie_display(unsigned char **ntmode, msg_t *msg, char *display, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
unsigned char *p;
|
|
Q931_info_t *qi = (Q931_info_t *) (msg->data + mISDN_HEADER_LEN);
|
|
int l;
|
|
|
|
if (!display[0])
|
|
{
|
|
printf("%s: ERROR: display text not given.\n", __FUNCTION__);
|
|
return;
|
|
}
|
|
|
|
l = strlen(display);
|
|
if (80 < l)
|
|
{
|
|
l = 80;
|
|
printf("%s: WARNING: display text too long (max %d chars), cutting.\n", __FUNCTION__, l);
|
|
display[l] = '\0';
|
|
}
|
|
|
|
/* if (MISDN_IE_DEBG) printf(" display='%s' (len=%d)\n", display, l); */
|
|
|
|
p = msg_put(msg, l + 2);
|
|
if (nt)
|
|
*ntmode = p + 1;
|
|
else
|
|
qi->QI_ELEMENT(display) = p - (unsigned char *) qi - sizeof(Q931_info_t);
|
|
p[0] = IE_DISPLAY;
|
|
p[1] = l;
|
|
strncpy((char *) p + 2, display, l);
|
|
}
|
|
|
|
#if 0
|
|
static void dec_ie_display(unsigned char *p, Q931_info_t *qi, char *display, size_t display_len, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
*display = '\0';
|
|
|
|
if (!nt)
|
|
{
|
|
p = NULL;
|
|
if (qi->QI_ELEMENT(display))
|
|
p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->QI_ELEMENT(display) + 1;
|
|
}
|
|
if (!p)
|
|
return;
|
|
if (p[0] < 1)
|
|
{
|
|
printf("%s: ERROR: IE too short (%d).\n", __FUNCTION__, p[0]);
|
|
return;
|
|
}
|
|
|
|
strnncpy(display, (char *)p+1, p[0], display_len);
|
|
|
|
if (MISDN_IE_DEBG) printf(" display='%s'\n", display);
|
|
}
|
|
#endif
|
|
|
|
/* IE_KEYPAD */
|
|
#if 1
|
|
static void enc_ie_keypad(unsigned char **ntmode, msg_t *msg, char *keypad, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
unsigned char *p;
|
|
Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
|
|
int l;
|
|
|
|
if (!keypad[0])
|
|
{
|
|
printf("%s: ERROR: keypad info not given.\n", __FUNCTION__);
|
|
return;
|
|
}
|
|
|
|
if (MISDN_IE_DEBG) printf(" keypad='%s'\n", keypad);
|
|
|
|
l = strlen(keypad);
|
|
p = msg_put(msg, l+2);
|
|
if (nt)
|
|
*ntmode = p+1;
|
|
else
|
|
qi->QI_ELEMENT(keypad) = p - (unsigned char *)qi - sizeof(Q931_info_t);
|
|
p[0] = IE_KEYPAD;
|
|
p[1] = l;
|
|
strncpy((char *)p+2, keypad, strlen(keypad));
|
|
}
|
|
#endif
|
|
|
|
static void dec_ie_keypad(unsigned char *p, Q931_info_t *qi, char *keypad, size_t keypad_len, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
*keypad = '\0';
|
|
|
|
if (!nt)
|
|
{
|
|
p = NULL;
|
|
if (qi->QI_ELEMENT(keypad))
|
|
p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->QI_ELEMENT(keypad) + 1;
|
|
}
|
|
if (!p)
|
|
return;
|
|
if (p[0] < 1)
|
|
{
|
|
printf("%s: ERROR: IE too short (%d).\n", __FUNCTION__, p[0]);
|
|
return;
|
|
}
|
|
|
|
strnncpy(keypad, (char *)p+1, p[0], keypad_len);
|
|
|
|
if (MISDN_IE_DEBG) printf(" keypad='%s'\n", keypad);
|
|
}
|
|
|
|
|
|
/* IE_NOTIFY */
|
|
static void enc_ie_notify(unsigned char **ntmode, msg_t *msg, int notify, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
unsigned char *p;
|
|
Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
|
|
int l;
|
|
|
|
if (notify<0 || notify>0x7f)
|
|
{
|
|
printf("%s: ERROR: notify(%d) is out of range.\n", __FUNCTION__, notify);
|
|
return;
|
|
}
|
|
|
|
if (MISDN_IE_DEBG) printf(" notify=%d\n", notify);
|
|
|
|
l = 1;
|
|
p = msg_put(msg, l+2);
|
|
if (nt)
|
|
*ntmode = p+1;
|
|
else
|
|
qi->QI_ELEMENT(notify) = p - (unsigned char *)qi - sizeof(Q931_info_t);
|
|
p[0] = IE_NOTIFY;
|
|
p[1] = l;
|
|
p[2] = 0x80 + notify;
|
|
}
|
|
|
|
static void dec_ie_notify(unsigned char *p, Q931_info_t *qi, int *notify, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
*notify = -1;
|
|
|
|
if (!nt)
|
|
{
|
|
p = NULL;
|
|
if (qi->QI_ELEMENT(notify))
|
|
p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->QI_ELEMENT(notify) + 1;
|
|
}
|
|
if (!p)
|
|
return;
|
|
if (p[0] < 1)
|
|
{
|
|
printf("%s: ERROR: IE too short (%d).\n", __FUNCTION__, p[0]);
|
|
return;
|
|
}
|
|
|
|
*notify = p[1] & 0x7f;
|
|
|
|
if (MISDN_IE_DEBG) printf(" notify=%d\n", *notify);
|
|
}
|
|
|
|
|
|
/* IE_PROGRESS */
|
|
static void enc_ie_progress(unsigned char **ntmode, msg_t *msg, int coding, int location, int progress, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
unsigned char *p;
|
|
Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
|
|
int l;
|
|
|
|
if (coding<0 || coding>0x03)
|
|
{
|
|
printf("%s: ERROR: coding(%d) is out of range.\n", __FUNCTION__, coding);
|
|
return;
|
|
}
|
|
if (location<0 || location>0x0f)
|
|
{
|
|
printf("%s: ERROR: location(%d) is out of range.\n", __FUNCTION__, location);
|
|
return;
|
|
}
|
|
if (progress<0 || progress>0x7f)
|
|
{
|
|
printf("%s: ERROR: progress(%d) is out of range.\n", __FUNCTION__, progress);
|
|
return;
|
|
}
|
|
|
|
if (MISDN_IE_DEBG) printf(" coding=%d location=%d progress=%d\n", coding, location, progress);
|
|
|
|
l = 2;
|
|
p = msg_put(msg, l+2);
|
|
if (nt)
|
|
*ntmode = p+1;
|
|
else
|
|
qi->QI_ELEMENT(progress) = p - (unsigned char *)qi - sizeof(Q931_info_t);
|
|
p[0] = IE_PROGRESS;
|
|
p[1] = l;
|
|
p[2] = 0x80 + (coding<<5) + location;
|
|
p[3] = 0x80 + progress;
|
|
}
|
|
|
|
static void dec_ie_progress(unsigned char *p, Q931_info_t *qi, int *coding, int *location, int *progress, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
*coding = -1;
|
|
*location = -1;
|
|
//*progress = -1;
|
|
*progress = 0;
|
|
|
|
if (!nt)
|
|
{
|
|
p = NULL;
|
|
if (qi->QI_ELEMENT(progress))
|
|
p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->QI_ELEMENT(progress) + 1;
|
|
}
|
|
if (!p)
|
|
return;
|
|
if (p[0] < 1)
|
|
{
|
|
printf("%s: ERROR: IE too short (%d).\n", __FUNCTION__, p[0]);
|
|
return;
|
|
}
|
|
|
|
*coding = (p[1]&0x60) >> 5;
|
|
*location = p[1] & 0x0f;
|
|
*progress = p[2] & 0x7f;
|
|
|
|
if (MISDN_IE_DEBG) printf(" coding=%d location=%d progress=%d\n", *coding, *location, *progress);
|
|
}
|
|
|
|
|
|
/* IE_REDIR_NR (redirecting = during MT_SETUP) */
|
|
static void enc_ie_redir_nr(unsigned char **ntmode, msg_t *msg, int type, int plan, int present, int screen, int reason, char *number, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
unsigned char *p;
|
|
Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
|
|
int l;
|
|
|
|
if (type<0 || type>7)
|
|
{
|
|
printf("%s: ERROR: type(%d) is out of range.\n", __FUNCTION__, type);
|
|
return;
|
|
}
|
|
if (plan<0 || plan>15)
|
|
{
|
|
printf("%s: ERROR: plan(%d) is out of range.\n", __FUNCTION__, plan);
|
|
return;
|
|
}
|
|
if (present > 3)
|
|
{
|
|
printf("%s: ERROR: present(%d) is out of range.\n", __FUNCTION__, present);
|
|
return;
|
|
}
|
|
if (present >= 0) if (screen<0 || screen>3)
|
|
{
|
|
printf("%s: ERROR: screen(%d) is out of range.\n", __FUNCTION__, screen);
|
|
return;
|
|
}
|
|
if (reason > 0x0f)
|
|
{
|
|
printf("%s: ERROR: reason(%d) is out of range.\n", __FUNCTION__, reason);
|
|
return;
|
|
}
|
|
|
|
if (MISDN_IE_DEBG) printf(" type=%d plan=%d present=%d screen=%d readon=%d number='%s'\n", type, plan, present, screen, reason, number);
|
|
|
|
l = 1;
|
|
if (number)
|
|
l += strlen((char *)number);
|
|
if (present >= 0)
|
|
{
|
|
l += 1;
|
|
if (reason >= 0)
|
|
l += 1;
|
|
}
|
|
p = msg_put(msg, l+2);
|
|
if (nt)
|
|
*ntmode = p+1;
|
|
else
|
|
qi->QI_ELEMENT(redirect_nr) = p - (unsigned char *)qi - sizeof(Q931_info_t);
|
|
p[0] = IE_REDIR_NR;
|
|
p[1] = l;
|
|
if (present >= 0)
|
|
{
|
|
if (reason >= 0)
|
|
{
|
|
p[2] = 0x00 + (type<<4) + plan;
|
|
p[3] = 0x00 + (present<<5) + screen;
|
|
p[4] = 0x80 + reason;
|
|
if (number)
|
|
strncpy((char *)p+5, (char *)number, strlen((char *)number));
|
|
} else
|
|
{
|
|
p[2] = 0x00 + (type<<4) + plan;
|
|
p[3] = 0x80 + (present<<5) + screen;
|
|
if (number)
|
|
strncpy((char *)p+4, (char *)number, strlen((char *)number));
|
|
}
|
|
} else
|
|
{
|
|
p[2] = 0x80 + (type<<4) + plan;
|
|
if (number) if (number[0])
|
|
strncpy((char *)p+3, (char *)number, strlen((char *)number));
|
|
}
|
|
}
|
|
|
|
static void dec_ie_redir_nr(unsigned char *p, Q931_info_t *qi, int *type, int *plan, int *present, int *screen, int *reason, char *number, size_t number_len, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
*type = -1;
|
|
*plan = -1;
|
|
*present = -1;
|
|
*screen = -1;
|
|
*reason = -1;
|
|
*number = '\0';
|
|
|
|
if (!nt)
|
|
{
|
|
p = NULL;
|
|
if (qi->QI_ELEMENT(redirect_nr))
|
|
p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->QI_ELEMENT(redirect_nr) + 1;
|
|
}
|
|
if (!p)
|
|
return;
|
|
if (p[0] < 1)
|
|
{
|
|
printf("%s: ERROR: IE too short (%d).\n", __FUNCTION__, p[0]);
|
|
return;
|
|
}
|
|
|
|
*type = (p[1]&0x70) >> 4;
|
|
*plan = p[1] & 0xf;
|
|
if (!(p[1] & 0x80))
|
|
{
|
|
*present = (p[2]&0x60) >> 5;
|
|
*screen = p[2] & 0x3;
|
|
if (!(p[2] & 0x80))
|
|
{
|
|
*reason = p[3] & 0x0f;
|
|
strnncpy(number, (char *)p+4, p[0]-3, number_len);
|
|
} else
|
|
{
|
|
strnncpy(number, (char *)p+3, p[0]-2, number_len);
|
|
}
|
|
} else
|
|
{
|
|
strnncpy(number, (char *)p+2, p[0]-1, number_len);
|
|
}
|
|
|
|
if (MISDN_IE_DEBG) printf(" type=%d plan=%d present=%d screen=%d reason=%d number='%s'\n", *type, *plan, *present, *screen, *reason, number);
|
|
}
|
|
|
|
|
|
/* IE_REDIR_DN (redirection = during MT_NOTIFY) */
|
|
static void enc_ie_redir_dn(unsigned char **ntmode, msg_t *msg, int type, int plan, int present, char *number, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
unsigned char *p;
|
|
Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
|
|
int l;
|
|
|
|
if (type<0 || type>7)
|
|
{
|
|
printf("%s: ERROR: type(%d) is out of range.\n", __FUNCTION__, type);
|
|
return;
|
|
}
|
|
if (plan<0 || plan>15)
|
|
{
|
|
printf("%s: ERROR: plan(%d) is out of range.\n", __FUNCTION__, plan);
|
|
return;
|
|
}
|
|
if (present > 3)
|
|
{
|
|
printf("%s: ERROR: present(%d) is out of range.\n", __FUNCTION__, present);
|
|
return;
|
|
}
|
|
|
|
if (MISDN_IE_DEBG) printf(" type=%d plan=%d present=%d number='%s'\n", type, plan, present, number);
|
|
|
|
l = 1;
|
|
if (number)
|
|
l += strlen((char *)number);
|
|
if (present >= 0)
|
|
l += 1;
|
|
p = msg_put(msg, l+2);
|
|
if (nt)
|
|
*ntmode = p+1;
|
|
else {
|
|
qi->QI_ELEMENT(redirect_dn) = p - (unsigned char *)qi - sizeof(Q931_info_t);
|
|
}
|
|
p[0] = IE_REDIR_DN;
|
|
p[1] = l;
|
|
if (present >= 0)
|
|
{
|
|
p[2] = 0x00 + (type<<4) + plan;
|
|
p[3] = 0x80 + (present<<5);
|
|
if (number)
|
|
strncpy((char *)p+4, (char *)number, strlen((char *)number));
|
|
} else
|
|
{
|
|
p[2] = 0x80 + (type<<4) + plan;
|
|
if (number)
|
|
strncpy((char *)p+3, (char *)number, strlen((char *)number));
|
|
}
|
|
}
|
|
|
|
static void dec_ie_redir_dn(unsigned char *p, Q931_info_t *qi, int *type, int *plan, int *present, char *number, size_t number_len, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
*type = -1;
|
|
*plan = -1;
|
|
*present = -1;
|
|
*number = '\0';
|
|
|
|
if (!nt)
|
|
{
|
|
p = NULL;
|
|
if (qi->QI_ELEMENT(redirect_dn))
|
|
p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->QI_ELEMENT(redirect_dn) + 1;
|
|
}
|
|
if (!p)
|
|
return;
|
|
if (p[0] < 1)
|
|
{
|
|
printf("%s: ERROR: IE too short (%d).\n", __FUNCTION__, p[0]);
|
|
return;
|
|
}
|
|
|
|
*type = (p[1]&0x70) >> 4;
|
|
*plan = p[1] & 0xf;
|
|
if (!(p[1] & 0x80))
|
|
{
|
|
*present = (p[2]&0x60) >> 5;
|
|
strnncpy(number, (char *)p+3, p[0]-2, number_len);
|
|
} else
|
|
{
|
|
strnncpy(number, (char *)p+2, p[0]-1, number_len);
|
|
}
|
|
|
|
if (MISDN_IE_DEBG) printf(" type=%d plan=%d present=%d number='%s'\n", *type, *plan, *present, number);
|
|
}
|
|
|
|
|
|
/* IE_USERUSER */
|
|
#if 1
|
|
static void enc_ie_useruser(unsigned char **ntmode, msg_t *msg, int protocol, char *user, int user_len, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
unsigned char *p;
|
|
Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
|
|
int l;
|
|
|
|
if (protocol<0 || protocol>127)
|
|
{
|
|
printf("%s: ERROR: protocol(%d) is out of range.\n", __FUNCTION__, protocol);
|
|
return;
|
|
}
|
|
if (!user || user_len<=0)
|
|
{
|
|
return;
|
|
}
|
|
|
|
if (MISDN_IE_DEBG) {
|
|
size_t i;
|
|
char debug[768];
|
|
|
|
for (i = 0; i < user_len; ++i) {
|
|
sprintf(debug + (i * 3), " %02x", user[i]);
|
|
}
|
|
debug[i * 3] = 0;
|
|
printf(" protocol=%d user-user%s\n", protocol, debug);
|
|
}
|
|
|
|
l = user_len+1;
|
|
p = msg_put(msg, l+3);
|
|
if (nt)
|
|
*ntmode = p+1;
|
|
else
|
|
qi->QI_ELEMENT(useruser) = p - (unsigned char *)qi - sizeof(Q931_info_t);
|
|
p[0] = IE_USER_USER;
|
|
p[1] = l;
|
|
p[2] = protocol;
|
|
memcpy(p+3, user, user_len);
|
|
}
|
|
#endif
|
|
|
|
#if 1
|
|
static void dec_ie_useruser(unsigned char *p, Q931_info_t *qi, int *protocol, char *user, int *user_len, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
*user_len = 0;
|
|
*protocol = -1;
|
|
|
|
if (!nt)
|
|
{
|
|
p = NULL;
|
|
if (qi->QI_ELEMENT(useruser))
|
|
p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->QI_ELEMENT(useruser) + 1;
|
|
}
|
|
if (!p)
|
|
return;
|
|
|
|
*user_len = p[0]-1;
|
|
if (p[0] < 1)
|
|
return;
|
|
*protocol = p[1];
|
|
memcpy(user, p+2, (*user_len<=128)?*(user_len):128); /* clip to 128 maximum */
|
|
|
|
if (MISDN_IE_DEBG) {
|
|
int i;
|
|
char debug[768];
|
|
|
|
for (i = 0; i < *user_len; ++i) {
|
|
sprintf(debug + (i * 3), " %02x", user[i]);
|
|
}
|
|
debug[i * 3] = 0;
|
|
printf(" protocol=%d user-user%s\n", *protocol, debug);
|
|
}
|
|
}
|
|
#endif
|
|
|
|
/* IE_DISPLAY */
|
|
static void enc_ie_restart_ind(unsigned char **ntmode, msg_t *msg, unsigned char rind, int nt, struct misdn_bchannel *bc)
|
|
{
|
|
unsigned char *p;
|
|
Q931_info_t *qi = (Q931_info_t *)(msg->data + mISDN_HEADER_LEN);
|
|
/* if (MISDN_IE_DEBG) printf(" display='%s' (len=%d)\n", display, strlen((char *)display)); */
|
|
|
|
p = msg_put(msg, 3);
|
|
if (nt)
|
|
*ntmode = p+1;
|
|
else
|
|
qi->QI_ELEMENT(restart_ind) = p - (unsigned char *)qi - sizeof(Q931_info_t);
|
|
p[0] = IE_RESTART_IND;
|
|
p[1] = 1;
|
|
p[2] = rind;
|
|
|
|
}
|
|
|