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

   1 /*****************************************************************************
   2  * a52.c: A/52 basic parser
   3  *****************************************************************************
   4  * Copyright (C) 2001-2002 VideoLAN
   5  * $Id: a52.c,v 1.9 2002/09/02 23:17:05 massiot Exp $
   6  *
   7  * Authors: Stéphane Borel <stef@via.ecp.fr>
   8  *          Christophe Massiot <massiot@via.ecp.fr>
   9  *          Michel Lespinasse <walken@zoy.org>
  10  *          Aaron Holtzman <aholtzma@ess.engr.uvic.ca>
  11  *
  12  * This program is free software; you can redistribute it and/or modify
  13  * it under the terms of the GNU General Public License as published by
  14  * the Free Software Foundation; either version 2 of the License, or
  15  * (at your option) any later version.
  16  *
  17  * This program is distributed in the hope that it will be useful,
  18  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  19  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  20  * GNU General Public License for more details.
  21  *
  22  * You should have received a copy of the GNU General Public License
  23  * along with this program; if not, write to the Free Software
  24  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111, USA.
  25  *****************************************************************************/
  26
  27 /*****************************************************************************
  28  * Preamble
  29  *****************************************************************************/
  30 #include <stdio.h>
  31 #include <stdlib.h>
  32 #include <string.h>                                              /* memcpy() */
  33 #include <fcntl.h>
  34
  35 #include <vlc/vlc.h>
  36 #include <vlc/decoder.h>
  37 #include <vlc/aout.h>
  38
  39 #ifdef HAVE_UNISTD_H
  40 #   include <unistd.h>
  41 #endif
  42
  43 #define A52_FRAME_NB 1536
  44
  45 /*****************************************************************************
  46  * spdif_thread_t : A52 pass-through thread descriptor
  47  *****************************************************************************/
  48 typedef struct spdif_thread_s
  49 {
  50     /*
  51      * Thread properties
  52      */
  53     vlc_thread_t        thread_id;                /* id for thread functions */
  54
  55     /*
  56      * Input properties
  57      */
  58     decoder_fifo_t *    p_fifo;                /* stores the PES stream data */
  59
  60     /* The bit stream structure handles the PES stream at the bit level */
  61     bit_stream_t        bit_stream;
  62
  63     /*
  64      * Output properties
  65      */
  66     aout_instance_t *   p_aout; /* opaque */
  67     aout_input_t *      p_aout_input; /* opaque */
  68     audio_sample_format_t output_format;
  69 } spdif_thread_t;
  70
  71 /****************************************************************************
  72  * Local prototypes
  73  ****************************************************************************/
  74 static int  OpenDecoder    ( vlc_object_t * );
  75 static int  RunDecoder     ( decoder_fifo_t * );
  76
  77 static int  InitThread     ( spdif_thread_t *, decoder_fifo_t * );
  78 static void EndThread      ( spdif_thread_t * );
  79
  80 static int  SyncInfo       ( const byte_t *, int *, int *, int * );
  81
  82 /*****************************************************************************
  83  * Module descriptor
  84  *****************************************************************************/
  85 vlc_module_begin();
  86     set_description( _("A/52 parser") );
  87     set_capability( "decoder", 0 );
  88     set_callbacks( OpenDecoder, NULL );
  89     add_shortcut( "pass_through" );
  90     add_shortcut( "pass" );
  91 vlc_module_end();
  92
  93 /*****************************************************************************
  94  * OpenDecoder: probe the decoder and return score
  95  *****************************************************************************
  96  * Tries to launch a decoder and return score so that the interface is able
  97  * to chose.
  98  *****************************************************************************/
  99 static int OpenDecoder( vlc_object_t *p_this )
 100 {
 101     decoder_fifo_t *p_fifo = (decoder_fifo_t*) p_this;
 102
 103     if( p_fifo->i_fourcc != VLC_FOURCC('a','5','2',' ')
 104          && p_fifo->i_fourcc != VLC_FOURCC('a','5','2','b') )
 105     {
 106         return VLC_EGENERIC;
 107     }
 108
 109     p_fifo->pf_run = RunDecoder;
 110     return VLC_SUCCESS;
 111 }
 112
 113 /****************************************************************************
 114  * RunDecoder: the whole thing
 115  ****************************************************************************
 116  * This function is called just after the thread is launched.
 117  ****************************************************************************/
 118 static int RunDecoder( decoder_fifo_t *p_fifo )
 119 {
 120     spdif_thread_t * p_dec;
 121     audio_date_t end_date;
 122
 123     /* Allocate the memory needed to store the thread's structure */
 124     p_dec = malloc( sizeof(spdif_thread_t) );
 125     if( p_dec == NULL )
 126     {
 127         msg_Err( p_fifo, "out of memory" );
 128         DecoderError( p_fifo );
 129         return -1;
 130     }
 131
 132     if ( InitThread( p_dec, p_fifo ) )
 133     {
 134
 135         msg_Err( p_fifo, "could not initialize thread" );
 136         DecoderError( p_fifo );
 137         free( p_dec );
 138         return -1;
 139     }
 140
 141     /* decoder thread's main loop */
 142     while ( !p_dec->p_fifo->b_die && !p_dec->p_fifo->b_error )
 143     {
 144         int i_frame_size, i_channels, i_rate, i_bit_rate;
 145         mtime_t pts;
 146         /* Temporary buffer to store the raw frame to be decoded */
 147         byte_t p_header[7];
 148         aout_buffer_t * p_buffer;
 149
 150         /* Look for sync word - should be 0x0b77 */
 151         RealignBits( &p_dec->bit_stream );
 152         while ( (ShowBits( &p_dec->bit_stream, 16 ) ) != 0x0b77 &&
 153                 (!p_dec->p_fifo->b_die) && (!p_dec->p_fifo->b_error))
 154         {
 155             RemoveBits( &p_dec->bit_stream, 8 );
 156         }
 157
 158         /* Set the Presentation Time Stamp */
 159         NextPTS( &p_dec->bit_stream, &pts, NULL );
 160         if ( pts != 0 && pts != aout_DateGet( &end_date ) )
 161         {
 162             aout_DateSet( &end_date, pts );
 163         }
 164
 165         /* Get A/52 frame header */
 166         GetChunk( &p_dec->bit_stream, p_header, 7 );
 167         if( p_dec->p_fifo->b_die ) break;
 168
 169         /* Check if frame is valid and get frame info */
 170         i_frame_size = SyncInfo( p_header, &i_channels, &i_rate,
 171                                  &i_bit_rate );
 172
 173         if( !i_frame_size )
 174         {
 175             msg_Warn( p_dec->p_fifo, "a52_syncinfo failed" );
 176             continue;
 177         }
 178
 179         if( (p_dec->p_aout_input != NULL) &&
 180             ( (p_dec->output_format.i_rate != i_rate)
 181                 || (p_dec->output_format.i_channels != i_channels)
 182                 || (p_dec->output_format.i_bytes_per_frame != i_frame_size) ) )
 183         {
 184             /* Parameters changed - this should not happen. */
 185             aout_InputDelete( p_dec->p_aout, p_dec->p_aout_input );
 186             p_dec->p_aout_input = NULL;
 187         }
 188
 189         /* Creating the audio input if not created yet. */
 190         if( p_dec->p_aout_input == NULL )
 191         {
 192             p_dec->output_format.i_rate = i_rate;
 193             p_dec->output_format.i_channels = i_channels;
 194             p_dec->output_format.i_bytes_per_frame = i_frame_size;
 195             p_dec->output_format.i_frame_length = A52_FRAME_NB;
 196             aout_DateInit( &end_date, i_rate );
 197             p_dec->p_aout_input = aout_InputNew( p_dec->p_fifo,
 198                                                  &p_dec->p_aout,
 199                                                  &p_dec->output_format );
 200
 201             if ( p_dec->p_aout_input == NULL )
 202             {
 203                 p_dec->p_fifo->b_error = 1;
 204                 break;
 205             }
 206         }
 207
 208         if ( !aout_DateGet( &end_date ) )
 209         {
 210             byte_t p_junk[3840];
 211
 212             /* We've just started the stream, wait for the first PTS. */
 213             GetChunk( &p_dec->bit_stream, p_junk, i_frame_size - 7 );
 214             continue;
 215         }
 216
 217         p_buffer = aout_BufferNew( p_dec->p_aout, p_dec->p_aout_input,
 218                                    A52_FRAME_NB );
 219         if ( p_buffer == NULL ) return -1;
 220         p_buffer->start_date = aout_DateGet( &end_date );
 221         p_buffer->end_date = aout_DateIncrement( &end_date,
 222                                                  A52_FRAME_NB );
 223
 224         /* Get the whole frame. */
 225         memcpy( p_buffer->p_buffer, p_header, 7 );
 226         GetChunk( &p_dec->bit_stream, p_buffer->p_buffer + 7,
 227                   i_frame_size - 7 );
 228         if( p_dec->p_fifo->b_die ) break;
 229
 230         /* Send the buffer to the mixer. */
 231         aout_BufferPlay( p_dec->p_aout, p_dec->p_aout_input, p_buffer );
 232     }
 233
 234     /* If b_error is set, the spdif thread enters the error loop */
 235     if( p_dec->p_fifo->b_error )
 236     {
 237         DecoderError( p_dec->p_fifo );
 238     }
 239
 240     /* End of the spdif decoder thread */
 241     EndThread( p_dec );
 242
 243     return 0;
 244 }
 245
 246 /****************************************************************************
 247  * InitThread: initialize thread data and create output fifo
 248  ****************************************************************************/
 249 static int InitThread( spdif_thread_t * p_dec, decoder_fifo_t * p_fifo )
 250 {
 251     /* Initialize the thread properties */
 252     p_dec->p_aout = NULL;
 253     p_dec->p_aout_input = NULL;
 254     p_dec->p_fifo = p_fifo;
 255     p_dec->output_format.i_format = AOUT_FMT_A52;
 256
 257     /* Init the Bitstream */
 258     InitBitstream( &p_dec->bit_stream, p_dec->p_fifo,
 259                    NULL, NULL );
 260
 261     return 0;
 262 }
 263
 264 /*****************************************************************************
 265  * EndThread : spdif thread destruction
 266  *****************************************************************************/
 267 static void EndThread( spdif_thread_t * p_dec )
 268 {
 269     if ( p_dec->p_aout_input != NULL )
 270     {
 271         aout_InputDelete( p_dec->p_aout, p_dec->p_aout_input );
 272     }
 273
 274     free( p_dec );
 275 }
 276
 277 /****************************************************************************
 278  * SyncInfo: parse A52 sync info
 279  ****************************************************************************
 280  * This code is borrowed from liba52 by Aaron Holtzman & Michel Lespinasse,
 281  * since we don't want to oblige S/PDIF people to use liba52 just to get
 282  * their SyncInfo...
 283  ****************************************************************************/
 284 int SyncInfo( const byte_t * p_buf, int * pi_channels, int * pi_sample_rate,
 285               int * pi_bit_rate)
 286 {
 287     static const u8 halfrate[12] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 2, 3};
 288     static const int rate[] = { 32,  40,  48,  56,  64,  80,  96, 112,
 289                                 128, 160, 192, 224, 256, 320, 384, 448,
 290                                 512, 576, 640};
 291     static const u8 lfeon[8] = {0x10, 0x10, 0x04, 0x04, 0x04, 0x01, 0x04, 0x01};
 292     int frmsizecod;
 293     int bitrate;
 294     int half;
 295     int acmod;
 296
 297     if ((p_buf[0] != 0x0b) || (p_buf[1] != 0x77))        /* syncword */
 298         return 0;
 299
 300     if (p_buf[5] >= 0x60)                /* bsid >= 12 */
 301         return 0;
 302     half = halfrate[p_buf[5] >> 3];
 303
 304     /* acmod, dsurmod and lfeon */
 305     acmod = p_buf[6] >> 5;
 306     if ( p_buf[6] & 0xf8 )
 307     {
 308         *pi_channels = AOUT_CHAN_DOLBY;
 309     }
 310     else switch ( acmod )
 311     {
 312     case 0x0: *pi_channels = AOUT_CHAN_CHANNEL; break;
 313     case 0x1: *pi_channels = AOUT_CHAN_MONO; break;
 314     case 0x2: *pi_channels = AOUT_CHAN_STEREO; break;
 315     case 0x3: *pi_channels = AOUT_CHAN_3F; break;
 316     case 0x4: *pi_channels = AOUT_CHAN_2F1R; break;
 317     case 0x5: *pi_channels = AOUT_CHAN_3F1R; break;
 318     case 0x6: *pi_channels = AOUT_CHAN_2F2R; break;
 319     case 0x7: *pi_channels = AOUT_CHAN_3F2R; break;
 320     case 0x8: *pi_channels = AOUT_CHAN_CHANNEL1; break;
 321     case 0x9: *pi_channels = AOUT_CHAN_CHANNEL2; break;
 322     }
 323
 324     if ( p_buf[6] & lfeon[acmod] ) *pi_channels |= AOUT_CHAN_LFE;
 325
 326     frmsizecod = p_buf[4] & 63;
 327     if (frmsizecod >= 38)
 328         return 0;
 329     bitrate = rate [frmsizecod >> 1];
 330     *pi_bit_rate = (bitrate * 1000) >> half;
 331
 332     switch (p_buf[4] & 0xc0) {
 333     case 0:
 334         *pi_sample_rate = 48000 >> half;
 335         return 4 * bitrate;
 336     case 0x40:
 337         *pi_sample_rate = 44100 >> half;
 338         return 2 * (320 * bitrate / 147 + (frmsizecod & 1));
 339     case 0x80:
 340         *pi_sample_rate = 32000 >> half;
 341         return 6 * bitrate;
 342     default:
 343         return 0;
 344     }
 345 }
 346