Add basic (passthrough, playback, record) support for ITU G.722.1 and G.722.1C (also...
[asterisk/asterisk.git] / formats / format_siren14.c
1 /*
2  * Asterisk -- An open source telephony toolkit.
3  *
4  * Copyright (C) 1999 - 2008, Anthony Minessale and Digium, Inc.
5  * Anthony Minessale (anthmct@yahoo.com)
6  * Kevin P. Fleming <kpfleming@digium.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 ITU G.722.1 Annex C (Siren14, licensed from Polycom) format, 48kbps bitrate only
22  * \arg File name extensions: siren14
23  * \ingroup formats
24  */
25  
26 #include "asterisk.h"
27
28 ASTERISK_FILE_VERSION(__FILE__, "$Revision$")
29
30 #include "asterisk/mod_format.h"
31 #include "asterisk/module.h"
32 #include "asterisk/endian.h"
33
34 #define BUF_SIZE        120             /* 20 milliseconds == 120 bytes, 640 samples */
35 #define SAMPLES_TO_BYTES(x)     ((typeof(x)) x / ((float) 640 / 120))
36 #define BYTES_TO_SAMPLES(x)     ((typeof(x)) x * ((float) 640 / 120))
37
38 static struct ast_frame *siren14read(struct ast_filestream *s, int *whennext)
39 {
40         int res;
41         /* Send a frame from the file to the appropriate channel */
42
43         s->fr.frametype = AST_FRAME_VOICE;
44         s->fr.subclass = AST_FORMAT_SIREN14;
45         s->fr.mallocd = 0;
46         AST_FRAME_SET_BUFFER(&s->fr, s->buf, AST_FRIENDLY_OFFSET, BUF_SIZE);
47         if ((res = fread(s->fr.data.ptr, 1, s->fr.datalen, s->f)) != s->fr.datalen) {
48                 if (res)
49                         ast_log(LOG_WARNING, "Short read (%d) (%s)!\n", res, strerror(errno));
50                 return NULL;
51         }
52         *whennext = s->fr.samples = BYTES_TO_SAMPLES(res);
53         ast_log(LOG_DEBUG, "Read frame of %d bytes and %d samples\n", res, s->fr.samples);
54         return &s->fr;
55 }
56
57 static int siren14write(struct ast_filestream *fs, struct ast_frame *f)
58 {
59         int res;
60
61         if (f->frametype != AST_FRAME_VOICE) {
62                 ast_log(LOG_WARNING, "Asked to write non-voice frame!\n");
63                 return -1;
64         }
65         if (f->subclass != AST_FORMAT_SIREN14) {
66                 ast_log(LOG_WARNING, "Asked to write non-Siren14 frame (%d)!\n", f->subclass);
67                 return -1;
68         }
69         if ((res = fwrite(f->data.ptr, 1, f->datalen, fs->f)) != f->datalen) {
70                 ast_log(LOG_WARNING, "Bad write (%d/%d): %s\n", res, f->datalen, strerror(errno));
71                 return -1;
72         }
73         return 0;
74 }
75
76 static int siren14seek(struct ast_filestream *fs, off_t sample_offset, int whence)
77 {
78         off_t offset = 0, min = 0, cur, max;
79
80         sample_offset = SAMPLES_TO_BYTES(sample_offset);
81
82         cur = ftello(fs->f);
83
84         fseeko(fs->f, 0, SEEK_END);
85
86         max = ftello(fs->f);
87
88         if (whence == SEEK_SET)
89                 offset = sample_offset;
90         else if (whence == SEEK_CUR || whence == SEEK_FORCECUR)
91                 offset = sample_offset + cur;
92         else if (whence == SEEK_END)
93                 offset = max - sample_offset;
94
95         if (whence != SEEK_FORCECUR)
96                 offset = (offset > max) ? max : offset;
97
98         /* always protect against seeking past begining. */
99         offset = (offset < min) ? min : offset;
100
101         return fseeko(fs->f, offset, SEEK_SET);
102 }
103
104 static int siren14trunc(struct ast_filestream *fs)
105 {
106         return ftruncate(fileno(fs->f), ftello(fs->f));
107 }
108
109 static off_t siren14tell(struct ast_filestream *fs)
110 {
111         return BYTES_TO_SAMPLES(ftello(fs->f));
112 }
113
114 static const struct ast_format siren14_f = {
115         .name = "siren14",
116         .exts = "siren14",
117         .format = AST_FORMAT_SIREN14,
118         .write = siren14write,
119         .seek = siren14seek,
120         .trunc = siren14trunc,
121         .tell = siren14tell,
122         .read = siren14read,
123         .buf_size = BUF_SIZE + AST_FRIENDLY_OFFSET,
124 };
125
126 static int load_module(void)
127 {
128         if (ast_format_register(&siren14_f))
129                 return AST_MODULE_LOAD_DECLINE;
130
131         return AST_MODULE_LOAD_SUCCESS;
132 }
133
134 static int unload_module(void)
135 {
136         return ast_format_unregister(siren14_f.name);
137 }       
138
139 AST_MODULE_INFO_STANDARD(ASTERISK_GPL_KEY, "ITU G.722.1 Annex C (Siren14, licensed from Polycom)");