5235775e7c005c98572e5bb7aabaa75cc0c604f7
[vlc.git] / modules / packetizer / mpeg4audio.c
1 /*****************************************************************************
2  * mpeg4audio.c
3  *****************************************************************************
4  * Copyright (C) 2001, 2002 VideoLAN
5  * $Id: mpeg4audio.c,v 1.3 2003/03/11 19:02:31 fenrir Exp $
6  *
7  * Authors: Laurent Aimar <fenrir@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., 59 Temple Place - Suite 330, Boston, MA  02111, USA.
22  *****************************************************************************/
23
24 /*****************************************************************************
25  * Preamble
26  *****************************************************************************/
27 #include <vlc/vlc.h>
28 #include <vlc/aout.h>
29 #include <vlc/decoder.h>
30 #include <vlc/input.h>
31 #include <vlc/sout.h>
32 #include "codecs.h"
33 #include <stdlib.h>                                      /* malloc(), free() */
34 #include <string.h>                                              /* strdup() */
35
36 /*****************************************************************************
37  * Local prototypes
38  *****************************************************************************/
39
40 /* AAC Config in ES:
41  *
42  * AudioObjectType          5 bits
43  * samplingFrequencyIndex   4 bits
44  * if (samplingFrequencyIndex == 0xF)
45  *  samplingFrequency   24 bits
46  * channelConfiguration     4 bits
47  * GA_SpecificConfig
48  *  FrameLengthFlag         1 bit 1024 or 960
49  *  DependsOnCoreCoder      1 bit (always 0)
50  *  ExtensionFlag           1 bit (always 0)
51  */
52
53 typedef struct packetizer_thread_s
54 {
55     /* Input properties */
56     int                     b_adts;
57
58     decoder_fifo_t          *p_fifo;
59     bit_stream_t            bit_stream;
60
61     /* Output properties */
62     sout_packetizer_input_t *p_sout_input;
63     sout_packet_format_t    output_format;
64
65     mtime_t                 i_pts_start;
66     mtime_t                 i_pts;
67
68     WAVEFORMATEX            *p_wf;
69
70     /* Extracted from AAC config */
71     int                     i_sample_rate;
72     int                     i_frame_size;   // 1024 or 960
73
74 } packetizer_thread_t;
75
76 static int  Open    ( vlc_object_t * );
77 static int  Run     ( decoder_fifo_t * );
78
79 static int  InitThread           ( packetizer_thread_t * );
80 static void PacketizeThreadMPEG4 ( packetizer_thread_t * );
81 static void PacketizeThreadADTS  ( packetizer_thread_t * );
82 static void EndThread            ( packetizer_thread_t * );
83
84 /*****************************************************************************
85  * Module descriptor
86  *****************************************************************************/
87
88 vlc_module_begin();
89     set_description( _("MPEG4 Audio packetizer") );
90     set_capability( "packetizer", 50 );
91     set_callbacks( Open, NULL );
92 vlc_module_end();
93
94
95 /*****************************************************************************
96  * OpenDecoder: probe the packetizer and return score
97  *****************************************************************************
98  * Tries to launch a decoder and return score so that the interface is able
99  * to choose.
100  *****************************************************************************/
101 static int Open( vlc_object_t *p_this )
102 {
103     decoder_fifo_t *p_fifo = (decoder_fifo_t*) p_this;
104
105     p_fifo->pf_run = Run;
106
107     if( p_fifo->i_fourcc == VLC_FOURCC( 'm', 'p', '4', 'a') )
108     {
109         return( VLC_SUCCESS );
110     }
111     else
112     {
113         return( VLC_EGENERIC );
114     }
115 }
116
117 /*****************************************************************************
118  * RunDecoder: this function is called just after the thread is created
119  *****************************************************************************/
120 static int Run( decoder_fifo_t *p_fifo )
121 {
122     packetizer_thread_t *p_pack;
123     int b_error;
124
125     msg_Info( p_fifo, "Running MPEG4 audio packetizer" );
126     if( !( p_pack = malloc( sizeof( packetizer_thread_t ) ) ) )
127     {
128         msg_Err( p_fifo, "out of memory" );
129         DecoderError( p_fifo );
130         return( -1 );
131     }
132     memset( p_pack, 0, sizeof( packetizer_thread_t ) );
133
134     p_pack->p_fifo = p_fifo;
135
136     if( InitThread( p_pack ) != 0 )
137     {
138         DecoderError( p_fifo );
139         return( -1 );
140     }
141
142     while( ( !p_pack->p_fifo->b_die )&&( !p_pack->p_fifo->b_error ) )
143     {
144         if( p_pack->b_adts )
145         {
146             PacketizeThreadADTS( p_pack );
147         }
148         else
149         {
150             PacketizeThreadMPEG4( p_pack );
151         }
152     }
153
154
155     if( ( b_error = p_pack->p_fifo->b_error ) )
156     {
157         DecoderError( p_pack->p_fifo );
158     }
159
160     EndThread( p_pack );
161     if( b_error )
162     {
163         return( -1 );
164     }
165
166     return( 0 );
167 }
168
169
170 #define FREE( p ) if( p ) free( p ); p = NULL
171
172 /*****************************************************************************
173  * InitThread: initialize data before entering main loop
174  *****************************************************************************/
175 static int i_sample_rates[] = 
176 {
177     96000, 88200, 64000, 48000, 44100, 32000, 24000, 22050, 
178     16000, 12000, 11025, 8000,  7350,  0,     0,     0
179 };
180
181 static int InitThread( packetizer_thread_t *p_pack )
182 {
183     WAVEFORMATEX    *p_wf;
184
185     p_wf = (WAVEFORMATEX*)p_pack->p_fifo->p_waveformatex;
186
187     if( p_wf && p_wf->cbSize > 0)
188     {
189         uint8_t *p_config = (uint8_t*)&p_wf[1];
190         int i_wf = sizeof( WAVEFORMATEX ) + p_wf->cbSize;
191         int i_index;
192
193
194         p_pack->p_wf = malloc( i_wf );
195         memcpy( p_pack->p_wf,
196                 p_wf,
197                 i_wf );
198         p_pack->output_format.i_cat = AUDIO_ES;
199         p_pack->output_format.i_fourcc = VLC_FOURCC( 'm', 'p', '4', 'a' );
200         p_pack->output_format.p_format = p_pack->p_wf;
201         p_pack->b_adts = 0;
202
203         i_index = ( ( p_config[0] << 1 ) | ( p_config[1] >> 7 ) )&0x0f;
204         if( i_index != 0x0f )
205         {
206             p_pack->i_sample_rate = i_sample_rates[i_index];
207             p_pack->i_frame_size  = ( ( p_config[1] >> 2 )&0x01 ) ? 960 : 1024;
208         }
209         else
210         {
211             p_pack->i_sample_rate = ( ( p_config[1]&0x7f ) << 17 ) | ( p_config[2] << 9 )| 
212                                       ( p_config[3] << 1 ) | ( p_config[4] >> 7 );
213             p_pack->i_frame_size  = ( ( p_config[4] >> 2 )&0x01 ) ? 960 : 1024;
214         }
215         msg_Dbg( p_pack->p_fifo,
216                  "aac %dHz %d samples/frame",
217                  p_pack->i_sample_rate,
218                  p_pack->i_frame_size );
219     }
220     else
221     {
222         /* we will try to create a AAC Config from adts */
223         p_pack->output_format.i_cat = UNKNOWN_ES;
224         p_pack->output_format.i_fourcc = VLC_FOURCC( 'n', 'u', 'l', 'l' );
225         p_pack->b_adts = 1;
226
227         if( InitBitstream( &p_pack->bit_stream, p_pack->p_fifo,
228                NULL, NULL ) != VLC_SUCCESS )
229         {
230             msg_Err( p_pack->p_fifo, "cannot initialize bitstream" );
231             return -1;
232         }
233
234     }
235
236     p_pack->p_sout_input = 
237         sout_InputNew( p_pack->p_fifo,
238                        &p_pack->output_format );
239
240     if( !p_pack->p_sout_input )
241     {
242         msg_Err( p_pack->p_fifo, 
243                  "cannot add a new stream" );
244         return( -1 );
245     }
246
247     p_pack->i_pts_start = -1;
248     p_pack->i_pts = 0;
249     return( 0 );
250 }
251
252 /*****************************************************************************
253  * PacketizeThread: packetize an unit (here copy a complete pes)
254  *****************************************************************************/
255 static void PacketizeThreadMPEG4( packetizer_thread_t *p_pack )
256 {
257     sout_buffer_t   *p_sout_buffer;
258     pes_packet_t    *p_pes;
259     ssize_t          i_size;
260
261     /* **** get samples count **** */
262     input_ExtractPES( p_pack->p_fifo, &p_pes );
263     if( !p_pes )
264     {
265         p_pack->p_fifo->b_error = 1;
266         return;
267     }
268 #if 0
269     if( p_pack->i_pts_start < 0 && p_pes->i_pts > 0 )
270     {
271         p_pack->i_pts_start = p_pes->i_pts;
272     }
273     p_pack->i_pts = p_pes->i_pts - p_pack->i_pts_start;
274 #endif
275
276     i_size = p_pes->i_pes_size;
277
278     if( i_size > 0 )
279     {
280         data_packet_t   *p_data;
281         ssize_t          i_buffer;
282
283         p_sout_buffer = 
284             sout_BufferNew( p_pack->p_sout_input->p_sout, i_size );
285         if( !p_sout_buffer )
286         {
287             p_pack->p_fifo->b_error = 1;
288             return;
289         }
290         /* TODO: memcpy of the pes packet */
291         for( i_buffer = 0, p_data = p_pes->p_first;
292              p_data != NULL && i_buffer < i_size;
293              p_data = p_data->p_next)
294         {
295             size_t          i_copy;
296
297             i_copy = __MIN( p_data->p_payload_end - p_data->p_payload_start,
298                             i_size - i_buffer );
299             if( i_copy > 0 )
300             {
301                 p_pack->p_fifo->p_vlc->pf_memcpy( p_sout_buffer->p_buffer + i_buffer,
302                                                   p_data->p_payload_start,
303                                                   i_copy );
304             }
305             i_buffer += i_copy;
306         }
307
308         p_sout_buffer->i_length = (mtime_t)1000000 * (mtime_t)p_pack->i_frame_size / (mtime_t)p_pack->i_sample_rate;
309         p_sout_buffer->i_bitrate = 0;
310         p_sout_buffer->i_dts = p_pack->i_pts;
311         p_sout_buffer->i_pts = p_pack->i_pts;
312
313         sout_InputSendBuffer( p_pack->p_sout_input,
314                                p_sout_buffer );
315
316         p_pack->i_pts += (mtime_t)1000000 * (mtime_t)p_pack->i_frame_size / (mtime_t)p_pack->i_sample_rate;
317     }
318
319     input_DeletePES( p_pack->p_fifo->p_packets_mgt, p_pes );
320 }
321
322
323 static void PacketizeThreadADTS( packetizer_thread_t *p_pack )
324 {
325     msg_Err( p_pack->p_fifo, "adts stream unsupported" );
326     p_pack->p_fifo->b_error = 1;
327 }
328
329 /*****************************************************************************
330  * EndThread : packetizer thread destruction
331  *****************************************************************************/
332 static void EndThread ( packetizer_thread_t *p_pack)
333 {
334     if( p_pack->p_sout_input )
335     {
336         sout_InputDelete( p_pack->p_sout_input );
337     }
338     if( p_pack->p_wf )
339     {
340         free( p_pack->p_wf );
341     }
342 }
343