fixeria
/
lcr
1
0
Fork 0
Code Pull Requests Releases Wiki Activity
lcr/ie.cpp

1366 lines
31 KiB
C++
Raw Permalink Blame History

/*****************************************************************************\
** **
** PBX4Linux **
** **
**---------------------------------------------------------------------------**
** Copyright: Andreas Eversberg **
** **
** information elements encode and decode **
** **
\*****************************************************************************/
/*
the pointer of enc_ie_* always points to the IE itself
if qi is not NULL (TE-mode), offset is set
*/
/* support stuff */
static void strnncpy(unsigned char *dest, unsigned char *src, int len, int dst_len)
{
if (len > dst_len-1)
len = dst_len-1;
UNCPY((char *)dest, (char *)src, len);
dest[len] = '\0';
}
/* IE_COMPLETE */
void Pdss1::enc_ie_complete(struct l3_msg *l3m, int complete)
{
if (complete<0 || complete>1) {
PERROR("complete(%d) is out of range.\n", complete);
return;
}
if (complete) {
add_trace("complete", NULL, NULL);
l3m->sending_complete++;
}
}
void Pdss1::dec_ie_complete(struct l3_msg *l3m, int *complete)
{
*complete = 0;
// special case: p is not a pointer, it's a value
unsigned char p = l3m->sending_complete;
if (p)
*complete = 1;
if (*complete)
add_trace("complete", NULL, NULL);
}
/* IE_BEARER */
void Pdss1::enc_ie_bearer(struct l3_msg *l3m, int coding, int capability, int mode, int rate, int multi, int user)
{
unsigned char p[256];
int l;
if (coding<0 || coding>3) {
PERROR("coding(%d) is out of range.\n", coding);
return;
}
if (capability<0 || capability>31) {
PERROR("capability(%d) is out of range.\n", capability);
return;
}
if (mode<0 || mode>3) {
PERROR("mode(%d) is out of range.\n", mode);
return;
}
if (rate<0 || rate>31) {
PERROR("rate(%d) is out of range.\n", rate);
return;
}
if (multi>127) {
PERROR("multi(%d) is out of range.\n", multi);
return;
}
if (user>31) {
PERROR("user L1(%d) is out of range.\n", user);
return;
}
if (rate!=24 && multi>=0) {
PERROR("multi(%d) is only possible if rate(%d) would be 24.\n", multi, rate);
multi = -1;
}
add_trace("bearer", "coding", "%d", coding);
add_trace("bearer", "capability", "%d", capability);
add_trace("bearer", "mode", "%d", mode);
add_trace("bearer", "rate", "%d", rate);
add_trace("bearer", "multi", "%d", multi);
add_trace("bearer", "user", "%d", user);
l = 2 + (multi>=0) + (user>=0);
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;
add_layer3_ie(l3m, p[0], p[1], p+2);
}
void Pdss1::dec_ie_bearer(struct l3_msg *l3m, int *coding, int *capability, int *mode, int *rate, int *multi, int *user)
{
*coding = -1;
*capability = -1;
*mode = -1;
*rate = -1;
*multi = -1;
*user = -1;
unsigned char *p = l3m->bearer_capability;
if (!p)
return;
if (p[0] < 2) {
add_trace("bearer", "error", "IE too short (len=%d)", p[0]);
return;
}
*coding = (p[1]&0x60) >> 5;
*capability = p[1] & 0x1f;
if (p[0]>=2) {
*mode = (p[2]&0x60) >> 5;
*rate = p[2] & 0x1f;
}
if (p[0]>=3 && *rate==0x18) {
*multi = p[3] & 0x7f;
if (p[0]>=4)
*user = p[4] & 0x1f;
} else {
if (p[0]>=3)
*user = p[3] & 0x1f;
}
add_trace("bearer", "coding", "%d", *coding);
add_trace("bearer", "capability", "%d", *capability);
add_trace("bearer", "mode", "%d", *mode);
add_trace("bearer", "rate", "%d", *rate);
add_trace("bearer", "multi", "%d", *multi);
add_trace("bearer", "user", "%d", *user);
}
/* IE_HLC */
void Pdss1::enc_ie_hlc(struct l3_msg *l3m, int coding, int interpretation, int presentation, int hlc, int exthlc)
{
unsigned char p[256];
int l;
if (coding<0 || coding>3) {
PERROR("coding(%d) is out of range.\n", coding);
return;
}
if (interpretation<0 || interpretation>7) {
PERROR("interpretation(%d) is out of range.\n", interpretation);
return;
}
if (presentation<0 || presentation>3) {
PERROR("presentation(%d) is out of range.\n", presentation);
return;
}
if (hlc<0 || hlc>127) {
PERROR("hlc(%d) is out of range.\n", hlc);
return;
}
if (exthlc>127) {
PERROR("hlc(%d) is out of range.\n", exthlc);
return;
}
add_trace("hlc", "coding", "%d", coding);
add_trace("hlc", "interpretation", "%d", interpretation);
add_trace("hlc", "presentation", "%d", presentation);
add_trace("hlc", "hlc", "%d", hlc);
if (exthlc >= 0)
add_trace("hlc", "exthlc", "%d", exthlc);
l = 2 + (exthlc>=0);
p[0] = IE_HLC;
p[1] = l;
p[2] = 0x80 + (coding<<5) + (interpretation<<2) + presentation;
if (exthlc >= 0) {
p[3] = hlc;
p[4] = 0x80 + exthlc;
} else
p[3] = 0x80 + hlc;
add_layer3_ie(l3m, p[0], p[1], p+2);
}
void Pdss1::dec_ie_hlc(struct l3_msg *l3m, int *coding, int *interpretation, int *presentation, int *hlc, int *exthlc)
{
*coding = -1;
*interpretation = -1;
*presentation = -1;
*hlc = -1;
*exthlc = -1;
unsigned char *p = l3m->hlc;
if (!p)
return;
if (p[0] < 2) {
add_trace("hlc", "error", "IE too short (len=%d)", p[0]);
return;
}
*coding = (p[1]&0x60) >> 5;
*interpretation = (p[1]&0x1c) >> 2;
*presentation = p[1] & 0x03;
*hlc = p[2] & 0x7f;
if (p[0]>=3) {
*exthlc = p[3] & 0x7f;
}
add_trace("hlc", "coding", "%d", *coding);
add_trace("hlc", "interpretation", "%d", *interpretation);
add_trace("hlc", "presentation", "%d", *presentation);
add_trace("hlc", "hlc", "%d", *hlc);
if (*exthlc >= 0)
add_trace("hlc", "exthlc", "%d", *exthlc);
}
/* IE_CALL_ID */
void Pdss1::enc_ie_call_id(struct l3_msg *l3m, unsigned char *callid, int callid_len)
{
unsigned char p[256];
int l;
char buffer[25];
int i;
if (!callid || callid_len<=0) {
return;
}
if (callid_len > 8) {
PERROR("callid_len(%d) is out of range.\n", callid_len);
return;
}
i = 0;
while(i < callid_len) {
UPRINT(buffer+(i*3), " %02x", callid[i]);
i++;
}
add_trace("callid", NULL, "%s", buffer[0]?buffer+1:"<none>");
l = callid_len;
p[0] = IE_CALL_ID;
p[1] = l;
memcpy(p+2, callid, callid_len);
add_layer3_ie(l3m, p[0], p[1], p+2);
}
void Pdss1::dec_ie_call_id(struct l3_msg *l3m, unsigned char *callid, int *callid_len)
{
char buffer[25];
int i;
*callid_len = -1;
unsigned char *p = l3m->call_id;
if (!p)
return;
if (p[0] > 8) {
add_trace("callid", "error", "IE too long (len=%d)", p[0]);
return;
}
*callid_len = p[0];
memcpy(callid, p+1, *callid_len);
i = 0;
while(i < *callid_len) {
UPRINT(buffer+(i*3), " %02x", callid[i]);
i++;
}
add_trace("callid", NULL, "%s", buffer[0]?buffer+1:"<none>");
}
/* IE_CALLED_PN */
void Pdss1::enc_ie_called_pn(struct l3_msg *l3m, int type, int plan, unsigned char *number, int number_len)
{
unsigned char p[256];
int l;
if (type<0 || type>7) {
PERROR("type(%d) is out of range.\n", type);
return;
}
if (plan<0 || plan>15) {
PERROR("plan(%d) is out of range.\n", plan);
return;
}
if (!number[0]) {
PERROR("number is not given.\n");
return;
}
add_trace("called_pn", "type", "%d", type);
add_trace("called_pn", "plan", "%d", plan);
UNCPY((char *)p, (char *)number, number_len);
p[number_len] = '\0';
add_trace("called_pn", "number", "%s", p);
l = 1+number_len;
p[0] = IE_CALLED_PN;
p[1] = l;
p[2] = 0x80 + (type<<4) + plan;
UNCPY((char *)p+3, (char *)number, number_len);
add_layer3_ie(l3m, p[0], p[1], p+2);
}
void Pdss1::dec_ie_called_pn(struct l3_msg *l3m, int *type, int *plan, unsigned char *number, int number_len)
{
*type = -1;
*plan = -1;
*number = '\0';
unsigned char *p = l3m->called_nr;
if (!p)
return;
if (p[0] < 2) {
add_trace("called_pn", "error", "IE too short (len=%d)", p[0]);
return;
}
*type = (p[1]&0x70) >> 4;
*plan = p[1] & 0xf;
strnncpy(number, p+2, p[0]-1, number_len);
add_trace("called_pn", "type", "%d", *type);
add_trace("called_pn", "plan", "%d", *plan);
add_trace("called_pn", "number", "%s", number);
}
/* IE_CALLING_PN */
void Pdss1::enc_ie_calling_pn(struct l3_msg *l3m, int type, int plan, int present, int screen, unsigned char *number, int type2, int plan2, int present2, int screen2, unsigned char *number2)
{
unsigned char p[256];
int l;
if (type<0 || type>7) {
PERROR("type(%d) is out of range.\n", type);
return;
}
if (plan<0 || plan>15) {
PERROR("plan(%d) is out of range.\n", plan);
return;
}
if (present>3) {
PERROR("present(%d) is out of range.\n", present);
return;
}
if (present >= 0) if (screen<0 || screen>3) {
PERROR("screen(%d) is out of range.\n", screen);
return;
}
add_trace("calling_pn", "type", "%d", type);
add_trace("calling_pn", "plan", "%d", plan);
add_trace("calling_pn", "present", "%d", present);
add_trace("calling_pn", "screen", "%d", screen);
add_trace("calling_pn", "number", "%s", number);
l = 1;
if (number) if (number[0])
l += strlen((char *)number);
if (present >= 0)
l += 1;
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])
UNCPY((char *)p+4, (char *)number, strlen((char *)number));
} else {
p[2] = 0x80 + (type<<4) + plan;
if (number) if (number[0])
UNCPY((char *)p+3, (char *)number, strlen((char *)number));
}
add_layer3_ie(l3m, p[0], p[1], p+2);
/* second calling party number */
if (type2 < 0)
return;
if (type2>7) {
PERROR("type2(%d) is out of range.\n", type2);
return;
}
if (plan2<0 || plan2>15) {
PERROR("plan2(%d) is out of range.\n", plan2);
return;
}
if (present2>3) {
PERROR("present2(%d) is out of range.\n", present2);
return;
}
if (present2 >= 0) if (screen2<0 || screen2>3) {
PERROR("screen2(%d) is out of range.\n", screen2);
return;
}
add_trace("call_pn 2", "type", "%d", type2);
add_trace("call_pn 2", "plan", "%d", plan2);
add_trace("call_pn 2", "present", "%d", present2);
add_trace("call_pn 2", "screen", "%d", screen2);
add_trace("call_pn 2", "number", "%s", number2);
l = 1;
if (number2) if (number2[0])
l += strlen((char *)number2);
if (present2 >= 0)
l += 1;
p[0] = IE_CALLING_PN;
p[1] = l;
if (present2 >= 0) {
p[2] = 0x00 + (type2<<4) + plan2;
p[3] = 0x80 + (present2<<5) + screen2;
if (number2) if (number2[0])
UNCPY((char *)p+4, (char *)number2, strlen((char *)number2));
} else {
p[2] = 0x80 + (type2<<4) + plan2;
if (number2) if (number2[0])
UNCPY((char *)p+3, (char *)number2, strlen((char *)number2));
}
add_layer3_ie(l3m, p[0], p[1], p+2);
}
void Pdss1::dec_ie_calling_pn(struct l3_msg *l3m, int *type, int *plan, int *present, int *screen, unsigned char *number, int number_len, int *type2, int *plan2, int *present2, int *screen2, unsigned char *number2, int number_len2)
{
*type = -1;
*plan = -1;
*present = -1;
*screen = -1;
*number = '\0';
*type2 = -1;
*plan2 = -1;
*present2 = -1;
*screen2 = -1;
*number2 = '\0';
unsigned int numextra = sizeof(l3m->extra) / sizeof(struct m_extie);
unsigned int i;
unsigned char *p = l3m->calling_nr;
if (!p)
return;
if (p[0] < 1) {
add_trace("calling_pn", "error", "IE too short (len=%d)", p[0]);
return;
}
*type = (p[1]&0x70) >> 4;
*plan = p[1] & 0xf;
if (!(p[1] & 0x80)) {
if (p[0] < 2) {
add_trace("calling_pn", "error", "IE too short (len=%d)", p[0]);
return;
}
*present = (p[2]&0x60) >> 5;
*screen = p[2] & 0x3;
strnncpy(number, p+3, p[0]-2, number_len);
} else {
strnncpy(number, p+2, p[0]-1, number_len);
}
add_trace("calling_pn", "type", "%d", *type);
add_trace("calling_pn", "plan", "%d", *plan);
add_trace("calling_pn", "present", "%d", *present);
add_trace("calling_pn", "screen", "%d", *screen);
add_trace("calling_pn", "number", "%s", number);
/* second calling party number */
p = NULL;
i = 0;
while(i < numextra) {
if (!l3m->extra[i].val)
break;
if (l3m->extra[i].ie == IE_CALLING_PN) {
p = l3m->extra[i].val;
break;
}
i++;
}
if (!p)
return;
if (p[0] < 1) {
add_trace("calling_pn2", "error", "IE too short (len=%d)", p[0]);
return;
}
*type2 = (p[1]&0x70) >> 4;
*plan2 = p[1] & 0xf;
if (!(p[1] & 0x80)) {
if (p[0] < 2) {
add_trace("calling_pn2", "error", "IE too short (len=%d)", p[0]);
return;
}
*present2 = (p[2]&0x60) >> 5;
*screen2 = p[2] & 0x3;
strnncpy(number2, p+3, p[0]-2, number_len2);
} else {
strnncpy(number2, p+2, p[0]-1, number_len2);
}
add_trace("call_pn 2", "type", "%d", *type2);
add_trace("call_pn 2", "plan", "%d", *plan2);
add_trace("call_pn 2", "present", "%d", *present2);
add_trace("call_pn 2", "screen", "%d", *screen2);
add_trace("call_pn 2", "number", "%s", number2);
}
/* IE_CONNECTED_PN */
void Pdss1::enc_ie_connected_pn(struct l3_msg *l3m, int type, int plan, int present, int screen, unsigned char *number)
{
unsigned char p[256];
int l;
if (type<0 || type>7) {
PERROR("type(%d) is out of range.\n", type);
return;
}
if (plan<0 || plan>15) {
PERROR("plan(%d) is out of range.\n", plan);
return;
}
if (present>3) {
PERROR("present(%d) is out of range.\n", present);
return;
}
if (present >= 0) if (screen<0 || screen>3) {
PERROR("screen(%d) is out of range.\n", screen);
return;
}
add_trace("connect_pn", "type", "%d", type);
add_trace("connect_pn", "plan", "%d", plan);
add_trace("connect_pn", "present", "%d", present);
add_trace("connect_pn", "screen", "%d", screen);
add_trace("connect_pn", "number", "%s", number);
l = 1;
if (number) if (number[0])
l += strlen((char *)number);
if (present >= 0)
l += 1;
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])
UNCPY((char *)p+4, (char *)number, strlen((char *)number));
} else {
p[2] = 0x80 + (type<<4) + plan;
if (number) if (number[0])
UNCPY((char *)p+3, (char *)number, strlen((char *)number));
}
add_layer3_ie(l3m, p[0], p[1], p+2);
}
void Pdss1::dec_ie_connected_pn(struct l3_msg *l3m, int *type, int *plan, int *present, int *screen, unsigned char *number, int number_len)
{
*type = -1;
*plan = -1;
*present = -1;
*screen = -1;
*number = '\0';
unsigned char *p = l3m->connected_nr;
if (!p)
return;
if (p[0] < 1) {
add_trace("connect_pn", "error", "IE too short (len=%d)", p[0]);
return;
}
*type = (p[1]&0x70) >> 4;
*plan = p[1] & 0xf;
if (!(p[1] & 0x80)) {
if (p[0] < 2) {
add_trace("connect_pn", "error", "IE too short (len=%d)", p[0]);
return;
}
*present = (p[2]&0x60) >> 5;
*screen = p[2] & 0x3;
strnncpy(number, p+3, p[0]-2, number_len);
} else {
strnncpy(number, p+2, p[0]-1, number_len);
}
add_trace("connect_pn", "type", "%d", *type);
add_trace("connect_pn", "plan", "%d", *plan);
add_trace("connect_pn", "present", "%d", *present);
add_trace("connect_pn", "screen", "%d", *screen);
add_trace("connect_pn", "number", "%s", number);
}
/* IE_CAUSE */
void Pdss1::enc_ie_cause(struct l3_msg *l3m, int location, int cause)
{
unsigned char p[256];
int l;
if (location<0 || location>10) {
PERROR("location(%d) is out of range.\n", location);
return;
}
if (cause<0 || cause>127) {
PERROR("cause(%d) is out of range.\n", cause);
return;
}
add_trace("cause", "location", "%d", location);
add_trace("cause", "value", "%d", cause);
l = 2;
p[0] = IE_CAUSE;
p[1] = l;
p[2] = 0x80 + location;
p[3] = 0x80 + cause;
add_layer3_ie(l3m, p[0], p[1], p+2);
}
void enc_ie_cause_standalone(struct l3_msg *l3m, int location, int cause)
{
unsigned char p[256];
p[0] = IE_CAUSE;
p[1] = 2;
p[2] = 0x80 + location;
p[3] = 0x80 + cause;
add_layer3_ie(l3m, p[0], p[1], p+2);
}
void Pdss1::dec_ie_cause(struct l3_msg *l3m, int *location, int *cause)
{
*location = -1;
*cause = -1;
unsigned char *p = l3m->cause;
if (!p)
return;
if (p[0] < 2) {
add_trace("cause", "error", "IE too short (len=%d)", p[0]);
return;
}
*location = p[1] & 0x0f;
*cause = p[2] & 0x7f;
add_trace("cause", "location", "%d", *location);
add_trace("cause", "value", "%d", *cause);
}
/* IE_CHANNEL_ID */
void Pdss1::enc_ie_channel_id(struct l3_msg *l3m, int exclusive, int channel)
{
unsigned char p[256];
int l;
int pri = p_m_mISDNport->pri;
if (exclusive<0 || exclusive>1) {
PERROR("exclusive(%d) is out of range.\n", exclusive);
return;
}
if ((channel<=0 && channel!=CHANNEL_NO && channel!=CHANNEL_ANY)
|| (!pri && channel>2)
|| (pri && channel>127)
|| (pri && channel==16)) {
PERROR("channel(%d) is out of range.\n", channel);
return;
}
add_trace("channel_id", "exclusive", "%d", exclusive);
switch(channel) {
case CHANNEL_ANY:
add_trace("channel_id", "channel", "any channel");
break;
case CHANNEL_NO:
add_trace("channel_id", "channel", "no channel");
break;
default:
add_trace("channel_id", "channel", "%d", channel);
}
if (!pri) {
/* BRI */
l = 1;
p[0] = IE_CHANNEL_ID;
p[1] = l;
if (channel == CHANNEL_NO)
channel = 0;
else if (channel == CHANNEL_ANY)
channel = 3;
p[2] = 0x80 + (exclusive<<3) + channel;
add_layer3_ie(l3m, p[0], p[1], p+2);
} else {
/* PRI */
if (channel == CHANNEL_NO || channel == CHANNEL_ANY) {
if (channel == CHANNEL_NO)
channel = 0;
else
channel = 3;
l = 1;
p[0] = IE_CHANNEL_ID;
p[1] = l;
p[2] = 0x80 + 0x20 + channel;
add_layer3_ie(l3m, p[0], p[1], p+2);
return; /* end */
}
l = 3;
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;
add_layer3_ie(l3m, p[0], p[1], p+2);
}
}
void Pdss1::dec_ie_channel_id(struct l3_msg *l3m, int *exclusive, int *channel)
{
int pri = p_m_mISDNport->pri;
*exclusive = -1;
*channel = -1;
unsigned char *p = l3m->channel_id;
if (!p)
return;
if (p[0] < 1) {
add_trace("channel_id", "error", "IE too short (len=%d)", p[0]);
return;
}
if (p[1] & 0x40) {
add_trace("channel_id", "error", "refering to channels of other interfaces is not supported");
return;
}
if (p[1] & 0x04) {
add_trace("channel_id", "error", "using d-channel is not supported");
return;
}
*exclusive = (p[1]&0x08) >> 3;
if (!pri) {
/* BRI */
if (p[1] & 0x20) {
add_trace("channel_id", "error", "extended channel ID with non PRI interface");
return;
}
*channel = p[1] & 0x03;
if (*channel == 3)
*channel = CHANNEL_ANY;
else if (*channel == 0)
*channel = CHANNEL_NO;
} else {
/* PRI */
if (p[0] < 1) {
add_trace("channel_id", "error", "IE too short for PRI (len=%d)", p[0]);
return;
}
if (!(p[1] & 0x20)) {
add_trace("channel_id", "error", "basic channel ID with PRI interface");
return;
}
if ((p[1]&0x03) == 0x00) {
/* no channel */
*channel = CHANNEL_NO;
return;
}
if ((p[1]&0x03) == 0x03) {
/* any channel */
*channel = CHANNEL_ANY;
return;
}
if (p[0] < 3) {
add_trace("channel_id", "error", "IE too short for PRI with channel (len=%d)", p[0]);
return;
}
if (p[2] & 0x10) {
add_trace("channel_id", "error", "channel map not supported");
return;
}
*channel = p[3] & 0x7f;
if ((*channel<1) || (*channel==16)) {
add_trace("channel_id", "error", "PRI interface channel out of range (%d)", *channel);
return;
}
}
add_trace("channel_id", "exclusive", "%d", *exclusive);
switch(*channel) {
case CHANNEL_ANY:
add_trace("channel_id", "channel", "any channel");
break;
case CHANNEL_NO:
add_trace("channel_id", "channel", "no channel");
break;
default:
add_trace("channel_id", "channel", "%d", *channel);
}
}
/* IE_DATE */
void Pdss1::enc_ie_date(struct l3_msg *l3m, time_t ti, int no_seconds)
{
unsigned char p[256];
int l;
struct tm *tm;
tm = localtime(&ti);
if (!tm) {
PERROR("localtime() returned NULL.\n");
return;
}
add_trace("date", "day", "%d.%d.%d", tm->tm_mday, tm->tm_mon+1, tm->tm_year%100);
add_trace("date", "time", "%d:%d:%d", tm->tm_hour, tm->tm_min, tm->tm_sec);
l = 5 + (!no_seconds);
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;
if (!no_seconds)
p[7] = tm->tm_sec;
add_layer3_ie(l3m, p[0], p[1], p+2);
}
/* IE_DISPLAY */
void Pdss1::enc_ie_display(struct l3_msg *l3m, unsigned char *display)
{
unsigned char p[256];
int l;
if (!display[0]) {
PERROR("display text not given.\n");
return;
}
if (strlen((char *)display) > 80) {
PERROR("display text too long (max 80 chars), cutting.\n");
display[80] = '\0';
}
add_trace("display", NULL, "%s", display);
l = strlen((char *)display);
p[0] = IE_DISPLAY;
p[1] = l;
UNCPY((char *)p+2, (char *)display, strlen((char *)display));
add_layer3_ie(l3m, p[0], p[1], p+2);
}
void Pdss1::dec_ie_display(struct l3_msg *l3m, unsigned char *display, int display_len)
{
*display = '\0';
unsigned char *p = l3m->display;
if (!p)
return;
if (p[0] < 1) {
add_trace("display", "error", "IE too short (len=%d)", p[0]);
return;
}
strnncpy(display, p+1, p[0], display_len);
add_trace("display", NULL, "%s", display);
}
/* IE_KEYPAD */
void Pdss1::enc_ie_keypad(struct l3_msg *l3m, unsigned char *keypad)
{
unsigned char p[256];
int l;
if (!keypad[0]) {
PERROR("keypad info not given.\n");
return;
}
add_trace("keypad", NULL, "%s", keypad);
l = strlen((char *)keypad);
p[0] = IE_KEYPAD;
p[1] = l;
UNCPY((char *)p+2, (char *)keypad, strlen((char *)keypad));
add_layer3_ie(l3m, p[0], p[1], p+2);
}
void Pdss1::dec_ie_keypad(struct l3_msg *l3m, unsigned char *keypad, int keypad_len)
{
*keypad = '\0';
unsigned char *p = l3m->keypad;
if (!p)
return;
if (p[0] < 1) {
add_trace("keypad", "error", "IE too short (len=%d)", p[0]);
return;
}
strnncpy(keypad, p+1, p[0], keypad_len);
add_trace("keypad", NULL, "%s", keypad);
}
/* IE_NOTIFY */
void Pdss1::enc_ie_notify(struct l3_msg *l3m, int notify)
{
unsigned char p[256];
int l;
if (notify<0 || notify>0x7f) {
PERROR("notify(%d) is out of range.\n", notify);
return;
}
add_trace("notify", NULL, "%d", notify);
l = 1;
p[0] = IE_NOTIFY;
p[1] = l;
p[2] = 0x80 + notify;
add_layer3_ie(l3m, p[0], p[1], p+2);
}
void Pdss1::dec_ie_notify(struct l3_msg *l3m, int *notify)
{
*notify = -1;
unsigned char *p = l3m->notify;
if (!p)
return;
if (p[0] < 1) {
add_trace("notify", "error", "IE too short (len=%d)", p[0]);
return;
}
*notify = p[1] & 0x7f;
add_trace("notify", NULL, "%d", *notify);
}
/* IE_PROGRESS */
void Pdss1::enc_ie_progress(struct l3_msg *l3m, int coding, int location, int progress)
{
unsigned char p[256];
int l;
if (coding<0 || coding>0x03) {
PERROR("coding(%d) is out of range.\n", coding);
return;
}
if (location<0 || location>0x0f) {
PERROR("location(%d) is out of range.\n", location);
return;
}
if (progress<0 || progress>0x7f) {
PERROR("progress(%d) is out of range.\n", progress);
return;
}
add_trace("progress", "codeing", "%d", coding);
add_trace("progress", "location", "%d", location);
add_trace("progress", "indicator", "%d", progress);
l = 2;
p[0] = IE_PROGRESS;
p[1] = l;
p[2] = 0x80 + (coding<<5) + location;
p[3] = 0x80 + progress;
add_layer3_ie(l3m, p[0], p[1], p+2);
}
void Pdss1::dec_ie_progress(struct l3_msg *l3m, int *coding, int *location, int *progress)
{
*coding = -1;
*location = -1;
*progress = -1;
unsigned char *p = l3m->progress;
if (!p)
return;
if (p[0] < 1) {
add_trace("progress", "error", "IE too short (len=%d)", p[0]);
return;
}
*coding = (p[1]&0x60) >> 5;
*location = p[1] & 0x0f;
*progress = p[2] & 0x7f;
add_trace("progress", "codeing", "%d", *coding);
add_trace("progress", "location", "%d", *location);
add_trace("progress", "indicator", "%d", *progress);
}
/* IE_REDIR_NR (redirecting = during MT_SETUP) */
void Pdss1::enc_ie_redir_nr(struct l3_msg *l3m, int type, int plan, int present, int screen, int reason, unsigned char *number)
{
unsigned char p[256];
int l;
if (type<0 || type>7) {
PERROR("type(%d) is out of range.\n", type);
return;
}
if (plan<0 || plan>15) {
PERROR("plan(%d) is out of range.\n", plan);
return;
}
if (present > 3) {
PERROR("present(%d) is out of range.\n", present);
return;
}
if (present >= 0) if (screen<0 || screen>3) {
PERROR("screen(%d) is out of range.\n", screen);
return;
}
if (reason > 0x0f) {
PERROR("reason(%d) is out of range.\n", reason);
return;
}
add_trace("redir'ing", "type", "%d", type);
add_trace("redir'ing", "plan", "%d", plan);
add_trace("redir'ing", "present", "%d", present);
add_trace("redir'ing", "screen", "%d", screen);
add_trace("redir'ing", "reason", "%d", reason);
add_trace("redir'ing", "number", "%s", number);
l = 1;
if (number)
l += strlen((char *)number);
if (present >= 0) {
l += 1;
if (reason >= 0)
l += 1;
}
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)
UNCPY((char *)p+5, (char *)number, strlen((char *)number));
} else {
p[2] = 0x00 + (type<<4) + plan;
p[3] = 0x80 + (present<<5) + screen;
if (number)
UNCPY((char *)p+4, (char *)number, strlen((char *)number));
}
} else {
p[2] = 0x80 + (type<<4) + plan;
if (number) if (number[0])
UNCPY((char *)p+3, (char *)number, strlen((char *)number));
}
add_layer3_ie(l3m, p[0], p[1], p+2);
}
void Pdss1::dec_ie_redir_nr(struct l3_msg *l3m, int *type, int *plan, int *present, int *screen, int *reason, unsigned char *number, int number_len)
{
*type = -1;
*plan = -1;
*present = -1;
*screen = -1;
*reason = -1;
*number = '\0';
unsigned char *p = l3m->redirecting_nr;
if (!p)
return;
if (p[0] < 1) {
add_trace("redir'ing", "error", "IE too short (len=%d)", 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, p+4, p[0]-3, number_len);
} else {
strnncpy(number, p+3, p[0]-2, number_len);
}
} else {
strnncpy(number, p+2, p[0]-1, number_len);
}
add_trace("redir'ing", "type", "%d", *type);
add_trace("redir'ing", "plan", "%d", *plan);
add_trace("redir'ing", "present", "%d", *present);
add_trace("redir'ing", "screen", "%d", *screen);
add_trace("redir'ing", "reason", "%d", *reason);
add_trace("redir'ing", "number", "%s", number);
}
/* IE_REDIR_DN (redirection = during MT_NOTIFY) */
void Pdss1::enc_ie_redir_dn(struct l3_msg *l3m, int type, int plan, int present, unsigned char *number)
{
unsigned char p[256];
int l;
if (type<0 || type>7) {
PERROR("type(%d) is out of range.\n", type);
return;
}
if (plan<0 || plan>15) {
PERROR("plan(%d) is out of range.\n", plan);
return;
}
if (present > 3) {
PERROR("present(%d) is out of range.\n", present);
return;
}
add_trace("redir'tion", "type", "%d", type);
add_trace("redir'tion", "plan", "%d", plan);
add_trace("redir'tion", "present", "%d", present);
add_trace("redir'tion", "number", "%s", number);
l = 1;
if (number)
l += strlen((char *)number);
if (present >= 0)
l += 1;
p[0] = IE_REDIR_DN;
p[1] = l;
if (present >= 0) {
p[2] = 0x00 + (type<<4) + plan;
p[3] = 0x80 + (present<<5);
if (number)
UNCPY((char *)p+4, (char *)number, strlen((char *)number));
} else {
p[2] = 0x80 + (type<<4) + plan;
if (number)
UNCPY((char *)p+3, (char *)number, strlen((char *)number));
}
add_layer3_ie(l3m, p[0], p[1], p+2);
}
void Pdss1::dec_ie_redir_dn(struct l3_msg *l3m, int *type, int *plan, int *present, unsigned char *number, int number_len)
{
*type = -1;
*plan = -1;
*present = -1;
*number = '\0';
unsigned char *p = l3m->redirection_nr;
if (!p)
return;
if (p[0] < 1) {
add_trace("redir'tion", "error", "IE too short (len=%d)", p[0]);
return;
}
*type = (p[1]&0x70) >> 4;
*plan = p[1] & 0xf;
if (!(p[1] & 0x80)) {
*present = (p[2]&0x60) >> 5;
strnncpy(number, p+3, p[0]-2, number_len);
} else {
strnncpy(number, p+2, p[0]-1, number_len);
}
add_trace("redir'tion", "type", "%d", *type);
add_trace("redir'tion", "plan", "%d", *plan);
add_trace("redir'tion", "present", "%d", *present);
add_trace("redir'tion", "number", "%s", number);
}
/* IE_FACILITY */
void Pdss1::enc_ie_facility(struct l3_msg *l3m, unsigned char *facility, int facility_len)
{
unsigned char p[256];
int l;
char buffer[768];
int i;
if (!facility || facility_len<=0) {
return;
}
i = 0;
while(i < facility_len) {
UPRINT(buffer+(i*3), " %02x", facility[i]);
i++;
}
add_trace("facility", NULL, "%s", buffer+1);
l = facility_len;
p[0] = IE_FACILITY;
p[1] = l;
memcpy(p+2, facility, facility_len);
add_layer3_ie(l3m, p[0], p[1], p+2);
}
void Pdss1::dec_ie_facility(struct l3_msg *l3m, unsigned char *facility, int *facility_len)
{
char debug[768];
int i;
*facility_len = 0;
unsigned char *p = l3m->facility;
if (!p)
return;
*facility_len = p[0];
memcpy(facility, p+1, *facility_len);
i = 0;
while(i < *facility_len) {
UPRINT(debug+(i*3), " %02x", facility[i]);
i++;
}
debug[i*3] = '\0';
add_trace("facility", NULL, "%s", debug[0]?debug+1:"<none>");
}
void Pdss1::dec_facility_centrex(struct l3_msg *l3m, unsigned char *cnip, int cnip_len)
{
unsigned char centrex[256];
char debug[768];
int facility_len = 0;
int i = 0, j;
*cnip = '\0';
dec_ie_facility(l3m, centrex, &facility_len);
if (facility_len >= 2) {
if (centrex[i++] != CENTREX_FAC)
return;
if (centrex[i++] != CENTREX_ID)
return;
}
/* loop sub IEs of facility */
while(facility_len > i+1) {
if (centrex[i+1]+i+1 > facility_len) {
PERROR("short read of centrex facility.\n");
return;
}
switch(centrex[i]) {
case 0x80:
strnncpy(cnip, &centrex[i+2], centrex[i+1], cnip_len);
add_trace("facility", "cnip", "%s", cnip);
break;
default:
j = 0;
while(j < centrex[i+1]) {
UPRINT(debug+(j*3), " %02x", centrex[i+1+j]);
i++;
}
add_trace("facility", "CENTREX", "unknown=0x%02x len=%d%s\n", centrex[i], centrex[i+1], debug);
}
i += 1+centrex[i+1];
}
}
/* IE_USERUSER */
void Pdss1::enc_ie_useruser(struct l3_msg *l3m, int protocol, unsigned char *user, int user_len)
{
unsigned char p[256];
int l;
char buffer[768];
int i;
if (protocol<0 || protocol>127) {
PERROR("protocol(%d) is out of range.\n", protocol);
return;
}
if (!user || user_len<=0) {
return;
}
i = 0;
while(i < user_len) {
UPRINT(buffer+(i*3), " %02x", user[i]);
i++;
}
add_trace("useruser", "protocol", "%d", protocol);
add_trace("useruser", "value", "%s", buffer);
l = user_len;
p[0] = IE_USER_USER;
p[1] = l;
p[2] = 0x80 + protocol;
memcpy(p+3, user, user_len);
add_layer3_ie(l3m, p[0], p[1], p+2);
}
void Pdss1::dec_ie_useruser(struct l3_msg *l3m, int *protocol, unsigned char *user, int *user_len)
{
char buffer[768];
int i;
*user_len = 0;
*protocol = -1;
unsigned char *p = l3m->useruser;
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 */
i = 0;
while(i < *user_len) {
UPRINT(buffer+(i*3), " %02x", user[i]);
i++;
}
buffer[i*3] = '\0';
add_trace("useruser", "protocol", "%d", *protocol);
add_trace("useruser", "value", "%s", buffer);
}
View Git Blame Copy Permalink