fd: Improve error handling of write_nonblock().
[paraslash.git] / mp3dec_filter.c
1 /*
2  * Copyright (C) 2005-2012 Andre Noll <maan@systemlinux.org>
3  *
4  * Licensed under the GPL v2. For licencing details see COPYING.
5  */
6
7 /** \file mp3dec_filter.c Paraslash's mp3 decoder. */
8
9 #include <mad.h>
10 #include <regex.h>
11
12 #include "para.h"
13 #include "mp3dec_filter.cmdline.h"
14 #include "list.h"
15 #include "sched.h"
16 #include "ggo.h"
17 #include "buffer_tree.h"
18 #include "filter.h"
19 #include "error.h"
20 #include "string.h"
21
22 /** Convert a sample value from libmad to a signed short. */
23 #define MAD_TO_SHORT(f) (f) >= MAD_F_ONE? SHRT_MAX :\
24         (f) <= -MAD_F_ONE? -SHRT_MAX : (signed short) ((f) >> (MAD_F_FRACBITS - 15))
25
26 /** Data specific to the mp3dec filter. */
27 struct private_mp3dec_data {
28         /** Information on the current mp3 stream. */
29         struct mad_stream stream;
30         /** Information about the frame which is currently decoded. */
31         struct mad_frame frame;
32         /** Contains the PCM output. */
33         struct mad_synth synth;
34         /** The number of channels of the current stream. */
35         unsigned int channels;
36         /** Current sample rate in Hz. */
37         unsigned int sample_rate;
38 };
39
40 /* Returns negative on serious errors. */
41 static int handle_decode_error(struct private_mp3dec_data *pmd)
42 {
43         if (!MAD_RECOVERABLE(pmd->stream.error)
44                         && pmd->stream.error != MAD_ERROR_BUFLEN) {
45                 PARA_ERROR_LOG("%s\n", mad_stream_errorstr(&pmd->stream));
46                 return -E_MAD_FRAME_DECODE;
47         }
48         PARA_DEBUG_LOG("%s\n", mad_stream_errorstr(&pmd->stream));
49         return 0;
50 }
51
52 static void mp3dec_consume(struct btr_node *btrn, struct mad_stream *s,
53                 size_t max)
54 {
55         size_t used;
56
57         if (!s->next_frame)
58                 used = max;
59         else { /* we still have some data */
60                 used = s->next_frame - s->buffer;
61                 assert(used <= max);
62         }
63         btr_consume(btrn, used);
64 }
65
66 static void mp3dec_close(struct filter_node *fn)
67 {
68         struct private_mp3dec_data *pmd = fn->private_data;
69
70         mad_synth_finish(&pmd->synth);
71         mad_frame_finish(&pmd->frame);
72         mad_stream_finish(&pmd->stream);
73
74         free(pmd);
75         fn->private_data = NULL;
76 }
77
78 #define MP3DEC_MAX_FRAME 8192
79
80 static void mp3dec_post_select(__a_unused struct sched *s, struct task *t)
81 {
82         struct filter_node *fn = container_of(t, struct filter_node, task);
83         int i, ret;
84         struct private_mp3dec_data *pmd = fn->private_data;
85         struct btr_node *btrn = fn->btrn;
86         size_t loaded = 0, len, iqs;
87         char *inbuffer, *outbuffer;
88
89 next_buffer:
90         pmd->stream.error = 0;
91         t->error = 0;
92         iqs = btr_get_input_queue_size(btrn);
93         ret = btr_node_status(btrn, fn->min_iqs, BTR_NT_INTERNAL);
94         if (ret < 0)
95                 goto err;
96         if (ret == 0)
97                 return;
98         btr_merge(btrn, fn->min_iqs);
99         len = btr_next_buffer(btrn, &inbuffer);
100         /*
101          * Decode at most 8K in one go to give the post_select() functions of
102          * other buffer tree nodes a chance to run. This is necessary to avoid
103          * buffer underruns on slow machines.
104          */
105         len = PARA_MIN(len, (size_t)MP3DEC_MAX_FRAME);
106         mad_stream_buffer(&pmd->stream, (unsigned char *)inbuffer, len);
107 next_frame:
108         ret = mad_header_decode(&pmd->frame.header, &pmd->stream);
109         if (ret < 0) {
110                 mp3dec_consume(btrn, &pmd->stream, len);
111                 if (pmd->stream.error == MAD_ERROR_BUFLEN) {
112                         if (len == iqs && btr_no_parent(btrn)) {
113                                 ret = -E_MP3DEC_EOF;
114                                 goto err;
115                         }
116                         fn->min_iqs += 100;
117                         ret = -E_MP3DEC_CORRUPT;
118                         if (fn->min_iqs > MP3DEC_MAX_FRAME)
119                                 goto err;
120                 }
121                 if (loaded == 0)
122                         goto next_buffer;
123                 return;
124         }
125         pmd->sample_rate = pmd->frame.header.samplerate;
126         pmd->channels = MAD_NCHANNELS(&pmd->frame.header);
127 decode:
128         ret = mad_frame_decode(&pmd->frame, &pmd->stream);
129         if (ret != 0) {
130                 ret = handle_decode_error(pmd);
131                 if (ret < 0)
132                         goto err;
133                 ret = mad_stream_sync(&pmd->stream);
134                 if (pmd->stream.error == MAD_ERROR_BUFLEN) {
135                         ret = -E_MP3DEC_EOF;
136                         if (len == iqs && btr_no_parent(btrn))
137                                 goto err;
138                         fn->min_iqs += 100;
139                         ret = -E_MP3DEC_CORRUPT;
140                         if (fn->min_iqs > MP3DEC_MAX_FRAME)
141                                 goto err;
142                         mp3dec_consume(btrn, &pmd->stream, len);
143                         return;
144                 }
145                 if (pmd->stream.error != MAD_ERROR_BADDATAPTR)
146                         goto decode;
147                 mp3dec_consume(btrn, &pmd->stream, len);
148                 return;
149         }
150         fn->min_iqs = 0;
151         mad_synth_frame(&pmd->synth, &pmd->frame);
152         outbuffer = para_malloc(pmd->synth.pcm.length * 2 * pmd->channels);
153         loaded = 0;
154         for (i = 0; i < pmd->synth.pcm.length; i++) {
155                 int sample = MAD_TO_SHORT(pmd->synth.pcm.samples[0][i]);
156                 write_int16_host_endian(outbuffer + loaded, sample);
157                 loaded += 2;
158                 if (pmd->channels == 2) { /* stereo */
159                         sample = MAD_TO_SHORT(pmd->synth.pcm.samples[1][i]);
160                         write_int16_host_endian(outbuffer + loaded, sample);
161                         loaded += 2;
162                 }
163         }
164         btr_add_output(outbuffer, loaded, btrn);
165         goto next_frame;
166 err:
167         assert(ret < 0);
168         t->error = ret;
169         btr_remove_node(btrn);
170 }
171
172 static void mp3dec_open(struct filter_node *fn)
173 {
174         struct private_mp3dec_data *pmd = para_calloc(sizeof(*pmd));
175         struct mp3dec_filter_args_info *mp3_conf = fn->conf;
176
177         fn->private_data = pmd;
178         mad_stream_init(&pmd->stream);
179         mad_frame_init(&pmd->frame);
180         mad_synth_init(&pmd->synth);
181         if (mp3_conf->ignore_crc_given)
182                 mad_stream_options(&pmd->stream, MAD_OPTION_IGNORECRC);
183 }
184
185 static int mp3dec_parse_config(int argc, char **argv, void **config)
186 {
187         int ret;
188         struct mp3dec_filter_args_info *mp3_conf;
189
190         mp3_conf = para_calloc(sizeof(*mp3_conf));
191         ret = -E_MP3DEC_SYNTAX;
192         if (mp3dec_cmdline_parser(argc, argv, mp3_conf))
193                 goto err;
194         *config = mp3_conf;
195         return 1;
196 err:
197         free(mp3_conf);
198         return ret;
199 }
200
201 static int mp3dec_execute(struct btr_node *btrn, const char *cmd, char **result)
202 {
203         struct filter_node *fn = btr_context(btrn);
204         struct private_mp3dec_data *pmd = fn->private_data;
205
206         return decoder_execute(cmd, pmd->sample_rate, pmd->channels, result);
207 }
208
209 static void mp3dec_free_config(void *conf)
210 {
211         mp3dec_cmdline_parser_free(conf);
212 }
213 /**
214  * The init function of the mp3dec filter.
215  *
216  * \param f Pointer to the filter struct to initialize.
217  *
218  * \sa filter::init.
219  */
220 void mp3dec_filter_init(struct filter *f)
221 {
222         struct mp3dec_filter_args_info dummy;
223
224         mp3dec_cmdline_parser_init(&dummy);
225         f->open = mp3dec_open;
226         f->close = mp3dec_close;
227         f->parse_config = mp3dec_parse_config;
228         f->free_config = mp3dec_free_config;
229         f->pre_select = generic_filter_pre_select;
230         f->post_select = mp3dec_post_select;
231         f->execute = mp3dec_execute;
232         f->help = (struct ggo_help) {
233                 .short_help = mp3dec_filter_args_info_help,
234                 .detailed_help = mp3dec_filter_args_info_detailed_help
235         };
236 }