2 * Asterisk -- A telephony toolkit for Linux.
4 * Implementation of Inter-Asterisk eXchange
6 * Copyright (C) 2003, Digium
8 * Mark Spencer <markster@linux-support.net>
10 * This program is free software, distributed under the terms of
11 * the GNU General Public License
14 #include <sys/types.h>
15 #include <sys/socket.h>
17 #include <netinet/in.h>
18 #include <asterisk/frame.h>
19 #include <arpa/inet.h>
24 #include "iax2-parser.h"
27 static int frames = 0;
28 static int iframes = 0;
29 static int oframes = 0;
31 static void internaloutput(const char *str)
36 static void internalerror(const char *str)
38 fprintf(stderr, "WARNING: %s", str);
41 static void (*outputf)(const char *str) = internaloutput;
42 static void (*errorf)(const char *str) = internalerror;
44 static void dump_addr(char *output, int maxlen, void *value, int len)
46 struct sockaddr_in sin;
47 if (len == sizeof(sin)) {
48 memcpy(&sin, value, len);
49 snprintf(output, maxlen, "IPV4 %s:%d", inet_ntoa(sin.sin_addr), ntohs(sin.sin_port));
51 snprintf(output, maxlen, "Invalid Address");
55 static void dump_string(char *output, int maxlen, void *value, int len)
60 strncpy(output,value, maxlen);
61 output[maxlen] = '\0';
64 static void dump_int(char *output, int maxlen, void *value, int len)
66 if (len == sizeof(unsigned int))
67 snprintf(output, maxlen, "%lu", (unsigned long)ntohl(*((unsigned int *)value)));
69 snprintf(output, maxlen, "Invalid INT");
72 static void dump_short(char *output, int maxlen, void *value, int len)
74 if (len == sizeof(unsigned short))
75 snprintf(output, maxlen, "%d", ntohs(*((unsigned short *)value)));
77 snprintf(output, maxlen, "Invalid SHORT");
80 static void dump_byte(char *output, int maxlen, void *value, int len)
82 if (len == sizeof(unsigned char))
83 snprintf(output, maxlen, "%d", ntohs(*((unsigned char *)value)));
85 snprintf(output, maxlen, "Invalid BYTE");
88 static struct iax2_ie {
91 void (*dump)(char *output, int maxlen, void *value, int len);
93 { IAX_IE_CALLED_NUMBER, "CALLED NUMBER", dump_string },
94 { IAX_IE_CALLING_NUMBER, "CALLING NUMBER", dump_string },
95 { IAX_IE_CALLING_ANI, "ANI", dump_string },
96 { IAX_IE_CALLING_NAME, "CALLING NAME", dump_string },
97 { IAX_IE_CALLED_CONTEXT, "CALLED CONTEXT", dump_string },
98 { IAX_IE_USERNAME, "USERNAME", dump_string },
99 { IAX_IE_PASSWORD, "PASSWORD", dump_string },
100 { IAX_IE_CAPABILITY, "CAPABILITY", dump_int },
101 { IAX_IE_FORMAT, "FORMAT", dump_int },
102 { IAX_IE_LANGUAGE, "LANGUAGE", dump_string },
103 { IAX_IE_VERSION, "VERSION", dump_short },
104 { IAX_IE_ADSICPE, "ADSICPE", dump_short },
105 { IAX_IE_DNID, "DNID", dump_string },
106 { IAX_IE_AUTHMETHODS, "AUTHMETHODS", dump_short },
107 { IAX_IE_CHALLENGE, "CHALLENGE", dump_string },
108 { IAX_IE_MD5_RESULT, "MD5 RESULT", dump_string },
109 { IAX_IE_RSA_RESULT, "RSA RESULT", dump_string },
110 { IAX_IE_APPARENT_ADDR, "APPARENT ADDRESS", dump_addr },
111 { IAX_IE_REFRESH, "REFRESH", dump_short },
112 { IAX_IE_DPSTATUS, "DIALPLAN STATUS", dump_short },
113 { IAX_IE_CALLNO, "CALL NUMBER", dump_short },
114 { IAX_IE_CAUSE, "CAUSE", dump_string },
115 { IAX_IE_IAX_UNKNOWN, "UNKNOWN IAX CMD", dump_byte },
116 { IAX_IE_MSGCOUNT, "MESSAGE COUNT", dump_short },
117 { IAX_IE_AUTOANSWER, "AUTO ANSWER REQ" },
118 { IAX_IE_TRANSFERID, "TRANSFER ID", dump_int },
119 { IAX_IE_RDNIS, "REFERRING DNIS", dump_string },
120 { IAX_IE_PROVISIONING, "PROVISIONING" },
121 { IAX_IE_AESPROVISIONING, "AES PROVISIONG" },
122 { IAX_IE_DATETIME, "DATE TIME", dump_int },
123 { IAX_IE_DEVICETYPE, "DEVICE TYPE", dump_string },
124 { IAX_IE_SERVICEIDENT, "SERVICE IDENT", dump_string },
125 { IAX_IE_FIRMWAREVER, "FIRMWARE VER", dump_short },
126 { IAX_IE_FWBLOCKDESC, "FW BLOCK DESC", dump_int },
127 { IAX_IE_FWBLOCKDATA, "FW BLOCK DATA" },
128 { IAX_IE_PROVVER, "PROVISIONG VER", dump_int },
131 const char *iax_ie2str(int ie)
134 for (x=0;x<sizeof(ies) / sizeof(ies[0]); x++) {
141 static void dump_ies(unsigned char *iedata, int len)
154 if (ielen + 2> len) {
155 snprintf(tmp, sizeof(tmp), "Total IE length of %d bytes exceeds remaining frame length of %d bytes\n", ielen + 2, len);
160 for (x=0;x<sizeof(ies) / sizeof(ies[0]); x++) {
161 if (ies[x].ie == ie) {
163 ies[x].dump(interp, sizeof(interp), iedata + 2, ielen);
164 snprintf(tmp, sizeof(tmp), " %-15.15s : %s\n", ies[x].name, interp);
168 snprintf(interp, sizeof(interp), "%d bytes", ielen);
170 strcpy(interp, "Present");
171 snprintf(tmp, sizeof(tmp), " %-15.15s : %s\n", ies[x].name, interp);
178 snprintf(tmp, sizeof(tmp), " Unknown IE %03d : Present\n", ie);
181 iedata += (2 + ielen);
187 void iax_showframe(struct iax_frame *f, struct ast_iax2_full_hdr *fhi, int rx, struct sockaddr_in *sin, int datalen)
248 struct ast_iax2_full_hdr *fh;
257 snprintf(retries, sizeof(retries), "%03d", f->retries);
260 if (ntohs(fh->dcallno) & IAX_FLAG_RETRANS)
261 strcpy(retries, "Yes");
263 strcpy(retries, "No");
265 if (!(ntohs(fh->scallno) & IAX_FLAG_FULL)) {
266 /* Don't mess with mini-frames */
269 if (fh->type > sizeof(frames)/sizeof(char *)) {
270 snprintf(class2, sizeof(class2), "(%d?)", fh->type);
273 class = frames[(int)fh->type];
275 if (fh->type == AST_FRAME_DTMF) {
276 sprintf(subclass2, "%c", fh->csub);
277 subclass = subclass2;
278 } else if (fh->type == AST_FRAME_IAX) {
279 if (fh->csub >= sizeof(iaxs)/sizeof(iaxs[0])) {
280 snprintf(subclass2, sizeof(subclass2), "(%d?)", fh->csub);
281 subclass = subclass2;
283 subclass = iaxs[(int)fh->csub];
285 } else if (fh->type == AST_FRAME_CONTROL) {
286 if (fh->csub > sizeof(cmds)/sizeof(char *)) {
287 snprintf(subclass2, sizeof(subclass2), "(%d?)", fh->csub);
288 subclass = subclass2;
290 subclass = cmds[(int)fh->csub];
293 snprintf(subclass2, sizeof(subclass2), "%d", fh->csub);
294 subclass = subclass2;
296 snprintf(tmp, sizeof(tmp),
297 "%s-Frame Retry[%s] -- OSeqno: %3.3d ISeqno: %3.3d Type: %s Subclass: %s\n",
299 retries, fh->oseqno, fh->iseqno, class, subclass);
301 snprintf(tmp, sizeof(tmp),
302 " Timestamp: %05lums SCall: %5.5d DCall: %5.5d [%s:%d]\n",
303 (unsigned long)ntohl(fh->ts),
304 ntohs(fh->scallno) & ~IAX_FLAG_FULL, ntohs(fh->dcallno) & ~IAX_FLAG_RETRANS,
305 inet_ntoa(sin->sin_addr), ntohs(sin->sin_port));
307 if (fh->type == AST_FRAME_IAX)
308 dump_ies(fh->iedata, datalen);
311 int iax_ie_append_raw(struct iax_ie_data *ied, unsigned char ie, void *data, int datalen)
314 if (datalen > (sizeof(ied->buf) - ied->pos)) {
315 snprintf(tmp, sizeof(tmp), "Out of space for ie '%s' (%d), need %d have %d\n", iax_ie2str(ie), ie, datalen, sizeof(ied->buf) - ied->pos);
319 ied->buf[ied->pos++] = ie;
320 ied->buf[ied->pos++] = datalen;
321 memcpy(ied->buf + ied->pos, data, datalen);
326 int iax_ie_append_addr(struct iax_ie_data *ied, unsigned char ie, struct sockaddr_in *sin)
328 return iax_ie_append_raw(ied, ie, sin, sizeof(struct sockaddr_in));
331 int iax_ie_append_int(struct iax_ie_data *ied, unsigned char ie, unsigned int value)
334 newval = htonl(value);
335 return iax_ie_append_raw(ied, ie, &newval, sizeof(newval));
338 int iax_ie_append_short(struct iax_ie_data *ied, unsigned char ie, unsigned short value)
340 unsigned short newval;
341 newval = htons(value);
342 return iax_ie_append_raw(ied, ie, &newval, sizeof(newval));
345 int iax_ie_append_str(struct iax_ie_data *ied, unsigned char ie, unsigned char *str)
347 return iax_ie_append_raw(ied, ie, str, strlen(str));
350 int iax_ie_append_byte(struct iax_ie_data *ied, unsigned char ie, unsigned char dat)
352 return iax_ie_append_raw(ied, ie, &dat, 1);
355 int iax_ie_append(struct iax_ie_data *ied, unsigned char ie)
357 return iax_ie_append_raw(ied, ie, NULL, 0);
360 void iax_set_output(void (*func)(const char *))
365 void iax_set_error(void (*func)(const char *))
370 int iax_parse_ies(struct iax_ies *ies, unsigned char *data, int datalen)
372 /* Parse data into information elements */
376 memset(ies, 0, sizeof(struct iax_ies));
378 ies->firmwarever = -1;
379 while(datalen >= 2) {
382 if (len > datalen - 2) {
383 errorf("Information element length exceeds message size\n");
387 case IAX_IE_CALLED_NUMBER:
388 ies->called_number = data + 2;
390 case IAX_IE_CALLING_NUMBER:
391 ies->calling_number = data + 2;
393 case IAX_IE_CALLING_ANI:
394 ies->calling_ani = data + 2;
396 case IAX_IE_CALLING_NAME:
397 ies->calling_name = data + 2;
399 case IAX_IE_CALLED_CONTEXT:
400 ies->called_context = data + 2;
402 case IAX_IE_USERNAME:
403 ies->username = data + 2;
405 case IAX_IE_PASSWORD:
406 ies->password = data + 2;
408 case IAX_IE_CAPABILITY:
409 if (len != sizeof(unsigned int)) {
410 snprintf(tmp, sizeof(tmp), "Expecting capability to be %d bytes long but was %d\n", sizeof(unsigned int), len);
413 ies->capability = ntohl(*((unsigned int *)(data + 2)));
416 if (len != sizeof(unsigned int)) {
417 snprintf(tmp, sizeof(tmp), "Expecting format to be %d bytes long but was %d\n", sizeof(unsigned int), len);
420 ies->format = ntohl(*((unsigned int *)(data + 2)));
422 case IAX_IE_LANGUAGE:
423 ies->language = data + 2;
426 if (len != sizeof(unsigned short)) {
427 snprintf(tmp, sizeof(tmp), "Expecting version to be %d bytes long but was %d\n", sizeof(unsigned short), len);
430 ies->version = ntohs(*((unsigned short *)(data + 2)));
433 if (len != sizeof(unsigned short)) {
434 snprintf(tmp, sizeof(tmp), "Expecting adsicpe to be %d bytes long but was %d\n", sizeof(unsigned short), len);
437 ies->adsicpe = ntohs(*((unsigned short *)(data + 2)));
440 ies->dnid = data + 2;
443 ies->rdnis = data + 2;
445 case IAX_IE_AUTHMETHODS:
446 if (len != sizeof(unsigned short)) {
447 snprintf(tmp, sizeof(tmp), "Expecting authmethods to be %d bytes long but was %d\n", sizeof(unsigned short), len);
450 ies->authmethods = ntohs(*((unsigned short *)(data + 2)));
452 case IAX_IE_CHALLENGE:
453 ies->challenge = data + 2;
455 case IAX_IE_MD5_RESULT:
456 ies->md5_result = data + 2;
458 case IAX_IE_RSA_RESULT:
459 ies->rsa_result = data + 2;
461 case IAX_IE_APPARENT_ADDR:
462 ies->apparent_addr = ((struct sockaddr_in *)(data + 2));
465 if (len != sizeof(unsigned short)) {
466 snprintf(tmp, sizeof(tmp), "Expecting refresh to be %d bytes long but was %d\n", sizeof(unsigned short), len);
469 ies->refresh = ntohs(*((unsigned short *)(data + 2)));
471 case IAX_IE_DPSTATUS:
472 if (len != sizeof(unsigned short)) {
473 snprintf(tmp, sizeof(tmp), "Expecting dpstatus to be %d bytes long but was %d\n", sizeof(unsigned short), len);
476 ies->dpstatus = ntohs(*((unsigned short *)(data + 2)));
479 if (len != sizeof(unsigned short)) {
480 snprintf(tmp, sizeof(tmp), "Expecting callno to be %d bytes long but was %d\n", sizeof(unsigned short), len);
483 ies->callno = ntohs(*((unsigned short *)(data + 2)));
486 ies->cause = data + 2;
488 case IAX_IE_IAX_UNKNOWN:
490 ies->iax_unknown = data[2];
492 snprintf(tmp, sizeof(tmp), "Expected single byte Unknown command, but was %d long\n", len);
496 case IAX_IE_MSGCOUNT:
497 if (len != sizeof(unsigned short)) {
498 snprintf(tmp, sizeof(tmp), "Expecting msgcount to be %d bytes long but was %d\n", sizeof(unsigned short), len);
501 ies->msgcount = ntohs(*((unsigned short *)(data + 2)));
503 case IAX_IE_AUTOANSWER:
506 case IAX_IE_MUSICONHOLD:
507 ies->musiconhold = 1;
509 case IAX_IE_TRANSFERID:
510 if (len != sizeof(unsigned int)) {
511 snprintf(tmp, sizeof(tmp), "Expecting transferid to be %d bytes long but was %d\n", sizeof(unsigned int), len);
514 ies->transferid = ntohl(*((unsigned int *)(data + 2)));
516 case IAX_IE_DATETIME:
517 if (len != sizeof(unsigned int)) {
518 snprintf(tmp, sizeof(tmp), "Expecting date/time to be %d bytes long but was %d\n", sizeof(unsigned int), len);
521 ies->datetime = ntohl(*((unsigned int *)(data + 2)));
523 case IAX_IE_FIRMWAREVER:
524 if (len != sizeof(unsigned short)) {
525 snprintf(tmp, sizeof(tmp), "Expecting firmwarever to be %d bytes long but was %d\n", sizeof(unsigned short), len);
528 ies->firmwarever = ntohs(*((unsigned short *)(data + 2)));
530 case IAX_IE_DEVICETYPE:
531 ies->devicetype = data + 2;
533 case IAX_IE_SERVICEIDENT:
534 ies->serviceident = data + 2;
536 case IAX_IE_FWBLOCKDESC:
537 if (len != sizeof(unsigned int)) {
538 snprintf(tmp, sizeof(tmp), "Expected block desc to be %d bytes long but was %d\n", sizeof(unsigned int), len);
541 ies->fwdesc = ntohl(*((unsigned int *)(data + 2)));
543 case IAX_IE_FWBLOCKDATA:
544 ies->fwdata = data + 2;
545 ies->fwdatalen = len;
548 if (len != sizeof(unsigned int)) {
549 snprintf(tmp, sizeof(tmp), "Expected provisioning version to be %d bytes long but was %d\n", sizeof(unsigned int), len);
552 ies->provver = ntohl(*((unsigned int *)(data + 2)));
555 snprintf(tmp, sizeof(tmp), "Ignoring unknown information element '%s' (%d) of length %d\n", iax_ie2str(ie), ie, len);
558 /* Overwrite information element with 0, to null terminate previous portion */
560 datalen -= (len + 2);
563 /* Null-terminate last field */
566 errorf("Invalid information element contents, strange boundary\n");
572 void iax_frame_wrap(struct iax_frame *fr, struct ast_frame *f)
574 fr->af.frametype = f->frametype;
575 fr->af.subclass = f->subclass;
576 fr->af.mallocd = 0; /* Our frame is static relative to the container */
577 fr->af.datalen = f->datalen;
578 fr->af.samples = f->samples;
579 fr->af.offset = AST_FRIENDLY_OFFSET;
581 fr->af.delivery.tv_sec = 0;
582 fr->af.delivery.tv_usec = 0;
583 fr->af.data = fr->afdata;
585 memcpy(fr->af.data, f->data, fr->af.datalen);
588 struct iax_frame *iax_frame_new(int direction, int datalen)
590 struct iax_frame *fr;
591 fr = malloc(sizeof(struct iax_frame) + datalen);
593 fr->direction = direction;
596 if (fr->direction == DIRECTION_INGRESS)
604 void iax_frame_free(struct iax_frame *fr)
606 /* Note: does not remove from scheduler! */
607 if (fr->direction == DIRECTION_INGRESS)
609 else if (fr->direction == DIRECTION_OUTGRESS)
612 errorf("Attempt to double free frame detected\n");
620 int iax_get_frames(void) { return frames; }
621 int iax_get_iframes(void) { return iframes; }
622 int iax_get_oframes(void) { return oframes; }