7dda5496443c0cc07f53a23b26860b1dbdec6211
[paraslash.git] / mp3_afh.c
1 /*
2 * Copyright (C) 2003-2008 Andre Noll <maan@systemlinux.org>
3 *
4 * Licensed under the GPL v2. For licencing details see COPYING.
5 */
6
7 /** \file mp3_afh.c para_server's mp3 audio format handler */
8
9 /*
10 * This file is based in part on mp3tech.c and mp3tech.h, Copyright (C)
11 * 2000-2001 Cedric Tefft <cedric@earthling.net>, which in turn is based
12 * in part on
13 *
14 * * MP3Info 0.5 by Ricardo Cerqueira <rmc@rccn.net>
15 * * MP3Stat 0.9 by Ed Sweetman <safemode@voicenet.com> and
16 * Johannes Overmann <overmann@iname.com>
17 */
18
19 #include "para.h"
20 #include "error.h"
21 #include "afh.h"
22 #include "string.h"
23 #include "afs.h"
24 #include "server.h"
25
26 /** \cond some defines and structs which are only used in this file */
27
28 /*
29 * MIN_CONSEC_GOOD_FRAMES defines how many consecutive valid MP3 frames we need
30 * to see before we decide we are looking at a real MP3 file
31 */
32 #define MIN_CONSEC_GOOD_FRAMES 4
33 #define FRAME_HEADER_SIZE 4
34 #define MIN_FRAME_SIZE 21
35
36 struct mp3header {
37 unsigned long sync;
38 unsigned int version;
39 unsigned int layer;
40 unsigned int crc;
41 unsigned int bitrate;
42 unsigned int freq;
43 unsigned int padding;
44 unsigned int mode;
45 unsigned int copyright;
46 unsigned int original;
47 unsigned int emphasis;
48 };
49
50 /** \endcond */
51 static const int frequencies[3][4] = {
52 {22050,24000,16000,50000}, /* MPEG 2.0 */
53 {44100,48000,32000,50000}, /* MPEG 1.0 */
54 {11025,12000,8000,50000} /* MPEG 2.5 */
55 };
56
57 static const int mp3info_bitrate[2][3][14] = {
58 { /* MPEG 2.0 */
59 {32,48,56,64,80,96,112,128,144,160,176,192,224,256}, /* layer 1 */
60 {8,16,24,32,40,48,56,64,80,96,112,128,144,160}, /* layer 2 */
61 {8,16,24,32,40,48,56,64,80,96,112,128,144,160} /* layer 3 */
62 },
63
64 { /* MPEG 1.0 */
65 {32,64,96,128,160,192,224,256,288,320,352,384,416,448}, /* layer 1 */
66 {32,48,56,64,80,96,112,128,160,192,224,256,320,384}, /* layer 2 */
67 {32,40,48,56,64,80,96,112,128,160,192,224,256,320} /* layer 3 */
68 }
69 };
70
71 static const int frame_size_index[] = {24000, 72000, 72000};
72 static const char *mode_text[] = {"stereo", "joint stereo", "dual channel", "mono", "invalid"};
73
74 static int header_frequency(struct mp3header *h)
75 {
76 if (h->version > 2 || h->freq > 3)
77 return -E_HEADER_FREQ;
78 return frequencies[h->version][h->freq];
79 }
80
81 static const char *header_mode(struct mp3header *h)
82 {
83 if (h->mode > 4)
84 h->mode = 4; /* invalid */
85 return mode_text[h->mode];
86 }
87
88 static int header_channels(struct mp3header *h)
89 {
90 if (h->mode > 3)
91 return 0;
92 if (h->mode < 3)
93 return 2;
94 return 1;
95 }
96
97 static int header_bitrate(struct mp3header *h)
98 {
99 if (!h->layer || h->layer > 3 || h->bitrate > 14 || !h->bitrate)
100 return -E_HEADER_BITRATE;
101 return mp3info_bitrate[h->version & 1][3 - h->layer][h->bitrate - 1];
102 }
103
104 static int frame_length(struct mp3header *header)
105 {
106 int hb, hf = header_frequency(header);
107
108 if (hf < 0)
109 return hf;
110 hb = header_bitrate(header);
111 if (hb < 0)
112 return hb;
113 if (header->sync != 0xFFE || header->layer > 3)
114 return -E_FRAME;
115 return frame_size_index[3 - header->layer] *
116 ((header->version & 1) + 1) * hb / hf
117 + header->padding;
118 }
119
120 /*
121 * Remove trailing whitespace from the end of a string
122 */
123 static char *unpad(char *string)
124 {
125 char *pos = string + strlen(string) - 1;
126 while (para_isspace(pos[0]))
127 (pos--)[0] = 0;
128 return string;
129 }
130
131 static int compare_headers(struct mp3header *h1,struct mp3header *h2)
132 {
133 if ((*(uint*)h1) == (*(uint*)h2))
134 return 1;
135 if ((h1->version == h2->version) &&
136 (h1->layer == h2->layer) &&
137 (h1->crc == h2->crc) &&
138 (h1->freq == h2->freq) &&
139 (h1->mode == h2->mode) &&
140 (h1->copyright == h2->copyright) &&
141 (h1->original == h2->original) &&
142 (h1->emphasis == h2->emphasis))
143 return 1;
144 return 0;
145 }
146
147 /*
148 * get next MP3 frame header.
149 *
150 * On success, the header frame length is returned and the given header
151 * structure that is filled in. A return value of zero means that we did not
152 * retrieve a valid frame header, and a negative return value indicates an
153 * error.
154 */
155 static int get_header(unsigned char *map, size_t numbytes, off_t *fpos,
156 struct mp3header *header)
157 {
158 int fl, ret;
159
160 if (*fpos + FRAME_HEADER_SIZE > numbytes) {
161 *fpos = numbytes - 1;
162 header->sync = 0;
163 return 0;
164 }
165 header->layer = (map[*fpos + 1] >> 1) & 3;
166 header->sync = (((int)map[*fpos]<<4) | ((int)(map[*fpos + 1]&0xE0)>>4));
167 if (map[*fpos + 1] & 0x10)
168 header->version = (map[*fpos + 1] >> 3) & 1;
169 else
170 header->version = 2;
171 if ((header->sync != 0xFFE) || (header->layer != 1)) {
172 ret = 0;
173 header->sync = 0;
174 goto out;
175 }
176 header->crc = map[*fpos + 1] & 1;
177 header->bitrate = (map[*fpos + 2] >> 4) & 0x0F;
178 header->freq = (map[*fpos + 2] >> 2) & 0x3;
179 header->padding = (map[*fpos + 2] >>1) & 0x1;
180 header->mode = (map[*fpos + 3] >> 6) & 0x3;
181 fl = frame_length(header);
182 ret = (fl >= MIN_FRAME_SIZE)? fl : -E_FRAME_LENGTH;
183 out:
184 *fpos += FRAME_HEADER_SIZE;
185 return ret;
186 }
187
188 /*
189 * find the next mp3 header
190 *
191 * Return the length of the next frame header or zero if the end of the file is
192 * reached.
193 */
194 static int mp3_seek_next_header(unsigned char *map, size_t numbytes, off_t *fpos,
195 struct mp3header *result)
196 {
197 int k, l = 0, first_len;
198 struct mp3header h, h2;
199 long valid_start = 0;
200
201 for (; *fpos < numbytes; (*fpos)++) {
202 if (map[*fpos] != 0xff)
203 continue;
204 valid_start = *fpos;
205 first_len = get_header(map, numbytes, fpos, &h);
206 if (first_len <= 0)
207 continue;
208 *fpos += first_len - FRAME_HEADER_SIZE;
209 for (k = 1; k < MIN_CONSEC_GOOD_FRAMES; k++) {
210 if ((l = get_header(map, numbytes, fpos, &h2)) <= 0)
211 break;
212 if (!compare_headers(&h, &h2))
213 break;
214 *fpos += l - FRAME_HEADER_SIZE;
215 }
216 if (k == MIN_CONSEC_GOOD_FRAMES) {
217 *fpos = valid_start;
218 *result = h2;
219 return first_len;
220 }
221 }
222 return 0;
223 }
224
225 static char *mp3_get_id3(unsigned char *map, size_t numbytes)
226 {
227 char title[31], artist[31], album[31], year[5], comment[31];
228 off_t fpos;
229
230 if (numbytes < 128 || strncmp("TAG", (char *)map + numbytes - 128, 3)) {
231 PARA_DEBUG_LOG("no id3 v1 tag\n");
232 return make_message("%s: (no id3 v1 tag)\n%s:\n",
233 status_item_list[SI_TAGINFO1],
234 status_item_list[SI_TAGINFO2]);
235 }
236 fpos = numbytes - 125;
237 memcpy(title, map + fpos, 30);
238 fpos += 30;
239 title[30] = '\0';
240 memcpy(artist, map + fpos, 30);
241 fpos += 30;
242 artist[30] = '\0';
243 memcpy(album, map + fpos, 30);
244 fpos += 30;
245 album[30] = '\0';
246 memcpy(year, map + fpos, 4);
247 fpos += 4;
248 year[4] = '\0';
249 memcpy(comment, map + fpos, 30);
250 comment[30] = '\0';
251 unpad(title);
252 unpad(artist);
253 unpad(album);
254 unpad(year);
255 unpad(comment);
256 return make_message("%s: %s, by %s\n" /* taginfo1 */
257 "%s: A: %s, Y: %s, C: %s\n", /* taginfo 2*/
258 status_item_list[SI_TAGINFO1],
259 *title? title : "(title tag not set)",
260 *artist? artist : "(artist tag not set)",
261 status_item_list[SI_TAGINFO2],
262 *album? album : "(album tag not set)",
263 *year? year : "????",
264 *comment? comment : "(comment tag not set)"
265 );
266 }
267
268 static int find_valid_start(unsigned char *map, size_t numbytes, off_t *fpos,
269 struct mp3header *header)
270 {
271 int frame_len;
272
273 frame_len = get_header(map, numbytes, fpos, header);
274 if (frame_len < 0)
275 return frame_len;
276 if (!frame_len) {
277 frame_len = mp3_seek_next_header(map, numbytes, fpos, header);
278 if (frame_len <= 0)
279 return frame_len;
280 } else
281 *fpos -= FRAME_HEADER_SIZE;
282 if (frame_len <= 1)
283 return -E_FRAME_LENGTH;
284 return frame_len;
285 }
286
287 static int mp3_read_info(unsigned char *map, size_t numbytes,
288 struct afh_info *afhi)
289 {
290 long freq_avg = 0, br_avg = 0;
291 int ret, len = 0, old_br = -1, vbr = 0;
292 struct timeval total_time = {0, 0};
293 unsigned chunk_table_size = 1000; /* gets increased on demand */
294 off_t fpos = 0;
295 struct mp3header header;
296 char *taginfo;
297
298 afhi->chunks_total = 0;
299 afhi->chunk_table = para_malloc(chunk_table_size * sizeof(size_t));
300 taginfo = mp3_get_id3(map, numbytes);
301 while (1) {
302 unsigned long freq, br, fl;
303 struct timeval tmp, cct; /* current chunk time */
304 fpos += len;
305 len = find_valid_start(map, numbytes, &fpos, &header);
306 if (len <= 0)
307 break;
308 ret = header_frequency(&header);
309 if (ret < 0)
310 continue;
311 freq = ret;
312 ret = header_bitrate(&header);
313 if (ret < 0)
314 continue;
315 br = ret;
316 ret = frame_length(&header);
317 if (ret < 0)
318 continue;
319 fl = ret;
320 tmp.tv_sec = fl;
321 tmp.tv_usec = 0;
322 tv_divide(br * 125, &tmp, &cct);
323 tv_add(&cct, &total_time, &tmp);
324 total_time = tmp;
325 //PARA_DEBUG_LOG("%s: br: %d, freq: %d, fl: %d, cct: %lu\n", __func__, br, freq, fl, cct.tv_usec);
326 if (afhi->chunks_total >= chunk_table_size) {
327 chunk_table_size *= 2;
328 afhi->chunk_table = para_realloc(afhi->chunk_table,
329 chunk_table_size * sizeof(size_t));
330 }
331 afhi->chunk_table[afhi->chunks_total] = fpos;
332 // if (afhi->chunks_total < 10 || !(afhi->chunks_total % 1000))
333 // PARA_INFO_LOG("chunk #%lu: %zd\n", afhi->chunks_total,
334 // afhi->chunk_table[afhi->chunks_total]);
335 afhi->chunks_total++;
336 if (afhi->chunks_total == 1) {
337 freq_avg = freq;
338 br_avg = br;
339 old_br = br;
340 continue;
341 }
342 freq_avg += ((long)freq - freq_avg) / ((long)afhi->chunks_total + 1);
343 br_avg += ((long)br - br_avg) / ((long)afhi->chunks_total + 1);
344 if (old_br != br)
345 vbr = 1;
346 old_br = br;
347 }
348 ret = -E_MP3_INFO;
349 if (!afhi->chunks_total || !freq_avg || !br_avg)
350 goto err_out;
351 afhi->chunk_table[afhi->chunks_total] = numbytes - 1;
352 afhi->bitrate = br_avg;
353 afhi->frequency = freq_avg;
354 afhi->channels = header_channels(&header);
355 afhi->seconds_total = (tv2ms(&total_time) + 500) / 1000;
356 tv_divide(afhi->chunks_total, &total_time, &afhi->chunk_tv);
357 PARA_DEBUG_LOG("%lu chunks, each %lums\n", afhi->chunks_total,
358 tv2ms(&afhi->chunk_tv));
359 tv_scale(3, &afhi->chunk_tv, &afhi->eof_tv);
360 PARA_DEBUG_LOG("eof timeout: %lu\n", tv2ms(&afhi->eof_tv));
361 afhi->info_string = make_message("%s: %cbr, %s\n%s",
362 status_item_list[SI_AUDIO_FILE_INFO], vbr? 'v' : 'c',
363 header_mode(&header), taginfo);
364 free(taginfo);
365 return 1;
366 err_out:
367 free(taginfo);
368 PARA_ERROR_LOG("%s\n", para_strerror(-ret));
369 free(afhi->chunk_table);
370 return ret;
371 }
372
373 /*
374 * Read mp3 information from audio file
375 */
376 int mp3_get_file_info(char *map, size_t numbytes,
377 struct afh_info *afhi)
378 {
379 int ret;
380
381 ret = mp3_read_info((unsigned char *)map, numbytes, afhi);
382 if (ret < 0)
383 return ret;
384 if (afhi->seconds_total < 2 || !afhi->chunks_total)
385 return -E_MP3_INFO;
386 return 1;
387 }
388
389 static const char* mp3_suffixes[] = {"mp3", NULL};
390
391 /**
392 * the init function of the mp3 audio format handler
393 *
394 * \param afh pointer to the struct to initialize
395 */
396 void mp3_init(struct audio_format_handler *afh)
397 {
398 afh->get_file_info = mp3_get_file_info;
399 afh->suffixes = mp3_suffixes;
400 }