git.sesse.net Git - vlc/blob - modules/audio_filter/converter/mpgatofixed32.c

   1 /*****************************************************************************
   2  * mpgatofixed32.c: MPEG-1 & 2 audio layer I, II, III + MPEG 2.5 decoder,
   3  * using MAD (MPEG Audio Decoder)
   4  *****************************************************************************
   5  * Copyright (C) 2001 by Jean-Paul Saman
   6  * $Id$
   7  *
   8  * Authors: Christophe Massiot <massiot@via.ecp.fr>
   9  *          Jean-Paul Saman <jpsaman@wxs.nl>
  10  *
  11  * This program is free software; you can redistribute it and/or modify
  12  * it under the terms of the GNU General Public License as published by
  13  * the Free Software Foundation; either version 2 of the License, or
  14  * (at your option) any later version.
  15  *
  16  * This program is distributed in the hope that it will be useful,
  17  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  18  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  19  * GNU General Public License for more details.
  20  *
  21  * You should have received a copy of the GNU General Public License
  22  * along with this program; if not, write to the Free Software
  23  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111, USA.
  24  *****************************************************************************/
  25
  26 /*****************************************************************************
  27  * Preamble
  28  *****************************************************************************/
  29 #include <stdlib.h>                                      /* malloc(), free() */
  30 #include <string.h>                                              /* strdup() */
  31
  32 #include <mad.h>
  33
  34 #include <vlc/vlc.h>
  35 #include <vlc/decoder.h>
  36 #include "aout_internal.h"
  37 #include "vlc_filter.h"
  38
  39 /*****************************************************************************
  40  * Local prototypes
  41  *****************************************************************************/
  42 static int  Create    ( vlc_object_t * );
  43 static void Destroy   ( vlc_object_t * );
  44 static void DoWork    ( aout_instance_t *, aout_filter_t *, aout_buffer_t *,
  45                         aout_buffer_t * );
  46
  47 static int  OpenFilter ( vlc_object_t * );
  48 static void CloseFilter( vlc_object_t * );
  49 static block_t *Convert( filter_t *, block_t * );
  50
  51 /*****************************************************************************
  52  * Local structures
  53  *****************************************************************************/
  54 struct filter_sys_t
  55 {
  56     struct mad_stream mad_stream;
  57     struct mad_frame mad_frame;
  58     struct mad_synth mad_synth;
  59 };
  60
  61 /*****************************************************************************
  62  * Module descriptor
  63  *****************************************************************************/
  64 vlc_module_begin();
  65     set_category( CAT_AUDIO );
  66     set_subcategory( SUBCAT_AUDIO_MISC );
  67     set_description( _("MPEG audio decoder") );
  68     set_capability( "audio filter", 100 );
  69     set_callbacks( Create, Destroy );
  70
  71     add_submodule();
  72     set_description( _("MPEG audio decoder") );
  73     set_capability( "audio filter2", 100 );
  74     set_callbacks( OpenFilter, CloseFilter );
  75 vlc_module_end();
  76
  77 /*****************************************************************************
  78  * Create:
  79  *****************************************************************************/
  80 static int Create( vlc_object_t *p_this )
  81 {
  82     aout_filter_t *p_filter = (aout_filter_t *)p_this;
  83     struct filter_sys_t *p_sys;
  84
  85     if ( (p_filter->input.i_format != VLC_FOURCC('m','p','g','a')
  86            && p_filter->input.i_format != VLC_FOURCC('m','p','g','3'))
  87             || (p_filter->output.i_format != VLC_FOURCC('f','l','3','2')
  88                  && p_filter->output.i_format != VLC_FOURCC('f','i','3','2')) )
  89     {
  90         return -1;
  91     }
  92
  93     if ( !AOUT_FMTS_SIMILAR( &p_filter->input, &p_filter->output ) )
  94     {
  95         return -1;
  96     }
  97
  98     /* Allocate the memory needed to store the module's structure */
  99     p_sys = malloc( sizeof(filter_sys_t) );
 100     p_filter->p_sys = (struct aout_filter_sys_t *)p_sys;
 101     if( p_sys == NULL )
 102     {
 103         msg_Err( p_filter, "out of memory" );
 104         return -1;
 105     }
 106
 107     /* Initialize libmad */
 108     mad_stream_init( &p_sys->mad_stream );
 109     mad_frame_init( &p_sys->mad_frame );
 110     mad_synth_init( &p_sys->mad_synth );
 111     mad_stream_options( &p_sys->mad_stream, MAD_OPTION_IGNORECRC );
 112
 113     p_filter->pf_do_work = DoWork;
 114     p_filter->b_in_place = 0;
 115
 116     return 0;
 117 }
 118
 119 /*****************************************************************************
 120  * DoWork: decode an MPEG audio frame.
 121  *****************************************************************************/
 122 static void DoWork( aout_instance_t * p_aout, aout_filter_t * p_filter,
 123                     aout_buffer_t * p_in_buf, aout_buffer_t * p_out_buf )
 124 {
 125     filter_sys_t *p_sys = (filter_sys_t *)p_filter->p_sys;
 126
 127     p_out_buf->i_nb_samples = p_in_buf->i_nb_samples;
 128     p_out_buf->i_nb_bytes = p_in_buf->i_nb_samples * sizeof(vlc_fixed_t) *
 129                                aout_FormatNbChannels( &p_filter->input );
 130
 131     /* Do the actual decoding now. */
 132     mad_stream_buffer( &p_sys->mad_stream, p_in_buf->p_buffer,
 133                        p_in_buf->i_nb_bytes );
 134     if ( mad_frame_decode( &p_sys->mad_frame, &p_sys->mad_stream ) == -1 )
 135     {
 136         msg_Dbg( p_aout, "libmad error: %s",
 137                   mad_stream_errorstr( &p_sys->mad_stream ) );
 138         if( p_filter->output.i_format == VLC_FOURCC('f','l','3','2') )
 139         {
 140             int i;
 141             int i_size = p_out_buf->i_nb_bytes / sizeof(float);
 142
 143             float * a = (float *)p_out_buf->p_buffer;
 144             for ( i = 0 ; i < i_size ; i++ )
 145                 *a++ = 0.0;
 146         }
 147         else
 148         {
 149             memset( p_out_buf->p_buffer, 0, p_out_buf->i_nb_bytes );
 150         }
 151         return;
 152     }
 153
 154     mad_synth_frame( &p_sys->mad_synth, &p_sys->mad_frame );
 155
 156     if ( p_filter->output.i_format == VLC_FOURCC('f','i','3','2') )
 157     {
 158         /* Interleave and keep buffers in mad_fixed_t format */
 159         mad_fixed_t * p_samples = (mad_fixed_t *)p_out_buf->p_buffer;
 160         struct mad_pcm * p_pcm = &p_sys->mad_synth.pcm;
 161         unsigned int i_samples = p_pcm->length;
 162         mad_fixed_t const * p_left = p_pcm->samples[0];
 163         mad_fixed_t const * p_right = p_pcm->samples[1];
 164
 165         switch ( p_pcm->channels )
 166         {
 167         case 2:
 168             if ( p_filter->output.i_original_channels == AOUT_CHAN_CENTER )
 169             while ( i_samples-- )
 170             {
 171                 *p_samples++ = (*p_left++ >> 1) + (*p_right++ >> 1);
 172             }
 173             else
 174             while ( i_samples-- )
 175             {
 176                 *p_samples++ = *p_left++;
 177                 *p_samples++ = *p_right++;
 178             }
 179             break;
 180
 181         case 1:
 182             p_filter->p_vlc->pf_memcpy( p_samples, p_left,
 183                                         i_samples * sizeof(mad_fixed_t) );
 184             break;
 185
 186         default:
 187             msg_Err( p_aout, "cannot interleave %i channels",
 188                      p_pcm->channels );
 189         }
 190     }
 191     else
 192     {
 193         /* float32 */
 194         float * p_samples = (float *)p_out_buf->p_buffer;
 195         struct mad_pcm * p_pcm = &p_sys->mad_synth.pcm;
 196         unsigned int i_samples = p_pcm->length;
 197         mad_fixed_t const * p_left = p_pcm->samples[0];
 198         mad_fixed_t const * p_right = p_pcm->samples[1];
 199         float f_temp = (float)FIXED32_ONE;
 200
 201         switch ( p_pcm->channels )
 202         {
 203         case 2:
 204             if ( p_filter->output.i_original_channels == AOUT_CHAN_CENTER )
 205             while ( i_samples-- )
 206             {
 207                 *p_samples++ = (float)*p_left++ / f_temp / 2 +
 208                                (float)*p_right++ / f_temp / 2;
 209             }
 210             else
 211             while ( i_samples-- )
 212             {
 213                 *p_samples++ = (float)*p_left++ / f_temp;
 214                 *p_samples++ = (float)*p_right++ / f_temp;
 215             }
 216             break;
 217
 218         case 1:
 219             while ( i_samples-- )
 220             {
 221                 *p_samples++ = (float)*p_left++ / f_temp;
 222             }
 223             break;
 224
 225         default:
 226             msg_Err( p_aout, "cannot interleave %i channels",
 227                      p_pcm->channels );
 228         }
 229     }
 230 }
 231
 232 /*****************************************************************************
 233  * Destroy : deallocate data structures
 234  *****************************************************************************/
 235 static void Destroy( vlc_object_t *p_this )
 236 {
 237     aout_filter_t *p_filter = (aout_filter_t *)p_this;
 238     filter_sys_t *p_sys = (filter_sys_t *)p_filter->p_sys;
 239
 240     mad_synth_finish( &p_sys->mad_synth );
 241     mad_frame_finish( &p_sys->mad_frame );
 242     mad_stream_finish( &p_sys->mad_stream );
 243     free( p_sys );
 244 }
 245
 246 /*****************************************************************************
 247  * OpenFilter:
 248  *****************************************************************************/
 249 static int OpenFilter( vlc_object_t *p_this )
 250 {
 251     filter_t *p_filter = (filter_t *)p_this;
 252     filter_sys_t *p_sys;
 253
 254     if( p_filter->fmt_in.i_codec != VLC_FOURCC('m','p','g','a') &&
 255         p_filter->fmt_in.i_codec != VLC_FOURCC('m','p','g','3') )
 256     {
 257         return VLC_EGENERIC;
 258     }
 259
 260     /* Allocate the memory needed to store the module's structure */
 261     p_sys = p_filter->p_sys = malloc( sizeof(filter_sys_t) );
 262     if( p_sys == NULL )
 263     {
 264         msg_Err( p_filter, "out of memory" );
 265         return -1;
 266     }
 267
 268     p_filter->pf_audio_filter = Convert;
 269
 270     /* Initialize libmad */
 271     mad_stream_init( &p_sys->mad_stream );
 272     mad_frame_init( &p_sys->mad_frame );
 273     mad_synth_init( &p_sys->mad_synth );
 274     mad_stream_options( &p_sys->mad_stream, MAD_OPTION_IGNORECRC );
 275
 276     if( p_this->p_libvlc->i_cpu & CPU_CAPABILITY_FPU )
 277         p_filter->fmt_out.i_codec = VLC_FOURCC('f','l','3','2');
 278     else
 279         p_filter->fmt_out.i_codec = VLC_FOURCC('f','i','3','2');
 280     p_filter->fmt_out.audio.i_format = p_filter->fmt_out.i_codec;
 281
 282     p_filter->fmt_out.audio.i_bitspersample = sizeof(float);
 283     p_filter->fmt_out.audio.i_rate = p_filter->fmt_in.audio.i_rate;
 284
 285     msg_Dbg( p_this, "%4.4s->%4.4s, bits per sample: %i",
 286              (char *)&p_filter->fmt_in.i_codec,
 287              (char *)&p_filter->fmt_out.i_codec,
 288              p_filter->fmt_out.audio.i_bitspersample );
 289
 290     return 0;
 291 }
 292
 293 /*****************************************************************************
 294  * CloseFilter : deallocate data structures
 295  *****************************************************************************/
 296 static void CloseFilter( vlc_object_t *p_this )
 297 {
 298     filter_t *p_filter = (filter_t *)p_this;
 299     filter_sys_t *p_sys = p_filter->p_sys;
 300
 301     mad_synth_finish( &p_sys->mad_synth );
 302     mad_frame_finish( &p_sys->mad_frame );
 303     mad_stream_finish( &p_sys->mad_stream );
 304     free( p_sys );
 305 }
 306
 307 static block_t *Convert( filter_t *p_filter, block_t *p_block )
 308 {
 309     aout_filter_t aout_filter;
 310     aout_buffer_t in_buf, out_buf;
 311     block_t *p_out;
 312     int i_out_size;
 313
 314     if( !p_block || !p_block->i_samples )
 315     {
 316         if( p_block ) p_block->pf_release( p_block );
 317         return NULL;
 318     }
 319
 320     i_out_size = p_block->i_samples *
 321       p_filter->fmt_out.audio.i_bitspersample *
 322         p_filter->fmt_out.audio.i_channels / 8;
 323
 324     p_out = p_filter->pf_audio_buffer_new( p_filter, i_out_size );
 325     if( !p_out )
 326     {
 327         msg_Warn( p_filter, "can't get output buffer" );
 328         p_block->pf_release( p_block );
 329         return NULL;
 330     }
 331
 332     p_out->i_samples = p_block->i_samples;
 333     p_out->i_dts = p_block->i_dts;
 334     p_out->i_pts = p_block->i_pts;
 335     p_out->i_length = p_block->i_length;
 336
 337     aout_filter.p_sys = (struct aout_filter_sys_t *)p_filter->p_sys;
 338     aout_filter.input = p_filter->fmt_in.audio;
 339     aout_filter.input.i_format = p_filter->fmt_in.i_codec;
 340     aout_filter.output = p_filter->fmt_out.audio;
 341     aout_filter.output.i_format = p_filter->fmt_out.i_codec;
 342
 343     in_buf.p_buffer = p_block->p_buffer;
 344     in_buf.i_nb_bytes = p_block->i_buffer;
 345     in_buf.i_nb_samples = p_block->i_samples;
 346     out_buf.p_buffer = p_out->p_buffer;
 347     out_buf.i_nb_bytes = p_out->i_buffer;
 348     out_buf.i_nb_samples = p_out->i_samples;
 349
 350     DoWork( (aout_instance_t *)p_filter, &aout_filter, &in_buf, &out_buf );
 351
 352     p_block->pf_release( p_block );
 353
 354     p_out->i_buffer = out_buf.i_nb_bytes;
 355     p_out->i_samples = out_buf.i_nb_samples;
 356
 357     return p_out;
 358 }