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