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
00027
00028
00029
00030
00031
00032
00033 #include "asterisk.h"
00034
00035 ASTERISK_FILE_VERSION(__FILE__, "$Revision: 176809 $")
00036
00037 #include <fcntl.h>
00038 #include <netinet/in.h>
00039 #include <sys/ioctl.h>
00040 #include <sys/mman.h>
00041 #include <sys/poll.h>
00042 #include <dahdi/user.h>
00043
00044 #include "asterisk/lock.h"
00045 #include "asterisk/translate.h"
00046 #include "asterisk/config.h"
00047 #include "asterisk/module.h"
00048 #include "asterisk/cli.h"
00049 #include "asterisk/channel.h"
00050 #include "asterisk/utils.h"
00051 #include "asterisk/linkedlists.h"
00052 #include "asterisk/ulaw.h"
00053
00054 #define BUFFER_SIZE 8000
00055
00056 #define G723_SAMPLES 240
00057 #define G729_SAMPLES 160
00058
00059 static unsigned int global_useplc = 0;
00060
00061 static struct channel_usage {
00062 int total;
00063 int encoders;
00064 int decoders;
00065 } channels;
00066
00067 static char *handle_cli_transcoder_show(struct ast_cli_entry *e, int cmd, struct ast_cli_args *a);
00068
00069 static struct ast_cli_entry cli[] = {
00070 AST_CLI_DEFINE(handle_cli_transcoder_show, "Display DAHDI transcoder utilization.")
00071 };
00072
00073 struct format_map {
00074 unsigned int map[32][32];
00075 };
00076
00077 static struct format_map global_format_map = { { { 0 } } };
00078
00079 struct translator {
00080 struct ast_translator t;
00081 AST_LIST_ENTRY(translator) entry;
00082 };
00083
00084 static AST_LIST_HEAD_STATIC(translators, translator);
00085
00086 struct codec_dahdi_pvt {
00087 int fd;
00088 #ifdef DEBUG_TRANSCODE
00089 int totalms;
00090 int lasttotalms;
00091 #endif
00092 struct dahdi_transcoder_formats fmts;
00093 unsigned int softslin:1;
00094 unsigned int fake:2;
00095 uint16_t required_samples;
00096 uint16_t samples_in_buffer;
00097 uint8_t ulaw_buffer[1024];
00098 };
00099
00100
00101 static int ulawtolin(struct ast_trans_pvt *pvt)
00102 {
00103 struct codec_dahdi_pvt *dahdip = pvt->pvt;
00104 int i = dahdip->required_samples;
00105 uint8_t *src = &dahdip->ulaw_buffer[0];
00106 int16_t *dst = pvt->outbuf.i16 + pvt->datalen;
00107
00108
00109 while (i--) {
00110 *dst++ = AST_MULAW(*src++);
00111 }
00112
00113 return 0;
00114 }
00115
00116
00117 static int lintoulaw(struct ast_trans_pvt *pvt, struct ast_frame *f)
00118 {
00119 struct codec_dahdi_pvt *dahdip = pvt->pvt;
00120 int i = f->samples;
00121 uint8_t *dst = &dahdip->ulaw_buffer[dahdip->samples_in_buffer];
00122 int16_t *src = f->data.ptr;
00123
00124 if (dahdip->samples_in_buffer + i > sizeof(dahdip->ulaw_buffer)) {
00125 ast_log(LOG_ERROR, "Out of buffer space!\n");
00126 return -i;
00127 }
00128
00129 while (i--) {
00130 *dst++ = AST_LIN2MU(*src++);
00131 }
00132
00133 dahdip->samples_in_buffer += f->samples;
00134 return 0;
00135 }
00136
00137 static char *handle_cli_transcoder_show(struct ast_cli_entry *e, int cmd, struct ast_cli_args *a)
00138 {
00139 struct channel_usage copy;
00140
00141 switch (cmd) {
00142 case CLI_INIT:
00143 e->command = "transcoder show";
00144 e->usage =
00145 "Usage: transcoder show\n"
00146 " Displays channel utilization of DAHDI transcoder(s).\n";
00147 return NULL;
00148 case CLI_GENERATE:
00149 return NULL;
00150 }
00151
00152 if (a->argc != 2)
00153 return CLI_SHOWUSAGE;
00154
00155 copy = channels;
00156
00157 if (copy.total == 0)
00158 ast_cli(a->fd, "No DAHDI transcoders found.\n");
00159 else
00160 ast_cli(a->fd, "%d/%d encoders/decoders of %d channels are in use.\n", copy.encoders, copy.decoders, copy.total);
00161
00162 return CLI_SUCCESS;
00163 }
00164
00165 static void dahdi_write_frame(struct codec_dahdi_pvt *dahdip, const uint8_t *buffer, const ssize_t count)
00166 {
00167 int res;
00168 struct pollfd p = {0};
00169 if (!count) return;
00170 res = write(dahdip->fd, buffer, count);
00171 if (option_verbose > 10) {
00172 if (-1 == res) {
00173 ast_log(LOG_ERROR, "Failed to write to transcoder: %s\n", strerror(errno));
00174 }
00175 if (count != res) {
00176 ast_log(LOG_ERROR, "Requested write of %zd bytes, but only wrote %d bytes.\n", count, res);
00177 }
00178 }
00179 p.fd = dahdip->fd;
00180 p.events = POLLOUT;
00181 res = poll(&p, 1, 50);
00182 }
00183
00184 static int dahdi_encoder_framein(struct ast_trans_pvt *pvt, struct ast_frame *f)
00185 {
00186 struct codec_dahdi_pvt *dahdip = pvt->pvt;
00187
00188 if (!f->subclass) {
00189
00190 dahdip->fake = 2;
00191 pvt->samples = f->samples;
00192 return 0;
00193 }
00194
00195
00196
00197 if (dahdip->softslin) {
00198 if (lintoulaw(pvt, f)) {
00199 return -1;
00200 }
00201 } else {
00202
00203
00204
00205
00206 if (dahdip->samples_in_buffer + f->samples > sizeof(dahdip->ulaw_buffer)) {
00207 ast_log(LOG_ERROR, "Out of buffer space.\n");
00208 return -1;
00209 }
00210 memcpy(&dahdip->ulaw_buffer[dahdip->samples_in_buffer], f->data.ptr, f->samples);
00211 dahdip->samples_in_buffer += f->samples;
00212 }
00213
00214 while (dahdip->samples_in_buffer > dahdip->required_samples) {
00215 dahdi_write_frame(dahdip, dahdip->ulaw_buffer, dahdip->required_samples);
00216 dahdip->samples_in_buffer -= dahdip->required_samples;
00217 if (dahdip->samples_in_buffer) {
00218
00219 memmove(dahdip->ulaw_buffer, &dahdip->ulaw_buffer[dahdip->required_samples],
00220 dahdip->samples_in_buffer);
00221 }
00222 }
00223 pvt->samples += f->samples;
00224 pvt->datalen = 0;
00225 return -1;
00226 }
00227
00228 static struct ast_frame *dahdi_encoder_frameout(struct ast_trans_pvt *pvt)
00229 {
00230 struct codec_dahdi_pvt *dahdip = pvt->pvt;
00231 int res;
00232
00233 if (2 == dahdip->fake) {
00234 dahdip->fake = 1;
00235 pvt->f.frametype = AST_FRAME_VOICE;
00236 pvt->f.subclass = 0;
00237 pvt->f.samples = dahdip->required_samples;
00238 pvt->f.data.ptr = NULL;
00239 pvt->f.offset = 0;
00240 pvt->f.datalen = 0;
00241 pvt->f.mallocd = 0;
00242 ast_set_flag(&pvt->f, AST_FRFLAG_FROM_TRANSLATOR);
00243 pvt->samples = 0;
00244
00245 return &pvt->f;
00246
00247 } else if (1 == dahdip->fake) {
00248 dahdip->fake = 0;
00249 return NULL;
00250 }
00251
00252 res = read(dahdip->fd, pvt->outbuf.c + pvt->datalen, pvt->t->buf_size - pvt->datalen);
00253 if (-1 == res) {
00254 if (EWOULDBLOCK == errno) {
00255
00256 return NULL;
00257 } else {
00258 ast_log(LOG_ERROR, "Failed to read from transcoder: %s\n", strerror(errno));
00259 return NULL;
00260 }
00261 } else {
00262 pvt->f.datalen = res;
00263 pvt->f.samples = dahdip->required_samples;
00264 pvt->f.frametype = AST_FRAME_VOICE;
00265 pvt->f.subclass = 1 << (pvt->t->dstfmt);
00266 pvt->f.mallocd = 0;
00267 pvt->f.offset = AST_FRIENDLY_OFFSET;
00268 pvt->f.src = pvt->t->name;
00269 pvt->f.data.ptr = pvt->outbuf.c;
00270 ast_set_flag(&pvt->f, AST_FRFLAG_FROM_TRANSLATOR);
00271
00272 pvt->samples = 0;
00273 pvt->datalen = 0;
00274 return &pvt->f;
00275 }
00276
00277
00278 return NULL;
00279 }
00280
00281 static int dahdi_decoder_framein(struct ast_trans_pvt *pvt, struct ast_frame *f)
00282 {
00283 struct codec_dahdi_pvt *dahdip = pvt->pvt;
00284
00285 if (!f->subclass) {
00286
00287 dahdip->fake = 2;
00288 pvt->samples = f->samples;
00289 return 0;
00290 }
00291
00292 if (!f->datalen) {
00293 if (f->samples != dahdip->required_samples) {
00294 ast_log(LOG_ERROR, "%d != %d %d\n", f->samples, dahdip->required_samples, f->datalen);
00295 }
00296 }
00297 dahdi_write_frame(dahdip, f->data.ptr, f->datalen);
00298 pvt->samples += f->samples;
00299 pvt->datalen = 0;
00300 return -1;
00301 }
00302
00303 static struct ast_frame *dahdi_decoder_frameout(struct ast_trans_pvt *pvt)
00304 {
00305 int res;
00306 struct codec_dahdi_pvt *dahdip = pvt->pvt;
00307
00308 if (2 == dahdip->fake) {
00309 dahdip->fake = 1;
00310 pvt->f.frametype = AST_FRAME_VOICE;
00311 pvt->f.subclass = 0;
00312 pvt->f.samples = dahdip->required_samples;
00313 pvt->f.data.ptr = NULL;
00314 pvt->f.offset = 0;
00315 pvt->f.datalen = 0;
00316 pvt->f.mallocd = 0;
00317 ast_set_flag(&pvt->f, AST_FRFLAG_FROM_TRANSLATOR);
00318 pvt->samples = 0;
00319 return &pvt->f;
00320 } else if (1 == dahdip->fake) {
00321 pvt->samples = 0;
00322 dahdip->fake = 0;
00323 return NULL;
00324 }
00325
00326
00327 if (dahdip->softslin) {
00328 res = read(dahdip->fd, dahdip->ulaw_buffer, sizeof(dahdip->ulaw_buffer));
00329 } else {
00330 res = read(dahdip->fd, pvt->outbuf.c + pvt->datalen, pvt->t->buf_size - pvt->datalen);
00331 }
00332
00333 if (-1 == res) {
00334 if (EWOULDBLOCK == errno) {
00335
00336 return NULL;
00337 } else {
00338 ast_log(LOG_ERROR, "Failed to read from transcoder: %s\n", strerror(errno));
00339 return NULL;
00340 }
00341 } else {
00342 if (dahdip->softslin) {
00343 ulawtolin(pvt);
00344 pvt->f.datalen = res * 2;
00345 } else {
00346 pvt->f.datalen = res;
00347 }
00348 pvt->datalen = 0;
00349 pvt->f.frametype = AST_FRAME_VOICE;
00350 pvt->f.subclass = 1 << (pvt->t->dstfmt);
00351 pvt->f.mallocd = 0;
00352 pvt->f.offset = AST_FRIENDLY_OFFSET;
00353 pvt->f.src = pvt->t->name;
00354 pvt->f.data.ptr = pvt->outbuf.c;
00355 pvt->f.samples = dahdip->required_samples;
00356 ast_set_flag(&pvt->f, AST_FRFLAG_FROM_TRANSLATOR);
00357 pvt->samples = 0;
00358
00359 return &pvt->f;
00360 }
00361
00362
00363 return NULL;
00364 }
00365
00366
00367 static void dahdi_destroy(struct ast_trans_pvt *pvt)
00368 {
00369 struct codec_dahdi_pvt *dahdip = pvt->pvt;
00370
00371 switch (dahdip->fmts.dstfmt) {
00372 case AST_FORMAT_G729A:
00373 case AST_FORMAT_G723_1:
00374 ast_atomic_fetchadd_int(&channels.encoders, -1);
00375 break;
00376 default:
00377 ast_atomic_fetchadd_int(&channels.decoders, -1);
00378 break;
00379 }
00380
00381 close(dahdip->fd);
00382 }
00383
00384 static int dahdi_translate(struct ast_trans_pvt *pvt, int dest, int source)
00385 {
00386
00387 int fd;
00388 struct codec_dahdi_pvt *dahdip = pvt->pvt;
00389 int flags;
00390 int tried_once = 0;
00391 const char *dev_filename = "/dev/dahdi/transcode";
00392
00393 if ((fd = open(dev_filename, O_RDWR)) < 0) {
00394 ast_log(LOG_ERROR, "Failed to open %s: %s\n", dev_filename, strerror(errno));
00395 return -1;
00396 }
00397
00398 dahdip->fmts.srcfmt = (1 << source);
00399 dahdip->fmts.dstfmt = (1 << dest);
00400
00401 ast_log(LOG_DEBUG, "Opening transcoder channel from %d to %d.\n", source, dest);
00402
00403 retry:
00404 if (ioctl(fd, DAHDI_TC_ALLOCATE, &dahdip->fmts)) {
00405 if ((ENODEV == errno) && !tried_once) {
00406
00407
00408
00409
00410
00411
00412
00413
00414 if (AST_FORMAT_SLINEAR == dahdip->fmts.srcfmt) {
00415 ast_log(LOG_DEBUG, "Using soft_slin support on source\n");
00416 dahdip->softslin = 1;
00417 dahdip->fmts.srcfmt = AST_FORMAT_ULAW;
00418 } else if (AST_FORMAT_SLINEAR == dahdip->fmts.dstfmt) {
00419 ast_log(LOG_DEBUG, "Using soft_slin support on destination\n");
00420 dahdip->softslin = 1;
00421 dahdip->fmts.dstfmt = AST_FORMAT_ULAW;
00422 }
00423 tried_once = 1;
00424 goto retry;
00425 }
00426 ast_log(LOG_ERROR, "Unable to attach to transcoder: %s\n", strerror(errno));
00427 close(fd);
00428
00429 return -1;
00430 }
00431
00432 flags = fcntl(fd, F_GETFL);
00433 if (flags > - 1) {
00434 if (fcntl(fd, F_SETFL, flags | O_NONBLOCK))
00435 ast_log(LOG_WARNING, "Could not set non-block mode!\n");
00436 }
00437
00438 dahdip->fd = fd;
00439
00440 dahdip->required_samples = ((dahdip->fmts.dstfmt|dahdip->fmts.srcfmt)&AST_FORMAT_G723_1) ? G723_SAMPLES : G729_SAMPLES;
00441
00442 switch (dahdip->fmts.dstfmt) {
00443 case AST_FORMAT_G729A:
00444 ast_atomic_fetchadd_int(&channels.encoders, +1);
00445 break;
00446 case AST_FORMAT_G723_1:
00447 ast_atomic_fetchadd_int(&channels.encoders, +1);
00448 break;
00449 default:
00450 ast_atomic_fetchadd_int(&channels.decoders, +1);
00451 break;
00452 }
00453
00454 return 0;
00455 }
00456
00457 static int dahdi_new(struct ast_trans_pvt *pvt)
00458 {
00459 return dahdi_translate(pvt, pvt->t->dstfmt, pvt->t->srcfmt);
00460 }
00461
00462 static struct ast_frame *fakesrc_sample(void)
00463 {
00464
00465 static struct ast_frame f = {
00466 .frametype = AST_FRAME_VOICE,
00467 .samples = 160,
00468 .src = __PRETTY_FUNCTION__
00469 };
00470
00471 return &f;
00472 }
00473
00474 static int is_encoder(struct translator *zt)
00475 {
00476 if (zt->t.srcfmt&(AST_FORMAT_ULAW|AST_FORMAT_ALAW|AST_FORMAT_SLINEAR)) {
00477 return 1;
00478 } else {
00479 return 0;
00480 }
00481 }
00482
00483 static int register_translator(int dst, int src)
00484 {
00485 struct translator *zt;
00486 int res;
00487
00488 if (!(zt = ast_calloc(1, sizeof(*zt)))) {
00489 return -1;
00490 }
00491
00492 snprintf((char *) (zt->t.name), sizeof(zt->t.name), "zap%sto%s",
00493 ast_getformatname((1 << src)), ast_getformatname((1 << dst)));
00494 zt->t.srcfmt = (1 << src);
00495 zt->t.dstfmt = (1 << dst);
00496 zt->t.buf_size = BUFFER_SIZE;
00497 if (is_encoder(zt)) {
00498 zt->t.framein = dahdi_encoder_framein;
00499 zt->t.frameout = dahdi_encoder_frameout;
00500 #if 0
00501 zt->t.buffer_samples = 0;
00502 #endif
00503 } else {
00504 zt->t.framein = dahdi_decoder_framein;
00505 zt->t.frameout = dahdi_decoder_frameout;
00506 #if 0
00507 if (AST_FORMAT_G723_1 == zt->t.srcfmt) {
00508 zt->t.plc_samples = G723_SAMPLES;
00509 } else {
00510 zt->t.plc_samples = G729_SAMPLES;
00511 }
00512 zt->t.buffer_samples = zt->t.plc_samples * 8;
00513 #endif
00514 }
00515 zt->t.destroy = dahdi_destroy;
00516 zt->t.buffer_samples = 0;
00517 zt->t.newpvt = dahdi_new;
00518 zt->t.sample = fakesrc_sample;
00519 #if 0
00520 zt->t.useplc = global_useplc;
00521 #endif
00522 zt->t.useplc = 0;
00523 zt->t.native_plc = 0;
00524
00525 zt->t.desc_size = sizeof(struct codec_dahdi_pvt);
00526 if ((res = ast_register_translator(&zt->t))) {
00527 ast_free(zt);
00528 return -1;
00529 }
00530
00531 AST_LIST_LOCK(&translators);
00532 AST_LIST_INSERT_HEAD(&translators, zt, entry);
00533 AST_LIST_UNLOCK(&translators);
00534
00535 global_format_map.map[dst][src] = 1;
00536
00537 return res;
00538 }
00539
00540 static void drop_translator(int dst, int src)
00541 {
00542 struct translator *cur;
00543
00544 AST_LIST_LOCK(&translators);
00545 AST_LIST_TRAVERSE_SAFE_BEGIN(&translators, cur, entry) {
00546 if (cur->t.srcfmt != src)
00547 continue;
00548
00549 if (cur->t.dstfmt != dst)
00550 continue;
00551
00552 AST_LIST_REMOVE_CURRENT(entry);
00553 ast_unregister_translator(&cur->t);
00554 ast_free(cur);
00555 global_format_map.map[dst][src] = 0;
00556 break;
00557 }
00558 AST_LIST_TRAVERSE_SAFE_END;
00559 AST_LIST_UNLOCK(&translators);
00560 }
00561
00562 static void unregister_translators(void)
00563 {
00564 struct translator *cur;
00565
00566 AST_LIST_LOCK(&translators);
00567 while ((cur = AST_LIST_REMOVE_HEAD(&translators, entry))) {
00568 ast_unregister_translator(&cur->t);
00569 ast_free(cur);
00570 }
00571 AST_LIST_UNLOCK(&translators);
00572 }
00573
00574 static int parse_config(int reload)
00575 {
00576 struct ast_variable *var;
00577 struct ast_flags config_flags = { reload ? CONFIG_FLAG_FILEUNCHANGED : 0 };
00578 struct ast_config *cfg = ast_config_load("codecs.conf", config_flags);
00579
00580 if (cfg == NULL)
00581 return 0;
00582 if (cfg == CONFIG_STATUS_FILEUNCHANGED)
00583 return 0;
00584
00585 for (var = ast_variable_browse(cfg, "plc"); var; var = var->next) {
00586 if (!strcasecmp(var->name, "genericplc")) {
00587 global_useplc = ast_true(var->value);
00588 ast_verb(3, "codec_dahdi: %susing generic PLC\n",
00589 global_useplc ? "" : "not ");
00590 }
00591 }
00592
00593 ast_config_destroy(cfg);
00594 return 0;
00595 }
00596
00597 static void build_translators(struct format_map *map, unsigned int dstfmts, unsigned int srcfmts)
00598 {
00599 unsigned int src, dst;
00600
00601 for (src = 0; src < 32; src++) {
00602 for (dst = 0; dst < 32; dst++) {
00603 if (!(srcfmts & (1 << src)))
00604 continue;
00605
00606 if (!(dstfmts & (1 << dst)))
00607 continue;
00608
00609 if (global_format_map.map[dst][src])
00610 continue;
00611
00612 if (!register_translator(dst, src))
00613 map->map[dst][src] = 1;
00614 }
00615 }
00616 }
00617
00618 static int find_transcoders(void)
00619 {
00620 struct dahdi_transcoder_info info = { 0, };
00621 struct format_map map = { { { 0 } } };
00622 int fd, res;
00623 unsigned int x, y;
00624
00625 if ((fd = open("/dev/dahdi/transcode", O_RDWR)) < 0) {
00626 ast_log(LOG_ERROR, "Failed to open /dev/dahdi/transcode: %s\n", strerror(errno));
00627 return 0;
00628 }
00629
00630 for (info.tcnum = 0; !(res = ioctl(fd, DAHDI_TC_GETINFO, &info)); info.tcnum++) {
00631 if (option_verbose > 1)
00632 ast_verbose(VERBOSE_PREFIX_2 "Found transcoder '%s'.\n", info.name);
00633
00634
00635
00636
00637
00638
00639
00640 if (info.dstfmts & (AST_FORMAT_ULAW | AST_FORMAT_ALAW)) {
00641 info.dstfmts |= AST_FORMAT_SLINEAR;
00642 info.dstfmts &= ~(AST_FORMAT_ULAW | AST_FORMAT_ALAW);
00643 }
00644 if (info.srcfmts & (AST_FORMAT_ULAW | AST_FORMAT_ALAW)) {
00645 info.srcfmts |= AST_FORMAT_SLINEAR;
00646 info.srcfmts &= ~(AST_FORMAT_ULAW | AST_FORMAT_ALAW);
00647 }
00648
00649 build_translators(&map, info.dstfmts, info.srcfmts);
00650 ast_atomic_fetchadd_int(&channels.total, info.numchannels / 2);
00651
00652 }
00653
00654 close(fd);
00655
00656 if (!info.tcnum && (option_verbose > 1))
00657 ast_verbose(VERBOSE_PREFIX_2 "No hardware transcoders found.\n");
00658
00659 for (x = 0; x < 32; x++) {
00660 for (y = 0; y < 32; y++) {
00661 if (!map.map[x][y] && global_format_map.map[x][y])
00662 drop_translator(x, y);
00663 }
00664 }
00665
00666 return 0;
00667 }
00668
00669 static int reload(void)
00670 {
00671 struct translator *cur;
00672
00673 if (parse_config(1))
00674 return AST_MODULE_LOAD_DECLINE;
00675
00676 AST_LIST_LOCK(&translators);
00677 AST_LIST_TRAVERSE(&translators, cur, entry)
00678 cur->t.useplc = global_useplc;
00679 AST_LIST_UNLOCK(&translators);
00680
00681 return AST_MODULE_LOAD_SUCCESS;
00682 }
00683
00684 static int unload_module(void)
00685 {
00686 ast_cli_unregister_multiple(cli, ARRAY_LEN(cli));
00687 unregister_translators();
00688
00689 return 0;
00690 }
00691
00692 static int load_module(void)
00693 {
00694 ast_ulaw_init();
00695 if (parse_config(0))
00696 return AST_MODULE_LOAD_DECLINE;
00697 find_transcoders();
00698 ast_cli_register_multiple(cli, ARRAY_LEN(cli));
00699 return AST_MODULE_LOAD_SUCCESS;
00700 }
00701
00702 AST_MODULE_INFO(ASTERISK_GPL_KEY, AST_MODFLAG_DEFAULT, "Generic DAHDI Transcoder Codec Translator",
00703 .load = load_module,
00704 .unload = unload_module,
00705 .reload = reload,
00706 );