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

   1 /*****************************************************************************
   2  * format.c : PCM format converter
   3  *****************************************************************************
   4  * Copyright (C) 2002-2005 the VideoLAN team
   5  * $Id$
   6  *
   7  * Authors: Christophe Massiot <massiot@via.ecp.fr>
   8  *          Gildas Bazin <gbazin@videolan.org>
   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., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301, USA.
  23  *****************************************************************************/
  24
  25 /*****************************************************************************
  26  * Preamble
  27  *****************************************************************************/
  28 #include <stdlib.h>                                      /* malloc(), free() */
  29 #include <string.h>
  30
  31 #include <vlc/vlc.h>
  32 #include <vlc_aout.h>
  33 #include <vlc_block.h>
  34 #include "vlc_filter.h"
  35
  36 #ifdef WORDS_BIGENDIAN
  37 #   define AOUT_FMT_S24_IE VLC_FOURCC('s','2','4','l')
  38 #   define AOUT_FMT_S16_IE VLC_FOURCC('s','1','6','l')
  39 #   define AOUT_FMT_U16_IE VLC_FOURCC('u','1','6','l')
  40 #else
  41 #   define AOUT_FMT_S24_IE VLC_FOURCC('s','2','4','b')
  42 #   define AOUT_FMT_S16_IE VLC_FOURCC('s','1','6','b')
  43 #   define AOUT_FMT_U16_IE VLC_FOURCC('u','1','6','b')
  44 #endif
  45
  46
  47 /*****************************************************************************
  48  * Local prototypes
  49  *****************************************************************************/
  50 static int  Open ( vlc_object_t * );
  51
  52 static block_t *Float32toS24( filter_t *, block_t * );
  53 static block_t *Float32toS16( filter_t *, block_t * );
  54 static block_t *Float32toU16( filter_t *, block_t * );
  55 static block_t *Float32toS8 ( filter_t *, block_t * );
  56 static block_t *Float32toU8 ( filter_t *, block_t * );
  57
  58 static block_t *S24toFloat32  ( filter_t *, block_t * );
  59 static block_t *S24toS16      ( filter_t *, block_t * );
  60 static block_t *S24toS16Invert( filter_t *, block_t * );
  61
  62 static block_t *S16toFloat32  ( filter_t *, block_t * );
  63 static block_t *S16toS24      ( filter_t *, block_t * );
  64 static block_t *S16toS24Invert( filter_t *, block_t * );
  65 static block_t *S16toS8       ( filter_t *, block_t * );
  66 static block_t *S16toU8       ( filter_t *, block_t * );
  67 static block_t *S16toU16      ( filter_t *, block_t * );
  68
  69 static block_t *U16toFloat32( filter_t *, block_t * );
  70 static block_t *U16toS8     ( filter_t *, block_t * );
  71 static block_t *U16toU8     ( filter_t *, block_t * );
  72 static block_t *U16toS16    ( filter_t *, block_t * );
  73
  74 static block_t *Float32toS24Invert( filter_t *, block_t * );
  75 static block_t *Float32toS16Invert( filter_t *, block_t * );
  76 static block_t *Float32toU16Invert( filter_t *, block_t * );
  77
  78 static block_t *S24InverttoFloat32  ( filter_t *, block_t * );
  79 static block_t *S24InverttoS16      ( filter_t *, block_t * );
  80 static block_t *S24InverttoS16Invert( filter_t *, block_t * );
  81
  82 static block_t *S16InverttoFloat32  ( filter_t *, block_t * );
  83 static block_t *S16InverttoS24      ( filter_t *, block_t * );
  84 static block_t *S16InverttoS24Invert( filter_t *, block_t * );
  85 static block_t *S16InverttoS8       ( filter_t *, block_t * );
  86 static block_t *S16InverttoU8       ( filter_t *, block_t * );
  87 static block_t *S16InverttoU16      ( filter_t *, block_t * );
  88
  89 static block_t *U16InverttoFloat32( filter_t *, block_t * );
  90 static block_t *U16InverttoS8     ( filter_t *, block_t * );
  91 static block_t *U16InverttoU8     ( filter_t *, block_t * );
  92 static block_t *U16InverttoS16    ( filter_t *, block_t * );
  93
  94 static block_t *S8toFloat32  ( filter_t *, block_t * );
  95 static block_t *S8toS16      ( filter_t *, block_t * );
  96 static block_t *S8toU16      ( filter_t *, block_t * );
  97 static block_t *S8toU8       ( filter_t *, block_t * );
  98 static block_t *S8toS16Invert( filter_t *, block_t * );
  99 static block_t *S8toU16Invert( filter_t *, block_t * );
 100
 101 static block_t *U8toFloat32  ( filter_t *, block_t * );
 102 static block_t *U8toFloat32  ( filter_t *, block_t * );
 103 static block_t *U8toS16      ( filter_t *, block_t * );
 104 static block_t *U8toU16      ( filter_t *, block_t * );
 105 static block_t *U8toS8       ( filter_t *, block_t * );
 106 static block_t *U8toS16Invert( filter_t *, block_t * );
 107 static block_t *U8toU16Invert( filter_t *, block_t * );
 108
 109
 110 static block_t *U8toS8( filter_t *, block_t * );
 111 static block_t *S8toU8( filter_t *, block_t * );
 112
 113
 114 static block_t *Swap16( filter_t *, block_t * );
 115 static block_t *Swap24( filter_t *, block_t * );
 116
 117 static struct
 118 {
 119     vlc_fourcc_t i_src;
 120     vlc_fourcc_t i_dst;
 121     block_t *(*pf_convert)( filter_t *, block_t *);
 122 } ConvertTable[] =
 123 {
 124     /* From fl32 */
 125     { VLC_FOURCC('f','l','3','2'), AOUT_FMT_S24_NE, Float32toS24 },
 126     { VLC_FOURCC('f','l','3','2'), AOUT_FMT_S16_NE, Float32toS16 },
 127     { VLC_FOURCC('f','l','3','2'), AOUT_FMT_U16_NE, Float32toU16 },
 128     { VLC_FOURCC('f','l','3','2'), AOUT_FMT_S24_IE, Float32toS24Invert },
 129     { VLC_FOURCC('f','l','3','2'), AOUT_FMT_S16_IE, Float32toS16Invert },
 130     { VLC_FOURCC('f','l','3','2'), AOUT_FMT_U16_IE, Float32toU16Invert },
 131     { VLC_FOURCC('f','l','3','2'), VLC_FOURCC('s','8',' ',' '), Float32toS8 },
 132     { VLC_FOURCC('f','l','3','2'), VLC_FOURCC('u','8',' ',' '), Float32toU8 },
 133
 134     /* From s24 invert */
 135     { AOUT_FMT_S24_NE, VLC_FOURCC('f','l','3','2'), S24toFloat32 },
 136     { AOUT_FMT_S24_NE, AOUT_FMT_S24_IE,             Swap24 },
 137     { AOUT_FMT_S24_NE, AOUT_FMT_S16_NE,             S24toS16 },
 138     { AOUT_FMT_S24_NE, AOUT_FMT_S16_IE,             S24toS16Invert },
 139
 140     /* From s16 */
 141     { AOUT_FMT_S16_NE, VLC_FOURCC('f','l','3','2'), S16toFloat32 },
 142     { AOUT_FMT_S16_NE, AOUT_FMT_S24_NE,             S16toS24 },
 143     { AOUT_FMT_S16_NE, AOUT_FMT_S24_IE,             S16toS24Invert },
 144     { AOUT_FMT_S16_NE, AOUT_FMT_S16_IE,             Swap16 },
 145     { AOUT_FMT_S16_NE, AOUT_FMT_U16_IE,             S16toU16 },
 146     { AOUT_FMT_S16_NE, VLC_FOURCC('s','8',' ',' '), S16toS8 },
 147     { AOUT_FMT_S16_NE, VLC_FOURCC('u','8',' ',' '), S16toU8 },
 148
 149     /* From u16 */
 150     { AOUT_FMT_U16_NE, VLC_FOURCC('f','l','3','2'), U16toFloat32 },
 151     { AOUT_FMT_U16_NE, AOUT_FMT_U16_IE,             Swap16 },
 152     { AOUT_FMT_U16_NE, AOUT_FMT_S16_IE,             U16toS16 },
 153     { AOUT_FMT_U16_NE, VLC_FOURCC('s','8',' ',' '), U16toS8 },
 154     { AOUT_FMT_U16_NE, VLC_FOURCC('u','8',' ',' '), U16toU8 },
 155
 156     /* From s8 */
 157     { VLC_FOURCC('s','8',' ',' '), VLC_FOURCC('f','l','3','2'), S8toFloat32 },
 158     { VLC_FOURCC('s','8',' ',' '), AOUT_FMT_S16_NE,             S8toS16 },
 159     { VLC_FOURCC('s','8',' ',' '), AOUT_FMT_S16_IE,             S8toS16Invert },
 160     { VLC_FOURCC('s','8',' ',' '), AOUT_FMT_U16_NE,             S8toU16 },
 161     { VLC_FOURCC('s','8',' ',' '), AOUT_FMT_U16_IE,             S8toU16Invert },
 162     { VLC_FOURCC('s','8',' ',' '), VLC_FOURCC('u','8',' ',' '), S8toU8 },
 163
 164     /* From u8 */
 165     { VLC_FOURCC('u','8',' ',' '), VLC_FOURCC('f','l','3','2'), U8toFloat32 },
 166     { VLC_FOURCC('u','8',' ',' '), AOUT_FMT_S16_NE,             U8toS16 },
 167     { VLC_FOURCC('u','8',' ',' '), AOUT_FMT_S16_IE,             U8toS16Invert },
 168     { VLC_FOURCC('u','8',' ',' '), AOUT_FMT_U16_NE,             U8toU16 },
 169     { VLC_FOURCC('u','8',' ',' '), AOUT_FMT_U16_IE,             U8toU16Invert },
 170     { VLC_FOURCC('u','8',' ',' '), VLC_FOURCC('s','8',' ',' '), U8toS8 },
 171
 172     /* From s24 invert */
 173     { AOUT_FMT_S24_IE, VLC_FOURCC('f','l','3','2'), S24InverttoFloat32 },
 174     { AOUT_FMT_S24_IE, AOUT_FMT_S24_NE,             Swap24 },
 175     { AOUT_FMT_S24_IE, AOUT_FMT_S16_NE,             S24InverttoS16 },
 176     { AOUT_FMT_S24_IE, AOUT_FMT_S16_IE,             S24InverttoS16Invert },
 177
 178     /* From s16 invert */
 179     { AOUT_FMT_S16_IE, VLC_FOURCC('f','l','3','2'), S16InverttoFloat32 },
 180     { AOUT_FMT_S16_IE, AOUT_FMT_S24_NE,             S16InverttoS24 },
 181     { AOUT_FMT_S16_IE, AOUT_FMT_S24_IE,             S16InverttoS24Invert },
 182     { AOUT_FMT_S16_IE, AOUT_FMT_S16_NE,             Swap16 },
 183     { AOUT_FMT_S16_IE, AOUT_FMT_U16_NE,             S16InverttoU16 },
 184     { AOUT_FMT_S16_IE, VLC_FOURCC('s','8',' ',' '), S16InverttoS8 },
 185     { AOUT_FMT_S16_IE, VLC_FOURCC('u','8',' ',' '), S16InverttoU8 },
 186
 187     /* From u16 invert */
 188     { AOUT_FMT_U16_IE, VLC_FOURCC('f','l','3','2'), U16InverttoFloat32 },
 189     { AOUT_FMT_U16_IE, AOUT_FMT_U16_NE,             Swap16 },
 190     { AOUT_FMT_U16_IE, AOUT_FMT_S16_NE,             U16InverttoS16 },
 191     { AOUT_FMT_U16_IE, VLC_FOURCC('s','8',' ',' '), U16InverttoS8 },
 192     { AOUT_FMT_U16_IE, VLC_FOURCC('u','8',' ',' '), U16InverttoU8 },
 193
 194     { 0, 0, NULL },
 195 };
 196
 197
 198 /*****************************************************************************
 199  * Module descriptor
 200  *****************************************************************************/
 201 vlc_module_begin();
 202     set_description( _("Audio filter for PCM format conversion") );
 203     set_category( CAT_AUDIO );
 204     set_subcategory( SUBCAT_AUDIO_MISC );
 205     set_capability( "audio filter2", 1 );
 206     set_callbacks( Open, NULL );
 207 vlc_module_end();
 208
 209 /*****************************************************************************
 210  * Open:
 211  *****************************************************************************/
 212 static int Open( vlc_object_t *p_this )
 213 {
 214     filter_t *p_filter = (filter_t *)p_this;
 215     int i;
 216
 217     for( i = 0; ConvertTable[i].pf_convert != NULL; i++ )
 218     {
 219         if( ConvertTable[i].i_src == p_filter->fmt_in.i_codec &&
 220             ConvertTable[i].i_dst == p_filter->fmt_out.i_codec )
 221             break;
 222     }
 223     if( ConvertTable[i].pf_convert == NULL )
 224         return VLC_EGENERIC;
 225
 226     p_filter->pf_audio_filter = ConvertTable[i].pf_convert;
 227     p_filter->fmt_out.audio = p_filter->fmt_in.audio;
 228     p_filter->fmt_out.audio.i_format = p_filter->fmt_out.i_codec;
 229
 230     msg_Dbg( p_this, "%4.4s->%4.4s, bits per sample: %i",
 231              (char *)&p_filter->fmt_in.i_codec,
 232              (char *)&p_filter->fmt_out.i_codec,
 233              p_filter->fmt_in.audio.i_bitspersample );
 234
 235     return VLC_SUCCESS;
 236 }
 237
 238 /*****************************************************************************
 239  * Convert a buffer
 240  *****************************************************************************/
 241 static block_t *Float32toS24( filter_t *p_filter, block_t *p_block )
 242 {
 243     int i;
 244     float *p_in = (float *)p_block->p_buffer;
 245     uint8_t *p_out = (uint8_t *)p_in;
 246     int32_t out;
 247
 248     for( i = p_block->i_buffer*8/p_filter->fmt_in.audio.i_bitspersample; i--; )
 249     {
 250         if ( *p_in >= 1.0 ) out = 8388607;
 251         else if ( *p_in < -1.0 ) out = -8388608;
 252         else out = *p_in * 8388608.0;
 253
 254 #ifdef WORDS_BIGENDIAN
 255         *((int16_t *)p_out) = out >> 8;
 256         p_out[2] = out & 0xFF;
 257 #else
 258         *((int16_t *)(p_out+1)) = out >> 8;
 259         p_out[0] = out & 0xFF;
 260 #endif
 261
 262         p_in++; p_out += 3;
 263     }
 264
 265     p_block->i_buffer = p_block->i_buffer * 3 / 4;
 266     return p_block;
 267 }
 268
 269 static block_t *Float32toS16( filter_t *p_filter, block_t *p_block )
 270 {
 271     int i;
 272     float *p_in = (float *)p_block->p_buffer;
 273     int16_t *p_out = (int16_t *)p_in;
 274
 275     for( i = p_block->i_buffer*8/p_filter->fmt_in.audio.i_bitspersample; i--; )
 276     {
 277 #if 0
 278         /* Slow version. */
 279         if ( *p_in >= 1.0 ) *p_out = 32767;
 280         else if ( *p_in < -1.0 ) *p_out = -32768;
 281         else *p_out = *p_in * 32768.0;
 282 #else
 283         /* This is walken's trick based on IEEE float format. */
 284         union { float f; int32_t i; } u;
 285         u.f = *p_in + 384.0;
 286         if ( u.i > 0x43c07fff ) *p_out = 32767;
 287         else if ( u.i < 0x43bf8000 ) *p_out = -32768;
 288         else *p_out = u.i - 0x43c00000;
 289 #endif
 290         p_in++; p_out++;
 291     }
 292
 293     p_block->i_buffer /= 2;
 294     return p_block;
 295 }
 296
 297 static block_t *Float32toU16( filter_t *p_filter, block_t *p_block )
 298 {
 299     int i;
 300     float *p_in = (float *)p_block->p_buffer;
 301     uint16_t *p_out = (uint16_t *)p_in;
 302
 303     for( i = p_block->i_buffer*8/p_filter->fmt_in.audio.i_bitspersample; i--; )
 304     {
 305         if ( *p_in >= 1.0 ) *p_out = 65535;
 306         else if ( *p_in < -1.0 ) *p_out = 0;
 307         else *p_out = (uint16_t)(32768 + *p_in * 32768);
 308         p_in++; p_out++;
 309     }
 310
 311     p_block->i_buffer /= 2;
 312     return p_block;
 313 }
 314
 315 static block_t *S24toFloat32( filter_t *p_filter, block_t *p_block )
 316 {
 317     block_t *p_block_out;
 318     uint8_t *p_in;
 319     float *p_out;
 320     int i;
 321
 322     p_block_out =
 323         p_filter->pf_audio_buffer_new( p_filter, p_block->i_buffer*4/3 );
 324     if( !p_block_out )
 325     {
 326         msg_Warn( p_filter, "can't get output buffer" );
 327         return NULL;
 328     }
 329
 330     p_in = p_block->p_buffer;
 331     p_out = (float *)p_block_out->p_buffer;
 332
 333     for( i = p_block->i_buffer*8/p_filter->fmt_in.audio.i_bitspersample; i--; )
 334     {
 335 #ifdef WORDS_BIGENDIAN
 336         *p_out = ((float)( (((int32_t)*(int16_t *)(p_in)) << 8) + p_in[2]))
 337 #else
 338         *p_out = ((float)( (((int32_t)*(int16_t *)(p_in+1)) << 8) + p_in[0]))
 339 #endif
 340             / 8388608.0;
 341
 342         p_in += 3; p_out++;
 343     }
 344
 345     p_block_out->i_samples = p_block->i_samples;
 346     p_block_out->i_dts = p_block->i_dts;
 347     p_block_out->i_pts = p_block->i_pts;
 348     p_block_out->i_length = p_block->i_length;
 349     p_block_out->i_rate = p_block->i_rate;
 350
 351     p_block->pf_release( p_block );
 352     return p_block_out;
 353 }
 354
 355 static block_t *S24toS16( filter_t *p_filter, block_t *p_block )
 356 {
 357     int i;
 358     uint8_t *p_in = (uint8_t *)p_block->p_buffer;
 359     uint8_t *p_out = (uint8_t *)p_in;
 360
 361     for( i = p_block->i_buffer*8/p_filter->fmt_in.audio.i_bitspersample; i--; )
 362     {
 363 #ifdef WORDS_BIGENDIAN
 364         *p_out++ = *p_in++;
 365         *p_out++ = *p_in++;
 366         p_in++;
 367 #else
 368         p_in++;
 369         *p_out++ = *p_in++;
 370         *p_out++ = *p_in++;
 371 #endif
 372     }
 373
 374     p_block->i_buffer = p_block->i_buffer * 2 / 3;
 375     return p_block;
 376 }
 377
 378 static block_t *S16toFloat32( filter_t *p_filter, block_t *p_block )
 379 {
 380     block_t *p_block_out;
 381     int16_t *p_in;
 382     float *p_out;
 383     int i;
 384
 385     p_block_out =
 386         p_filter->pf_audio_buffer_new( p_filter, p_block->i_buffer*2 );
 387     if( !p_block_out )
 388     {
 389         msg_Warn( p_filter, "can't get output buffer" );
 390         return NULL;
 391     }
 392
 393     p_in = (int16_t *)p_block->p_buffer;
 394     p_out = (float *)p_block_out->p_buffer;
 395
 396     for( i = p_block->i_buffer*8/p_filter->fmt_in.audio.i_bitspersample; i--; )
 397     {
 398 #if 0
 399         /* Slow version */
 400         *p_out = (float)*p_in / 32768.0;
 401 #else
 402         /* This is walken's trick based on IEEE float format. On my PIII
 403          * this takes 16 seconds to perform one billion conversions, instead
 404          * of 19 seconds for the above division. */
 405         union { float f; int32_t i; } u;
 406         u.i = *p_in + 0x43c00000;
 407         *p_out = u.f - 384.0;
 408 #endif
 409
 410         p_in++; p_out++;
 411     }
 412
 413     p_block_out->i_samples = p_block->i_samples;
 414     p_block_out->i_dts = p_block->i_dts;
 415     p_block_out->i_pts = p_block->i_pts;
 416     p_block_out->i_length = p_block->i_length;
 417     p_block_out->i_rate = p_block->i_rate;
 418
 419     p_block->pf_release( p_block );
 420     return p_block_out;
 421 }
 422
 423 static block_t *U16toFloat32( filter_t *p_filter, block_t *p_block )
 424 {
 425     block_t *p_block_out;
 426     int16_t *p_in;
 427     float *p_out;
 428     int i;
 429
 430     p_block_out =
 431         p_filter->pf_audio_buffer_new( p_filter, p_block->i_buffer*2 );
 432     if( !p_block_out )
 433     {
 434         msg_Warn( p_filter, "can't get output buffer" );
 435         return NULL;
 436     }
 437
 438     p_in = (int16_t *)p_block->p_buffer;
 439     p_out = (float *)p_block_out->p_buffer;
 440
 441     for( i = p_block->i_buffer*8/p_filter->fmt_in.audio.i_bitspersample; i--; )
 442     {
 443         *p_out++ = (float)(*p_in++ - 32768) / 32768.0;
 444     }
 445
 446     p_block_out->i_samples = p_block->i_samples;
 447     p_block_out->i_dts = p_block->i_dts;
 448     p_block_out->i_pts = p_block->i_pts;
 449     p_block_out->i_length = p_block->i_length;
 450     p_block_out->i_rate = p_block->i_rate;
 451
 452     p_block->pf_release( p_block );
 453     return p_block_out;
 454 }
 455
 456 static block_t *S16toS24( filter_t *p_filter, block_t *p_block )
 457 {
 458     block_t *p_block_out;
 459     uint8_t *p_in, *p_out;
 460     int i;
 461
 462     p_block_out =
 463         p_filter->pf_audio_buffer_new( p_filter, p_block->i_buffer*3/2 );
 464     if( !p_block_out )
 465     {
 466         msg_Warn( p_filter, "can't get output buffer" );
 467         return NULL;
 468     }
 469
 470     p_in = (uint8_t *)p_block->p_buffer;
 471     p_out = (uint8_t *)p_block_out->p_buffer;
 472
 473     for( i = p_block->i_buffer*8/p_filter->fmt_in.audio.i_bitspersample; i--; )
 474     {
 475 #ifdef WORDS_BIGENDIAN
 476         *p_out++ = *p_in++;
 477         *p_out++ = *p_in++;
 478         *p_out++ = 0;
 479 #else
 480         *p_out++ = 0;
 481         *p_out++ = *p_in++;
 482         *p_out++ = *p_in++;
 483 #endif
 484     }
 485
 486     p_block_out->i_samples = p_block->i_samples;
 487     p_block_out->i_dts = p_block->i_dts;
 488     p_block_out->i_pts = p_block->i_pts;
 489     p_block_out->i_length = p_block->i_length;
 490     p_block_out->i_rate = p_block->i_rate;
 491
 492     p_block->pf_release( p_block );
 493     return p_block_out;
 494 }
 495
 496 static block_t *S16toS8( filter_t *p_filter, block_t *p_block )
 497 {
 498     int i;
 499     int16_t *p_in = (int16_t *)p_block->p_buffer;
 500     int8_t *p_out = (int8_t *)p_in;
 501
 502     for( i = p_block->i_buffer*8/p_filter->fmt_in.audio.i_bitspersample; i--; )
 503         *p_out++ = (*p_in++) >> 8;
 504
 505     p_block->i_buffer /= 2;
 506     return p_block;
 507 }
 508 static block_t *S16toU8( filter_t *p_filter, block_t *p_block )
 509 {
 510     int i;
 511     int16_t *p_in = (int16_t *)p_block->p_buffer;
 512     uint8_t *p_out = (uint8_t *)p_in;
 513
 514     for( i = p_block->i_buffer*8/p_filter->fmt_in.audio.i_bitspersample; i--; )
 515         *p_out++ = ((*p_in++) + 32768) >> 8;
 516
 517     p_block->i_buffer /= 2;
 518     return p_block;
 519 }
 520 static block_t *S16toU16( filter_t *p_filter, block_t *p_block )
 521 {
 522     int i;
 523     int16_t *p_in = (int16_t *)p_block->p_buffer;
 524     uint16_t *p_out = (uint16_t *)p_in;
 525
 526     for( i = p_block->i_buffer*8/p_filter->fmt_in.audio.i_bitspersample; i--; )
 527         *p_out++ = (*p_in++) + 32768;
 528
 529     return p_block;
 530 }
 531
 532 static block_t *U16toS8( filter_t *p_filter, block_t *p_block )
 533 {
 534     int i;
 535     uint16_t *p_in = (uint16_t *)p_block->p_buffer;
 536     int8_t *p_out = (int8_t *)p_in;
 537
 538     for( i = p_block->i_buffer*8/p_filter->fmt_in.audio.i_bitspersample; i--; )
 539         *p_out++ = ((int)(*p_in++) - 32768) >> 8;
 540
 541     p_block->i_buffer /= 2;
 542     return p_block;
 543 }
 544 static block_t *U16toU8( filter_t *p_filter, block_t *p_block )
 545 {
 546     int i;
 547     uint16_t *p_in = (uint16_t *)p_block->p_buffer;
 548     uint8_t *p_out = (uint8_t *)p_in;
 549
 550     for( i = p_block->i_buffer*8/p_filter->fmt_in.audio.i_bitspersample; i--; )
 551         *p_out++ = (*p_in++) >> 8;
 552
 553     p_block->i_buffer /= 2;
 554     return p_block;
 555 }
 556 static block_t *U16toS16( filter_t *p_filter, block_t *p_block )
 557 {
 558     int i;
 559     int16_t *p_in = (int16_t *)p_block->p_buffer;
 560     uint16_t *p_out = (uint16_t *)p_in;
 561
 562     for( i = p_block->i_buffer*8/p_filter->fmt_in.audio.i_bitspersample; i--; )
 563         *p_out++ = (int)(*p_in++) - 32768;
 564
 565     return p_block;
 566 }
 567
 568 static block_t *S8toU8( filter_t *p_filter, block_t *p_block )
 569 {
 570     int i;
 571     int8_t *p_in = (int8_t *)p_block->p_buffer;
 572     uint8_t *p_out = (uint8_t *)p_in;
 573
 574     for( i = p_block->i_buffer*8/p_filter->fmt_in.audio.i_bitspersample; i--; )
 575         *p_out++ = ((*p_in++) + 128);
 576
 577     return p_block;
 578 }
 579 static block_t *U8toS8( filter_t *p_filter, block_t *p_block )
 580 {
 581     int i;
 582     uint8_t *p_in = (uint8_t *)p_block->p_buffer;
 583     int8_t *p_out = (int8_t *)p_in;
 584
 585     for( i = p_block->i_buffer*8/p_filter->fmt_in.audio.i_bitspersample; i--; )
 586         *p_out++ = ((*p_in++) - 128);
 587
 588     return p_block;
 589 }
 590
 591 /* */
 592 static block_t *S8toU16( filter_t *p_filter, block_t *p_block )
 593 {
 594     block_t *p_block_out;
 595     int8_t *p_in;
 596     uint16_t *p_out;
 597     int i;
 598
 599     p_block_out =
 600         p_filter->pf_audio_buffer_new( p_filter, p_block->i_buffer*2 );
 601     if( !p_block_out )
 602     {
 603         msg_Warn( p_filter, "can't get output buffer" );
 604         return NULL;
 605     }
 606
 607     p_in = (int8_t *)p_block->p_buffer;
 608     p_out = (uint16_t *)p_block_out->p_buffer;
 609
 610     for( i = p_block->i_buffer*8/p_filter->fmt_in.audio.i_bitspersample; i--; )
 611         *p_out++ = ((*p_in++) + 128) << 8;
 612
 613     p_block_out->i_samples = p_block->i_samples;
 614     p_block_out->i_dts = p_block->i_dts;
 615     p_block_out->i_pts = p_block->i_pts;
 616     p_block_out->i_length = p_block->i_length;
 617     p_block_out->i_rate = p_block->i_rate;
 618
 619     p_block->pf_release( p_block );
 620     return p_block_out;
 621 }
 622
 623 static block_t *U8toS16( filter_t *p_filter, block_t *p_block )
 624 {
 625     block_t *p_block_out;
 626     uint8_t *p_in;
 627     int16_t *p_out;
 628     int i;
 629
 630     p_block_out =
 631         p_filter->pf_audio_buffer_new( p_filter, p_block->i_buffer*2 );
 632     if( !p_block_out )
 633     {
 634         msg_Warn( p_filter, "can't get output buffer" );
 635         return NULL;
 636     }
 637
 638     p_in = (uint8_t *)p_block->p_buffer;
 639     p_out = (int16_t *)p_block_out->p_buffer;
 640
 641     for( i = p_block->i_buffer*8/p_filter->fmt_in.audio.i_bitspersample; i--; )
 642         *p_out++ = ((*p_in++) - 128) << 8;
 643
 644     p_block_out->i_samples = p_block->i_samples;
 645     p_block_out->i_dts = p_block->i_dts;
 646     p_block_out->i_pts = p_block->i_pts;
 647     p_block_out->i_length = p_block->i_length;
 648     p_block_out->i_rate = p_block->i_rate;
 649
 650     p_block->pf_release( p_block );
 651     return p_block_out;
 652 }
 653
 654
 655 static block_t *S8toS16( filter_t *p_filter, block_t *p_block )
 656 {
 657     block_t *p_block_out;
 658     int8_t *p_in;
 659     int16_t *p_out;
 660     int i;
 661
 662     p_block_out =
 663         p_filter->pf_audio_buffer_new( p_filter, p_block->i_buffer*2 );
 664     if( !p_block_out )
 665     {
 666         msg_Warn( p_filter, "can't get output buffer" );
 667         return NULL;
 668     }
 669
 670     p_in = (int8_t *)p_block->p_buffer;
 671     p_out = (int16_t *)p_block_out->p_buffer;
 672
 673     for( i = p_block->i_buffer*8/p_filter->fmt_in.audio.i_bitspersample; i--; )
 674         *p_out++ = (*p_in++) << 8;
 675
 676     p_block_out->i_samples = p_block->i_samples;
 677     p_block_out->i_dts = p_block->i_dts;
 678     p_block_out->i_pts = p_block->i_pts;
 679     p_block_out->i_length = p_block->i_length;
 680     p_block_out->i_rate = p_block->i_rate;
 681
 682     p_block->pf_release( p_block );
 683     return p_block_out;
 684 }
 685
 686 static block_t *U8toU16( filter_t *p_filter, block_t *p_block )
 687 {
 688     block_t *p_block_out;
 689     uint8_t *p_in;
 690     uint16_t *p_out;
 691     int i;
 692
 693     p_block_out =
 694         p_filter->pf_audio_buffer_new( p_filter, p_block->i_buffer*2 );
 695     if( !p_block_out )
 696     {
 697         msg_Warn( p_filter, "can't get output buffer" );
 698         return NULL;
 699     }
 700
 701     p_in = (uint8_t *)p_block->p_buffer;
 702     p_out = (uint16_t *)p_block_out->p_buffer;
 703
 704     for( i = p_block->i_buffer*8/p_filter->fmt_in.audio.i_bitspersample; i--; )
 705         *p_out++ = (*p_in++) << 8;
 706
 707     p_block_out->i_samples = p_block->i_samples;
 708     p_block_out->i_dts = p_block->i_dts;
 709     p_block_out->i_pts = p_block->i_pts;
 710     p_block_out->i_length = p_block->i_length;
 711     p_block_out->i_rate = p_block->i_rate;
 712
 713     p_block->pf_release( p_block );
 714     return p_block_out;
 715 }
 716
 717 /*****************************************************************************
 718  * Swap a buffer of words
 719  *****************************************************************************/
 720 static block_t *Swap16( filter_t *p_filter, block_t *p_block )
 721 {
 722     int i;
 723     uint8_t *p_in = (uint8_t *)p_block->p_buffer;
 724     uint8_t tmp;
 725
 726     for( i = 0; i < p_block->i_buffer / 2; i++ )
 727     {
 728         tmp = p_in[0];
 729         p_in[0] = p_in[1];
 730         p_in[1] = tmp;
 731         p_in += 2;
 732     }
 733
 734     return p_block;
 735 }
 736
 737 static block_t *Swap24( filter_t *p_filter, block_t *p_block )
 738 {
 739     int i;
 740     uint8_t *p_in = (uint8_t *)p_block->p_buffer;
 741     uint8_t tmp;
 742
 743     for( i = 0; i < p_block->i_buffer / 3; i++ )
 744     {
 745         tmp = p_in[0];
 746         p_in[0] = p_in[2];
 747         p_in[2] = tmp;
 748         p_in += 3;
 749     }
 750
 751     return p_block;
 752 }
 753
 754 #define CONVERT_NN( func, f_in, f_out, b_pre_invert, b_post_invert, swapa, swapb ) \
 755 static block_t *func( filter_t *p_filter, block_t *p_block ) \
 756 {                                                   \
 757     if( b_pre_invert )                              \
 758         swapa( p_filter, p_block );                  \
 759                                                     \
 760     p_block = f_in##to##f_out( p_filter, p_block ); \
 761                                                     \
 762     if( b_post_invert )                             \
 763         swapb( p_filter, p_block );                  \
 764                                                     \
 765     return p_block;                                 \
 766 }
 767
 768 CONVERT_NN( Float32toS24Invert, Float32, S24, 0, 1, Swap24, Swap24 )
 769 CONVERT_NN( Float32toS16Invert, Float32, S16, 0, 1, Swap16, Swap16 )
 770 CONVERT_NN( Float32toU16Invert, Float32, U16, 0, 1, Swap16, Swap16 )
 771
 772 CONVERT_NN( S24InverttoFloat32, S24, Float32, 1, 0, Swap24, Swap24 )
 773 CONVERT_NN( S24InverttoS16,     S24, S16,     1, 0, Swap24, Swap16 )
 774 CONVERT_NN( S24InverttoS16Invert, S24, S16,   1, 1, Swap24, Swap16 )
 775 CONVERT_NN( S24toS16Invert,     S24, S16,     0, 1, Swap24, Swap16 )
 776
 777 CONVERT_NN( S16InverttoFloat32, S16, Float32, 1, 0, Swap16, Swap16 )
 778 CONVERT_NN( S16InverttoS24,     S16, S24,     1, 0, Swap16, Swap24 )
 779 CONVERT_NN( S16toS24Invert,     S16, S24,     0, 1, Swap16, Swap24 )
 780 CONVERT_NN( S16InverttoS24Invert, S16, S24,   1, 1, Swap16, Swap24 )
 781 CONVERT_NN( S16InverttoS8,      S16, S8,      1, 0, Swap16, Swap16 )
 782 CONVERT_NN( S16InverttoU8,      S16, U8,      1, 0, Swap16, Swap16 )
 783 CONVERT_NN( S16InverttoU16,     S16, U16,     1, 0, Swap16, Swap16 )
 784
 785 CONVERT_NN( U16InverttoFloat32, U16, Float32, 1, 0, Swap16, Swap16 )
 786 CONVERT_NN( U16InverttoS8,      U16, S8,      1, 0, Swap16, Swap16 )
 787 CONVERT_NN( U16InverttoU8,      U16, U8,      1, 0, Swap16, Swap16 )
 788 CONVERT_NN( U16InverttoS16,     U16, S16,     1, 0, Swap16, Swap16 )
 789
 790 #undef CONVERT_NN
 791
 792 #define CONVERT_INDIRECT( func, f_in, f_mid, f_out )                    \
 793 static block_t *func( filter_t *p_filter, block_t *p_block )            \
 794 {                                                                       \
 795     return f_mid##to##f_out( p_filter,                                  \
 796                              f_in##to##f_mid( p_filter, p_block ) );    \
 797 }
 798
 799 CONVERT_INDIRECT( Float32toS8,   Float32, S16, U8 )
 800 CONVERT_INDIRECT( Float32toU8,   Float32, U16, U8 )
 801 CONVERT_INDIRECT( S8toFloat32,   S8,      S16, Float32 )
 802 CONVERT_INDIRECT( U8toFloat32,   U8,      U16, Float32 )
 803
 804 #define S16toS16Invert Swap16
 805 #define U16toU16Invert Swap16
 806
 807 CONVERT_INDIRECT( U8toS16Invert, U8,      S16, S16Invert )
 808 CONVERT_INDIRECT( S8toU16Invert, S8,      U16, U16Invert )
 809
 810 CONVERT_INDIRECT( U8toU16Invert, U8,      U16, U16Invert )
 811 CONVERT_INDIRECT( S8toS16Invert, S8,      S16, S16Invert )
 812
 813 #undef CONVERT_INDIRECT