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

   1 /*****************************************************************************
   2  * s16tofloat32swab.c : converter from signed 16 bits integer to float32
   3  *                      with endianness change
   4  *****************************************************************************
   5  * Copyright (C) 2002-2006 the VideoLAN team
   6  * $Id$
   7  *
   8  * Authors: Samuel Hocevar <sam@zoy.org>
   9  *          Henri Fallon <henri@videolan.org>
  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., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301, USA.
  24  *****************************************************************************/
  25
  26 /*****************************************************************************
  27  * Preamble
  28  *****************************************************************************/
  29 #include <vlc/vlc.h>
  30 #include <stdlib.h>                                      /* malloc(), free() */
  31 #include <string.h>
  32
  33 #ifdef HAVE_UNISTD_H
  34 #   include <unistd.h>
  35 #endif
  36
  37 #ifdef HAVE_ALLOCA_H
  38 #   include <alloca.h>
  39 #endif
  40
  41 #include "audio_output.h"
  42 #include "aout_internal.h"
  43
  44 /*****************************************************************************
  45  * Local prototypes
  46  *****************************************************************************/
  47 static int  Create    ( vlc_object_t * );
  48
  49 static void DoWork    ( aout_instance_t *, aout_filter_t *, aout_buffer_t *,
  50                         aout_buffer_t * );
  51 static void DoWork24  ( aout_instance_t *, aout_filter_t *, aout_buffer_t *,
  52                         aout_buffer_t * );
  53
  54 /*****************************************************************************
  55  * Module descriptor
  56  *****************************************************************************/
  57 vlc_module_begin();
  58     set_category( CAT_AUDIO );
  59     set_subcategory( SUBCAT_AUDIO_MISC );
  60     set_description(
  61             _("Audio filter for s16->float32 with endianness conversion") );
  62     set_capability( "audio filter", 1 );
  63     set_callbacks( Create, NULL );
  64 vlc_module_end();
  65
  66 /*****************************************************************************
  67  * Create: allocate trivial mixer
  68  *****************************************************************************
  69  * This function allocates and initializes a Crop vout method.
  70  *****************************************************************************/
  71 static int Create( vlc_object_t *p_this )
  72 {
  73     aout_filter_t * p_filter = (aout_filter_t *)p_this;
  74
  75     if ( !AOUT_FMTS_SIMILAR( &p_filter->input, &p_filter->output ) )
  76     {
  77         return -1;
  78     }
  79
  80     if ( (p_filter->input.i_format == VLC_FOURCC('s','1','6','l') ||
  81          p_filter->input.i_format == VLC_FOURCC('s','1','6','b'))
  82          && p_filter->output.i_format == VLC_FOURCC('f','l','3','2')
  83          && p_filter->input.i_format != AOUT_FMT_S16_NE )
  84     {
  85         p_filter->pf_do_work = DoWork;
  86         p_filter->b_in_place = VLC_TRUE;
  87
  88         return 0;
  89     }
  90
  91     if ( (p_filter->input.i_format == VLC_FOURCC('s','2','4','l') ||
  92          p_filter->input.i_format == VLC_FOURCC('s','2','4','b'))
  93          && p_filter->output.i_format == VLC_FOURCC('f','l','3','2')
  94          && p_filter->input.i_format != AOUT_FMT_S24_NE )
  95     {
  96         p_filter->pf_do_work = DoWork24;
  97         p_filter->b_in_place = VLC_TRUE;
  98
  99         return 0;
 100     }
 101
 102     return -1;
 103 }
 104
 105 /*****************************************************************************
 106  * DoWork: convert a buffer
 107  *****************************************************************************/
 108 static void DoWork( aout_instance_t * p_aout, aout_filter_t * p_filter,
 109                     aout_buffer_t * p_in_buf, aout_buffer_t * p_out_buf )
 110 {
 111     int i = p_in_buf->i_nb_samples * aout_FormatNbChannels( &p_filter->input );
 112
 113     /* We start from the end because b_in_place is true */
 114     int16_t * p_in;
 115     float * p_out = (float *)p_out_buf->p_buffer + i - 1;
 116
 117 #ifdef HAVE_SWAB
 118 #   ifdef HAVE_ALLOCA
 119     int16_t * p_swabbed = alloca( i * sizeof(int16_t) );
 120 #   else
 121     int16_t * p_swabbed = malloc( i * sizeof(int16_t) );
 122 #   endif
 123
 124     swab( p_in_buf->p_buffer, (void *)p_swabbed, i * sizeof(int16_t) );
 125     p_in = p_swabbed + i - 1;
 126
 127 #else
 128     byte_t p_tmp[2];
 129     p_in = (int16_t *)p_in_buf->p_buffer + i - 1;
 130 #endif
 131
 132     while( i-- )
 133     {
 134 #ifndef HAVE_SWAB
 135         p_tmp[0] = ((byte_t *)p_in)[1];
 136         p_tmp[1] = ((byte_t *)p_in)[0];
 137         *p_out = (float)( *(int16_t *)p_tmp ) / 32768.0;
 138 #else
 139         *p_out = (float)*p_in / 32768.0;
 140 #endif
 141         p_in--; p_out--;
 142     }
 143
 144 #ifdef HAVE_SWAB
 145 #   ifndef HAVE_ALLOCA
 146     free( p_swabbed );
 147 #   endif
 148 #endif
 149
 150     p_out_buf->i_nb_samples = p_in_buf->i_nb_samples;
 151     p_out_buf->i_nb_bytes = p_in_buf->i_nb_bytes * 2;
 152 }
 153
 154 static void DoWork24( aout_instance_t * p_aout, aout_filter_t * p_filter,
 155                       aout_buffer_t * p_in_buf, aout_buffer_t * p_out_buf )
 156 {
 157     int i = p_in_buf->i_nb_samples * aout_FormatNbChannels( &p_filter->input );
 158
 159     /* We start from the end because b_in_place is true */
 160     uint8_t * p_in = (uint8_t *)p_in_buf->p_buffer + (i - 1) * 3;
 161     float * p_out = (float *)p_out_buf->p_buffer + i - 1;
 162
 163     byte_t p_tmp[3];
 164
 165     while( i-- )
 166     {
 167         p_tmp[0] = p_in[2];
 168         p_tmp[1] = p_in[1];
 169         p_tmp[2] = p_in[0];
 170
 171 #ifdef WORDS_BIGENDIAN
 172         *p_out = ((float)( (((int32_t)*(int16_t *)(p_tmp)) << 8) + p_tmp[2]))
 173 #else
 174         *p_out = ((float)( (((int32_t)*(int16_t *)(p_tmp+1)) << 8) + p_tmp[0]))
 175 #endif
 176             / 8388608.0;
 177
 178         p_in -= 3; p_out--;
 179     }
 180
 181     p_out_buf->i_nb_samples = p_in_buf->i_nb_samples;
 182     p_out_buf->i_nb_bytes = p_in_buf->i_nb_bytes * 4 / 3;
 183 }