Fix --device bug
[paraslash.git] / play.c
1 /*
2 * Copyright (C) 2005-2006 Andre Noll <maan@systemlinux.org>
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; either version 2 of the License, or
7 * (at your option) any later version.
8 *
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
13 *
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, write to the Free Software
16 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111, USA.
17 */
18
19 /*
20 * Based in parts on aplay.c from the alsa-utils-1.0.8 package,
21 * Copyright (c) by Jaroslav Kysela <perex@suse.cz>, which is
22 * based on the vplay program by Michael Beck.
23 */
24
25 #define BUFFER_SIZE 1000 * 1000
26 #define WAV_HEADER_LEN 44
27 #include <sys/time.h> /* gettimeofday */
28 #include "para.h"
29 #include "play.cmdline.h"
30 #include <alsa/asoundlib.h>
31
32 enum { E_BROKEN_CONF, /* Broken configuration for this PCM */
33 E_ACCESS_TYPE, /* Access type not available */
34 E_SAMPLE_FORMAT, /* Sample format not available */
35 E_CHANNEL_COUNT, /* Channels count not available */
36 E_HW_PARAMS, /* Unable to install hw params */
37 E_SW_PARAMS, /* Unable to install sw params */
38 E_BAD_PERIOD, /* Can't use period equal to buffer size */
39 E_GET_XFER, /* Unable to obtain xfer align */
40 E_SET_XFER, /* snd_pcm_sw_params_set_xfer_align failed */
41 E_MEM, /* not enough memory */
42 E_READ, /* read error */
43 E_WRITE, /* write error */
44 E_PIPE, /* write to pipe with other side closed */
45 E_PCM_OPEN, /* unable to open pcm */
46 E_SND_PCM_INFO, /* pcm info error */
47 E_GET_BUFFER_TIME, /* snd_pcm_hw_params_get_buffer_time_max failed */
48 E_SET_BUFFER_TIME, /* snd_pcm_hw_params_set_buffer_time_near failed */
49 E_SET_RATE, /* snd_pcm_hw_params_set_rate_near failed */
50 E_START_THRESHOLD, /* snd_pcm_sw_params_set_start_threshold failed */
51 E_STOP_THRESHOLD, /* snd_pcm_sw_params_set_stop_threshold failed */
52 E_LOG, /* snd_output_stdio_attach failed */
53 E_SYNTAX /* could not parse start_time option */
54 };
55
56 #define FORMAT SND_PCM_FORMAT_S16_LE
57
58 #define EXIT(EXP) \
59 do { if (EXP) \
60 fprintf (stderr, "error: " #EXP "\n"); exit(EXP);} \
61 while (0)
62
63 static snd_pcm_t *handle;
64 static unsigned char *audiobuf;
65 static snd_pcm_uframes_t chunk_size;
66 static size_t bytes_per_frame;
67 static struct timeval *start_time;
68 static struct gengetopt_args_info conf;
69
70 /*
71 * read_wav_header - read WAV_HEADER_LEN bytes from stdin to audio buffer
72 *
73 * Exit on errors and on eof before WAV_HEADER_LEN could be read.
74 */
75 static void read_wav_header(void)
76 {
77 ssize_t ret, count = 0;
78
79 while (count < WAV_HEADER_LEN) {
80 ret = read(STDIN_FILENO, audiobuf + count, WAV_HEADER_LEN - count);
81 if (ret <= 0)
82 EXIT(E_READ);
83 count += ret;
84 }
85 }
86
87 /*
88 * set_alsa_params - Prepare the PCM handle for writing
89 *
90 * Install PCM software and hardware configuration. Exit on errors.
91 */
92 static void set_alsa_params(void)
93 {
94 snd_pcm_hw_params_t *hwparams;
95 snd_pcm_sw_params_t *swparams;
96 snd_pcm_uframes_t buffer_size, xfer_align, start_threshold,
97 stop_threshold;
98 unsigned buffer_time = 0;
99 int err;
100
101 snd_pcm_hw_params_alloca(&hwparams);
102 snd_pcm_sw_params_alloca(&swparams);
103 if (snd_pcm_hw_params_any(handle, hwparams) < 0)
104 EXIT(E_BROKEN_CONF);
105 if (snd_pcm_hw_params_set_access(handle, hwparams,
106 SND_PCM_ACCESS_RW_INTERLEAVED) < 0)
107 EXIT(E_ACCESS_TYPE);
108 if (snd_pcm_hw_params_set_format(handle, hwparams, FORMAT) < 0)
109 EXIT(E_SAMPLE_FORMAT);
110 if (snd_pcm_hw_params_set_channels(handle, hwparams, conf.channels_arg) < 0)
111 EXIT(E_CHANNEL_COUNT);
112 if (snd_pcm_hw_params_set_rate_near(handle, hwparams, (unsigned int*) &conf.sample_rate_arg, 0) < 0)
113 EXIT(E_SET_RATE);
114 err = snd_pcm_hw_params_get_buffer_time_max(hwparams, &buffer_time, 0);
115 if (err < 0 || !buffer_time)
116 EXIT(E_GET_BUFFER_TIME);
117 if (buffer_time > 500000)
118 buffer_time = 500000;
119 if (snd_pcm_hw_params_set_buffer_time_near(handle, hwparams,
120 &buffer_time, 0) < 0)
121 EXIT(E_SET_BUFFER_TIME);
122 if (snd_pcm_hw_params(handle, hwparams) < 0)
123 EXIT(E_HW_PARAMS);
124 snd_pcm_hw_params_get_period_size(hwparams, &chunk_size, 0);
125 snd_pcm_hw_params_get_buffer_size(hwparams, &buffer_size);
126 if (chunk_size == buffer_size)
127 EXIT(E_BAD_PERIOD);
128 snd_pcm_sw_params_current(handle, swparams);
129 err = snd_pcm_sw_params_get_xfer_align(swparams, &xfer_align);
130 if (err < 0 || !xfer_align)
131 EXIT(E_GET_XFER);
132 snd_pcm_sw_params_set_sleep_min(handle, swparams, 0);
133 snd_pcm_sw_params_set_avail_min(handle, swparams, chunk_size);
134 /* round to closest transfer boundary */
135 start_threshold = (buffer_size / xfer_align) * xfer_align;
136 if (start_threshold < 1)
137 start_threshold = 1;
138 if (snd_pcm_sw_params_set_start_threshold(handle, swparams,
139 start_threshold) < 0)
140 EXIT(E_START_THRESHOLD);
141 stop_threshold = buffer_size;
142 if (snd_pcm_sw_params_set_stop_threshold(handle, swparams,
143 stop_threshold) < 0)
144 EXIT(E_STOP_THRESHOLD);
145 if (snd_pcm_sw_params_set_xfer_align(handle, swparams, xfer_align) < 0)
146 EXIT(E_SET_XFER);
147 if (snd_pcm_sw_params(handle, swparams) < 0)
148 EXIT(E_SW_PARAMS);
149 bytes_per_frame = snd_pcm_format_physical_width(FORMAT) * conf.channels_arg / 8;
150 }
151
152 /*
153 * pcm_write - push out pcm frames
154 * \param data pointer do data to be written
155 * \param count number of frames
156 *
157 * \return Number of bytes written. Exit on errors.
158 */
159 static snd_pcm_sframes_t pcm_write(u_char *data, size_t count)
160 {
161 snd_pcm_sframes_t r, result = 0;
162 while (count > 0) {
163 /* write interleaved frames */
164 r = snd_pcm_writei(handle, data, count);
165 if (r < 0)
166 fprintf(stderr, "write error: %s\n", snd_strerror(r));
167 if (r == -EAGAIN || (r >= 0 && r < count))
168 snd_pcm_wait(handle, 1);
169 else if (r == -EPIPE)
170 snd_pcm_prepare(handle);
171 else if (r < 0)
172 EXIT(E_WRITE);
173 if (r > 0) {
174 result += r;
175 count -= r;
176 data += r * bytes_per_frame;
177 }
178 }
179 return result;
180 }
181
182 /*
183 * start_time_in_future - check if current time is later than start_time
184 * \param diff pointer to write remaining time to
185 *
186 * If start_time was not given, or current time is later than given
187 * start_time, return 0. Otherwise, return 1 and write the time
188 * difference between current time and start_time to diff. diff may be
189 * NULL.
190 *
191 */
192 static int start_time_in_future(struct timeval *diff)
193 {
194 struct timeval now;
195
196 if (!conf.start_time_given)
197 return 0;
198 gettimeofday(&now, NULL);
199 return tv_diff(start_time, &now, diff) > 0? 1 : 0;
200 }
201
202 /*
203 * do_initial_delay - sleep until time given at command line
204 *
205 * This is called if the initial buffer is filled. It returns
206 * immediately if no start_time was given at the command line
207 * or if the given start time is in the past.
208 *
209 */
210 static void do_initial_delay(struct timeval *delay)
211 {
212 fprintf(stderr, "sleeping %lums\n", tv2ms(delay));
213 do
214 select(1, NULL, NULL, NULL, delay);
215 while (start_time_in_future(delay));
216 }
217
218 /*
219 * play_pcm - play raw pcm data
220 * \param loaded number of bytes already loaded
221 *
222 * If start_time was given, prebuffer data until buffer is full or
223 * start_time is reached. In any case, do not start playing before
224 * start_time.
225 */
226 static void play_pcm(size_t loaded)
227 {
228 size_t chunk_bytes, bufsize, written = 0;
229 ssize_t ret;
230 unsigned char *p;
231 int dont_write;
232 struct timeval delay;
233
234 set_alsa_params();
235 chunk_bytes = chunk_size * bytes_per_frame;
236 bufsize = chunk_bytes * 1024;
237 audiobuf = realloc(audiobuf, bufsize);
238 if (!audiobuf)
239 EXIT(E_MEM);
240 again:
241 dont_write = 0;
242 if (!written && start_time)
243 dont_write = start_time_in_future(&delay);
244 if (!dont_write) {
245 p = audiobuf;
246 while (loaded >= chunk_bytes) {
247 ret = (ssize_t) pcm_write(p, chunk_size) * bytes_per_frame;
248 if (ret <= 0) {
249 fprintf(stderr, "write error: %d\n", ret);
250 EXIT(E_WRITE);
251 }
252 p += ret;
253 written += ret;
254 loaded -= ret;
255 }
256 if (loaded && p != audiobuf) {
257 fprintf(stderr, "memcpy: %d\n", loaded);
258 memcpy(audiobuf, p, loaded);
259 }
260 }
261 if (dont_write && loaded >= bufsize) {
262 do_initial_delay(&delay);
263 start_time = NULL;
264 goto again;
265 }
266 ret = read(STDIN_FILENO, audiobuf, bufsize - loaded);
267 if (ret < 0)
268 EXIT(E_READ);
269 if (ret) {
270 loaded += ret;
271 goto again;
272 }
273 snd_pcm_drain(handle);
274 }
275
276 /*
277 * check_wave - test if audio buffer contains a valid wave header
278 *
279 * If not, return 0, otherwise, store number of channels and sample rate
280 * in struct conf and return WAV_HEADER_LEN.
281 */
282 static size_t check_wave(void)
283 {
284 unsigned char *a = audiobuf;
285 if (a[0] != 'R' || a[1] != 'I' || a[2] != 'F' || a[3] != 'F')
286 return WAV_HEADER_LEN;
287 conf.channels_arg = (unsigned) a[22];
288 conf.sample_rate_arg = a[24] + (a[25] << 8) + (a[26] << 16) + (a[27] << 24);
289 // fprintf(stderr, "channels: %d, rate: %d\n", conf.channels_arg,
290 // conf.sample_rate_arg);
291 return 0;
292 }
293
294 int main(int argc, char *argv[])
295 {
296 snd_pcm_info_t *info;
297 snd_output_t *log;
298 struct timeval tv;
299 int err;
300
301 cmdline_parser(argc, argv, &conf);
302 if (conf.start_time_given) {
303 if (sscanf(conf.start_time_arg, "%lu:%lu",
304 &tv.tv_sec, &tv.tv_usec) != 2)
305 EXIT(E_SYNTAX);
306 start_time = &tv;
307 }
308 // fprintf(stderr, "argc=%d, argv[1]=%s\n",argc, argv[1]);
309 snd_pcm_info_alloca(&info);
310 if (snd_output_stdio_attach(&log, stderr, 0) < 0)
311 EXIT(E_LOG);
312 err = snd_pcm_open(&handle, conf.device_arg,
313 SND_PCM_STREAM_PLAYBACK, 0);
314 if (err < 0)
315 EXIT(E_PCM_OPEN);
316 if ((err = snd_pcm_info(handle, info)) < 0)
317 EXIT(E_SND_PCM_INFO);
318 audiobuf = malloc(WAV_HEADER_LEN);
319 read_wav_header();
320 play_pcm(check_wave());
321 snd_pcm_close(handle);
322 free(audiobuf);
323 // snd_output_close(log);
324 snd_config_update_free_global();
325 return EXIT_SUCCESS;
326 }