?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
codec: ass: Don't force fonts that aren't shipped anymore in the winstore app
[vlc.git] / modules / codec / lpcm.c
blob97b9a485b5bc1f8c7d6d3259fd9cbacc8d85a080
1 /*****************************************************************************
2 * lpcm.c: lpcm decoder/packetizer module
3 *****************************************************************************
4 * Copyright (C) 1999-2008 VLC authors and VideoLAN
5 * $Id$
6 *
7 * Authors: Samuel Hocevar <sam@zoy.org>
8 * Henri Fallon <henri@videolan.org>
9 * Christophe Massiot <massiot@via.ecp.fr>
10 * Gildas Bazin <gbazin@videolan.org>
11 * Lauren Aimar <fenrir _AT_ videolan _DOT_ org >
12 * Steinar H. Gunderson <steinar+vlc@gunderson.no>
13 *
14 * This program is free software; you can redistribute it and/or modify it
15 * under the terms of the GNU Lesser General Public License as published by
16 * the Free Software Foundation; either version 2.1 of the License, or
17 * (at your option) any later version.
18 *
19 * This program is distributed in the hope that it will be useful,
20 * but WITHOUT ANY WARRANTY; without even the implied warranty of
21 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
22 * GNU Lesser General Public License for more details.
23 *
24 * You should have received a copy of the GNU Lesser General Public License
25 * along with this program; if not, write to the Free Software Foundation,
26 * Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301, USA.
27 *****************************************************************************/
28
29 /*****************************************************************************
30 * Preamble
31 *****************************************************************************/
32 #ifdef HAVE_CONFIG_H
33 # include "config.h"
34 #endif
35
36 #include <vlc_common.h>
37 #include <vlc_plugin.h>
38 #include <vlc_codec.h>
39 #include <vlc_aout.h>
40 #include <unistd.h>
41 #include <assert.h>
42
43 /*****************************************************************************
44 * Module descriptor
45 *****************************************************************************/
46 static int OpenDecoder ( vlc_object_t * );
47 static int OpenPacketizer( vlc_object_t * );
48 static void CloseCommon ( vlc_object_t * );
49
50 #ifdef ENABLE_SOUT
51 static int OpenEncoder ( vlc_object_t * );
52 static void CloseEncoder ( vlc_object_t * );
53 static block_t *EncodeFrames( encoder_t *, block_t * );
54 #endif
55
56 vlc_module_begin ()
57
58 set_category( CAT_INPUT )
59 set_subcategory( SUBCAT_INPUT_ACODEC )
60 set_description( N_("Linear PCM audio decoder") )
61 set_capability( "decoder", 100 )
62 set_callbacks( OpenDecoder, CloseCommon )
63
64 add_submodule ()
65 set_description( N_("Linear PCM audio packetizer") )
66 set_capability( "packetizer", 100 )
67 set_callbacks( OpenPacketizer, CloseCommon )
68
69 #ifdef ENABLE_SOUT
70 add_submodule ()
71 set_description( N_("Linear PCM audio encoder") )
72 set_capability( "encoder", 100 )
73 set_callbacks( OpenEncoder, CloseEncoder )
74 add_shortcut( "lpcm" )
75 #endif
76
77 vlc_module_end ()
78
79
80 /*****************************************************************************
81 * decoder_sys_t : lpcm decoder descriptor
82 *****************************************************************************/
83 struct decoder_sys_t
84 {
85 /* Module mode */
86 bool b_packetizer;
87
88 /*
89 * Output properties
90 */
91 date_t end_date;
92
93 /* */
94 unsigned i_header_size;
95 int i_type;
96 uint8_t i_chans_to_reorder;
97 uint8_t pi_chan_table[AOUT_CHAN_MAX];
98 };
99
100 #ifdef ENABLE_SOUT
101 struct encoder_sys_t
102 {
103 int i_channels;
104 int i_rate;
105
106 int i_frame_samples;
107 uint8_t *p_buffer;
108 int i_buffer_used;
109 int i_frame_num;
110 };
111 #endif
112
113 /*
114 * LPCM DVD header :
115 * - number of frames in this packet (8 bits)
116 * - first access unit (16 bits) == 0x0003 ?
117 * - emphasis (1 bit)
118 * - mute (1 bit)
119 * - reserved (1 bit)
120 * - current frame (5 bits)
121 * - quantisation (2 bits) 0 == 16bps, 1 == 20bps, 2 == 24bps, 3 == illegal
122 * - frequency (2 bits) 0 == 48 kHz, 1 == 96 kHz, 2 == 44.1 kHz, 3 == 32 kHz
123 * - reserved (1 bit)
124 * - number of channels - 1 (3 bits) 1 == 2 channels
125 * - dynamic range (8 bits) 0x80 == neutral
126 *
127 * LPCM DVD-A header (http://dvd-audio.sourceforge.net/spec/aob.shtml)
128 * - continuity counter (8 bits, clipped to 0x00-0x1f)
129 * - header size (16 bits)
130 * - byte pointer to start of first audio frame.
131 * - unknown (8bits, 0x10 for stereo, 0x00 for surround)
132 * - sample size (4+4 bits)
133 * - samplerate (4+4 bits)
134 * - unknown (8 bits)
135 * - group assignment (8 bits)
136 * - unknown (8 bits)
137 * - padding(variable)
138 *
139 * LPCM BD header :
140 * - unknown (16 bits)
141 * - number of channels (4 bits)
142 * - frequency (4 bits)
143 * - bits per sample (2 bits)
144 * - unknown (6 bits)
145 *
146 * LPCM WIDI header
147 * refers http://www.dvdforum.org/images/Guideline1394V10R0_20020911.pdf
148 * - sub stream id (8 bits) = 0xa0
149 * - frame header count (8 bits) = 0x06
150 * [ 0b0000000 (7 bits)
151 * - audio emphasis (1 bit) ] (8 bits)
152 * [ qz word length (2 bits) 0x00 == 16bits
153 * - sampling freq (3 bits) 0b001 == 44.1K, 0b010 == 48K Hz
154 * - channels count(3 bits) ] (8 bits) 0b000 == dual mono, 0b001 == stereo
155 * follows: LPCM data (15360 bits/1920 bytes)
156 */
157
158 #define LPCM_VOB_HEADER_LEN (6)
159 #define LPCM_AOB_HEADER_LEN (11)
160 #define LPCM_BD_HEADER_LEN (4)
161 #define LPCM_WIDI_HEADER_LEN (4)
162
163 enum
164 {
165 LPCM_VOB,
166 LPCM_AOB,
167 LPCM_BD,
168 LPCM_WIDI,
169 };
170
171 typedef struct
172 {
173 unsigned i_channels;
174 unsigned i_bits;
175 unsigned pi_position[6];
176 } aob_group_t;
177
178 /*****************************************************************************
179 * Local prototypes
180 *****************************************************************************/
181 static block_t *DecodeFrame ( decoder_t *, block_t ** );
182 static void Flush( decoder_t * );
183
184 /* */
185 static int VobHeader( unsigned *pi_rate,
186 unsigned *pi_channels, unsigned *pi_original_channels,
187 unsigned *pi_bits,
188 const uint8_t *p_header );
189 static void VobExtract( block_t *, block_t *, unsigned i_bits );
190 /* */
191 static int AobHeader( unsigned *pi_rate,
192 unsigned *pi_channels, unsigned *pi_layout,
193 unsigned *pi_bits,
194 unsigned *pi_padding,
195 aob_group_t g[2],
196 const uint8_t *p_header );
197 static void AobExtract( block_t *, block_t *, unsigned i_bits, aob_group_t p_group[2] );
198 /* */
199 static int BdHeader( decoder_sys_t *p_sys,
200 unsigned *pi_rate,
201 unsigned *pi_channels,
202 unsigned *pi_channels_padding,
203 unsigned *pi_original_channels,
204 unsigned *pi_bits,
205 const uint8_t *p_header );
206 static void BdExtract( block_t *, block_t *, unsigned, unsigned, unsigned, unsigned );
207 /* */
208 static int WidiHeader( unsigned *pi_rate,
209 unsigned *pi_channels, unsigned *pi_original_channels,
210 unsigned *pi_bits,
211 const uint8_t *p_header );
212
213 /*****************************************************************************
214 * OpenCommon:
215 *****************************************************************************/
216 static int OpenCommon( vlc_object_t *p_this, bool b_packetizer )
217 {
218 decoder_t *p_dec = (decoder_t*)p_this;
219 decoder_sys_t *p_sys;
220 int i_type;
221 int i_header_size;
222
223 switch( p_dec->fmt_in.i_codec )
224 {
225 /* DVD LPCM */
226 case VLC_CODEC_DVD_LPCM:
227 i_type = LPCM_VOB;
228 i_header_size = LPCM_VOB_HEADER_LEN;
229 break;
230 /* DVD-Audio LPCM */
231 case VLC_CODEC_DVDA_LPCM:
232 i_type = LPCM_AOB;
233 i_header_size = LPCM_AOB_HEADER_LEN;
234 break;
235 /* BD LPCM */
236 case VLC_CODEC_BD_LPCM:
237 i_type = LPCM_BD;
238 i_header_size = LPCM_BD_HEADER_LEN;
239 break;
240 /* WIDI LPCM */
241 case VLC_CODEC_WIDI_LPCM:
242 i_type = LPCM_WIDI;
243 i_header_size = LPCM_WIDI_HEADER_LEN;
244 break;
245 default:
246 return VLC_EGENERIC;
247 }
248
249 /* Allocate the memory needed to store the decoder's structure */
250 if( ( p_dec->p_sys = p_sys = malloc(sizeof(decoder_sys_t)) ) == NULL )
251 return VLC_ENOMEM;
252
253 /* Misc init */
254 p_sys->b_packetizer = b_packetizer;
255 date_Set( &p_sys->end_date, 0 );
256 p_sys->i_type = i_type;
257 p_sys->i_header_size = i_header_size;
258 p_sys->i_chans_to_reorder = 0;
259
260 /* Set output properties */
261 p_dec->fmt_out.i_cat = AUDIO_ES;
262
263 if( b_packetizer )
264 {
265 switch( i_type )
266 {
267 case LPCM_VOB:
268 p_dec->fmt_out.i_codec = VLC_CODEC_DVD_LPCM;
269 break;
270 case LPCM_AOB:
271 p_dec->fmt_out.i_codec = VLC_CODEC_DVDA_LPCM;
272 break;
273 case LPCM_WIDI:
274 p_dec->fmt_out.i_codec = VLC_CODEC_WIDI_LPCM;
275 break;
276 default:
277 vlc_assert_unreachable();
278 case LPCM_BD:
279 p_dec->fmt_out.i_codec = VLC_CODEC_BD_LPCM;
280 break;
281 }
282 }
283 else
284 {
285 switch( p_dec->fmt_out.audio.i_bitspersample )
286 {
287 case 24:
288 case 20:
289 p_dec->fmt_out.i_codec = VLC_CODEC_S32N;
290 p_dec->fmt_out.audio.i_bitspersample = 32;
291 break;
292 default:
293 p_dec->fmt_out.i_codec = VLC_CODEC_S16N;
294 p_dec->fmt_out.audio.i_bitspersample = 16;
295 break;
296 }
297 }
298
299 /* Set callback */
300 p_dec->pf_decode_audio = DecodeFrame;
301 p_dec->pf_packetize = DecodeFrame;
302 p_dec->pf_flush = Flush;
303
304 return VLC_SUCCESS;
305 }
306 static int OpenDecoder( vlc_object_t *p_this )
307 {
308 return OpenCommon( p_this, false );
309 }
310 static int OpenPacketizer( vlc_object_t *p_this )
311 {
312 return OpenCommon( p_this, true );
313 }
314
315 /*****************************************************************************
316 * Flush:
317 *****************************************************************************/
318 static void Flush( decoder_t *p_dec )
319 {
320 decoder_sys_t *p_sys = p_dec->p_sys;
321
322 date_Set( &p_sys->end_date, 0 );
323 }
324
325 /*****************************************************************************
326 * DecodeFrame: decodes an lpcm frame.
327 ****************************************************************************
328 * Beware, this function must be fed with complete frames (PES packet).
329 *****************************************************************************/
330 static block_t *DecodeFrame( decoder_t *p_dec, block_t **pp_block )
331 {
332 decoder_sys_t *p_sys = p_dec->p_sys;
333 block_t *p_block;
334 unsigned int i_rate = 0, i_original_channels = 0, i_channels = 0, i_bits = 0;
335 int i_frame_length;
336
337 if( !pp_block || !*pp_block ) return NULL;
338
339 p_block = *pp_block;
340 *pp_block = NULL; /* So the packet doesn't get re-sent */
341
342 if( p_block->i_flags & BLOCK_FLAG_DISCONTINUITY )
343 Flush( p_dec );
344
345 if( p_block->i_flags & BLOCK_FLAG_CORRUPTED )
346 {
347 block_Release( p_block );
348 return NULL;
349 }
350
351 /* Date management */
352 if( p_block->i_pts > VLC_TS_INVALID &&
353 p_block->i_pts != date_Get( &p_sys->end_date ) )
354 {
355 date_Set( &p_sys->end_date, p_block->i_pts );
356 }
357
358 if( !date_Get( &p_sys->end_date ) )
359 {
360 /* We've just started the stream, wait for the first PTS. */
361 block_Release( p_block );
362 return NULL;
363 }
364
365 if( p_block->i_buffer <= p_sys->i_header_size )
366 {
367 msg_Err(p_dec, "frame is too short");
368 block_Release( p_block );
369 return NULL;
370 }
371
372 int i_ret;
373 unsigned i_channels_padding = 0;
374 unsigned i_padding = 0; /* only for AOB */
375 aob_group_t p_aob_group[2];
376
377 switch( p_sys->i_type )
378 {
379 case LPCM_VOB:
380 i_ret = VobHeader( &i_rate, &i_channels, &i_original_channels, &i_bits,
381 p_block->p_buffer );
382 break;
383 case LPCM_AOB:
384 i_ret = AobHeader( &i_rate, &i_channels, &i_original_channels, &i_bits, &i_padding,
385 p_aob_group,
386 p_block->p_buffer );
387 break;
388 case LPCM_BD:
389 i_ret = BdHeader( p_sys, &i_rate, &i_channels, &i_channels_padding, &i_original_channels, &i_bits,
390 p_block->p_buffer );
391 break;
392 case LPCM_WIDI:
393 i_ret = WidiHeader( &i_rate, &i_channels, &i_original_channels, &i_bits,
394 p_block->p_buffer );
395 break;
396 default:
397 abort();
398 }
399
400 if( i_ret || p_block->i_buffer <= p_sys->i_header_size + i_padding )
401 {
402 msg_Warn( p_dec, "no frame sync or too small frame" );
403 block_Release( p_block );
404 return NULL;
405 }
406
407 /* Set output properties */
408 if( p_dec->fmt_out.audio.i_rate != i_rate )
409 {
410 date_Init( &p_sys->end_date, i_rate, 1 );
411 date_Set( &p_sys->end_date, p_block->i_pts );
412 }
413 p_dec->fmt_out.audio.i_rate = i_rate;
414 p_dec->fmt_out.audio.i_channels = i_channels;
415 p_dec->fmt_out.audio.i_original_channels = i_original_channels;
416 p_dec->fmt_out.audio.i_physical_channels = i_original_channels;
417
418 if ( p_sys->i_type == LPCM_AOB )
419 {
420 i_frame_length = (p_block->i_buffer - p_sys->i_header_size - i_padding) /
421 (
422 ( (p_aob_group[0].i_bits / 8) * p_aob_group[0].i_channels ) +
423 ( (p_aob_group[1].i_bits / 8) * p_aob_group[1].i_channels )
424 );
425 }
426 else
427 {
428 i_frame_length = (p_block->i_buffer - p_sys->i_header_size - i_padding) /
429 (i_channels + i_channels_padding) * 8 / i_bits;
430 }
431
432 if( p_sys->b_packetizer )
433 {
434 p_block->i_pts = p_block->i_dts = date_Get( &p_sys->end_date );
435 p_block->i_length =
436 date_Increment( &p_sys->end_date, i_frame_length ) -
437 p_block->i_pts;
438
439 /* Just pass on the incoming frame */
440 return p_block;
441 }
442 else
443 {
444 /* */
445 if( i_bits == 16 )
446 {
447 p_dec->fmt_out.i_codec = VLC_CODEC_S16N;
448 p_dec->fmt_out.audio.i_bitspersample = 16;
449 }
450 else
451 {
452 p_dec->fmt_out.i_codec = VLC_CODEC_S32N;
453 p_dec->fmt_out.audio.i_bitspersample = 32;
454 }
455
456 /* */
457 block_t *p_aout_buffer;
458 if( decoder_UpdateAudioFormat( p_dec ) )
459 return NULL;
460 p_aout_buffer = decoder_NewAudioBuffer( p_dec, i_frame_length );
461 if( !p_aout_buffer )
462 return NULL;
463
464 p_aout_buffer->i_pts = date_Get( &p_sys->end_date );
465 p_aout_buffer->i_length =
466 date_Increment( &p_sys->end_date, i_frame_length )
467 - p_aout_buffer->i_pts;
468
469 p_block->p_buffer += p_sys->i_header_size + i_padding;
470 p_block->i_buffer -= p_sys->i_header_size + i_padding;
471
472 const unsigned block_nb_frames = p_block->i_buffer / ( i_bits * 4 / 8 );
473 const unsigned aout_nb_frames = p_aout_buffer->i_nb_samples
474 / ( p_dec->fmt_out.audio.i_bitspersample / 8 );
475
476 if( block_nb_frames > aout_nb_frames )
477 {
478 msg_Warn( p_dec, "invalid block size" );
479
480 block_Release( p_block );
481 block_Release( p_aout_buffer );
482
483 return NULL;
484 }
485
486 switch( p_sys->i_type )
487 {
488 case LPCM_WIDI:
489 case LPCM_VOB:
490 VobExtract( p_aout_buffer, p_block, i_bits );
491 break;
492 case LPCM_AOB:
493 AobExtract( p_aout_buffer, p_block, i_bits, p_aob_group );
494 break;
495 default:
496 vlc_assert_unreachable();
497 case LPCM_BD:
498 BdExtract( p_aout_buffer, p_block, i_frame_length, i_channels, i_channels_padding, i_bits );
499 break;
500 }
501
502 if( p_sys->i_chans_to_reorder )
503 {
504 aout_ChannelReorder( p_aout_buffer->p_buffer, p_aout_buffer->i_buffer,
505 p_sys->i_chans_to_reorder, p_sys->pi_chan_table,
506 p_dec->fmt_out.i_codec );
507 }
508
509 block_Release( p_block );
510 return p_aout_buffer;
511 }
512 }
513
514 /*****************************************************************************
515 * CloseCommon : lpcm decoder destruction
516 *****************************************************************************/
517 static void CloseCommon( vlc_object_t *p_this )
518 {
519 decoder_t *p_dec = (decoder_t*)p_this;
520 free( p_dec->p_sys );
521 }
522
523 #ifdef ENABLE_SOUT
524 /*****************************************************************************
525 * OpenEncoder: lpcm encoder construction
526 *****************************************************************************/
527 static int OpenEncoder( vlc_object_t *p_this )
528 {
529 encoder_t *p_enc = (encoder_t *)p_this;
530 encoder_sys_t *p_sys;
531
532 /* We only support DVD LPCM yet. */
533 if( p_enc->fmt_out.i_codec != VLC_CODEC_DVD_LPCM )
534 return VLC_EGENERIC;
535
536 if( p_enc->fmt_in.audio.i_rate != 48000 &&
537 p_enc->fmt_in.audio.i_rate != 96000 &&
538 p_enc->fmt_in.audio.i_rate != 44100 &&
539 p_enc->fmt_in.audio.i_rate != 32000 )
540 {
541 msg_Err( p_enc, "DVD LPCM supports only sample rates of 48, 96, 44.1 or 32 kHz" );
542 return VLC_EGENERIC;
543 }
544
545 if( p_enc->fmt_in.audio.i_channels > 8 )
546 {
547 msg_Err( p_enc, "DVD LPCM supports a maximum of eight channels" );
548 return VLC_EGENERIC;
549 }
550
551 /* Allocate the memory needed to store the encoder's structure */
552 if( ( p_enc->p_sys = p_sys =
553 (encoder_sys_t *)malloc(sizeof(encoder_sys_t)) ) == NULL )
554 return VLC_ENOMEM;
555
556 /* In DVD LCPM, a frame is always 150 PTS ticks. */
557 p_sys->i_frame_samples = p_enc->fmt_in.audio.i_rate * 150 / 90000;
558 p_sys->p_buffer = xmalloc(p_sys->i_frame_samples
559 * p_enc->fmt_in.audio.i_channels * 16);
560 p_sys->i_buffer_used = 0;
561 p_sys->i_frame_num = 0;
562
563 p_sys->i_channels = p_enc->fmt_in.audio.i_channels;
564 p_sys->i_rate = p_enc->fmt_in.audio.i_rate;
565
566 p_enc->pf_encode_audio = EncodeFrames;
567 p_enc->fmt_in.i_codec = p_enc->fmt_out.i_codec;
568
569 p_enc->fmt_in.audio.i_bitspersample = 16;
570 p_enc->fmt_in.i_codec = VLC_CODEC_S16N;
571
572 p_enc->fmt_out.i_bitrate =
573 p_enc->fmt_in.audio.i_channels *
574 p_enc->fmt_in.audio.i_rate *
575 p_enc->fmt_in.audio.i_bitspersample *
576 (p_sys->i_frame_samples + LPCM_VOB_HEADER_LEN) /
577 p_sys->i_frame_samples;
578
579 return VLC_SUCCESS;
580 }
581
582 /*****************************************************************************
583 * CloseEncoder: lpcm encoder destruction
584 *****************************************************************************/
585 static void CloseEncoder ( vlc_object_t *p_this )
586 {
587 encoder_t *p_enc = (encoder_t *)p_this;
588 encoder_sys_t *p_sys = p_enc->p_sys;
589
590 free( p_sys->p_buffer );
591 free( p_sys );
592 }
593
594 /*****************************************************************************
595 * EncodeFrames: encode zero or more LCPM audio packets
596 *****************************************************************************/
597 static block_t *EncodeFrames( encoder_t *p_enc, block_t *p_aout_buf )
598 {
599 encoder_sys_t *p_sys = p_enc->p_sys;
600 block_t *p_first_block = NULL, *p_last_block = NULL;
601
602 if( !p_aout_buf || !p_aout_buf->i_buffer ) return NULL;
603
604 const int i_num_frames = ( p_sys->i_buffer_used + p_aout_buf->i_nb_samples ) /
605 p_sys->i_frame_samples;
606 const int i_leftover_samples = ( p_sys->i_buffer_used + p_aout_buf->i_nb_samples ) %
607 p_sys->i_frame_samples;
608 const int i_frame_size = p_sys->i_frame_samples * p_sys->i_channels * 2 + LPCM_VOB_HEADER_LEN;
609 const int i_start_offset = -p_sys->i_buffer_used;
610
611 uint8_t i_freq_code = 0;
612
613 switch( p_sys->i_rate ) {
614 case 48000:
615 i_freq_code = 0;
616 break;
617 case 96000:
618 i_freq_code = 1;
619 break;
620 case 44100:
621 i_freq_code = 2;
622 break;
623 case 32000:
624 i_freq_code = 3;
625 break;
626 default:
627 vlc_assert_unreachable();
628 }
629
630 int i_bytes_consumed = 0;
631
632 for ( int i = 0; i < i_num_frames; ++i )
633 {
634 block_t *p_block = block_Alloc( i_frame_size );
635 if( !p_block )
636 return NULL;
637
638 uint8_t *frame = (uint8_t *)p_block->p_buffer;
639 frame[0] = 1; /* one frame in packet */
640 frame[1] = 0;
641 frame[2] = 0; /* no first access unit */
642 frame[3] = (p_sys->i_frame_num + i) & 0x1f; /* no emphasis, no mute */
643 frame[4] = (i_freq_code << 4) | (p_sys->i_channels - 1);
644 frame[5] = 0x80; /* neutral dynamic range */
645
646 const int i_consume_samples = p_sys->i_frame_samples - p_sys->i_buffer_used;
647 const int i_kept_bytes = p_sys->i_buffer_used * p_sys->i_channels * 2;
648 const int i_consume_bytes = i_consume_samples * p_sys->i_channels * 2;
649
650 #ifdef WORDS_BIGENDIAN
651 memcpy( frame + 6, p_sys->p_buffer, i_kept_bytes );
652 memcpy( frame + 6 + i_kept_bytes, p_aout_buf->p_buffer + i_bytes_consumed,
653 i_consume_bytes );
654 #else
655 swab( p_sys->p_buffer, frame + 6, i_kept_bytes );
656 swab( p_aout_buf->p_buffer + i_bytes_consumed, frame + 6 + i_kept_bytes,
657 i_consume_bytes );
658 #endif
659
660 p_sys->i_frame_num++;
661 p_sys->i_buffer_used = 0;
662 i_bytes_consumed += i_consume_bytes;
663
664 /* We need to find i_length by means of next_pts due to possible roundoff errors. */
665 mtime_t this_pts = p_aout_buf->i_pts +
666 (i * p_sys->i_frame_samples + i_start_offset) * CLOCK_FREQ / p_sys->i_rate;
667 mtime_t next_pts = p_aout_buf->i_pts +
668 ((i + 1) * p_sys->i_frame_samples + i_start_offset) * CLOCK_FREQ / p_sys->i_rate;
669
670 p_block->i_pts = p_block->i_dts = this_pts;
671 p_block->i_length = next_pts - this_pts;
672
673 if( !p_first_block )
674 p_first_block = p_last_block = p_block;
675 else
676 p_last_block = p_last_block->p_next = p_block;
677 }
678
679 memcpy( p_sys->p_buffer,
680 p_aout_buf->p_buffer + i_bytes_consumed,
681 i_leftover_samples * p_sys->i_channels * 2 );
682 p_sys->i_buffer_used = i_leftover_samples;
683
684 return p_first_block;
685 }
686 #endif
687
688 /*****************************************************************************
689 *
690 *****************************************************************************/
691 static int VobHeader( unsigned *pi_rate,
692 unsigned *pi_channels, unsigned *pi_original_channels,
693 unsigned *pi_bits,
694 const uint8_t *p_header )
695 {
696 const uint8_t i_header = p_header[4];
697
698 switch( (i_header >> 4) & 0x3 )
699 {
700 case 0:
701 *pi_rate = 48000;
702 break;
703 case 1:
704 *pi_rate = 96000;
705 break;
706 case 2:
707 *pi_rate = 44100;
708 break;
709 case 3:
710 *pi_rate = 32000;
711 break;
712 }
713
714 *pi_channels = (i_header & 0x7) + 1;
715 switch( *pi_channels - 1 )
716 {
717 case 0:
718 *pi_original_channels = AOUT_CHAN_CENTER;
719 break;
720 case 1:
721 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT;
722 break;
723 case 2:
724 /* This is unsure. */
725 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_LFE;
726 break;
727 case 3:
728 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT
729 | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT;
730 break;
731 case 4:
732 /* This is unsure. */
733 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT
734 | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT
735 | AOUT_CHAN_LFE;
736 break;
737 case 5:
738 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT
739 | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT
740 | AOUT_CHAN_CENTER | AOUT_CHAN_LFE;
741 break;
742 case 6:
743 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT
744 | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT
745 | AOUT_CHAN_CENTER | AOUT_CHAN_MIDDLELEFT
746 | AOUT_CHAN_MIDDLERIGHT;
747 break;
748 case 7:
749 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT
750 | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT
751 | AOUT_CHAN_CENTER | AOUT_CHAN_MIDDLELEFT
752 | AOUT_CHAN_MIDDLERIGHT | AOUT_CHAN_LFE;
753 break;
754 }
755
756 switch( (i_header >> 6) & 0x3 )
757 {
758 case 2:
759 *pi_bits = 24;
760 break;
761 case 1:
762 *pi_bits = 20;
763 break;
764 case 0:
765 default:
766 *pi_bits = 16;
767 break;
768 }
769
770 /* Check frame sync and drop it. */
771 if( p_header[5] != 0x80 )
772 return -1;
773 return 0;
774 }
775
776 static const unsigned p_aob_group1[21][6] = {
777 { AOUT_CHAN_CENTER, 0 },
778 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
779 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
780 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
781 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
782 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
783 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
784 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
785 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
786 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
787 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
788 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
789 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
790 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER, 0 },
791 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER, 0 },
792 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER, 0 },
793 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER, 0 },
794 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER, 0 },
795 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0 },
796 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0 },
797 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0 },
798 };
799 static const unsigned p_aob_group2[21][6] = {
800 { 0 },
801 { 0 },
802 { AOUT_CHAN_REARCENTER, 0 },
803 { AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0 },
804 { AOUT_CHAN_LFE, 0 },
805 { AOUT_CHAN_LFE, AOUT_CHAN_REARCENTER, 0 },
806 { AOUT_CHAN_LFE, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0 },
807 { AOUT_CHAN_CENTER, 0 },
808 { AOUT_CHAN_CENTER, AOUT_CHAN_REARCENTER, 0 },
809 { AOUT_CHAN_CENTER, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0 },
810 { AOUT_CHAN_CENTER, AOUT_CHAN_LFE, 0 },
811 { AOUT_CHAN_CENTER, AOUT_CHAN_LFE, AOUT_CHAN_REARCENTER, 0 },
812 { AOUT_CHAN_CENTER, AOUT_CHAN_LFE, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0 },
813 { AOUT_CHAN_REARCENTER, 0 },
814 { AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0 },
815 { AOUT_CHAN_LFE, 0 },
816 { AOUT_CHAN_LFE, AOUT_CHAN_REARCENTER, 0 },
817 { AOUT_CHAN_LFE, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0 },
818 { AOUT_CHAN_LFE, 0 },
819 { AOUT_CHAN_CENTER, 0 },
820 { AOUT_CHAN_CENTER, AOUT_CHAN_LFE, 0 },
821 };
822
823 static int AobHeader( unsigned *pi_rate,
824 unsigned *pi_channels, unsigned *pi_layout,
825 unsigned *pi_bits,
826 unsigned *pi_padding,
827 aob_group_t g[2],
828 const uint8_t *p_header )
829 {
830 const unsigned i_header_size = GetWBE( &p_header[1] );
831 if( i_header_size + 3 < LPCM_AOB_HEADER_LEN )
832 return VLC_EGENERIC;
833
834 /* Padding = Total header size - Normal AOB header
835 * + 3 bytes (1 for continuity counter + 2 for header_size ) */
836 *pi_padding = 3 + i_header_size - LPCM_AOB_HEADER_LEN;
837
838 const int i_index_size_g1 = (p_header[6] >> 4) & 0x0f;
839 const int i_index_size_g2 = (p_header[6] ) & 0x0f;
840 const int i_index_rate_g1 = (p_header[7] >> 4) & 0x0f;
841 const int i_index_rate_g2 = (p_header[7] ) & 0x0f;
842 const int i_assignment = p_header[9];
843
844 /* Validate */
845 if( i_index_size_g1 > 0x02 ||
846 ( i_index_size_g2 != 0x0f && i_index_size_g2 > 0x02 ) )
847 return VLC_EGENERIC;
848 if( (i_index_rate_g1 & 0x07) > 0x02 ||
849 ( i_index_rate_g2 != 0x0f && (i_index_rate_g1 & 0x07) > 0x02 ) )
850 return VLC_EGENERIC;
851 if( i_assignment > 20 )
852 return VLC_EGENERIC;
853
854 /* */
855 /* max is 0x2, 0xf == unused */
856 g[0].i_bits = 16 + 4 * i_index_size_g1;
857 g[1].i_bits = ( i_index_size_g2 != 0x0f ) ? 16 + 4 * i_index_size_g2 : 0;
858
859 /* No info about interlacing of different sampling rate */
860 if ( g[1].i_bits && ( i_index_rate_g1 != i_index_rate_g2 ) )
861 return VLC_EGENERIC;
862
863 /* only set 16bits if both are <= */
864 if( g[0].i_bits )
865 {
866 if( g[0].i_bits > 16 || g[1].i_bits > 16 )
867 *pi_bits = 32;
868 else
869 *pi_bits = 16;
870 }
871 else
872 return VLC_EGENERIC;
873
874 if( i_index_rate_g1 & 0x08 )
875 *pi_rate = 44100 << (i_index_rate_g1 & 0x07);
876 else
877 *pi_rate = 48000 << (i_index_rate_g1 & 0x07);
878
879
880 /* Group1 */
881 unsigned i_channels1 = 0;
882 unsigned i_layout1 = 0;
883 for( int i = 0; p_aob_group1[i_assignment][i] != 0; i++ )
884 {
885 i_channels1++;
886 i_layout1 |= p_aob_group1[i_assignment][i];
887 }
888 /* Group2 */
889 unsigned i_channels2 = 0;
890 unsigned i_layout2 = 0;
891 if( i_index_size_g2 != 0x0f && i_index_rate_g2 != 0x0f )
892 {
893 for( int i = 0; p_aob_group2[i_assignment][i] != 0; i++ )
894 {
895 i_channels2++;
896 i_layout2 |= p_aob_group2[i_assignment][i];
897 }
898 assert( (i_layout1 & i_layout2) == 0 );
899 }
900
901 /* */
902 *pi_channels = i_channels1 + ( g[1].i_bits ? i_channels2 : 0 );
903 *pi_layout = i_layout1 | ( g[1].i_bits ? i_layout2 : 0 );
904
905 /* */
906 for( unsigned i = 0; i < 2; i++ )
907 {
908 const unsigned *p_aob = i == 0 ? p_aob_group1[i_assignment] :
909 p_aob_group2[i_assignment];
910 g[i].i_channels = i == 0 ? i_channels1 :
911 i_channels2;
912
913 if( !g[i].i_bits )
914 continue;
915 for( unsigned j = 0; j < g[i].i_channels; j++ )
916 {
917 g[i].pi_position[j] = 0;
918 for( int k = 0; pi_vlc_chan_order_wg4[k] != 0; k++ )
919 {
920 const unsigned i_channel = pi_vlc_chan_order_wg4[k];
921 if( i_channel == p_aob[j] )
922 break;
923 if( (*pi_layout) & i_channel )
924 g[i].pi_position[j]++;
925 }
926 }
927 }
928 return VLC_SUCCESS;
929 }
930
931 static const uint32_t pi_8channels_in[] =
932 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER,
933 AOUT_CHAN_MIDDLELEFT, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT,
934 AOUT_CHAN_MIDDLERIGHT, AOUT_CHAN_LFE, 0 };
935
936 static const uint32_t pi_7channels_in[] =
937 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER,
938 AOUT_CHAN_MIDDLELEFT, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT,
939 AOUT_CHAN_MIDDLERIGHT, 0 };
940
941 static const uint32_t pi_6channels_in[] =
942 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER,
943 AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, AOUT_CHAN_LFE, 0 };
944
945 static const uint32_t pi_5channels_in[] =
946 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER,
947 AOUT_CHAN_MIDDLELEFT, AOUT_CHAN_MIDDLERIGHT, 0 };
948
949 static const uint32_t pi_4channels_in[] =
950 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT,
951 AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0 };
952
953 static const uint32_t pi_3channels_in[] =
954 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT,
955 AOUT_CHAN_CENTER, 0 };
956
957
958 static int BdHeader( decoder_sys_t *p_sys,
959 unsigned *pi_rate,
960 unsigned *pi_channels,
961 unsigned *pi_channels_padding,
962 unsigned *pi_original_channels,
963 unsigned *pi_bits,
964 const uint8_t *p_header )
965 {
966 const uint32_t h = GetDWBE( p_header );
967 const uint32_t *pi_channels_in = NULL;
968 switch( ( h & 0xf000) >> 12 )
969 {
970 case 1:
971 *pi_channels = 1;
972 *pi_original_channels = AOUT_CHAN_CENTER;
973 break;
974 case 3:
975 *pi_channels = 2;
976 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT;
977 break;
978 case 4:
979 *pi_channels = 3;
980 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER;
981 pi_channels_in = pi_3channels_in;
982 break;
983 case 5:
984 *pi_channels = 3;
985 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_REARCENTER;
986 break;
987 case 6:
988 *pi_channels = 4;
989 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER |
990 AOUT_CHAN_REARCENTER;
991 break;
992 case 7:
993 *pi_channels = 4;
994 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT |
995 AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT;
996 pi_channels_in = pi_4channels_in;
997 break;
998 case 8:
999 *pi_channels = 5;
1000 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER |
1001 AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT;
1002 pi_channels_in = pi_5channels_in;
1003 break;
1004 case 9:
1005 *pi_channels = 6;
1006 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER |
1007 AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT |
1008 AOUT_CHAN_LFE;
1009 pi_channels_in = pi_6channels_in;
1010 break;
1011 case 10:
1012 *pi_channels = 7;
1013 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER |
1014 AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT |
1015 AOUT_CHAN_MIDDLELEFT | AOUT_CHAN_MIDDLERIGHT;
1016 pi_channels_in = pi_7channels_in;
1017 break;
1018 case 11:
1019 *pi_channels = 8;
1020 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER |
1021 AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT |
1022 AOUT_CHAN_MIDDLELEFT | AOUT_CHAN_MIDDLERIGHT |
1023 AOUT_CHAN_LFE;
1024 pi_channels_in = pi_8channels_in;
1025 break;
1026
1027 default:
1028 return -1;
1029 }
1030 *pi_channels_padding = *pi_channels & 1;
1031
1032 switch( (h >> 6) & 0x03 )
1033 {
1034 case 1:
1035 *pi_bits = 16;
1036 break;
1037 case 2: /* 20 bits but samples are stored on 24 bits */
1038 case 3: /* 24 bits */
1039 *pi_bits = 24;
1040 break;
1041 default:
1042 return -1;
1043 }
1044 switch( (h >> 8) & 0x0f )
1045 {
1046 case 1:
1047 *pi_rate = 48000;
1048 break;
1049 case 4:
1050 *pi_rate = 96000;
1051 break;
1052 case 5:
1053 *pi_rate = 192000;
1054 break;
1055 default:
1056 return -1;
1057 }
1058
1059 if( pi_channels_in )
1060 {
1061 p_sys->i_chans_to_reorder =
1062 aout_CheckChannelReorder( pi_channels_in, NULL,
1063 *pi_original_channels,
1064 p_sys->pi_chan_table );
1065 }
1066
1067 return 0;
1068 }
1069
1070 static int WidiHeader( unsigned *pi_rate,
1071 unsigned *pi_channels, unsigned *pi_original_channels,
1072 unsigned *pi_bits,
1073 const uint8_t *p_header )
1074 {
1075 if ( p_header[0] != 0xa0 || p_header[1] != 0x06 )
1076 return -1;
1077
1078 switch( ( p_header[3] & 0x38 ) >> 3 )
1079 {
1080 case 0x01: //0b001
1081 *pi_rate = 44100;
1082 break;
1083 case 0x02: //0b010
1084 *pi_rate = 48000;
1085 break;
1086 default:
1087 return -1;
1088 }
1089
1090 if( p_header[3] >> 6 != 0 )
1091 return -1;
1092 else
1093 *pi_bits = 16;
1094
1095 *pi_channels = (p_header[3] & 0x7) + 1;
1096
1097 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT;
1098
1099 return 0;
1100 }
1101
1102 static void VobExtract( block_t *p_aout_buffer, block_t *p_block,
1103 unsigned i_bits )
1104 {
1105 /* 20/24 bits LPCM use special packing */
1106 if( i_bits == 24 )
1107 {
1108 uint32_t *p_out = (uint32_t *)p_aout_buffer->p_buffer;
1109
1110 while( p_block->i_buffer / 12 )
1111 {
1112 /* Sample 1 */
1113 *(p_out++) = (p_block->p_buffer[ 0] << 24)
1114 | (p_block->p_buffer[ 1] << 16)
1115 | (p_block->p_buffer[ 8] << 8);
1116 /* Sample 2 */
1117 *(p_out++) = (p_block->p_buffer[ 2] << 24)
1118 | (p_block->p_buffer[ 3] << 16)
1119 | (p_block->p_buffer[ 9] << 8);
1120 /* Sample 3 */
1121 *(p_out++) = (p_block->p_buffer[ 4] << 24)
1122 | (p_block->p_buffer[ 5] << 16)
1123 | (p_block->p_buffer[10] << 8);
1124 /* Sample 4 */
1125 *(p_out++) = (p_block->p_buffer[ 6] << 24)
1126 | (p_block->p_buffer[ 7] << 16)
1127 | (p_block->p_buffer[11] << 8);
1128
1129 p_block->i_buffer -= 12;
1130 p_block->p_buffer += 12;
1131 }
1132 }
1133 else if( i_bits == 20 )
1134 {
1135 uint32_t *p_out = (uint32_t *)p_aout_buffer->p_buffer;
1136
1137 while( p_block->i_buffer / 10 )
1138 {
1139 /* Sample 1 */
1140 *(p_out++) = ( p_block->p_buffer[0] << 24)
1141 | ( p_block->p_buffer[1] << 16)
1142 | ((p_block->p_buffer[8] & 0xF0) << 8);
1143 /* Sample 2 */
1144 *(p_out++) = ( p_block->p_buffer[2] << 24)
1145 | ( p_block->p_buffer[3] << 16)
1146 | ((p_block->p_buffer[8] & 0x0F) << 12);
1147 /* Sample 3 */
1148 *(p_out++) = ( p_block->p_buffer[4] << 24)
1149 | ( p_block->p_buffer[5] << 16)
1150 | ((p_block->p_buffer[9] & 0xF0) << 8);
1151 /* Sample 4 */
1152 *(p_out++) = ( p_block->p_buffer[6] << 24)
1153 | ( p_block->p_buffer[7] << 16)
1154 | ((p_block->p_buffer[9] & 0x0F) << 12);
1155
1156 p_block->i_buffer -= 10;
1157 p_block->p_buffer += 10;
1158 }
1159 }
1160 else
1161 {
1162 assert( i_bits == 16 );
1163 #ifdef WORDS_BIGENDIAN
1164 memcpy( p_aout_buffer->p_buffer, p_block->p_buffer, p_block->i_buffer );
1165 #else
1166 swab( p_block->p_buffer, p_aout_buffer->p_buffer, p_block->i_buffer );
1167 #endif
1168 }
1169 }
1170
1171 static void AobExtract( block_t *p_aout_buffer,
1172 block_t *p_block, unsigned i_aoutbits, aob_group_t p_group[2] )
1173 {
1174 uint8_t *p_out = p_aout_buffer->p_buffer;
1175 const unsigned i_total_channels = p_group[0].i_channels +
1176 ( p_group[1].i_bits ? p_group[1].i_channels : 0 );
1177
1178 while( p_block->i_buffer > 0 )
1179 {
1180 unsigned int i_aout_written = 0;
1181
1182 for( int i = 0; i < 2; i++ )
1183 {
1184 const aob_group_t *g = &p_group[1-i];
1185 const unsigned int i_group_size = 2 * g->i_channels * g->i_bits / 8;
1186
1187 if( p_block->i_buffer < i_group_size )
1188 {
1189 p_block->i_buffer = 0;
1190 break;
1191 }
1192
1193 if( !g->i_bits )
1194 continue;
1195
1196 for( unsigned n = 0; n < 2; n++ )
1197 {
1198 for( unsigned j = 0; j < g->i_channels; j++ )
1199 {
1200 const int i_src = n * g->i_channels + j;
1201 const int i_dst = n * i_total_channels + g->pi_position[j];
1202 uint32_t *p_out32 = (uint32_t *) &p_out[4*i_dst];
1203
1204 if( g->i_bits == 24 )
1205 {
1206 assert( i_aoutbits == 32 );
1207 *p_out32 = (p_block->p_buffer[2*i_src+0] << 24)
1208 | (p_block->p_buffer[2*i_src+1] << 16)
1209 | (p_block->p_buffer[4*g->i_channels+i_src] << 8);
1210 #ifdef WORDS_BIGENDIAN
1211 *p_out32 = bswap32(*p_out32);
1212 #endif
1213 i_aout_written += 4;
1214 }
1215 else if( g->i_bits == 20 )
1216 {
1217 assert( i_aoutbits == 32 );
1218 *p_out32 = (p_block->p_buffer[2*i_src+0] << 24)
1219 | (p_block->p_buffer[2*i_src+1] << 16)
1220 | (((p_block->p_buffer[4*g->i_channels+i_src] << ((!n)?0:4) ) & 0xf0) << 8);
1221 #ifdef WORDS_BIGENDIAN
1222 *p_out32 = bswap32(*p_out32);
1223 #endif
1224 i_aout_written += 4;
1225 }
1226 else
1227 {
1228 assert( g->i_bits == 16 );
1229 assert( i_aoutbits == 16 || i_aoutbits == 32 );
1230 if( i_aoutbits == 16 )
1231 {
1232 #ifdef WORDS_BIGENDIAN
1233 memcpy( &p_out[2*i_dst], &p_block->p_buffer[2*i_src], 2 );
1234 #else
1235 p_out[2*i_dst+1] = p_block->p_buffer[2*i_src+0];
1236 p_out[2*i_dst+0] = p_block->p_buffer[2*i_src+1];
1237 #endif
1238 i_aout_written += 2;
1239 }
1240 else
1241 {
1242 *p_out32 = (p_block->p_buffer[2*i_src+0] << 24)
1243 | (p_block->p_buffer[2*i_src+1] << 16);
1244 #ifdef WORDS_BIGENDIAN
1245 *p_out32 = bswap32(*p_out32);
1246 #endif
1247 i_aout_written += 4;
1248 }
1249 }
1250 }
1251 }
1252
1253 /* */
1254 p_block->i_buffer -= i_group_size;
1255 p_block->p_buffer += i_group_size;
1256 }
1257 p_out += i_aout_written;
1258 }
1259 }
1260 static void BdExtract( block_t *p_aout_buffer, block_t *p_block,
1261 unsigned i_frame_length,
1262 unsigned i_channels, unsigned i_channels_padding,
1263 unsigned i_bits )
1264 {
1265 if( i_bits != 16 || i_channels_padding > 0 )
1266 {
1267 uint8_t *p_src = p_block->p_buffer;
1268 uint8_t *p_dst = p_aout_buffer->p_buffer;
1269 int dst_inc = ((i_bits == 16) ? 2 : 4) * i_channels;
1270
1271 while( i_frame_length > 0 )
1272 {
1273 #ifdef WORDS_BIGENDIAN
1274 memcpy( p_dst, p_src, i_channels * i_bits / 8 );
1275 #else
1276 if (i_bits == 16) {
1277 swab( p_src, p_dst, (i_channels + i_channels_padding) * i_bits / 8 );
1278 } else {
1279 for (unsigned i = 0; i < i_channels; ++i) {
1280 p_dst[i * 4] = 0;
1281 p_dst[1 + (i * 4)] = p_src[2 + (i * 3)];
1282 p_dst[2 + (i * 4)] = p_src[1 + (i * 3)];
1283 p_dst[3 + (i * 4)] = p_src[i * 3];
1284 }
1285 }
1286 #endif
1287 p_src += (i_channels + i_channels_padding) * i_bits / 8;
1288 p_dst += dst_inc;
1289 i_frame_length--;
1290 }
1291 }
1292 else
1293 {
1294 #ifdef WORDS_BIGENDIAN
1295 memcpy( p_aout_buffer->p_buffer, p_block->p_buffer, p_block->i_buffer );
1296 #else
1297 swab( p_block->p_buffer, p_aout_buffer->p_buffer, p_block->i_buffer );
1298 #endif
1299 }
1300 }
1301
VLC Development tree mirror