equalizer.c: compile fix for old compilers (thx sam)
[vlc.git] / modules / audio_output / directx.c
1 /*****************************************************************************
2  * directx.c: Windows DirectX audio output method
3  *****************************************************************************
4  * Copyright (C) 2001 VideoLAN
5  * $Id: directx.c,v 1.27 2004/02/26 17:02:17 gbazin Exp $
6  *
7  * Authors: Gildas Bazin <gbazin@netcourrier.com>
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., 59 Temple Place - Suite 330, Boston, MA  02111, USA.
22  *****************************************************************************/
23
24 /*****************************************************************************
25  * Preamble
26  *****************************************************************************/
27 #include <errno.h>                                                 /* ENOMEM */
28 #include <fcntl.h>                                       /* open(), O_WRONLY */
29 #include <string.h>                                            /* strerror() */
30
31 #include <stdlib.h>                            /* calloc(), malloc(), free() */
32
33 #include <vlc/vlc.h>
34 #include <vlc/aout.h>
35 #include "aout_internal.h"
36
37 #include <windows.h>
38 #include <mmsystem.h>
39 #include <dsound.h>
40
41 #define FRAME_SIZE 2048              /* The size is in samples, not in bytes */
42 #define FRAMES_NUM 8
43
44 /* frame buffer status */
45 #define FRAME_QUEUED 0
46 #define FRAME_EMPTY 1
47
48 /*****************************************************************************
49  * DirectSound GUIDs.
50  * Defining them here allows us to get rid of the dxguid library during
51  * the linking stage.
52  *****************************************************************************/
53 #include <initguid.h>
54 DEFINE_GUID(IID_IDirectSoundNotify, 0xb0210783, 0x89cd, 0x11d0, 0xaf, 0x8, 0x0, 0xa0, 0xc9, 0x25, 0xcd, 0x16);
55
56 /*****************************************************************************
57  * Useful macros
58  *****************************************************************************/
59 #ifndef WAVE_FORMAT_IEEE_FLOAT
60 #   define WAVE_FORMAT_IEEE_FLOAT 0x0003
61 #endif
62
63 #ifndef WAVE_FORMAT_DOLBY_AC3_SPDIF
64 #   define WAVE_FORMAT_DOLBY_AC3_SPDIF 0x0092
65 #endif
66
67 #ifndef WAVE_FORMAT_EXTENSIBLE
68 #define  WAVE_FORMAT_EXTENSIBLE   0xFFFE
69 #endif
70
71 #ifndef SPEAKER_FRONT_LEFT
72 #   define SPEAKER_FRONT_LEFT             0x1
73 #   define SPEAKER_FRONT_RIGHT            0x2
74 #   define SPEAKER_FRONT_CENTER           0x4
75 #   define SPEAKER_LOW_FREQUENCY          0x8
76 #   define SPEAKER_BACK_LEFT              0x10
77 #   define SPEAKER_BACK_RIGHT             0x20
78 #   define SPEAKER_FRONT_LEFT_OF_CENTER   0x40
79 #   define SPEAKER_FRONT_RIGHT_OF_CENTER  0x80
80 #   define SPEAKER_BACK_CENTER            0x100
81 #   define SPEAKER_SIDE_LEFT              0x200
82 #   define SPEAKER_SIDE_RIGHT             0x400
83 #   define SPEAKER_TOP_CENTER             0x800
84 #   define SPEAKER_TOP_FRONT_LEFT         0x1000
85 #   define SPEAKER_TOP_FRONT_CENTER       0x2000
86 #   define SPEAKER_TOP_FRONT_RIGHT        0x4000
87 #   define SPEAKER_TOP_BACK_LEFT          0x8000
88 #   define SPEAKER_TOP_BACK_CENTER        0x10000
89 #   define SPEAKER_TOP_BACK_RIGHT         0x20000
90 #   define SPEAKER_RESERVED               0x80000000
91 #endif
92
93 #ifndef DSSPEAKER_HEADPHONE
94 #   define DSSPEAKER_HEADPHONE         0x00000001
95 #endif
96 #ifndef DSSPEAKER_MONO
97 #   define DSSPEAKER_MONO              0x00000002
98 #endif
99 #ifndef DSSPEAKER_QUAD
100 #   define DSSPEAKER_QUAD              0x00000003
101 #endif
102 #ifndef DSSPEAKER_STEREO
103 #   define DSSPEAKER_STEREO            0x00000004
104 #endif
105 #ifndef DSSPEAKER_SURROUND
106 #   define DSSPEAKER_SURROUND          0x00000005
107 #endif
108 #ifndef DSSPEAKER_5POINT1
109 #   define DSSPEAKER_5POINT1           0x00000006
110 #endif
111
112 #ifndef _WAVEFORMATEXTENSIBLE_
113 typedef struct {
114     WAVEFORMATEX    Format;
115     union {
116         WORD wValidBitsPerSample;       /* bits of precision  */
117         WORD wSamplesPerBlock;          /* valid if wBitsPerSample==0 */
118         WORD wReserved;                 /* If neither applies, set to zero. */
119     } Samples;
120     DWORD           dwChannelMask;      /* which channels are */
121                                         /* present in stream  */
122     GUID            SubFormat;
123 } WAVEFORMATEXTENSIBLE, *PWAVEFORMATEXTENSIBLE;
124 #endif
125
126 DEFINE_GUID( _KSDATAFORMAT_SUBTYPE_IEEE_FLOAT, WAVE_FORMAT_IEEE_FLOAT, 0x0000, 0x0010, 0x80, 0x00, 0x00, 0xaa, 0x00, 0x38, 0x9b, 0x71 );
127 DEFINE_GUID( _KSDATAFORMAT_SUBTYPE_PCM, WAVE_FORMAT_PCM, 0x0000, 0x0010, 0x80, 0x00, 0x00, 0xaa, 0x00, 0x38, 0x9b, 0x71 );
128 DEFINE_GUID( _KSDATAFORMAT_SUBTYPE_DOLBY_AC3_SPDIF, WAVE_FORMAT_DOLBY_AC3_SPDIF, 0x0000, 0x0010, 0x80, 0x00, 0x00, 0xaa, 0x00, 0x38, 0x9b, 0x71 );
129
130 /*****************************************************************************
131  * notification_thread_t: DirectX event thread
132  *****************************************************************************/
133 typedef struct notification_thread_t
134 {
135     VLC_COMMON_MEMBERS
136
137     aout_instance_t * p_aout;
138     int i_frame_status[FRAMES_NUM];           /* status of each frame buffer */
139     DSBPOSITIONNOTIFY p_events[FRAMES_NUM];      /* play notification events */
140     int i_frame_size;                         /* Size in bytes of one frame */
141
142     mtime_t start_date;
143
144 } notification_thread_t;
145
146 /*****************************************************************************
147  * aout_sys_t: directx audio output method descriptor
148  *****************************************************************************
149  * This structure is part of the audio output thread descriptor.
150  * It describes the direct sound specific properties of an audio device.
151  *****************************************************************************/
152 struct aout_sys_t
153 {
154     HINSTANCE           hdsound_dll;      /* handle of the opened dsound dll */
155     LPDIRECTSOUND       p_dsobject;              /* main Direct Sound object */
156     LPDIRECTSOUNDBUFFER p_dsbuffer;   /* the sound buffer we use (direct sound
157                                        * takes care of mixing all the
158                                        * secondary buffers into the primary) */
159
160     LPDIRECTSOUNDNOTIFY p_dsnotify;         /* the position notify interface */
161     notification_thread_t *p_notif;                  /* DirectSoundThread id */
162
163     int b_playing;                                         /* playing status */
164
165     int i_frame_size;                         /* Size in bytes of one frame */
166
167     vlc_bool_t b_chan_reorder;              /* do we need channel reordering */
168     int *pi_chan_table;
169     uint32_t i_channel_mask;
170 };
171
172 static const uint32_t pi_channels_in[] =
173     { AOUT_CHAN_LEFT, AOUT_CHAN_RIGHT,
174       AOUT_CHAN_REARLEFT, AOUT_CHAN_REARRIGHT,
175       AOUT_CHAN_CENTER, AOUT_CHAN_LFE };
176 static const uint32_t pi_channels_out[] =
177     { SPEAKER_FRONT_LEFT, SPEAKER_FRONT_RIGHT,
178       SPEAKER_BACK_LEFT, SPEAKER_BACK_RIGHT,
179       SPEAKER_FRONT_CENTER, SPEAKER_LOW_FREQUENCY };
180 static const uint32_t pi_channels_ordered[] =
181     { SPEAKER_FRONT_LEFT, SPEAKER_FRONT_RIGHT, SPEAKER_FRONT_CENTER,
182       SPEAKER_LOW_FREQUENCY,
183       SPEAKER_BACK_LEFT, SPEAKER_BACK_RIGHT };
184
185 /*****************************************************************************
186  * Local prototypes.
187  *****************************************************************************/
188 static int  OpenAudio  ( vlc_object_t * );
189 static void CloseAudio ( vlc_object_t * );
190 static void Play       ( aout_instance_t * );
191
192 /* local functions */
193 static void Probe             ( aout_instance_t * );
194 static int  InitDirectSound   ( aout_instance_t * );
195 static int  CreateDSBuffer    ( aout_instance_t *, int, int, int, int, int, vlc_bool_t );
196 static int  CreateDSBufferPCM ( aout_instance_t *, int*, int, int, int, vlc_bool_t );
197 static void DestroyDSBuffer   ( aout_instance_t * );
198 static void DirectSoundThread ( notification_thread_t * );
199 static int  FillBuffer        ( aout_instance_t *, int, aout_buffer_t * );
200
201 static void CheckReordering   ( aout_instance_t *, int );
202 static void InterleaveFloat32 ( float *, float *, int *, int );
203 static void InterleaveS16     ( int16_t *, int16_t *, int *, int );
204
205 /*****************************************************************************
206  * Module descriptor
207  *****************************************************************************/
208 vlc_module_begin();
209     set_description( _("DirectX audio output") );
210     set_capability( "audio output", 100 );
211     add_shortcut( "directx" );
212     set_callbacks( OpenAudio, CloseAudio );
213 vlc_module_end();
214
215 /*****************************************************************************
216  * OpenAudio: open the audio device
217  *****************************************************************************
218  * This function opens and setups Direct Sound.
219  *****************************************************************************/
220 static int OpenAudio( vlc_object_t *p_this )
221 {
222     aout_instance_t * p_aout = (aout_instance_t *)p_this;
223     vlc_value_t val;
224     int i;
225
226     msg_Dbg( p_aout, "OpenAudio" );
227
228    /* Allocate structure */
229     p_aout->output.p_sys = malloc( sizeof( aout_sys_t ) );
230     if( p_aout->output.p_sys == NULL )
231     {
232         msg_Err( p_aout, "out of memory" );
233         return VLC_EGENERIC;
234     }
235
236     /* Initialize some variables */
237     p_aout->output.p_sys->p_dsobject = NULL;
238     p_aout->output.p_sys->p_dsbuffer = NULL;
239     p_aout->output.p_sys->p_dsnotify = NULL;
240     p_aout->output.p_sys->p_notif = NULL;
241     p_aout->output.p_sys->b_playing = 0;
242     p_aout->output.p_sys->pi_chan_table = NULL;
243
244     p_aout->output.pf_play = Play;
245     aout_VolumeSoftInit( p_aout );
246
247     /* Initialise DirectSound */
248     if( InitDirectSound( p_aout ) )
249     {
250         msg_Err( p_aout, "cannot initialize DirectSound" );
251         goto error;
252     }
253
254     if( var_Type( p_aout, "audio-device" ) == 0 )
255     {
256         Probe( p_aout );
257     }
258
259     if( var_Get( p_aout, "audio-device", &val ) < 0 )
260     {
261         /* Probe() has failed. */
262         goto error;
263     }
264
265     /* Now we need to setup our DirectSound play notification structure */
266     p_aout->output.p_sys->p_notif =
267         vlc_object_create( p_aout, sizeof(notification_thread_t) );
268     p_aout->output.p_sys->p_notif->p_aout = p_aout;
269
270     /* Then create the notification events */
271     for( i = 0; i < FRAMES_NUM; i++ )
272         p_aout->output.p_sys->p_notif->p_events[i].hEventNotify =
273             CreateEvent( NULL, FALSE, FALSE, NULL );
274
275     /* Open the device */
276     if( val.i_int == AOUT_VAR_SPDIF )
277     {
278         p_aout->output.output.i_format = VLC_FOURCC('s','p','d','i');
279
280         /* Calculate the frame size in bytes */
281         p_aout->output.i_nb_samples = A52_FRAME_NB;
282         p_aout->output.output.i_bytes_per_frame = AOUT_SPDIF_SIZE;
283         p_aout->output.output.i_frame_length = A52_FRAME_NB;
284         p_aout->output.p_sys->i_frame_size =
285             p_aout->output.output.i_bytes_per_frame;
286
287         if( CreateDSBuffer( p_aout, VLC_FOURCC('s','p','d','i'),
288                             p_aout->output.output.i_physical_channels,
289                             aout_FormatNbChannels( &p_aout->output.output ),
290                             p_aout->output.output.i_rate,
291                             p_aout->output.p_sys->i_frame_size, VLC_FALSE )
292             != VLC_SUCCESS )
293         {
294             msg_Err( p_aout, "cannot open directx audio device" );
295             free( p_aout->output.p_sys );
296             return VLC_EGENERIC;
297         }
298
299         aout_VolumeNoneInit( p_aout );
300     }
301     else
302     {
303         if( val.i_int == AOUT_VAR_5_1 )
304         {
305             p_aout->output.output.i_physical_channels
306                 = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER
307                    | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT
308                    | AOUT_CHAN_LFE;
309         }
310         else if( val.i_int == AOUT_VAR_3F2R )
311         {
312             p_aout->output.output.i_physical_channels
313                 = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT | AOUT_CHAN_CENTER
314                    | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT;
315         }
316         else if( val.i_int == AOUT_VAR_2F2R )
317         {
318             p_aout->output.output.i_physical_channels
319                 = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT
320                    | AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT;
321         }
322         else if( val.i_int == AOUT_VAR_MONO )
323         {
324             p_aout->output.output.i_physical_channels = AOUT_CHAN_CENTER;
325         }
326         else
327         {
328             p_aout->output.output.i_physical_channels
329                 = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT;
330         }
331
332         if( CreateDSBufferPCM( p_aout, &p_aout->output.output.i_format,
333                                p_aout->output.output.i_physical_channels,
334                                aout_FormatNbChannels( &p_aout->output.output ),
335                                p_aout->output.output.i_rate, VLC_FALSE )
336             != VLC_SUCCESS )
337         {
338             msg_Err( p_aout, "cannot open directx audio device" );
339             free( p_aout->output.p_sys );
340             return VLC_EGENERIC;
341         }
342
343         /* Calculate the frame size in bytes */
344         p_aout->output.i_nb_samples = FRAME_SIZE;
345         aout_FormatPrepare( &p_aout->output.output );
346         p_aout->output.p_sys->i_frame_size =
347             FRAME_SIZE * p_aout->output.output.i_bytes_per_frame;
348
349         aout_VolumeSoftInit( p_aout );
350     }
351
352     /* then launch the notification thread */
353     msg_Dbg( p_aout, "creating DirectSoundThread" );
354     if( vlc_thread_create( p_aout->output.p_sys->p_notif,
355                            "DirectSound Notification Thread",
356                            DirectSoundThread,
357                            VLC_THREAD_PRIORITY_HIGHEST, VLC_FALSE ) )
358     {
359         msg_Err( p_aout, "cannot create DirectSoundThread" );
360         goto error;
361     }
362
363     vlc_object_attach( p_aout->output.p_sys->p_notif, p_aout );
364
365     return VLC_SUCCESS;
366
367  error:
368     CloseAudio( VLC_OBJECT(p_aout) );
369     return VLC_EGENERIC;
370 }
371
372 /*****************************************************************************
373  * Probe: probe the audio device for available formats and channels
374  *****************************************************************************/
375 static void Probe( aout_instance_t * p_aout )
376 {
377     vlc_value_t val, text;
378     int i_format;
379     unsigned int i_physical_channels;
380     DWORD ui_speaker_config;
381
382     var_Create( p_aout, "audio-device", VLC_VAR_INTEGER | VLC_VAR_HASCHOICE );
383     text.psz_string = _("Audio Device");
384     var_Change( p_aout, "audio-device", VLC_VAR_SETTEXT, &text, NULL );
385
386     /* Test for 5.1 support */
387     i_physical_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT |
388                           AOUT_CHAN_CENTER | AOUT_CHAN_REARLEFT |
389                           AOUT_CHAN_REARRIGHT | AOUT_CHAN_LFE;
390     if( p_aout->output.output.i_physical_channels == i_physical_channels )
391     {
392         if( CreateDSBufferPCM( p_aout, &i_format, i_physical_channels, 6,
393                                p_aout->output.output.i_rate, VLC_TRUE )
394             == VLC_SUCCESS )
395         {
396             val.i_int = AOUT_VAR_5_1;
397             text.psz_string = N_("5.1");
398             var_Change( p_aout, "audio-device",
399                         VLC_VAR_ADDCHOICE, &val, &text );
400             msg_Dbg( p_aout, "device supports 5.1 channels" );
401         }
402     }
403
404     /* Test for 3 Front 2 Rear support */
405     i_physical_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT |
406                           AOUT_CHAN_CENTER | AOUT_CHAN_REARLEFT |
407                           AOUT_CHAN_REARRIGHT;
408     if( p_aout->output.output.i_physical_channels == i_physical_channels )
409     {
410         if( CreateDSBufferPCM( p_aout, &i_format, i_physical_channels, 5,
411                                p_aout->output.output.i_rate, VLC_TRUE )
412             == VLC_SUCCESS )
413         {
414             val.i_int = AOUT_VAR_3F2R;
415             text.psz_string = N_("3 Front 2 Rear");
416             var_Change( p_aout, "audio-device",
417                         VLC_VAR_ADDCHOICE, &val, &text );
418             msg_Dbg( p_aout, "device supports 5 channels" );
419         }
420     }
421
422     /* Test for 2 Front 2 Rear support */
423     i_physical_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT |
424                           AOUT_CHAN_REARLEFT | AOUT_CHAN_REARRIGHT;
425     if( ( p_aout->output.output.i_physical_channels & i_physical_channels )
426         == i_physical_channels )
427     {
428         if( CreateDSBufferPCM( p_aout, &i_format, i_physical_channels, 4,
429                                p_aout->output.output.i_rate, VLC_TRUE )
430             == VLC_SUCCESS )
431         {
432             val.i_int = AOUT_VAR_2F2R;
433             text.psz_string = N_("2 Front 2 Rear");
434             var_Change( p_aout, "audio-device",
435                         VLC_VAR_ADDCHOICE, &val, &text );
436             msg_Dbg( p_aout, "device supports 4 channels" );
437         }
438     }
439
440     /* Test for stereo support */
441     i_physical_channels = AOUT_CHAN_LEFT | AOUT_CHAN_RIGHT;
442     if( CreateDSBufferPCM( p_aout, &i_format, i_physical_channels, 2,
443                            p_aout->output.output.i_rate, VLC_TRUE )
444         == VLC_SUCCESS )
445     {
446         val.i_int = AOUT_VAR_STEREO;
447         text.psz_string = N_("Stereo");
448         var_Change( p_aout, "audio-device", VLC_VAR_ADDCHOICE, &val, &text );
449         var_Change( p_aout, "audio-device", VLC_VAR_SETDEFAULT, &val, NULL );
450         msg_Dbg( p_aout, "device supports 2 channels" );
451     }
452
453     /* Test for mono support */
454     i_physical_channels = AOUT_CHAN_CENTER;
455     if( CreateDSBufferPCM( p_aout, &i_format, i_physical_channels, 1,
456                            p_aout->output.output.i_rate, VLC_TRUE )
457         == VLC_SUCCESS )
458     {
459         val.i_int = AOUT_VAR_MONO;
460         text.psz_string = N_("Mono");
461         var_Change( p_aout, "audio-device", VLC_VAR_ADDCHOICE, &val, &text );
462         msg_Dbg( p_aout, "device supports 1 channel" );
463     }
464
465     /* Check the speaker configuration to determine which channel config should
466      * be the default */
467     if FAILED( IDirectSound_GetSpeakerConfig( p_aout->output.p_sys->p_dsobject,
468                                               &ui_speaker_config ) )
469     {
470         ui_speaker_config = DSSPEAKER_STEREO;
471     }
472     switch( DSSPEAKER_CONFIG(ui_speaker_config) )
473     {
474     case DSSPEAKER_5POINT1:
475         val.i_int = AOUT_VAR_5_1;
476         break;
477     case DSSPEAKER_QUAD:
478         val.i_int = AOUT_VAR_2F2R;
479         break;
480 #if 0 /* Lots of people just get their settings wrong and complain that
481        * this is a problem with VLC so just don't ever set mono by default. */
482     case DSSPEAKER_MONO:
483         val.i_int = AOUT_VAR_MONO;
484         break;
485 #endif
486     case DSSPEAKER_SURROUND:
487     case DSSPEAKER_STEREO:
488     default:
489         val.i_int = AOUT_VAR_STEREO;
490         break;
491     }
492     var_Set( p_aout, "audio-device", val );
493
494     /* Test for SPDIF support */
495     if ( AOUT_FMT_NON_LINEAR( &p_aout->output.output ) )
496     {
497         if( CreateDSBuffer( p_aout, VLC_FOURCC('s','p','d','i'),
498                             p_aout->output.output.i_physical_channels,
499                             aout_FormatNbChannels( &p_aout->output.output ),
500                             p_aout->output.output.i_rate,
501                             AOUT_SPDIF_SIZE, VLC_TRUE )
502             == VLC_SUCCESS )
503         {
504             msg_Dbg( p_aout, "device supports A/52 over S/PDIF" );
505             val.i_int = AOUT_VAR_SPDIF;
506             text.psz_string = N_("A/52 over S/PDIF");
507             var_Change( p_aout, "audio-device",
508                         VLC_VAR_ADDCHOICE, &val, &text );
509             if( config_GetInt( p_aout, "spdif" ) )
510                 var_Set( p_aout, "audio-device", val );
511         }
512     }
513
514     var_Change( p_aout, "audio-device", VLC_VAR_CHOICESCOUNT, &val, NULL );
515     if( val.i_int <= 0 )
516     {
517         /* Probe() has failed. */
518         var_Destroy( p_aout, "audio-device" );
519         return;
520     }
521
522     var_AddCallback( p_aout, "audio-device", aout_ChannelsRestart, NULL );
523
524     val.b_bool = VLC_TRUE;
525     var_Set( p_aout, "intf-change", val );
526 }
527
528 /*****************************************************************************
529  * Play: we'll start playing the directsound buffer here because at least here
530  *       we know the first buffer has been put in the aout fifo and we also
531  *       know its date.
532  *****************************************************************************/
533 static void Play( aout_instance_t *p_aout )
534 {
535     if( !p_aout->output.p_sys->b_playing )
536     {
537         aout_buffer_t *p_buffer;
538
539         p_aout->output.p_sys->b_playing = 1;
540
541         /* get the playing date of the first aout buffer */
542         p_aout->output.p_sys->p_notif->start_date =
543             aout_FifoFirstDate( p_aout, &p_aout->output.fifo );
544
545         /* fill in the first samples */
546         p_buffer = aout_FifoPop( p_aout, &p_aout->output.fifo );
547         FillBuffer( p_aout, 0, p_buffer );
548
549         /* wake up the audio output thread */
550         SetEvent( p_aout->output.p_sys->p_notif->p_events[0].hEventNotify );
551     }
552 }
553
554 /*****************************************************************************
555  * CloseAudio: close the audio device
556  *****************************************************************************/
557 static void CloseAudio( vlc_object_t *p_this )
558 {
559     aout_instance_t * p_aout = (aout_instance_t *)p_this;
560
561     msg_Dbg( p_aout, "CloseAudio" );
562
563     /* kill the position notification thread, if any */
564     if( p_aout->output.p_sys->p_notif )
565     {
566         vlc_object_detach( p_aout->output.p_sys->p_notif );
567         if( p_aout->output.p_sys->p_notif->b_thread )
568         {
569             p_aout->output.p_sys->p_notif->b_die = 1;
570
571             if( !p_aout->output.p_sys->b_playing )
572                 /* wake up the audio thread */
573                 SetEvent(
574                     p_aout->output.p_sys->p_notif->p_events[0].hEventNotify );
575
576             vlc_thread_join( p_aout->output.p_sys->p_notif );
577         }
578         vlc_object_destroy( p_aout->output.p_sys->p_notif );
579     }
580
581     /* release the secondary buffer */
582     DestroyDSBuffer( p_aout );
583
584     /* finally release the DirectSound object */
585     if( p_aout->output.p_sys->p_dsobject )
586         IDirectSound_Release( p_aout->output.p_sys->p_dsobject );
587     
588     /* free DSOUND.DLL */
589     if( p_aout->output.p_sys->hdsound_dll )
590        FreeLibrary( p_aout->output.p_sys->hdsound_dll );
591
592     if( p_aout->output.p_sys->pi_chan_table )
593         free( p_aout->output.p_sys->pi_chan_table );
594
595     free( p_aout->output.p_sys );
596 }
597
598 /*****************************************************************************
599  * InitDirectSound: handle all the gory details of DirectSound initialisation
600  *****************************************************************************/
601 static int InitDirectSound( aout_instance_t *p_aout )
602 {
603     HRESULT (WINAPI *OurDirectSoundCreate)(LPGUID, LPDIRECTSOUND *, LPUNKNOWN);
604
605     p_aout->output.p_sys->hdsound_dll = LoadLibrary("DSOUND.DLL");
606     if( p_aout->output.p_sys->hdsound_dll == NULL )
607     {
608         msg_Warn( p_aout, "cannot open DSOUND.DLL" );
609         goto error;
610     }
611
612     OurDirectSoundCreate = (void *)GetProcAddress(
613                                            p_aout->output.p_sys->hdsound_dll,
614                                            "DirectSoundCreate" );
615     if( OurDirectSoundCreate == NULL )
616     {
617         msg_Warn( p_aout, "GetProcAddress FAILED" );
618         goto error;
619     }
620
621     /* Create the direct sound object */
622     if FAILED( OurDirectSoundCreate( NULL, &p_aout->output.p_sys->p_dsobject,
623                                      NULL ) )
624     {
625         msg_Warn( p_aout, "cannot create a direct sound device" );
626         goto error;
627     }
628
629     /* Set DirectSound Cooperative level, ie what control we want over Windows
630      * sound device. In our case, DSSCL_EXCLUSIVE means that we can modify the
631      * settings of the primary buffer, but also that only the sound of our
632      * application will be hearable when it will have the focus.
633      * !!! (this is not really working as intended yet because to set the
634      * cooperative level you need the window handle of your application, and
635      * I don't know of any easy way to get it. Especially since we might play
636      * sound without any video, and so what window handle should we use ???
637      * The hack for now is to use the Desktop window handle - it seems to be
638      * working */
639     if( IDirectSound_SetCooperativeLevel( p_aout->output.p_sys->p_dsobject,
640                                           GetDesktopWindow(),
641                                           DSSCL_EXCLUSIVE) )
642     {
643         msg_Warn( p_aout, "cannot set direct sound cooperative level" );
644     }
645
646     return VLC_SUCCESS;
647
648  error:
649     p_aout->output.p_sys->p_dsobject = NULL;
650     if( p_aout->output.p_sys->hdsound_dll )
651     {
652         FreeLibrary( p_aout->output.p_sys->hdsound_dll );
653         p_aout->output.p_sys->hdsound_dll = NULL;
654     }
655     return VLC_EGENERIC;
656
657 }
658
659 /*****************************************************************************
660  * CreateDSBuffer: Creates a direct sound buffer of the required format.
661  *****************************************************************************
662  * This function creates the buffer we'll use to play audio.
663  * In DirectSound there are two kinds of buffers:
664  * - the primary buffer: which is the actual buffer that the soundcard plays
665  * - the secondary buffer(s): these buffers are the one actually used by
666  *    applications and DirectSound takes care of mixing them into the primary.
667  *
668  * Once you create a secondary buffer, you cannot change its format anymore so
669  * you have to release the current one and create another.
670  *****************************************************************************/
671 static int CreateDSBuffer( aout_instance_t *p_aout, int i_format,
672                            int i_channels, int i_nb_channels, int i_rate,
673                            int i_bytes_per_frame, vlc_bool_t b_probe )
674 {
675     WAVEFORMATEXTENSIBLE waveformat;
676     DSBUFFERDESC         dsbdesc;
677     unsigned int         i;
678
679     /* First set the sound buffer format */
680     waveformat.dwChannelMask = 0;
681     for( i = 0; i < sizeof(pi_channels_in)/sizeof(uint32_t); i++ )
682     {
683         if( i_channels & pi_channels_in[i] )
684             waveformat.dwChannelMask |= pi_channels_out[i];
685     }
686
687     switch( i_format )
688     {
689     case VLC_FOURCC('s','p','d','i'):
690         i_nb_channels = 2;
691         /* To prevent channel re-ordering */
692         waveformat.dwChannelMask = SPEAKER_FRONT_LEFT | SPEAKER_FRONT_RIGHT;
693         waveformat.Format.wBitsPerSample = 16;
694         waveformat.Samples.wValidBitsPerSample =
695             waveformat.Format.wBitsPerSample;
696         waveformat.Format.wFormatTag = WAVE_FORMAT_DOLBY_AC3_SPDIF;
697         waveformat.SubFormat = _KSDATAFORMAT_SUBTYPE_DOLBY_AC3_SPDIF;
698         break;
699
700     case VLC_FOURCC('f','l','3','2'):
701         waveformat.Format.wBitsPerSample = sizeof(float) * 8;
702         waveformat.Samples.wValidBitsPerSample =
703             waveformat.Format.wBitsPerSample;
704         waveformat.Format.wFormatTag = WAVE_FORMAT_IEEE_FLOAT;
705         waveformat.SubFormat = _KSDATAFORMAT_SUBTYPE_IEEE_FLOAT;
706         break;
707
708     case VLC_FOURCC('s','1','6','l'):
709         waveformat.Format.wBitsPerSample = 16;
710         waveformat.Samples.wValidBitsPerSample =
711             waveformat.Format.wBitsPerSample;
712         waveformat.Format.wFormatTag = WAVE_FORMAT_PCM;
713         waveformat.SubFormat = _KSDATAFORMAT_SUBTYPE_PCM;
714         break;
715     }
716
717     waveformat.Format.nChannels = i_nb_channels;
718     waveformat.Format.nSamplesPerSec = i_rate;
719     waveformat.Format.nBlockAlign =
720         waveformat.Format.wBitsPerSample / 8 * i_nb_channels;
721     waveformat.Format.nAvgBytesPerSec =
722         waveformat.Format.nSamplesPerSec * waveformat.Format.nBlockAlign;
723
724     /* Then fill in the direct sound descriptor */
725     memset(&dsbdesc, 0, sizeof(DSBUFFERDESC));
726     dsbdesc.dwSize = sizeof(DSBUFFERDESC);
727     dsbdesc.dwFlags = DSBCAPS_GETCURRENTPOSITION2/* Better position accuracy */
728                     | DSBCAPS_CTRLPOSITIONNOTIFY     /* We need notification */
729                     | DSBCAPS_GLOBALFOCUS;      /* Allows background playing */
730
731     /* Only use the new WAVE_FORMAT_EXTENSIBLE format for multichannel audio */
732     if( i_nb_channels <= 2 )
733     {
734         waveformat.Format.cbSize = 0;
735     }
736     else
737     {
738         waveformat.Format.wFormatTag = WAVE_FORMAT_EXTENSIBLE;
739         waveformat.Format.cbSize =
740             sizeof(WAVEFORMATEXTENSIBLE) - sizeof(WAVEFORMATEX);
741
742         /* Needed for 5.1 on emu101k */
743         dsbdesc.dwFlags |= DSBCAPS_LOCHARDWARE;
744     }
745
746     dsbdesc.dwBufferBytes = FRAMES_NUM * i_bytes_per_frame;   /* buffer size */
747     dsbdesc.lpwfxFormat = (WAVEFORMATEX *)&waveformat;
748
749     if FAILED( IDirectSound_CreateSoundBuffer(
750                    p_aout->output.p_sys->p_dsobject, &dsbdesc,
751                    &p_aout->output.p_sys->p_dsbuffer, NULL) )
752     {
753         if( dsbdesc.dwFlags & DSBCAPS_LOCHARDWARE )
754         {
755             /* Try without DSBCAPS_LOCHARDWARE */
756             dsbdesc.dwFlags &= ~DSBCAPS_LOCHARDWARE;
757             if FAILED( IDirectSound_CreateSoundBuffer(
758                    p_aout->output.p_sys->p_dsobject, &dsbdesc,
759                    &p_aout->output.p_sys->p_dsbuffer, NULL) )
760             {
761                 return VLC_EGENERIC;
762             }
763             if( !b_probe )
764                 msg_Dbg( p_aout, "couldn't use hardware sound buffer" );
765         }
766         else
767         {
768             return VLC_EGENERIC;
769         }
770     }
771
772     /* Stop here if we were just probing */
773     if( b_probe )
774     {
775         IDirectSoundBuffer_Release( p_aout->output.p_sys->p_dsbuffer );
776         p_aout->output.p_sys->p_dsbuffer = NULL;
777         return VLC_SUCCESS;
778     }
779
780     /* Backup the size of a frame */
781     p_aout->output.p_sys->p_notif->i_frame_size = i_bytes_per_frame;
782
783     /* Now the secondary buffer is created, we need to setup its position
784      * notification */
785     for( i = 0; i < FRAMES_NUM; i++ )
786     {
787         p_aout->output.p_sys->p_notif->p_events[i].dwOffset = i *
788             p_aout->output.p_sys->p_notif->i_frame_size;
789
790         p_aout->output.p_sys->p_notif->i_frame_status[i] = FRAME_EMPTY;
791     }
792
793     /* Get the IDirectSoundNotify interface */
794     if FAILED( IDirectSoundBuffer_QueryInterface(
795                                 p_aout->output.p_sys->p_dsbuffer,
796                                 &IID_IDirectSoundNotify,
797                                 (LPVOID *)&p_aout->output.p_sys->p_dsnotify ) )
798     {
799         msg_Err( p_aout, "cannot get IDirectSoundNotify interface" );
800         goto error;
801     }
802
803     if FAILED( IDirectSoundNotify_SetNotificationPositions(
804                                     p_aout->output.p_sys->p_dsnotify,
805                                     FRAMES_NUM,
806                                     p_aout->output.p_sys->p_notif->p_events ) )
807     {
808         msg_Err( p_aout, "cannot set position notification" );
809         goto error;
810     }
811
812     p_aout->output.p_sys->i_channel_mask = waveformat.dwChannelMask;
813     CheckReordering( p_aout, i_nb_channels );
814
815     return VLC_SUCCESS;
816
817  error:
818     DestroyDSBuffer( p_aout );
819     return VLC_EGENERIC;
820 }
821
822 /*****************************************************************************
823  * CreateDSBufferPCM: creates a PCM direct sound buffer.
824  *****************************************************************************
825  * We first try to create a WAVE_FORMAT_IEEE_FLOAT buffer if supported by
826  * the hardware, otherwise we create a WAVE_FORMAT_PCM buffer.
827  ****************************************************************************/
828 static int CreateDSBufferPCM( aout_instance_t *p_aout, int *i_format,
829                               int i_channels, int i_nb_channels, int i_rate,
830                               vlc_bool_t b_probe )
831 {
832     /* Float32 audio samples are not supported for 5.1 output on the emu101k */
833
834     if( i_nb_channels > 2 ||
835         CreateDSBuffer( p_aout, VLC_FOURCC('f','l','3','2'),
836                         i_channels, i_nb_channels, i_rate,
837                         FRAME_SIZE * 4 * i_nb_channels, b_probe )
838         != VLC_SUCCESS )
839     {
840         if ( CreateDSBuffer( p_aout, VLC_FOURCC('s','1','6','l'),
841                              i_channels, i_nb_channels, i_rate,
842                              FRAME_SIZE * 2 * i_nb_channels, b_probe )
843              != VLC_SUCCESS )
844         {
845             return VLC_EGENERIC;
846         }
847         else
848         {
849             *i_format = VLC_FOURCC('s','1','6','l');
850             return VLC_SUCCESS;
851         }
852     }
853     else
854     {
855         *i_format = VLC_FOURCC('f','l','3','2');
856         return VLC_SUCCESS;
857     }
858 }
859
860 /*****************************************************************************
861  * DestroyDSBuffer
862  *****************************************************************************
863  * This function destroys the secondary buffer.
864  *****************************************************************************/
865 static void DestroyDSBuffer( aout_instance_t *p_aout )
866 {
867     if( p_aout->output.p_sys->p_dsnotify )
868     {
869         IDirectSoundNotify_Release( p_aout->output.p_sys->p_dsnotify );
870         p_aout->output.p_sys->p_dsnotify = NULL;
871     }
872
873     if( p_aout->output.p_sys->p_dsbuffer )
874     {
875         IDirectSoundBuffer_Release( p_aout->output.p_sys->p_dsbuffer );
876         p_aout->output.p_sys->p_dsbuffer = NULL;
877     }
878 }
879
880 /*****************************************************************************
881  * FillBuffer: Fill in one of the direct sound frame buffers.
882  *****************************************************************************
883  * Returns VLC_SUCCESS on success.
884  *****************************************************************************/
885 static int FillBuffer( aout_instance_t *p_aout, int i_frame,
886                        aout_buffer_t *p_buffer )
887 {
888     notification_thread_t *p_notif = p_aout->output.p_sys->p_notif;
889     void *p_write_position, *p_wrap_around;
890     long l_bytes1, l_bytes2;
891     HRESULT dsresult;
892
893     /* Before copying anything, we have to lock the buffer */
894     dsresult = IDirectSoundBuffer_Lock(
895                 p_aout->output.p_sys->p_dsbuffer,               /* DS buffer */
896                 i_frame * p_notif->i_frame_size,             /* Start offset */
897                 p_notif->i_frame_size,                    /* Number of bytes */
898                 &p_write_position,                  /* Address of lock start */
899                 &l_bytes1,       /* Count of bytes locked before wrap around */
900                 &p_wrap_around,            /* Buffer adress (if wrap around) */
901                 &l_bytes2,               /* Count of bytes after wrap around */
902                 0 );                                                /* Flags */
903     if( dsresult == DSERR_BUFFERLOST )
904     {
905         IDirectSoundBuffer_Restore( p_aout->output.p_sys->p_dsbuffer );
906         dsresult = IDirectSoundBuffer_Lock(
907                                p_aout->output.p_sys->p_dsbuffer,
908                                i_frame * p_notif->i_frame_size,
909                                p_notif->i_frame_size,
910                                &p_write_position,
911                                &l_bytes1,
912                                &p_wrap_around,
913                                &l_bytes2,
914                                0 );
915     }
916     if( dsresult != DS_OK )
917     {
918         msg_Warn( p_notif, "cannot lock buffer" );
919         if( p_buffer ) aout_BufferFree( p_buffer );
920         return VLC_EGENERIC;
921     }
922
923     if( p_buffer == NULL )
924     {
925         memset( p_write_position, 0, l_bytes1 );
926     }
927     else if( p_aout->output.p_sys->b_chan_reorder )
928     {
929         /* Do the channel reordering here */
930
931         if( p_aout->output.output.i_format ==  VLC_FOURCC('s','1','6','l') )
932           InterleaveS16( (int16_t *)p_buffer->p_buffer,
933                          (int16_t *)p_write_position,
934                          p_aout->output.p_sys->pi_chan_table,
935                          aout_FormatNbChannels( &p_aout->output.output ) );
936         else
937           InterleaveFloat32( (float *)p_buffer->p_buffer,
938                              (float *)p_write_position,
939                              p_aout->output.p_sys->pi_chan_table,
940                              aout_FormatNbChannels( &p_aout->output.output ) );
941
942         aout_BufferFree( p_buffer );
943     }
944     else
945     {
946         p_aout->p_vlc->pf_memcpy( p_write_position, p_buffer->p_buffer,
947                                   l_bytes1 );
948         aout_BufferFree( p_buffer );
949     }
950
951     /* Now the data has been copied, unlock the buffer */
952     IDirectSoundBuffer_Unlock( p_aout->output.p_sys->p_dsbuffer,
953                                p_write_position, l_bytes1,
954                                p_wrap_around, l_bytes2 );
955
956     return VLC_SUCCESS;
957 }
958
959 /*****************************************************************************
960  * DirectSoundThread: this thread will capture play notification events. 
961  *****************************************************************************
962  * We use this thread to emulate a callback mechanism. The thread probes for
963  * event notification and fills up the DS secondary buffer when needed.
964  *****************************************************************************/
965 static void DirectSoundThread( notification_thread_t *p_notif )
966 {
967     HANDLE  notification_events[FRAMES_NUM];
968     HRESULT dsresult;
969     aout_instance_t *p_aout = p_notif->p_aout;
970     int i, i_which_frame, i_last_frame, i_next_frame;
971     mtime_t mtime;
972     vlc_bool_t b_sleek;
973
974     for( i = 0; i < FRAMES_NUM; i++ )
975         notification_events[i] = p_notif->p_events[i].hEventNotify;
976
977     /* We don't want any resampling when using S/PDIF output */
978     b_sleek = p_aout->output.output.i_format == VLC_FOURCC('s','p','d','i');
979
980     /* Tell the main thread that we are ready */
981     vlc_thread_ready( p_notif );
982
983     msg_Dbg( p_notif, "DirectSoundThread ready" );
984
985     /* Wait here until Play() is called */
986     WaitForSingleObject( notification_events[0], INFINITE );
987
988     if( !p_notif->b_die )
989     {
990         mwait( p_notif->start_date - AOUT_PTS_TOLERANCE / 2 );
991
992         /* start playing the buffer */
993         dsresult = IDirectSoundBuffer_Play( p_aout->output.p_sys->p_dsbuffer,
994                                         0,                         /* Unused */
995                                         0,                         /* Unused */
996                                         DSBPLAY_LOOPING );          /* Flags */
997         if( dsresult == DSERR_BUFFERLOST )
998         {
999             IDirectSoundBuffer_Restore( p_aout->output.p_sys->p_dsbuffer );
1000             dsresult = IDirectSoundBuffer_Play(
1001                                             p_aout->output.p_sys->p_dsbuffer,
1002                                             0,                     /* Unused */
1003                                             0,                     /* Unused */
1004                                             DSBPLAY_LOOPING );      /* Flags */
1005         }
1006         if( dsresult != DS_OK )
1007         {
1008             msg_Err( p_aout, "cannot start playing buffer" );
1009         }
1010     }
1011
1012     while( !p_notif->b_die )
1013     {
1014         aout_buffer_t *p_buffer;
1015         long l_latency;
1016
1017         /* wait for the position notification */
1018         i_which_frame = WaitForMultipleObjects( FRAMES_NUM,
1019                                                 notification_events, 0,
1020                                                 INFINITE ) - WAIT_OBJECT_0;
1021
1022         if( p_notif->b_die )
1023             break;
1024
1025         mtime = mdate();
1026
1027         /* We take into account the current latency */
1028         if SUCCEEDED( IDirectSoundBuffer_GetCurrentPosition(
1029                         p_aout->output.p_sys->p_dsbuffer,
1030                         &l_latency, NULL ) )
1031         {
1032             if( l_latency > (i_which_frame * FRAME_SIZE)
1033                   && l_latency < ((i_which_frame+1) * FRAME_SIZE) )
1034             {
1035                 l_latency = - ( l_latency /
1036                                 p_aout->output.output.i_bytes_per_frame %
1037                                 FRAME_SIZE );
1038             }
1039             else
1040             {
1041                 l_latency = FRAME_SIZE - ( l_latency /
1042                                       p_aout->output.output.i_bytes_per_frame %
1043                                       FRAME_SIZE );
1044             }
1045         }
1046         else
1047         {
1048             l_latency = 0;
1049         }
1050
1051         /* Mark last frame as empty */
1052         i_last_frame = (i_which_frame + FRAMES_NUM -1) % FRAMES_NUM;
1053         i_next_frame = (i_which_frame + 1) % FRAMES_NUM;
1054         p_notif->i_frame_status[i_last_frame] = FRAME_EMPTY;
1055
1056         /* Try to fill in as many frame buffers as possible */
1057         for( i = i_next_frame; (i % FRAMES_NUM) != i_which_frame; i++ )
1058         {
1059
1060             /* Check if frame buf is already filled */
1061             if( p_notif->i_frame_status[i % FRAMES_NUM] == FRAME_QUEUED )
1062                 continue;
1063
1064             p_buffer = aout_OutputNextBuffer( p_aout,
1065                 mtime + 1000000 / p_aout->output.output.i_rate *
1066                 ((i - i_next_frame + 1) * FRAME_SIZE + l_latency), b_sleek );
1067
1068             /* If there is no audio data available and we have some buffered
1069              * already, then just wait for the next time */
1070             if( !p_buffer && (i != i_next_frame) )
1071             {
1072                 //msg_Err( p_aout, "only %i frame buffers filled!",
1073                 //         i - i_next_frame );
1074                 break;
1075             }
1076
1077             if( FillBuffer( p_aout, (i%FRAMES_NUM), p_buffer )
1078                 != VLC_SUCCESS )
1079                 break;
1080
1081             /* Mark the frame buffer as QUEUED */
1082             p_notif->i_frame_status[i%FRAMES_NUM] = FRAME_QUEUED;
1083         }
1084
1085     }
1086
1087     /* make sure the buffer isn't playing */
1088     IDirectSoundBuffer_Stop( p_aout->output.p_sys->p_dsbuffer );
1089
1090     /* free the events */
1091     for( i = 0; i < FRAMES_NUM; i++ )
1092         CloseHandle( notification_events[i] );
1093
1094     msg_Dbg( p_notif, "DirectSoundThread exiting" );
1095 }
1096
1097 /*****************************************************************************
1098  * CheckReordering: Check if we need to do some channel re-ordering (the ac3
1099  *                  channel order is different from the one chosen by
1100  *                  Microsoft).
1101  *****************************************************************************/
1102 static void CheckReordering( aout_instance_t *p_aout, int i_nb_channels )
1103 {
1104     int i, j, k, l;
1105
1106 #define i_channel_mask p_aout->output.p_sys->i_channel_mask
1107 #define pi_chan_table p_aout->output.p_sys->pi_chan_table
1108
1109     p_aout->output.p_sys->b_chan_reorder = VLC_FALSE;
1110
1111     pi_chan_table = malloc( i_nb_channels * sizeof(int) );
1112     if( !pi_chan_table )
1113     {
1114         return;
1115     }
1116
1117     for( i = 0, j = 0;
1118          i < (int)(sizeof(pi_channels_out)/sizeof(uint32_t)); i++ )
1119     {
1120         if( i_channel_mask & pi_channels_out[i] )
1121         {
1122             for( k = 0, l = 0;
1123                  pi_channels_out[i] != pi_channels_ordered[k]; k++ )
1124             {
1125                 if( i_channel_mask & pi_channels_ordered[k] )
1126                 {
1127                     l++;
1128                 }
1129             }
1130
1131             pi_chan_table[j] = l;
1132
1133             j++;
1134         }
1135     }
1136
1137     for( i = 0; i < i_nb_channels; i++ )
1138     {
1139         if( pi_chan_table[i] != i )
1140         {
1141             p_aout->output.p_sys->b_chan_reorder = VLC_TRUE;
1142         }
1143     }
1144
1145     if( p_aout->output.p_sys->b_chan_reorder )
1146     {
1147         msg_Dbg( p_aout, "channel reordering needed" );
1148     }
1149
1150 #undef pi_chan_table
1151 #undef waveformat
1152 }
1153
1154 /*****************************************************************************
1155  * InterleaveFloat32/S16: change the channel order to the Microsoft one.
1156  *****************************************************************************/
1157 static void InterleaveFloat32( float *p_buf, float *p_buf_out,
1158                                int *pi_chan_table, int i_nb_channels )
1159 {
1160     int i, j;
1161
1162     for( i = 0; i < FRAME_SIZE; i++ )
1163     {
1164         for( j = 0; j < i_nb_channels; j++ )
1165         {
1166             p_buf_out[i*i_nb_channels + pi_chan_table[j]] =
1167                 p_buf[i*i_nb_channels + j];
1168         }
1169     }
1170 }
1171
1172 static void InterleaveS16( int16_t *p_buf, int16_t *p_buf_out,
1173                            int *pi_chan_table, int i_nb_channels )
1174 {
1175     int i, j;
1176
1177     for( i = 0; i < FRAME_SIZE; i++ )
1178     {
1179         for( j = 0; j < i_nb_channels; j++ )
1180         {
1181             p_buf_out[ i*i_nb_channels + pi_chan_table[j]] =
1182                 p_buf[i*i_nb_channels + j];
1183         }
1184     }
1185 }