git.sesse.net Git - vlc/blob - src/audio_output/common.c

   1 /*****************************************************************************
   2  * common.c : audio output management of common data structures
   3  *****************************************************************************
   4  * Copyright (C) 2002-2007 the VideoLAN team
   5  * $Id$
   6  *
   7  * Authors: Christophe Massiot <massiot@via.ecp.fr>
   8  *
   9  * This program is free software; you can redistribute it and/or modify
  10  * it under the terms of the GNU General Public License as published by
  11  * the Free Software Foundation; either version 2 of the License, or
  12  * (at your option) any later version.
  13  *
  14  * This program is distributed in the hope that it will be useful,
  15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17  * GNU General Public License for more details.
  18  *
  19  * You should have received a copy of the GNU General Public License
  20  * along with this program; if not, write to the Free Software
  21  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301, USA.
  22  *****************************************************************************/
  23
  24 /*****************************************************************************
  25  * Preamble
  26  *****************************************************************************/
  27 #ifdef HAVE_CONFIG_H
  28 # include "config.h"
  29 #endif
  30
  31 #include <assert.h>
  32
  33 #include <vlc_common.h>
  34 #include <vlc_aout.h>
  35 #include "aout_internal.h"
  36 #include "libvlc.h"
  37
  38 /*
  39  * Instances management (internal and external)
  40  */
  41
  42 #define AOUT_ASSERT_FIFO_LOCKED aout_assert_fifo_locked(p_aout, p_fifo)
  43 static inline void aout_assert_fifo_locked( aout_instance_t * p_aout, aout_fifo_t * p_fifo )
  44 {
  45 #ifndef NDEBUG
  46     if( p_fifo == &p_aout->output.fifo )
  47         vlc_assert_locked( &p_aout->output_fifo_lock );
  48     else
  49     {
  50         int i;
  51         for( i = 0; i < p_aout->i_nb_inputs; i++ )
  52         {
  53             if( p_fifo == &p_aout->pp_inputs[i]->fifo)
  54             {
  55                 vlc_assert_locked( &p_aout->input_fifos_lock );
  56                 break;
  57             }
  58         }
  59         if( i == p_aout->i_nb_inputs )
  60             vlc_assert_locked( &p_aout->mixer_lock );
  61     }
  62 #else
  63     (void)p_aout;
  64     (void)p_fifo;
  65 #endif
  66 }
  67
  68 /* Local functions */
  69 static void aout_Destructor( vlc_object_t * p_this );
  70
  71 /*****************************************************************************
  72  * aout_New: initialize aout structure
  73  *****************************************************************************/
  74 aout_instance_t * __aout_New( vlc_object_t * p_parent )
  75 {
  76     aout_instance_t * p_aout;
  77     vlc_value_t val;
  78
  79     /* Allocate descriptor. */
  80     p_aout = vlc_object_create( p_parent, VLC_OBJECT_AOUT );
  81     if( p_aout == NULL )
  82     {
  83         return NULL;
  84     }
  85
  86     /* Initialize members. */
  87     vlc_mutex_init( &p_aout->input_fifos_lock );
  88     vlc_mutex_init( &p_aout->mixer_lock );
  89     vlc_mutex_init( &p_aout->output_fifo_lock );
  90     p_aout->i_nb_inputs = 0;
  91     p_aout->mixer.f_multiplier = 1.0;
  92     p_aout->mixer.b_error = 1;
  93     p_aout->output.b_error = 1;
  94     p_aout->output.b_starving = 1;
  95
  96     var_Create( p_aout, "intf-change", VLC_VAR_BOOL );
  97     val.b_bool = true;
  98     var_Set( p_aout, "intf-change", val );
  99
 100     vlc_object_set_destructor( p_aout, aout_Destructor );
 101
 102     return p_aout;
 103 }
 104
 105 /*****************************************************************************
 106  * aout_Destructor: destroy aout structure
 107  *****************************************************************************/
 108 static void aout_Destructor( vlc_object_t * p_this )
 109 {
 110     aout_instance_t * p_aout = (aout_instance_t *)p_this;
 111     vlc_mutex_destroy( &p_aout->input_fifos_lock );
 112     vlc_mutex_destroy( &p_aout->mixer_lock );
 113     vlc_mutex_destroy( &p_aout->output_fifo_lock );
 114 }
 115
 116
 117 /*
 118  * Formats management (internal and external)
 119  */
 120
 121 /*****************************************************************************
 122  * aout_FormatNbChannels : return the number of channels
 123  *****************************************************************************/
 124 unsigned int aout_FormatNbChannels( const audio_sample_format_t * p_format )
 125 {
 126     static const uint32_t pi_channels[] =
 127         { AOUT_CHAN_CENTER, AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT,
 128           AOUT_CHAN_REARCENTER, AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT,
 129           AOUT_CHAN_MIDDLELEFT, AOUT_CHAN_MIDDLERIGHT, AOUT_CHAN_LFE };
 130     unsigned int i_nb = 0, i;
 131
 132     for ( i = 0; i < sizeof(pi_channels)/sizeof(uint32_t); i++ )
 133     {
 134         if ( p_format->i_physical_channels & pi_channels[i] ) i_nb++;
 135     }
 136
 137     return i_nb;
 138 }
 139
 140 /*****************************************************************************
 141  * aout_BitsPerSample : get the number of bits per sample
 142  *****************************************************************************/
 143 unsigned int aout_BitsPerSample( vlc_fourcc_t i_format )
 144 {
 145     switch( i_format )
 146     {
 147     case VLC_CODEC_U8:
 148     case VLC_CODEC_S8:
 149         return 8;
 150
 151     case VLC_CODEC_U16L:
 152     case VLC_CODEC_S16L:
 153     case VLC_CODEC_U16B:
 154     case VLC_CODEC_S16B:
 155         return 16;
 156
 157     case VLC_CODEC_U24L:
 158     case VLC_CODEC_S24L:
 159     case VLC_CODEC_U24B:
 160     case VLC_CODEC_S24B:
 161         return 24;
 162
 163     case VLC_CODEC_S32L:
 164     case VLC_CODEC_S32B:
 165     case VLC_CODEC_FL32:
 166     case VLC_CODEC_FI32:
 167         return 32;
 168
 169     case VLC_CODEC_FL64:
 170         return 64;
 171
 172     default:
 173         /* For these formats the caller has to indicate the parameters
 174          * by hand. */
 175         return 0;
 176     }
 177 }
 178
 179 /*****************************************************************************
 180  * aout_FormatPrepare : compute the number of bytes per frame & frame length
 181  *****************************************************************************/
 182 void aout_FormatPrepare( audio_sample_format_t * p_format )
 183 {
 184     p_format->i_bitspersample = aout_BitsPerSample( p_format->i_format );
 185     if( p_format->i_bitspersample > 0 )
 186     {
 187         p_format->i_bytes_per_frame = ( p_format->i_bitspersample / 8 )
 188                                     * aout_FormatNbChannels( p_format );
 189         p_format->i_frame_length = 1;
 190     }
 191 }
 192
 193 /*****************************************************************************
 194  * aout_FormatPrintChannels : print a channel in a human-readable form
 195  *****************************************************************************/
 196 const char * aout_FormatPrintChannels( const audio_sample_format_t * p_format )
 197 {
 198     switch ( p_format->i_physical_channels & AOUT_CHAN_PHYSMASK )
 199     {
 200     case AOUT_CHAN_LEFT:
 201     case AOUT_CHAN_RIGHT:
 202     case AOUT_CHAN_CENTER:
 203         if ( (p_format->i_original_channels & AOUT_CHAN_CENTER)
 204               || (p_format->i_original_channels
 205                    & (AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT)) )
 206             return "Mono";
 207         else if ( p_format->i_original_channels & AOUT_CHAN_LEFT )
 208             return "Left";
 209         return "Right";
 210     case AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT:
 211         if ( p_format->i_original_channels & AOUT_CHAN_REVERSESTEREO )
 212         {
 213             if ( p_format->i_original_channels & AOUT_CHAN_DOLBYSTEREO )
 214                 return "Dolby/Reverse";
 215             return "Stereo/Reverse";
 216         }
 217         else
 218         {
 219             if ( p_format->i_original_channels & AOUT_CHAN_DOLBYSTEREO )
 220                 return "Dolby";
 221             else if ( p_format->i_original_channels & AOUT_CHAN_DUALMONO )
 222                 return "Dual-mono";
 223             else if ( p_format->i_original_channels == AOUT_CHAN_CENTER )
 224                 return "Stereo/Mono";
 225             else if ( !(p_format->i_original_channels & AOUT_CHAN_RIGHT) )
 226                 return "Stereo/Left";
 227             else if ( !(p_format->i_original_channels & AOUT_CHAN_LEFT) )
 228                 return "Stereo/Right";
 229             return "Stereo";
 230         }
 231     case AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER:
 232         return "3F";
 233     case AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_REARCENTER:
 234         return "2F1R";
 235     case AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER
 236           | AOUT_CHAN_REARCENTER:
 237         return "3F1R";
 238     case AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT
 239           | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT:
 240         return "2F2R";
 241     case AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT
 242           | AOUT_CHAN_MIDDLELEFT | AOUT_CHAN_MIDDLERIGHT:
 243         return "2F2M";
 244     case AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER
 245           | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT:
 246         return "3F2R";
 247     case AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER
 248           | AOUT_CHAN_MIDDLELEFT | AOUT_CHAN_MIDDLERIGHT:
 249         return "3F2M";
 250
 251     case AOUT_CHAN_CENTER | AOUT_CHAN_LFE:
 252         if ( (p_format->i_original_channels & AOUT_CHAN_CENTER)
 253               || (p_format->i_original_channels
 254                    & (AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT)) )
 255             return "Mono/LFE";
 256         else if ( p_format->i_original_channels & AOUT_CHAN_LEFT )
 257             return "Left/LFE";
 258         return "Right/LFE";
 259     case AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_LFE:
 260         if ( p_format->i_original_channels & AOUT_CHAN_DOLBYSTEREO )
 261             return "Dolby/LFE";
 262         else if ( p_format->i_original_channels & AOUT_CHAN_DUALMONO )
 263             return "Dual-mono/LFE";
 264         else if ( p_format->i_original_channels == AOUT_CHAN_CENTER )
 265             return "Mono/LFE";
 266         else if ( !(p_format->i_original_channels & AOUT_CHAN_RIGHT) )
 267             return "Stereo/Left/LFE";
 268         else if ( !(p_format->i_original_channels & AOUT_CHAN_LEFT) )
 269             return "Stereo/Right/LFE";
 270          return "Stereo/LFE";
 271     case AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER | AOUT_CHAN_LFE:
 272         return "3F/LFE";
 273     case AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_REARCENTER
 274           | AOUT_CHAN_LFE:
 275         return "2F1R/LFE";
 276     case AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER
 277           | AOUT_CHAN_REARCENTER | AOUT_CHAN_LFE:
 278         return "3F1R/LFE";
 279     case AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT
 280           | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT | AOUT_CHAN_LFE:
 281         return "2F2R/LFE";
 282     case AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT
 283           | AOUT_CHAN_MIDDLELEFT | AOUT_CHAN_MIDDLERIGHT | AOUT_CHAN_LFE:
 284         return "2F2M/LFE";
 285     case AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER
 286           | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT | AOUT_CHAN_LFE:
 287         return "3F2R/LFE";
 288     case AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER
 289           | AOUT_CHAN_MIDDLELEFT | AOUT_CHAN_MIDDLERIGHT | AOUT_CHAN_LFE:
 290         return "3F2M/LFE";
 291     case AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER
 292           | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT | AOUT_CHAN_MIDDLELEFT
 293           | AOUT_CHAN_MIDDLERIGHT:
 294         return "3F2M2R";
 295     case AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER
 296           | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT | AOUT_CHAN_MIDDLELEFT
 297           | AOUT_CHAN_MIDDLERIGHT | AOUT_CHAN_LFE:
 298         return "3F2M2R/LFE";
 299     }
 300
 301     return "ERROR";
 302 }
 303
 304 /*****************************************************************************
 305  * aout_FormatPrint : print a format in a human-readable form
 306  *****************************************************************************/
 307 void aout_FormatPrint( aout_instance_t * p_aout, const char * psz_text,
 308                        const audio_sample_format_t * p_format )
 309 {
 310     msg_Dbg( p_aout, "%s '%4.4s' %d Hz %s frame=%d samples/%d bytes", psz_text,
 311              (char *)&p_format->i_format, p_format->i_rate,
 312              aout_FormatPrintChannels( p_format ),
 313              p_format->i_frame_length, p_format->i_bytes_per_frame );
 314 }
 315
 316 /*****************************************************************************
 317  * aout_FormatsPrint : print two formats in a human-readable form
 318  *****************************************************************************/
 319 void aout_FormatsPrint( aout_instance_t * p_aout, const char * psz_text,
 320                         const audio_sample_format_t * p_format1,
 321                         const audio_sample_format_t * p_format2 )
 322 {
 323     msg_Dbg( p_aout, "%s '%4.4s'->'%4.4s' %d Hz->%d Hz %s->%s",
 324              psz_text,
 325              (char *)&p_format1->i_format, (char *)&p_format2->i_format,
 326              p_format1->i_rate, p_format2->i_rate,
 327              aout_FormatPrintChannels( p_format1 ),
 328              aout_FormatPrintChannels( p_format2 ) );
 329 }
 330
 331
 332 /*
 333  * FIFO management (internal) - please understand that solving race conditions
 334  * is _your_ job, ie. in the audio output you should own the mixer lock
 335  * before calling any of these functions.
 336  */
 337
 338 /*****************************************************************************
 339  * aout_FifoInit : initialize the members of a FIFO
 340  *****************************************************************************/
 341 void aout_FifoInit( aout_instance_t * p_aout, aout_fifo_t * p_fifo,
 342                     uint32_t i_rate )
 343 {
 344     AOUT_ASSERT_FIFO_LOCKED;
 345
 346     if( i_rate == 0 )
 347     {
 348         msg_Err( p_aout, "initialising fifo with zero divider" );
 349     }
 350
 351     p_fifo->p_first = NULL;
 352     p_fifo->pp_last = &p_fifo->p_first;
 353     date_Init( &p_fifo->end_date, i_rate, 1 );
 354 }
 355
 356 /*****************************************************************************
 357  * aout_FifoPush : push a packet into the FIFO
 358  *****************************************************************************/
 359 void aout_FifoPush( aout_instance_t * p_aout, aout_fifo_t * p_fifo,
 360                     aout_buffer_t * p_buffer )
 361 {
 362     (void)p_aout;
 363     AOUT_ASSERT_FIFO_LOCKED;
 364
 365     *p_fifo->pp_last = p_buffer;
 366     p_fifo->pp_last = &p_buffer->p_next;
 367     *p_fifo->pp_last = NULL;
 368     /* Enforce the continuity of the stream. */
 369     if ( date_Get( &p_fifo->end_date ) )
 370     {
 371         p_buffer->start_date = date_Get( &p_fifo->end_date );
 372         p_buffer->end_date = date_Increment( &p_fifo->end_date,
 373                                              p_buffer->i_nb_samples );
 374     }
 375     else
 376     {
 377         date_Set( &p_fifo->end_date, p_buffer->end_date );
 378     }
 379 }
 380
 381 /*****************************************************************************
 382  * aout_FifoSet : set end_date and trash all buffers (because they aren't
 383  * properly dated)
 384  *****************************************************************************/
 385 void aout_FifoSet( aout_instance_t * p_aout, aout_fifo_t * p_fifo,
 386                    mtime_t date )
 387 {
 388     aout_buffer_t * p_buffer;
 389     (void)p_aout;
 390     AOUT_ASSERT_FIFO_LOCKED;
 391
 392     date_Set( &p_fifo->end_date, date );
 393     p_buffer = p_fifo->p_first;
 394     while ( p_buffer != NULL )
 395     {
 396         aout_buffer_t * p_next = p_buffer->p_next;
 397         aout_BufferFree( p_buffer );
 398         p_buffer = p_next;
 399     }
 400     p_fifo->p_first = NULL;
 401     p_fifo->pp_last = &p_fifo->p_first;
 402 }
 403
 404 /*****************************************************************************
 405  * aout_FifoMoveDates : Move forwards or backwards all dates in the FIFO
 406  *****************************************************************************/
 407 void aout_FifoMoveDates( aout_instance_t * p_aout, aout_fifo_t * p_fifo,
 408                          mtime_t difference )
 409 {
 410     aout_buffer_t * p_buffer;
 411     (void)p_aout;
 412     AOUT_ASSERT_FIFO_LOCKED;
 413
 414     date_Move( &p_fifo->end_date, difference );
 415     p_buffer = p_fifo->p_first;
 416     while ( p_buffer != NULL )
 417     {
 418         p_buffer->start_date += difference;
 419         p_buffer->end_date += difference;
 420         p_buffer = p_buffer->p_next;
 421     }
 422 }
 423
 424 /*****************************************************************************
 425  * aout_FifoNextStart : return the current end_date
 426  *****************************************************************************/
 427 mtime_t aout_FifoNextStart( aout_instance_t * p_aout, aout_fifo_t * p_fifo )
 428 {
 429     (void)p_aout;
 430     AOUT_ASSERT_FIFO_LOCKED;
 431     return date_Get( &p_fifo->end_date );
 432 }
 433
 434 /*****************************************************************************
 435  * aout_FifoFirstDate : return the playing date of the first buffer in the
 436  * FIFO
 437  *****************************************************************************/
 438 mtime_t aout_FifoFirstDate( aout_instance_t * p_aout, aout_fifo_t * p_fifo )
 439 {
 440     (void)p_aout;
 441     AOUT_ASSERT_FIFO_LOCKED;
 442     return p_fifo->p_first ?  p_fifo->p_first->start_date : 0;
 443 }
 444
 445 /*****************************************************************************
 446  * aout_FifoPop : get the next buffer out of the FIFO
 447  *****************************************************************************/
 448 aout_buffer_t * aout_FifoPop( aout_instance_t * p_aout, aout_fifo_t * p_fifo )
 449 {
 450     aout_buffer_t * p_buffer;
 451     (void)p_aout;
 452     AOUT_ASSERT_FIFO_LOCKED;
 453
 454     p_buffer = p_fifo->p_first;
 455     if ( p_buffer == NULL ) return NULL;
 456     p_fifo->p_first = p_buffer->p_next;
 457     if ( p_fifo->p_first == NULL )
 458     {
 459         p_fifo->pp_last = &p_fifo->p_first;
 460     }
 461
 462     return p_buffer;
 463 }
 464
 465 /*****************************************************************************
 466  * aout_FifoDestroy : destroy a FIFO and its buffers
 467  *****************************************************************************/
 468 void aout_FifoDestroy( aout_instance_t * p_aout, aout_fifo_t * p_fifo )
 469 {
 470     aout_buffer_t * p_buffer;
 471     (void)p_aout;
 472     AOUT_ASSERT_FIFO_LOCKED;
 473
 474     p_buffer = p_fifo->p_first;
 475     while ( p_buffer != NULL )
 476     {
 477         aout_buffer_t * p_next = p_buffer->p_next;
 478         aout_BufferFree( p_buffer );
 479         p_buffer = p_next;
 480     }
 481
 482     p_fifo->p_first = NULL;
 483     p_fifo->pp_last = &p_fifo->p_first;
 484 }
 485
 486 /*****************************************************************************
 487  * aout_CheckChannelReorder : Check if we need to do some channel re-ordering
 488  *****************************************************************************/
 489 int aout_CheckChannelReorder( const uint32_t *pi_chan_order_in,
 490                               const uint32_t *pi_chan_order_out,
 491                               uint32_t i_channel_mask,
 492                               int i_channels, int *pi_chan_table )
 493 {
 494     bool b_chan_reorder = false;
 495     int i, j, k, l;
 496
 497     if( i_channels > AOUT_CHAN_MAX )
 498         return false;
 499
 500     if( pi_chan_order_in == NULL )
 501         pi_chan_order_in = pi_vlc_chan_order_wg4;
 502     if( pi_chan_order_out == NULL )
 503         pi_chan_order_out = pi_vlc_chan_order_wg4;
 504
 505     for( i = 0, j = 0; pi_chan_order_in[i]; i++ )
 506     {
 507         if( !(i_channel_mask & pi_chan_order_in[i]) ) continue;
 508
 509         for( k = 0, l = 0; pi_chan_order_in[i] != pi_chan_order_out[k]; k++ )
 510         {
 511             if( i_channel_mask & pi_chan_order_out[k] ) l++;
 512         }
 513
 514         pi_chan_table[j++] = l;
 515     }
 516
 517     for( i = 0; i < i_channels; i++ )
 518     {
 519         if( pi_chan_table[i] != i ) b_chan_reorder = true;
 520     }
 521
 522     return b_chan_reorder;
 523 }
 524
 525 /*****************************************************************************
 526  * aout_ChannelReorder :
 527  *****************************************************************************/
 528 void aout_ChannelReorder( uint8_t *p_buf, int i_buffer,
 529                           int i_channels, const int *pi_chan_table,
 530                           int i_bits_per_sample )
 531 {
 532     uint8_t p_tmp[AOUT_CHAN_MAX * 4];
 533     int i, j;
 534
 535     if( i_bits_per_sample == 8 )
 536     {
 537         for( i = 0; i < i_buffer / i_channels; i++ )
 538         {
 539             for( j = 0; j < i_channels; j++ )
 540             {
 541                 p_tmp[pi_chan_table[j]] = p_buf[j];
 542             }
 543
 544             memcpy( p_buf, p_tmp, i_channels );
 545             p_buf += i_channels;
 546         }
 547     }
 548     else if( i_bits_per_sample == 16 )
 549     {
 550         for( i = 0; i < i_buffer / i_channels / 2; i++ )
 551         {
 552             for( j = 0; j < i_channels; j++ )
 553             {
 554                 p_tmp[2 * pi_chan_table[j]]     = p_buf[2 * j];
 555                 p_tmp[2 * pi_chan_table[j] + 1] = p_buf[2 * j + 1];
 556             }
 557
 558             memcpy( p_buf, p_tmp, 2 * i_channels );
 559             p_buf += 2 * i_channels;
 560         }
 561     }
 562     else if( i_bits_per_sample == 24 )
 563     {
 564         for( i = 0; i < i_buffer / i_channels / 3; i++ )
 565         {
 566             for( j = 0; j < i_channels; j++ )
 567             {
 568                 p_tmp[3 * pi_chan_table[j]]     = p_buf[3 * j];
 569                 p_tmp[3 * pi_chan_table[j] + 1] = p_buf[3 * j + 1];
 570                 p_tmp[3 * pi_chan_table[j] + 2] = p_buf[3 * j + 2];
 571             }
 572
 573             memcpy( p_buf, p_tmp, 3 * i_channels );
 574             p_buf += 3 * i_channels;
 575         }
 576     }
 577     else if( i_bits_per_sample == 32 )
 578     {
 579         for( i = 0; i < i_buffer / i_channels / 4; i++ )
 580         {
 581             for( j = 0; j < i_channels; j++ )
 582             {
 583                 p_tmp[4 * pi_chan_table[j]]     = p_buf[4 * j];
 584                 p_tmp[4 * pi_chan_table[j] + 1] = p_buf[4 * j + 1];
 585                 p_tmp[4 * pi_chan_table[j] + 2] = p_buf[4 * j + 2];
 586                 p_tmp[4 * pi_chan_table[j] + 3] = p_buf[4 * j + 3];
 587             }
 588
 589             memcpy( p_buf, p_tmp, 4 * i_channels );
 590             p_buf += 4 * i_channels;
 591         }
 592     }
 593 }
 594
 595 /*****************************************************************************
 596  * aout_ChannelExtract:
 597  *****************************************************************************/
 598 static inline void ExtractChannel( uint8_t *pi_dst, int i_dst_channels,
 599                                    const uint8_t *pi_src, int i_src_channels,
 600                                    int i_sample_count,
 601                                    const int *pi_selection, int i_bytes )
 602 {
 603     for( int i = 0; i < i_sample_count; i++ )
 604     {
 605         for( int j = 0; j < i_dst_channels; j++ )
 606             memcpy( &pi_dst[j * i_bytes], &pi_src[pi_selection[j] * i_bytes], i_bytes );
 607         pi_dst += i_dst_channels * i_bytes;
 608         pi_src += i_src_channels * i_bytes;
 609     }
 610 }
 611
 612 void aout_ChannelExtract( void *p_dst, int i_dst_channels,
 613                           const void *p_src, int i_src_channels,
 614                           int i_sample_count, const int *pi_selection, int i_bits_per_sample )
 615 {
 616     /* It does not work in place */
 617     assert( p_dst != p_src );
 618
 619     /* Force the compiler to inline for the specific cases so it can optimize */
 620     if( i_bits_per_sample == 8 )
 621         ExtractChannel( p_dst, i_dst_channels, p_src, i_src_channels, i_sample_count, pi_selection, 1 );
 622     else  if( i_bits_per_sample == 16 )
 623         ExtractChannel( p_dst, i_dst_channels, p_src, i_src_channels, i_sample_count, pi_selection, 2 );
 624     else  if( i_bits_per_sample == 24 )
 625         ExtractChannel( p_dst, i_dst_channels, p_src, i_src_channels, i_sample_count, pi_selection, 3 );
 626     else  if( i_bits_per_sample == 32 )
 627         ExtractChannel( p_dst, i_dst_channels, p_src, i_src_channels, i_sample_count, pi_selection, 4 );
 628     else  if( i_bits_per_sample == 64 )
 629         ExtractChannel( p_dst, i_dst_channels, p_src, i_src_channels, i_sample_count, pi_selection, 8 );
 630 }
 631
 632 bool aout_CheckChannelExtraction( int *pi_selection,
 633                                   uint32_t *pi_layout, int *pi_channels,
 634                                   const uint32_t pi_order_dst[AOUT_CHAN_MAX],
 635                                   const uint32_t *pi_order_src, int i_channels )
 636 {
 637     const uint32_t pi_order_dual_mono[] = { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT };
 638     uint32_t i_layout = 0;
 639     int i_out = 0;
 640     int pi_index[AOUT_CHAN_MAX];
 641
 642     /* */
 643     if( !pi_order_dst )
 644         pi_order_dst = pi_vlc_chan_order_wg4;
 645
 646     /* Detect special dual mono case */
 647     if( i_channels == 2 &&
 648         pi_order_src[0] == AOUT_CHAN_CENTER && pi_order_src[1] == AOUT_CHAN_CENTER )
 649     {
 650         i_layout |= AOUT_CHAN_DUALMONO;
 651         pi_order_src = pi_order_dual_mono;
 652     }
 653
 654     /* */
 655     for( int i = 0; i < i_channels; i++ )
 656     {
 657         /* Ignore unknown or duplicated channels or not present in output */
 658         if( !pi_order_src[i] || (i_layout & pi_order_src[i]) )
 659             continue;
 660
 661         for( int j = 0; j < AOUT_CHAN_MAX; j++ )
 662         {
 663             if( pi_order_dst[j] == pi_order_src[i] )
 664             {
 665                 assert( i_out < AOUT_CHAN_MAX );
 666                 pi_index[i_out++] = i;
 667                 i_layout |= pi_order_src[i];
 668                 break;
 669             }
 670         }
 671     }
 672
 673     /* */
 674     for( int i = 0, j = 0; i < AOUT_CHAN_MAX; i++ )
 675     {
 676         for( int k = 0; k < i_out; k++ )
 677         {
 678             if( pi_order_dst[i] == pi_order_src[pi_index[k]] )
 679             {
 680                 pi_selection[j++] = pi_index[k];
 681                 break;
 682             }
 683         }
 684     }
 685
 686     *pi_layout = i_layout;
 687     *pi_channels = i_out;
 688
 689     for( int i = 0; i < i_out; i++ )
 690     {
 691         if( pi_selection[i] != i )
 692             return true;
 693     }
 694     return i_out == i_channels;
 695 }