00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026 #include "asterisk.h"
00027
00028 ASTERISK_FILE_VERSION(__FILE__, "$Revision: 139521 $")
00029
00030 #include <stdlib.h>
00031 #include <unistd.h>
00032 #include <string.h>
00033 #include <errno.h>
00034 #include <stdio.h>
00035
00036 #include "asterisk/lock.h"
00037 #include "asterisk/frame.h"
00038 #include "asterisk/logger.h"
00039 #include "asterisk/options.h"
00040 #include "asterisk/channel.h"
00041 #include "asterisk/cli.h"
00042 #include "asterisk/term.h"
00043 #include "asterisk/utils.h"
00044 #include "asterisk/threadstorage.h"
00045 #include "asterisk/linkedlists.h"
00046 #include "asterisk/translate.h"
00047 #include "asterisk/dsp.h"
00048
00049 #ifdef TRACE_FRAMES
00050 static int headers;
00051 static AST_LIST_HEAD_STATIC(headerlist, ast_frame);
00052 #endif
00053
00054 #if !defined(LOW_MEMORY)
00055 static void frame_cache_cleanup(void *data);
00056
00057
00058 AST_THREADSTORAGE_CUSTOM(frame_cache, frame_cache_init, frame_cache_cleanup);
00059
00060
00061
00062
00063
00064
00065
00066
00067
00068
00069 #define FRAME_CACHE_MAX_SIZE 10
00070
00071
00072
00073 AST_LIST_HEAD_NOLOCK(ast_frames, ast_frame);
00074
00075 struct ast_frame_cache {
00076 struct ast_frames list;
00077 size_t size;
00078 };
00079 #endif
00080
00081 #define SMOOTHER_SIZE 8000
00082
00083 enum frame_type {
00084 TYPE_HIGH,
00085 TYPE_LOW,
00086 TYPE_SILENCE,
00087 TYPE_DONTSEND
00088 };
00089
00090 #define TYPE_MASK 0x3
00091
00092 struct ast_smoother {
00093 int size;
00094 int format;
00095 int readdata;
00096 int optimizablestream;
00097 int flags;
00098 float samplesperbyte;
00099 struct ast_frame f;
00100 struct timeval delivery;
00101 char data[SMOOTHER_SIZE];
00102 char framedata[SMOOTHER_SIZE + AST_FRIENDLY_OFFSET];
00103 struct ast_frame *opt;
00104 int len;
00105 };
00106
00107
00108 static struct ast_format_list AST_FORMAT_LIST[] = {
00109 { 1, AST_FORMAT_G723_1 , "g723" , "G.723.1", 24, 30, 300, 30, 30 },
00110 { 1, AST_FORMAT_GSM, "gsm" , "GSM", 33, 20, 300, 20, 20 },
00111 { 1, AST_FORMAT_ULAW, "ulaw", "G.711 u-law", 80, 10, 150, 10, 20 },
00112 { 1, AST_FORMAT_ALAW, "alaw", "G.711 A-law", 80, 10, 150, 10, 20 },
00113 { 1, AST_FORMAT_G726, "g726", "G.726 RFC3551", 40, 10, 300, 10, 20 },
00114 { 1, AST_FORMAT_ADPCM, "adpcm" , "ADPCM", 40, 10, 300, 10, 20 },
00115 { 1, AST_FORMAT_SLINEAR, "slin", "16 bit Signed Linear PCM", 160, 10, 70, 10, 20, AST_SMOOTHER_FLAG_BE },
00116 { 1, AST_FORMAT_LPC10, "lpc10", "LPC10", 7, 20, 20, 20, 20 },
00117 { 1, AST_FORMAT_G729A, "g729", "G.729A", 10, 10, 230, 10, 40, AST_SMOOTHER_FLAG_G729 },
00118 { 1, AST_FORMAT_SPEEX, "speex", "SpeeX", 10, 10, 60, 10, 20 },
00119 { 1, AST_FORMAT_ILBC, "ilbc", "iLBC", 50, 30, 30, 30, 30 },
00120 { 1, AST_FORMAT_G726_AAL2, "g726aal2", "G.726 AAL2", 40, 10, 300, 10, 20 },
00121 { 1, AST_FORMAT_G722, "g722", "G.722", 80, 10, 150, 10, 20 },
00122 { 0, 0, "nothing", "undefined" },
00123 { 0, 0, "nothing", "undefined" },
00124 { 0, 0, "nothing", "undefined" },
00125 { 0, 0, "nothing", "undefined" },
00126 { 0, AST_FORMAT_MAX_AUDIO, "maxaudio", "Maximum audio format" },
00127 { 1, AST_FORMAT_JPEG, "jpeg", "JPEG image"},
00128 { 1, AST_FORMAT_PNG, "png", "PNG image"},
00129 { 1, AST_FORMAT_H261, "h261", "H.261 Video" },
00130 { 1, AST_FORMAT_H263, "h263", "H.263 Video" },
00131 { 1, AST_FORMAT_H263_PLUS, "h263p", "H.263+ Video" },
00132 { 1, AST_FORMAT_H264, "h264", "H.264 Video" },
00133 { 0, 0, "nothing", "undefined" },
00134 { 0, 0, "nothing", "undefined" },
00135 { 0, 0, "nothing", "undefined" },
00136 { 0, AST_FORMAT_MAX_VIDEO, "maxvideo", "Maximum video format" },
00137 };
00138
00139 struct ast_frame ast_null_frame = { AST_FRAME_NULL, };
00140
00141 void ast_smoother_reset(struct ast_smoother *s, int size)
00142 {
00143 memset(s, 0, sizeof(*s));
00144 s->size = size;
00145 }
00146
00147 struct ast_smoother *ast_smoother_new(int size)
00148 {
00149 struct ast_smoother *s;
00150 if (size < 1)
00151 return NULL;
00152 if ((s = ast_malloc(sizeof(*s))))
00153 ast_smoother_reset(s, size);
00154 return s;
00155 }
00156
00157 int ast_smoother_get_flags(struct ast_smoother *s)
00158 {
00159 return s->flags;
00160 }
00161
00162 void ast_smoother_set_flags(struct ast_smoother *s, int flags)
00163 {
00164 s->flags = flags;
00165 }
00166
00167 int ast_smoother_test_flag(struct ast_smoother *s, int flag)
00168 {
00169 return (s->flags & flag);
00170 }
00171
00172 int __ast_smoother_feed(struct ast_smoother *s, struct ast_frame *f, int swap)
00173 {
00174 if (f->frametype != AST_FRAME_VOICE) {
00175 ast_log(LOG_WARNING, "Huh? Can't smooth a non-voice frame!\n");
00176 return -1;
00177 }
00178 if (!s->format) {
00179 s->format = f->subclass;
00180 s->samplesperbyte = (float)f->samples / (float)f->datalen;
00181 } else if (s->format != f->subclass) {
00182 ast_log(LOG_WARNING, "Smoother was working on %d format frames, now trying to feed %d?\n", s->format, f->subclass);
00183 return -1;
00184 }
00185 if (s->len + f->datalen > SMOOTHER_SIZE) {
00186 ast_log(LOG_WARNING, "Out of smoother space\n");
00187 return -1;
00188 }
00189 if (((f->datalen == s->size) || ((f->datalen < 10) && (s->flags & AST_SMOOTHER_FLAG_G729)))
00190 && !s->opt && (f->offset >= AST_MIN_OFFSET)) {
00191 if (!s->len) {
00192
00193
00194
00195 if (swap)
00196 ast_swapcopy_samples(f->data, f->data, f->samples);
00197 s->opt = f;
00198 return 0;
00199 }
00200 }
00201 if (s->flags & AST_SMOOTHER_FLAG_G729) {
00202 if (s->len % 10) {
00203 ast_log(LOG_NOTICE, "Dropping extra frame of G.729 since we already have a VAD frame at the end\n");
00204 return 0;
00205 }
00206 }
00207 if (swap)
00208 ast_swapcopy_samples(s->data+s->len, f->data, f->samples);
00209 else
00210 memcpy(s->data + s->len, f->data, f->datalen);
00211
00212 if (!s->len || ast_tvzero(f->delivery) || ast_tvzero(s->delivery))
00213 s->delivery = f->delivery;
00214 s->len += f->datalen;
00215 return 0;
00216 }
00217
00218 struct ast_frame *ast_smoother_read(struct ast_smoother *s)
00219 {
00220 struct ast_frame *opt;
00221 int len;
00222
00223
00224 if (s->opt) {
00225 if (s->opt->offset < AST_FRIENDLY_OFFSET)
00226 ast_log(LOG_WARNING, "Returning a frame of inappropriate offset (%d).\n",
00227 s->opt->offset);
00228 opt = s->opt;
00229 s->opt = NULL;
00230 return opt;
00231 }
00232
00233
00234 if (s->len < s->size) {
00235
00236 if (!((s->flags & AST_SMOOTHER_FLAG_G729) && (s->size % 10)))
00237 return NULL;
00238 }
00239 len = s->size;
00240 if (len > s->len)
00241 len = s->len;
00242
00243 s->f.frametype = AST_FRAME_VOICE;
00244 s->f.subclass = s->format;
00245 s->f.data = s->framedata + AST_FRIENDLY_OFFSET;
00246 s->f.offset = AST_FRIENDLY_OFFSET;
00247 s->f.datalen = len;
00248
00249 s->f.samples = len * s->samplesperbyte;
00250 s->f.delivery = s->delivery;
00251
00252 memcpy(s->f.data, s->data, len);
00253 s->len -= len;
00254
00255 if (s->len) {
00256
00257
00258 memmove(s->data, s->data + len, s->len);
00259 if (!ast_tvzero(s->delivery)) {
00260
00261 s->delivery = ast_tvadd(s->delivery, ast_samp2tv(s->f.samples, 8000));
00262 }
00263 }
00264
00265 return &s->f;
00266 }
00267
00268 void ast_smoother_free(struct ast_smoother *s)
00269 {
00270 free(s);
00271 }
00272
00273 static struct ast_frame *ast_frame_header_new(void)
00274 {
00275 struct ast_frame *f;
00276
00277 #if !defined(LOW_MEMORY)
00278 struct ast_frame_cache *frames;
00279
00280 if ((frames = ast_threadstorage_get(&frame_cache, sizeof(*frames)))) {
00281 if ((f = AST_LIST_REMOVE_HEAD(&frames->list, frame_list))) {
00282 size_t mallocd_len = f->mallocd_hdr_len;
00283 memset(f, 0, sizeof(*f));
00284 f->mallocd_hdr_len = mallocd_len;
00285 f->mallocd = AST_MALLOCD_HDR;
00286 frames->size--;
00287 return f;
00288 }
00289 }
00290 if (!(f = ast_calloc_cache(1, sizeof(*f))))
00291 return NULL;
00292 #else
00293 if (!(f = ast_calloc(1, sizeof(*f))))
00294 return NULL;
00295 #endif
00296
00297 f->mallocd_hdr_len = sizeof(*f);
00298 #ifdef TRACE_FRAMES
00299 AST_LIST_LOCK(&headerlist);
00300 headers++;
00301 AST_LIST_INSERT_HEAD(&headerlist, f, frame_list);
00302 AST_LIST_UNLOCK(&headerlist);
00303 #endif
00304
00305 return f;
00306 }
00307
00308 #if !defined(LOW_MEMORY)
00309 static void frame_cache_cleanup(void *data)
00310 {
00311 struct ast_frame_cache *frames = data;
00312 struct ast_frame *f;
00313
00314 while ((f = AST_LIST_REMOVE_HEAD(&frames->list, frame_list)))
00315 free(f);
00316
00317 free(frames);
00318 }
00319 #endif
00320
00321 void ast_frame_free(struct ast_frame *fr, int cache)
00322 {
00323 if (ast_test_flag(fr, AST_FRFLAG_FROM_TRANSLATOR))
00324 ast_translate_frame_freed(fr);
00325 else if (ast_test_flag(fr, AST_FRFLAG_FROM_DSP))
00326 ast_dsp_frame_freed(fr);
00327
00328 if (!fr->mallocd)
00329 return;
00330
00331 #if !defined(LOW_MEMORY)
00332 if (cache && fr->mallocd == AST_MALLOCD_HDR) {
00333
00334
00335 struct ast_frame_cache *frames;
00336
00337 if ((frames = ast_threadstorage_get(&frame_cache, sizeof(*frames)))
00338 && frames->size < FRAME_CACHE_MAX_SIZE) {
00339 AST_LIST_INSERT_HEAD(&frames->list, fr, frame_list);
00340 frames->size++;
00341 return;
00342 }
00343 }
00344 #endif
00345
00346 if (fr->mallocd & AST_MALLOCD_DATA) {
00347 if (fr->data)
00348 free(fr->data - fr->offset);
00349 }
00350 if (fr->mallocd & AST_MALLOCD_SRC) {
00351 if (fr->src)
00352 free((char *)fr->src);
00353 }
00354 if (fr->mallocd & AST_MALLOCD_HDR) {
00355 #ifdef TRACE_FRAMES
00356 AST_LIST_LOCK(&headerlist);
00357 headers--;
00358 AST_LIST_REMOVE(&headerlist, fr, frame_list);
00359 AST_LIST_UNLOCK(&headerlist);
00360 #endif
00361 free(fr);
00362 }
00363 }
00364
00365
00366
00367
00368
00369
00370 struct ast_frame *ast_frisolate(struct ast_frame *fr)
00371 {
00372 struct ast_frame *out;
00373 void *newdata;
00374
00375 ast_clear_flag(fr, AST_FRFLAG_FROM_TRANSLATOR);
00376 ast_clear_flag(fr, AST_FRFLAG_FROM_DSP);
00377
00378 if (!(fr->mallocd & AST_MALLOCD_HDR)) {
00379
00380 if (!(out = ast_frame_header_new()))
00381 return NULL;
00382 out->frametype = fr->frametype;
00383 out->subclass = fr->subclass;
00384 out->datalen = fr->datalen;
00385 out->samples = fr->samples;
00386 out->offset = fr->offset;
00387 out->data = fr->data;
00388
00389 ast_copy_flags(out, fr, AST_FRFLAG_HAS_TIMING_INFO);
00390 if (ast_test_flag(fr, AST_FRFLAG_HAS_TIMING_INFO)) {
00391 out->ts = fr->ts;
00392 out->len = fr->len;
00393 out->seqno = fr->seqno;
00394 }
00395 } else
00396 out = fr;
00397
00398 if (!(fr->mallocd & AST_MALLOCD_SRC)) {
00399 if (fr->src) {
00400 if (!(out->src = ast_strdup(fr->src))) {
00401 if (out != fr)
00402 free(out);
00403 return NULL;
00404 }
00405 }
00406 } else
00407 out->src = fr->src;
00408
00409 if (!(fr->mallocd & AST_MALLOCD_DATA)) {
00410 if (!(newdata = ast_malloc(fr->datalen + AST_FRIENDLY_OFFSET))) {
00411 if (out->src != fr->src)
00412 free((void *) out->src);
00413 if (out != fr)
00414 free(out);
00415 return NULL;
00416 }
00417 newdata += AST_FRIENDLY_OFFSET;
00418 out->offset = AST_FRIENDLY_OFFSET;
00419 out->datalen = fr->datalen;
00420 memcpy(newdata, fr->data, fr->datalen);
00421 out->data = newdata;
00422 }
00423
00424 out->mallocd = AST_MALLOCD_HDR | AST_MALLOCD_SRC | AST_MALLOCD_DATA;
00425
00426 return out;
00427 }
00428
00429 struct ast_frame *ast_frdup(const struct ast_frame *f)
00430 {
00431 struct ast_frame *out = NULL;
00432 int len, srclen = 0;
00433 void *buf = NULL;
00434
00435 #if !defined(LOW_MEMORY)
00436 struct ast_frame_cache *frames;
00437 #endif
00438
00439
00440 len = sizeof(*out) + AST_FRIENDLY_OFFSET + f->datalen;
00441
00442
00443
00444
00445
00446 if (f->src)
00447 srclen = strlen(f->src);
00448 if (srclen > 0)
00449 len += srclen + 1;
00450
00451 #if !defined(LOW_MEMORY)
00452 if ((frames = ast_threadstorage_get(&frame_cache, sizeof(*frames)))) {
00453 AST_LIST_TRAVERSE_SAFE_BEGIN(&frames->list, out, frame_list) {
00454 if (out->mallocd_hdr_len >= len) {
00455 size_t mallocd_len = out->mallocd_hdr_len;
00456 AST_LIST_REMOVE_CURRENT(&frames->list, frame_list);
00457 memset(out, 0, sizeof(*out));
00458 out->mallocd_hdr_len = mallocd_len;
00459 buf = out;
00460 frames->size--;
00461 break;
00462 }
00463 }
00464 AST_LIST_TRAVERSE_SAFE_END
00465 }
00466 #endif
00467
00468 if (!buf) {
00469 if (!(buf = ast_calloc_cache(1, len)))
00470 return NULL;
00471 out = buf;
00472 out->mallocd_hdr_len = len;
00473 }
00474
00475 out->frametype = f->frametype;
00476 out->subclass = f->subclass;
00477 out->datalen = f->datalen;
00478 out->samples = f->samples;
00479 out->delivery = f->delivery;
00480
00481
00482 out->mallocd = AST_MALLOCD_HDR;
00483 out->offset = AST_FRIENDLY_OFFSET;
00484 if (out->datalen) {
00485 out->data = buf + sizeof(*out) + AST_FRIENDLY_OFFSET;
00486 memcpy(out->data, f->data, out->datalen);
00487 }
00488 if (srclen > 0) {
00489 out->src = buf + sizeof(*out) + AST_FRIENDLY_OFFSET + f->datalen;
00490
00491 strcpy((char *)out->src, f->src);
00492 }
00493 ast_copy_flags(out, f, AST_FRFLAG_HAS_TIMING_INFO);
00494 out->ts = f->ts;
00495 out->len = f->len;
00496 out->seqno = f->seqno;
00497 return out;
00498 }
00499
00500 void ast_swapcopy_samples(void *dst, const void *src, int samples)
00501 {
00502 int i;
00503 unsigned short *dst_s = dst;
00504 const unsigned short *src_s = src;
00505
00506 for (i = 0; i < samples; i++)
00507 dst_s[i] = (src_s[i]<<8) | (src_s[i]>>8);
00508 }
00509
00510
00511 struct ast_format_list *ast_get_format_list_index(int index)
00512 {
00513 return &AST_FORMAT_LIST[index];
00514 }
00515
00516 struct ast_format_list *ast_get_format_list(size_t *size)
00517 {
00518 *size = (sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]));
00519 return AST_FORMAT_LIST;
00520 }
00521
00522 char* ast_getformatname(int format)
00523 {
00524 int x;
00525 char *ret = "unknown";
00526 for (x = 0; x < sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]); x++) {
00527 if(AST_FORMAT_LIST[x].visible && AST_FORMAT_LIST[x].bits == format) {
00528 ret = AST_FORMAT_LIST[x].name;
00529 break;
00530 }
00531 }
00532 return ret;
00533 }
00534
00535 char *ast_getformatname_multiple(char *buf, size_t size, int format)
00536 {
00537 int x;
00538 unsigned len;
00539 char *start, *end = buf;
00540
00541 if (!size)
00542 return buf;
00543 snprintf(end, size, "0x%x (", format);
00544 len = strlen(end);
00545 end += len;
00546 size -= len;
00547 start = end;
00548 for (x = 0; x < sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]); x++) {
00549 if (AST_FORMAT_LIST[x].visible && (AST_FORMAT_LIST[x].bits & format)) {
00550 snprintf(end, size,"%s|",AST_FORMAT_LIST[x].name);
00551 len = strlen(end);
00552 end += len;
00553 size -= len;
00554 }
00555 }
00556 if (start == end)
00557 snprintf(start, size, "nothing)");
00558 else if (size > 1)
00559 *(end -1) = ')';
00560 return buf;
00561 }
00562
00563 static struct ast_codec_alias_table {
00564 char *alias;
00565 char *realname;
00566 } ast_codec_alias_table[] = {
00567 { "slinear", "slin"},
00568 { "g723.1", "g723"},
00569 };
00570
00571 static const char *ast_expand_codec_alias(const char *in)
00572 {
00573 int x;
00574
00575 for (x = 0; x < sizeof(ast_codec_alias_table) / sizeof(ast_codec_alias_table[0]); x++) {
00576 if(!strcmp(in,ast_codec_alias_table[x].alias))
00577 return ast_codec_alias_table[x].realname;
00578 }
00579 return in;
00580 }
00581
00582 int ast_getformatbyname(const char *name)
00583 {
00584 int x, all, format = 0;
00585
00586 all = strcasecmp(name, "all") ? 0 : 1;
00587 for (x = 0; x < sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]); x++) {
00588 if(AST_FORMAT_LIST[x].visible && (all ||
00589 !strcasecmp(AST_FORMAT_LIST[x].name,name) ||
00590 !strcasecmp(AST_FORMAT_LIST[x].name,ast_expand_codec_alias(name)))) {
00591 format |= AST_FORMAT_LIST[x].bits;
00592 if(!all)
00593 break;
00594 }
00595 }
00596
00597 return format;
00598 }
00599
00600 char *ast_codec2str(int codec)
00601 {
00602 int x;
00603 char *ret = "unknown";
00604 for (x = 0; x < sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]); x++) {
00605 if(AST_FORMAT_LIST[x].visible && AST_FORMAT_LIST[x].bits == codec) {
00606 ret = AST_FORMAT_LIST[x].desc;
00607 break;
00608 }
00609 }
00610 return ret;
00611 }
00612
00613 static int show_codecs_deprecated(int fd, int argc, char *argv[])
00614 {
00615 int i, found=0;
00616 char hex[25];
00617
00618 if ((argc < 2) || (argc > 3))
00619 return RESULT_SHOWUSAGE;
00620
00621 if (!ast_opt_dont_warn)
00622 ast_cli(fd, "Disclaimer: this command is for informational purposes only.\n"
00623 "\tIt does not indicate anything about your configuration.\n");
00624
00625 ast_cli(fd, "%11s %9s %10s TYPE %8s %s\n","INT","BINARY","HEX","NAME","DESC");
00626 ast_cli(fd, "--------------------------------------------------------------------------------\n");
00627 if ((argc == 2) || (!strcasecmp(argv[1],"audio"))) {
00628 found = 1;
00629 for (i=0;i<13;i++) {
00630 snprintf(hex,25,"(0x%x)",1<<i);
00631 ast_cli(fd, "%11u (1 << %2d) %10s audio %8s (%s)\n",1 << i,i,hex,ast_getformatname(1<<i),ast_codec2str(1<<i));
00632 }
00633 }
00634
00635 if ((argc == 2) || (!strcasecmp(argv[1],"image"))) {
00636 found = 1;
00637 for (i=16;i<18;i++) {
00638 snprintf(hex,25,"(0x%x)",1<<i);
00639 ast_cli(fd, "%11u (1 << %2d) %10s image %8s (%s)\n",1 << i,i,hex,ast_getformatname(1<<i),ast_codec2str(1<<i));
00640 }
00641 }
00642
00643 if ((argc == 2) || (!strcasecmp(argv[1],"video"))) {
00644 found = 1;
00645 for (i=18;i<22;i++) {
00646 snprintf(hex,25,"(0x%x)",1<<i);
00647 ast_cli(fd, "%11u (1 << %2d) %10s video %8s (%s)\n",1 << i,i,hex,ast_getformatname(1<<i),ast_codec2str(1<<i));
00648 }
00649 }
00650
00651 if (! found)
00652 return RESULT_SHOWUSAGE;
00653 else
00654 return RESULT_SUCCESS;
00655 }
00656
00657 static int show_codecs(int fd, int argc, char *argv[])
00658 {
00659 int i, found=0;
00660 char hex[25];
00661
00662 if ((argc < 3) || (argc > 4))
00663 return RESULT_SHOWUSAGE;
00664
00665 if (!ast_opt_dont_warn)
00666 ast_cli(fd, "Disclaimer: this command is for informational purposes only.\n"
00667 "\tIt does not indicate anything about your configuration.\n");
00668
00669 ast_cli(fd, "%11s %9s %10s TYPE %8s %s\n","INT","BINARY","HEX","NAME","DESC");
00670 ast_cli(fd, "--------------------------------------------------------------------------------\n");
00671 if ((argc == 3) || (!strcasecmp(argv[3],"audio"))) {
00672 found = 1;
00673 for (i=0;i<13;i++) {
00674 snprintf(hex,25,"(0x%x)",1<<i);
00675 ast_cli(fd, "%11u (1 << %2d) %10s audio %8s (%s)\n",1 << i,i,hex,ast_getformatname(1<<i),ast_codec2str(1<<i));
00676 }
00677 }
00678
00679 if ((argc == 3) || (!strcasecmp(argv[3],"image"))) {
00680 found = 1;
00681 for (i=16;i<18;i++) {
00682 snprintf(hex,25,"(0x%x)",1<<i);
00683 ast_cli(fd, "%11u (1 << %2d) %10s image %8s (%s)\n",1 << i,i,hex,ast_getformatname(1<<i),ast_codec2str(1<<i));
00684 }
00685 }
00686
00687 if ((argc == 3) || (!strcasecmp(argv[3],"video"))) {
00688 found = 1;
00689 for (i=18;i<22;i++) {
00690 snprintf(hex,25,"(0x%x)",1<<i);
00691 ast_cli(fd, "%11u (1 << %2d) %10s video %8s (%s)\n",1 << i,i,hex,ast_getformatname(1<<i),ast_codec2str(1<<i));
00692 }
00693 }
00694
00695 if (! found)
00696 return RESULT_SHOWUSAGE;
00697 else
00698 return RESULT_SUCCESS;
00699 }
00700
00701 static char frame_show_codecs_usage[] =
00702 "Usage: core show codecs [audio|video|image]\n"
00703 " Displays codec mapping\n";
00704
00705 static int show_codec_n_deprecated(int fd, int argc, char *argv[])
00706 {
00707 int codec, i, found=0;
00708
00709 if (argc != 3)
00710 return RESULT_SHOWUSAGE;
00711
00712 if (sscanf(argv[2],"%d",&codec) != 1)
00713 return RESULT_SHOWUSAGE;
00714
00715 for (i = 0; i < 32; i++)
00716 if (codec & (1 << i)) {
00717 found = 1;
00718 ast_cli(fd, "%11u (1 << %2d) %s\n",1 << i,i,ast_codec2str(1<<i));
00719 }
00720
00721 if (!found)
00722 ast_cli(fd, "Codec %d not found\n", codec);
00723
00724 return RESULT_SUCCESS;
00725 }
00726
00727 static int show_codec_n(int fd, int argc, char *argv[])
00728 {
00729 int codec, i, found=0;
00730
00731 if (argc != 4)
00732 return RESULT_SHOWUSAGE;
00733
00734 if (sscanf(argv[3],"%d",&codec) != 1)
00735 return RESULT_SHOWUSAGE;
00736
00737 for (i = 0; i < 32; i++)
00738 if (codec & (1 << i)) {
00739 found = 1;
00740 ast_cli(fd, "%11u (1 << %2d) %s\n",1 << i,i,ast_codec2str(1<<i));
00741 }
00742
00743 if (!found)
00744 ast_cli(fd, "Codec %d not found\n", codec);
00745
00746 return RESULT_SUCCESS;
00747 }
00748
00749 static char frame_show_codec_n_usage[] =
00750 "Usage: core show codec <number>\n"
00751 " Displays codec mapping\n";
00752
00753
00754 void ast_frame_dump(const char *name, struct ast_frame *f, char *prefix)
00755 {
00756 const char noname[] = "unknown";
00757 char ftype[40] = "Unknown Frametype";
00758 char cft[80];
00759 char subclass[40] = "Unknown Subclass";
00760 char csub[80];
00761 char moreinfo[40] = "";
00762 char cn[60];
00763 char cp[40];
00764 char cmn[40];
00765
00766 if (!name)
00767 name = noname;
00768
00769
00770 if (!f) {
00771 ast_verbose("%s [ %s (NULL) ] [%s]\n",
00772 term_color(cp, prefix, COLOR_BRMAGENTA, COLOR_BLACK, sizeof(cp)),
00773 term_color(cft, "HANGUP", COLOR_BRRED, COLOR_BLACK, sizeof(cft)),
00774 term_color(cn, name, COLOR_YELLOW, COLOR_BLACK, sizeof(cn)));
00775 return;
00776 }
00777
00778 if (f->frametype == AST_FRAME_VOICE)
00779 return;
00780 if (f->frametype == AST_FRAME_VIDEO)
00781 return;
00782 switch(f->frametype) {
00783 case AST_FRAME_DTMF_BEGIN:
00784 strcpy(ftype, "DTMF Begin");
00785 subclass[0] = f->subclass;
00786 subclass[1] = '\0';
00787 break;
00788 case AST_FRAME_DTMF_END:
00789 strcpy(ftype, "DTMF End");
00790 subclass[0] = f->subclass;
00791 subclass[1] = '\0';
00792 break;
00793 case AST_FRAME_CONTROL:
00794 strcpy(ftype, "Control");
00795 switch(f->subclass) {
00796 case AST_CONTROL_HANGUP:
00797 strcpy(subclass, "Hangup");
00798 break;
00799 case AST_CONTROL_RING:
00800 strcpy(subclass, "Ring");
00801 break;
00802 case AST_CONTROL_RINGING:
00803 strcpy(subclass, "Ringing");
00804 break;
00805 case AST_CONTROL_ANSWER:
00806 strcpy(subclass, "Answer");
00807 break;
00808 case AST_CONTROL_BUSY:
00809 strcpy(subclass, "Busy");
00810 break;
00811 case AST_CONTROL_TAKEOFFHOOK:
00812 strcpy(subclass, "Take Off Hook");
00813 break;
00814 case AST_CONTROL_OFFHOOK:
00815 strcpy(subclass, "Line Off Hook");
00816 break;
00817 case AST_CONTROL_CONGESTION:
00818 strcpy(subclass, "Congestion");
00819 break;
00820 case AST_CONTROL_FLASH:
00821 strcpy(subclass, "Flash");
00822 break;
00823 case AST_CONTROL_WINK:
00824 strcpy(subclass, "Wink");
00825 break;
00826 case AST_CONTROL_OPTION:
00827 strcpy(subclass, "Option");
00828 break;
00829 case AST_CONTROL_RADIO_KEY:
00830 strcpy(subclass, "Key Radio");
00831 break;
00832 case AST_CONTROL_RADIO_UNKEY:
00833 strcpy(subclass, "Unkey Radio");
00834 break;
00835 case AST_CONTROL_PROGRESS:
00836 strcpy(subclass, "Call Progress");
00837 break;
00838 case AST_CONTROL_PROCEEDING:
00839 strcpy(subclass, "Proceeding");
00840 break;
00841 case AST_CONTROL_HOLD:
00842 strcpy(subclass, "Hold");
00843 break;
00844 case AST_CONTROL_UNHOLD:
00845 strcpy(subclass, "UnHold");
00846 break;
00847 case -1:
00848 strcpy(subclass, "Stop generators");
00849 break;
00850 default:
00851 snprintf(subclass, sizeof(subclass), "Unknown control '%d'", f->subclass);
00852 }
00853 break;
00854 case AST_FRAME_NULL:
00855 strcpy(ftype, "Null Frame");
00856 strcpy(subclass, "N/A");
00857 break;
00858 case AST_FRAME_IAX:
00859
00860 strcpy(ftype, "IAX Specific");
00861 snprintf(subclass, sizeof(subclass), "IAX Frametype %d", f->subclass);
00862 break;
00863 case AST_FRAME_TEXT:
00864 strcpy(ftype, "Text");
00865 strcpy(subclass, "N/A");
00866 ast_copy_string(moreinfo, f->data, sizeof(moreinfo));
00867 break;
00868 case AST_FRAME_IMAGE:
00869 strcpy(ftype, "Image");
00870 snprintf(subclass, sizeof(subclass), "Image format %s\n", ast_getformatname(f->subclass));
00871 break;
00872 case AST_FRAME_HTML:
00873 strcpy(ftype, "HTML");
00874 switch(f->subclass) {
00875 case AST_HTML_URL:
00876 strcpy(subclass, "URL");
00877 ast_copy_string(moreinfo, f->data, sizeof(moreinfo));
00878 break;
00879 case AST_HTML_DATA:
00880 strcpy(subclass, "Data");
00881 break;
00882 case AST_HTML_BEGIN:
00883 strcpy(subclass, "Begin");
00884 break;
00885 case AST_HTML_END:
00886 strcpy(subclass, "End");
00887 break;
00888 case AST_HTML_LDCOMPLETE:
00889 strcpy(subclass, "Load Complete");
00890 break;
00891 case AST_HTML_NOSUPPORT:
00892 strcpy(subclass, "No Support");
00893 break;
00894 case AST_HTML_LINKURL:
00895 strcpy(subclass, "Link URL");
00896 ast_copy_string(moreinfo, f->data, sizeof(moreinfo));
00897 break;
00898 case AST_HTML_UNLINK:
00899 strcpy(subclass, "Unlink");
00900 break;
00901 case AST_HTML_LINKREJECT:
00902 strcpy(subclass, "Link Reject");
00903 break;
00904 default:
00905 snprintf(subclass, sizeof(subclass), "Unknown HTML frame '%d'\n", f->subclass);
00906 break;
00907 }
00908 break;
00909 case AST_FRAME_MODEM:
00910 strcpy(ftype, "Modem");
00911 switch (f->subclass) {
00912 case AST_MODEM_T38:
00913 strcpy(subclass, "T.38");
00914 break;
00915 case AST_MODEM_V150:
00916 strcpy(subclass, "V.150");
00917 break;
00918 default:
00919 snprintf(subclass, sizeof(subclass), "Unknown MODEM frame '%d'\n", f->subclass);
00920 break;
00921 }
00922 break;
00923 default:
00924 snprintf(ftype, sizeof(ftype), "Unknown Frametype '%d'", f->frametype);
00925 }
00926 if (!ast_strlen_zero(moreinfo))
00927 ast_verbose("%s [ TYPE: %s (%d) SUBCLASS: %s (%d) '%s' ] [%s]\n",
00928 term_color(cp, prefix, COLOR_BRMAGENTA, COLOR_BLACK, sizeof(cp)),
00929 term_color(cft, ftype, COLOR_BRRED, COLOR_BLACK, sizeof(cft)),
00930 f->frametype,
00931 term_color(csub, subclass, COLOR_BRCYAN, COLOR_BLACK, sizeof(csub)),
00932 f->subclass,
00933 term_color(cmn, moreinfo, COLOR_BRGREEN, COLOR_BLACK, sizeof(cmn)),
00934 term_color(cn, name, COLOR_YELLOW, COLOR_BLACK, sizeof(cn)));
00935 else
00936 ast_verbose("%s [ TYPE: %s (%d) SUBCLASS: %s (%d) ] [%s]\n",
00937 term_color(cp, prefix, COLOR_BRMAGENTA, COLOR_BLACK, sizeof(cp)),
00938 term_color(cft, ftype, COLOR_BRRED, COLOR_BLACK, sizeof(cft)),
00939 f->frametype,
00940 term_color(csub, subclass, COLOR_BRCYAN, COLOR_BLACK, sizeof(csub)),
00941 f->subclass,
00942 term_color(cn, name, COLOR_YELLOW, COLOR_BLACK, sizeof(cn)));
00943 }
00944
00945
00946 #ifdef TRACE_FRAMES
00947 static int show_frame_stats(int fd, int argc, char *argv[])
00948 {
00949 struct ast_frame *f;
00950 int x=1;
00951 if (argc != 4)
00952 return RESULT_SHOWUSAGE;
00953 AST_LIST_LOCK(&headerlist);
00954 ast_cli(fd, " Framer Statistics \n");
00955 ast_cli(fd, "---------------------------\n");
00956 ast_cli(fd, "Total allocated headers: %d\n", headers);
00957 ast_cli(fd, "Queue Dump:\n");
00958 AST_LIST_TRAVERSE(&headerlist, f, frame_list)
00959 ast_cli(fd, "%d. Type %d, subclass %d from %s\n", x++, f->frametype, f->subclass, f->src ? f->src : "<Unknown>");
00960 AST_LIST_UNLOCK(&headerlist);
00961 return RESULT_SUCCESS;
00962 }
00963
00964 static char frame_stats_usage[] =
00965 "Usage: core show frame stats\n"
00966 " Displays debugging statistics from framer\n";
00967 #endif
00968
00969
00970 static struct ast_cli_entry cli_show_codecs = {
00971 { "show", "codecs", NULL },
00972 show_codecs_deprecated, NULL,
00973 NULL };
00974
00975 static struct ast_cli_entry cli_show_audio_codecs = {
00976 { "show", "audio", "codecs", NULL },
00977 show_codecs_deprecated, NULL,
00978 NULL };
00979
00980 static struct ast_cli_entry cli_show_video_codecs = {
00981 { "show", "video", "codecs", NULL },
00982 show_codecs_deprecated, NULL,
00983 NULL };
00984
00985 static struct ast_cli_entry cli_show_image_codecs = {
00986 { "show", "image", "codecs", NULL },
00987 show_codecs_deprecated, NULL,
00988 NULL };
00989
00990 static struct ast_cli_entry cli_show_codec = {
00991 { "show", "codec", NULL },
00992 show_codec_n_deprecated, NULL,
00993 NULL };
00994
00995 #ifdef TRACE_FRAMES
00996 static struct ast_cli_entry cli_show_frame_stats = {
00997 { "show", "frame", "stats", NULL },
00998 show_frame_stats, NULL,
00999 NULL };
01000 #endif
01001
01002 static struct ast_cli_entry my_clis[] = {
01003 { { "core", "show", "codecs", NULL },
01004 show_codecs, "Displays a list of codecs",
01005 frame_show_codecs_usage, NULL, &cli_show_codecs },
01006
01007 { { "core", "show", "audio", "codecs", NULL },
01008 show_codecs, "Displays a list of audio codecs",
01009 frame_show_codecs_usage, NULL, &cli_show_audio_codecs },
01010
01011 { { "core", "show", "video", "codecs", NULL },
01012 show_codecs, "Displays a list of video codecs",
01013 frame_show_codecs_usage, NULL, &cli_show_video_codecs },
01014
01015 { { "core", "show", "image", "codecs", NULL },
01016 show_codecs, "Displays a list of image codecs",
01017 frame_show_codecs_usage, NULL, &cli_show_image_codecs },
01018
01019 { { "core", "show", "codec", NULL },
01020 show_codec_n, "Shows a specific codec",
01021 frame_show_codec_n_usage, NULL, &cli_show_codec },
01022
01023 #ifdef TRACE_FRAMES
01024 { { "core", "show", "frame", "stats", NULL },
01025 show_frame_stats, "Shows frame statistics",
01026 frame_stats_usage, NULL, &cli_show_frame_stats },
01027 #endif
01028 };
01029
01030 int init_framer(void)
01031 {
01032 ast_cli_register_multiple(my_clis, sizeof(my_clis) / sizeof(struct ast_cli_entry));
01033 return 0;
01034 }
01035
01036 void ast_codec_pref_convert(struct ast_codec_pref *pref, char *buf, size_t size, int right)
01037 {
01038 int x, differential = (int) 'A', mem;
01039 char *from, *to;
01040
01041 if(right) {
01042 from = pref->order;
01043 to = buf;
01044 mem = size;
01045 } else {
01046 to = pref->order;
01047 from = buf;
01048 mem = 32;
01049 }
01050
01051 memset(to, 0, mem);
01052 for (x = 0; x < 32 ; x++) {
01053 if(!from[x])
01054 break;
01055 to[x] = right ? (from[x] + differential) : (from[x] - differential);
01056 }
01057 }
01058
01059 int ast_codec_pref_string(struct ast_codec_pref *pref, char *buf, size_t size)
01060 {
01061 int x, codec;
01062 size_t total_len, slen;
01063 char *formatname;
01064
01065 memset(buf,0,size);
01066 total_len = size;
01067 buf[0] = '(';
01068 total_len--;
01069 for(x = 0; x < 32 ; x++) {
01070 if(total_len <= 0)
01071 break;
01072 if(!(codec = ast_codec_pref_index(pref,x)))
01073 break;
01074 if((formatname = ast_getformatname(codec))) {
01075 slen = strlen(formatname);
01076 if(slen > total_len)
01077 break;
01078 strncat(buf, formatname, total_len - 1);
01079 total_len -= slen;
01080 }
01081 if(total_len && x < 31 && ast_codec_pref_index(pref , x + 1)) {
01082 strncat(buf, "|", total_len - 1);
01083 total_len--;
01084 }
01085 }
01086 if(total_len) {
01087 strncat(buf, ")", total_len - 1);
01088 total_len--;
01089 }
01090
01091 return size - total_len;
01092 }
01093
01094 int ast_codec_pref_index(struct ast_codec_pref *pref, int index)
01095 {
01096 int slot = 0;
01097
01098
01099 if((index >= 0) && (index < sizeof(pref->order))) {
01100 slot = pref->order[index];
01101 }
01102
01103 return slot ? AST_FORMAT_LIST[slot-1].bits : 0;
01104 }
01105
01106
01107 void ast_codec_pref_remove(struct ast_codec_pref *pref, int format)
01108 {
01109 struct ast_codec_pref oldorder;
01110 int x, y = 0;
01111 int slot;
01112 int size;
01113
01114 if(!pref->order[0])
01115 return;
01116
01117 memcpy(&oldorder, pref, sizeof(oldorder));
01118 memset(pref, 0, sizeof(*pref));
01119
01120 for (x = 0; x < sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]); x++) {
01121 slot = oldorder.order[x];
01122 size = oldorder.framing[x];
01123 if(! slot)
01124 break;
01125 if(AST_FORMAT_LIST[slot-1].bits != format) {
01126 pref->order[y] = slot;
01127 pref->framing[y++] = size;
01128 }
01129 }
01130
01131 }
01132
01133
01134 int ast_codec_pref_append(struct ast_codec_pref *pref, int format)
01135 {
01136 int x, newindex = 0;
01137
01138 ast_codec_pref_remove(pref, format);
01139
01140 for (x = 0; x < sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]); x++) {
01141 if(AST_FORMAT_LIST[x].bits == format) {
01142 newindex = x + 1;
01143 break;
01144 }
01145 }
01146
01147 if(newindex) {
01148 for (x = 0; x < sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]); x++) {
01149 if(!pref->order[x]) {
01150 pref->order[x] = newindex;
01151 break;
01152 }
01153 }
01154 }
01155
01156 return x;
01157 }
01158
01159
01160 void ast_codec_pref_prepend(struct ast_codec_pref *pref, int format, int only_if_existing)
01161 {
01162 int x, newindex = 0;
01163
01164
01165 for (x = 0; x < ARRAY_LEN(AST_FORMAT_LIST); x++) {
01166 if (AST_FORMAT_LIST[x].bits == format) {
01167 newindex = x + 1;
01168 break;
01169 }
01170 }
01171
01172 if (!newindex)
01173 return;
01174
01175
01176 for (x = 0; x < 32; x++) {
01177 if (!pref->order[x] || pref->order[x] == newindex)
01178 break;
01179 }
01180
01181 if (only_if_existing && !pref->order[x])
01182 return;
01183
01184
01185
01186 for (; x > 0; x--) {
01187 pref->order[x] = pref->order[x - 1];
01188 pref->framing[x] = pref->framing[x - 1];
01189 }
01190
01191
01192 pref->order[0] = newindex;
01193 pref->framing[0] = 0;
01194 }
01195
01196
01197 int ast_codec_pref_setsize(struct ast_codec_pref *pref, int format, int framems)
01198 {
01199 int x, index = -1;
01200
01201 for (x = 0; x < sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]); x++) {
01202 if(AST_FORMAT_LIST[x].bits == format) {
01203 index = x;
01204 break;
01205 }
01206 }
01207
01208 if(index < 0)
01209 return -1;
01210
01211
01212 if(!framems)
01213 framems = AST_FORMAT_LIST[index].def_ms;
01214
01215 if(AST_FORMAT_LIST[index].inc_ms && framems % AST_FORMAT_LIST[index].inc_ms)
01216 framems -= framems % AST_FORMAT_LIST[index].inc_ms;
01217
01218 if(framems < AST_FORMAT_LIST[index].min_ms)
01219 framems = AST_FORMAT_LIST[index].min_ms;
01220
01221 if(framems > AST_FORMAT_LIST[index].max_ms)
01222 framems = AST_FORMAT_LIST[index].max_ms;
01223
01224
01225 for (x = 0; x < sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]); x++) {
01226 if(pref->order[x] == (index + 1)) {
01227 pref->framing[x] = framems;
01228 break;
01229 }
01230 }
01231
01232 return x;
01233 }
01234
01235
01236 struct ast_format_list ast_codec_pref_getsize(struct ast_codec_pref *pref, int format)
01237 {
01238 int x, index = -1, framems = 0;
01239 struct ast_format_list fmt = {0};
01240
01241 for (x = 0; x < sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]); x++) {
01242 if(AST_FORMAT_LIST[x].bits == format) {
01243 fmt = AST_FORMAT_LIST[x];
01244 index = x;
01245 break;
01246 }
01247 }
01248
01249 for (x = 0; x < sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]); x++) {
01250 if(pref->order[x] == (index + 1)) {
01251 framems = pref->framing[x];
01252 break;
01253 }
01254 }
01255
01256
01257 if(!framems)
01258 framems = AST_FORMAT_LIST[index].def_ms;
01259
01260 if(AST_FORMAT_LIST[index].inc_ms && framems % AST_FORMAT_LIST[index].inc_ms)
01261 framems -= framems % AST_FORMAT_LIST[index].inc_ms;
01262
01263 if(framems < AST_FORMAT_LIST[index].min_ms)
01264 framems = AST_FORMAT_LIST[index].min_ms;
01265
01266 if(framems > AST_FORMAT_LIST[index].max_ms)
01267 framems = AST_FORMAT_LIST[index].max_ms;
01268
01269 fmt.cur_ms = framems;
01270
01271 return fmt;
01272 }
01273
01274
01275 int ast_codec_choose(struct ast_codec_pref *pref, int formats, int find_best)
01276 {
01277 int x, ret = 0, slot;
01278
01279 for (x = 0; x < sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]); x++) {
01280 slot = pref->order[x];
01281
01282 if (!slot)
01283 break;
01284 if (formats & AST_FORMAT_LIST[slot-1].bits) {
01285 ret = AST_FORMAT_LIST[slot-1].bits;
01286 break;
01287 }
01288 }
01289 if(ret & AST_FORMAT_AUDIO_MASK)
01290 return ret;
01291
01292 if (option_debug > 3)
01293 ast_log(LOG_DEBUG, "Could not find preferred codec - %s\n", find_best ? "Going for the best codec" : "Returning zero codec");
01294
01295 return find_best ? ast_best_codec(formats) : 0;
01296 }
01297
01298 void ast_parse_allow_disallow(struct ast_codec_pref *pref, int *mask, const char *list, int allowing)
01299 {
01300 char *parse = NULL, *this = NULL, *psize = NULL;
01301 int format = 0, framems = 0;
01302
01303 parse = ast_strdupa(list);
01304 while ((this = strsep(&parse, ","))) {
01305 framems = 0;
01306 if ((psize = strrchr(this, ':'))) {
01307 *psize++ = '\0';
01308 if (option_debug)
01309 ast_log(LOG_DEBUG,"Packetization for codec: %s is %s\n", this, psize);
01310 framems = atoi(psize);
01311 if (framems < 0)
01312 framems = 0;
01313 }
01314 if (!(format = ast_getformatbyname(this))) {
01315 ast_log(LOG_WARNING, "Cannot %s unknown format '%s'\n", allowing ? "allow" : "disallow", this);
01316 continue;
01317 }
01318
01319 if (mask) {
01320 if (allowing)
01321 *mask |= format;
01322 else
01323 *mask &= ~format;
01324 }
01325
01326
01327
01328
01329 if (pref && (format & AST_FORMAT_AUDIO_MASK)) {
01330 if (strcasecmp(this, "all")) {
01331 if (allowing) {
01332 ast_codec_pref_append(pref, format);
01333 ast_codec_pref_setsize(pref, format, framems);
01334 }
01335 else
01336 ast_codec_pref_remove(pref, format);
01337 } else if (!allowing) {
01338 memset(pref, 0, sizeof(*pref));
01339 }
01340 }
01341 }
01342 }
01343
01344 static int g723_len(unsigned char buf)
01345 {
01346 enum frame_type type = buf & TYPE_MASK;
01347
01348 switch(type) {
01349 case TYPE_DONTSEND:
01350 return 0;
01351 break;
01352 case TYPE_SILENCE:
01353 return 4;
01354 break;
01355 case TYPE_HIGH:
01356 return 24;
01357 break;
01358 case TYPE_LOW:
01359 return 20;
01360 break;
01361 default:
01362 ast_log(LOG_WARNING, "Badly encoded frame (%d)\n", type);
01363 }
01364 return -1;
01365 }
01366
01367 static int g723_samples(unsigned char *buf, int maxlen)
01368 {
01369 int pos = 0;
01370 int samples = 0;
01371 int res;
01372 while(pos < maxlen) {
01373 res = g723_len(buf[pos]);
01374 if (res <= 0)
01375 break;
01376 samples += 240;
01377 pos += res;
01378 }
01379 return samples;
01380 }
01381
01382 static unsigned char get_n_bits_at(unsigned char *data, int n, int bit)
01383 {
01384 int byte = bit / 8;
01385 int rem = 8 - (bit % 8);
01386 unsigned char ret = 0;
01387
01388 if (n <= 0 || n > 8)
01389 return 0;
01390
01391 if (rem < n) {
01392 ret = (data[byte] << (n - rem));
01393 ret |= (data[byte + 1] >> (8 - n + rem));
01394 } else {
01395 ret = (data[byte] >> (rem - n));
01396 }
01397
01398 return (ret & (0xff >> (8 - n)));
01399 }
01400
01401 static int speex_get_wb_sz_at(unsigned char *data, int len, int bit)
01402 {
01403 static int SpeexWBSubModeSz[] = {
01404 0, 36, 112, 192,
01405 352, 0, 0, 0 };
01406 int off = bit;
01407 unsigned char c;
01408
01409
01410 if (((len * 8 - off) >= 5) &&
01411 get_n_bits_at(data, 1, off)) {
01412 c = get_n_bits_at(data, 3, off + 1);
01413 off += SpeexWBSubModeSz[c];
01414
01415 if (((len * 8 - off) >= 5) &&
01416 get_n_bits_at(data, 1, off)) {
01417 c = get_n_bits_at(data, 3, off + 1);
01418 off += SpeexWBSubModeSz[c];
01419
01420 if (((len * 8 - off) >= 5) &&
01421 get_n_bits_at(data, 1, off)) {
01422 ast_log(LOG_WARNING, "Encountered corrupt speex frame; too many wideband frames in a row.\n");
01423 return -1;
01424 }
01425 }
01426
01427 }
01428 return off - bit;
01429 }
01430
01431 static int speex_samples(unsigned char *data, int len)
01432 {
01433 static int SpeexSubModeSz[] = {
01434 5, 43, 119, 160,
01435 220, 300, 364, 492,
01436 79, 0, 0, 0,
01437 0, 0, 0, 0 };
01438 static int SpeexInBandSz[] = {
01439 1, 1, 4, 4,
01440 4, 4, 4, 4,
01441 8, 8, 16, 16,
01442 32, 32, 64, 64 };
01443 int bit = 0;
01444 int cnt = 0;
01445 int off;
01446 unsigned char c;
01447
01448 while ((len * 8 - bit) >= 5) {
01449
01450 off = speex_get_wb_sz_at(data, len, bit);
01451 if (off < 0) {
01452 ast_log(LOG_WARNING, "Had error while reading wideband frames for speex samples\n");
01453 break;
01454 }
01455 bit += off;
01456
01457 if ((len * 8 - bit) < 5) {
01458 ast_log(LOG_WARNING, "Not enough bits remaining after wide band for speex samples.\n");
01459 break;
01460 }
01461
01462
01463 c = get_n_bits_at(data, 5, bit);
01464 bit += 5;
01465
01466 if (c == 15) {
01467
01468 break;
01469 } else if (c == 14) {
01470
01471 c = get_n_bits_at(data, 4, bit);
01472 bit += 4;
01473 bit += SpeexInBandSz[c];
01474 } else if (c == 13) {
01475
01476 c = get_n_bits_at(data, 5, bit);
01477 bit += 5;
01478 bit += c * 8;
01479 } else if (c > 8) {
01480
01481 break;
01482 } else {
01483
01484 bit += SpeexSubModeSz[c] - 5;
01485 cnt += 160;
01486 }
01487 }
01488 return cnt;
01489 }
01490
01491 int ast_codec_get_samples(struct ast_frame *f)
01492 {
01493 int samples=0;
01494 switch(f->subclass) {
01495 case AST_FORMAT_SPEEX:
01496 samples = speex_samples(f->data, f->datalen);
01497 break;
01498 case AST_FORMAT_G723_1:
01499 samples = g723_samples(f->data, f->datalen);
01500 break;
01501 case AST_FORMAT_ILBC:
01502 samples = 240 * (f->datalen / 50);
01503 break;
01504 case AST_FORMAT_GSM:
01505 samples = 160 * (f->datalen / 33);
01506 break;
01507 case AST_FORMAT_G729A:
01508 samples = f->datalen * 8;
01509 break;
01510 case AST_FORMAT_SLINEAR:
01511 samples = f->datalen / 2;
01512 break;
01513 case AST_FORMAT_LPC10:
01514
01515 samples = 22 * 8;
01516 samples += (((char *)(f->data))[7] & 0x1) * 8;
01517 break;
01518 case AST_FORMAT_ULAW:
01519 case AST_FORMAT_ALAW:
01520 samples = f->datalen;
01521 break;
01522 case AST_FORMAT_G722:
01523 case AST_FORMAT_ADPCM:
01524 case AST_FORMAT_G726:
01525 case AST_FORMAT_G726_AAL2:
01526 samples = f->datalen * 2;
01527 break;
01528 default:
01529 ast_log(LOG_WARNING, "Unable to calculate samples for format %s\n", ast_getformatname(f->subclass));
01530 }
01531 return samples;
01532 }
01533
01534 int ast_codec_get_len(int format, int samples)
01535 {
01536 int len = 0;
01537
01538
01539 switch(format) {
01540 case AST_FORMAT_ILBC:
01541 len = (samples / 240) * 50;
01542 break;
01543 case AST_FORMAT_GSM:
01544 len = (samples / 160) * 33;
01545 break;
01546 case AST_FORMAT_G729A:
01547 len = samples / 8;
01548 break;
01549 case AST_FORMAT_SLINEAR:
01550 len = samples * 2;
01551 break;
01552 case AST_FORMAT_ULAW:
01553 case AST_FORMAT_ALAW:
01554 len = samples;
01555 break;
01556 case AST_FORMAT_G722:
01557 case AST_FORMAT_ADPCM:
01558 case AST_FORMAT_G726:
01559 case AST_FORMAT_G726_AAL2:
01560 len = samples / 2;
01561 break;
01562 default:
01563 ast_log(LOG_WARNING, "Unable to calculate sample length for format %s\n", ast_getformatname(format));
01564 }
01565
01566 return len;
01567 }
01568
01569 int ast_frame_adjust_volume(struct ast_frame *f, int adjustment)
01570 {
01571 int count;
01572 short *fdata = f->data;
01573 short adjust_value = abs(adjustment);
01574
01575 if ((f->frametype != AST_FRAME_VOICE) || (f->subclass != AST_FORMAT_SLINEAR))
01576 return -1;
01577
01578 if (!adjustment)
01579 return 0;
01580
01581 for (count = 0; count < f->samples; count++) {
01582 if (adjustment > 0) {
01583 ast_slinear_saturated_multiply(&fdata[count], &adjust_value);
01584 } else if (adjustment < 0) {
01585 ast_slinear_saturated_divide(&fdata[count], &adjust_value);
01586 }
01587 }
01588
01589 return 0;
01590 }
01591
01592 int ast_frame_slinear_sum(struct ast_frame *f1, struct ast_frame *f2)
01593 {
01594 int count;
01595 short *data1, *data2;
01596
01597 if ((f1->frametype != AST_FRAME_VOICE) || (f1->subclass != AST_FORMAT_SLINEAR))
01598 return -1;
01599
01600 if ((f2->frametype != AST_FRAME_VOICE) || (f2->subclass != AST_FORMAT_SLINEAR))
01601 return -1;
01602
01603 if (f1->samples != f2->samples)
01604 return -1;
01605
01606 for (count = 0, data1 = f1->data, data2 = f2->data;
01607 count < f1->samples;
01608 count++, data1++, data2++)
01609 ast_slinear_saturated_add(data1, data2);
01610
01611 return 0;
01612 }