diff options
Diffstat (limited to '1.2-netsec/channels/iax2-parser.c')
-rw-r--r-- | 1.2-netsec/channels/iax2-parser.c | 951 |
1 files changed, 0 insertions, 951 deletions
diff --git a/1.2-netsec/channels/iax2-parser.c b/1.2-netsec/channels/iax2-parser.c deleted file mode 100644 index 3ef80a39c..000000000 --- a/1.2-netsec/channels/iax2-parser.c +++ /dev/null @@ -1,951 +0,0 @@ -/* - * Asterisk -- An open source telephony toolkit. - * - * Copyright (C) 1999 - 2005, Digium, Inc. - * - * Mark Spencer <markster@digium.com> - * - * See http://www.asterisk.org for more information about - * the Asterisk project. Please do not directly contact - * any of the maintainers of this project for assistance; - * the project provides a web site, mailing lists and IRC - * channels for your use. - * - * This program is free software, distributed under the terms of - * the GNU General Public License Version 2. See the LICENSE file - * at the top of the source tree. - */ - -/*! \file - * - * \brief Implementation of Inter-Asterisk eXchange Protocol, v 2 - * - */ - -#include <sys/types.h> -#include <sys/socket.h> -#include <string.h> -#include <netinet/in.h> -#include <arpa/inet.h> -#include <unistd.h> -#include <stdlib.h> -#include <stdio.h> - -#include "asterisk.h" - -ASTERISK_FILE_VERSION(__FILE__, "$Revision$") - -#include "asterisk/frame.h" -#include "asterisk/utils.h" -#include "asterisk/unaligned.h" -#include "iax2.h" -#include "iax2-parser.h" -#include "iax2-provision.h" - -static int frames = 0; -static int iframes = 0; -static int oframes = 0; - -static void internaloutput(const char *str) -{ - fputs(str, stdout); -} - -static void internalerror(const char *str) -{ - fprintf(stderr, "WARNING: %s", str); -} - -static void (*outputf)(const char *str) = internaloutput; -static void (*errorf)(const char *str) = internalerror; - -static void dump_addr(char *output, int maxlen, void *value, int len) -{ - struct sockaddr_in sin; - char iabuf[INET_ADDRSTRLEN]; - if (len == (int)sizeof(sin)) { - memcpy(&sin, value, len); - snprintf(output, maxlen, "IPV4 %s:%d", ast_inet_ntoa(iabuf, sizeof(iabuf), sin.sin_addr), ntohs(sin.sin_port)); - } else { - snprintf(output, maxlen, "Invalid Address"); - } -} - -static void dump_string(char *output, int maxlen, void *value, int len) -{ - maxlen--; - if (maxlen > len) - maxlen = len; - strncpy(output, value, maxlen); - output[maxlen] = '\0'; -} - -static void dump_prefs(char *output, int maxlen, void *value, int len) -{ - struct ast_codec_pref pref; - int total_len = 0; - - maxlen--; - total_len = maxlen; - - if (maxlen > len) - maxlen = len; - - strncpy(output, value, maxlen); - output[maxlen] = '\0'; - - ast_codec_pref_convert(&pref, output, total_len, 0); - memset(output,0,total_len); - ast_codec_pref_string(&pref, output, total_len); -} - -static void dump_int(char *output, int maxlen, void *value, int len) -{ - if (len == (int)sizeof(unsigned int)) - snprintf(output, maxlen, "%lu", (unsigned long)ntohl(get_unaligned_uint32(value))); - else - ast_copy_string(output, "Invalid INT", maxlen); -} - -static void dump_short(char *output, int maxlen, void *value, int len) -{ - if (len == (int)sizeof(unsigned short)) - snprintf(output, maxlen, "%d", ntohs(get_unaligned_uint16(value))); - else - ast_copy_string(output, "Invalid SHORT", maxlen); -} - -static void dump_byte(char *output, int maxlen, void *value, int len) -{ - if (len == (int)sizeof(unsigned char)) - snprintf(output, maxlen, "%d", *((unsigned char *)value)); - else - ast_copy_string(output, "Invalid BYTE", maxlen); -} - -static void dump_datetime(char *output, int maxlen, void *value, int len) -{ - struct tm tm; - unsigned long val = (unsigned long) ntohl(get_unaligned_uint32(value)); - if (len == (int)sizeof(unsigned int)) { - tm.tm_sec = (val & 0x1f) << 1; - tm.tm_min = (val >> 5) & 0x3f; - tm.tm_hour = (val >> 11) & 0x1f; - tm.tm_mday = (val >> 16) & 0x1f; - tm.tm_mon = ((val >> 21) & 0x0f) - 1; - tm.tm_year = ((val >> 25) & 0x7f) + 100; - strftime(output, maxlen, "%Y-%m-%d %T", &tm); - } else - ast_copy_string(output, "Invalid DATETIME format!", maxlen); -} - -static void dump_ipaddr(char *output, int maxlen, void *value, int len) -{ - struct sockaddr_in sin; - char iabuf[INET_ADDRSTRLEN]; - if (len == (int)sizeof(unsigned int)) { - memcpy(&sin.sin_addr, value, len); - ast_inet_ntoa(iabuf, sizeof(iabuf), sin.sin_addr); - snprintf(output, maxlen, "%s", iabuf); - } else - ast_copy_string(output, "Invalid IPADDR", maxlen); -} - - -static void dump_prov_flags(char *output, int maxlen, void *value, int len) -{ - char buf[256] = ""; - if (len == (int)sizeof(unsigned int)) - snprintf(output, maxlen, "%lu (%s)", (unsigned long)ntohl(get_unaligned_uint32(value)), - iax_provflags2str(buf, sizeof(buf), ntohl(get_unaligned_uint32(value)))); - else - ast_copy_string(output, "Invalid INT", maxlen); -} - -static void dump_samprate(char *output, int maxlen, void *value, int len) -{ - char tmp[256]=""; - int sr; - if (len == (int)sizeof(unsigned short)) { - sr = ntohs(*((unsigned short *)value)); - if (sr & IAX_RATE_8KHZ) - strcat(tmp, ",8khz"); - if (sr & IAX_RATE_11KHZ) - strcat(tmp, ",11.025khz"); - if (sr & IAX_RATE_16KHZ) - strcat(tmp, ",16khz"); - if (sr & IAX_RATE_22KHZ) - strcat(tmp, ",22.05khz"); - if (sr & IAX_RATE_44KHZ) - strcat(tmp, ",44.1khz"); - if (sr & IAX_RATE_48KHZ) - strcat(tmp, ",48khz"); - if (strlen(tmp)) - ast_copy_string(output, &tmp[1], maxlen); - else - ast_copy_string(output, "None Specified!\n", maxlen); - } else - ast_copy_string(output, "Invalid SHORT", maxlen); - -} - -static void dump_prov_ies(char *output, int maxlen, unsigned char *iedata, int len); -static void dump_prov(char *output, int maxlen, void *value, int len) -{ - dump_prov_ies(output, maxlen, value, len); -} - -static struct iax2_ie { - int ie; - char *name; - void (*dump)(char *output, int maxlen, void *value, int len); -} ies[] = { - { IAX_IE_CALLED_NUMBER, "CALLED NUMBER", dump_string }, - { IAX_IE_CALLING_NUMBER, "CALLING NUMBER", dump_string }, - { IAX_IE_CALLING_ANI, "ANI", dump_string }, - { IAX_IE_CALLING_NAME, "CALLING NAME", dump_string }, - { IAX_IE_CALLED_CONTEXT, "CALLED CONTEXT", dump_string }, - { IAX_IE_USERNAME, "USERNAME", dump_string }, - { IAX_IE_PASSWORD, "PASSWORD", dump_string }, - { IAX_IE_CAPABILITY, "CAPABILITY", dump_int }, - { IAX_IE_FORMAT, "FORMAT", dump_int }, - { IAX_IE_LANGUAGE, "LANGUAGE", dump_string }, - { IAX_IE_VERSION, "VERSION", dump_short }, - { IAX_IE_ADSICPE, "ADSICPE", dump_short }, - { IAX_IE_DNID, "DNID", dump_string }, - { IAX_IE_AUTHMETHODS, "AUTHMETHODS", dump_short }, - { IAX_IE_CHALLENGE, "CHALLENGE", dump_string }, - { IAX_IE_MD5_RESULT, "MD5 RESULT", dump_string }, - { IAX_IE_RSA_RESULT, "RSA RESULT", dump_string }, - { IAX_IE_APPARENT_ADDR, "APPARENT ADDRESS", dump_addr }, - { IAX_IE_REFRESH, "REFRESH", dump_short }, - { IAX_IE_DPSTATUS, "DIALPLAN STATUS", dump_short }, - { IAX_IE_CALLNO, "CALL NUMBER", dump_short }, - { IAX_IE_CAUSE, "CAUSE", dump_string }, - { IAX_IE_IAX_UNKNOWN, "UNKNOWN IAX CMD", dump_byte }, - { IAX_IE_MSGCOUNT, "MESSAGE COUNT", dump_short }, - { IAX_IE_AUTOANSWER, "AUTO ANSWER REQ" }, - { IAX_IE_TRANSFERID, "TRANSFER ID", dump_int }, - { IAX_IE_RDNIS, "REFERRING DNIS", dump_string }, - { IAX_IE_PROVISIONING, "PROVISIONING", dump_prov }, - { IAX_IE_AESPROVISIONING, "AES PROVISIONG" }, - { IAX_IE_DATETIME, "DATE TIME", dump_datetime }, - { IAX_IE_DEVICETYPE, "DEVICE TYPE", dump_string }, - { IAX_IE_SERVICEIDENT, "SERVICE IDENT", dump_string }, - { IAX_IE_FIRMWAREVER, "FIRMWARE VER", dump_short }, - { IAX_IE_FWBLOCKDESC, "FW BLOCK DESC", dump_int }, - { IAX_IE_FWBLOCKDATA, "FW BLOCK DATA" }, - { IAX_IE_PROVVER, "PROVISIONG VER", dump_int }, - { IAX_IE_CALLINGPRES, "CALLING PRESNTN", dump_byte }, - { IAX_IE_CALLINGTON, "CALLING TYPEOFNUM", dump_byte }, - { IAX_IE_CALLINGTNS, "CALLING TRANSITNET", dump_short }, - { IAX_IE_SAMPLINGRATE, "SAMPLINGRATE", dump_samprate }, - { IAX_IE_CAUSECODE, "CAUSE CODE", dump_byte }, - { IAX_IE_ENCRYPTION, "ENCRYPTION", dump_short }, - { IAX_IE_ENCKEY, "ENCRYPTION KEY" }, - { IAX_IE_CODEC_PREFS, "CODEC_PREFS", dump_prefs }, - { IAX_IE_RR_JITTER, "RR_JITTER", dump_int }, - { IAX_IE_RR_LOSS, "RR_LOSS", dump_int }, - { IAX_IE_RR_PKTS, "RR_PKTS", dump_int }, - { IAX_IE_RR_DELAY, "RR_DELAY", dump_short }, - { IAX_IE_RR_DROPPED, "RR_DROPPED", dump_int }, - { IAX_IE_RR_OOO, "RR_OUTOFORDER", dump_int }, -}; - -static struct iax2_ie prov_ies[] = { - { PROV_IE_USEDHCP, "USEDHCP" }, - { PROV_IE_IPADDR, "IPADDR", dump_ipaddr }, - { PROV_IE_SUBNET, "SUBNET", dump_ipaddr }, - { PROV_IE_GATEWAY, "GATEWAY", dump_ipaddr }, - { PROV_IE_PORTNO, "BINDPORT", dump_short }, - { PROV_IE_USER, "USERNAME", dump_string }, - { PROV_IE_PASS, "PASSWORD", dump_string }, - { PROV_IE_LANG, "LANGUAGE", dump_string }, - { PROV_IE_TOS, "TYPEOFSERVICE", dump_byte }, - { PROV_IE_FLAGS, "FLAGS", dump_prov_flags }, - { PROV_IE_FORMAT, "FORMAT", dump_int }, - { PROV_IE_AESKEY, "AESKEY" }, - { PROV_IE_SERVERIP, "SERVERIP", dump_ipaddr }, - { PROV_IE_SERVERPORT, "SERVERPORT", dump_short }, - { PROV_IE_NEWAESKEY, "NEWAESKEY" }, - { PROV_IE_PROVVER, "PROV VERSION", dump_int }, - { PROV_IE_ALTSERVER, "ALTSERVERIP", dump_ipaddr }, -}; - -const char *iax_ie2str(int ie) -{ - int x; - for (x=0;x<(int)sizeof(ies) / (int)sizeof(ies[0]); x++) { - if (ies[x].ie == ie) - return ies[x].name; - } - return "Unknown IE"; -} - - -static void dump_prov_ies(char *output, int maxlen, unsigned char *iedata, int len) -{ - int ielen; - int ie; - int x; - int found; - char interp[80]; - char tmp[256]; - if (len < 2) - return; - strcpy(output, "\n"); - maxlen -= strlen(output); output += strlen(output); - while(len > 2) { - ie = iedata[0]; - ielen = iedata[1]; - if (ielen + 2> len) { - snprintf(tmp, (int)sizeof(tmp), "Total Prov IE length of %d bytes exceeds remaining prov frame length of %d bytes\n", ielen + 2, len); - ast_copy_string(output, tmp, maxlen); - maxlen -= strlen(output); - output += strlen(output); - return; - } - found = 0; - for (x=0;x<(int)sizeof(prov_ies) / (int)sizeof(prov_ies[0]); x++) { - if (prov_ies[x].ie == ie) { - if (prov_ies[x].dump) { - prov_ies[x].dump(interp, (int)sizeof(interp), iedata + 2, ielen); - snprintf(tmp, (int)sizeof(tmp), " %-15.15s : %s\n", prov_ies[x].name, interp); - ast_copy_string(output, tmp, maxlen); - maxlen -= strlen(output); output += strlen(output); - } else { - if (ielen) - snprintf(interp, (int)sizeof(interp), "%d bytes", ielen); - else - strcpy(interp, "Present"); - snprintf(tmp, (int)sizeof(tmp), " %-15.15s : %s\n", prov_ies[x].name, interp); - ast_copy_string(output, tmp, maxlen); - maxlen -= strlen(output); output += strlen(output); - } - found++; - } - } - if (!found) { - snprintf(tmp, (int)sizeof(tmp), " Unknown Prov IE %03d : Present\n", ie); - ast_copy_string(output, tmp, maxlen); - maxlen -= strlen(output); output += strlen(output); - } - iedata += (2 + ielen); - len -= (2 + ielen); - } -} - -static void dump_ies(unsigned char *iedata, int len) -{ - int ielen; - int ie; - int x; - int found; - char interp[1024]; - char tmp[1024]; - if (len < 2) - return; - while(len > 2) { - ie = iedata[0]; - ielen = iedata[1]; - if (ielen + 2> len) { - snprintf(tmp, (int)sizeof(tmp), "Total IE length of %d bytes exceeds remaining frame length of %d bytes\n", ielen + 2, len); - outputf(tmp); - return; - } - found = 0; - for (x=0;x<(int)sizeof(ies) / (int)sizeof(ies[0]); x++) { - if (ies[x].ie == ie) { - if (ies[x].dump) { - ies[x].dump(interp, (int)sizeof(interp), iedata + 2, ielen); - snprintf(tmp, (int)sizeof(tmp), " %-15.15s : %s\n", ies[x].name, interp); - outputf(tmp); - } else { - if (ielen) - snprintf(interp, (int)sizeof(interp), "%d bytes", ielen); - else - strcpy(interp, "Present"); - snprintf(tmp, (int)sizeof(tmp), " %-15.15s : %s\n", ies[x].name, interp); - outputf(tmp); - } - found++; - } - } - if (!found) { - snprintf(tmp, (int)sizeof(tmp), " Unknown IE %03d : Present\n", ie); - outputf(tmp); - } - iedata += (2 + ielen); - len -= (2 + ielen); - } - outputf("\n"); -} - -void iax_showframe(struct iax_frame *f, struct ast_iax2_full_hdr *fhi, int rx, struct sockaddr_in *sin, int datalen) -{ - const char *frames[] = { - "(0?)", - "DTMF ", - "VOICE ", - "VIDEO ", - "CONTROL", - "NULL ", - "IAX ", - "TEXT ", - "IMAGE ", - "HTML ", - "CNG " }; - const char *iaxs[] = { - "(0?)", - "NEW ", - "PING ", - "PONG ", - "ACK ", - "HANGUP ", - "REJECT ", - "ACCEPT ", - "AUTHREQ", - "AUTHREP", - "INVAL ", - "LAGRQ ", - "LAGRP ", - "REGREQ ", - "REGAUTH", - "REGACK ", - "REGREJ ", - "REGREL ", - "VNAK ", - "DPREQ ", - "DPREP ", - "DIAL ", - "TXREQ ", - "TXCNT ", - "TXACC ", - "TXREADY", - "TXREL ", - "TXREJ ", - "QUELCH ", - "UNQULCH", - "POKE ", - "PAGE ", - "MWI ", - "UNSPRTD", - "TRANSFR", - "PROVISN", - "FWDWNLD", - "FWDATA " - }; - const char *cmds[] = { - "(0?)", - "HANGUP ", - "RING ", - "RINGING", - "ANSWER ", - "BUSY ", - "TKOFFHK", - "OFFHOOK" }; - struct ast_iax2_full_hdr *fh; - char retries[20]; - char class2[20]; - char subclass2[20]; - const char *class; - const char *subclass; - char *dir; - char tmp[512]; - char iabuf[INET_ADDRSTRLEN]; - - switch(rx) { - case 0: - dir = "Tx"; - break; - case 2: - dir = "TE"; - break; - case 3: - dir = "RD"; - break; - default: - dir = "Rx"; - break; - } - if (f) { - fh = f->data; - snprintf(retries, sizeof(retries), "%03d", f->retries); - } else { - fh = fhi; - if (ntohs(fh->dcallno) & IAX_FLAG_RETRANS) - strcpy(retries, "Yes"); - else - strcpy(retries, " No"); - } - if (!(ntohs(fh->scallno) & IAX_FLAG_FULL)) { - /* Don't mess with mini-frames */ - return; - } - if (fh->type >= (int)sizeof(frames)/(int)sizeof(frames[0])) { - snprintf(class2, sizeof(class2), "(%d?)", fh->type); - class = class2; - } else { - class = frames[(int)fh->type]; - } - if (fh->type == AST_FRAME_DTMF) { - sprintf(subclass2, "%c", fh->csub); - subclass = subclass2; - } else if (fh->type == AST_FRAME_IAX) { - if (fh->csub >= (int)sizeof(iaxs)/(int)sizeof(iaxs[0])) { - snprintf(subclass2, sizeof(subclass2), "(%d?)", fh->csub); - subclass = subclass2; - } else { - subclass = iaxs[(int)fh->csub]; - } - } else if (fh->type == AST_FRAME_CONTROL) { - if (fh->csub >= (int)sizeof(cmds)/(int)sizeof(cmds[0])) { - snprintf(subclass2, sizeof(subclass2), "(%d?)", fh->csub); - subclass = subclass2; - } else { - subclass = cmds[(int)fh->csub]; - } - } else { - snprintf(subclass2, sizeof(subclass2), "%d", fh->csub); - subclass = subclass2; - } - snprintf(tmp, sizeof(tmp), - "%s-Frame Retry[%s] -- OSeqno: %3.3d ISeqno: %3.3d Type: %s Subclass: %s\n", - dir, - retries, fh->oseqno, fh->iseqno, class, subclass); - outputf(tmp); - snprintf(tmp, sizeof(tmp), - " Timestamp: %05lums SCall: %5.5d DCall: %5.5d [%s:%d]\n", - (unsigned long)ntohl(fh->ts), - ntohs(fh->scallno) & ~IAX_FLAG_FULL, ntohs(fh->dcallno) & ~IAX_FLAG_RETRANS, - ast_inet_ntoa(iabuf, sizeof(iabuf), sin->sin_addr), ntohs(sin->sin_port)); - outputf(tmp); - if (fh->type == AST_FRAME_IAX) - dump_ies(fh->iedata, datalen); -} - -int iax_ie_append_raw(struct iax_ie_data *ied, unsigned char ie, void *data, int datalen) -{ - char tmp[256]; - if (datalen > ((int)sizeof(ied->buf) - ied->pos)) { - snprintf(tmp, (int)sizeof(tmp), "Out of space for ie '%s' (%d), need %d have %d\n", iax_ie2str(ie), ie, datalen, (int)sizeof(ied->buf) - ied->pos); - errorf(tmp); - return -1; - } - ied->buf[ied->pos++] = ie; - ied->buf[ied->pos++] = datalen; - memcpy(ied->buf + ied->pos, data, datalen); - ied->pos += datalen; - return 0; -} - -int iax_ie_append_addr(struct iax_ie_data *ied, unsigned char ie, struct sockaddr_in *sin) -{ - return iax_ie_append_raw(ied, ie, sin, (int)sizeof(struct sockaddr_in)); -} - -int iax_ie_append_int(struct iax_ie_data *ied, unsigned char ie, unsigned int value) -{ - unsigned int newval; - newval = htonl(value); - return iax_ie_append_raw(ied, ie, &newval, (int)sizeof(newval)); -} - -int iax_ie_append_short(struct iax_ie_data *ied, unsigned char ie, unsigned short value) -{ - unsigned short newval; - newval = htons(value); - return iax_ie_append_raw(ied, ie, &newval, (int)sizeof(newval)); -} - -int iax_ie_append_str(struct iax_ie_data *ied, unsigned char ie, char *str) -{ - return iax_ie_append_raw(ied, ie, str, strlen(str)); -} - -int iax_ie_append_byte(struct iax_ie_data *ied, unsigned char ie, unsigned char dat) -{ - return iax_ie_append_raw(ied, ie, &dat, 1); -} - -int iax_ie_append(struct iax_ie_data *ied, unsigned char ie) -{ - return iax_ie_append_raw(ied, ie, NULL, 0); -} - -void iax_set_output(void (*func)(const char *)) -{ - outputf = func; -} - -void iax_set_error(void (*func)(const char *)) -{ - errorf = func; -} - -int iax_parse_ies(struct iax_ies *ies, unsigned char *data, int datalen) -{ - /* Parse data into information elements */ - int len; - int ie; - char tmp[256]; - memset(ies, 0, (int)sizeof(struct iax_ies)); - ies->msgcount = -1; - ies->firmwarever = -1; - ies->calling_ton = -1; - ies->calling_tns = -1; - ies->calling_pres = -1; - ies->samprate = IAX_RATE_8KHZ; - while(datalen >= 2) { - ie = data[0]; - len = data[1]; - if (len > datalen - 2) { - errorf("Information element length exceeds message size\n"); - return -1; - } - switch(ie) { - case IAX_IE_CALLED_NUMBER: - ies->called_number = (char *)data + 2; - break; - case IAX_IE_CALLING_NUMBER: - ies->calling_number = (char *)data + 2; - break; - case IAX_IE_CALLING_ANI: - ies->calling_ani = (char *)data + 2; - break; - case IAX_IE_CALLING_NAME: - ies->calling_name = (char *)data + 2; - break; - case IAX_IE_CALLED_CONTEXT: - ies->called_context = (char *)data + 2; - break; - case IAX_IE_USERNAME: - ies->username = (char *)data + 2; - break; - case IAX_IE_PASSWORD: - ies->password = (char *)data + 2; - break; - case IAX_IE_CODEC_PREFS: - ies->codec_prefs = (char *)data + 2; - break; - case IAX_IE_CAPABILITY: - if (len != (int)sizeof(unsigned int)) { - snprintf(tmp, (int)sizeof(tmp), "Expecting capability to be %d bytes long but was %d\n", (int)sizeof(unsigned int), len); - errorf(tmp); - } else - ies->capability = ntohl(get_unaligned_uint32(data + 2)); - break; - case IAX_IE_FORMAT: - if (len != (int)sizeof(unsigned int)) { - snprintf(tmp, (int)sizeof(tmp), "Expecting format to be %d bytes long but was %d\n", (int)sizeof(unsigned int), len); - errorf(tmp); - } else - ies->format = ntohl(get_unaligned_uint32(data + 2)); - break; - case IAX_IE_LANGUAGE: - ies->language = (char *)data + 2; - break; - case IAX_IE_VERSION: - if (len != (int)sizeof(unsigned short)) { - snprintf(tmp, (int)sizeof(tmp), "Expecting version to be %d bytes long but was %d\n", (int)sizeof(unsigned short), len); - errorf(tmp); - } else - ies->version = ntohs(get_unaligned_uint16(data + 2)); - break; - case IAX_IE_ADSICPE: - if (len != (int)sizeof(unsigned short)) { - snprintf(tmp, (int)sizeof(tmp), "Expecting adsicpe to be %d bytes long but was %d\n", (int)sizeof(unsigned short), len); - errorf(tmp); - } else - ies->adsicpe = ntohs(get_unaligned_uint16(data + 2)); - break; - case IAX_IE_SAMPLINGRATE: - if (len != (int)sizeof(unsigned short)) { - snprintf(tmp, (int)sizeof(tmp), "Expecting samplingrate to be %d bytes long but was %d\n", (int)sizeof(unsigned short), len); - errorf(tmp); - } else - ies->samprate = ntohs(get_unaligned_uint16(data + 2)); - break; - case IAX_IE_DNID: - ies->dnid = (char *)data + 2; - break; - case IAX_IE_RDNIS: - ies->rdnis = (char *)data + 2; - break; - case IAX_IE_AUTHMETHODS: - if (len != (int)sizeof(unsigned short)) { - snprintf(tmp, (int)sizeof(tmp), "Expecting authmethods to be %d bytes long but was %d\n", (int)sizeof(unsigned short), len); - errorf(tmp); - } else - ies->authmethods = ntohs(get_unaligned_uint16(data + 2)); - break; - case IAX_IE_ENCRYPTION: - if (len != (int)sizeof(unsigned short)) { - snprintf(tmp, (int)sizeof(tmp), "Expecting encryption to be %d bytes long but was %d\n", (int)sizeof(unsigned short), len); - errorf(tmp); - } else - ies->encmethods = ntohs(get_unaligned_uint16(data + 2)); - break; - case IAX_IE_CHALLENGE: - ies->challenge = (char *)data + 2; - break; - case IAX_IE_MD5_RESULT: - ies->md5_result = (char *)data + 2; - break; - case IAX_IE_RSA_RESULT: - ies->rsa_result = (char *)data + 2; - break; - case IAX_IE_APPARENT_ADDR: - ies->apparent_addr = ((struct sockaddr_in *)(data + 2)); - break; - case IAX_IE_REFRESH: - if (len != (int)sizeof(unsigned short)) { - snprintf(tmp, (int)sizeof(tmp), "Expecting refresh to be %d bytes long but was %d\n", (int)sizeof(unsigned short), len); - errorf(tmp); - } else - ies->refresh = ntohs(get_unaligned_uint16(data + 2)); - break; - case IAX_IE_DPSTATUS: - if (len != (int)sizeof(unsigned short)) { - snprintf(tmp, (int)sizeof(tmp), "Expecting dpstatus to be %d bytes long but was %d\n", (int)sizeof(unsigned short), len); - errorf(tmp); - } else - ies->dpstatus = ntohs(get_unaligned_uint16(data + 2)); - break; - case IAX_IE_CALLNO: - if (len != (int)sizeof(unsigned short)) { - snprintf(tmp, (int)sizeof(tmp), "Expecting callno to be %d bytes long but was %d\n", (int)sizeof(unsigned short), len); - errorf(tmp); - } else - ies->callno = ntohs(get_unaligned_uint16(data + 2)); - break; - case IAX_IE_CAUSE: - ies->cause = (char *)data + 2; - break; - case IAX_IE_CAUSECODE: - if (len != 1) { - snprintf(tmp, (int)sizeof(tmp), "Expecting causecode to be single byte but was %d\n", len); - errorf(tmp); - } else { - ies->causecode = data[2]; - } - break; - case IAX_IE_IAX_UNKNOWN: - if (len == 1) - ies->iax_unknown = data[2]; - else { - snprintf(tmp, (int)sizeof(tmp), "Expected single byte Unknown command, but was %d long\n", len); - errorf(tmp); - } - break; - case IAX_IE_MSGCOUNT: - if (len != (int)sizeof(unsigned short)) { - snprintf(tmp, (int)sizeof(tmp), "Expecting msgcount to be %d bytes long but was %d\n", (int)sizeof(unsigned short), len); - errorf(tmp); - } else - ies->msgcount = ntohs(get_unaligned_uint16(data + 2)); - break; - case IAX_IE_AUTOANSWER: - ies->autoanswer = 1; - break; - case IAX_IE_MUSICONHOLD: - ies->musiconhold = 1; - break; - case IAX_IE_TRANSFERID: - if (len != (int)sizeof(unsigned int)) { - snprintf(tmp, (int)sizeof(tmp), "Expecting transferid to be %d bytes long but was %d\n", (int)sizeof(unsigned int), len); - errorf(tmp); - } else - ies->transferid = ntohl(get_unaligned_uint32(data + 2)); - break; - case IAX_IE_DATETIME: - if (len != (int)sizeof(unsigned int)) { - snprintf(tmp, (int)sizeof(tmp), "Expecting date/time to be %d bytes long but was %d\n", (int)sizeof(unsigned int), len); - errorf(tmp); - } else - ies->datetime = ntohl(get_unaligned_uint32(data + 2)); - break; - case IAX_IE_FIRMWAREVER: - if (len != (int)sizeof(unsigned short)) { - snprintf(tmp, (int)sizeof(tmp), "Expecting firmwarever to be %d bytes long but was %d\n", (int)sizeof(unsigned short), len); - errorf(tmp); - } else - ies->firmwarever = ntohs(get_unaligned_uint16(data + 2)); - break; - case IAX_IE_DEVICETYPE: - ies->devicetype = (char *)data + 2; - break; - case IAX_IE_SERVICEIDENT: - ies->serviceident = (char *)data + 2; - break; - case IAX_IE_FWBLOCKDESC: - if (len != (int)sizeof(unsigned int)) { - snprintf(tmp, (int)sizeof(tmp), "Expected block desc to be %d bytes long but was %d\n", (int)sizeof(unsigned int), len); - errorf(tmp); - } else - ies->fwdesc = ntohl(get_unaligned_uint32(data + 2)); - break; - case IAX_IE_FWBLOCKDATA: - ies->fwdata = data + 2; - ies->fwdatalen = len; - break; - case IAX_IE_ENCKEY: - ies->enckey = data + 2; - ies->enckeylen = len; - break; - case IAX_IE_PROVVER: - if (len != (int)sizeof(unsigned int)) { - snprintf(tmp, (int)sizeof(tmp), "Expected provisioning version to be %d bytes long but was %d\n", (int)sizeof(unsigned int), len); - errorf(tmp); - } else { - ies->provverpres = 1; - ies->provver = ntohl(get_unaligned_uint32(data + 2)); - } - break; - case IAX_IE_CALLINGPRES: - if (len == 1) - ies->calling_pres = data[2]; - else { - snprintf(tmp, (int)sizeof(tmp), "Expected single byte callingpres, but was %d long\n", len); - errorf(tmp); - } - break; - case IAX_IE_CALLINGTON: - if (len == 1) - ies->calling_ton = data[2]; - else { - snprintf(tmp, (int)sizeof(tmp), "Expected single byte callington, but was %d long\n", len); - errorf(tmp); - } - break; - case IAX_IE_CALLINGTNS: - if (len != (int)sizeof(unsigned short)) { - snprintf(tmp, (int)sizeof(tmp), "Expecting callingtns to be %d bytes long but was %d\n", (int)sizeof(unsigned short), len); - errorf(tmp); - } else - ies->calling_tns = ntohs(get_unaligned_uint16(data + 2)); - break; - case IAX_IE_RR_JITTER: - if (len != (int)sizeof(unsigned int)) { - snprintf(tmp, (int)sizeof(tmp), "Expected jitter rr to be %d bytes long but was %d\n", (int)sizeof(unsigned int), len); - errorf(tmp); - } else { - ies->rr_jitter = ntohl(get_unaligned_uint32(data + 2)); - } - break; - case IAX_IE_RR_LOSS: - if (len != (int)sizeof(unsigned int)) { - snprintf(tmp, (int)sizeof(tmp), "Expected loss rr to be %d bytes long but was %d\n", (int)sizeof(unsigned int), len); - errorf(tmp); - } else { - ies->rr_loss = ntohl(get_unaligned_uint32(data + 2)); - } - break; - case IAX_IE_RR_PKTS: - if (len != (int)sizeof(unsigned int)) { - snprintf(tmp, (int)sizeof(tmp), "Expected packets rr to be %d bytes long but was %d\n", (int)sizeof(unsigned int), len); - errorf(tmp); - } else { - ies->rr_pkts = ntohl(get_unaligned_uint32(data + 2)); - } - break; - case IAX_IE_RR_DELAY: - if (len != (int)sizeof(unsigned short)) { - snprintf(tmp, (int)sizeof(tmp), "Expected loss rr to be %d bytes long but was %d\n", (int)sizeof(unsigned short), len); - errorf(tmp); - } else { - ies->rr_delay = ntohs(get_unaligned_uint16(data + 2)); - } - break; - case IAX_IE_RR_DROPPED: - if (len != (int)sizeof(unsigned int)) { - snprintf(tmp, (int)sizeof(tmp), "Expected packets rr to be %d bytes long but was %d\n", (int)sizeof(unsigned int), len); - errorf(tmp); - } else { - ies->rr_dropped = ntohl(get_unaligned_uint32(data + 2)); - } - break; - case IAX_IE_RR_OOO: - if (len != (int)sizeof(unsigned int)) { - snprintf(tmp, (int)sizeof(tmp), "Expected packets rr to be %d bytes long but was %d\n", (int)sizeof(unsigned int), len); - errorf(tmp); - } else { - ies->rr_ooo = ntohl(get_unaligned_uint32(data + 2)); - } - break; - default: - snprintf(tmp, (int)sizeof(tmp), "Ignoring unknown information element '%s' (%d) of length %d\n", iax_ie2str(ie), ie, len); - outputf(tmp); - } - /* Overwrite information element with 0, to null terminate previous portion */ - data[0] = 0; - datalen -= (len + 2); - data += (len + 2); - } - /* Null-terminate last field */ - *data = '\0'; - if (datalen) { - errorf("Invalid information element contents, strange boundary\n"); - return -1; - } - return 0; -} - -void iax_frame_wrap(struct iax_frame *fr, struct ast_frame *f) -{ - fr->af.frametype = f->frametype; - fr->af.subclass = f->subclass; - fr->af.mallocd = 0; /* Our frame is static relative to the container */ - fr->af.datalen = f->datalen; - fr->af.samples = f->samples; - fr->af.offset = AST_FRIENDLY_OFFSET; - fr->af.src = f->src; - fr->af.delivery.tv_sec = 0; - fr->af.delivery.tv_usec = 0; - fr->af.data = fr->afdata; - if (fr->af.datalen) { -#if __BYTE_ORDER == __LITTLE_ENDIAN - /* We need to byte-swap slinear samples from network byte order */ - if ((fr->af.frametype == AST_FRAME_VOICE) && (fr->af.subclass == AST_FORMAT_SLINEAR)) { - ast_swapcopy_samples(fr->af.data, f->data, fr->af.samples); - } else -#endif - memcpy(fr->af.data, f->data, fr->af.datalen); - } -} - -struct iax_frame *iax_frame_new(int direction, int datalen) -{ - struct iax_frame *fr; - fr = malloc((int)sizeof(struct iax_frame) + datalen); - if (fr) { - fr->direction = direction; - fr->retrans = -1; - frames++; - if (fr->direction == DIRECTION_INGRESS) - iframes++; - else - oframes++; - } - return fr; -} - -void iax_frame_free(struct iax_frame *fr) -{ - /* Note: does not remove from scheduler! */ - if (fr->direction == DIRECTION_INGRESS) - iframes--; - else if (fr->direction == DIRECTION_OUTGRESS) - oframes--; - else { - errorf("Attempt to double free frame detected\n"); - return; - } - fr->direction = 0; - free(fr); - frames--; -} - -int iax_get_frames(void) { return frames; } -int iax_get_iframes(void) { return iframes; } -int iax_get_oframes(void) { return oframes; } |