/*****************************************************************************\ ** ** ** 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:""); 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:""); } /* 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:""); } 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, ¢rex[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); }