git migration: Refactor the ASTERISK_FILE_VERSION macro
[asterisk/asterisk.git] / codecs / codec_dahdi.c
1 /*
2  * Asterisk -- An open source telephony toolkit.
3  *
4  * DAHDI native transcoding support
5  *
6  * Copyright (C) 1999 - 2008, Digium, Inc.
7  *
8  * Mark Spencer <markster@digium.com>
9  * Kevin P. Fleming <kpfleming@digium.com>
10  *
11  * See http://www.asterisk.org for more information about
12  * the Asterisk project. Please do not directly contact
13  * any of the maintainers of this project for assistance;
14  * the project provides a web site, mailing lists and IRC
15  * channels for your use.
16  *
17  * This program is free software, distributed under the terms of
18  * the GNU General Public License Version 2. See the LICENSE file
19  * at the top of the source tree.
20  */
21
22 /*! \file
23  *
24  * \brief Translate between various formats natively through DAHDI transcoding
25  *
26  * \ingroup codecs
27  */
28
29 /*** MODULEINFO
30         <support_level>core</support_level>
31         <depend>dahdi</depend>
32  ***/
33
34 #include "asterisk.h"
35 #include <stdbool.h>
36
37 ASTERISK_REGISTER_FILE()
38
39 #include <fcntl.h>
40 #include <netinet/in.h>
41 #include <sys/ioctl.h>
42 #include <sys/mman.h>
43 #include <sys/poll.h>
44 #include <dahdi/user.h>
45
46 #include "asterisk/lock.h"
47 #include "asterisk/translate.h"
48 #include "asterisk/config.h"
49 #include "asterisk/module.h"
50 #include "asterisk/cli.h"
51 #include "asterisk/channel.h"
52 #include "asterisk/utils.h"
53 #include "asterisk/linkedlists.h"
54 #include "asterisk/ulaw.h"
55 #include "asterisk/format_compatibility.h"
56
57 #define BUFFER_SIZE 8000
58
59 #define G723_SAMPLES 240
60 #define G729_SAMPLES 160
61 #define ULAW_SAMPLES 160
62
63 /* Defines from DAHDI. */
64 #ifndef DAHDI_FORMAT_MAX_AUDIO
65 /*! G.723.1 compression */
66 #define DAHDI_FORMAT_G723_1    (1 << 0)
67 /*! GSM compression */
68 #define DAHDI_FORMAT_GSM       (1 << 1)
69 /*! Raw mu-law data (G.711) */
70 #define DAHDI_FORMAT_ULAW      (1 << 2)
71 /*! Raw A-law data (G.711) */
72 #define DAHDI_FORMAT_ALAW      (1 << 3)
73 /*! ADPCM (G.726, 32kbps) */
74 #define DAHDI_FORMAT_G726      (1 << 4)
75 /*! ADPCM (IMA) */
76 #define DAHDI_FORMAT_ADPCM     (1 << 5)
77 /*! Raw 16-bit Signed Linear (8000 Hz) PCM */
78 #define DAHDI_FORMAT_SLINEAR   (1 << 6)
79 /*! LPC10, 180 samples/frame */
80 #define DAHDI_FORMAT_LPC10     (1 << 7)
81 /*! G.729A audio */
82 #define DAHDI_FORMAT_G729A     (1 << 8)
83 /*! SpeeX Free Compression */
84 #define DAHDI_FORMAT_SPEEX     (1 << 9)
85 /*! iLBC Free Compression */
86 #define DAHDI_FORMAT_ILBC      (1 << 10)
87 #endif
88
89 static struct channel_usage {
90         int total;
91         int encoders;
92         int decoders;
93 } channels;
94
95 #if defined(NOT_NEEDED)
96 /*!
97  * \internal
98  * \brief Convert DAHDI format bitfield to old Asterisk format bitfield.
99  * \since 13.0.0
100  *
101  * \param dahdi Bitfield from DAHDI to convert.
102  *
103  * \note They should be the same values but they don't have to be.
104  *
105  * \return Old Asterisk bitfield equivalent.
106  */
107 static uint64_t bitfield_dahdi2ast(unsigned dahdi)
108 {
109         uint64_t ast;
110
111         switch (dahdi) {
112         case DAHDI_FORMAT_G723_1:
113                 ast = AST_FORMAT_G723;
114                 break;
115         case DAHDI_FORMAT_GSM:
116                 ast = AST_FORMAT_GSM;
117                 break;
118         case DAHDI_FORMAT_ULAW:
119                 ast = AST_FORMAT_ULAW;
120                 break;
121         case DAHDI_FORMAT_ALAW:
122                 ast = AST_FORMAT_ALAW;
123                 break;
124         case DAHDI_FORMAT_G726:
125                 ast = AST_FORMAT_G726_AAL2;
126                 break;
127         case DAHDI_FORMAT_ADPCM:
128                 ast = AST_FORMAT_ADPCM;
129                 break;
130         case DAHDI_FORMAT_SLINEAR:
131                 ast = AST_FORMAT_SLIN;
132                 break;
133         case DAHDI_FORMAT_LPC10:
134                 ast = AST_FORMAT_LPC10;
135                 break;
136         case DAHDI_FORMAT_G729A:
137                 ast = AST_FORMAT_G729;
138                 break;
139         case DAHDI_FORMAT_SPEEX:
140                 ast = AST_FORMAT_SPEEX;
141                 break;
142         case DAHDI_FORMAT_ILBC:
143                 ast = AST_FORMAT_ILBC;
144                 break;
145         default:
146                 ast = 0;
147                 break;
148         }
149
150         return ast;
151 }
152 #endif  /* defined(NOT_NEEDED) */
153
154 /*!
155  * \internal
156  * \brief Get the ast_codec by DAHDI format.
157  * \since 13.0.0
158  *
159  * \param dahdi_fmt DAHDI specific codec identifier.
160  *
161  * \return Specified codec if exists otherwise NULL.
162  */
163 static const struct ast_codec *get_dahdi_codec(uint32_t dahdi_fmt)
164 {
165         const struct ast_codec *codec;
166
167         static const struct ast_codec dahdi_g723_1 = {
168                 .name = "g723",
169                 .type = AST_MEDIA_TYPE_AUDIO,
170                 .sample_rate = 8000,
171         };
172         static const struct ast_codec dahdi_gsm = {
173                 .name = "gsm",
174                 .type = AST_MEDIA_TYPE_AUDIO,
175                 .sample_rate = 8000,
176         };
177         static const struct ast_codec dahdi_ulaw = {
178                 .name = "ulaw",
179                 .type = AST_MEDIA_TYPE_AUDIO,
180                 .sample_rate = 8000,
181         };
182         static const struct ast_codec dahdi_alaw = {
183                 .name = "alaw",
184                 .type = AST_MEDIA_TYPE_AUDIO,
185                 .sample_rate = 8000,
186         };
187         static const struct ast_codec dahdi_g726 = {
188                 .name = "g726",
189                 .type = AST_MEDIA_TYPE_AUDIO,
190                 .sample_rate = 8000,
191         };
192         static const struct ast_codec dahdi_adpcm = {
193                 .name = "adpcm",
194                 .type = AST_MEDIA_TYPE_AUDIO,
195                 .sample_rate = 8000,
196         };
197         static const struct ast_codec dahdi_slinear = {
198                 .name = "slin",
199                 .type = AST_MEDIA_TYPE_AUDIO,
200                 .sample_rate = 8000,
201         };
202         static const struct ast_codec dahdi_lpc10 = {
203                 .name = "lpc10",
204                 .type = AST_MEDIA_TYPE_AUDIO,
205                 .sample_rate = 8000,
206         };
207         static const struct ast_codec dahdi_g729a = {
208                 .name = "g729",
209                 .type = AST_MEDIA_TYPE_AUDIO,
210                 .sample_rate = 8000,
211         };
212         static const struct ast_codec dahdi_speex = {
213                 .name = "speex",
214                 .type = AST_MEDIA_TYPE_AUDIO,
215                 .sample_rate = 8000,
216         };
217         static const struct ast_codec dahdi_ilbc = {
218                 .name = "ilbc",
219                 .type = AST_MEDIA_TYPE_AUDIO,
220                 .sample_rate = 8000,
221         };
222
223         switch (dahdi_fmt) {
224         case DAHDI_FORMAT_G723_1:
225                 codec = &dahdi_g723_1;
226                 break;
227         case DAHDI_FORMAT_GSM:
228                 codec = &dahdi_gsm;
229                 break;
230         case DAHDI_FORMAT_ULAW:
231                 codec = &dahdi_ulaw;
232                 break;
233         case DAHDI_FORMAT_ALAW:
234                 codec = &dahdi_alaw;
235                 break;
236         case DAHDI_FORMAT_G726:
237                 codec = &dahdi_g726;
238                 break;
239         case DAHDI_FORMAT_ADPCM:
240                 codec = &dahdi_adpcm;
241                 break;
242         case DAHDI_FORMAT_SLINEAR:
243                 codec = &dahdi_slinear;
244                 break;
245         case DAHDI_FORMAT_LPC10:
246                 codec = &dahdi_lpc10;
247                 break;
248         case DAHDI_FORMAT_G729A:
249                 codec = &dahdi_g729a;
250                 break;
251         case DAHDI_FORMAT_SPEEX:
252                 codec = &dahdi_speex;
253                 break;
254         case DAHDI_FORMAT_ILBC:
255                 codec = &dahdi_ilbc;
256                 break;
257         default:
258                 codec = NULL;
259                 break;
260         }
261
262         return codec;
263 }
264
265 static char *handle_cli_transcoder_show(struct ast_cli_entry *e, int cmd, struct ast_cli_args *a);
266
267 static struct ast_cli_entry cli[] = {
268         AST_CLI_DEFINE(handle_cli_transcoder_show, "Display DAHDI transcoder utilization.")
269 };
270
271 struct translator {
272         struct ast_translator t;
273         uint32_t src_dahdi_fmt;
274         uint32_t dst_dahdi_fmt;
275         AST_LIST_ENTRY(translator) entry;
276 };
277
278 #ifndef container_of
279 #define container_of(ptr, type, member) \
280         ((type *)((char *)(ptr) - offsetof(type, member)))
281 #endif
282
283 static AST_LIST_HEAD_STATIC(translators, translator);
284
285 struct codec_dahdi_pvt {
286         int fd;
287         struct dahdi_transcoder_formats fmts;
288         unsigned int softslin:1;
289         unsigned int fake:2;
290         uint16_t required_samples;
291         uint16_t samples_in_buffer;
292         uint16_t samples_written_to_hardware;
293         uint8_t ulaw_buffer[1024];
294 };
295
296 /* Only used by a decoder */
297 static int ulawtolin(struct ast_trans_pvt *pvt, int samples)
298 {
299         struct codec_dahdi_pvt *dahdip = pvt->pvt;
300         int i = samples;
301         uint8_t *src = &dahdip->ulaw_buffer[0];
302         int16_t *dst = pvt->outbuf.i16 + pvt->datalen;
303
304         /* convert and copy in outbuf */
305         while (i--) {
306                 *dst++ = AST_MULAW(*src++);
307         }
308
309         return 0;
310 }
311
312 /* Only used by an encoder. */
313 static int lintoulaw(struct ast_trans_pvt *pvt, struct ast_frame *f)
314 {
315         struct codec_dahdi_pvt *dahdip = pvt->pvt;
316         int i = f->samples;
317         uint8_t *dst = &dahdip->ulaw_buffer[dahdip->samples_in_buffer];
318         int16_t *src = f->data.ptr;
319
320         if (dahdip->samples_in_buffer + i > sizeof(dahdip->ulaw_buffer)) {
321                 ast_log(LOG_ERROR, "Out of buffer space!\n");
322                 return -i;
323         }
324
325         while (i--) {
326                 *dst++ = AST_LIN2MU(*src++);
327         }
328
329         dahdip->samples_in_buffer += f->samples;
330         return 0;
331 }
332
333 static char *handle_cli_transcoder_show(struct ast_cli_entry *e, int cmd, struct ast_cli_args *a)
334 {
335         struct channel_usage copy;
336
337         switch (cmd) {
338         case CLI_INIT:
339                 e->command = "transcoder show";
340                 e->usage =
341                         "Usage: transcoder show\n"
342                         "       Displays channel utilization of DAHDI transcoder(s).\n";
343                 return NULL;
344         case CLI_GENERATE:
345                 return NULL;
346         }
347
348         if (a->argc != 2)
349                 return CLI_SHOWUSAGE;
350
351         copy = channels;
352
353         if (copy.total == 0)
354                 ast_cli(a->fd, "No DAHDI transcoders found.\n");
355         else
356                 ast_cli(a->fd, "%d/%d encoders/decoders of %d channels are in use.\n", copy.encoders, copy.decoders, copy.total);
357
358         return CLI_SUCCESS;
359 }
360
361 static void dahdi_write_frame(struct codec_dahdi_pvt *dahdip, const uint8_t *buffer, const ssize_t count)
362 {
363         int res;
364         if (!count) return;
365         res = write(dahdip->fd, buffer, count);
366         if (-1 == res) {
367                 ast_log(LOG_ERROR, "Failed to write to transcoder: %s\n", strerror(errno));
368         }
369         if (count != res) {
370                 ast_log(LOG_ERROR, "Requested write of %zd bytes, but only wrote %d bytes.\n", count, res);
371         }
372 }
373
374 static int dahdi_encoder_framein(struct ast_trans_pvt *pvt, struct ast_frame *f)
375 {
376         struct codec_dahdi_pvt *dahdip = pvt->pvt;
377
378         if (!f->subclass.format) {
379                 /* We're just faking a return for calculation purposes. */
380                 dahdip->fake = 2;
381                 pvt->samples = f->samples;
382                 return 0;
383         }
384
385         /* Buffer up the packets and send them to the hardware if we
386          * have enough samples set up. */
387         if (dahdip->softslin) {
388                 if (lintoulaw(pvt, f)) {
389                          return -1;
390                 }
391         } else {
392                 /* NOTE:  If softslin support is not needed, and the sample
393                  * size is equal to the required sample size, we wouldn't
394                  * need this copy operation.  But at the time this was
395                  * written, only softslin is supported. */
396                 if (dahdip->samples_in_buffer + f->samples > sizeof(dahdip->ulaw_buffer)) {
397                         ast_log(LOG_ERROR, "Out of buffer space.\n");
398                         return -1;
399                 }
400                 memcpy(&dahdip->ulaw_buffer[dahdip->samples_in_buffer], f->data.ptr, f->samples);
401                 dahdip->samples_in_buffer += f->samples;
402         }
403
404         while (dahdip->samples_in_buffer >= dahdip->required_samples) {
405                 dahdi_write_frame(dahdip, dahdip->ulaw_buffer, dahdip->required_samples);
406                 dahdip->samples_written_to_hardware += dahdip->required_samples;
407                 dahdip->samples_in_buffer -= dahdip->required_samples;
408                 if (dahdip->samples_in_buffer) {
409                         /* Shift any remaining bytes down. */
410                         memmove(dahdip->ulaw_buffer, &dahdip->ulaw_buffer[dahdip->required_samples],
411                                 dahdip->samples_in_buffer);
412                 }
413         }
414         pvt->samples += f->samples;
415         pvt->datalen = 0;
416         return -1;
417 }
418
419 static void dahdi_wait_for_packet(int fd)
420 {
421         struct pollfd p = {0};
422         p.fd = fd;
423         p.events = POLLIN;
424         poll(&p, 1, 10);
425 }
426
427 static struct ast_frame *dahdi_encoder_frameout(struct ast_trans_pvt *pvt)
428 {
429         struct codec_dahdi_pvt *dahdip = pvt->pvt;
430         int res;
431
432         if (2 == dahdip->fake) {
433                 struct ast_frame frm = {
434                         .frametype = AST_FRAME_VOICE,
435                         .samples = dahdip->required_samples,
436                         .src = pvt->t->name,
437                 };
438
439                 dahdip->fake = 1;
440                 pvt->samples = 0;
441
442                 return ast_frisolate(&frm);
443         } else if (1 == dahdip->fake) {
444                 dahdip->fake = 0;
445                 return NULL;
446         }
447
448         if (dahdip->samples_written_to_hardware >= dahdip->required_samples) {
449                 dahdi_wait_for_packet(dahdip->fd);
450         }
451
452         res = read(dahdip->fd, pvt->outbuf.c + pvt->datalen, pvt->t->buf_size - pvt->datalen);
453         if (-1 == res) {
454                 if (EWOULDBLOCK == errno) {
455                         /* Nothing waiting... */
456                         return NULL;
457                 } else {
458                         ast_log(LOG_ERROR, "Failed to read from transcoder: %s\n", strerror(errno));
459                         return NULL;
460                 }
461         } else {
462                 pvt->f.datalen = res;
463                 pvt->f.samples = ast_codec_samples_count(&pvt->f);
464
465                 dahdip->samples_written_to_hardware =
466                   (dahdip->samples_written_to_hardware >= pvt->f.samples) ?
467                      dahdip->samples_written_to_hardware - pvt->f.samples : 0;
468
469                 pvt->samples = 0;
470                 pvt->datalen = 0;
471                 return ast_frisolate(&pvt->f);
472         }
473
474         /* Shouldn't get here... */
475         return NULL;
476 }
477
478 static int dahdi_decoder_framein(struct ast_trans_pvt *pvt, struct ast_frame *f)
479 {
480         struct codec_dahdi_pvt *dahdip = pvt->pvt;
481
482         if (!f->subclass.format) {
483                 /* We're just faking a return for calculation purposes. */
484                 dahdip->fake = 2;
485                 pvt->samples = f->samples;
486                 return 0;
487         }
488
489         if (!f->datalen) {
490                 if (f->samples != dahdip->required_samples) {
491                         ast_log(LOG_ERROR, "%d != %d %d\n", f->samples, dahdip->required_samples, f->datalen);
492                 }
493         }
494         dahdi_write_frame(dahdip, f->data.ptr, f->datalen);
495         dahdip->samples_written_to_hardware += f->samples;
496         pvt->samples += f->samples;
497         pvt->datalen = 0;
498         return -1;
499 }
500
501 static struct ast_frame *dahdi_decoder_frameout(struct ast_trans_pvt *pvt)
502 {
503         int res;
504         struct codec_dahdi_pvt *dahdip = pvt->pvt;
505
506         if (2 == dahdip->fake) {
507                 struct ast_frame frm = {
508                         .frametype = AST_FRAME_VOICE,
509                         .samples = dahdip->required_samples,
510                         .src = pvt->t->name,
511                 };
512
513                 dahdip->fake = 1;
514                 pvt->samples = 0;
515
516                 return ast_frisolate(&frm);
517         } else if (1 == dahdip->fake) {
518                 pvt->samples = 0;
519                 dahdip->fake = 0;
520                 return NULL;
521         }
522
523         if (dahdip->samples_written_to_hardware >= ULAW_SAMPLES) {
524                 dahdi_wait_for_packet(dahdip->fd);
525         }
526
527         /* Let's check to see if there is a new frame for us.... */
528         if (dahdip->softslin) {
529                 res = read(dahdip->fd, dahdip->ulaw_buffer, sizeof(dahdip->ulaw_buffer));
530         } else {
531                 res = read(dahdip->fd, pvt->outbuf.c + pvt->datalen, pvt->t->buf_size - pvt->datalen);
532         }
533
534         if (-1 == res) {
535                 if (EWOULDBLOCK == errno) {
536                         /* Nothing waiting... */
537                         return NULL;
538                 } else {
539                         ast_log(LOG_ERROR, "Failed to read from transcoder: %s\n", strerror(errno));
540                         return NULL;
541                 }
542         } else {
543                 if (dahdip->softslin) {
544                         ulawtolin(pvt, res);
545                         pvt->f.datalen = res * 2;
546                 } else {
547                         pvt->f.datalen = res;
548                 }
549                 pvt->datalen = 0;
550                 pvt->f.samples = res;
551                 pvt->samples = 0;
552                 dahdip->samples_written_to_hardware =
553                         (dahdip->samples_written_to_hardware >= res) ?
554                                 dahdip->samples_written_to_hardware - res : 0;
555
556                 return ast_frisolate(&pvt->f);
557         }
558
559         /* Shouldn't get here... */
560         return NULL;
561 }
562
563
564 static void dahdi_destroy(struct ast_trans_pvt *pvt)
565 {
566         struct codec_dahdi_pvt *dahdip = pvt->pvt;
567
568         switch (dahdip->fmts.dstfmt) {
569         case DAHDI_FORMAT_G729A:
570         case DAHDI_FORMAT_G723_1:
571                 ast_atomic_fetchadd_int(&channels.encoders, -1);
572                 break;
573         default:
574                 ast_atomic_fetchadd_int(&channels.decoders, -1);
575                 break;
576         }
577
578         close(dahdip->fd);
579 }
580
581 static struct ast_format *dahdi_format_to_cached(int format)
582 {
583         switch (format) {
584         case DAHDI_FORMAT_G723_1:
585                 return ast_format_g723;
586         case DAHDI_FORMAT_GSM:
587                 return ast_format_gsm;
588         case DAHDI_FORMAT_ULAW:
589                 return ast_format_ulaw;
590         case DAHDI_FORMAT_ALAW:
591                 return ast_format_alaw;
592         case DAHDI_FORMAT_G726:
593                 return ast_format_g726;
594         case DAHDI_FORMAT_ADPCM:
595                 return ast_format_adpcm;
596         case DAHDI_FORMAT_SLINEAR:
597                 return ast_format_slin;
598         case DAHDI_FORMAT_LPC10:
599                 return ast_format_lpc10;
600         case DAHDI_FORMAT_G729A:
601                 return ast_format_g729;
602         case DAHDI_FORMAT_SPEEX:
603                 return ast_format_speex;
604         case DAHDI_FORMAT_ILBC:
605                 return ast_format_ilbc;
606         }
607
608         /* This will never be reached */
609         ast_assert(0);
610         return NULL;
611 }
612
613 static int dahdi_translate(struct ast_trans_pvt *pvt, uint32_t dst_dahdi_fmt, uint32_t src_dahdi_fmt)
614 {
615         /* Request translation through zap if possible */
616         int fd;
617         struct codec_dahdi_pvt *dahdip = pvt->pvt;
618         int flags;
619         int tried_once = 0;
620         const char *dev_filename = "/dev/dahdi/transcode";
621
622         if ((fd = open(dev_filename, O_RDWR)) < 0) {
623                 ast_log(LOG_ERROR, "Failed to open %s: %s\n", dev_filename, strerror(errno));
624                 return -1;
625         }
626
627         dahdip->fmts.srcfmt = src_dahdi_fmt;
628         dahdip->fmts.dstfmt = dst_dahdi_fmt;
629
630         ast_assert(pvt->f.subclass.format == NULL);
631         pvt->f.subclass.format = ao2_bump(dahdi_format_to_cached(dahdip->fmts.dstfmt));
632
633         ast_debug(1, "Opening transcoder channel from %s to %s.\n", pvt->t->src_codec.name, pvt->t->dst_codec.name);
634
635 retry:
636         if (ioctl(fd, DAHDI_TC_ALLOCATE, &dahdip->fmts)) {
637                 if ((ENODEV == errno) && !tried_once) {
638                         /* We requested to translate to/from an unsupported
639                          * format.  Most likely this is because signed linear
640                          * was not supported by any hardware devices even
641                          * though this module always registers signed linear
642                          * support. In this case we'll retry, requesting
643                          * support for ULAW instead of signed linear and then
644                          * we'll just convert from ulaw to signed linear in
645                          * software. */
646                         if (dahdip->fmts.srcfmt == DAHDI_FORMAT_SLINEAR) {
647                                 ast_debug(1, "Using soft_slin support on source\n");
648                                 dahdip->softslin = 1;
649                                 dahdip->fmts.srcfmt = DAHDI_FORMAT_ULAW;
650                         } else if (dahdip->fmts.dstfmt == DAHDI_FORMAT_SLINEAR) {
651                                 ast_debug(1, "Using soft_slin support on destination\n");
652                                 dahdip->softslin = 1;
653                                 dahdip->fmts.dstfmt = DAHDI_FORMAT_ULAW;
654                         }
655                         tried_once = 1;
656                         goto retry;
657                 }
658                 ast_log(LOG_ERROR, "Unable to attach to transcoder: %s\n", strerror(errno));
659                 close(fd);
660
661                 return -1;
662         }
663
664         flags = fcntl(fd, F_GETFL);
665         if (flags > - 1) {
666                 if (fcntl(fd, F_SETFL, flags | O_NONBLOCK))
667                         ast_log(LOG_WARNING, "Could not set non-block mode!\n");
668         }
669
670         dahdip->fd = fd;
671
672         dahdip->required_samples = ((dahdip->fmts.dstfmt|dahdip->fmts.srcfmt) & (DAHDI_FORMAT_G723_1)) ? G723_SAMPLES : G729_SAMPLES;
673
674         switch (dahdip->fmts.dstfmt) {
675         case DAHDI_FORMAT_G729A:
676                 ast_atomic_fetchadd_int(&channels.encoders, +1);
677                 break;
678         case DAHDI_FORMAT_G723_1:
679                 ast_atomic_fetchadd_int(&channels.encoders, +1);
680                 break;
681         default:
682                 ast_atomic_fetchadd_int(&channels.decoders, +1);
683                 break;
684         }
685
686         return 0;
687 }
688
689 static int dahdi_new(struct ast_trans_pvt *pvt)
690 {
691         struct translator *zt = container_of(pvt->t, struct translator, t);
692
693         return dahdi_translate(pvt, zt->dst_dahdi_fmt, zt->src_dahdi_fmt);
694 }
695
696 static struct ast_frame *fakesrc_sample(void)
697 {
698         /* Don't bother really trying to test hardware ones. */
699         static struct ast_frame f = {
700                 .frametype = AST_FRAME_VOICE,
701                 .samples = 160,
702                 .src = __PRETTY_FUNCTION__
703         };
704
705         return &f;
706 }
707
708 static bool is_encoder(uint32_t src_dahdi_fmt)
709 {
710         return ((src_dahdi_fmt & (DAHDI_FORMAT_ULAW | DAHDI_FORMAT_ALAW | DAHDI_FORMAT_SLINEAR)) > 0);
711 }
712
713 /* Must be called with the translators list locked. */
714 static int register_translator(uint32_t dst_dahdi_fmt, uint32_t src_dahdi_fmt)
715 {
716         const struct ast_codec *dst_codec;
717         const struct ast_codec *src_codec;
718         struct translator *zt;
719         int res;
720
721         dst_codec = get_dahdi_codec(dst_dahdi_fmt);
722         src_codec = get_dahdi_codec(src_dahdi_fmt);
723         if (!dst_codec || !src_codec) {
724                 return -1;
725         }
726
727         if (!(zt = ast_calloc(1, sizeof(*zt)))) {
728                 return -1;
729         }
730
731         zt->src_dahdi_fmt = src_dahdi_fmt;
732         zt->dst_dahdi_fmt = dst_dahdi_fmt;
733
734         snprintf(zt->t.name, sizeof(zt->t.name), "dahdi_%s_to_%s",
735                 src_codec->name, dst_codec->name);
736
737         memcpy(&zt->t.src_codec, src_codec, sizeof(*src_codec));
738         memcpy(&zt->t.dst_codec, dst_codec, sizeof(*dst_codec));
739         zt->t.buf_size = BUFFER_SIZE;
740         if (is_encoder(src_dahdi_fmt)) {
741                 zt->t.framein = dahdi_encoder_framein;
742                 zt->t.frameout = dahdi_encoder_frameout;
743         } else {
744                 zt->t.framein = dahdi_decoder_framein;
745                 zt->t.frameout = dahdi_decoder_frameout;
746         }
747         zt->t.destroy = dahdi_destroy;
748         zt->t.buffer_samples = 0;
749         zt->t.newpvt = dahdi_new;
750         zt->t.sample = fakesrc_sample;
751         zt->t.native_plc = 0;
752
753         zt->t.desc_size = sizeof(struct codec_dahdi_pvt);
754         if ((res = ast_register_translator(&zt->t))) {
755                 ast_free(zt);
756                 return -1;
757         }
758
759         AST_LIST_INSERT_HEAD(&translators, zt, entry);
760
761         return res;
762 }
763
764 static void unregister_translators(void)
765 {
766         struct translator *cur;
767
768         AST_LIST_LOCK(&translators);
769         while ((cur = AST_LIST_REMOVE_HEAD(&translators, entry))) {
770                 ast_unregister_translator(&cur->t);
771                 ast_free(cur);
772         }
773         AST_LIST_UNLOCK(&translators);
774 }
775
776 /* Must be called with the translators list locked. */
777 static bool is_already_registered(uint32_t dstfmt, uint32_t srcfmt)
778 {
779         bool res = false;
780         const struct translator *zt;
781
782         AST_LIST_TRAVERSE(&translators, zt, entry) {
783                 if ((zt->src_dahdi_fmt == srcfmt) && (zt->dst_dahdi_fmt == dstfmt)) {
784                         res = true;
785                         break;
786                 }
787         }
788
789         return res;
790 }
791
792 static void build_translators(uint32_t dstfmts, uint32_t srcfmts)
793 {
794         uint32_t srcfmt;
795         uint32_t dstfmt;
796
797         AST_LIST_LOCK(&translators);
798
799         for (srcfmt = 1; srcfmt != 0; srcfmt <<= 1) {
800                 for (dstfmt = 1; dstfmt != 0; dstfmt <<= 1) {
801                         if (!(dstfmts & dstfmt) || !(srcfmts & srcfmt)) {
802                                 continue;
803                         }
804                         if (is_already_registered(dstfmt, srcfmt)) {
805                                 continue;
806                         }
807                         register_translator(dstfmt, srcfmt);
808                 }
809         }
810
811         AST_LIST_UNLOCK(&translators);
812 }
813
814 static int find_transcoders(void)
815 {
816         struct dahdi_transcoder_info info = { 0, };
817         int fd;
818
819         if ((fd = open("/dev/dahdi/transcode", O_RDWR)) < 0) {
820                 ast_log(LOG_ERROR, "Failed to open /dev/dahdi/transcode: %s\n", strerror(errno));
821                 return 0;
822         }
823
824         for (info.tcnum = 0; !ioctl(fd, DAHDI_TC_GETINFO, &info); info.tcnum++) {
825                 ast_verb(2, "Found transcoder '%s'.\n", info.name);
826
827                 /* Complex codecs need to support signed linear.  If the
828                  * hardware transcoder does not natively support signed linear
829                  * format, we will emulate it in software directly in this
830                  * module. Also, do not allow direct ulaw/alaw to complex
831                  * codec translation, since that will prevent the generic PLC
832                  * functions from working. */
833                 if (info.dstfmts & (DAHDI_FORMAT_ULAW | DAHDI_FORMAT_ALAW)) {
834                         info.dstfmts |= DAHDI_FORMAT_SLINEAR;
835                         info.dstfmts &= ~(DAHDI_FORMAT_ULAW | DAHDI_FORMAT_ALAW);
836                 }
837                 if (info.srcfmts & (DAHDI_FORMAT_ULAW | DAHDI_FORMAT_ALAW)) {
838                         info.srcfmts |= DAHDI_FORMAT_SLINEAR;
839                         info.srcfmts &= ~(DAHDI_FORMAT_ULAW | DAHDI_FORMAT_ALAW);
840                 }
841
842                 build_translators(info.dstfmts, info.srcfmts);
843                 ast_atomic_fetchadd_int(&channels.total, info.numchannels / 2);
844         }
845
846         close(fd);
847
848         if (!info.tcnum) {
849                 ast_verb(2, "No hardware transcoders found.\n");
850         }
851
852         return 0;
853 }
854
855 static int reload(void)
856 {
857         return AST_MODULE_LOAD_SUCCESS;
858 }
859
860 static int unload_module(void)
861 {
862         ast_cli_unregister_multiple(cli, ARRAY_LEN(cli));
863         unregister_translators();
864
865         return 0;
866 }
867
868 static int load_module(void)
869 {
870         find_transcoders();
871         ast_cli_register_multiple(cli, ARRAY_LEN(cli));
872         return AST_MODULE_LOAD_SUCCESS;
873 }
874
875 AST_MODULE_INFO(ASTERISK_GPL_KEY, AST_MODFLAG_DEFAULT, "Generic DAHDI Transcoder Codec Translator",
876                 .support_level = AST_MODULE_SUPPORT_CORE,
877                 .load = load_module,
878                 .unload = unload_module,
879                 .reload = reload,
880                );