diff options
Diffstat (limited to '1.2-netsec/channels/misdn/ie.c')
-rw-r--r-- | 1.2-netsec/channels/misdn/ie.c | 1621 |
1 files changed, 0 insertions, 1621 deletions
diff --git a/1.2-netsec/channels/misdn/ie.c b/1.2-netsec/channels/misdn/ie.c deleted file mode 100644 index 4d1815f65..000000000 --- a/1.2-netsec/channels/misdn/ie.c +++ /dev/null @@ -1,1621 +0,0 @@ - -/* - * 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 - */ - -/* - the pointer of enc_ie_* always points to the IE itself - if qi is not NULL (TE-mode), offset is set -*/ - - -#include <string.h> - - -#include "isdn_lib_intern.h" - -#include <mISDNuser/mISDNlib.h> -#include <mISDNuser/isdn_net.h> -#include <mISDNuser/l3dss1.h> -#include <mISDNuser/net_l3.h> - - -#define CENTREX_FAC 0x88 -#define CENTREX_ID 0xa1 - -#define MISDN_IE_DEBG 0 - -/* 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; - strncpy((char *)dest, (char *)src, len); - dest[len] = '\0'; -} - - -/* IE_COMPLETE */ -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->sending_complete = p - (unsigned char *)qi - sizeof(Q931_info_t); - p[0] = IE_COMPLETE; - } -} - -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->sending_complete) - *complete = 1; - } else - if (p) - *complete = 1; - - if (*complete) - if (MISDN_IE_DEBG) printf(" complete=%d\n", *complete); -} - - -/* IE_BEARER */ -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->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; -} - -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; - if (qi->llc) - p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->llc + 1; - else if (qi->bearer_capability) - p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->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 */ -void enc_ie_call_id(unsigned char **ntmode, msg_t *msg, unsigned 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->call_id = p - (unsigned char *)qi - sizeof(Q931_info_t); - p[0] = IE_CALL_ID; - p[1] = l; - memcpy(p+2, callid, callid_len); -} - -void dec_ie_call_id(unsigned char *p, Q931_info_t *qi, unsigned 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->call_id) - p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->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); -} - - -/* IE_CALLED_PN */ -void enc_ie_called_pn(unsigned char **ntmode, msg_t *msg, int type, int plan, unsigned 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->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)); -} - -void dec_ie_called_pn(unsigned char *p, Q931_info_t *qi, int *type, int *plan, unsigned char *number, int number_len, int nt, struct misdn_bchannel *bc) -{ - *type = -1; - *plan = -1; - *number = '\0'; - - if (!nt) - { - p = NULL; - if (qi->called_nr) - p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->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, 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 */ -void enc_ie_calling_pn(unsigned char **ntmode, msg_t *msg, int type, int plan, int present, int screen, unsigned 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->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)); - } -} - -void dec_ie_calling_pn(unsigned char *p, Q931_info_t *qi, int *type, int *plan, int *present, int *screen, unsigned char *number, int number_len, int nt, struct misdn_bchannel *bc) -{ - *type = -1; - *plan = -1; - *present = -1; - *screen = -1; - *number = '\0'; - - if (!nt) - { - p = NULL; - if (qi->calling_nr) - p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->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, p+3, p[0]-2, number_len); - } else - { - strnncpy(number, 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 */ -void enc_ie_connected_pn(unsigned char **ntmode, msg_t *msg, int type, int plan, int present, int screen, unsigned 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->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)); - } -} - -void dec_ie_connected_pn(unsigned char *p, Q931_info_t *qi, int *type, int *plan, int *present, int *screen, unsigned char *number, int number_len, int nt, struct misdn_bchannel *bc) -{ - *type = -1; - *plan = -1; - *present = -1; - *screen = -1; - *number = '\0'; - - if (!nt) - { - p = NULL; - if (qi->connected_nr) - p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->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, p+3, p[0]-2, number_len); - } else - { - strnncpy(number, 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 */ -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->cause = p - (unsigned char *)qi - sizeof(Q931_info_t); - p[0] = IE_CAUSE; - p[1] = l; - p[2] = 0x80 + location; - p[3] = 0x80 + cause; -} -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->cause = p - (unsigned char *)qi - sizeof(Q931_info_t); - p[0] = IE_CAUSE; - p[1] = 2; - p[2] = 0x80 + location; - p[3] = 0x80 + cause; -} - - -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->cause) - p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->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 */ -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->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->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->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]); */ - } -} - -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->channel_id) - p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->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 */ -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 tm *tm; - - tm = localtime(&ti); - if (!tm) - { - printf("%s: ERROR: gettimeofday() returned NULL.\n", __FUNCTION__); - return; - } - - 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->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 */ -void enc_ie_display(unsigned char **ntmode, msg_t *msg, unsigned 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; - } - - if (strlen((char *)display) > 80) - { - printf("%s: WARNING: display text too long (max 80 chars), cutting.\n", __FUNCTION__); - display[80] = '\0'; - } - - /* if (MISDN_IE_DEBG) printf(" display='%s' (len=%d)\n", display, strlen((char *)display)); */ - - l = strlen((char *)display); - p = msg_put(msg, l+2); - if (nt) - *ntmode = p+1; - else - qi->display = p - (unsigned char *)qi - sizeof(Q931_info_t); - p[0] = IE_DISPLAY; - p[1] = l; - strncpy((char *)p+2, (char *)display, strlen((char *)display)); -} - -void dec_ie_display(unsigned char *p, Q931_info_t *qi, unsigned char *display, int display_len, int nt, struct misdn_bchannel *bc) -{ - *display = '\0'; - - if (!nt) - { - p = NULL; - if (qi->display) - p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->display + 1; - } - if (!p) - return; - if (p[0] < 1) - { - printf("%s: ERROR: IE too short (%d).\n", __FUNCTION__, p[0]); - return; - } - - strnncpy(display, p+1, p[0], display_len); - - if (MISDN_IE_DEBG) printf(" display='%s'\n", display); -} - - -/* IE_KEYPAD */ -void enc_ie_keypad(unsigned char **ntmode, msg_t *msg, unsigned 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((char *)keypad); - p = msg_put(msg, l+2); - if (nt) - *ntmode = p+1; - else - qi->keypad = p - (unsigned char *)qi - sizeof(Q931_info_t); - p[0] = IE_KEYPAD; - p[1] = l; - strncpy((char *)p+2, (char *)keypad, strlen((char *)keypad)); -} - -void dec_ie_keypad(unsigned char *p, Q931_info_t *qi, unsigned char *keypad, int keypad_len, int nt, struct misdn_bchannel *bc) -{ - *keypad = '\0'; - - if (!nt) - { - p = NULL; - if (qi->keypad) - p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->keypad + 1; - } - if (!p) - return; - if (p[0] < 1) - { - printf("%s: ERROR: IE too short (%d).\n", __FUNCTION__, p[0]); - return; - } - - strnncpy(keypad, p+1, p[0], keypad_len); - - if (MISDN_IE_DEBG) printf(" keypad='%s'\n", keypad); -} - - -/* IE_NOTIFY */ -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->notify = p - (unsigned char *)qi - sizeof(Q931_info_t); - p[0] = IE_NOTIFY; - p[1] = l; - p[2] = 0x80 + notify; -} - -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->notify) - p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->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 */ -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->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; -} - -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->progress) - p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->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) */ -void enc_ie_redir_nr(unsigned char **ntmode, msg_t *msg, int type, int plan, int present, int screen, int reason, unsigned 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->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)); - } -} - -void dec_ie_redir_nr(unsigned char *p, Q931_info_t *qi, int *type, int *plan, int *present, int *screen, int *reason, unsigned char *number, int 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->redirect_nr) - p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->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, 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); - } - - 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) */ -void enc_ie_redir_dn(unsigned char **ntmode, msg_t *msg, int type, int plan, int present, unsigned 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 -/* #warning REINSERT redir_dn, when included in te-mode */ - /*qi->redir_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)); - } -} - -void dec_ie_redir_dn(unsigned char *p, Q931_info_t *qi, int *type, int *plan, int *present, unsigned char *number, int number_len, int nt, struct misdn_bchannel *bc) -{ - *type = -1; - *plan = -1; - *present = -1; - *number = '\0'; - - if (!nt) - { - p = NULL; -/* #warning REINSERT redir_dn, when included in te-mode */ -/* if (qi->redir_dn) */ -/* p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->redir_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, p+3, p[0]-2, number_len); - } else - { - strnncpy(number, 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_FACILITY */ -void enc_ie_facility(unsigned char **ntmode, msg_t *msg, unsigned char *facility, int facility_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[768]; - int i; - - if (!facility || facility_len<=0) - { - return; - } - - i = 0; - while(i < facility_len) - { - if (MISDN_IE_DEBG) printf(debug+(i*3), " %02x", facility[i]); - i++; - } - - if (MISDN_IE_DEBG) printf(" facility%s\n", debug); - - l = facility_len; - p = msg_put(msg, l+2); - if (nt) - *ntmode = p+1; - else - qi->facility = p - (unsigned char *)qi - sizeof(Q931_info_t); - p[0] = IE_FACILITY; - p[1] = l; - memcpy(p+2, facility, facility_len); -} - -void dec_ie_facility(unsigned char *p, Q931_info_t *qi, unsigned char *facility, int *facility_len, int nt, struct misdn_bchannel *bc) -{ - int i; - struct misdn_stack *stack=get_stack_by_bc(bc); - - *facility_len = 0; - - if (!nt) - { - p = NULL; - if (qi->facility) - p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->facility + 1; - } - if (!p) - return; - - *facility_len = p[0]; - memcpy(facility, p+1, *facility_len); - - i = 0; - while(i < *facility_len) - { - cb_log(3, stack->port, " %02x", facility[i]); - i++; - } - cb_log(3, stack->port, " facility\n"); -} - - -/* facility for siemens CENTEX (known parts implemented only) */ -void enc_facility_centrex(unsigned char **ntmode, msg_t *msg, unsigned char *cnip, int setup, int nt, struct misdn_bchannel *bc) -{ - unsigned char centrex[256]; - int i = 0; - - if (!cnip) - return; - - /* centrex facility */ - centrex[i++] = CENTREX_FAC; - centrex[i++] = CENTREX_ID; - - /* cnip */ - if (strlen((char *)cnip) > 15) - { -/* if (options.deb & DEBUG_PORT) */ - if (MISDN_IE_DEBG) printf("%s: CNIP/CONP text too long (max 13 chars), cutting.\n", __FUNCTION__); - cnip[15] = '\0'; - } - /* dunno what the 8 bytes mean */ - if (setup) - { - centrex[i++] = 0x17; - centrex[i++] = 0x02; - centrex[i++] = 0x02; - centrex[i++] = 0x44; - centrex[i++] = 0x18; - centrex[i++] = 0x02; - centrex[i++] = 0x01; - centrex[i++] = 0x09; - } else - { - centrex[i++] = 0x18; - centrex[i++] = 0x02; - centrex[i++] = 0x02; - centrex[i++] = 0x81; - centrex[i++] = 0x09; - centrex[i++] = 0x02; - centrex[i++] = 0x01; - centrex[i++] = 0x0a; - } - - centrex[i++] = 0x80; - centrex[i++] = strlen((char *)cnip); - strcpy((char *)(¢rex[i]), (char *)cnip); - i += strlen((char *)cnip); - if (MISDN_IE_DEBG) printf(" cnip='%s'\n", cnip); - - /* encode facility */ - enc_ie_facility(ntmode, msg, centrex, i, nt , bc); -} - -void dec_facility_centrex(unsigned char *p, Q931_info_t *qi, unsigned char *cnip, int cnip_len, int nt, struct misdn_bchannel *bc) -{ - unsigned char centrex[256]; - char debug[768]; - int facility_len = 0; - int i = 0, j; - *cnip = '\0'; - - dec_ie_facility(p, qi, centrex, &facility_len, nt, bc); - 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) - { - printf("%s: ERROR: short read of centrex facility.\n", __FUNCTION__); - return; - } - switch(centrex[i]) - { - case 0x80: - strnncpy(cnip, ¢rex[i+2], centrex[i+1], cnip_len); - if (MISDN_IE_DEBG) printf(" CENTREX cnip='%s'\n", cnip); - break; - - default: - j = 0; - while(j < centrex[i+1]) - { - if (MISDN_IE_DEBG) printf(debug+(j*3), " %02x", centrex[i+1+j]); - i++; - } - if (MISDN_IE_DEBG) printf(" CENTREX unknown=0x%2x len=%d%s\n", centrex[i], centrex[i+1], debug); - } - i += 1+centrex[i+1]; - } -} - - - - -/* facility for siemens CENTEX (known parts implemented only) */ -void enc_facility_calldeflect(unsigned char **ntmode, msg_t *msg, unsigned char *nr, int nt, struct misdn_bchannel *bc) -{ - unsigned char fac[256]; - - if (!nr) - return; - - /* calldeflect facility */ - - /* cnip */ - if (strlen((char *)nr) > 15) - { -/* if (options.deb & DEBUG_PORT) */ - if (MISDN_IE_DEBG) printf("%s: NR text too long (max 13 chars), cutting.\n", __FUNCTION__); - nr[15] = '\0'; - } - - fac[0]=0; // len - fac[1]=0; //len - fac[2]=0x01; // Use D-Chan - fac[3]=0; // Keypad len - fac[4]=31; // user user data? len = 31 = 29 + 2 - fac[5]=0x1c; // magic? - fac[6]=0x1d; // strlen destination + 18 = 29 - fac[7]=0x91; // .. - fac[8]=0xA1; - fac[9]=0x1A; // strlen destination + 15 = 26 - fac[10]=0x02; - fac[11]=0x01; - fac[12]=0x70; - fac[13]=0x02; - fac[14]=0x01; - fac[15]=0x0d; - fac[16]=0x30; - fac[17]=0x12; // strlen destination + 7 = 18 - fac[18]=0x30; // ...hm 0x30 - fac[19]=0x0d; // strlen destination + 2 - fac[20]=0x80; // CLIP - fac[21]=0x0b; // strlen destination - fac[22]=0x01; // destination start - fac[23]=0x01; // - fac[24]=0x01; // - fac[25]=0x01; // - fac[26]=0x01; // - fac[27]=0x01; // - fac[28]=0x01; // - fac[29]=0x01; // - fac[30]=0x01; // - fac[31]=0x01; // - fac[32]=0x01; // - fac[33]=0x01; // 0x1 = sending complete - fac[34]=0x01; - fac[35]=0x01; - - memcpy((unsigned char *)fac+22,nr,strlen(nr)); - fac[22+strlen( nr)]=0x01; // fill with 0x01 if number is only 6 numbers (local call) - fac[23+strlen(nr)]=0x01; - fac[24+strlen(nr)]=0x01; - fac[25+strlen(nr)]=0x01; - fac[26+strlen(nr)]=0x01; - - fac[6]=18+strlen(nr); - fac[9]=15+strlen(nr); - fac[17]=7+strlen(nr); - fac[19]=2+strlen(nr); - fac[21]=strlen(nr); - - enc_ie_facility(ntmode, msg, &fac[4], 36-4, nt , bc); -} - - -/* IE_USERUSER */ -void enc_ie_useruser(unsigned char **ntmode, msg_t *msg, int protocol, unsigned 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; - - char debug[768]; - int i; - - if (protocol<0 || protocol>127) - { - printf("%s: ERROR: protocol(%d) is out of range.\n", __FUNCTION__, protocol); - return; - } - if (!user || user_len<=0) - { - return; - } - - i = 0; - while(i < user_len) - { - if (MISDN_IE_DEBG) printf(debug+(i*3), " %02x", user[i]); - i++; - } - - if (MISDN_IE_DEBG) printf(" protocol=%d user-user%s\n", protocol, debug); - - l = user_len; - p = msg_put(msg, l+3); - if (nt) - *ntmode = p+1; - else - qi->useruser = p - (unsigned char *)qi - sizeof(Q931_info_t); - p[0] = IE_USER_USER; - p[1] = l; - p[2] = 0x80 + protocol; - memcpy(p+3, user, user_len); -} - -void dec_ie_useruser(unsigned char *p, Q931_info_t *qi, int *protocol, unsigned char *user, int *user_len, int nt, struct misdn_bchannel *bc) -{ - char debug[768]; - int i; - - *user_len = 0; - *protocol = -1; - - if (!nt) - { - p = NULL; - if (qi->useruser) - p = (unsigned char *)qi + sizeof(Q931_info_t) + qi->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 */ - - i = 0; - while(i < *user_len) - { - if (MISDN_IE_DEBG) printf(debug+(i*3), " %02x", user[i]); - i++; - } - debug[i*3] = '\0'; - - if (MISDN_IE_DEBG) printf(" protocol=%d user-user%s\n", *protocol, debug); -} - - |