aft.c: Fix com_add().
[paraslash.git] / ogg_afh.c
1 /*
2  * Copyright (C) 2004-2007 Andre Noll <maan@systemlinux.org>
3  *
4  * Licensed under the GPL v2. For licencing details see COPYING.
5  */
6 /** \file ogg_afh.c para_server's ogg vorbis audio format handler */
7
8 #include <inttypes.h>
9 #include <ogg/ogg.h>
10 #include <vorbis/codec.h>
11 #include <vorbis/vorbisfile.h>
12
13 #include "para.h"
14 #include "afh.h"
15 #include "server.h"
16 #include "error.h"
17 #include "string.h"
18
19 /** must be big enough to hold header */
20 #define CHUNK_SIZE 32768
21 static double chunk_time = 0.25;
22
23 /** describes a memory-mapped ogg vorbis file */
24 struct ogg_datasource {
25         /** the memory mapping */
26         char *map;
27         /** this size of the mapping */
28         off_t numbytes;
29         /** the current position in the mapping */
30         off_t fpos;
31 };
32
33 static size_t cb_read(void *buf, size_t size, size_t nmemb, void *datasource)
34 {
35         struct ogg_datasource *ods = datasource;
36         size_t copy = PARA_MIN(ods->numbytes - ods->fpos, size * nmemb),
37                 ret = copy / size;
38         if (!ret)
39                 return 0;
40         memcpy(buf, ods->map + ods->fpos, copy);
41 //      PARA_INFO_LOG("size: %zd, nmemb: %zd, ret: %zd\n", size, nmemb, ret);
42         ods->fpos += ret * size;
43         return ret;
44 }
45
46 static int cb_seek(void *datasource, ogg_int64_t offset,
47                 int whence)
48 {
49         struct ogg_datasource *ods = datasource;
50         switch (whence) {
51         case SEEK_SET:
52                 if (offset >= 0 && offset <= ods->numbytes) {
53                         ods->fpos = offset;
54                         return 0;
55                 }
56                 errno = EINVAL;
57                 return -1;
58                 break;
59         case SEEK_END:
60                 if (offset <= 0 && -offset <= ods->numbytes) {
61                         ods->fpos = ods->numbytes + offset;
62                         return 0;
63                 }
64                 errno = EINVAL;
65                 return -1;
66                 break;
67         case SEEK_CUR:
68                 if ((offset >= 0 && offset + ods->fpos > ods->numbytes) ||
69                                 (offset < 0 && offset + ods->fpos < 0)) {
70                         errno = EINVAL;
71                         return -1;
72                 }
73                 ods->fpos += offset;
74                 return 0;
75         }
76         errno = EINVAL;
77         return -1;
78 }
79
80 /* don't do anything as vss still needs the open filehandle */
81 static int cb_close(__a_unused void *datasource)
82 {
83         return 0;
84 }
85
86 static long cb_tell(void *datasource)
87 {
88         struct ogg_datasource *ods = datasource;
89         return (unsigned long)ods->fpos;
90 }
91
92 static int ogg_open_callbacks(void *datasource, OggVorbis_File *vf, ov_callbacks c)
93 {
94         int ret = ov_open_callbacks(datasource, vf,
95                 NULL, /* no initial buffer */
96                 0, /* no initial bytes */
97                 c); /* the ov_open_callbacks */
98
99         if (ret == OV_EREAD)
100                 return -E_OGG_READ;
101         if (ret == OV_ENOTVORBIS)
102                 return -E_VORBIS;
103         if (ret == OV_EVERSION)
104                 return -E_OGG_VERSION;
105         if (ret == OV_EBADHEADER)
106                 return -E_OGG_BAD_HEADER;
107         if (ret < 0)
108                 return -E_OGG_UNKNOWN_ERROR;
109         return 1;
110
111 }
112
113 static int ogg_compute_header_len(char *map, size_t numbytes,
114                 struct audio_format_info *afi)
115 {
116         int ret;
117         size_t len = PARA_MIN(numbytes, CHUNK_SIZE);
118         int serial;
119         char *buf;
120
121         ogg_page page;
122         ogg_packet packet;
123         vorbis_comment vc;
124         vorbis_info vi;
125         ogg_stream_state *stream_in = para_malloc(sizeof(ogg_stream_state));
126         ogg_stream_state *stream_out = para_malloc(sizeof(ogg_stream_state));
127         ogg_sync_state *sync_in = para_malloc(sizeof(ogg_sync_state));
128
129         ogg_sync_init(sync_in);
130         vorbis_info_init(&vi);
131         vorbis_comment_init(&vc);
132         buf = ogg_sync_buffer(sync_in, (long)len);
133         memcpy(buf, map, len);
134         ogg_sync_wrote(sync_in, (long)len);
135         ret = -E_SYNC_PAGEOUT;
136         if (ogg_sync_pageout(sync_in, &page) <= 0)
137                 goto err1;
138         serial = ogg_page_serialno(&page);
139         ogg_stream_init(stream_in, serial);
140         ogg_stream_init(stream_out, serial);
141         ret = ogg_stream_pagein(stream_in, &page);
142         if (ret < 0) {
143                 ret = -E_STREAM_PAGEIN;
144                 goto err2;
145         }
146         ret = ogg_stream_packetout(stream_in, &packet);
147         if (ret != 1) {
148                 ret = -E_STREAM_PACKETOUT;
149                 goto err2;
150         }
151         ret = -E_VORBIS;
152         if (vorbis_synthesis_headerin(&vi, &vc, &packet) < 0)
153                 goto err2;
154         PARA_INFO_LOG("channels: %i, rate: %li\n", vi.channels, vi.rate);
155         ogg_stream_packetin(stream_out, &packet);
156
157         ret = ogg_sync_pageout(sync_in, &page);
158         if (ret <= 0) {
159                 ret = -E_SYNC_PAGEOUT;
160                 goto err2;
161         }
162         ogg_stream_pagein(stream_in, &page);
163         ogg_stream_packetout(stream_in, &packet);
164         ogg_stream_packetin(stream_out, &packet);
165
166         ret = ogg_sync_pageout(sync_in, &page);
167         if (ret <= 0) {
168                 ret = -E_SYNC_PAGEOUT;
169                 goto err2;
170         }
171         ogg_stream_pagein(stream_in, &page);
172         ogg_stream_packetout(stream_in, &packet);
173         ogg_stream_packetin(stream_out, &packet);
174
175         afi->header_len = 0;
176         while (ogg_stream_flush(stream_out, &page))
177                 afi->header_len += page.body_len + page.header_len;
178         PARA_INFO_LOG("header_len = %d\n", afi->header_len);
179         afi->header_offset = 0;
180         ret = 1;
181 err2:
182         ogg_stream_destroy(stream_in);
183         ogg_stream_destroy(stream_out);
184 err1:
185         ogg_sync_destroy(sync_in);
186         vorbis_info_clear(&vi);
187         vorbis_comment_clear(&vc);
188         return ret;
189 }
190
191 /*
192  * Alloc and fill array table of byte offsets. chunk_table[i] is the
193  * offset in the current input file at which the sample containing time i *
194  * CHUNK_TIME begins. Always successful.
195  */
196 static long unsigned ogg_compute_chunk_table(OggVorbis_File *of,
197         struct audio_format_info *afi, long unsigned time_total)
198 {
199         int i, ret, num;
200         ssize_t max_chunk_len, pos = 0, min = 0, old_pos;
201         long unsigned num_chunks;
202
203         old_pos = 0;
204         ret = 0;
205         num = time_total / chunk_time + 3;
206         PARA_DEBUG_LOG("chunk time: %g allocating %d chunk pointers\n",
207                 chunk_time, num);
208         afi->chunk_table = para_malloc((num + 1) * sizeof(size_t));
209         afi->chunk_table[0] = 0;
210         max_chunk_len = 0;
211         for (i = 1; ret <= num; i++) {
212                 ogg_int64_t diff;
213                 ret = ov_time_seek(of, i * chunk_time);
214                 if (ret)
215                         break;
216                 pos = ov_raw_tell(of);
217                 diff = pos - old_pos;
218                 max_chunk_len = PARA_MAX(max_chunk_len, diff);
219                 min = (i == 1)? diff : PARA_MIN(min, diff);
220                 afi->chunk_table[i] = pos;
221 //              if (i < 11 || !((i - 1) % 1000)|| i > num - 11)
222 //                      PARA_DEBUG_LOG("chunk #%d: %g secs, pos: %zd, "
223 //                              "size: %zd\n", i - 1,
224 //                              i * chunk_time, pos, pos - old_pos);
225                 old_pos = pos;
226         }
227         num_chunks = i - 1;
228 //fi->chunk_table[i] = pos;
229         PARA_INFO_LOG("%lu chunks (%fs), max chunk: %zd, min chunk: %zd\n",
230                 num_chunks, chunk_time, max_chunk_len, min);
231         return num_chunks;
232 }
233
234 /*
235  * Init oggvorbis file and write some tech data to given pointers.
236  */
237 static int ogg_get_file_info(char *map, size_t numbytes,
238                 struct audio_format_info *afi)
239 {
240         int ret;
241         vorbis_info *vi;
242         OggVorbis_File of;
243         const ov_callbacks ovc = {
244                 .read_func = cb_read,
245                 .seek_func = cb_seek,
246                 .close_func = cb_close,
247                 .tell_func = cb_tell
248         };
249         struct ogg_datasource ods = {.map = map, .numbytes = numbytes, .fpos = 0};
250
251         ret = ogg_compute_header_len(map, numbytes, afi);
252         if (ret < 0)
253                 return ret;
254         ret = ogg_open_callbacks(&ods, &of, ovc);
255         if (ret < 0)
256                 goto err;
257         ret = -E_OGG_INFO;
258         vi = ov_info(&of, 0);
259         if (!vi)
260                 goto err;
261         afi->seconds_total = ov_time_total(&of, -1);
262         afi->frequency = vi->rate;
263         afi->bitrate = ov_bitrate(&of, 0);
264         afi->channels = vi->channels;
265         afi->chunks_total = ogg_compute_chunk_table(&of, afi, afi->seconds_total);
266         sprintf(afi->info_string, "audio_file_info1:%lu x %lu, %ukHz, "
267                 "%d channels, %ukbps\n"
268                 "audio_file_info2: \n"
269                 "audio_file_info3: \n",
270                 afi->chunks_total, (long unsigned) (chunk_time * 1000 * 1000),
271                 afi->frequency / 1000, vi->channels, afi->bitrate / 1000
272                 );
273         afi->chunk_tv.tv_sec = 0;
274         afi->chunk_tv.tv_usec = 250 * 1000;
275         tv_scale(3, &afi->chunk_tv, &afi->eof_tv);
276         ret = 1;
277 err:
278         ov_clear(&of); /* keeps the file open */
279         return ret;
280 }
281
282 static const char* ogg_suffixes[] = {"ogg", NULL};
283
284 /**
285  * the init function of the ogg vorbis audio format handler
286  *
287  * \param afh pointer to the struct to initialize
288  */
289 void ogg_init(struct audio_format_handler *afh)
290 {
291         afh->get_file_info = ogg_get_file_info,
292         afh->suffixes = ogg_suffixes;
293 }