Merge HUGE set of changes temporarily into a branch, to allow me to move them from...
[profile/ivi/pulseaudio-panda.git] / src / modules / module-alsa-sink.c
1 /* $Id$ */
2
3 /***
4   This file is part of PulseAudio.
5
6   Copyright 2004-2006 Lennart Poettering
7   Copyright 2006 Pierre Ossman <ossman@cendio.se> for Cendio AB
8
9   PulseAudio is free software; you can redistribute it and/or modify
10   it under the terms of the GNU Lesser General Public License as published
11   by the Free Software Foundation; either version 2 of the License,
12   or (at your option) any later version.
13
14   PulseAudio is distributed in the hope that it will be useful, but
15   WITHOUT ANY WARRANTY; without even the implied warranty of
16   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
17   General Public License for more details.
18
19   You should have received a copy of the GNU Lesser General Public License
20   along with PulseAudio; if not, write to the Free Software
21   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
22   USA.
23 ***/
24
25 #ifdef HAVE_CONFIG_H
26 #include <config.h>
27 #endif
28
29 #include <assert.h>
30 #include <stdio.h>
31
32 #ifdef HAVE_SYS_POLL_H
33 #include <sys/poll.h>
34 #else
35 #include "poll.h"
36 #endif
37
38 #include <asoundlib.h>
39
40 #include <pulse/xmalloc.h>
41
42 #include <pulsecore/core.h>
43 #include <pulsecore/module.h>
44 #include <pulsecore/memchunk.h>
45 #include <pulsecore/sink.h>
46 #include <pulsecore/modargs.h>
47 #include <pulsecore/core-util.h>
48 #include <pulsecore/sample-util.h>
49 #include <pulsecore/log.h>
50
51 #include "alsa-util.h"
52 #include "module-alsa-sink-symdef.h"
53
54 PA_MODULE_AUTHOR("Lennart Poettering")
55 PA_MODULE_DESCRIPTION("ALSA Sink")
56 PA_MODULE_VERSION(PACKAGE_VERSION)
57 PA_MODULE_USAGE(
58         "sink_name=<name for the sink> "
59         "device=<ALSA device> "
60         "format=<sample format> "
61         "channels=<number of channels> "
62         "rate=<sample rate> "
63         "fragments=<number of fragments> "
64         "fragment_size=<fragment size> "
65         "channel_map=<channel map>")
66
67 struct userdata {
68     snd_pcm_t *pcm_handle;
69     snd_mixer_t *mixer_handle;
70     snd_mixer_elem_t *mixer_elem;
71     pa_sink *sink;
72     struct pa_alsa_fdlist *pcm_fdl;
73     struct pa_alsa_fdlist *mixer_fdl;
74     long hw_volume_max, hw_volume_min;
75
76     size_t frame_size, fragment_size;
77     pa_memchunk memchunk, silence;
78     pa_module *module;
79 };
80
81 static const char* const valid_modargs[] = {
82     "device",
83     "sink_name",
84     "format",
85     "channels",
86     "rate",
87     "fragments",
88     "fragment_size",
89     "channel_map",
90     NULL
91 };
92
93 #define DEFAULT_DEVICE "default"
94
95 static void update_usage(struct userdata *u) {
96     pa_module_set_used(u->module, u->sink ? pa_sink_used_by(u->sink) : 0);
97 }
98
99 static void clear_up(struct userdata *u) {
100     assert(u);
101
102     if (u->sink) {
103         pa_sink_disconnect(u->sink);
104         pa_sink_unref(u->sink);
105         u->sink = NULL;
106     }
107
108     if (u->pcm_fdl)
109         pa_alsa_fdlist_free(u->pcm_fdl);
110     if (u->mixer_fdl)
111         pa_alsa_fdlist_free(u->mixer_fdl);
112
113     u->pcm_fdl = u->mixer_fdl = NULL;
114
115     if (u->mixer_handle) {
116         snd_mixer_close(u->mixer_handle);
117         u->mixer_handle = NULL;
118     }
119
120     if (u->pcm_handle) {
121         snd_pcm_drop(u->pcm_handle);
122         snd_pcm_close(u->pcm_handle);
123         u->pcm_handle = NULL;
124     }
125 }
126
127 static int xrun_recovery(struct userdata *u) {
128     int ret;
129     assert(u);
130
131     pa_log_info("*** ALSA-XRUN (playback) ***");
132
133     if ((ret = snd_pcm_prepare(u->pcm_handle)) < 0) {
134         pa_log("snd_pcm_prepare() failed: %s", snd_strerror(-ret));
135
136         clear_up(u);
137         pa_module_unload_request(u->module);
138         return -1;
139     }
140
141     return ret;
142 }
143
144 static int suspend_recovery(struct userdata *u) {
145     int ret;
146     assert(u);
147
148     pa_log_info("*** ALSA-SUSPEND (playback) ***");
149
150     if ((ret = snd_pcm_resume(u->pcm_handle)) < 0) {
151         if (ret == -EAGAIN)
152             return -1;
153
154         if (ret != -ENOSYS)
155             pa_log("snd_pcm_resume() failed: %s", snd_strerror(-ret));
156         else {
157             if ((ret = snd_pcm_prepare(u->pcm_handle)) < 0)
158                 pa_log("snd_pcm_prepare() failed: %s", snd_strerror(-ret));
159         }
160
161         if (ret < 0) {
162             clear_up(u);
163             pa_module_unload_request(u->module);
164             return -1;
165         }
166     }
167
168     return ret;
169 }
170
171 static void do_write(struct userdata *u) {
172     assert(u);
173
174     update_usage(u);
175
176     for (;;) {
177         void *p;
178         pa_memchunk *memchunk = NULL;
179         snd_pcm_sframes_t frames;
180
181         if (u->memchunk.memblock)
182             memchunk = &u->memchunk;
183         else {
184             if (pa_sink_render(u->sink, u->fragment_size, &u->memchunk) < 0)
185                 memchunk = &u->silence;
186             else
187                 memchunk = &u->memchunk;
188         }
189         assert(memchunk->memblock);
190         assert(memchunk->length);
191         assert((memchunk->length % u->frame_size) == 0);
192
193         p = pa_memblock_acquire(memchunk->memblock);
194
195         if ((frames = snd_pcm_writei(u->pcm_handle, (uint8_t*) p + memchunk->index, memchunk->length / u->frame_size)) < 0) {
196             pa_memblock_release(memchunk->memblock);
197
198             if (frames == -EAGAIN)
199                 return;
200
201             if (frames == -EPIPE) {
202                 if (xrun_recovery(u) < 0)
203                     return;
204
205                 continue;
206             }
207
208             if (frames == -ESTRPIPE) {
209                 if (suspend_recovery(u) < 0)
210                     return;
211
212                 continue;
213             }
214
215             pa_log("snd_pcm_writei() failed: %s", snd_strerror(-frames));
216
217             clear_up(u);
218             pa_module_unload_request(u->module);
219             return;
220         }
221
222         pa_memblock_release(memchunk->memblock);
223
224         if (memchunk == &u->memchunk) {
225             size_t l = frames * u->frame_size;
226             memchunk->index += l;
227             memchunk->length -= l;
228
229             if (memchunk->length == 0) {
230                 pa_memblock_unref(memchunk->memblock);
231                 memchunk->memblock = NULL;
232                 memchunk->index = memchunk->length = 0;
233             }
234         }
235
236         break;
237     }
238 }
239
240 static void fdl_callback(void *userdata) {
241     struct userdata *u = userdata;
242     assert(u);
243
244     if (snd_pcm_state(u->pcm_handle) == SND_PCM_STATE_XRUN)
245         if (xrun_recovery(u) < 0)
246             return;
247
248     if (snd_pcm_state(u->pcm_handle) == SND_PCM_STATE_SUSPENDED)
249         if (suspend_recovery(u) < 0)
250             return;
251
252     do_write(u);
253 }
254
255 static int mixer_callback(snd_mixer_elem_t *elem, unsigned int mask) {
256     struct userdata *u = snd_mixer_elem_get_callback_private(elem);
257
258     assert(u && u->mixer_handle);
259
260     if (mask == SND_CTL_EVENT_MASK_REMOVE)
261         return 0;
262
263     if (mask & SND_CTL_EVENT_MASK_VALUE) {
264         if (u->sink->get_hw_volume)
265             u->sink->get_hw_volume(u->sink);
266         if (u->sink->get_hw_mute)
267             u->sink->get_hw_mute(u->sink);
268         pa_subscription_post(u->sink->core,
269             PA_SUBSCRIPTION_EVENT_SINK|PA_SUBSCRIPTION_EVENT_CHANGE,
270             u->sink->index);
271     }
272
273     return 0;
274 }
275
276 static pa_usec_t sink_get_latency_cb(pa_sink *s) {
277     pa_usec_t r = 0;
278     struct userdata *u = s->userdata;
279     snd_pcm_sframes_t frames;
280     int err;
281
282     assert(s && u && u->sink);
283
284     if ((err = snd_pcm_delay(u->pcm_handle, &frames)) < 0) {
285         pa_log("failed to get delay: %s", snd_strerror(err));
286         s->get_latency = NULL;
287         return 0;
288     }
289
290     if (frames < 0)
291         frames = 0;
292
293     r += pa_bytes_to_usec(frames * u->frame_size, &s->sample_spec);
294
295     if (u->memchunk.memblock)
296         r += pa_bytes_to_usec(u->memchunk.length, &s->sample_spec);
297
298     return r;
299 }
300
301 static int sink_get_hw_volume_cb(pa_sink *s) {
302     struct userdata *u = s->userdata;
303     int err;
304     int i;
305
306     assert(u);
307     assert(u->mixer_elem);
308
309     for (i = 0; i < s->hw_volume.channels; i++) {
310         long set_vol, vol;
311
312         assert(snd_mixer_selem_has_playback_channel(u->mixer_elem, i));
313
314         if ((err = snd_mixer_selem_get_playback_volume(u->mixer_elem, i, &vol)) < 0)
315             goto fail;
316
317         set_vol = (long) roundf(((float) s->hw_volume.values[i] * (u->hw_volume_max - u->hw_volume_min)) / PA_VOLUME_NORM) + u->hw_volume_min;
318
319         /* Try to avoid superfluous volume changes */
320         if (set_vol != vol)
321             s->hw_volume.values[i] = (pa_volume_t) roundf(((float) (vol - u->hw_volume_min) * PA_VOLUME_NORM) / (u->hw_volume_max - u->hw_volume_min));
322     }
323
324     return 0;
325
326 fail:
327     pa_log_error("Unable to read volume: %s", snd_strerror(err));
328     s->get_hw_volume = NULL;
329     s->set_hw_volume = NULL;
330     return -1;
331 }
332
333 static int sink_set_hw_volume_cb(pa_sink *s) {
334     struct userdata *u = s->userdata;
335     int err;
336     int i;
337     pa_volume_t vol;
338
339     assert(u);
340     assert(u->mixer_elem);
341
342     for (i = 0; i < s->hw_volume.channels; i++) {
343         long alsa_vol;
344
345         assert(snd_mixer_selem_has_playback_channel(u->mixer_elem, i));
346
347         vol = s->hw_volume.values[i];
348
349         if (vol > PA_VOLUME_NORM)
350             vol = PA_VOLUME_NORM;
351
352         alsa_vol = (long) roundf(((float) vol * (u->hw_volume_max - u->hw_volume_min)) / PA_VOLUME_NORM) + u->hw_volume_min;
353
354         if ((err = snd_mixer_selem_set_playback_volume(u->mixer_elem, i, alsa_vol)) < 0)
355             goto fail;
356     }
357
358     return 0;
359
360 fail:
361     pa_log_error("Unable to set volume: %s", snd_strerror(err));
362     s->get_hw_volume = NULL;
363     s->set_hw_volume = NULL;
364     return -1;
365 }
366
367 static int sink_get_hw_mute_cb(pa_sink *s) {
368     struct userdata *u = s->userdata;
369     int err, sw;
370
371     assert(u && u->mixer_elem);
372
373     err = snd_mixer_selem_get_playback_switch(u->mixer_elem, 0, &sw);
374     if (err) {
375         pa_log_error("Unable to get switch: %s", snd_strerror(err));
376         s->get_hw_mute = NULL;
377         s->set_hw_mute = NULL;
378         return -1;
379     }
380
381     s->hw_muted = !sw;
382
383     return 0;
384 }
385
386 static int sink_set_hw_mute_cb(pa_sink *s) {
387     struct userdata *u = s->userdata;
388     int err;
389
390     assert(u && u->mixer_elem);
391
392     err = snd_mixer_selem_set_playback_switch_all(u->mixer_elem, !s->hw_muted);
393     if (err) {
394         pa_log_error("Unable to set switch: %s", snd_strerror(err));
395         s->get_hw_mute = NULL;
396         s->set_hw_mute = NULL;
397         return -1;
398     }
399
400     return 0;
401 }
402
403 int pa__init(pa_core *c, pa_module*m) {
404     pa_modargs *ma = NULL;
405     int ret = -1;
406     struct userdata *u = NULL;
407     const char *dev;
408     pa_sample_spec ss;
409     pa_channel_map map;
410     uint32_t periods, fragsize;
411     snd_pcm_uframes_t period_size;
412     size_t frame_size;
413     snd_pcm_info_t *pcm_info = NULL;
414     int err;
415     char *t;
416     const char *name;
417     char *name_buf = NULL;
418     int namereg_fail;
419
420     if (!(ma = pa_modargs_new(m->argument, valid_modargs))) {
421         pa_log("failed to parse module arguments");
422         goto fail;
423     }
424
425     ss = c->default_sample_spec;
426     if (pa_modargs_get_sample_spec_and_channel_map(ma, &ss, &map, PA_CHANNEL_MAP_ALSA) < 0) {
427         pa_log("failed to parse sample specification and channel map");
428         goto fail;
429     }
430
431     frame_size = pa_frame_size(&ss);
432
433     /* Fix latency to 100ms */
434     periods = 8;
435     fragsize = pa_bytes_per_second(&ss)/128;
436
437     if (pa_modargs_get_value_u32(ma, "fragments", &periods) < 0 || pa_modargs_get_value_u32(ma, "fragment_size", &fragsize) < 0) {
438         pa_log("failed to parse buffer metrics");
439         goto fail;
440     }
441     period_size = fragsize/frame_size;
442
443     u = pa_xnew0(struct userdata, 1);
444     m->userdata = u;
445     u->module = m;
446
447     snd_config_update_free_global();
448     if ((err = snd_pcm_open(&u->pcm_handle, dev = pa_modargs_get_value(ma, "device", DEFAULT_DEVICE), SND_PCM_STREAM_PLAYBACK, SND_PCM_NONBLOCK)) < 0) {
449         pa_log("Error opening PCM device %s: %s", dev, snd_strerror(err));
450         goto fail;
451     }
452
453     if ((err = snd_pcm_info_malloc(&pcm_info)) < 0 ||
454         (err = snd_pcm_info(u->pcm_handle, pcm_info)) < 0) {
455         pa_log("Error fetching PCM info: %s", snd_strerror(err));
456         goto fail;
457     }
458
459     if ((err = pa_alsa_set_hw_params(u->pcm_handle, &ss, &periods, &period_size)) < 0) {
460         pa_log("Failed to set hardware parameters: %s", snd_strerror(err));
461         goto fail;
462     }
463
464     /* ALSA might tweak the sample spec, so recalculate the frame size */
465     frame_size = pa_frame_size(&ss);
466
467     if (ss.channels != map.channels)
468         /* Seems ALSA didn't like the channel number, so let's fix the channel map */
469         pa_channel_map_init_auto(&map, ss.channels, PA_CHANNEL_MAP_ALSA);
470
471     if ((err = snd_mixer_open(&u->mixer_handle, 0)) < 0) {
472         pa_log("Error opening mixer: %s", snd_strerror(err));
473         goto fail;
474     }
475
476     if ((pa_alsa_prepare_mixer(u->mixer_handle, dev) < 0) ||
477         !(u->mixer_elem = pa_alsa_find_elem(u->mixer_handle, "PCM", "Master"))) {
478         snd_mixer_close(u->mixer_handle);
479         u->mixer_handle = NULL;
480     }
481
482     if ((name = pa_modargs_get_value(ma, "sink_name", NULL)))
483         namereg_fail = 1;
484     else {
485         name = name_buf = pa_sprintf_malloc("alsa_output.%s", dev);
486         namereg_fail = 0;
487     }
488
489     if (!(u->sink = pa_sink_new(c, __FILE__, name, namereg_fail, &ss, &map))) {
490         pa_log("Failed to create sink object");
491         goto fail;
492     }
493
494     u->sink->is_hardware = 1;
495     u->sink->get_latency = sink_get_latency_cb;
496     if (u->mixer_handle) {
497         assert(u->mixer_elem);
498         if (snd_mixer_selem_has_playback_volume(u->mixer_elem)) {
499             int i;
500
501             for (i = 0;i < ss.channels;i++) {
502                 if (!snd_mixer_selem_has_playback_channel(u->mixer_elem, i))
503                     break;
504             }
505
506             if (i == ss.channels) {
507                 u->sink->get_hw_volume = sink_get_hw_volume_cb;
508                 u->sink->set_hw_volume = sink_set_hw_volume_cb;
509                 snd_mixer_selem_get_playback_volume_range(
510                     u->mixer_elem, &u->hw_volume_min, &u->hw_volume_max);
511             }
512         }
513         if (snd_mixer_selem_has_playback_switch(u->mixer_elem)) {
514             u->sink->get_hw_mute = sink_get_hw_mute_cb;
515             u->sink->set_hw_mute = sink_set_hw_mute_cb;
516         }
517     }
518     u->sink->userdata = u;
519     pa_sink_set_owner(u->sink, m);
520     pa_sink_set_description(u->sink, t = pa_sprintf_malloc("ALSA PCM on %s (%s)", dev, snd_pcm_info_get_name(pcm_info)));
521     pa_xfree(t);
522
523     u->pcm_fdl = pa_alsa_fdlist_new();
524     assert(u->pcm_fdl);
525     if (pa_alsa_fdlist_init_pcm(u->pcm_fdl, u->pcm_handle, c->mainloop, fdl_callback, u) < 0) {
526         pa_log("failed to initialise file descriptor monitoring");
527         goto fail;
528     }
529
530     if (u->mixer_handle) {
531         u->mixer_fdl = pa_alsa_fdlist_new();
532         assert(u->mixer_fdl);
533         if (pa_alsa_fdlist_init_mixer(u->mixer_fdl, u->mixer_handle, c->mainloop) < 0) {
534             pa_log("failed to initialise file descriptor monitoring");
535             goto fail;
536         }
537         snd_mixer_elem_set_callback(u->mixer_elem, mixer_callback);
538         snd_mixer_elem_set_callback_private(u->mixer_elem, u);
539     } else
540         u->mixer_fdl = NULL;
541
542     u->frame_size = frame_size;
543     u->fragment_size = period_size * frame_size;
544
545     pa_log_info("using %u fragments of size %lu bytes.", periods, (long unsigned)u->fragment_size);
546
547     u->silence.memblock = pa_memblock_new(c->mempool, u->silence.length = u->fragment_size);
548     assert(u->silence.memblock);
549     pa_silence_memblock(u->silence.memblock, &ss);
550     u->silence.index = 0;
551
552     u->memchunk.memblock = NULL;
553     u->memchunk.index = u->memchunk.length = 0;
554
555     ret = 0;
556
557     /* Get initial mixer settings */
558     if (u->sink->get_hw_volume)
559         u->sink->get_hw_volume(u->sink);
560     if (u->sink->get_hw_mute)
561         u->sink->get_hw_mute(u->sink);
562
563 finish:
564
565     pa_xfree(name_buf);
566
567      if (ma)
568          pa_modargs_free(ma);
569
570     if (pcm_info)
571         snd_pcm_info_free(pcm_info);
572
573     return ret;
574
575 fail:
576
577     if (u)
578         pa__done(c, m);
579
580     goto finish;
581 }
582
583 void pa__done(pa_core *c, pa_module*m) {
584     struct userdata *u;
585     assert(c && m);
586
587     if (!(u = m->userdata))
588         return;
589
590     clear_up(u);
591
592     if (u->memchunk.memblock)
593         pa_memblock_unref(u->memchunk.memblock);
594     if (u->silence.memblock)
595         pa_memblock_unref(u->silence.memblock);
596
597     pa_xfree(u);
598 }
599