git.sesse.net Git - vlc/blob - modules/codec/lpcm.c

   1 /*****************************************************************************
   2  * lpcm.c: lpcm decoder/packetizer module
   3  *****************************************************************************
   4  * Copyright (C) 1999-2008 the VideoLAN team
   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  *
  13  * This program is free software; you can redistribute it and/or modify
  14  * it under the terms of the GNU General Public License as published by
  15  * the Free Software Foundation; either version 2 of the License, or
  16  * (at your option) any later version.
  17  *
  18  * This program is distributed in the hope that it will be useful,
  19  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  20  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  21  * GNU General Public License for more details.
  22  *
  23  * You should have received a copy of the GNU General Public License
  24  * along with this program; if not, write to the Free Software
  25  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301, USA.
  26  *****************************************************************************/
  27
  28 /*****************************************************************************
  29  * Preamble
  30  *****************************************************************************/
  31 #ifdef HAVE_CONFIG_H
  32 # include "config.h"
  33 #endif
  34
  35 #include <vlc_common.h>
  36 #include <vlc_plugin.h>
  37 #include <vlc_codec.h>
  38 #include <vlc_aout.h>
  39 #include <assert.h>
  40
  41 /*****************************************************************************
  42  * Module descriptor
  43  *****************************************************************************/
  44 static int  OpenDecoder   ( vlc_object_t * );
  45 static int  OpenPacketizer( vlc_object_t * );
  46 static void CloseCommon   ( vlc_object_t * );
  47
  48 vlc_module_begin ()
  49
  50     set_category( CAT_INPUT )
  51     set_subcategory( SUBCAT_INPUT_ACODEC )
  52     set_description( N_("Linear PCM audio decoder") )
  53     set_capability( "decoder", 100 )
  54     set_callbacks( OpenDecoder, CloseCommon )
  55
  56     add_submodule ()
  57     set_description( N_("Linear PCM audio packetizer") )
  58     set_capability( "packetizer", 100 )
  59     set_callbacks( OpenPacketizer, CloseCommon )
  60
  61 vlc_module_end ()
  62
  63
  64 /*****************************************************************************
  65  * decoder_sys_t : lpcm decoder descriptor
  66  *****************************************************************************/
  67 struct decoder_sys_t
  68 {
  69     /* Module mode */
  70     bool b_packetizer;
  71
  72     /*
  73      * Output properties
  74      */
  75     date_t   end_date;
  76
  77     /* */
  78     unsigned i_header_size;
  79     int      i_type;
  80 };
  81
  82 /*
  83  * LPCM DVD header :
  84  * - frame number (8 bits)
  85  * - unknown (16 bits) == 0x0003 ?
  86  * - unknown (4 bits)
  87  * - current frame (4 bits)
  88  * - unknown (2 bits)
  89  * - frequency (2 bits) 0 == 48 kHz, 1 == 32 kHz, 2 == ?, 3 == ?
  90  * - unknown (1 bit)
  91  * - number of channels - 1 (3 bits) 1 == 2 channels
  92  * - start code (8 bits) == 0x80
  93  *
  94  * LPCM DVD-A header (http://dvd-audio.sourceforge.net/spec/aob.shtml)
  95  * - continuity counter (8 bits, clipped to 0x00-0x1f)
  96  * - header size (16 bits)
  97  * - byte pointer to start of first audio frame.
  98  * - unknown (8bits, 0x10 for stereo, 0x00 for surround)
  99  * - sample size (4+4 bits)
 100  * - samplerate (4+4 bits)
 101  * - unknown (8 bits)
 102  * - group assignment (8 bits)
 103  * - unknown (8 bits)
 104  * - padding(variable)
 105  *
 106  * LPCM BD header :
 107  * - unkown (16 bits)
 108  * - number of channels (4 bits)
 109  * - frequency (4 bits)
 110  * - bits per sample (2 bits)
 111  * - unknown (6 bits)
 112  */
 113
 114 #define LPCM_VOB_HEADER_LEN (6)
 115 #define LPCM_AOB_HEADER_LEN (11)
 116 #define LPCM_BD_HEADER_LEN (4)
 117
 118 enum
 119 {
 120     LPCM_VOB,
 121     LPCM_AOB,
 122     LPCM_BD,
 123 };
 124
 125 typedef struct
 126 {
 127     unsigned i_channels;
 128     bool     b_used;
 129     unsigned pi_position[6];
 130 } aob_group_t;
 131
 132 /*****************************************************************************
 133  * Local prototypes
 134  *****************************************************************************/
 135 static void *DecodeFrame  ( decoder_t *, block_t ** );
 136
 137 /* */
 138 static int VobHeader( unsigned *pi_rate,
 139                       unsigned *pi_channels, unsigned *pi_original_channels,
 140                       unsigned *pi_bits,
 141                       const uint8_t *p_header );
 142 static void VobExtract( aout_buffer_t *, block_t *, unsigned i_bits );
 143 /* */
 144 static int AobHeader( unsigned *pi_rate,
 145                       unsigned *pi_channels, unsigned *pi_layout,
 146                       unsigned *pi_bits,
 147                       unsigned *pi_padding,
 148                       aob_group_t g[2],
 149                       const uint8_t *p_header );
 150 static void AobExtract( aout_buffer_t *, block_t *, unsigned i_bits, aob_group_t p_group[2] );
 151 /* */
 152 static int BdHeader( unsigned *pi_rate,
 153                      unsigned *pi_channels, unsigned *pi_original_channels,
 154                      unsigned *pi_bits,
 155                      const uint8_t *p_header );
 156 static void BdExtract( aout_buffer_t *, block_t * );
 157
 158
 159 /*****************************************************************************
 160  * OpenCommon:
 161  *****************************************************************************/
 162 static int OpenCommon( vlc_object_t *p_this, bool b_packetizer )
 163 {
 164     decoder_t *p_dec = (decoder_t*)p_this;
 165     decoder_sys_t *p_sys;
 166     int i_type;
 167     int i_header_size;
 168
 169     switch( p_dec->fmt_in.i_codec )
 170     {
 171     /* DVD LPCM */
 172     case VLC_CODEC_DVD_LPCM:
 173         i_type = LPCM_VOB;
 174         i_header_size = LPCM_VOB_HEADER_LEN;
 175         break;
 176     /* DVD-Audio LPCM */
 177     case VLC_CODEC_DVDA_LPCM:
 178         i_type = LPCM_AOB;
 179         i_header_size = LPCM_AOB_HEADER_LEN;
 180         break;
 181     /* BD LPCM */
 182     case VLC_CODEC_BD_LPCM:
 183         i_type = LPCM_BD;
 184         i_header_size = LPCM_BD_HEADER_LEN;
 185         break;
 186     default:
 187         return VLC_EGENERIC;
 188     }
 189
 190     /* Allocate the memory needed to store the decoder's structure */
 191     if( ( p_dec->p_sys = p_sys = malloc(sizeof(decoder_sys_t)) ) == NULL )
 192         return VLC_ENOMEM;
 193
 194     /* Misc init */
 195     p_sys->b_packetizer = b_packetizer;
 196     date_Set( &p_sys->end_date, 0 );
 197     p_sys->i_type = i_type;
 198     p_sys->i_header_size = i_header_size;
 199
 200     /* Set output properties */
 201     p_dec->fmt_out.i_cat = AUDIO_ES;
 202
 203     if( b_packetizer )
 204     {
 205         switch( i_type )
 206         {
 207         case LPCM_VOB:
 208             p_dec->fmt_out.i_codec = VLC_CODEC_DVD_LPCM;
 209             break;
 210         case LPCM_AOB:
 211             p_dec->fmt_out.i_codec = VLC_CODEC_DVDA_LPCM;
 212             break;
 213         default:
 214             assert(0);
 215         case LPCM_BD:
 216             p_dec->fmt_out.i_codec = VLC_CODEC_BD_LPCM;
 217             break;
 218         }
 219     }
 220     else
 221     {
 222         switch( p_dec->fmt_out.audio.i_bitspersample )
 223         {
 224         case 24:
 225         case 20:
 226             p_dec->fmt_out.i_codec = VLC_CODEC_S24B;
 227             p_dec->fmt_out.audio.i_bitspersample = 24;
 228             break;
 229         default:
 230             p_dec->fmt_out.i_codec = VLC_CODEC_S16B;
 231             p_dec->fmt_out.audio.i_bitspersample = 16;
 232             break;
 233         }
 234     }
 235
 236     /* Set callback */
 237     p_dec->pf_decode_audio = (aout_buffer_t *(*)(decoder_t *, block_t **))
 238         DecodeFrame;
 239     p_dec->pf_packetize    = (block_t *(*)(decoder_t *, block_t **))
 240         DecodeFrame;
 241
 242     return VLC_SUCCESS;
 243 }
 244 static int OpenDecoder( vlc_object_t *p_this )
 245 {
 246     return OpenCommon( p_this, false );
 247 }
 248 static int OpenPacketizer( vlc_object_t *p_this )
 249 {
 250     return OpenCommon( p_this, true );
 251 }
 252
 253 /*****************************************************************************
 254  * DecodeFrame: decodes an lpcm frame.
 255  ****************************************************************************
 256  * Beware, this function must be fed with complete frames (PES packet).
 257  *****************************************************************************/
 258 static void *DecodeFrame( decoder_t *p_dec, block_t **pp_block )
 259 {
 260     decoder_sys_t *p_sys = p_dec->p_sys;
 261     block_t       *p_block;
 262     unsigned int  i_rate = 0, i_original_channels = 0, i_channels = 0, i_bits = 0;
 263     int           i_frame_length;
 264
 265     if( !pp_block || !*pp_block ) return NULL;
 266
 267     p_block = *pp_block;
 268     *pp_block = NULL; /* So the packet doesn't get re-sent */
 269
 270     /* Date management */
 271     if( p_block->i_pts > VLC_TS_INVALID &&
 272         p_block->i_pts != date_Get( &p_sys->end_date ) )
 273     {
 274         date_Set( &p_sys->end_date, p_block->i_pts );
 275     }
 276
 277     if( !date_Get( &p_sys->end_date ) )
 278     {
 279         /* We've just started the stream, wait for the first PTS. */
 280         block_Release( p_block );
 281         return NULL;
 282     }
 283
 284     if( p_block->i_buffer <= p_sys->i_header_size )
 285     {
 286         msg_Err(p_dec, "frame is too short");
 287         block_Release( p_block );
 288         return NULL;
 289     }
 290
 291     int i_ret;
 292     unsigned i_padding = 0;
 293     aob_group_t p_aob_group[2];
 294     switch( p_sys->i_type )
 295     {
 296     case LPCM_VOB:
 297         i_ret = VobHeader( &i_rate, &i_channels, &i_original_channels, &i_bits,
 298                            p_block->p_buffer );
 299         break;
 300     case LPCM_AOB:
 301         i_ret = AobHeader( &i_rate, &i_channels, &i_original_channels, &i_bits, &i_padding,
 302                            p_aob_group,
 303                            p_block->p_buffer );
 304         break;
 305     case LPCM_BD:
 306         i_ret = BdHeader( &i_rate, &i_channels, &i_original_channels, &i_bits,
 307                           p_block->p_buffer );
 308         break;
 309     default:
 310         abort();
 311     }
 312
 313     if( i_ret || p_block->i_buffer <= p_sys->i_header_size + i_padding )
 314     {
 315         msg_Warn( p_dec, "no frame sync or too small frame" );
 316         block_Release( p_block );
 317         return NULL;
 318     }
 319
 320     /* Set output properties */
 321     if( p_dec->fmt_out.audio.i_rate != i_rate )
 322     {
 323         date_Init( &p_sys->end_date, i_rate, 1 );
 324         date_Set( &p_sys->end_date, p_block->i_pts );
 325     }
 326     p_dec->fmt_out.audio.i_rate = i_rate;
 327     p_dec->fmt_out.audio.i_channels = i_channels;
 328     p_dec->fmt_out.audio.i_original_channels = i_original_channels;
 329     p_dec->fmt_out.audio.i_physical_channels = i_original_channels & AOUT_CHAN_PHYSMASK;
 330
 331     i_frame_length = (p_block->i_buffer - p_sys->i_header_size - i_padding) / i_channels * 8 / i_bits;
 332
 333     if( p_sys->b_packetizer )
 334     {
 335         p_block->i_pts = p_block->i_dts = date_Get( &p_sys->end_date );
 336         p_block->i_length =
 337             date_Increment( &p_sys->end_date, i_frame_length ) -
 338             p_block->i_pts;
 339
 340         /* Just pass on the incoming frame */
 341         return p_block;
 342     }
 343     else
 344     {
 345         /* */
 346         if( i_bits == 16 )
 347         {
 348             p_dec->fmt_out.i_codec = VLC_CODEC_S16B;
 349             p_dec->fmt_out.audio.i_bitspersample = 16;
 350         }
 351         else
 352         {
 353             p_dec->fmt_out.i_codec = VLC_CODEC_S24B;
 354             p_dec->fmt_out.audio.i_bitspersample = 24;
 355         }
 356
 357         /* */
 358         aout_buffer_t *p_aout_buffer;
 359         p_aout_buffer = decoder_NewAudioBuffer( p_dec, i_frame_length );
 360         if( !p_aout_buffer )
 361             return NULL;
 362
 363         p_aout_buffer->i_pts = date_Get( &p_sys->end_date );
 364         p_aout_buffer->i_length =
 365             date_Increment( &p_sys->end_date, i_frame_length )
 366             - p_aout_buffer->i_pts;
 367
 368         p_block->p_buffer += p_sys->i_header_size + i_padding;
 369         p_block->i_buffer -= p_sys->i_header_size + i_padding;
 370
 371         switch( p_sys->i_type )
 372         {
 373         case LPCM_VOB:
 374             VobExtract( p_aout_buffer, p_block, i_bits );
 375             break;
 376         case LPCM_AOB:
 377             AobExtract( p_aout_buffer, p_block, i_bits, p_aob_group );
 378             break;
 379         default:
 380             assert(0);
 381         case LPCM_BD:
 382             BdExtract( p_aout_buffer, p_block );
 383             break;
 384         }
 385
 386         block_Release( p_block );
 387         return p_aout_buffer;
 388     }
 389 }
 390
 391 /*****************************************************************************
 392  * CloseCommon : lpcm decoder destruction
 393  *****************************************************************************/
 394 static void CloseCommon( vlc_object_t *p_this )
 395 {
 396     decoder_t *p_dec = (decoder_t*)p_this;
 397     free( p_dec->p_sys );
 398 }
 399
 400 /*****************************************************************************
 401  *
 402  *****************************************************************************/
 403 static int VobHeader( unsigned *pi_rate,
 404                       unsigned *pi_channels, unsigned *pi_original_channels,
 405                       unsigned *pi_bits,
 406                       const uint8_t *p_header )
 407 {
 408     const uint8_t i_header = p_header[4];
 409
 410     switch( (i_header >> 4) & 0x3 )
 411     {
 412     case 0:
 413         *pi_rate = 48000;
 414         break;
 415     case 1:
 416         *pi_rate = 96000;
 417         break;
 418     case 2:
 419         *pi_rate = 44100;
 420         break;
 421     case 3:
 422         *pi_rate = 32000;
 423         break;
 424     }
 425
 426     *pi_channels = (i_header & 0x7) + 1;
 427     switch( *pi_channels - 1 )
 428     {
 429     case 0:
 430         *pi_original_channels = AOUT_CHAN_CENTER;
 431         break;
 432     case 1:
 433         *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT;
 434         break;
 435     case 2:
 436         /* This is unsure. */
 437         *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_LFE;
 438         break;
 439     case 3:
 440         *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT
 441                                | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT;
 442         break;
 443     case 4:
 444         /* This is unsure. */
 445         *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT
 446                                | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT
 447                                | AOUT_CHAN_LFE;
 448         break;
 449     case 5:
 450         *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT
 451                                | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT
 452                                | AOUT_CHAN_CENTER | AOUT_CHAN_LFE;
 453         break;
 454     case 6:
 455         *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT
 456                                | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT
 457                                | AOUT_CHAN_CENTER | AOUT_CHAN_MIDDLELEFT
 458                                | AOUT_CHAN_MIDDLERIGHT;
 459         break;
 460     case 7:
 461         *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT
 462                                | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT
 463                                | AOUT_CHAN_CENTER | AOUT_CHAN_MIDDLELEFT
 464                                | AOUT_CHAN_MIDDLERIGHT | AOUT_CHAN_LFE;
 465         break;
 466     }
 467
 468     switch( (i_header >> 6) & 0x3 )
 469     {
 470     case 2:
 471         *pi_bits = 24;
 472         break;
 473     case 1:
 474         *pi_bits = 20;
 475         break;
 476     case 0:
 477     default:
 478         *pi_bits = 16;
 479         break;
 480     }
 481
 482     /* Check frame sync and drop it. */
 483     if( p_header[5] != 0x80 )
 484         return -1;
 485     return 0;
 486 }
 487
 488 static const unsigned p_aob_group1[21][6] = {
 489     { AOUT_CHAN_CENTER, 0 },
 490     { AOUT_CHAN_LEFT,   AOUT_CHAN_RIGHT, 0 },
 491     { AOUT_CHAN_LEFT,   AOUT_CHAN_RIGHT, 0 },
 492     { AOUT_CHAN_LEFT,   AOUT_CHAN_RIGHT, 0 },
 493     { AOUT_CHAN_LEFT,   AOUT_CHAN_RIGHT, 0 },
 494     { AOUT_CHAN_LEFT,   AOUT_CHAN_RIGHT, 0 },
 495     { AOUT_CHAN_LEFT,   AOUT_CHAN_RIGHT, 0 },
 496     { AOUT_CHAN_LEFT,   AOUT_CHAN_RIGHT, 0 },
 497     { AOUT_CHAN_LEFT,   AOUT_CHAN_RIGHT, 0 },
 498     { AOUT_CHAN_LEFT,   AOUT_CHAN_RIGHT, 0 },
 499     { AOUT_CHAN_LEFT,   AOUT_CHAN_RIGHT, 0 },
 500     { AOUT_CHAN_LEFT,   AOUT_CHAN_RIGHT, 0 },
 501     { AOUT_CHAN_LEFT,   AOUT_CHAN_RIGHT, 0 },
 502     { AOUT_CHAN_LEFT,   AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER,   0 },
 503     { AOUT_CHAN_LEFT,   AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER,   0 },
 504     { AOUT_CHAN_LEFT,   AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER,   0 },
 505     { AOUT_CHAN_LEFT,   AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER,   0 },
 506     { AOUT_CHAN_LEFT,   AOUT_CHAN_RIGHT, AOUT_CHAN_CENTER,   0 },
 507     { AOUT_CHAN_LEFT,   AOUT_CHAN_RIGHT, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0  },
 508     { AOUT_CHAN_LEFT,   AOUT_CHAN_RIGHT, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0  },
 509     { AOUT_CHAN_LEFT,   AOUT_CHAN_RIGHT, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT, 0  },
 510 };
 511 static const unsigned p_aob_group2[21][6] = {
 512     { 0 },
 513     { 0 },
 514     { AOUT_CHAN_REARCENTER, 0 },
 515     { AOUT_CHAN_REARLEFT,   AOUT_CHAN_REARRIGHT,    0 },
 516     { AOUT_CHAN_LFE,        0 },
 517     { AOUT_CHAN_LFE,        AOUT_CHAN_REARCENTER,   0 },
 518     { AOUT_CHAN_LFE,        AOUT_CHAN_REARLEFT,     AOUT_CHAN_REARRIGHT,    0 },
 519     { AOUT_CHAN_CENTER,     0 },
 520     { AOUT_CHAN_CENTER,     AOUT_CHAN_REARCENTER, 0 },
 521     { AOUT_CHAN_CENTER,     AOUT_CHAN_REARLEFT,   AOUT_CHAN_REARRIGHT,    0 },
 522     { AOUT_CHAN_CENTER,     AOUT_CHAN_LFE,        0 },
 523     { AOUT_CHAN_CENTER,     AOUT_CHAN_LFE,        AOUT_CHAN_REARCENTER,   0 },
 524     { AOUT_CHAN_CENTER,     AOUT_CHAN_LFE,        AOUT_CHAN_REARLEFT,     AOUT_CHAN_REARRIGHT,    0 },
 525     { AOUT_CHAN_REARCENTER, 0 },
 526     { AOUT_CHAN_REARLEFT,   AOUT_CHAN_REARRIGHT,    0 },
 527     { AOUT_CHAN_LFE,        0 },
 528     { AOUT_CHAN_LFE,        AOUT_CHAN_REARCENTER,   0 },
 529     { AOUT_CHAN_LFE,        AOUT_CHAN_REARLEFT,     AOUT_CHAN_REARRIGHT,    0 },
 530     { AOUT_CHAN_LFE,        0 },
 531     { AOUT_CHAN_CENTER,     0 },
 532     { AOUT_CHAN_CENTER,     AOUT_CHAN_LFE,          0 },
 533 };
 534
 535 static int AobHeader( unsigned *pi_rate,
 536                       unsigned *pi_channels, unsigned *pi_layout,
 537                       unsigned *pi_bits,
 538                       unsigned *pi_padding,
 539                       aob_group_t g[2],
 540                       const uint8_t *p_header )
 541 {
 542     const unsigned i_header_size = GetWBE( &p_header[1] );
 543     if( i_header_size + 3 < LPCM_AOB_HEADER_LEN )
 544         return VLC_EGENERIC;
 545
 546     *pi_padding = 3+i_header_size - LPCM_AOB_HEADER_LEN;
 547
 548     const int i_index_size_g1 = (p_header[6] >> 4) & 0x0f;
 549     const int i_index_size_g2 = (p_header[6]     ) & 0x0f;
 550     const int i_index_rate_g1 = (p_header[7] >> 4) & 0x0f;
 551     const int i_index_rate_g2 = (p_header[7]     ) & 0x0f;
 552     const int i_assignment     = p_header[9];
 553
 554     /* Validate */
 555     if( i_index_size_g1 > 0x02 ||
 556         ( i_index_size_g2 != 0x0f && i_index_size_g2 > 0x02 ) )
 557         return VLC_EGENERIC;
 558     if( (i_index_rate_g1 & 0x07) > 0x02 ||
 559         ( i_index_rate_g2 != 0x0f && (i_index_rate_g1 & 0x07) > 0x02 ) )
 560         return VLC_EGENERIC;
 561     if( i_assignment > 20 )
 562         return VLC_EGENERIC;
 563
 564     /* */
 565     *pi_bits = 16 + 4 * i_index_size_g1;
 566     if( i_index_rate_g1 & 0x08 )
 567         *pi_rate = 44100 << (i_index_rate_g1 & 0x07);
 568     else
 569         *pi_rate = 48000 << (i_index_rate_g1 & 0x07);
 570
 571
 572     /* Group1 */
 573     unsigned i_channels1 = 0;
 574     unsigned i_layout1 = 0;
 575     for( int i = 0; p_aob_group1[i_assignment][i] != 0; i++ )
 576     {
 577         i_channels1++;
 578         i_layout1 |= p_aob_group1[i_assignment][i];
 579     }
 580     /* Group2 */
 581     unsigned i_channels2 = 0;
 582     unsigned i_layout2 = 0;
 583     if( i_index_size_g2 != 0x0f && i_index_rate_g2 != 0x0f )
 584     {
 585         for( int i = 0; p_aob_group2[i_assignment][i] != 0; i++ )
 586         {
 587             i_channels2++;
 588             i_layout2 |= p_aob_group2[i_assignment][i];
 589         }
 590         assert( (i_layout1 & i_layout2) == 0 );
 591     }
 592     /* It is enabled only when presents and compatible wih group1 */
 593     const bool b_group2_used = i_index_size_g1 == i_index_size_g2 &&
 594                                i_index_rate_g1 == i_index_rate_g2;
 595
 596     /* */
 597     *pi_channels = i_channels1 + ( b_group2_used ? i_channels2 : 0 );
 598     *pi_layout   = i_layout1   | ( b_group2_used ? i_layout2   : 0 );
 599
 600     /* */
 601     for( unsigned i = 0; i < 2; i++ )
 602     {
 603         const unsigned *p_aob = i == 0 ? p_aob_group1[i_assignment] :
 604                                          p_aob_group2[i_assignment];
 605         g[i].i_channels = i == 0 ? i_channels1 :
 606                                    i_channels2;
 607
 608         g[i].b_used = i == 0 || b_group2_used;
 609         if( !g[i].b_used )
 610             continue;
 611         for( unsigned j = 0; j < g[i].i_channels; j++ )
 612         {
 613             g[i].pi_position[j] = 0;
 614             for( int k = 0; pi_vlc_chan_order_wg4[k] != 0; k++ )
 615             {
 616                 const unsigned i_channel = pi_vlc_chan_order_wg4[k];
 617                 if( i_channel == p_aob[j] )
 618                     break;
 619                 if( (*pi_layout) & i_channel )
 620                     g[i].pi_position[j]++;
 621             }
 622         }
 623     }
 624     return VLC_SUCCESS;
 625 }
 626
 627 static int BdHeader( unsigned *pi_rate,
 628                      unsigned *pi_channels, unsigned *pi_original_channels,
 629                      unsigned *pi_bits,
 630                      const uint8_t *p_header )
 631 {
 632     const uint32_t h = GetDWBE( p_header );
 633     switch( ( h & 0xf000) >> 12 )
 634     {
 635     case 1:
 636         *pi_channels = 1;
 637         *pi_original_channels = AOUT_CHAN_CENTER;
 638         break;
 639     case 3:
 640         *pi_channels = 2;
 641         *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT;
 642         break;
 643     case 4:
 644         *pi_channels = 3;
 645         *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER;
 646         break;
 647     case 5:
 648         *pi_channels = 3;
 649         *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_REARCENTER;
 650         break;
 651     case 6:
 652         *pi_channels = 4;
 653         *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER |
 654                                 AOUT_CHAN_REARCENTER;
 655         break;
 656     case 7:
 657         *pi_channels = 4;
 658         *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT |
 659                                 AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT;
 660         break;
 661     case 8:
 662         *pi_channels = 5;
 663         *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER |
 664                                 AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT;
 665         break;
 666     case 9:
 667         *pi_channels = 6;
 668         *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER |
 669                                 AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT |
 670                                 AOUT_CHAN_LFE;
 671         break;
 672     case 10:
 673         *pi_channels = 7;
 674         *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER |
 675                                 AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT |
 676                                 AOUT_CHAN_MIDDLELEFT | AOUT_CHAN_MIDDLERIGHT;
 677         break;
 678     case 11:
 679         *pi_channels = 8;
 680         *pi_original_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER |
 681                                 AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT |
 682                                 AOUT_CHAN_MIDDLELEFT | AOUT_CHAN_MIDDLERIGHT |
 683                                 AOUT_CHAN_LFE;
 684         break;
 685
 686     default:
 687         return -1;
 688     }
 689     switch( (h >> 6) & 0x03 )
 690     {
 691     case 1:
 692         *pi_bits = 16;
 693         break;
 694     case 2: /* 20 bits but samples are stored on 24 bits */
 695     case 3: /* 24 bits */
 696         *pi_bits = 24;
 697         break;
 698     default:
 699         return -1;
 700     }
 701     switch( (h >> 8) & 0x0f )
 702     {
 703     case 1:
 704         *pi_rate = 48000;
 705         break;
 706     case 4:
 707         *pi_rate = 96000;
 708         break;
 709     case 5:
 710         *pi_rate = 192000;
 711         break;
 712     default:
 713         return -1;
 714     }
 715     return 0;
 716 }
 717
 718 static void VobExtract( aout_buffer_t *p_aout_buffer, block_t *p_block,
 719                         unsigned i_bits )
 720 {
 721     uint8_t *p_out = p_aout_buffer->p_buffer;
 722
 723     /* 20/24 bits LPCM use special packing */
 724     if( i_bits == 24 )
 725     {
 726         while( p_block->i_buffer / 12 )
 727         {
 728             /* Sample 1 */
 729             p_out[0] = p_block->p_buffer[0];
 730             p_out[1] = p_block->p_buffer[1];
 731             p_out[2] = p_block->p_buffer[8];
 732             /* Sample 2 */
 733             p_out[3] = p_block->p_buffer[2];
 734             p_out[4] = p_block->p_buffer[3];
 735             p_out[5] = p_block->p_buffer[9];
 736             /* Sample 3 */
 737             p_out[6] = p_block->p_buffer[4];
 738             p_out[7] = p_block->p_buffer[5];
 739             p_out[8] = p_block->p_buffer[10];
 740             /* Sample 4 */
 741             p_out[9] = p_block->p_buffer[6];
 742             p_out[10] = p_block->p_buffer[7];
 743             p_out[11] = p_block->p_buffer[11];
 744
 745             p_block->i_buffer -= 12;
 746             p_block->p_buffer += 12;
 747             p_out += 12;
 748         }
 749     }
 750     else if( i_bits == 20 )
 751     {
 752         while( p_block->i_buffer / 10 )
 753         {
 754             /* Sample 1 */
 755             p_out[0] = p_block->p_buffer[0];
 756             p_out[1] = p_block->p_buffer[1];
 757             p_out[2] = p_block->p_buffer[8] & 0xF0;
 758             /* Sample 2 */
 759             p_out[3] = p_block->p_buffer[2];
 760             p_out[4] = p_block->p_buffer[3];
 761             p_out[5] = p_block->p_buffer[8] << 4;
 762             /* Sample 3 */
 763             p_out[6] = p_block->p_buffer[4];
 764             p_out[7] = p_block->p_buffer[5];
 765             p_out[8] = p_block->p_buffer[9] & 0xF0;
 766             /* Sample 4 */
 767             p_out[9] = p_block->p_buffer[6];
 768             p_out[10] = p_block->p_buffer[7];
 769             p_out[11] = p_block->p_buffer[9] << 4;
 770
 771             p_block->i_buffer -= 10;
 772             p_block->p_buffer += 10;
 773             p_out += 12;
 774         }
 775     }
 776     else
 777     {
 778         assert( i_bits == 16 );
 779         memcpy( p_out, p_block->p_buffer, p_block->i_buffer );
 780     }
 781 }
 782 static void AobExtract( aout_buffer_t *p_aout_buffer,
 783                         block_t *p_block, unsigned i_bits, aob_group_t p_group[2] )
 784 {
 785     const unsigned i_channels = p_group[0].i_channels +
 786                                 ( p_group[1].b_used ? p_group[1].i_channels : 0 );
 787     uint8_t *p_out = p_aout_buffer->p_buffer;
 788
 789     while( p_block->i_buffer > 0 )
 790     {
 791         for( int i = 0; i < 2; i++ )
 792         {
 793             const aob_group_t *g = &p_group[1-i];
 794             const unsigned int i_group_size = 2 * g->i_channels * i_bits / 8;
 795
 796             if( p_block->i_buffer < i_group_size )
 797             {
 798                 p_block->i_buffer = 0;
 799                 break;
 800             }
 801             for( unsigned n = 0; n < 2; n++ )
 802             {
 803                 for( unsigned j = 0; j < g->i_channels && g->b_used; j++ )
 804                 {
 805                     const int i_src = n * g->i_channels + j;
 806                     const int i_dst = n * i_channels + g->pi_position[j];
 807
 808                     if( i_bits == 24 )
 809                     {
 810                         p_out[3*i_dst+0] = p_block->p_buffer[2*i_src+0];
 811                         p_out[3*i_dst+1] = p_block->p_buffer[2*i_src+1];
 812                         p_out[3*i_dst+2] = p_block->p_buffer[4*g->i_channels+i_src];
 813                     }
 814                     else if( i_bits == 20 )
 815                     {
 816                         p_out[3*i_dst+0] = p_block->p_buffer[2*i_src+0];
 817                         p_out[3*i_dst+1] = p_block->p_buffer[2*i_src+1];
 818                         if( n == 0 )
 819                             p_out[3*i_dst+2] = (p_block->p_buffer[4*g->i_channels+i_src]     ) & 0xf0;
 820                         else
 821                             p_out[3*i_dst+2] = (p_block->p_buffer[4*g->i_channels+i_src] << 4) & 0xf0;
 822                     }
 823                     else
 824                     {
 825                         assert( i_bits == 16 );
 826                         p_out[2*i_dst+0] = p_block->p_buffer[2*i_src+0];
 827                         p_out[2*i_dst+1] = p_block->p_buffer[2*i_src+1];
 828                     }
 829                 }
 830             }
 831
 832             p_block->i_buffer -= i_group_size;
 833             p_block->p_buffer += i_group_size;
 834         }
 835         /* */
 836         p_out += (i_bits == 16 ? 2 : 3) * i_channels * 2;
 837
 838     }
 839 }
 840 static void BdExtract( aout_buffer_t *p_aout_buffer, block_t *p_block )
 841 {
 842     memcpy( p_aout_buffer->p_buffer, p_block->p_buffer, p_block->i_buffer );
 843 }
 844