1d046a3bb28b601faabbaf3ee536870aab2060cf
[ffmpeg.git] / libavcodec / oggvorbis.c
1 /*
2  * Ogg Vorbis codec support via libvorbisenc
3  * Mark Hills <mark@pogo.org.uk>
4  */
5
6 #include <time.h>
7
8 #include <vorbis/vorbisenc.h>
9
10 #include "avcodec.h"
11 #include "oggvorbis.h"
12
13 #define OGGVORBIS_FRAME_SIZE 1024
14
15
16 typedef struct OggVorbisContext {
17     vorbis_info vi ;
18     vorbis_dsp_state vd ;
19     vorbis_block vb ;
20
21     /* decoder */
22     vorbis_comment vc ;
23 } OggVorbisContext ;
24
25
26 int oggvorbis_init_encoder(vorbis_info *vi, AVCodecContext *avccontext) {
27     if(avccontext->quality) /* VBR requested */
28         return vorbis_encode_init_vbr(vi, avccontext->channels,
29                   avccontext->sample_rate, (float)avccontext->quality / 1000) ;
30
31     return vorbis_encode_init(vi, avccontext->channels,
32                   avccontext->sample_rate, -1, avccontext->bit_rate, -1) ;
33 }
34
35
36 static int oggvorbis_encode_init(AVCodecContext *avccontext) {
37     OggVorbisContext *context = avccontext->priv_data ;
38
39     vorbis_info_init(&context->vi) ;
40     if(oggvorbis_init_encoder(&context->vi, avccontext) < 0) {
41         fprintf(stderr, "oggvorbis_encode_init: init_encoder failed") ;
42         return -1 ;
43     }
44     vorbis_analysis_init(&context->vd, &context->vi) ;
45     vorbis_block_init(&context->vd, &context->vb) ;
46
47     avccontext->frame_size = OGGVORBIS_FRAME_SIZE ;
48     
49     return 0 ;
50 }
51
52
53 static int oggvorbis_encode_frame(AVCodecContext *avccontext,
54                                   unsigned char *packets,
55                            int buf_size, void *data)
56 {
57     OggVorbisContext *context = avccontext->priv_data ;
58     float **buffer ;
59     ogg_packet op ;
60     signed char *audio = data ;
61     int l, samples = OGGVORBIS_FRAME_SIZE ;
62
63     buffer = vorbis_analysis_buffer(&context->vd, samples) ;
64
65     if(context->vi.channels == 1) {
66         for(l = 0 ; l < samples ; l++)
67             buffer[0][l]=((audio[l*2+1]<<8)|(0x00ff&(int)audio[l*2]))/32768.f;
68     } else {
69         for(l = 0 ; l < samples ; l++){
70             buffer[0][l]=((audio[l*4+1]<<8)|(0x00ff&(int)audio[l*4]))/32768.f;
71             buffer[1][l]=((audio[l*4+3]<<8)|(0x00ff&(int)audio[l*4+2]))/32768.f;
72         }
73     }
74     
75     vorbis_analysis_wrote(&context->vd, samples) ; 
76
77     l = 0 ;
78
79     while(vorbis_analysis_blockout(&context->vd, &context->vb) == 1) {
80         vorbis_analysis(&context->vb, NULL);
81         vorbis_bitrate_addblock(&context->vb) ;
82
83         while(vorbis_bitrate_flushpacket(&context->vd, &op)) {
84             memcpy(packets + l, &op, sizeof(ogg_packet)) ;
85             memcpy(packets + l + sizeof(ogg_packet), op.packet, op.bytes) ;
86             l += sizeof(ogg_packet) + op.bytes ;
87         }
88     }
89
90     return l ;
91 }
92
93
94 static int oggvorbis_encode_close(AVCodecContext *avccontext) {
95     OggVorbisContext *context = avccontext->priv_data ;
96 /*  ogg_packet op ; */
97     
98     vorbis_analysis_wrote(&context->vd, 0) ; /* notify vorbisenc this is EOF */
99
100     /* We need to write all the remaining packets into the stream
101      * on closing */
102     
103     fprintf(stderr, "fixme: not all packets written on oggvorbis_encode_close()\n") ;
104
105 /*
106     while(vorbis_bitrate_flushpacket(&context->vd, &op)) {
107         memcpy(packets + l, &op, sizeof(ogg_packet)) ;
108         memcpy(packets + l + sizeof(ogg_packet), op.packet, op.bytes) ;
109         l += sizeof(ogg_packet) + op.bytes ;    
110     }
111 */
112
113     vorbis_block_clear(&context->vb);
114     vorbis_dsp_clear(&context->vd);
115     vorbis_info_clear(&context->vi);
116   
117     return 0 ;
118 }
119
120
121 AVCodec oggvorbis_encoder = {
122     "vorbis",
123     CODEC_TYPE_AUDIO,
124     CODEC_ID_VORBIS,
125     sizeof(OggVorbisContext),
126     oggvorbis_encode_init,
127     oggvorbis_encode_frame,
128     oggvorbis_encode_close
129 } ;
130
131
132 static int oggvorbis_decode_init(AVCodecContext *avccontext) {
133     OggVorbisContext *context = avccontext->priv_data ;
134
135     vorbis_info_init(&context->vi) ;
136     vorbis_comment_init(&context->vc) ;
137
138     return 0 ;
139 }
140
141
142 static inline int conv(int samples, float **pcm, char *buf, int channels) {
143     int i, j, val ;
144     ogg_int16_t *ptr, *data = (ogg_int16_t*)buf ;
145     float *mono ;
146  
147     for(i = 0 ; i < channels ; i++){
148         ptr = &data[i];
149         mono = pcm[i] ;
150         
151         for(j = 0 ; j < samples ; j++) {
152             
153             val = mono[j] * 32767.f;
154             
155             if(val > 32767) val = 32767 ;
156             if(val < -32768) val = -32768 ;
157                     
158             *ptr = val ;
159             ptr += channels;
160         }
161     }
162     
163     return 0 ;
164 }
165            
166         
167 static int oggvorbis_decode_frame(AVCodecContext *avccontext,
168                         void *data, int *data_size,
169                         UINT8 *buf, int buf_size)
170 {
171     OggVorbisContext *context = avccontext->priv_data ;
172     ogg_packet *op = (ogg_packet*)buf ;
173     float **pcm ;
174     int samples, total_samples, total_bytes ;
175  
176     op->packet = (char*)op + sizeof(ogg_packet) ; /* correct data pointer */
177
178     if(op->packetno < 3) {
179         vorbis_synthesis_headerin(&context->vi, &context->vc, op) ;
180         return buf_size ;
181     }
182
183     if(op->packetno == 3) {
184         fprintf(stderr, "vorbis_decode: %d channel, %ldHz, encoder `%s'\n",
185                 context->vi.channels, context->vi.rate, context->vc.vendor);
186
187         avccontext->channels = context->vi.channels ;
188         avccontext->sample_rate = context->vi.rate ;
189         
190         vorbis_synthesis_init(&context->vd, &context->vi) ;
191         vorbis_block_init(&context->vd, &context->vb); 
192     }
193
194     if(vorbis_synthesis(&context->vb, op) == 0)
195         vorbis_synthesis_blockin(&context->vd, &context->vb) ;
196     
197     total_samples = 0 ;
198     total_bytes = 0 ;
199
200     while((samples = vorbis_synthesis_pcmout(&context->vd, &pcm)) > 0) {
201         conv(samples, pcm, (char*)data + total_bytes, context->vi.channels) ;
202         total_bytes += samples * 2 * context->vi.channels ;
203         total_samples += samples ;
204         vorbis_synthesis_read(&context->vd, samples) ;
205     }
206
207     *data_size = total_bytes ;   
208     return buf_size ;
209 }
210
211
212 static int oggvorbis_decode_close(AVCodecContext *avccontext) {
213     OggVorbisContext *context = avccontext->priv_data ;
214    
215     vorbis_info_clear(&context->vi) ;
216     vorbis_comment_clear(&context->vc) ;
217
218     return 0 ;
219 }
220
221
222 AVCodec oggvorbis_decoder = {
223     "vorbis",
224     CODEC_TYPE_AUDIO,
225     CODEC_ID_VORBIS,
226     sizeof(OggVorbisContext),
227     oggvorbis_decode_init,
228     NULL,
229     oggvorbis_decode_close,
230     oggvorbis_decode_frame,
231 } ;