First version of the aac audio format handler that kinda works.
[paraslash.git] / aacdec.c
1 /*
2  * Copyright (C) 2006 Andre Noll <maan@systemlinux.org>
3  *
4  *     This program is free software; you can redistribute it and/or modify
5  *     it under the terms of the GNU General Public License as published by
6  *     the Free Software Foundation; either version 2 of the License, or
7  *     (at your option) any later version.
8  *
9  *     This program is distributed in the hope that it will be useful,
10  *     but WITHOUT ANY WARRANTY; without even the implied warranty of
11  *     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
12  *     GNU General Public License for more details.
13  *
14  *     You should have received a copy of the GNU General Public License
15  *     along with this program; if not, write to the Free Software
16  *     Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111, USA.
17  */
18
19 /*
20  * based in parts on libfaad, Copyright (C) 2003-2005 M. Bakker,
21  * Ahead Software AG
22  */
23
24 /** \file aacdec.c paraslash's mp3 decoder */
25
26 #include "para.h"
27
28 #include "list.h"
29 #include "filter.h"
30 #include "error.h"
31 #include "string.h"
32 #include "aac.h"
33
34 /** the output buffer size */
35 #define MAX_CHANNELS 6
36 #define AAC_OUTBUF_SIZE (FAAD_MIN_STREAMSIZE * MAX_CHANNELS)
37
38 /**
39  * data specific to the aacdec filter
40  *
41  * \sa filter, filter_node
42  */
43 struct private_mp4dec_data {
44         NeAACDecHandle decoder;
45         NeAACDecFrameInfo frame_info;
46
47         int initialized;
48         int decoder_length;
49         unsigned char *inbuf;
50         int inbuf_len;
51         int consumed;
52         long unsigned consumed_total;
53
54         unsigned noffsets;
55         unsigned *offset;
56         unsigned offset0;
57         int offset_pos;
58 };
59
60 static int read_int32(struct private_mp4dec_data *padd, unsigned *result)
61 {
62         uint8_t *d = (uint8_t*)(padd->inbuf + padd->consumed);
63         if (padd->consumed + 4 > padd->inbuf_len)
64                 return -1;
65         padd->consumed += 4;
66         *result = (d[0] << 24) | (d[1] << 16) | (d[2] << 8) | d[3];
67         return 1;
68 }
69
70 static int fill_offset_table(struct private_mp4dec_data *padd)
71 {
72         int i, ret;
73
74         for (i = padd->offset_pos; i < padd->noffsets; i++) {
75                 ret = read_int32(padd, &padd->offset[i]);
76                 if (ret < 0)
77                         return -1;
78                 PARA_DEBUG_LOG("offset #%d: %d\n", i, padd->offset[i]);
79                 padd->offset_pos++;
80         }
81         return 1;
82 }
83
84 static int find_stco(struct private_mp4dec_data *padd)
85 {
86         int ret;
87
88         for (; padd->consumed < padd->inbuf_len; padd->consumed++) {
89                 unsigned char *p = padd->inbuf + padd->consumed;
90
91                 if (p[0] != 's' || p[1] != 't' || p[2] != 'c' || p[3] != 'o')
92                         continue;
93                 PARA_INFO_LOG("found stco: %d\n", padd->consumed);
94                 padd->consumed += 8;
95                 ret = read_int32(padd, &padd->noffsets);
96                 padd->offset = para_malloc(padd->noffsets * sizeof(int));
97                 PARA_INFO_LOG("num entries: %d\n", padd->noffsets);
98                 return 1;
99         }
100         return -E_STCO;
101 }
102
103 static ssize_t mp4dec(char *inbuffer, size_t len, struct filter_node *fn)
104 {
105         struct private_mp4dec_data *padd = fn->private_data;
106         struct filter_chain_info *fci = fn->fci;
107         unsigned long rate = 0;
108         unsigned char channels = 0;
109         int i, ret, nbytes, skip;
110         unsigned char *p, *outbuffer;
111
112         if (fn->loaded > fn->bufsize * 4 / 5)
113                 return 0;
114         if (len < 1000 && !*fci->eof)
115                 return 0;
116         padd->consumed = 0;
117         padd->inbuf = (unsigned char*)inbuffer;
118         padd->inbuf_len = len;
119
120         if (!padd->initialized) {
121                 padd->decoder_length = aac_find_esds(padd->inbuf, padd->inbuf_len,
122                         &skip);
123                 PARA_INFO_LOG("decoder len: %d\n", padd->decoder_length);
124                 if (padd->decoder_length < 0) {
125                         ret = NeAACDecInit(padd->decoder, padd->inbuf,
126                                 padd->inbuf_len, &rate, &channels);
127                         PARA_INFO_LOG("decoder init: %d\n", ret);
128                         if (ret < 0) {
129                                 ret = -E_AACDEC_INIT;
130                                 goto out;
131                         }
132                         padd->consumed = ret;
133                 } else {
134                         padd->consumed += skip;
135                         p = padd->inbuf + padd->consumed;
136                         ret = -E_AACDEC_INIT;
137                         if (NeAACDecInit2(padd->decoder, p,
138                                         padd->decoder_length, &rate,
139                                         &channels) < 0)
140                                 goto out;
141                 }
142                 fci->samplerate = rate;
143                 fci->channels = channels;
144                 PARA_INFO_LOG("rate: %u, channels: %d\n",
145                         fci->samplerate, fci->channels);
146                 padd->initialized = 1;
147         }
148         if (padd->decoder_length > 0) {
149                 padd->consumed = 0;
150                 if (!padd->offset_pos) {
151                         ret = aac_find_stco(padd->inbuf + padd->consumed,
152                                 padd->inbuf_len - padd->consumed, &skip);
153                         if (ret < 0) {
154                                 ret = len;
155                                 goto out;
156                         }
157                         padd->noffsets = ret;
158                         padd->offset = para_malloc(padd->noffsets * sizeof(int));
159                         padd->consumed += skip;
160                 }
161                 if (padd->offset_pos < padd->noffsets) {
162                         fill_offset_table(padd);
163                         ret = padd->consumed;
164                         goto out;
165                 }
166 //              PARA_INFO_LOG("consumed total: %lu, first_chunk: %d\n",
167 //                      padd->consumed_total, padd->offset[0]);
168                 ret = len;
169                 if (padd->consumed_total + len < padd->offset[0])
170                         goto out;
171                 if (padd->consumed_total < padd->offset[0])
172                         padd->consumed = padd->offset[0] - padd->consumed_total;
173         }
174         for (; padd->consumed < padd->inbuf_len; padd->consumed++)
175                 if ((padd->inbuf[padd->consumed] & 0xfe) == 0x20)
176                         break;
177         if (padd->consumed >= padd->inbuf_len)
178                 goto success;
179         p = padd->inbuf + padd->consumed;
180 //      PARA_NOTICE_LOG("p[0]: %lx\n", (long unsigned) *p);
181         outbuffer = NeAACDecDecode(padd->decoder, &padd->frame_info, p,
182                 len - padd->consumed);
183         ret = -E_AAC_DECODE;
184         if (padd->frame_info.error != 0) {
185                 PARA_ERROR_LOG("frame_error: %d, consumed: %lu + %d + %lu\n",
186                         padd->frame_info.error, padd->consumed_total,
187                         padd->consumed, padd->frame_info.bytesconsumed);
188                 PARA_ERROR_LOG("%s\n", NeAACDecGetErrorMessage(
189                         padd->frame_info.error));
190                 padd->consumed++; /* catch 21 */
191                 goto success;
192         }
193         padd->consumed += padd->frame_info.bytesconsumed;
194         ret = padd->consumed;
195         if (!padd->frame_info.samples)
196                 goto out;
197         nbytes = padd->frame_info.samples;
198         for (i = 0; i < padd->frame_info.samples; i++) {
199                 short *s = (short *)outbuffer;
200                 fn->buf[fn->loaded++] = s[i] & 0xff;
201                 fn->buf[fn->loaded++] = (s[i] >> 8) & 0xff;
202         }
203 success:
204         ret = padd->consumed;
205 out:
206         if (ret > 0)
207                 padd->consumed_total += ret;
208         return ret;
209 }
210
211 static void mp4dec_open(struct filter_node *fn)
212 {
213         fn->private_data = para_calloc(sizeof(struct private_mp4dec_data));
214         struct private_mp4dec_data *padd = fn->private_data;
215
216         fn->bufsize = AAC_OUTBUF_SIZE;
217         fn->buf = para_calloc(fn->bufsize);
218         padd->decoder = aac_open();
219 }
220
221 static void mp4dec_close(struct filter_node *fn)
222 {
223         struct private_mp4dec_data *padd = fn->private_data;
224
225         NeAACDecClose(padd->decoder);
226         free(fn->buf);
227         fn->buf = NULL;
228         free(padd);
229         fn->private_data = NULL;
230 }
231
232 /**
233  * the init function of the mp3dec filter
234  *
235  * \sa filter::init
236  */
237 void aacdec_init(struct filter *f)
238 {
239         f->open = mp4dec_open;
240         f->convert = mp4dec;
241         f->close = mp4dec_close;
242 }