comparison dtsdec.c @ 2123:ef54decf5624 libavcodec

libdts support by (Benjamin Zores <ben at geexbox dot org>)
author michael
date Wed, 14 Jul 2004 01:32:14 +0000
parents
children 181cb6785f6b
comparison
equal deleted inserted replaced
2122:503496800167 2123:ef54decf5624
1 /*
2 * dtsdec.c : free DTS Coherent Acoustics stream decoder.
3 * Copyright (C) 2004 Benjamin Zores <ben@geexbox.org>
4 *
5 * This file is part of libavcodec.
6 *
7 * This library is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU Lesser General Public
9 * License as published by the Free Software Foundation; either
10 * version 2 of the License, or (at your option) any later version.
11 *
12 * This library is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * Lesser General Public License for more details.
16 *
17 * You should have received a copy of the GNU Lesser General Public
18 * License along with this library; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
20 */
21
22 #ifdef HAVE_AV_CONFIG_H
23 #undef HAVE_AV_CONFIG_H
24 #endif
25
26 #include "avcodec.h"
27 #include <dts.h>
28 #include "dts_internal.h"
29
30 #include <stdlib.h>
31 #include <string.h>
32 #include <malloc.h>
33 #include <math.h>
34
35 #define INBUF_SIZE 4096
36 #define BUFFER_SIZE 4096
37 #define HEADER_SIZE 14
38
39 #ifdef LIBDTS_FIXED
40 #define CONVERT_LEVEL (1 << 26)
41 #define CONVERT_BIAS 0
42 #else
43 #define CONVERT_LEVEL 1
44 #define CONVERT_BIAS 384
45 #endif
46
47 static void
48 pre_calc_cosmod (dts_state_t * state)
49 {
50 int i, j, k;
51
52 for (j=0,k=0;k<16;k++)
53 for (i=0;i<16;i++)
54 state->cos_mod[j++] = cos((2*i+1)*(2*k+1)*M_PI/64);
55
56 for (k=0;k<16;k++)
57 for (i=0;i<16;i++)
58 state->cos_mod[j++] = cos((i)*(2*k+1)*M_PI/32);
59
60 for (k=0;k<16;k++)
61 state->cos_mod[j++] = 0.25/(2*cos((2*k+1)*M_PI/128));
62
63 for (k=0;k<16;k++)
64 state->cos_mod[j++] = -0.25/(2.0*sin((2*k+1)*M_PI/128));
65 }
66
67 static inline
68 int16_t convert (int32_t i)
69 {
70 #ifdef LIBDTS_FIXED
71 i >>= 15;
72 #else
73 i -= 0x43c00000;
74 #endif
75 return (i > 32767) ? 32767 : ((i < -32768) ? -32768 : i);
76 }
77
78 void
79 convert2s16_2 (sample_t * _f, int16_t * s16)
80 {
81 int i;
82 int32_t * f = (int32_t *) _f;
83
84 for (i = 0; i < 256; i++)
85 {
86 s16[2*i] = convert (f[i]);
87 s16[2*i+1] = convert (f[i+256]);
88 }
89 }
90
91 void
92 convert2s16_4 (sample_t * _f, int16_t * s16)
93 {
94 int i;
95 int32_t * f = (int32_t *) _f;
96
97 for (i = 0; i < 256; i++)
98 {
99 s16[4*i] = convert (f[i]);
100 s16[4*i+1] = convert (f[i+256]);
101 s16[4*i+2] = convert (f[i+512]);
102 s16[4*i+3] = convert (f[i+768]);
103 }
104 }
105
106 void
107 convert2s16_5 (sample_t * _f, int16_t * s16)
108 {
109 int i;
110 int32_t * f = (int32_t *) _f;
111
112 for (i = 0; i < 256; i++)
113 {
114 s16[5*i] = convert (f[i]);
115 s16[5*i+1] = convert (f[i+256]);
116 s16[5*i+2] = convert (f[i+512]);
117 s16[5*i+3] = convert (f[i+768]);
118 s16[5*i+4] = convert (f[i+1024]);
119 }
120 }
121
122 static void
123 convert2s16_multi (sample_t * _f, int16_t * s16, int flags)
124 {
125 int i;
126 int32_t * f = (int32_t *) _f;
127
128 switch (flags)
129 {
130 case DTS_MONO:
131 for (i = 0; i < 256; i++)
132 {
133 s16[5*i] = s16[5*i+1] = s16[5*i+2] = s16[5*i+3] = 0;
134 s16[5*i+4] = convert (f[i]);
135 }
136 break;
137 case DTS_CHANNEL:
138 case DTS_STEREO:
139 case DTS_DOLBY:
140 convert2s16_2 (_f, s16);
141 break;
142 case DTS_3F:
143 for (i = 0; i < 256; i++)
144 {
145 s16[5*i] = convert (f[i]);
146 s16[5*i+1] = convert (f[i+512]);
147 s16[5*i+2] = s16[5*i+3] = 0;
148 s16[5*i+4] = convert (f[i+256]);
149 }
150 break;
151 case DTS_2F2R:
152 convert2s16_4 (_f, s16);
153 break;
154 case DTS_3F2R:
155 convert2s16_5 (_f, s16);
156 break;
157 case DTS_MONO | DTS_LFE:
158 for (i = 0; i < 256; i++)
159 {
160 s16[6*i] = s16[6*i+1] = s16[6*i+2] = s16[6*i+3] = 0;
161 s16[6*i+4] = convert (f[i+256]);
162 s16[6*i+5] = convert (f[i]);
163 }
164 break;
165 case DTS_CHANNEL | DTS_LFE:
166 case DTS_STEREO | DTS_LFE:
167 case DTS_DOLBY | DTS_LFE:
168 for (i = 0; i < 256; i++)
169 {
170 s16[6*i] = convert (f[i+256]);
171 s16[6*i+1] = convert (f[i+512]);
172 s16[6*i+2] = s16[6*i+3] = s16[6*i+4] = 0;
173 s16[6*i+5] = convert (f[i]);
174 }
175 break;
176 case DTS_3F | DTS_LFE:
177 for (i = 0; i < 256; i++)
178 {
179 s16[6*i] = convert (f[i+256]);
180 s16[6*i+1] = convert (f[i+768]);
181 s16[6*i+2] = s16[6*i+3] = 0;
182 s16[6*i+4] = convert (f[i+512]);
183 s16[6*i+5] = convert (f[i]);
184 }
185 break;
186 case DTS_2F2R | DTS_LFE:
187 for (i = 0; i < 256; i++)
188 {
189 s16[6*i] = convert (f[i+256]);
190 s16[6*i+1] = convert (f[i+512]);
191 s16[6*i+2] = convert (f[i+768]);
192 s16[6*i+3] = convert (f[i+1024]);
193 s16[6*i+4] = 0;
194 s16[6*i+5] = convert (f[i]);
195 }
196 break;
197 case DTS_3F2R | DTS_LFE:
198 for (i = 0; i < 256; i++)
199 {
200 s16[6*i] = convert (f[i+256]);
201 s16[6*i+1] = convert (f[i+768]);
202 s16[6*i+2] = convert (f[i+1024]);
203 s16[6*i+3] = convert (f[i+1280]);
204 s16[6*i+4] = convert (f[i+512]);
205 s16[6*i+5] = convert (f[i]);
206 }
207 break;
208 }
209 }
210
211 static int
212 channels_multi (int flags)
213 {
214 if (flags & DTS_LFE)
215 return 6;
216 else if (flags & 1) /* center channel */
217 return 5;
218 else if ((flags & DTS_CHANNEL_MASK) == DTS_2F2R)
219 return 4;
220 else
221 return 2;
222 }
223
224 static int
225 dts_decode_frame (AVCodecContext *avctx, void *data, int *data_size,
226 uint8_t *buff, int buff_size)
227 {
228 uint8_t * start = buff;
229 uint8_t * end = buff + buff_size;
230 *data_size = 0;
231
232 static uint8_t buf[BUFFER_SIZE];
233 static uint8_t * bufptr = buf;
234 static uint8_t * bufpos = buf + HEADER_SIZE;
235
236 static int sample_rate;
237 static int frame_length;
238 static int flags;
239 int bit_rate;
240 int len;
241 dts_state_t *state = avctx->priv_data;
242
243 while (1)
244 {
245 len = end - start;
246 if (!len)
247 break;
248 if (len > bufpos - bufptr)
249 len = bufpos - bufptr;
250 memcpy (bufptr, start, len);
251 bufptr += len;
252 start += len;
253 if (bufptr == bufpos)
254 {
255 if (bufpos == buf + HEADER_SIZE)
256 {
257 int length;
258
259 length = dts_syncinfo (state, buf, &flags, &sample_rate,
260 &bit_rate, &frame_length);
261 if (!length)
262 {
263 av_log (NULL, AV_LOG_INFO, "skip\n");
264 for (bufptr = buf; bufptr < buf + HEADER_SIZE-1; bufptr++)
265 bufptr[0] = bufptr[1];
266 continue;
267 }
268 bufpos = buf + length;
269 }
270 else
271 {
272 level_t level;
273 sample_t bias;
274 int i;
275
276 flags = 2; /* ???????????? */
277 level = CONVERT_LEVEL;
278 bias = CONVERT_BIAS;
279
280 flags |= DTS_ADJUST_LEVEL;
281 if (dts_frame (state, buf, &flags, &level, bias))
282 goto error;
283 for (i = 0; i < dts_blocks_num (state); i++)
284 {
285 if (dts_block (state))
286 goto error;
287 {
288 int chans;
289 chans = channels_multi (flags);
290 convert2s16_multi (dts_samples (state), data,
291 flags & (DTS_CHANNEL_MASK | DTS_LFE));
292
293 data += 256 * sizeof (int16_t) * chans;
294 *data_size += 256 * sizeof (int16_t) * chans;
295 }
296 }
297 bufptr = buf;
298 bufpos = buf + HEADER_SIZE;
299 continue;
300 error:
301 av_log (NULL, AV_LOG_ERROR, "error\n");
302 bufptr = buf;
303 bufpos = buf + HEADER_SIZE;
304 }
305 }
306 }
307
308 return buff_size;
309 }
310
311 static int
312 dts_decode_init (AVCodecContext *avctx)
313 {
314 dts_state_t * state;
315 int i;
316
317 state = avctx->priv_data;
318 memset (state, 0, sizeof (dts_state_t));
319
320 state->samples = (sample_t *) memalign (16, 256 * 12 * sizeof (sample_t));
321 if (state->samples == NULL)
322 return 1;
323
324 for (i = 0; i < 256 * 12; i++)
325 state->samples[i] = 0;
326
327 /* Pre-calculate cosine modulation coefficients */
328 pre_calc_cosmod (state);
329 state->downmixed = 1;
330
331 return 0;
332 }
333
334 static int
335 dts_decode_end (AVCodecContext *s)
336 {
337 return 0;
338 }
339
340 AVCodec dts_decoder = {
341 "dts",
342 CODEC_TYPE_AUDIO,
343 CODEC_ID_DTS,
344 sizeof (dts_state_t),
345 dts_decode_init,
346 NULL,
347 dts_decode_end,
348 dts_decode_frame,
349 };