sysmocom/asterisk
11
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity
asterisk/channels/misdn/ie.c
Kevin P. Fleming 166b4e2b30 Multiple revisions 369001-369002 
........
  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
2012-06-15 16:20:16 +00:00

1416 lines
32 KiB
C
Raw Blame History

/*
* 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;
}
Reference in a new issue View git blame Copy permalink