1 /*****************************************************************************
2 * lpcm.c: lpcm decoder/packetizer module
3 *****************************************************************************
4 * Copyright (C) 1999-2008 VLC authors and VideoLAN
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>
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.
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.
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 *****************************************************************************/
29 /*****************************************************************************
31 *****************************************************************************/
36 #include <vlc_common.h>
37 #include <vlc_plugin.h>
38 #include <vlc_codec.h>
43 /*****************************************************************************
45 *****************************************************************************/
46 static int OpenDecoder ( vlc_object_t * );
47 static int OpenPacketizer( vlc_object_t * );
48 static void CloseCommon ( vlc_object_t * );
51 static int OpenEncoder ( vlc_object_t * );
52 static void CloseEncoder ( vlc_object_t * );
53 static block_t *EncodeFrames( encoder_t *, block_t * );
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 )
65 set_description( N_("Linear PCM audio packetizer") )
66 set_capability( "packetizer", 100 )
67 set_callbacks( OpenPacketizer, CloseCommon )
71 set_description( N_("Linear PCM audio encoder") )
72 set_capability( "encoder", 100 )
73 set_callbacks( OpenEncoder, CloseEncoder )
74 add_shortcut( "lpcm" )
80 /*****************************************************************************
81 * decoder_sys_t : lpcm decoder descriptor
82 *****************************************************************************/
94 unsigned i_header_size;
96 uint8_t i_chans_to_reorder;
97 uint8_t pi_chan_table[AOUT_CHAN_MAX];
115 * - number of frames in this packet (8 bits)
116 * - first access unit (16 bits) == 0x0003 ?
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
124 * - number of channels - 1 (3 bits) 1 == 2 channels
125 * - dynamic range (8 bits) 0x80 == neutral
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)
135 * - group assignment (8 bits)
137 * - padding(variable)
140 * - unknown (16 bits)
141 * - number of channels (4 bits)
142 * - frequency (4 bits)
143 * - bits per sample (2 bits)
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)
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)
175 unsigned pi_position[6];
178 /*****************************************************************************
180 *****************************************************************************/
181 static block_t *DecodeFrame ( decoder_t *, block_t ** );
184 static int VobHeader( unsigned *pi_rate,
185 unsigned *pi_channels, unsigned *pi_original_channels,
187 const uint8_t *p_header );
188 static void VobExtract( block_t *, block_t *, unsigned i_bits );
190 static int AobHeader( unsigned *pi_rate,
191 unsigned *pi_channels, unsigned *pi_layout,
193 unsigned *pi_padding,
195 const uint8_t *p_header );
196 static void AobExtract( block_t *, block_t *, unsigned i_bits, aob_group_t p_group[2] );
198 static int BdHeader( decoder_sys_t *p_sys,
200 unsigned *pi_channels,
201 unsigned *pi_channels_padding,
202 unsigned *pi_original_channels,
204 const uint8_t *p_header );
205 static void BdExtract( block_t *, block_t *, unsigned, unsigned, unsigned, unsigned );
207 static int WidiHeader( unsigned *pi_rate,
208 unsigned *pi_channels, unsigned *pi_original_channels,
210 const uint8_t *p_header );
212 /*****************************************************************************
214 *****************************************************************************/
215 static int OpenCommon( vlc_object_t *p_this, bool b_packetizer )
217 decoder_t *p_dec = (decoder_t*)p_this;
218 decoder_sys_t *p_sys;
222 switch( p_dec->fmt_in.i_codec )
225 case VLC_CODEC_DVD_LPCM:
227 i_header_size = LPCM_VOB_HEADER_LEN;
230 case VLC_CODEC_DVDA_LPCM:
232 i_header_size = LPCM_AOB_HEADER_LEN;
235 case VLC_CODEC_BD_LPCM:
237 i_header_size = LPCM_BD_HEADER_LEN;
240 case VLC_CODEC_WIDI_LPCM:
242 i_header_size = LPCM_WIDI_HEADER_LEN;
248 /* Allocate the memory needed to store the decoder's structure */
249 if( ( p_dec->p_sys = p_sys = malloc(sizeof(decoder_sys_t)) ) == NULL )
253 p_sys->b_packetizer = b_packetizer;
254 date_Set( &p_sys->end_date, 0 );
255 p_sys->i_type = i_type;
256 p_sys->i_header_size = i_header_size;
257 p_sys->i_chans_to_reorder = 0;
259 /* Set output properties */
260 p_dec->fmt_out.i_cat = AUDIO_ES;
267 p_dec->fmt_out.i_codec = VLC_CODEC_DVD_LPCM;
270 p_dec->fmt_out.i_codec = VLC_CODEC_DVDA_LPCM;
273 p_dec->fmt_out.i_codec = VLC_CODEC_WIDI_LPCM;
276 vlc_assert_unreachable();
278 p_dec->fmt_out.i_codec = VLC_CODEC_BD_LPCM;
284 switch( p_dec->fmt_out.audio.i_bitspersample )
288 p_dec->fmt_out.i_codec = VLC_CODEC_S32N;
289 p_dec->fmt_out.audio.i_bitspersample = 32;
292 p_dec->fmt_out.i_codec = VLC_CODEC_S16N;
293 p_dec->fmt_out.audio.i_bitspersample = 16;
299 p_dec->pf_decode_audio = DecodeFrame;
300 p_dec->pf_packetize = DecodeFrame;
304 static int OpenDecoder( vlc_object_t *p_this )
306 return OpenCommon( p_this, false );
308 static int OpenPacketizer( vlc_object_t *p_this )
310 return OpenCommon( p_this, true );
313 /*****************************************************************************
314 * DecodeFrame: decodes an lpcm frame.
315 ****************************************************************************
316 * Beware, this function must be fed with complete frames (PES packet).
317 *****************************************************************************/
318 static block_t *DecodeFrame( decoder_t *p_dec, block_t **pp_block )
320 decoder_sys_t *p_sys = p_dec->p_sys;
322 unsigned int i_rate = 0, i_original_channels = 0, i_channels = 0, i_bits = 0;
325 if( !pp_block || !*pp_block ) return NULL;
328 *pp_block = NULL; /* So the packet doesn't get re-sent */
330 /* Date management */
331 if( p_block->i_pts > VLC_TS_INVALID &&
332 p_block->i_pts != date_Get( &p_sys->end_date ) )
334 date_Set( &p_sys->end_date, p_block->i_pts );
337 if( !date_Get( &p_sys->end_date ) )
339 /* We've just started the stream, wait for the first PTS. */
340 block_Release( p_block );
344 if( p_block->i_buffer <= p_sys->i_header_size )
346 msg_Err(p_dec, "frame is too short");
347 block_Release( p_block );
352 unsigned i_channels_padding = 0;
353 unsigned i_padding = 0;
354 aob_group_t p_aob_group[2];
355 switch( p_sys->i_type )
358 i_ret = VobHeader( &i_rate, &i_channels, &i_original_channels, &i_bits,
362 i_ret = AobHeader( &i_rate, &i_channels, &i_original_channels, &i_bits, &i_padding,
367 i_ret = BdHeader( p_sys, &i_rate, &i_channels, &i_channels_padding, &i_original_channels, &i_bits,
371 i_ret = WidiHeader( &i_rate, &i_channels, &i_original_channels, &i_bits,
378 if( i_ret || p_block->i_buffer <= p_sys->i_header_size + i_padding )
380 msg_Warn( p_dec, "no frame sync or too small frame" );
381 block_Release( p_block );
385 /* Set output properties */
386 if( p_dec->fmt_out.audio.i_rate != i_rate )
388 date_Init( &p_sys->end_date, i_rate, 1 );
389 date_Set( &p_sys->end_date, p_block->i_pts );
391 p_dec->fmt_out.audio.i_rate = i_rate;
392 p_dec->fmt_out.audio.i_channels = i_channels;
393 p_dec->fmt_out.audio.i_original_channels = i_original_channels;
394 p_dec->fmt_out.audio.i_physical_channels = i_original_channels;
396 if ( p_sys->i_type == LPCM_AOB )
398 i_frame_length = (p_block->i_buffer - p_sys->i_header_size - i_padding) /
400 ( (p_aob_group[0].i_bits / 8) * p_aob_group[0].i_channels ) +
401 ( (p_aob_group[1].i_bits / 8) * p_aob_group[1].i_channels )
406 i_frame_length = (p_block->i_buffer - p_sys->i_header_size - i_padding) /
407 (i_channels + i_channels_padding) * 8 / i_bits;
410 if( p_sys->b_packetizer )
412 p_block->i_pts = p_block->i_dts = date_Get( &p_sys->end_date );
414 date_Increment( &p_sys->end_date, i_frame_length ) -
417 /* Just pass on the incoming frame */
425 p_dec->fmt_out.i_codec = VLC_CODEC_S16N;
426 p_dec->fmt_out.audio.i_bitspersample = 16;
430 p_dec->fmt_out.i_codec = VLC_CODEC_S32N;
431 p_dec->fmt_out.audio.i_bitspersample = 32;
435 block_t *p_aout_buffer;
436 p_aout_buffer = decoder_NewAudioBuffer( p_dec, i_frame_length );
440 p_aout_buffer->i_pts = date_Get( &p_sys->end_date );
441 p_aout_buffer->i_length =
442 date_Increment( &p_sys->end_date, i_frame_length )
443 - p_aout_buffer->i_pts;
445 p_block->p_buffer += p_sys->i_header_size + i_padding;
446 p_block->i_buffer -= p_sys->i_header_size + i_padding;
448 switch( p_sys->i_type )
452 VobExtract( p_aout_buffer, p_block, i_bits );
455 AobExtract( p_aout_buffer, p_block, i_bits, p_aob_group );
458 vlc_assert_unreachable();
460 BdExtract( p_aout_buffer, p_block, i_frame_length, i_channels, i_channels_padding, i_bits );
464 if( p_sys->i_chans_to_reorder )
466 aout_ChannelReorder( p_aout_buffer->p_buffer, p_aout_buffer->i_buffer,
467 p_sys->i_chans_to_reorder, p_sys->pi_chan_table,
468 p_dec->fmt_out.i_codec );
471 block_Release( p_block );
472 return p_aout_buffer;
476 /*****************************************************************************
477 * CloseCommon : lpcm decoder destruction
478 *****************************************************************************/
479 static void CloseCommon( vlc_object_t *p_this )
481 decoder_t *p_dec = (decoder_t*)p_this;
482 free( p_dec->p_sys );
486 /*****************************************************************************
487 * OpenEncoder: lpcm encoder construction
488 *****************************************************************************/
489 static int OpenEncoder( vlc_object_t *p_this )
491 encoder_t *p_enc = (encoder_t *)p_this;
492 encoder_sys_t *p_sys;
494 /* We only support DVD LPCM yet. */
495 if( p_enc->fmt_out.i_codec != VLC_CODEC_DVD_LPCM )
498 if( p_enc->fmt_in.audio.i_rate != 48000 &&
499 p_enc->fmt_in.audio.i_rate != 96000 &&
500 p_enc->fmt_in.audio.i_rate != 44100 &&
501 p_enc->fmt_in.audio.i_rate != 32000 )
503 msg_Err( p_enc, "DVD LPCM supports only sample rates of 48, 96, 44.1 or 32 kHz" );
507 if( p_enc->fmt_in.audio.i_channels > 8 )
509 msg_Err( p_enc, "DVD LPCM supports a maximum of eight channels" );
513 /* Allocate the memory needed to store the encoder's structure */
514 if( ( p_enc->p_sys = p_sys =
515 (encoder_sys_t *)malloc(sizeof(encoder_sys_t)) ) == NULL )
518 /* In DVD LCPM, a frame is always 150 PTS ticks. */
519 p_sys->i_frame_samples = p_enc->fmt_in.audio.i_rate * 150 / 90000;
520 p_sys->p_buffer = xmalloc(p_sys->i_frame_samples
521 * p_enc->fmt_in.audio.i_channels * 16);
522 p_sys->i_buffer_used = 0;
523 p_sys->i_frame_num = 0;
525 p_sys->i_channels = p_enc->fmt_in.audio.i_channels;
526 p_sys->i_rate = p_enc->fmt_in.audio.i_rate;
528 p_enc->pf_encode_audio = EncodeFrames;
529 p_enc->fmt_in.i_codec = p_enc->fmt_out.i_codec;
531 p_enc->fmt_in.audio.i_bitspersample = 16;
532 p_enc->fmt_in.i_codec = VLC_CODEC_S16N;
534 p_enc->fmt_out.i_bitrate =
535 p_enc->fmt_in.audio.i_channels *
536 p_enc->fmt_in.audio.i_rate *
537 p_enc->fmt_in.audio.i_bitspersample *
538 (p_sys->i_frame_samples + LPCM_VOB_HEADER_LEN) /
539 p_sys->i_frame_samples;
544 /*****************************************************************************
545 * CloseEncoder: lpcm encoder destruction
546 *****************************************************************************/
547 static void CloseEncoder ( vlc_object_t *p_this )
549 encoder_t *p_enc = (encoder_t *)p_this;
550 encoder_sys_t *p_sys = p_enc->p_sys;
552 free( p_sys->p_buffer );
556 /*****************************************************************************
557 * EncodeFrames: encode zero or more LCPM audio packets
558 *****************************************************************************/
559 static block_t *EncodeFrames( encoder_t *p_enc, block_t *p_aout_buf )
561 encoder_sys_t *p_sys = p_enc->p_sys;
562 block_t *p_first_block = NULL, *p_last_block = NULL;
564 if( !p_aout_buf || !p_aout_buf->i_buffer ) return NULL;
566 const int i_num_frames = ( p_sys->i_buffer_used + p_aout_buf->i_nb_samples ) /
567 p_sys->i_frame_samples;
568 const int i_leftover_samples = ( p_sys->i_buffer_used + p_aout_buf->i_nb_samples ) %
569 p_sys->i_frame_samples;
570 const int i_frame_size = p_sys->i_frame_samples * p_sys->i_channels * 2 + LPCM_VOB_HEADER_LEN;
571 const int i_start_offset = -p_sys->i_buffer_used;
573 uint8_t i_freq_code = 0;
575 switch( p_sys->i_rate ) {
589 vlc_assert_unreachable();
592 int i_bytes_consumed = 0;
594 for ( int i = 0; i < i_num_frames; ++i )
596 block_t *p_block = block_Alloc( i_frame_size );
600 uint8_t *frame = (uint8_t *)p_block->p_buffer;
601 frame[0] = 1; /* one frame in packet */
603 frame[2] = 0; /* no first access unit */
604 frame[3] = (p_sys->i_frame_num + i) & 0x1f; /* no emphasis, no mute */
605 frame[4] = (i_freq_code << 4) | (p_sys->i_channels - 1);
606 frame[5] = 0x80; /* neutral dynamic range */
608 const int i_consume_samples = p_sys->i_frame_samples - p_sys->i_buffer_used;
609 const int i_kept_bytes = p_sys->i_buffer_used * p_sys->i_channels * 2;
610 const int i_consume_bytes = i_consume_samples * p_sys->i_channels * 2;
612 #ifdef WORDS_BIGENDIAN
613 memcpy( frame + 6, p_sys->p_buffer, i_kept_bytes );
614 memcpy( frame + 6 + i_kept_bytes, p_aout_buf->p_buffer + i_bytes_consumed,
617 swab( p_sys->p_buffer, frame + 6, i_kept_bytes );
618 swab( p_aout_buf->p_buffer + i_bytes_consumed, frame + 6 + i_kept_bytes,
622 p_sys->i_frame_num++;
623 p_sys->i_buffer_used = 0;
624 i_bytes_consumed += i_consume_bytes;
626 /* We need to find i_length by means of next_pts due to possible roundoff errors. */
627 mtime_t this_pts = p_aout_buf->i_pts +
628 (i * p_sys->i_frame_samples + i_start_offset) * CLOCK_FREQ / p_sys->i_rate;
629 mtime_t next_pts = p_aout_buf->i_pts +
630 ((i + 1) * p_sys->i_frame_samples + i_start_offset) * CLOCK_FREQ / p_sys->i_rate;
632 p_block->i_pts = p_block->i_dts = this_pts;
633 p_block->i_length = next_pts - this_pts;
636 p_first_block = p_last_block = p_block;
638 p_last_block = p_last_block->p_next = p_block;
641 memcpy( p_sys->p_buffer,
642 p_aout_buf->p_buffer + i_bytes_consumed,
643 i_leftover_samples * p_sys->i_channels * 2 );
644 p_sys->i_buffer_used = i_leftover_samples;
646 return p_first_block;
650 /*****************************************************************************
652 *****************************************************************************/
653 static int VobHeader( unsigned *pi_rate,
654 unsigned *pi_channels, unsigned *pi_original_channels,
656 const uint8_t *p_header )
658 const uint8_t i_header = p_header[4];
660 switch( (i_header >> 4) & 0x3 )
676 *pi_channels = (i_header & 0x7) + 1;
677 switch( *pi_channels - 1 )
680 *pi_original_channels = AOUT_CHAN_CENTER;
683 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT;
686 /* This is unsure. */
687 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_LFE;
690 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT
691 | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT;
694 /* This is unsure. */
695 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT
696 | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT
700 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT
701 | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT
702 | AOUT_CHAN_CENTER | AOUT_CHAN_LFE;
705 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT
706 | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT
707 | AOUT_CHAN_CENTER | AOUT_CHAN_MIDDLELEFT
708 | AOUT_CHAN_MIDDLERIGHT;
711 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT
712 | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT
713 | AOUT_CHAN_CENTER | AOUT_CHAN_MIDDLELEFT
714 | AOUT_CHAN_MIDDLERIGHT | AOUT_CHAN_LFE;
718 switch( (i_header >> 6) & 0x3 )
732 /* Check frame sync and drop it. */
733 if( p_header[5] != 0x80 )
738 static const unsigned p_aob_group1[21][6] = {
739 { AOUT_CHAN_CENTER, 0 },
740 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
741 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
742 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
743 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
744 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
745 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
746 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
747 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
748 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
749 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
750 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
751 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, 0 },
752 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER, 0 },
753 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER, 0 },
754 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER, 0 },
755 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER, 0 },
756 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER, 0 },
757 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0 },
758 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0 },
759 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0 },
761 static const unsigned p_aob_group2[21][6] = {
764 { AOUT_CHAN_REARCENTER, 0 },
765 { AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0 },
766 { AOUT_CHAN_LFE, 0 },
767 { AOUT_CHAN_LFE, AOUT_CHAN_REARCENTER, 0 },
768 { AOUT_CHAN_LFE, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0 },
769 { AOUT_CHAN_CENTER, 0 },
770 { AOUT_CHAN_CENTER, AOUT_CHAN_REARCENTER, 0 },
771 { AOUT_CHAN_CENTER, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0 },
772 { AOUT_CHAN_CENTER, AOUT_CHAN_LFE, 0 },
773 { AOUT_CHAN_CENTER, AOUT_CHAN_LFE, AOUT_CHAN_REARCENTER, 0 },
774 { AOUT_CHAN_CENTER, AOUT_CHAN_LFE, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0 },
775 { AOUT_CHAN_REARCENTER, 0 },
776 { AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0 },
777 { AOUT_CHAN_LFE, 0 },
778 { AOUT_CHAN_LFE, AOUT_CHAN_REARCENTER, 0 },
779 { AOUT_CHAN_LFE, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0 },
780 { AOUT_CHAN_LFE, 0 },
781 { AOUT_CHAN_CENTER, 0 },
782 { AOUT_CHAN_CENTER, AOUT_CHAN_LFE, 0 },
785 static int AobHeader( unsigned *pi_rate,
786 unsigned *pi_channels, unsigned *pi_layout,
788 unsigned *pi_padding,
790 const uint8_t *p_header )
792 const unsigned i_header_size = GetWBE( &p_header[1] );
793 if( i_header_size + 3 < LPCM_AOB_HEADER_LEN )
796 *pi_padding = 3+i_header_size - LPCM_AOB_HEADER_LEN;
798 const int i_index_size_g1 = (p_header[6] >> 4) & 0x0f;
799 const int i_index_size_g2 = (p_header[6] ) & 0x0f;
800 const int i_index_rate_g1 = (p_header[7] >> 4) & 0x0f;
801 const int i_index_rate_g2 = (p_header[7] ) & 0x0f;
802 const int i_assignment = p_header[9];
805 if( i_index_size_g1 > 0x02 ||
806 ( i_index_size_g2 != 0x0f && i_index_size_g2 > 0x02 ) )
808 if( (i_index_rate_g1 & 0x07) > 0x02 ||
809 ( i_index_rate_g2 != 0x0f && (i_index_rate_g1 & 0x07) > 0x02 ) )
811 if( i_assignment > 20 )
815 /* max is 0x2, 0xf == unused */
816 g[0].i_bits = ( i_index_size_g1 != 0x0f ) ? 16 + 4 * i_index_size_g1 : 0;
817 g[1].i_bits = ( i_index_size_g2 != 0x0f ) ? 16 + 4 * i_index_size_g2 : 0;
819 /* No info about interlacing of different sampling rate */
820 if ( g[1].i_bits && ( i_index_rate_g1 != i_index_rate_g2 ) )
823 /* only set 16bits if both are <= */
826 if( g[0].i_bits > 16 || g[1].i_bits > 16 )
834 if( i_index_rate_g1 & 0x08 )
835 *pi_rate = 44100 << (i_index_rate_g1 & 0x07);
837 *pi_rate = 48000 << (i_index_rate_g1 & 0x07);
841 unsigned i_channels1 = 0;
842 unsigned i_layout1 = 0;
843 for( int i = 0; p_aob_group1[i_assignment][i] != 0; i++ )
846 i_layout1 |= p_aob_group1[i_assignment][i];
849 unsigned i_channels2 = 0;
850 unsigned i_layout2 = 0;
851 if( i_index_size_g2 != 0x0f && i_index_rate_g2 != 0x0f )
853 for( int i = 0; p_aob_group2[i_assignment][i] != 0; i++ )
856 i_layout2 |= p_aob_group2[i_assignment][i];
858 assert( (i_layout1 & i_layout2) == 0 );
862 *pi_channels = i_channels1 + ( g[1].i_bits ? i_channels2 : 0 );
863 *pi_layout = i_layout1 | ( g[1].i_bits ? i_layout2 : 0 );
866 for( unsigned i = 0; i < 2; i++ )
868 const unsigned *p_aob = i == 0 ? p_aob_group1[i_assignment] :
869 p_aob_group2[i_assignment];
870 g[i].i_channels = i == 0 ? i_channels1 :
875 for( unsigned j = 0; j < g[i].i_channels; j++ )
877 g[i].pi_position[j] = 0;
878 for( int k = 0; pi_vlc_chan_order_wg4[k] != 0; k++ )
880 const unsigned i_channel = pi_vlc_chan_order_wg4[k];
881 if( i_channel == p_aob[j] )
883 if( (*pi_layout) & i_channel )
884 g[i].pi_position[j]++;
891 static const uint32_t pi_8channels_in[] =
892 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER,
893 AOUT_CHAN_MIDDLELEFT, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT,
894 AOUT_CHAN_MIDDLERIGHT, AOUT_CHAN_LFE, 0 };
896 static const uint32_t pi_7channels_in[] =
897 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER,
898 AOUT_CHAN_MIDDLELEFT, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT,
899 AOUT_CHAN_MIDDLERIGHT, 0 };
901 static const uint32_t pi_6channels_in[] =
902 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER,
903 AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, AOUT_CHAN_LFE, 0 };
905 static const uint32_t pi_5channels_in[] =
906 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER,
907 AOUT_CHAN_MIDDLELEFT, AOUT_CHAN_MIDDLERIGHT, 0 };
909 static const uint32_t pi_4channels_in[] =
910 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT,
911 AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0 };
913 static const uint32_t pi_3channels_in[] =
914 { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT,
915 AOUT_CHAN_CENTER, 0 };
918 static int BdHeader( decoder_sys_t *p_sys,
920 unsigned *pi_channels,
921 unsigned *pi_channels_padding,
922 unsigned *pi_original_channels,
924 const uint8_t *p_header )
926 const uint32_t h = GetDWBE( p_header );
927 const uint32_t *pi_channels_in = NULL;
928 switch( ( h & 0xf000) >> 12 )
932 *pi_original_channels = AOUT_CHAN_CENTER;
936 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT;
940 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER;
941 pi_channels_in = pi_3channels_in;
945 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_REARCENTER;
949 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER |
950 AOUT_CHAN_REARCENTER;
954 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT |
955 AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT;
956 pi_channels_in = pi_4channels_in;
960 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER |
961 AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT;
962 pi_channels_in = pi_5channels_in;
966 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER |
967 AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT |
969 pi_channels_in = pi_6channels_in;
973 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER |
974 AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT |
975 AOUT_CHAN_MIDDLELEFT | AOUT_CHAN_MIDDLERIGHT;
976 pi_channels_in = pi_7channels_in;
980 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER |
981 AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT |
982 AOUT_CHAN_MIDDLELEFT | AOUT_CHAN_MIDDLERIGHT |
984 pi_channels_in = pi_8channels_in;
990 *pi_channels_padding = *pi_channels & 1;
992 switch( (h >> 6) & 0x03 )
997 case 2: /* 20 bits but samples are stored on 24 bits */
998 case 3: /* 24 bits */
1004 switch( (h >> 8) & 0x0f )
1019 if( pi_channels_in )
1021 p_sys->i_chans_to_reorder =
1022 aout_CheckChannelReorder( pi_channels_in, NULL,
1023 *pi_original_channels,
1024 p_sys->pi_chan_table );
1030 static int WidiHeader( unsigned *pi_rate,
1031 unsigned *pi_channels, unsigned *pi_original_channels,
1033 const uint8_t *p_header )
1035 if ( p_header[0] != 0xa0 || p_header[1] != 0x06 )
1038 switch( ( p_header[3] & 0x38 ) >> 3 )
1050 if( p_header[3] >> 6 != 0 )
1055 *pi_channels = (p_header[3] & 0x7) + 1;
1057 *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT;
1062 static void VobExtract( block_t *p_aout_buffer, block_t *p_block,
1065 /* 20/24 bits LPCM use special packing */
1068 uint32_t *p_out = (uint32_t *)p_aout_buffer->p_buffer;
1070 while( p_block->i_buffer / 12 )
1073 *(p_out++) = (p_block->p_buffer[ 0] << 24)
1074 | (p_block->p_buffer[ 1] << 16)
1075 | (p_block->p_buffer[ 8] << 8);
1077 *(p_out++) = (p_block->p_buffer[ 2] << 24)
1078 | (p_block->p_buffer[ 3] << 16)
1079 | (p_block->p_buffer[ 9] << 8);
1081 *(p_out++) = (p_block->p_buffer[ 4] << 24)
1082 | (p_block->p_buffer[ 5] << 16)
1083 | (p_block->p_buffer[10] << 8);
1085 *(p_out++) = (p_block->p_buffer[ 6] << 24)
1086 | (p_block->p_buffer[ 7] << 16)
1087 | (p_block->p_buffer[11] << 8);
1089 p_block->i_buffer -= 12;
1090 p_block->p_buffer += 12;
1093 else if( i_bits == 20 )
1095 uint32_t *p_out = (uint32_t *)p_aout_buffer->p_buffer;
1097 while( p_block->i_buffer / 10 )
1100 *(p_out++) = ( p_block->p_buffer[0] << 24)
1101 | ( p_block->p_buffer[1] << 16)
1102 | ((p_block->p_buffer[8] & 0xF0) << 8);
1104 *(p_out++) = ( p_block->p_buffer[2] << 24)
1105 | ( p_block->p_buffer[3] << 16)
1106 | ((p_block->p_buffer[8] & 0x0F) << 12);
1108 *(p_out++) = ( p_block->p_buffer[4] << 24)
1109 | ( p_block->p_buffer[5] << 16)
1110 | ((p_block->p_buffer[9] & 0xF0) << 8);
1112 *(p_out++) = ( p_block->p_buffer[6] << 24)
1113 | ( p_block->p_buffer[7] << 16)
1114 | ((p_block->p_buffer[9] & 0x0F) << 12);
1116 p_block->i_buffer -= 10;
1117 p_block->p_buffer += 10;
1122 assert( i_bits == 16 );
1123 #ifdef WORDS_BIGENDIAN
1124 memcpy( p_aout_buffer->p_buffer, p_block->p_buffer, p_block->i_buffer );
1126 swab( p_block->p_buffer, p_aout_buffer->p_buffer, p_block->i_buffer );
1131 static void AobExtract( block_t *p_aout_buffer,
1132 block_t *p_block, unsigned i_aoutbits, aob_group_t p_group[2] )
1134 uint8_t *p_out = p_aout_buffer->p_buffer;
1135 const unsigned i_total_channels = p_group[0].i_channels +
1136 ( p_group[1].i_bits ? p_group[1].i_channels : 0 );
1138 while( p_block->i_buffer > 0 )
1140 unsigned int i_aout_written = 0;
1142 for( int i = 0; i < 2; i++ )
1144 const aob_group_t *g = &p_group[1-i];
1145 const unsigned int i_group_size = 2 * g->i_channels * g->i_bits / 8;
1147 if( p_block->i_buffer < i_group_size )
1149 p_block->i_buffer = 0;
1156 for( unsigned n = 0; n < 2; n++ )
1158 for( unsigned j = 0; j < g->i_channels; j++ )
1160 const int i_src = n * g->i_channels + j;
1161 const int i_dst = n * i_total_channels + g->pi_position[j];
1162 uint32_t *p_out32 = (uint32_t *) &p_out[4*i_dst];
1164 if( g->i_bits == 24 )
1166 assert( i_aoutbits == 32 );
1167 *p_out32 = (p_block->p_buffer[2*i_src+0] << 24)
1168 | (p_block->p_buffer[2*i_src+1] << 16)
1169 | (p_block->p_buffer[4*g->i_channels+i_src] << 8);
1170 #ifdef WORDS_BIGENDIAN
1171 *p_out32 = bswap32(*p_out32);
1173 i_aout_written += 4;
1175 else if( g->i_bits == 20 )
1177 assert( i_aoutbits == 32 );
1178 *p_out32 = (p_block->p_buffer[2*i_src+0] << 24)
1179 | (p_block->p_buffer[2*i_src+1] << 16)
1180 | (((p_block->p_buffer[4*g->i_channels+i_src] << ((!n)?0:4) ) & 0xf0) << 8);
1181 #ifdef WORDS_BIGENDIAN
1182 *p_out32 = bswap32(*p_out32);
1184 i_aout_written += 4;
1188 assert( g->i_bits == 16 );
1189 assert( i_aoutbits == 16 || i_aoutbits == 32 );
1190 if( i_aoutbits == 16 )
1192 #ifdef WORDS_BIGENDIAN
1193 memcpy( &p_out[2*i_dst], &p_block->p_buffer[2*i_src], 2 );
1195 p_out[2*i_dst+1] = p_block->p_buffer[2*i_src+0];
1196 p_out[2*i_dst+0] = p_block->p_buffer[2*i_src+1];
1198 i_aout_written += 2;
1202 *p_out32 = (p_block->p_buffer[2*i_src+0] << 24)
1203 | (p_block->p_buffer[2*i_src+1] << 16);
1204 #ifdef WORDS_BIGENDIAN
1205 *p_out32 = bswap32(*p_out32);
1207 i_aout_written += 4;
1214 p_block->i_buffer -= i_group_size;
1215 p_block->p_buffer += i_group_size;
1217 p_out += i_aout_written;
1220 static void BdExtract( block_t *p_aout_buffer, block_t *p_block,
1221 unsigned i_frame_length,
1222 unsigned i_channels, unsigned i_channels_padding,
1225 if( i_bits != 16 || i_channels_padding > 0 )
1227 uint8_t *p_src = p_block->p_buffer;
1228 uint8_t *p_dst = p_aout_buffer->p_buffer;
1229 int dst_inc = ((i_bits == 16) ? 2 : 4) * i_channels;
1231 while( i_frame_length > 0 )
1233 #ifdef WORDS_BIGENDIAN
1234 memcpy( p_dst, p_src, i_channels * i_bits / 8 );
1237 swab( p_src, p_dst, (i_channels + i_channels_padding) * i_bits / 8 );
1239 for (unsigned i = 0; i < i_channels; ++i) {
1241 p_dst[1 + (i * 4)] = p_src[2 + (i * 3)];
1242 p_dst[2 + (i * 4)] = p_src[1 + (i * 3)];
1243 p_dst[3 + (i * 4)] = p_src[i * 3];
1247 p_src += (i_channels + i_channels_padding) * i_bits / 8;
1254 #ifdef WORDS_BIGENDIAN
1255 memcpy( p_aout_buffer->p_buffer, p_block->p_buffer, p_block->i_buffer );
1257 swab( p_block->p_buffer, p_aout_buffer->p_buffer, p_block->i_buffer );