Removed audio_date_t in favor to date_t.
[vlc.git] / 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 }