2 * This file is part of DisOrder
3 * Copyright (C) 2007-2009 Richard Kettlewell
5 * This program is free software: you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation, either version 3 of the License, or
8 * (at your option) any later version.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
15 * You should have received a copy of the GNU General Public License
16 * along with this program. If not, see <http://www.gnu.org/licenses/>.
18 /** @file server/decode.c
19 * @brief General-purpose decoder for use by speaker process
22 #include "disorder-server.h"
26 #include <vorbis/vorbisfile.h>
28 /* libFLAC has had an API change and stupidly taken away the old API */
29 #if HAVE_FLAC_FILE_DECODER_H
30 # include <FLAC/file_decoder.h>
32 # include <FLAC/stream_decoder.h>
33 #define FLAC__FileDecoder FLAC__StreamDecoder
34 #define FLAC__FileDecoderState FLAC__StreamDecoderState
38 #include "speaker-protocol.h"
41 /** @brief Encoding lookup table type */
43 /** @brief Glob pattern matching file */
45 /** @brief Decoder function */
49 static struct hreader input[1];
51 /** @brief Output file */
52 static FILE *outputfp;
54 /** @brief Filename */
55 static const char *path;
57 /** @brief Input buffer */
58 static char input_buffer[1048576];
60 /** @brief Number of bytes read into buffer */
61 static int input_count;
63 /** @brief Write an 8-bit word */
64 static inline void output_8(int n) {
65 if(putc(n, outputfp) < 0)
66 disorder_fatal(errno, "decoding %s: output error", path);
69 /** @brief Write a 16-bit word in bigendian format */
70 static inline void output_16(uint16_t n) {
71 if(putc(n >> 8, outputfp) < 0
72 || putc(n, outputfp) < 0)
73 disorder_fatal(errno, "decoding %s: output error", path);
76 /** @brief Write a 24-bit word in bigendian format */
77 static inline void output_24(uint32_t n) {
78 if(putc(n >> 16, outputfp) < 0
79 || putc(n >> 8, outputfp) < 0
80 || putc(n, outputfp) < 0)
81 disorder_fatal(errno, "decoding %s: output error", path);
84 /** @brief Write a 32-bit word in bigendian format */
85 static inline void output_32(uint32_t n) {
86 if(putc(n >> 24, outputfp) < 0
87 || putc(n >> 16, outputfp) < 0
88 || putc(n >> 8, outputfp) < 0
89 || putc(n, outputfp) < 0)
90 disorder_fatal(errno, "decoding %s: output error", path);
93 /** @brief Write a block header
94 * @param rate Sample rate in Hz
95 * @param channels Channel count (currently only 1 or 2 supported)
96 * @param bits Bits per sample (must be a multiple of 8, no more than 64)
97 * @param nbytes Total number of data bytes
98 * @param endian @ref ENDIAN_BIG or @ref ENDIAN_LITTLE
100 * Checks that the sample format is a supported one (so other calls do not have
101 * to) and calls disorder_fatal() on error.
103 static void output_header(int rate,
108 struct stream_header header;
110 if(bits <= 0 || bits % 8 || bits > 64)
111 disorder_fatal(0, "decoding %s: unsupported sample size %d bits",
113 if(channels <= 0 || channels > 2)
114 disorder_fatal(0, "decoding %s: unsupported channel count %d",
117 disorder_fatal(0, "decoding %s: nonsensical sample rate %dHz", path, rate);
120 header.channels = channels;
121 header.endian = endian;
122 header.nbytes = nbytes;
123 if(fwrite(&header, sizeof header, 1, outputfp) < 1)
124 disorder_fatal(errno, "decoding %s: writing format header", path);
127 /** @brief Dithering state
128 * Filched from mpg321, which credits it to Robert Leslie */
129 struct audio_dither {
130 mad_fixed_t error[3];
134 /** @brief 32-bit PRNG
135 * Filched from mpg321, which credits it to Robert Leslie */
136 static inline unsigned long prng(unsigned long state)
138 return (state * 0x0019660dL + 0x3c6ef35fL) & 0xffffffffL;
141 /** @brief Generic linear sample quantize and dither routine
142 * Filched from mpg321, which credits it to Robert Leslie */
143 static long audio_linear_dither(mad_fixed_t sample,
144 struct audio_dither *dither) {
145 unsigned int scalebits;
146 mad_fixed_t output, mask, rnd;
155 sample += dither->error[0] - dither->error[1] + dither->error[2];
157 dither->error[2] = dither->error[1];
158 dither->error[1] = dither->error[0] / 2;
161 output = sample + (1L << (MAD_F_FRACBITS + 1 - bits - 1));
163 scalebits = MAD_F_FRACBITS + 1 - bits;
164 mask = (1L << scalebits) - 1;
167 rnd = prng(dither->random);
168 output += (rnd & mask) - (dither->random & mask);
170 dither->random = rnd;
179 else if (output < MIN) {
190 dither->error[0] = sample - output;
193 return output >> scalebits;
196 /** @brief MP3 output callback */
197 static enum mad_flow mp3_output(void attribute((unused)) *data,
198 struct mad_header const *header,
199 struct mad_pcm *pcm) {
200 size_t n = pcm->length;
201 const mad_fixed_t *l = pcm->samples[0], *r = pcm->samples[1];
202 static struct audio_dither ld[1], rd[1];
204 output_header(header->samplerate,
207 2 * pcm->channels * pcm->length,
209 switch(pcm->channels) {
212 output_16(audio_linear_dither(*l++, ld));
216 output_16(audio_linear_dither(*l++, ld));
217 output_16(audio_linear_dither(*r++, rd));
221 return MAD_FLOW_CONTINUE;
224 /** @brief MP3 input callback */
225 static enum mad_flow mp3_input(void attribute((unused)) *data,
226 struct mad_stream *stream) {
229 /* libmad requires its caller to do ALL the buffering work, including coping
230 * with partial frames. Given that it appears to be completely undocumented
231 * you could perhaps be forgiven for not discovering this... */
233 /* Compute total number of bytes consumed */
234 used = (char *)stream->next_frame - input_buffer;
235 /* Compute number of bytes left to consume */
236 remain = input_count - used;
237 memmove(input_buffer, input_buffer + used, remain);
242 n = hreader_read(input,
243 input_buffer + remain,
244 (sizeof input_buffer) - remain);
246 disorder_fatal(errno, "reading from %s", path);
247 /* Compute total number of bytes available */
248 input_count = remain + n;
250 mad_stream_buffer(stream, (unsigned char *)input_buffer, input_count);
252 return MAD_FLOW_CONTINUE;
254 return MAD_FLOW_STOP;
257 /** @brief MP3 error callback */
258 static enum mad_flow mp3_error(void attribute((unused)) *data,
259 struct mad_stream *stream,
260 struct mad_frame attribute((unused)) *frame) {
262 /* Just generates pointless verbosity l-( */
263 disorder_error(0, "decoding %s: %s (%#04x)",
264 path, mad_stream_errorstr(stream), stream->error);
265 return MAD_FLOW_CONTINUE;
268 /** @brief MP3 decoder */
269 static void decode_mp3(void) {
270 struct mad_decoder mad[1];
272 if(hreader_init(path, input))
273 disorder_fatal(errno, "opening %s", path);
274 mad_decoder_init(mad, 0/*data*/, mp3_input, 0/*header*/, 0/*filter*/,
275 mp3_output, mp3_error, 0/*message*/);
276 if(mad_decoder_run(mad, MAD_DECODER_MODE_SYNC))
278 mad_decoder_finish(mad);
281 static size_t ogg_read_func(void *ptr, size_t size, size_t nmemb, void *datasource) {
282 struct hreader *h = datasource;
284 int n = hreader_read(h, ptr, size * nmemb);
289 static int ogg_seek_func(void *datasource, ogg_int64_t offset, int whence) {
290 struct hreader *h = datasource;
292 return hreader_seek(h, offset, whence) < 0 ? -1 : 0;
295 static int ogg_close_func(void attribute((unused)) *datasource) {
299 static long ogg_tell_func(void *datasource) {
300 struct hreader *h = datasource;
302 return hreader_seek(h, 0, SEEK_CUR);
305 static const ov_callbacks ogg_callbacks = {
312 /** @brief OGG decoder */
313 static void decode_ogg(void) {
314 struct hreader ogginput[1];
315 OggVorbis_File vf[1];
321 hreader_init(path, ogginput);
322 /* There doesn't seem to be any standard function for mapping the error codes
324 if((err = ov_open_callbacks(ogginput, vf, 0/*initial*/, 0/*ibytes*/,
326 disorder_fatal(0, "ov_open_callbacks %s: %d", path, err);
327 if(!(vi = ov_info(vf, 0/*link*/)))
328 disorder_fatal(0, "ov_info %s: failed", path);
329 while((n = ov_read(vf, input_buffer, sizeof input_buffer, 1/*bigendianp*/,
330 2/*bytes/word*/, 1/*signed*/, &bitstream))) {
332 disorder_fatal(0, "ov_read %s: %ld", path, n);
334 disorder_fatal(0, "only single-bitstream ogg files are supported");
335 output_header(vi->rate, vi->channels, 16/*bits*/, n, ENDIAN_BIG);
336 if(fwrite(input_buffer, 1, n, outputfp) < (size_t)n)
337 disorder_fatal(errno, "decoding %s: writing sample data", path);
341 /** @brief Sample data callback used by decode_wav() */
342 static int wav_write(struct wavfile attribute((unused)) *f,
345 void attribute((unused)) *u) {
346 if(fwrite(data, 1, nbytes, outputfp) < nbytes)
347 disorder_fatal(errno, "decoding %s: writing sample data", path);
351 /** @brief WAV file decoder */
352 static void decode_wav(void) {
356 if((err = wav_init(f, path)))
357 disorder_fatal(err, "opening %s", path);
358 output_header(f->rate, f->channels, f->bits, f->datasize, ENDIAN_LITTLE);
359 if((err = wav_data(f, wav_write, 0)))
360 disorder_fatal(err, "error decoding %s", path);
363 /** @brief Metadata callback for FLAC decoder
365 * This is a no-op here.
367 static void flac_metadata(const FLAC__FileDecoder attribute((unused)) *decoder,
368 const FLAC__StreamMetadata attribute((unused)) *metadata,
369 void attribute((unused)) *client_data) {
372 /** @brief Error callback for FLAC decoder */
373 static void flac_error(const FLAC__FileDecoder attribute((unused)) *decoder,
374 FLAC__StreamDecoderErrorStatus status,
375 void attribute((unused)) *client_data) {
376 disorder_fatal(0, "error decoding %s: %s", path,
377 FLAC__StreamDecoderErrorStatusString[status]);
380 /** @brief Write callback for FLAC decoder */
381 static FLAC__StreamDecoderWriteStatus flac_write
382 (const FLAC__FileDecoder attribute((unused)) *decoder,
383 const FLAC__Frame *frame,
384 const FLAC__int32 *const buffer[],
385 void attribute((unused)) *client_data) {
388 output_header(frame->header.sample_rate,
389 frame->header.channels,
390 frame->header.bits_per_sample,
391 (frame->header.channels * frame->header.blocksize
392 * frame->header.bits_per_sample) / 8,
394 for(n = 0; n < frame->header.blocksize; ++n) {
395 for(c = 0; c < frame->header.channels; ++c) {
396 switch(frame->header.bits_per_sample) {
397 case 8: output_8(buffer[c][n]); break;
398 case 16: output_16(buffer[c][n]); break;
399 case 24: output_24(buffer[c][n]); break;
400 case 32: output_32(buffer[c][n]); break;
404 return FLAC__STREAM_DECODER_WRITE_STATUS_CONTINUE;
408 /** @brief FLAC file decoder */
409 static void decode_flac(void) {
410 #if HAVE_FLAC_FILE_DECODER_H
411 FLAC__FileDecoder *fd = 0;
412 FLAC__FileDecoderState fs;
414 if(!(fd = FLAC__file_decoder_new()))
415 disorder_fatal(0, "FLAC__file_decoder_new failed");
416 if(!(FLAC__file_decoder_set_filename(fd, path)))
417 disorder_fatal(0, "FLAC__file_set_filename failed");
418 FLAC__file_decoder_set_metadata_callback(fd, flac_metadata);
419 FLAC__file_decoder_set_error_callback(fd, flac_error);
420 FLAC__file_decoder_set_write_callback(fd, flac_write);
421 if((fs = FLAC__file_decoder_init(fd)))
422 disorder_fatal(0, "FLAC__file_decoder_init: %s", FLAC__FileDecoderStateString[fs]);
423 FLAC__file_decoder_process_until_end_of_file(fd);
425 FLAC__StreamDecoder *sd = FLAC__stream_decoder_new();
426 FLAC__StreamDecoderInitStatus is;
429 disorder_fatal(0, "FLAC__stream_decoder_new failed");
431 if((is = FLAC__stream_decoder_init_file(sd, path, flac_write, flac_metadata,
433 disorder_fatal(0, "FLAC__stream_decoder_init_file %s: %s",
434 path, FLAC__StreamDecoderInitStatusString[is]);
436 FLAC__stream_decoder_process_until_end_of_stream(sd);
437 FLAC__stream_decoder_finish(sd);
438 FLAC__stream_decoder_delete(sd);
442 /** @brief Lookup table of decoders */
443 static const struct decoder decoders[] = {
444 { "*.mp3", decode_mp3 },
445 { "*.MP3", decode_mp3 },
446 { "*.ogg", decode_ogg },
447 { "*.OGG", decode_ogg },
448 { "*.flac", decode_flac },
449 { "*.FLAC", decode_flac },
450 { "*.wav", decode_wav },
451 { "*.WAV", decode_wav },
455 static const struct option options[] = {
456 { "help", no_argument, 0, 'h' },
457 { "version", no_argument, 0, 'V' },
461 /* Display usage message and terminate. */
462 static void help(void) {
464 " disorder-decode [OPTIONS] PATH\n"
466 " --help, -h Display usage message\n"
467 " --version, -V Display version number\n"
469 "Audio decoder for DisOrder. Only intended to be used by speaker\n"
470 "process, not for normal users.\n");
475 int main(int argc, char **argv) {
480 if(!setlocale(LC_CTYPE, "")) disorder_fatal(errno, "calling setlocale");
481 while((n = getopt_long(argc, argv, "hV", options, 0)) >= 0) {
484 case 'V': version("disorder-decode");
485 default: disorder_fatal(0, "invalid option");
489 disorder_fatal(0, "missing filename");
490 if(optind + 1 < argc)
491 disorder_fatal(0, "excess arguments");
492 if((e = getenv("DISORDER_RAW_FD"))) {
493 if(!(outputfp = fdopen(atoi(e), "wb")))
494 disorder_fatal(errno, "fdopen");
500 && fnmatch(decoders[n].pattern, path, 0) != 0;
503 if(!decoders[n].pattern)
504 disorder_fatal(0, "cannot determine file type for %s", path);
505 decoders[n].decode();