Merged revisions 330204 via svnmerge from
[asterisk/asterisk.git] / formats / format_g726.c
1 /*
2  * Asterisk -- An open source telephony toolkit.
3  *
4  * Copyright (c) 2004 - 2005, inAccess Networks
5  *
6  * Michael Manousos <manousos@inaccessnetworks.com>
7  *
8  * See http://www.asterisk.org for more information about
9  * the Asterisk project. Please do not directly contact
10  * any of the maintainers of this project for assistance;
11  * the project provides a web site, mailing lists and IRC
12  * channels for your use.
13  *
14  * This program is free software, distributed under the terms of
15  * the GNU General Public License Version 2. See the LICENSE file
16  * at the top of the source tree.
17  */
18
19 /*!\file
20  *
21  * \brief Headerless G.726 (16/24/32/40kbps) data format for Asterisk.
22  * 
23  * File name extensions:
24  * \arg 40 kbps: g726-40
25  * \arg 32 kbps: g726-32
26  * \arg 24 kbps: g726-24
27  * \arg 16 kbps: g726-16
28  * \ingroup formats
29  */
30
31 /*** MODULEINFO
32         <support_level>core</support_level>
33  ***/
34  
35 #include "asterisk.h"
36
37 ASTERISK_FILE_VERSION(__FILE__, "$Revision$")
38
39 #include "asterisk/mod_format.h"
40 #include "asterisk/module.h"
41 #include "asterisk/endian.h"
42
43 #define RATE_40         0
44 #define RATE_32         1
45 #define RATE_24         2
46 #define RATE_16         3
47
48 /* We can only read/write chunks of FRAME_TIME ms G.726 data */
49 #define FRAME_TIME      10      /* 10 ms size */
50
51 #define BUF_SIZE        (5*FRAME_TIME)  /* max frame size in bytes ? */
52 /* Frame sizes in bytes */
53 static int frame_size[4] = { 
54                 FRAME_TIME * 5,
55                 FRAME_TIME * 4,
56                 FRAME_TIME * 3,
57                 FRAME_TIME * 2
58 };
59
60 struct g726_desc  {
61         int rate;       /* RATE_* defines */
62 };
63
64 /*
65  * Rate dependant format functions (open, rewrite)
66  */
67 static int g726_open(struct ast_filestream *tmp, int rate)
68 {
69         struct g726_desc *s = (struct g726_desc *)tmp->_private;
70         s->rate = rate;
71         ast_debug(1, "Created filestream G.726-%dk.\n", 40 - s->rate * 8);
72         return 0;
73 }
74
75 static int g726_40_open(struct ast_filestream *s)
76 {
77         return g726_open(s, RATE_40);
78 }
79
80 static int g726_32_open(struct ast_filestream *s)
81 {
82         return g726_open(s, RATE_32);
83 }
84
85 static int g726_24_open(struct ast_filestream *s)
86 {
87         return g726_open(s, RATE_24);
88 }
89
90 static int g726_16_open(struct ast_filestream *s)
91 {
92         return g726_open(s, RATE_16);
93 }
94
95 static int g726_40_rewrite(struct ast_filestream *s, const char *comment)
96 {
97         return g726_open(s, RATE_40);
98 }
99
100 static int g726_32_rewrite(struct ast_filestream *s, const char *comment)
101 {
102         return g726_open(s, RATE_32);
103 }
104
105 static int g726_24_rewrite(struct ast_filestream *s, const char *comment)
106 {
107         return g726_open(s, RATE_24);
108 }
109
110 static int g726_16_rewrite(struct ast_filestream *s, const char *comment)
111 {
112         return g726_open(s, RATE_16);
113 }
114
115 /*
116  * Rate independent format functions (read, write)
117  */
118
119 static struct ast_frame *g726_read(struct ast_filestream *s, int *whennext)
120 {
121         int res;
122         struct g726_desc *fs = (struct g726_desc *)s->_private;
123
124         /* Send a frame from the file to the appropriate channel */
125         s->fr.frametype = AST_FRAME_VOICE;
126         ast_format_set(&s->fr.subclass.format, AST_FORMAT_G726, 0);
127         s->fr.mallocd = 0;
128         AST_FRAME_SET_BUFFER(&s->fr, s->buf, AST_FRIENDLY_OFFSET, frame_size[fs->rate]);
129         s->fr.samples = 8 * FRAME_TIME;
130         if ((res = fread(s->fr.data.ptr, 1, s->fr.datalen, s->f)) != s->fr.datalen) {
131                 if (res)
132                         ast_log(LOG_WARNING, "Short read (%d) (%s)!\n", res, strerror(errno));
133                 return NULL;
134         }
135         *whennext = s->fr.samples;
136         return &s->fr;
137 }
138
139 static int g726_write(struct ast_filestream *s, struct ast_frame *f)
140 {
141         int res;
142         struct g726_desc *fs = (struct g726_desc *)s->_private;
143
144         if (f->frametype != AST_FRAME_VOICE) {
145                 ast_log(LOG_WARNING, "Asked to write non-voice frame!\n");
146                 return -1;
147         }
148         if (f->subclass.format.id != AST_FORMAT_G726) {
149                 ast_log(LOG_WARNING, "Asked to write non-G726 frame (%s)!\n", 
150                                                 ast_getformatname(&f->subclass.format));
151                 return -1;
152         }
153         if (f->datalen % frame_size[fs->rate]) {
154                 ast_log(LOG_WARNING, "Invalid data length %d, should be multiple of %d\n", 
155                                                 f->datalen, frame_size[fs->rate]);
156                 return -1;
157         }
158         if ((res = fwrite(f->data.ptr, 1, f->datalen, s->f)) != f->datalen) {
159                 ast_log(LOG_WARNING, "Bad write (%d/%d): %s\n", 
160                                 res, frame_size[fs->rate], strerror(errno));
161                         return -1;
162         }
163         return 0;
164 }
165
166 static int g726_seek(struct ast_filestream *fs, off_t sample_offset, int whence)
167 {
168         return -1;
169 }
170
171 static int g726_trunc(struct ast_filestream *fs)
172 {
173         return -1;
174 }
175
176 static off_t g726_tell(struct ast_filestream *fs)
177 {
178         return -1;
179 }
180
181 static struct ast_format_def f[] = {
182         {
183                 .name = "g726-40",
184                 .exts = "g726-40",
185                 .open = g726_40_open,
186                 .rewrite = g726_40_rewrite,
187                 .write = g726_write,
188                 .seek = g726_seek,
189                 .trunc = g726_trunc,
190                 .tell = g726_tell,
191                 .read = g726_read,
192                 .buf_size = BUF_SIZE + AST_FRIENDLY_OFFSET,
193                 .desc_size = sizeof(struct g726_desc),
194         },
195         {
196                 .name = "g726-32",
197                 .exts = "g726-32",
198                 .open = g726_32_open,
199                 .rewrite = g726_32_rewrite,
200                 .write = g726_write,
201                 .seek = g726_seek,
202                 .trunc = g726_trunc,
203                 .tell = g726_tell,
204                 .read = g726_read,
205                 .buf_size = BUF_SIZE + AST_FRIENDLY_OFFSET,
206                 .desc_size = sizeof(struct g726_desc),
207         },
208         {
209                 .name = "g726-24",
210                 .exts = "g726-24",
211                 .open = g726_24_open,
212                 .rewrite = g726_24_rewrite,
213                 .write = g726_write,
214                 .seek = g726_seek,
215                 .trunc = g726_trunc,
216                 .tell = g726_tell,
217                 .read = g726_read,
218                 .buf_size = BUF_SIZE + AST_FRIENDLY_OFFSET,
219                 .desc_size = sizeof(struct g726_desc),
220         },
221         {
222                 .name = "g726-16",
223                 .exts = "g726-16",
224                 .open = g726_16_open,
225                 .rewrite = g726_16_rewrite,
226                 .write = g726_write,
227                 .seek = g726_seek,
228                 .trunc = g726_trunc,
229                 .tell = g726_tell,
230                 .read = g726_read,
231                 .buf_size = BUF_SIZE + AST_FRIENDLY_OFFSET,
232                 .desc_size = sizeof(struct g726_desc),
233         },
234         {       .desc_size = 0 }        /* terminator */
235 };
236
237 static int load_module(void)
238 {
239         int i;
240
241         for (i = 0; f[i].desc_size ; i++) {
242                 ast_format_set(&f[i].format, AST_FORMAT_G726, 0);
243                 if (ast_format_def_register(&f[i])) {   /* errors are fatal */
244                         ast_log(LOG_WARNING, "Failed to register format %s.\n", f[i].name);
245                         return AST_MODULE_LOAD_FAILURE;
246                 }
247         }
248         return AST_MODULE_LOAD_SUCCESS;
249 }
250
251 static int unload_module(void)
252 {
253         int i;
254
255         for (i = 0; f[i].desc_size ; i++) {
256                 if (ast_format_def_unregister(f[i].name))
257                         ast_log(LOG_WARNING, "Failed to unregister format %s.\n", f[i].name);
258         }
259         return(0);
260 }
261
262 AST_MODULE_INFO(ASTERISK_GPL_KEY, AST_MODFLAG_LOAD_ORDER, "Raw G.726 (16/24/32/40kbps) data",
263         .load = load_module,
264         .unload = unload_module,
265         .load_pri = AST_MODPRI_APP_DEPEND
266 );