git.sesse.net Git - vlc/blob - modules/packetizer/mpeg4audio.c

   1 /*****************************************************************************
   2  * mpeg4audio.c: parse and packetize an MPEG 4 audio stream
   3  *****************************************************************************
   4  * Copyright (C) 2001, 2002 VideoLAN
   5  * $Id: mpeg4audio.c,v 1.12 2003/11/16 21:07:31 gbazin Exp $
   6  *
   7  * Authors: Laurent Aimar <fenrir@via.ecp.fr>
   8  *          Gildas Bazin <gbazin@netcourrier.com>
   9  *
  10  * This program is free software; you can redistribute it and/or modify
  11  * it under the terms of the GNU General Public License as published by
  12  * the Free Software Foundation; either version 2 of the License, or
  13  * (at your option) any later version.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  *
  20  * You should have received a copy of the GNU General Public License
  21  * along with this program; if not, write to the Free Software
  22  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111, USA.
  23  *****************************************************************************/
  24
  25 /*****************************************************************************
  26  * Preamble
  27  *****************************************************************************/
  28 #include <stdlib.h>                                      /* malloc(), free() */
  29 #include <string.h>                                              /* strdup() */
  30
  31 #include <vlc/vlc.h>
  32 #include <vlc/aout.h>
  33 #include <vlc/decoder.h>
  34 #include <vlc/input.h>
  35 #include <vlc/sout.h>
  36 #include "codecs.h"
  37
  38 #include "vlc_block_helper.h"
  39
  40 /* AAC Config in ES:
  41  *
  42  * AudioObjectType          5 bits
  43  * samplingFrequencyIndex   4 bits
  44  * if (samplingFrequencyIndex == 0xF)
  45  *  samplingFrequency   24 bits
  46  * channelConfiguration     4 bits
  47  * GA_SpecificConfig
  48  *  FrameLengthFlag         1 bit 1024 or 960
  49  *  DependsOnCoreCoder      1 bit (always 0)
  50  *  ExtensionFlag           1 bit (always 0)
  51  */
  52
  53 /*****************************************************************************
  54  * decoder_sys_t : decoder descriptor
  55  *****************************************************************************/
  56 struct decoder_sys_t
  57 {
  58     /*
  59      * Input properties
  60      */
  61     int i_state;
  62
  63     block_bytestream_t bytestream;
  64
  65     /*
  66      * Common properties
  67      */
  68     audio_date_t end_date;
  69     mtime_t i_pts;
  70
  71     int i_frame_size, i_raw_blocks;
  72     unsigned int i_channels;
  73     unsigned int i_rate, i_frame_length, i_header_size;
  74 };
  75
  76 enum {
  77
  78     STATE_NOSYNC,
  79     STATE_SYNC,
  80     STATE_HEADER,
  81     STATE_NEXT_SYNC,
  82     STATE_GET_DATA,
  83     STATE_SEND_DATA
  84 };
  85
  86 static int i_sample_rates[] =
  87 {
  88     96000, 88200, 64000, 48000, 44100, 32000, 24000, 22050,
  89     16000, 12000, 11025, 8000,  7350,  0,     0,     0
  90 };
  91
  92 #define ADTS_HEADER_SIZE 9
  93
  94 /****************************************************************************
  95  * Local prototypes
  96  ****************************************************************************/
  97 static int  OpenPacketizer( vlc_object_t * );
  98 static void ClosePacketizer( vlc_object_t * );
  99
 100 static block_t *PacketizeBlock    ( decoder_t *, block_t ** );
 101 static block_t *ADTSPacketizeBlock( decoder_t *, block_t ** );
 102
 103 static uint8_t *GetOutBuffer ( decoder_t *, void ** );
 104
 105 static int ADTSSyncInfo( decoder_t *, const byte_t * p_buf,
 106                          unsigned int * pi_channels,
 107                          unsigned int * pi_sample_rate,
 108                          unsigned int * pi_frame_length,
 109                          unsigned int * pi_header_size,
 110                          unsigned int * pi_raw_blocks );
 111
 112 /*****************************************************************************
 113  * Module descriptor
 114  *****************************************************************************/
 115 vlc_module_begin();
 116     set_description( _("MPEG4 Audio packetizer") );
 117     set_capability( "packetizer", 50 );
 118     set_callbacks( OpenPacketizer, ClosePacketizer );
 119 vlc_module_end();
 120
 121 /*****************************************************************************
 122  * OpenPacketizer: probe the packetizer and return score
 123  *****************************************************************************/
 124 static int OpenPacketizer( vlc_object_t *p_this )
 125 {
 126     decoder_t *p_dec = (decoder_t*)p_this;
 127     decoder_sys_t *p_sys;
 128
 129     if( p_dec->fmt_in.i_codec != VLC_FOURCC( 'm', 'p', '4', 'a' ) )
 130     {
 131         return VLC_EGENERIC;
 132     }
 133
 134     /* Allocate the memory needed to store the decoder's structure */
 135     if( ( p_dec->p_sys = p_sys =
 136           (decoder_sys_t *)malloc(sizeof(decoder_sys_t)) ) == NULL )
 137     {
 138         msg_Err( p_dec, "out of memory" );
 139         return VLC_EGENERIC;
 140     }
 141
 142     /* Misc init */
 143     p_sys->i_state = STATE_NOSYNC;
 144     aout_DateSet( &p_sys->end_date, 0 );
 145     p_sys->bytestream = block_BytestreamInit( p_dec );
 146
 147     /* Set output properties */
 148     p_dec->fmt_out.i_cat = AUDIO_ES;
 149     p_dec->fmt_out.i_codec = VLC_FOURCC('m','p','4','a');
 150
 151     /* Set callback */
 152     p_dec->pf_packetize = PacketizeBlock;
 153
 154     msg_Info( p_dec, "Running MPEG4 audio packetizer" );
 155
 156     if( p_dec->fmt_in.i_extra > 0 )
 157     {
 158         uint8_t *p_config = (uint8_t*)p_dec->fmt_in.p_extra;
 159         int     i_index;
 160
 161         i_index = ( ( p_config[0] << 1 ) | ( p_config[1] >> 7 ) ) & 0x0f;
 162         if( i_index != 0x0f )
 163         {
 164             p_dec->fmt_out.audio.i_rate = i_sample_rates[i_index];
 165             p_dec->fmt_out.audio.i_frame_length =
 166                 (( p_config[1] >> 2 ) & 0x01) ? 960 : 1024;
 167         }
 168         else
 169         {
 170             p_dec->fmt_out.audio.i_rate = ( ( p_config[1] & 0x7f ) << 17 ) |
 171                 ( p_config[2] << 9 ) | ( p_config[3] << 1 ) |
 172                 ( p_config[4] >> 7 );
 173             p_dec->fmt_out.audio.i_frame_length =
 174                 (( p_config[4] >> 2 ) & 0x01) ? 960 : 1024;
 175         }
 176
 177         msg_Dbg( p_dec, "AAC %dHz %d samples/frame",
 178                  p_dec->fmt_out.audio.i_rate,
 179                  p_dec->fmt_out.audio.i_frame_length );
 180
 181         aout_DateInit( &p_sys->end_date, p_dec->fmt_out.audio.i_rate );
 182
 183         p_dec->fmt_out.audio.i_channels = p_dec->fmt_in.audio.i_channels;
 184         p_dec->fmt_out.i_extra = p_dec->fmt_in.i_extra;
 185         p_dec->fmt_out.p_extra = malloc( p_dec->fmt_in.i_extra );
 186         memcpy( p_dec->fmt_out.p_extra, p_dec->fmt_in.p_extra,
 187                 p_dec->fmt_in.i_extra );
 188     }
 189     else
 190     {
 191         msg_Dbg( p_dec, "No decoder specific info, must be an ADTS stream" );
 192
 193         /* We will try to create a AAC Config from adts */
 194         p_dec->fmt_out.i_extra = 0;
 195         p_dec->fmt_out.p_extra = NULL;
 196         p_dec->pf_packetize = ADTSPacketizeBlock;
 197     }
 198
 199     return VLC_SUCCESS;
 200 }
 201
 202 /****************************************************************************
 203  * PacketizeBlock: the whole thing
 204  ****************************************************************************
 205  * This function must be fed with complete frames.
 206  ****************************************************************************/
 207 static block_t *PacketizeBlock( decoder_t *p_dec, block_t **pp_block )
 208 {
 209     decoder_sys_t *p_sys = p_dec->p_sys;
 210     block_t *p_block;
 211
 212     if( !pp_block || !*pp_block ) return NULL;
 213
 214     p_block = *pp_block;
 215
 216     if( !aout_DateGet( &p_sys->end_date ) && !p_block->i_pts )
 217     {
 218         /* We've just started the stream, wait for the first PTS. */
 219         block_Release( p_block );
 220         return NULL;
 221     }
 222     else if( p_block->i_pts != 0 &&
 223              p_block->i_pts != aout_DateGet( &p_sys->end_date ) )
 224     {
 225         aout_DateSet( &p_sys->end_date, p_block->i_pts );
 226     }
 227
 228     p_block->i_pts = p_block->i_dts = aout_DateGet( &p_sys->end_date );
 229
 230     p_block->i_length = aout_DateIncrement( &p_sys->end_date,
 231         p_dec->fmt_out.audio.i_frame_length ) - p_block->i_pts;
 232
 233     return *pp_block;
 234 }
 235
 236 /****************************************************************************
 237  * DTSPacketizeBlock: the whole thing
 238  ****************************************************************************/
 239 static block_t *ADTSPacketizeBlock( decoder_t *p_dec, block_t **pp_block )
 240 {
 241     decoder_sys_t *p_sys = p_dec->p_sys;
 242     uint8_t p_header[ADTS_HEADER_SIZE];
 243     void *p_out_buffer;
 244     uint8_t *p_buf;
 245
 246     if( !pp_block || !*pp_block ) return NULL;
 247
 248     if( !aout_DateGet( &p_sys->end_date ) && !(*pp_block)->i_pts )
 249     {
 250         /* We've just started the stream, wait for the first PTS. */
 251         block_Release( *pp_block );
 252         return NULL;
 253     }
 254
 255     if( (*pp_block)->b_discontinuity )
 256     {
 257         p_sys->i_state = STATE_NOSYNC;
 258     }
 259
 260     block_BytestreamPush( &p_sys->bytestream, *pp_block );
 261
 262     while( 1 )
 263     {
 264         switch( p_sys->i_state )
 265         {
 266
 267         case STATE_NOSYNC:
 268             while( block_PeekBytes( &p_sys->bytestream, p_header, 2 )
 269                    == VLC_SUCCESS )
 270             {
 271                 /* Look for sync word - should be 0xfff + 2 layer bits */
 272                 if( p_header[0] == 0xff && (p_header[1] & 0xf6) == 0xf0 )
 273                 {
 274                     p_sys->i_state = STATE_SYNC;
 275                     break;
 276                 }
 277                 block_SkipByte( &p_sys->bytestream );
 278             }
 279             if( p_sys->i_state != STATE_SYNC )
 280             {
 281                 block_BytestreamFlush( &p_sys->bytestream );
 282
 283                 /* Need more data */
 284                 return NULL;
 285             }
 286
 287         case STATE_SYNC:
 288             /* New frame, set the Presentation Time Stamp */
 289             p_sys->i_pts = p_sys->bytestream.p_block->i_pts;
 290             if( p_sys->i_pts != 0 &&
 291                 p_sys->i_pts != aout_DateGet( &p_sys->end_date ) )
 292             {
 293                 aout_DateSet( &p_sys->end_date, p_sys->i_pts );
 294             }
 295             p_sys->i_state = STATE_HEADER;
 296             break;
 297
 298         case STATE_HEADER:
 299             /* Get ADTS frame header (ADTS_HEADER_SIZE bytes) */
 300             if( block_PeekBytes( &p_sys->bytestream, p_header,
 301                                  ADTS_HEADER_SIZE ) != VLC_SUCCESS )
 302             {
 303                 /* Need more data */
 304                 return NULL;
 305             }
 306
 307             /* Check if frame is valid and get frame info */
 308             p_sys->i_frame_size = ADTSSyncInfo( p_dec, p_header,
 309                                                 &p_sys->i_channels,
 310                                                 &p_sys->i_rate,
 311                                                 &p_sys->i_frame_length,
 312                                                 &p_sys->i_header_size,
 313                                                 &p_sys->i_raw_blocks );
 314             if( p_sys->i_frame_size <= 0 )
 315             {
 316                 msg_Dbg( p_dec, "emulated sync word" );
 317                 block_SkipByte( &p_sys->bytestream );
 318                 p_sys->i_state = STATE_NOSYNC;
 319                 break;
 320             }
 321
 322             p_sys->i_state = STATE_NEXT_SYNC;
 323
 324         case STATE_NEXT_SYNC:
 325             /* TODO: If p_block == NULL, flush the buffer without checking the
 326              * next sync word */
 327
 328             /* Check if next expected frame contains the sync word */
 329             if( block_PeekOffsetBytes( &p_sys->bytestream, p_sys->i_frame_size
 330                                        + p_sys->i_header_size, p_header, 2 )
 331                 != VLC_SUCCESS )
 332             {
 333                 /* Need more data */
 334                 return NULL;
 335             }
 336
 337             if( p_header[0] != 0xff || (p_header[1] & 0xf6) != 0xf0 )
 338             {
 339                 msg_Dbg( p_dec, "emulated sync word "
 340                          "(no sync on following frame)" );
 341                 p_sys->i_state = STATE_NOSYNC;
 342                 block_SkipByte( &p_sys->bytestream );
 343                 break;
 344             }
 345
 346             p_sys->i_state = STATE_SEND_DATA;
 347             break;
 348
 349         case STATE_GET_DATA:
 350             /* Make sure we have enough data.
 351              * (Not useful if we went through NEXT_SYNC) */
 352             if( block_WaitBytes( &p_sys->bytestream, p_sys->i_frame_size +
 353                                  p_sys->i_header_size) != VLC_SUCCESS )
 354             {
 355                 /* Need more data */
 356                 return NULL;
 357             }
 358             p_sys->i_state = STATE_SEND_DATA;
 359
 360         case STATE_SEND_DATA:
 361             if( !(p_buf = GetOutBuffer( p_dec, &p_out_buffer )) )
 362             {
 363                 //p_dec->b_error = VLC_TRUE;
 364                 return NULL;
 365             }
 366
 367             /* When we reach this point we already know we have enough
 368              * data available. */
 369
 370             /* Skip the ADTS header */
 371             block_SkipBytes( &p_sys->bytestream, p_sys->i_header_size );
 372
 373             /* Copy the whole frame into the buffer */
 374             block_GetBytes( &p_sys->bytestream, p_buf, p_sys->i_frame_size );
 375
 376             /* Make sure we don't reuse the same pts twice */
 377             if( p_sys->i_pts == p_sys->bytestream.p_block->i_pts )
 378                 p_sys->i_pts = p_sys->bytestream.p_block->i_pts = 0;
 379
 380             /* So p_block doesn't get re-added several times */
 381             *pp_block = block_BytestreamPop( &p_sys->bytestream );
 382
 383             p_sys->i_state = STATE_NOSYNC;
 384
 385             return p_out_buffer;
 386         }
 387     }
 388
 389     return NULL;
 390 }
 391
 392 /*****************************************************************************
 393  * GetOutBuffer:
 394  *****************************************************************************/
 395 static uint8_t *GetOutBuffer( decoder_t *p_dec, void **pp_out_buffer )
 396 {
 397     decoder_sys_t *p_sys = p_dec->p_sys;
 398     block_t *p_block;
 399
 400     if( p_dec->fmt_out.audio.i_rate != p_sys->i_rate )
 401     {
 402         msg_Info( p_dec, "AAC channels: %d samplerate: %d",
 403                   p_sys->i_channels, p_sys->i_rate );
 404
 405         aout_DateInit( &p_sys->end_date, p_sys->i_rate );
 406         aout_DateSet( &p_sys->end_date, p_sys->i_pts );
 407     }
 408
 409     p_dec->fmt_out.audio.i_rate     = p_sys->i_rate;
 410     p_dec->fmt_out.audio.i_channels = p_sys->i_channels;
 411     p_dec->fmt_out.audio.i_bytes_per_frame = p_sys->i_frame_size;
 412     p_dec->fmt_out.audio.i_frame_length = p_sys->i_frame_length;
 413
 414 #if 0
 415     p_dec->fmt_out.audio.i_original_channels = p_sys->i_channels_conf;
 416     p_dec->fmt_out.audio.i_physical_channels =
 417         p_sys->i_channels_conf & AOUT_CHAN_PHYSMASK;
 418 #endif
 419
 420     p_block = block_New( p_dec, p_sys->i_frame_size );
 421     if( p_block == NULL ) return NULL;
 422
 423     p_block->i_pts = p_block->i_dts = aout_DateGet( &p_sys->end_date );
 424
 425     p_block->i_length = aout_DateIncrement( &p_sys->end_date,
 426                             p_sys->i_frame_length ) - p_block->i_pts;
 427
 428     *pp_out_buffer = p_block;
 429     return p_block->p_buffer;
 430 }
 431
 432 /*****************************************************************************
 433  * ClosePacketizer: clean up the packetizer
 434  *****************************************************************************/
 435 static void ClosePacketizer( vlc_object_t *p_this )
 436 {
 437     decoder_t *p_dec = (decoder_t *)p_this;
 438     decoder_sys_t *p_sys = p_dec->p_sys;
 439
 440     block_BytestreamRelease( &p_sys->bytestream );
 441
 442     free( p_dec->p_sys );
 443 }
 444
 445 /*****************************************************************************
 446  * ADTSSyncInfo: parse MPEG 4 audio ADTS sync info
 447  *****************************************************************************/
 448 static int ADTSSyncInfo( decoder_t * p_dec, const byte_t * p_buf,
 449                          unsigned int * pi_channels,
 450                          unsigned int * pi_sample_rate,
 451                          unsigned int * pi_frame_length,
 452                          unsigned int * pi_header_size,
 453                          unsigned int * pi_raw_blocks_in_frame )
 454 {
 455     int i_id, i_profile, i_sample_rate_idx, i_frame_size;
 456     vlc_bool_t b_crc;
 457
 458     /* Fixed header between frames */
 459     i_id = ( (p_buf[1] >> 3) & 0x01 ) ? 2 : 4;
 460     b_crc = !(p_buf[1] & 0x01);
 461     i_profile = p_buf[2] >> 6;
 462     i_sample_rate_idx = (p_buf[2] >> 2) & 0x0f;
 463     *pi_sample_rate = i_sample_rates[i_sample_rate_idx];
 464     *pi_channels = ((p_buf[2] & 0x01) << 2) | ((p_buf[3] >> 6) & 0x03);
 465
 466     /* Variable header */
 467     i_frame_size = ((p_buf[3] & 0x03) << 11) | (p_buf[4] << 3) |
 468                    ((p_buf[5] >> 5) & 0x7);
 469     *pi_raw_blocks_in_frame = (p_buf[6] & 0x02) + 1;
 470
 471     if( !*pi_sample_rate || !*pi_channels || !i_frame_size )
 472     {
 473         return 0;
 474     }
 475
 476     /* Fixme */
 477     *pi_frame_length = 1024;
 478
 479     /* Build the decoder specific info header */
 480     if( !p_dec->fmt_out.i_extra )
 481     {
 482         p_dec->fmt_out.i_extra = 2;
 483         p_dec->fmt_out.p_extra = malloc( 2 );
 484         ((uint8_t *)p_dec->fmt_out.p_extra)[0] =
 485             (i_profile + 1) << 3 | (i_sample_rate_idx >> 1);
 486         ((uint8_t *)p_dec->fmt_out.p_extra)[1] =
 487             ((i_sample_rate_idx & 0x01) << 7) | (*pi_channels <<3);
 488     }
 489
 490     /* ADTS header length */
 491     *pi_header_size = b_crc ? 9 : 7;
 492
 493     return i_frame_size - *pi_header_size;
 494 }