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: 114211 $")
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, 20, 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", "G722"},
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 -1:
00836 strcpy(subclass, "Stop generators");
00837 break;
00838 default:
00839 snprintf(subclass, sizeof(subclass), "Unknown control '%d'", f->subclass);
00840 }
00841 break;
00842 case AST_FRAME_NULL:
00843 strcpy(ftype, "Null Frame");
00844 strcpy(subclass, "N/A");
00845 break;
00846 case AST_FRAME_IAX:
00847
00848 strcpy(ftype, "IAX Specific");
00849 snprintf(subclass, sizeof(subclass), "IAX Frametype %d", f->subclass);
00850 break;
00851 case AST_FRAME_TEXT:
00852 strcpy(ftype, "Text");
00853 strcpy(subclass, "N/A");
00854 ast_copy_string(moreinfo, f->data, sizeof(moreinfo));
00855 break;
00856 case AST_FRAME_IMAGE:
00857 strcpy(ftype, "Image");
00858 snprintf(subclass, sizeof(subclass), "Image format %s\n", ast_getformatname(f->subclass));
00859 break;
00860 case AST_FRAME_HTML:
00861 strcpy(ftype, "HTML");
00862 switch(f->subclass) {
00863 case AST_HTML_URL:
00864 strcpy(subclass, "URL");
00865 ast_copy_string(moreinfo, f->data, sizeof(moreinfo));
00866 break;
00867 case AST_HTML_DATA:
00868 strcpy(subclass, "Data");
00869 break;
00870 case AST_HTML_BEGIN:
00871 strcpy(subclass, "Begin");
00872 break;
00873 case AST_HTML_END:
00874 strcpy(subclass, "End");
00875 break;
00876 case AST_HTML_LDCOMPLETE:
00877 strcpy(subclass, "Load Complete");
00878 break;
00879 case AST_HTML_NOSUPPORT:
00880 strcpy(subclass, "No Support");
00881 break;
00882 case AST_HTML_LINKURL:
00883 strcpy(subclass, "Link URL");
00884 ast_copy_string(moreinfo, f->data, sizeof(moreinfo));
00885 break;
00886 case AST_HTML_UNLINK:
00887 strcpy(subclass, "Unlink");
00888 break;
00889 case AST_HTML_LINKREJECT:
00890 strcpy(subclass, "Link Reject");
00891 break;
00892 default:
00893 snprintf(subclass, sizeof(subclass), "Unknown HTML frame '%d'\n", f->subclass);
00894 break;
00895 }
00896 break;
00897 case AST_FRAME_MODEM:
00898 strcpy(ftype, "Modem");
00899 switch (f->subclass) {
00900 case AST_MODEM_T38:
00901 strcpy(subclass, "T.38");
00902 break;
00903 case AST_MODEM_V150:
00904 strcpy(subclass, "V.150");
00905 break;
00906 default:
00907 snprintf(subclass, sizeof(subclass), "Unknown MODEM frame '%d'\n", f->subclass);
00908 break;
00909 }
00910 break;
00911 default:
00912 snprintf(ftype, sizeof(ftype), "Unknown Frametype '%d'", f->frametype);
00913 }
00914 if (!ast_strlen_zero(moreinfo))
00915 ast_verbose("%s [ TYPE: %s (%d) SUBCLASS: %s (%d) '%s' ] [%s]\n",
00916 term_color(cp, prefix, COLOR_BRMAGENTA, COLOR_BLACK, sizeof(cp)),
00917 term_color(cft, ftype, COLOR_BRRED, COLOR_BLACK, sizeof(cft)),
00918 f->frametype,
00919 term_color(csub, subclass, COLOR_BRCYAN, COLOR_BLACK, sizeof(csub)),
00920 f->subclass,
00921 term_color(cmn, moreinfo, COLOR_BRGREEN, COLOR_BLACK, sizeof(cmn)),
00922 term_color(cn, name, COLOR_YELLOW, COLOR_BLACK, sizeof(cn)));
00923 else
00924 ast_verbose("%s [ TYPE: %s (%d) SUBCLASS: %s (%d) ] [%s]\n",
00925 term_color(cp, prefix, COLOR_BRMAGENTA, COLOR_BLACK, sizeof(cp)),
00926 term_color(cft, ftype, COLOR_BRRED, COLOR_BLACK, sizeof(cft)),
00927 f->frametype,
00928 term_color(csub, subclass, COLOR_BRCYAN, COLOR_BLACK, sizeof(csub)),
00929 f->subclass,
00930 term_color(cn, name, COLOR_YELLOW, COLOR_BLACK, sizeof(cn)));
00931 }
00932
00933
00934 #ifdef TRACE_FRAMES
00935 static int show_frame_stats_deprecated(int fd, int argc, char *argv[])
00936 {
00937 struct ast_frame *f;
00938 int x=1;
00939 if (argc != 3)
00940 return RESULT_SHOWUSAGE;
00941 AST_LIST_LOCK(&headerlist);
00942 ast_cli(fd, " Framer Statistics \n");
00943 ast_cli(fd, "---------------------------\n");
00944 ast_cli(fd, "Total allocated headers: %d\n", headers);
00945 ast_cli(fd, "Queue Dump:\n");
00946 AST_LIST_TRAVERSE(&headerlist, f, frame_list)
00947 ast_cli(fd, "%d. Type %d, subclass %d from %s\n", x++, f->frametype, f->subclass, f->src ? f->src : "<Unknown>");
00948 AST_LIST_UNLOCK(&headerlist);
00949 return RESULT_SUCCESS;
00950 }
00951
00952 static int show_frame_stats(int fd, int argc, char *argv[])
00953 {
00954 struct ast_frame *f;
00955 int x=1;
00956 if (argc != 4)
00957 return RESULT_SHOWUSAGE;
00958 AST_LIST_LOCK(&headerlist);
00959 ast_cli(fd, " Framer Statistics \n");
00960 ast_cli(fd, "---------------------------\n");
00961 ast_cli(fd, "Total allocated headers: %d\n", headers);
00962 ast_cli(fd, "Queue Dump:\n");
00963 AST_LIST_TRAVERSE(&headerlist, f, frame_list)
00964 ast_cli(fd, "%d. Type %d, subclass %d from %s\n", x++, f->frametype, f->subclass, f->src ? f->src : "<Unknown>");
00965 AST_LIST_UNLOCK(&headerlist);
00966 return RESULT_SUCCESS;
00967 }
00968
00969 static char frame_stats_usage[] =
00970 "Usage: core show frame stats\n"
00971 " Displays debugging statistics from framer\n";
00972 #endif
00973
00974
00975 static struct ast_cli_entry cli_show_codecs = {
00976 { "show", "codecs", NULL },
00977 show_codecs_deprecated, NULL,
00978 NULL };
00979
00980 static struct ast_cli_entry cli_show_audio_codecs = {
00981 { "show", "audio", "codecs", NULL },
00982 show_codecs_deprecated, NULL,
00983 NULL };
00984
00985 static struct ast_cli_entry cli_show_video_codecs = {
00986 { "show", "video", "codecs", NULL },
00987 show_codecs_deprecated, NULL,
00988 NULL };
00989
00990 static struct ast_cli_entry cli_show_image_codecs = {
00991 { "show", "image", "codecs", NULL },
00992 show_codecs_deprecated, NULL,
00993 NULL };
00994
00995 static struct ast_cli_entry cli_show_codec = {
00996 { "show", "codec", NULL },
00997 show_codec_n_deprecated, NULL,
00998 NULL };
00999
01000 #ifdef TRACE_FRAMES
01001 static struct ast_cli_entry cli_show_frame_stats = {
01002 { "show", "frame", "stats", NULL },
01003 show_frame_stats, NULL,
01004 NULL };
01005 #endif
01006
01007 static struct ast_cli_entry my_clis[] = {
01008 { { "core", "show", "codecs", NULL },
01009 show_codecs, "Displays a list of codecs",
01010 frame_show_codecs_usage, NULL, &cli_show_codecs },
01011
01012 { { "core", "show", "audio", "codecs", NULL },
01013 show_codecs, "Displays a list of audio codecs",
01014 frame_show_codecs_usage, NULL, &cli_show_audio_codecs },
01015
01016 { { "core", "show", "video", "codecs", NULL },
01017 show_codecs, "Displays a list of video codecs",
01018 frame_show_codecs_usage, NULL, &cli_show_video_codecs },
01019
01020 { { "core", "show", "image", "codecs", NULL },
01021 show_codecs, "Displays a list of image codecs",
01022 frame_show_codecs_usage, NULL, &cli_show_image_codecs },
01023
01024 { { "core", "show", "codec", NULL },
01025 show_codec_n, "Shows a specific codec",
01026 frame_show_codec_n_usage, NULL, &cli_show_codec },
01027
01028 #ifdef TRACE_FRAMES
01029 { { "core", "show", "frame", "stats", NULL },
01030 show_frame_stats, "Shows frame statistics",
01031 frame_stats_usage, NULL, &cli_show_frame_stats },
01032 #endif
01033 };
01034
01035 int init_framer(void)
01036 {
01037 ast_cli_register_multiple(my_clis, sizeof(my_clis) / sizeof(struct ast_cli_entry));
01038 return 0;
01039 }
01040
01041 void ast_codec_pref_convert(struct ast_codec_pref *pref, char *buf, size_t size, int right)
01042 {
01043 int x, differential = (int) 'A', mem;
01044 char *from, *to;
01045
01046 if(right) {
01047 from = pref->order;
01048 to = buf;
01049 mem = size;
01050 } else {
01051 to = pref->order;
01052 from = buf;
01053 mem = 32;
01054 }
01055
01056 memset(to, 0, mem);
01057 for (x = 0; x < 32 ; x++) {
01058 if(!from[x])
01059 break;
01060 to[x] = right ? (from[x] + differential) : (from[x] - differential);
01061 }
01062 }
01063
01064 int ast_codec_pref_string(struct ast_codec_pref *pref, char *buf, size_t size)
01065 {
01066 int x, codec;
01067 size_t total_len, slen;
01068 char *formatname;
01069
01070 memset(buf,0,size);
01071 total_len = size;
01072 buf[0] = '(';
01073 total_len--;
01074 for(x = 0; x < 32 ; x++) {
01075 if(total_len <= 0)
01076 break;
01077 if(!(codec = ast_codec_pref_index(pref,x)))
01078 break;
01079 if((formatname = ast_getformatname(codec))) {
01080 slen = strlen(formatname);
01081 if(slen > total_len)
01082 break;
01083 strncat(buf, formatname, total_len - 1);
01084 total_len -= slen;
01085 }
01086 if(total_len && x < 31 && ast_codec_pref_index(pref , x + 1)) {
01087 strncat(buf, "|", total_len - 1);
01088 total_len--;
01089 }
01090 }
01091 if(total_len) {
01092 strncat(buf, ")", total_len - 1);
01093 total_len--;
01094 }
01095
01096 return size - total_len;
01097 }
01098
01099 int ast_codec_pref_index(struct ast_codec_pref *pref, int index)
01100 {
01101 int slot = 0;
01102
01103
01104 if((index >= 0) && (index < sizeof(pref->order))) {
01105 slot = pref->order[index];
01106 }
01107
01108 return slot ? AST_FORMAT_LIST[slot-1].bits : 0;
01109 }
01110
01111
01112 void ast_codec_pref_remove(struct ast_codec_pref *pref, int format)
01113 {
01114 struct ast_codec_pref oldorder;
01115 int x, y = 0;
01116 int slot;
01117 int size;
01118
01119 if(!pref->order[0])
01120 return;
01121
01122 memcpy(&oldorder, pref, sizeof(oldorder));
01123 memset(pref, 0, sizeof(*pref));
01124
01125 for (x = 0; x < sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]); x++) {
01126 slot = oldorder.order[x];
01127 size = oldorder.framing[x];
01128 if(! slot)
01129 break;
01130 if(AST_FORMAT_LIST[slot-1].bits != format) {
01131 pref->order[y] = slot;
01132 pref->framing[y++] = size;
01133 }
01134 }
01135
01136 }
01137
01138
01139 int ast_codec_pref_append(struct ast_codec_pref *pref, int format)
01140 {
01141 int x, newindex = 0;
01142
01143 ast_codec_pref_remove(pref, format);
01144
01145 for (x = 0; x < sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]); x++) {
01146 if(AST_FORMAT_LIST[x].bits == format) {
01147 newindex = x + 1;
01148 break;
01149 }
01150 }
01151
01152 if(newindex) {
01153 for (x = 0; x < sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]); x++) {
01154 if(!pref->order[x]) {
01155 pref->order[x] = newindex;
01156 break;
01157 }
01158 }
01159 }
01160
01161 return x;
01162 }
01163
01164
01165 void ast_codec_pref_prepend(struct ast_codec_pref *pref, int format, int only_if_existing)
01166 {
01167 int x, newindex = 0;
01168
01169
01170 for (x = 0; x < ARRAY_LEN(AST_FORMAT_LIST); x++) {
01171 if (AST_FORMAT_LIST[x].bits == format) {
01172 newindex = x + 1;
01173 break;
01174 }
01175 }
01176
01177 if (!newindex)
01178 return;
01179
01180
01181 for (x = 0; x < 32; x++) {
01182 if (!pref->order[x] || pref->order[x] == newindex)
01183 break;
01184 }
01185
01186 if (only_if_existing && !pref->order[x])
01187 return;
01188
01189
01190
01191 for (; x > 0; x--) {
01192 pref->order[x] = pref->order[x - 1];
01193 pref->framing[x] = pref->framing[x - 1];
01194 }
01195
01196
01197 pref->order[0] = newindex;
01198 pref->framing[0] = 0;
01199 }
01200
01201
01202 int ast_codec_pref_setsize(struct ast_codec_pref *pref, int format, int framems)
01203 {
01204 int x, index = -1;
01205
01206 for (x = 0; x < sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]); x++) {
01207 if(AST_FORMAT_LIST[x].bits == format) {
01208 index = x;
01209 break;
01210 }
01211 }
01212
01213 if(index < 0)
01214 return -1;
01215
01216
01217 if(!framems)
01218 framems = AST_FORMAT_LIST[index].def_ms;
01219
01220 if(AST_FORMAT_LIST[index].inc_ms && framems % AST_FORMAT_LIST[index].inc_ms)
01221 framems -= framems % AST_FORMAT_LIST[index].inc_ms;
01222
01223 if(framems < AST_FORMAT_LIST[index].min_ms)
01224 framems = AST_FORMAT_LIST[index].min_ms;
01225
01226 if(framems > AST_FORMAT_LIST[index].max_ms)
01227 framems = AST_FORMAT_LIST[index].max_ms;
01228
01229
01230 for (x = 0; x < sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]); x++) {
01231 if(pref->order[x] == (index + 1)) {
01232 pref->framing[x] = framems;
01233 break;
01234 }
01235 }
01236
01237 return x;
01238 }
01239
01240
01241 struct ast_format_list ast_codec_pref_getsize(struct ast_codec_pref *pref, int format)
01242 {
01243 int x, index = -1, framems = 0;
01244 struct ast_format_list fmt = {0};
01245
01246 for (x = 0; x < sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]); x++) {
01247 if(AST_FORMAT_LIST[x].bits == format) {
01248 fmt = AST_FORMAT_LIST[x];
01249 index = x;
01250 break;
01251 }
01252 }
01253
01254 for (x = 0; x < sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]); x++) {
01255 if(pref->order[x] == (index + 1)) {
01256 framems = pref->framing[x];
01257 break;
01258 }
01259 }
01260
01261
01262 if(!framems)
01263 framems = AST_FORMAT_LIST[index].def_ms;
01264
01265 if(AST_FORMAT_LIST[index].inc_ms && framems % AST_FORMAT_LIST[index].inc_ms)
01266 framems -= framems % AST_FORMAT_LIST[index].inc_ms;
01267
01268 if(framems < AST_FORMAT_LIST[index].min_ms)
01269 framems = AST_FORMAT_LIST[index].min_ms;
01270
01271 if(framems > AST_FORMAT_LIST[index].max_ms)
01272 framems = AST_FORMAT_LIST[index].max_ms;
01273
01274 fmt.cur_ms = framems;
01275
01276 return fmt;
01277 }
01278
01279
01280 int ast_codec_choose(struct ast_codec_pref *pref, int formats, int find_best)
01281 {
01282 int x, ret = 0, slot;
01283
01284 for (x = 0; x < sizeof(AST_FORMAT_LIST) / sizeof(AST_FORMAT_LIST[0]); x++) {
01285 slot = pref->order[x];
01286
01287 if (!slot)
01288 break;
01289 if (formats & AST_FORMAT_LIST[slot-1].bits) {
01290 ret = AST_FORMAT_LIST[slot-1].bits;
01291 break;
01292 }
01293 }
01294 if(ret & AST_FORMAT_AUDIO_MASK)
01295 return ret;
01296
01297 if (option_debug > 3)
01298 ast_log(LOG_DEBUG, "Could not find preferred codec - %s\n", find_best ? "Going for the best codec" : "Returning zero codec");
01299
01300 return find_best ? ast_best_codec(formats) : 0;
01301 }
01302
01303 void ast_parse_allow_disallow(struct ast_codec_pref *pref, int *mask, const char *list, int allowing)
01304 {
01305 char *parse = NULL, *this = NULL, *psize = NULL;
01306 int format = 0, framems = 0;
01307
01308 parse = ast_strdupa(list);
01309 while ((this = strsep(&parse, ","))) {
01310 framems = 0;
01311 if ((psize = strrchr(this, ':'))) {
01312 *psize++ = '\0';
01313 if (option_debug)
01314 ast_log(LOG_DEBUG,"Packetization for codec: %s is %s\n", this, psize);
01315 framems = atoi(psize);
01316 if (framems < 0)
01317 framems = 0;
01318 }
01319 if (!(format = ast_getformatbyname(this))) {
01320 ast_log(LOG_WARNING, "Cannot %s unknown format '%s'\n", allowing ? "allow" : "disallow", this);
01321 continue;
01322 }
01323
01324 if (mask) {
01325 if (allowing)
01326 *mask |= format;
01327 else
01328 *mask &= ~format;
01329 }
01330
01331
01332
01333
01334 if (pref && (format & AST_FORMAT_AUDIO_MASK)) {
01335 if (strcasecmp(this, "all")) {
01336 if (allowing) {
01337 ast_codec_pref_append(pref, format);
01338 ast_codec_pref_setsize(pref, format, framems);
01339 }
01340 else
01341 ast_codec_pref_remove(pref, format);
01342 } else if (!allowing) {
01343 memset(pref, 0, sizeof(*pref));
01344 }
01345 }
01346 }
01347 }
01348
01349 static int g723_len(unsigned char buf)
01350 {
01351 enum frame_type type = buf & TYPE_MASK;
01352
01353 switch(type) {
01354 case TYPE_DONTSEND:
01355 return 0;
01356 break;
01357 case TYPE_SILENCE:
01358 return 4;
01359 break;
01360 case TYPE_HIGH:
01361 return 24;
01362 break;
01363 case TYPE_LOW:
01364 return 20;
01365 break;
01366 default:
01367 ast_log(LOG_WARNING, "Badly encoded frame (%d)\n", type);
01368 }
01369 return -1;
01370 }
01371
01372 static int g723_samples(unsigned char *buf, int maxlen)
01373 {
01374 int pos = 0;
01375 int samples = 0;
01376 int res;
01377 while(pos < maxlen) {
01378 res = g723_len(buf[pos]);
01379 if (res <= 0)
01380 break;
01381 samples += 240;
01382 pos += res;
01383 }
01384 return samples;
01385 }
01386
01387 static unsigned char get_n_bits_at(unsigned char *data, int n, int bit)
01388 {
01389 int byte = bit / 8;
01390 int rem = 8 - (bit % 8);
01391 unsigned char ret = 0;
01392
01393 if (n <= 0 || n > 8)
01394 return 0;
01395
01396 if (rem < n) {
01397 ret = (data[byte] << (n - rem));
01398 ret |= (data[byte + 1] >> (8 - n + rem));
01399 } else {
01400 ret = (data[byte] >> (rem - n));
01401 }
01402
01403 return (ret & (0xff >> (8 - n)));
01404 }
01405
01406 static int speex_get_wb_sz_at(unsigned char *data, int len, int bit)
01407 {
01408 static int SpeexWBSubModeSz[] = {
01409 0, 36, 112, 192,
01410 352, 0, 0, 0 };
01411 int off = bit;
01412 unsigned char c;
01413
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 c = get_n_bits_at(data, 3, off + 1);
01423 off += SpeexWBSubModeSz[c];
01424
01425 if (((len * 8 - off) >= 5) &&
01426 get_n_bits_at(data, 1, off)) {
01427 ast_log(LOG_WARNING, "Encountered corrupt speex frame; too many wideband frames in a row.\n");
01428 return -1;
01429 }
01430 }
01431
01432 }
01433 return off - bit;
01434 }
01435
01436 static int speex_samples(unsigned char *data, int len)
01437 {
01438 static int SpeexSubModeSz[] = {
01439 5, 43, 119, 160,
01440 220, 300, 364, 492,
01441 79, 0, 0, 0,
01442 0, 0, 0, 0 };
01443 static int SpeexInBandSz[] = {
01444 1, 1, 4, 4,
01445 4, 4, 4, 4,
01446 8, 8, 16, 16,
01447 32, 32, 64, 64 };
01448 int bit = 0;
01449 int cnt = 0;
01450 int off;
01451 unsigned char c;
01452
01453 while ((len * 8 - bit) >= 5) {
01454
01455 off = speex_get_wb_sz_at(data, len, bit);
01456 if (off < 0) {
01457 ast_log(LOG_WARNING, "Had error while reading wideband frames for speex samples\n");
01458 break;
01459 }
01460 bit += off;
01461
01462 if ((len * 8 - bit) < 5) {
01463 ast_log(LOG_WARNING, "Not enough bits remaining after wide band for speex samples.\n");
01464 break;
01465 }
01466
01467
01468 c = get_n_bits_at(data, 5, bit);
01469 bit += 5;
01470
01471 if (c == 15) {
01472
01473 break;
01474 } else if (c == 14) {
01475
01476 c = get_n_bits_at(data, 4, bit);
01477 bit += 4;
01478 bit += SpeexInBandSz[c];
01479 } else if (c == 13) {
01480
01481 c = get_n_bits_at(data, 5, bit);
01482 bit += 5;
01483 bit += c * 8;
01484 } else if (c > 8) {
01485
01486 break;
01487 } else {
01488
01489 bit += SpeexSubModeSz[c] - 5;
01490 cnt += 160;
01491 }
01492 }
01493 return cnt;
01494 }
01495
01496 int ast_codec_get_samples(struct ast_frame *f)
01497 {
01498 int samples=0;
01499 switch(f->subclass) {
01500 case AST_FORMAT_SPEEX:
01501 samples = speex_samples(f->data, f->datalen);
01502 break;
01503 case AST_FORMAT_G723_1:
01504 samples = g723_samples(f->data, f->datalen);
01505 break;
01506 case AST_FORMAT_ILBC:
01507 samples = 240 * (f->datalen / 50);
01508 break;
01509 case AST_FORMAT_GSM:
01510 samples = 160 * (f->datalen / 33);
01511 break;
01512 case AST_FORMAT_G729A:
01513 samples = f->datalen * 8;
01514 break;
01515 case AST_FORMAT_SLINEAR:
01516 samples = f->datalen / 2;
01517 break;
01518 case AST_FORMAT_LPC10:
01519
01520 samples = 22 * 8;
01521 samples += (((char *)(f->data))[7] & 0x1) * 8;
01522 break;
01523 case AST_FORMAT_ULAW:
01524 case AST_FORMAT_ALAW:
01525 samples = f->datalen;
01526 break;
01527 case AST_FORMAT_G722:
01528 case AST_FORMAT_ADPCM:
01529 case AST_FORMAT_G726:
01530 case AST_FORMAT_G726_AAL2:
01531 samples = f->datalen * 2;
01532 break;
01533 default:
01534 ast_log(LOG_WARNING, "Unable to calculate samples for format %s\n", ast_getformatname(f->subclass));
01535 }
01536 return samples;
01537 }
01538
01539 int ast_codec_get_len(int format, int samples)
01540 {
01541 int len = 0;
01542
01543
01544 switch(format) {
01545 case AST_FORMAT_ILBC:
01546 len = (samples / 240) * 50;
01547 break;
01548 case AST_FORMAT_GSM:
01549 len = (samples / 160) * 33;
01550 break;
01551 case AST_FORMAT_G729A:
01552 len = samples / 8;
01553 break;
01554 case AST_FORMAT_SLINEAR:
01555 len = samples * 2;
01556 break;
01557 case AST_FORMAT_ULAW:
01558 case AST_FORMAT_ALAW:
01559 len = samples;
01560 break;
01561 case AST_FORMAT_G722:
01562 case AST_FORMAT_ADPCM:
01563 case AST_FORMAT_G726:
01564 case AST_FORMAT_G726_AAL2:
01565 len = samples / 2;
01566 break;
01567 default:
01568 ast_log(LOG_WARNING, "Unable to calculate sample length for format %s\n", ast_getformatname(format));
01569 }
01570
01571 return len;
01572 }
01573
01574 int ast_frame_adjust_volume(struct ast_frame *f, int adjustment)
01575 {
01576 int count;
01577 short *fdata = f->data;
01578 short adjust_value = abs(adjustment);
01579
01580 if ((f->frametype != AST_FRAME_VOICE) || (f->subclass != AST_FORMAT_SLINEAR))
01581 return -1;
01582
01583 if (!adjustment)
01584 return 0;
01585
01586 for (count = 0; count < f->samples; count++) {
01587 if (adjustment > 0) {
01588 ast_slinear_saturated_multiply(&fdata[count], &adjust_value);
01589 } else if (adjustment < 0) {
01590 ast_slinear_saturated_divide(&fdata[count], &adjust_value);
01591 }
01592 }
01593
01594 return 0;
01595 }
01596
01597 int ast_frame_slinear_sum(struct ast_frame *f1, struct ast_frame *f2)
01598 {
01599 int count;
01600 short *data1, *data2;
01601
01602 if ((f1->frametype != AST_FRAME_VOICE) || (f1->subclass != AST_FORMAT_SLINEAR))
01603 return -1;
01604
01605 if ((f2->frametype != AST_FRAME_VOICE) || (f2->subclass != AST_FORMAT_SLINEAR))
01606 return -1;
01607
01608 if (f1->samples != f2->samples)
01609 return -1;
01610
01611 for (count = 0, data1 = f1->data, data2 = f2->data;
01612 count < f1->samples;
01613 count++, data1++, data2++)
01614 ast_slinear_saturated_add(data1, data2);
01615
01616 return 0;
01617 }