Merge commit 'origin/master-tx'
[profile/ivi/pulseaudio-panda.git] / src / modules / alsa-util.c
1 /***
2   This file is part of PulseAudio.
3
4   Copyright 2004-2006 Lennart Poettering
5   Copyright 2006 Pierre Ossman <ossman@cendio.se> for Cendio AB
6
7   PulseAudio is free software; you can redistribute it and/or modify
8   it under the terms of the GNU Lesser General Public License as published
9   by the Free Software Foundation; either version 2 of the License,
10   or (at your option) any later version.
11
12   PulseAudio is distributed in the hope that it will be useful, but
13   WITHOUT ANY WARRANTY; without even the implied warranty of
14   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15   General Public License for more details.
16
17   You should have received a copy of the GNU Lesser General Public License
18   along with PulseAudio; if not, write to the Free Software
19   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
20   USA.
21 ***/
22
23 #ifdef HAVE_CONFIG_H
24 #include <config.h>
25 #endif
26
27 #include <sys/types.h>
28 #include <limits.h>
29 #include <asoundlib.h>
30
31 #include <pulse/sample.h>
32 #include <pulse/xmalloc.h>
33
34 #include <pulsecore/log.h>
35 #include <pulsecore/macro.h>
36 #include <pulsecore/core-util.h>
37 #include <pulsecore/atomic.h>
38
39 #include "alsa-util.h"
40
41 struct pa_alsa_fdlist {
42     unsigned num_fds;
43     struct pollfd *fds;
44     /* This is a temporary buffer used to avoid lots of mallocs */
45     struct pollfd *work_fds;
46
47     snd_mixer_t *mixer;
48
49     pa_mainloop_api *m;
50     pa_defer_event *defer;
51     pa_io_event **ios;
52
53     pa_bool_t polled;
54
55     void (*cb)(void *userdata);
56     void *userdata;
57 };
58
59 static void io_cb(pa_mainloop_api*a, pa_io_event* e, int fd, pa_io_event_flags_t events, void *userdata) {
60
61     struct pa_alsa_fdlist *fdl = userdata;
62     int err;
63     unsigned i;
64     unsigned short revents;
65
66     pa_assert(a);
67     pa_assert(fdl);
68     pa_assert(fdl->mixer);
69     pa_assert(fdl->fds);
70     pa_assert(fdl->work_fds);
71
72     if (fdl->polled)
73         return;
74
75     fdl->polled = TRUE;
76
77     memcpy(fdl->work_fds, fdl->fds, sizeof(struct pollfd) * fdl->num_fds);
78
79     for (i = 0; i < fdl->num_fds; i++) {
80         if (e == fdl->ios[i]) {
81             if (events & PA_IO_EVENT_INPUT)
82                 fdl->work_fds[i].revents |= POLLIN;
83             if (events & PA_IO_EVENT_OUTPUT)
84                 fdl->work_fds[i].revents |= POLLOUT;
85             if (events & PA_IO_EVENT_ERROR)
86                 fdl->work_fds[i].revents |= POLLERR;
87             if (events & PA_IO_EVENT_HANGUP)
88                 fdl->work_fds[i].revents |= POLLHUP;
89             break;
90         }
91     }
92
93     pa_assert(i != fdl->num_fds);
94
95     if ((err = snd_mixer_poll_descriptors_revents(fdl->mixer, fdl->work_fds, fdl->num_fds, &revents)) < 0) {
96         pa_log_error("Unable to get poll revent: %s", snd_strerror(err));
97         return;
98     }
99
100     a->defer_enable(fdl->defer, 1);
101
102     if (revents)
103         snd_mixer_handle_events(fdl->mixer);
104 }
105
106 static void defer_cb(pa_mainloop_api*a, pa_defer_event* e, void *userdata) {
107     struct pa_alsa_fdlist *fdl = userdata;
108     unsigned num_fds, i;
109     int err;
110     struct pollfd *temp;
111
112     pa_assert(a);
113     pa_assert(fdl);
114     pa_assert(fdl->mixer);
115
116     a->defer_enable(fdl->defer, 0);
117
118     num_fds = (unsigned) snd_mixer_poll_descriptors_count(fdl->mixer);
119
120     if (num_fds != fdl->num_fds) {
121         if (fdl->fds)
122             pa_xfree(fdl->fds);
123         if (fdl->work_fds)
124             pa_xfree(fdl->work_fds);
125         fdl->fds = pa_xnew0(struct pollfd, num_fds);
126         fdl->work_fds = pa_xnew(struct pollfd, num_fds);
127     }
128
129     memset(fdl->work_fds, 0, sizeof(struct pollfd) * num_fds);
130
131     if ((err = snd_mixer_poll_descriptors(fdl->mixer, fdl->work_fds, num_fds)) < 0) {
132         pa_log_error("Unable to get poll descriptors: %s", snd_strerror(err));
133         return;
134     }
135
136     fdl->polled = FALSE;
137
138     if (memcmp(fdl->fds, fdl->work_fds, sizeof(struct pollfd) * num_fds) == 0)
139         return;
140
141     if (fdl->ios) {
142         for (i = 0; i < fdl->num_fds; i++)
143             a->io_free(fdl->ios[i]);
144
145         if (num_fds != fdl->num_fds) {
146             pa_xfree(fdl->ios);
147             fdl->ios = NULL;
148         }
149     }
150
151     if (!fdl->ios)
152         fdl->ios = pa_xnew(pa_io_event*, num_fds);
153
154     /* Swap pointers */
155     temp = fdl->work_fds;
156     fdl->work_fds = fdl->fds;
157     fdl->fds = temp;
158
159     fdl->num_fds = num_fds;
160
161     for (i = 0;i < num_fds;i++)
162         fdl->ios[i] = a->io_new(a, fdl->fds[i].fd,
163             ((fdl->fds[i].events & POLLIN) ? PA_IO_EVENT_INPUT : 0) |
164             ((fdl->fds[i].events & POLLOUT) ? PA_IO_EVENT_OUTPUT : 0),
165             io_cb, fdl);
166 }
167
168 struct pa_alsa_fdlist *pa_alsa_fdlist_new(void) {
169     struct pa_alsa_fdlist *fdl;
170
171     fdl = pa_xnew0(struct pa_alsa_fdlist, 1);
172
173     fdl->num_fds = 0;
174     fdl->fds = NULL;
175     fdl->work_fds = NULL;
176     fdl->mixer = NULL;
177     fdl->m = NULL;
178     fdl->defer = NULL;
179     fdl->ios = NULL;
180     fdl->polled = FALSE;
181
182     return fdl;
183 }
184
185 void pa_alsa_fdlist_free(struct pa_alsa_fdlist *fdl) {
186     pa_assert(fdl);
187
188     if (fdl->defer) {
189         pa_assert(fdl->m);
190         fdl->m->defer_free(fdl->defer);
191     }
192
193     if (fdl->ios) {
194         unsigned i;
195         pa_assert(fdl->m);
196         for (i = 0; i < fdl->num_fds; i++)
197             fdl->m->io_free(fdl->ios[i]);
198         pa_xfree(fdl->ios);
199     }
200
201     if (fdl->fds)
202         pa_xfree(fdl->fds);
203     if (fdl->work_fds)
204         pa_xfree(fdl->work_fds);
205
206     pa_xfree(fdl);
207 }
208
209 int pa_alsa_fdlist_set_mixer(struct pa_alsa_fdlist *fdl, snd_mixer_t *mixer_handle, pa_mainloop_api* m) {
210     pa_assert(fdl);
211     pa_assert(mixer_handle);
212     pa_assert(m);
213     pa_assert(!fdl->m);
214
215     fdl->mixer = mixer_handle;
216     fdl->m = m;
217     fdl->defer = m->defer_new(m, defer_cb, fdl);
218
219     return 0;
220 }
221
222 static int set_format(snd_pcm_t *pcm_handle, snd_pcm_hw_params_t *hwparams, pa_sample_format_t *f) {
223
224     static const snd_pcm_format_t format_trans[] = {
225         [PA_SAMPLE_U8] = SND_PCM_FORMAT_U8,
226         [PA_SAMPLE_ALAW] = SND_PCM_FORMAT_A_LAW,
227         [PA_SAMPLE_ULAW] = SND_PCM_FORMAT_MU_LAW,
228         [PA_SAMPLE_S16LE] = SND_PCM_FORMAT_S16_LE,
229         [PA_SAMPLE_S16BE] = SND_PCM_FORMAT_S16_BE,
230         [PA_SAMPLE_FLOAT32LE] = SND_PCM_FORMAT_FLOAT_LE,
231         [PA_SAMPLE_FLOAT32BE] = SND_PCM_FORMAT_FLOAT_BE,
232         [PA_SAMPLE_S32LE] = SND_PCM_FORMAT_S32_LE,
233         [PA_SAMPLE_S32BE] = SND_PCM_FORMAT_S32_BE,
234     };
235
236     static const pa_sample_format_t try_order[] = {
237         PA_SAMPLE_FLOAT32NE,
238         PA_SAMPLE_FLOAT32RE,
239         PA_SAMPLE_S32NE,
240         PA_SAMPLE_S32RE,
241         PA_SAMPLE_S16NE,
242         PA_SAMPLE_S16RE,
243         PA_SAMPLE_ALAW,
244         PA_SAMPLE_ULAW,
245         PA_SAMPLE_U8,
246         PA_SAMPLE_INVALID
247     };
248
249     int i, ret;
250
251     pa_assert(pcm_handle);
252     pa_assert(f);
253
254     if ((ret = snd_pcm_hw_params_set_format(pcm_handle, hwparams, format_trans[*f])) >= 0)
255         return ret;
256
257     if (*f == PA_SAMPLE_FLOAT32BE)
258         *f = PA_SAMPLE_FLOAT32LE;
259     else if (*f == PA_SAMPLE_FLOAT32LE)
260         *f = PA_SAMPLE_FLOAT32BE;
261     else if (*f == PA_SAMPLE_S16BE)
262         *f = PA_SAMPLE_S16LE;
263     else if (*f == PA_SAMPLE_S16LE)
264         *f = PA_SAMPLE_S16BE;
265     else if (*f == PA_SAMPLE_S32BE)
266         *f = PA_SAMPLE_S32LE;
267     else if (*f == PA_SAMPLE_S32LE)
268         *f = PA_SAMPLE_S32BE;
269     else
270         goto try_auto;
271
272     if ((ret = snd_pcm_hw_params_set_format(pcm_handle, hwparams, format_trans[*f])) >= 0)
273         return ret;
274
275 try_auto:
276
277     for (i = 0; try_order[i] != PA_SAMPLE_INVALID; i++) {
278         *f = try_order[i];
279
280         if ((ret = snd_pcm_hw_params_set_format(pcm_handle, hwparams, format_trans[*f])) >= 0)
281             return ret;
282     }
283
284     return -1;
285 }
286
287 /* Set the hardware parameters of the given ALSA device. Returns the
288  * selected fragment settings in *period and *period_size */
289 int pa_alsa_set_hw_params(
290         snd_pcm_t *pcm_handle,
291         pa_sample_spec *ss,
292         uint32_t *periods,
293         snd_pcm_uframes_t *period_size,
294         snd_pcm_uframes_t tsched_size,
295         pa_bool_t *use_mmap,
296         pa_bool_t *use_tsched,
297         pa_bool_t require_exact_channel_number) {
298
299     int ret = -1;
300     snd_pcm_uframes_t _period_size = *period_size;
301     unsigned int _periods = *periods;
302     snd_pcm_uframes_t buffer_size;
303     unsigned int r = ss->rate;
304     unsigned int c = ss->channels;
305     pa_sample_format_t f = ss->format;
306     snd_pcm_hw_params_t *hwparams;
307     pa_bool_t _use_mmap = use_mmap && *use_mmap;
308     pa_bool_t _use_tsched = use_tsched && *use_tsched;
309     int dir;
310
311     pa_assert(pcm_handle);
312     pa_assert(ss);
313     pa_assert(periods);
314     pa_assert(period_size);
315
316     snd_pcm_hw_params_alloca(&hwparams);
317
318     if ((ret = snd_pcm_hw_params_any(pcm_handle, hwparams)) < 0)
319         goto finish;
320
321     if ((ret = snd_pcm_hw_params_set_rate_resample(pcm_handle, hwparams, 0)) < 0)
322         goto finish;
323
324     if (_use_mmap) {
325         if ((ret = snd_pcm_hw_params_set_access(pcm_handle, hwparams, SND_PCM_ACCESS_MMAP_INTERLEAVED)) < 0) {
326
327             /* mmap() didn't work, fall back to interleaved */
328
329             if ((ret = snd_pcm_hw_params_set_access(pcm_handle, hwparams, SND_PCM_ACCESS_RW_INTERLEAVED)) < 0)
330                 goto finish;
331
332             _use_mmap = FALSE;
333         }
334
335     } else if ((ret = snd_pcm_hw_params_set_access(pcm_handle, hwparams, SND_PCM_ACCESS_RW_INTERLEAVED)) < 0)
336         goto finish;
337
338     if (!_use_mmap)
339         _use_tsched = FALSE;
340
341     if ((ret = set_format(pcm_handle, hwparams, &f)) < 0)
342         goto finish;
343
344     if ((ret = snd_pcm_hw_params_set_rate_near(pcm_handle, hwparams, &r, NULL)) < 0)
345         goto finish;
346
347     /* Adjust the buffer sizes, if we didn't get the rate we were asking for */
348     _period_size = (snd_pcm_uframes_t) (((uint64_t) _period_size * r) / ss->rate);
349     tsched_size = (snd_pcm_uframes_t) (((uint64_t) tsched_size * r) / ss->rate);
350
351     if (require_exact_channel_number) {
352         if ((ret = snd_pcm_hw_params_set_channels(pcm_handle, hwparams, c)) < 0)
353             goto finish;
354     } else {
355         if ((ret = snd_pcm_hw_params_set_channels_near(pcm_handle, hwparams, &c)) < 0)
356             goto finish;
357     }
358
359     if (_use_tsched) {
360         _period_size = tsched_size;
361         _periods = 1;
362
363         pa_assert_se(snd_pcm_hw_params_get_buffer_size_max(hwparams, &buffer_size) == 0);
364         pa_log_debug("Maximum hw buffer size is %u ms", (unsigned) buffer_size * 1000 / r);
365     }
366
367     buffer_size = _periods * _period_size;
368
369     if ((ret = snd_pcm_hw_params_set_periods_integer(pcm_handle, hwparams)) < 0)
370         goto finish;
371
372     if (_periods > 0) {
373         dir = 1;
374         if ((ret = snd_pcm_hw_params_set_periods_near(pcm_handle, hwparams, &_periods, &dir)) < 0) {
375             dir = -1;
376             if ((ret = snd_pcm_hw_params_set_periods_near(pcm_handle, hwparams, &_periods, &dir)) < 0)
377                 goto finish;
378         }
379     }
380
381     if (_period_size > 0)
382         if ((ret = snd_pcm_hw_params_set_buffer_size_near(pcm_handle, hwparams, &buffer_size)) < 0)
383             goto finish;
384
385     if  ((ret = snd_pcm_hw_params(pcm_handle, hwparams)) < 0)
386         goto finish;
387
388     if (ss->rate != r)
389         pa_log_warn("Device %s doesn't support %u Hz, changed to %u Hz.", snd_pcm_name(pcm_handle), ss->rate, r);
390
391     if (ss->channels != c)
392         pa_log_warn("Device %s doesn't support %u channels, changed to %u.", snd_pcm_name(pcm_handle), ss->channels, c);
393
394     if (ss->format != f)
395         pa_log_warn("Device %s doesn't support sample format %s, changed to %s.", snd_pcm_name(pcm_handle), pa_sample_format_to_string(ss->format), pa_sample_format_to_string(f));
396
397     if ((ret = snd_pcm_prepare(pcm_handle)) < 0)
398         goto finish;
399
400     if ((ret = snd_pcm_hw_params_get_period_size(hwparams, &_period_size, &dir)) < 0 ||
401         (ret = snd_pcm_hw_params_get_periods(hwparams, &_periods, &dir)) < 0)
402         goto finish;
403
404     /* If the sample rate deviates too much, we need to resample */
405     if (r < ss->rate*.95 || r > ss->rate*1.05)
406         ss->rate = r;
407     ss->channels = (uint8_t) c;
408     ss->format = f;
409
410     pa_assert(_periods > 0);
411     pa_assert(_period_size > 0);
412
413     *periods = _periods;
414     *period_size = _period_size;
415
416     if (use_mmap)
417         *use_mmap = _use_mmap;
418
419     if (use_tsched)
420         *use_tsched = _use_tsched;
421
422     ret = 0;
423
424     snd_pcm_nonblock(pcm_handle, 1);
425
426 finish:
427
428     return ret;
429 }
430
431 int pa_alsa_set_sw_params(snd_pcm_t *pcm, snd_pcm_uframes_t avail_min) {
432     snd_pcm_sw_params_t *swparams;
433     int err;
434
435     pa_assert(pcm);
436
437     snd_pcm_sw_params_alloca(&swparams);
438
439     if ((err = snd_pcm_sw_params_current(pcm, swparams) < 0)) {
440         pa_log_warn("Unable to determine current swparams: %s\n", snd_strerror(err));
441         return err;
442     }
443
444     if ((err = snd_pcm_sw_params_set_stop_threshold(pcm, swparams, (snd_pcm_uframes_t) -1)) < 0) {
445         pa_log_warn("Unable to set stop threshold: %s\n", snd_strerror(err));
446         return err;
447     }
448
449     if ((err = snd_pcm_sw_params_set_start_threshold(pcm, swparams, (snd_pcm_uframes_t) -1)) < 0) {
450         pa_log_warn("Unable to set start threshold: %s\n", snd_strerror(err));
451         return err;
452     }
453
454     if ((err = snd_pcm_sw_params_set_avail_min(pcm, swparams, avail_min)) < 0) {
455         pa_log_error("snd_pcm_sw_params_set_avail_min() failed: %s", snd_strerror(err));
456         return err;
457     }
458
459     if ((err = snd_pcm_sw_params(pcm, swparams)) < 0) {
460         pa_log_warn("Unable to set sw params: %s\n", snd_strerror(err));
461         return err;
462     }
463
464     return 0;
465 }
466
467 struct device_info {
468     pa_channel_map map;
469     const char *name;
470 };
471
472 static const struct device_info device_table[] = {
473     {{ 2, { PA_CHANNEL_POSITION_LEFT, PA_CHANNEL_POSITION_RIGHT } }, "front" },
474
475     {{ 4, { PA_CHANNEL_POSITION_FRONT_LEFT, PA_CHANNEL_POSITION_FRONT_RIGHT,
476             PA_CHANNEL_POSITION_REAR_LEFT, PA_CHANNEL_POSITION_REAR_RIGHT }}, "surround40" },
477
478     {{ 5, { PA_CHANNEL_POSITION_FRONT_LEFT, PA_CHANNEL_POSITION_FRONT_RIGHT,
479             PA_CHANNEL_POSITION_REAR_LEFT, PA_CHANNEL_POSITION_REAR_RIGHT,
480             PA_CHANNEL_POSITION_LFE }}, "surround41" },
481
482     {{ 5, { PA_CHANNEL_POSITION_FRONT_LEFT, PA_CHANNEL_POSITION_FRONT_RIGHT,
483             PA_CHANNEL_POSITION_REAR_LEFT, PA_CHANNEL_POSITION_REAR_RIGHT,
484             PA_CHANNEL_POSITION_CENTER }}, "surround50" },
485
486     {{ 6, { PA_CHANNEL_POSITION_FRONT_LEFT, PA_CHANNEL_POSITION_FRONT_RIGHT,
487             PA_CHANNEL_POSITION_REAR_LEFT, PA_CHANNEL_POSITION_REAR_RIGHT,
488             PA_CHANNEL_POSITION_CENTER, PA_CHANNEL_POSITION_LFE }}, "surround51" },
489
490     {{ 8, { PA_CHANNEL_POSITION_FRONT_LEFT, PA_CHANNEL_POSITION_FRONT_RIGHT,
491             PA_CHANNEL_POSITION_REAR_LEFT, PA_CHANNEL_POSITION_REAR_RIGHT,
492             PA_CHANNEL_POSITION_CENTER, PA_CHANNEL_POSITION_LFE,
493             PA_CHANNEL_POSITION_SIDE_LEFT, PA_CHANNEL_POSITION_SIDE_RIGHT }} , "surround71" },
494
495     {{ 0, { 0 }}, NULL }
496 };
497
498 static pa_bool_t channel_map_superset(const pa_channel_map *a, const pa_channel_map *b) {
499     pa_bool_t in_a[PA_CHANNEL_POSITION_MAX];
500     unsigned i;
501
502     pa_assert(a);
503     pa_assert(b);
504
505     memset(in_a, 0, sizeof(in_a));
506
507     for (i = 0; i < a->channels; i++)
508         in_a[a->map[i]] = TRUE;
509
510     for (i = 0; i < b->channels; i++)
511         if (!in_a[b->map[i]])
512             return FALSE;
513
514     return TRUE;
515 }
516
517 snd_pcm_t *pa_alsa_open_by_device_id(
518         const char *dev_id,
519         char **dev,
520         pa_sample_spec *ss,
521         pa_channel_map* map,
522         int mode,
523         uint32_t *nfrags,
524         snd_pcm_uframes_t *period_size,
525         snd_pcm_uframes_t tsched_size,
526         pa_bool_t *use_mmap,
527         pa_bool_t *use_tsched) {
528
529     int i;
530     int direction = 1;
531     int err;
532     char *d;
533     snd_pcm_t *pcm_handle;
534
535     pa_assert(dev_id);
536     pa_assert(dev);
537     pa_assert(ss);
538     pa_assert(map);
539     pa_assert(nfrags);
540     pa_assert(period_size);
541
542     /* First we try to find a device string with a superset of the
543      * requested channel map and open it without the plug: prefix. We
544      * iterate through our device table from top to bottom and take
545      * the first that matches. If we didn't find a working device that
546      * way, we iterate backwards, and check all devices that do not
547      * provide a superset of the requested channel map.*/
548
549     for (i = 0;; i += direction) {
550         pa_sample_spec try_ss;
551
552         if (i < 0) {
553             pa_assert(direction == -1);
554
555             /* OK, so we iterated backwards, and now are at the
556              * beginning of our list. */
557
558             break;
559
560         } else if (!device_table[i].name) {
561             pa_assert(direction == 1);
562
563             /* OK, so we are at the end of our list. at iterated
564              * forwards. */
565
566             i--;
567             direction = -1;
568         }
569
570         if ((direction > 0) == !channel_map_superset(&device_table[i].map, map))
571             continue;
572
573         d = pa_sprintf_malloc("%s:%s", device_table[i].name, dev_id);
574
575         for (;;) {
576             pa_log_debug("Trying %s...", d);
577
578             /* We don't pass SND_PCM_NONBLOCK here, since alsa-lib <=
579              * 1.0.17a would then ignore the SND_PCM_NO_xxx
580              * flags. Instead we enable nonblock mode afterwards via
581              * snd_pcm_nonblock(). Also see
582              * http://mailman.alsa-project.org/pipermail/alsa-devel/2008-August/010258.html */
583
584             if ((err = snd_pcm_open(&pcm_handle, d, mode,
585                                     /* SND_PCM_NONBLOCK| */
586                                     SND_PCM_NO_AUTO_RESAMPLE|
587                                     SND_PCM_NO_AUTO_CHANNELS|
588                                     SND_PCM_NO_AUTO_FORMAT)) < 0) {
589                 pa_log_info("Couldn't open PCM device %s: %s", d, snd_strerror(err));
590                 break;
591             }
592
593             try_ss.channels = device_table[i].map.channels;
594             try_ss.rate = ss->rate;
595             try_ss.format = ss->format;
596
597             if ((err = pa_alsa_set_hw_params(pcm_handle, &try_ss, nfrags, period_size, tsched_size, use_mmap, use_tsched, TRUE)) < 0) {
598
599                 if (!pa_startswith(d, "plug:") && !pa_startswith(d, "plughw:")) {
600                     char *t;
601
602                     t = pa_sprintf_malloc("plug:%s", d);
603                     pa_xfree(d);
604                     d = t;
605
606                     snd_pcm_close(pcm_handle);
607                     continue;
608                 }
609
610                 pa_log_info("PCM device %s refused our hw parameters: %s", d, snd_strerror(err));
611                 snd_pcm_close(pcm_handle);
612                 break;
613             }
614
615             *ss = try_ss;
616             *map = device_table[i].map;
617             pa_assert(map->channels == ss->channels);
618             *dev = d;
619             return pcm_handle;
620         }
621
622         pa_xfree(d);
623     }
624
625     /* OK, we didn't find any good device, so let's try the raw plughw: stuff */
626
627     d = pa_sprintf_malloc("hw:%s", dev_id);
628     pa_log_debug("Trying %s as last resort...", d);
629     pcm_handle = pa_alsa_open_by_device_string(d, dev, ss, map, mode, nfrags, period_size, tsched_size, use_mmap, use_tsched);
630     pa_xfree(d);
631
632     return pcm_handle;
633 }
634
635 snd_pcm_t *pa_alsa_open_by_device_string(
636         const char *device,
637         char **dev,
638         pa_sample_spec *ss,
639         pa_channel_map* map,
640         int mode,
641         uint32_t *nfrags,
642         snd_pcm_uframes_t *period_size,
643         snd_pcm_uframes_t tsched_size,
644         pa_bool_t *use_mmap,
645         pa_bool_t *use_tsched) {
646
647     int err;
648     char *d;
649     snd_pcm_t *pcm_handle;
650
651     pa_assert(device);
652     pa_assert(dev);
653     pa_assert(ss);
654     pa_assert(map);
655     pa_assert(nfrags);
656     pa_assert(period_size);
657
658     d = pa_xstrdup(device);
659
660     for (;;) {
661         pa_log_debug("Trying %s...", d);
662
663         /* We don't pass SND_PCM_NONBLOCK here, since alsa-lib <=
664          * 1.0.17a would then ignore the SND_PCM_NO_xxx flags. Instead
665          * we enable nonblock mode afterwards via
666          * snd_pcm_nonblock(). Also see
667          * http://mailman.alsa-project.org/pipermail/alsa-devel/2008-August/010258.html */
668
669         if ((err = snd_pcm_open(&pcm_handle, d, mode,
670                                 /*SND_PCM_NONBLOCK|*/
671                                 SND_PCM_NO_AUTO_RESAMPLE|
672                                 SND_PCM_NO_AUTO_CHANNELS|
673                                 SND_PCM_NO_AUTO_FORMAT)) < 0) {
674             pa_log("Error opening PCM device %s: %s", d, snd_strerror(err));
675             pa_xfree(d);
676             return NULL;
677         }
678
679         if ((err = pa_alsa_set_hw_params(pcm_handle, ss, nfrags, period_size, tsched_size, use_mmap, use_tsched, FALSE)) < 0) {
680
681             /* Hmm, some hw is very exotic, so we retry with plug, if without it didn't work */
682
683             if (!pa_startswith(d, "plug:") && !pa_startswith(d, "plughw:")) {
684                 char *t;
685
686                 t = pa_sprintf_malloc("plug:%s", d);
687                 pa_xfree(d);
688                 d = t;
689
690                 snd_pcm_close(pcm_handle);
691                 continue;
692             }
693
694             pa_log("Failed to set hardware parameters on %s: %s", d, snd_strerror(err));
695             pa_xfree(d);
696             snd_pcm_close(pcm_handle);
697             return NULL;
698         }
699
700         *dev = d;
701
702         if (ss->channels != map->channels)
703             pa_channel_map_init_extend(map, ss->channels, PA_CHANNEL_MAP_ALSA);
704
705         return pcm_handle;
706     }
707 }
708
709 int pa_alsa_prepare_mixer(snd_mixer_t *mixer, const char *dev) {
710     int err;
711
712     pa_assert(mixer);
713     pa_assert(dev);
714
715     if ((err = snd_mixer_attach(mixer, dev)) < 0) {
716         pa_log_info("Unable to attach to mixer %s: %s", dev, snd_strerror(err));
717         return -1;
718     }
719
720     if ((err = snd_mixer_selem_register(mixer, NULL, NULL)) < 0) {
721         pa_log_warn("Unable to register mixer: %s", snd_strerror(err));
722         return -1;
723     }
724
725     if ((err = snd_mixer_load(mixer)) < 0) {
726         pa_log_warn("Unable to load mixer: %s", snd_strerror(err));
727         return -1;
728     }
729
730     pa_log_info("Successfully attached to mixer '%s'", dev);
731
732     return 0;
733 }
734
735 snd_mixer_elem_t *pa_alsa_find_elem(snd_mixer_t *mixer, const char *name, const char *fallback) {
736     snd_mixer_elem_t *elem;
737     snd_mixer_selem_id_t *sid = NULL;
738
739     snd_mixer_selem_id_alloca(&sid);
740
741     pa_assert(mixer);
742     pa_assert(name);
743
744     snd_mixer_selem_id_set_name(sid, name);
745
746     if (!(elem = snd_mixer_find_selem(mixer, sid))) {
747         pa_log_info("Cannot find mixer control \"%s\".", snd_mixer_selem_id_get_name(sid));
748
749         if (fallback) {
750             snd_mixer_selem_id_set_name(sid, fallback);
751
752             if (!(elem = snd_mixer_find_selem(mixer, sid)))
753                 pa_log_warn("Cannot find fallback mixer control \"%s\".", snd_mixer_selem_id_get_name(sid));
754         }
755     }
756
757     if (elem)
758         pa_log_info("Using mixer control \"%s\".", snd_mixer_selem_id_get_name(sid));
759
760     return elem;
761 }
762
763 static const snd_mixer_selem_channel_id_t alsa_channel_ids[PA_CHANNEL_POSITION_MAX] = {
764     [PA_CHANNEL_POSITION_MONO] = SND_MIXER_SCHN_MONO, /* The ALSA name is just an alias! */
765
766     [PA_CHANNEL_POSITION_FRONT_CENTER] = SND_MIXER_SCHN_FRONT_CENTER,
767     [PA_CHANNEL_POSITION_FRONT_LEFT] = SND_MIXER_SCHN_FRONT_LEFT,
768     [PA_CHANNEL_POSITION_FRONT_RIGHT] = SND_MIXER_SCHN_FRONT_RIGHT,
769
770     [PA_CHANNEL_POSITION_REAR_CENTER] = SND_MIXER_SCHN_REAR_CENTER,
771     [PA_CHANNEL_POSITION_REAR_LEFT] = SND_MIXER_SCHN_REAR_LEFT,
772     [PA_CHANNEL_POSITION_REAR_RIGHT] = SND_MIXER_SCHN_REAR_RIGHT,
773
774     [PA_CHANNEL_POSITION_LFE] = SND_MIXER_SCHN_WOOFER,
775
776     [PA_CHANNEL_POSITION_FRONT_LEFT_OF_CENTER] = SND_MIXER_SCHN_UNKNOWN,
777     [PA_CHANNEL_POSITION_FRONT_RIGHT_OF_CENTER] = SND_MIXER_SCHN_UNKNOWN,
778
779     [PA_CHANNEL_POSITION_SIDE_LEFT] = SND_MIXER_SCHN_SIDE_LEFT,
780     [PA_CHANNEL_POSITION_SIDE_RIGHT] = SND_MIXER_SCHN_SIDE_RIGHT,
781
782     [PA_CHANNEL_POSITION_AUX0] = SND_MIXER_SCHN_UNKNOWN,
783     [PA_CHANNEL_POSITION_AUX1] = SND_MIXER_SCHN_UNKNOWN,
784     [PA_CHANNEL_POSITION_AUX2] = SND_MIXER_SCHN_UNKNOWN,
785     [PA_CHANNEL_POSITION_AUX3] = SND_MIXER_SCHN_UNKNOWN,
786     [PA_CHANNEL_POSITION_AUX4] = SND_MIXER_SCHN_UNKNOWN,
787     [PA_CHANNEL_POSITION_AUX5] = SND_MIXER_SCHN_UNKNOWN,
788     [PA_CHANNEL_POSITION_AUX6] = SND_MIXER_SCHN_UNKNOWN,
789     [PA_CHANNEL_POSITION_AUX7] = SND_MIXER_SCHN_UNKNOWN,
790     [PA_CHANNEL_POSITION_AUX8] = SND_MIXER_SCHN_UNKNOWN,
791     [PA_CHANNEL_POSITION_AUX9] =  SND_MIXER_SCHN_UNKNOWN,
792     [PA_CHANNEL_POSITION_AUX10] = SND_MIXER_SCHN_UNKNOWN,
793     [PA_CHANNEL_POSITION_AUX11] = SND_MIXER_SCHN_UNKNOWN,
794     [PA_CHANNEL_POSITION_AUX12] = SND_MIXER_SCHN_UNKNOWN,
795     [PA_CHANNEL_POSITION_AUX13] = SND_MIXER_SCHN_UNKNOWN,
796     [PA_CHANNEL_POSITION_AUX14] = SND_MIXER_SCHN_UNKNOWN,
797     [PA_CHANNEL_POSITION_AUX15] = SND_MIXER_SCHN_UNKNOWN,
798     [PA_CHANNEL_POSITION_AUX16] = SND_MIXER_SCHN_UNKNOWN,
799     [PA_CHANNEL_POSITION_AUX17] = SND_MIXER_SCHN_UNKNOWN,
800     [PA_CHANNEL_POSITION_AUX18] = SND_MIXER_SCHN_UNKNOWN,
801     [PA_CHANNEL_POSITION_AUX19] = SND_MIXER_SCHN_UNKNOWN,
802     [PA_CHANNEL_POSITION_AUX20] = SND_MIXER_SCHN_UNKNOWN,
803     [PA_CHANNEL_POSITION_AUX21] = SND_MIXER_SCHN_UNKNOWN,
804     [PA_CHANNEL_POSITION_AUX22] = SND_MIXER_SCHN_UNKNOWN,
805     [PA_CHANNEL_POSITION_AUX23] = SND_MIXER_SCHN_UNKNOWN,
806     [PA_CHANNEL_POSITION_AUX24] = SND_MIXER_SCHN_UNKNOWN,
807     [PA_CHANNEL_POSITION_AUX25] = SND_MIXER_SCHN_UNKNOWN,
808     [PA_CHANNEL_POSITION_AUX26] = SND_MIXER_SCHN_UNKNOWN,
809     [PA_CHANNEL_POSITION_AUX27] = SND_MIXER_SCHN_UNKNOWN,
810     [PA_CHANNEL_POSITION_AUX28] = SND_MIXER_SCHN_UNKNOWN,
811     [PA_CHANNEL_POSITION_AUX29] = SND_MIXER_SCHN_UNKNOWN,
812     [PA_CHANNEL_POSITION_AUX30] = SND_MIXER_SCHN_UNKNOWN,
813     [PA_CHANNEL_POSITION_AUX31] = SND_MIXER_SCHN_UNKNOWN,
814
815     [PA_CHANNEL_POSITION_TOP_CENTER] = SND_MIXER_SCHN_UNKNOWN,
816
817     [PA_CHANNEL_POSITION_TOP_FRONT_CENTER] = SND_MIXER_SCHN_UNKNOWN,
818     [PA_CHANNEL_POSITION_TOP_FRONT_LEFT] = SND_MIXER_SCHN_UNKNOWN,
819     [PA_CHANNEL_POSITION_TOP_FRONT_RIGHT] = SND_MIXER_SCHN_UNKNOWN,
820
821     [PA_CHANNEL_POSITION_TOP_REAR_CENTER] = SND_MIXER_SCHN_UNKNOWN,
822     [PA_CHANNEL_POSITION_TOP_REAR_LEFT] = SND_MIXER_SCHN_UNKNOWN,
823     [PA_CHANNEL_POSITION_TOP_REAR_RIGHT] = SND_MIXER_SCHN_UNKNOWN
824 };
825
826
827 int pa_alsa_calc_mixer_map(snd_mixer_elem_t *elem, const pa_channel_map *channel_map, snd_mixer_selem_channel_id_t mixer_map[], pa_bool_t playback) {
828     unsigned i;
829     pa_bool_t alsa_channel_used[SND_MIXER_SCHN_LAST];
830     pa_bool_t mono_used = FALSE;
831
832     pa_assert(elem);
833     pa_assert(channel_map);
834     pa_assert(mixer_map);
835
836     memset(&alsa_channel_used, 0, sizeof(alsa_channel_used));
837
838     if (channel_map->channels > 1 &&
839         ((playback && snd_mixer_selem_has_playback_volume_joined(elem)) ||
840          (!playback && snd_mixer_selem_has_capture_volume_joined(elem)))) {
841         pa_log_info("ALSA device lacks independant volume controls for each channel.");
842         return -1;
843     }
844
845     for (i = 0; i < channel_map->channels; i++) {
846         snd_mixer_selem_channel_id_t id;
847         pa_bool_t is_mono;
848
849         is_mono = channel_map->map[i] == PA_CHANNEL_POSITION_MONO;
850         id = alsa_channel_ids[channel_map->map[i]];
851
852         if (!is_mono && id == SND_MIXER_SCHN_UNKNOWN) {
853             pa_log_info("Configured channel map contains channel '%s' that is unknown to the ALSA mixer.", pa_channel_position_to_string(channel_map->map[i]));
854             return -1;
855         }
856
857         if ((is_mono && mono_used) || (!is_mono && alsa_channel_used[id])) {
858             pa_log_info("Channel map has duplicate channel '%s', falling back to software volume control.", pa_channel_position_to_string(channel_map->map[i]));
859             return -1;
860         }
861
862         if ((playback && (!snd_mixer_selem_has_playback_channel(elem, id) || (is_mono && !snd_mixer_selem_is_playback_mono(elem)))) ||
863             (!playback && (!snd_mixer_selem_has_capture_channel(elem, id) || (is_mono && !snd_mixer_selem_is_capture_mono(elem))))) {
864
865             pa_log_info("ALSA device lacks separate volumes control for channel '%s'", pa_channel_position_to_string(channel_map->map[i]));
866             return -1;
867         }
868
869         if (is_mono) {
870             mixer_map[i] = SND_MIXER_SCHN_MONO;
871             mono_used = TRUE;
872         } else {
873             mixer_map[i] = id;
874             alsa_channel_used[id] = TRUE;
875         }
876     }
877
878     pa_log_info("All %u channels can be mapped to mixer channels.", channel_map->channels);
879
880     return 0;
881 }
882
883 void pa_alsa_dump(snd_pcm_t *pcm) {
884     int err;
885     snd_output_t *out;
886
887     pa_assert(pcm);
888
889     pa_assert_se(snd_output_buffer_open(&out) == 0);
890
891     if ((err = snd_pcm_dump(pcm, out)) < 0)
892         pa_log_debug("snd_pcm_dump(): %s", snd_strerror(err));
893     else {
894         char *s = NULL;
895         snd_output_buffer_string(out, &s);
896         pa_log_debug("snd_pcm_dump():\n%s", pa_strnull(s));
897     }
898
899     pa_assert_se(snd_output_close(out) == 0);
900 }
901
902 void pa_alsa_dump_status(snd_pcm_t *pcm) {
903     int err;
904     snd_output_t *out;
905     snd_pcm_status_t *status;
906
907     pa_assert(pcm);
908
909     snd_pcm_status_alloca(&status);
910
911     pa_assert_se(snd_output_buffer_open(&out) == 0);
912
913     pa_assert_se(snd_pcm_status(pcm, status) == 0);
914
915     if ((err = snd_pcm_status_dump(status, out)) < 0)
916         pa_log_debug("snd_pcm_dump(): %s", snd_strerror(err));
917     else {
918         char *s = NULL;
919         snd_output_buffer_string(out, &s);
920         pa_log_debug("snd_pcm_dump():\n%s", pa_strnull(s));
921     }
922
923     pa_assert_se(snd_output_close(out) == 0);
924 }
925
926 static void alsa_error_handler(const char *file, int line, const char *function, int err, const char *fmt,...) {
927     va_list ap;
928     char *alsa_file;
929
930     alsa_file = pa_sprintf_malloc("(alsa-lib)%s", file);
931
932     va_start(ap, fmt);
933
934     pa_log_levelv_meta(PA_LOG_INFO, alsa_file, line, function, fmt, ap);
935
936     va_end(ap);
937
938     pa_xfree(alsa_file);
939 }
940
941 static pa_atomic_t n_error_handler_installed = PA_ATOMIC_INIT(0);
942
943 void pa_alsa_redirect_errors_inc(void) {
944     /* This is not really thread safe, but we do our best */
945
946     if (pa_atomic_inc(&n_error_handler_installed) == 0)
947         snd_lib_error_set_handler(alsa_error_handler);
948 }
949
950 void pa_alsa_redirect_errors_dec(void) {
951     int r;
952
953     pa_assert_se((r = pa_atomic_dec(&n_error_handler_installed)) >= 1);
954
955     if (r == 1)
956         snd_lib_error_set_handler(NULL);
957 }
958
959 void pa_alsa_init_proplist(pa_proplist *p, snd_pcm_info_t *pcm_info) {
960
961     static const char * const alsa_class_table[SND_PCM_CLASS_LAST+1] = {
962         [SND_PCM_CLASS_GENERIC] = "generic",
963         [SND_PCM_CLASS_MULTI] = "multi",
964         [SND_PCM_CLASS_MODEM] = "modem",
965         [SND_PCM_CLASS_DIGITIZER] = "digitizer"
966     };
967     static const char * const class_table[SND_PCM_CLASS_LAST+1] = {
968         [SND_PCM_CLASS_GENERIC] = "sound",
969         [SND_PCM_CLASS_MULTI] = NULL,
970         [SND_PCM_CLASS_MODEM] = "modem",
971         [SND_PCM_CLASS_DIGITIZER] = NULL
972     };
973     static const char * const alsa_subclass_table[SND_PCM_SUBCLASS_LAST+1] = {
974         [SND_PCM_SUBCLASS_GENERIC_MIX] = "generic-mix",
975         [SND_PCM_SUBCLASS_MULTI_MIX] = "multi-mix"
976     };
977
978     snd_pcm_class_t class;
979     snd_pcm_subclass_t subclass;
980     const char *n, *id, *sdn;
981     char *cn = NULL, *lcn = NULL;
982     int card;
983
984     pa_assert(p);
985     pa_assert(pcm_info);
986
987     pa_proplist_sets(p, PA_PROP_DEVICE_API, "alsa");
988
989     class = snd_pcm_info_get_class(pcm_info);
990     if (class <= SND_PCM_CLASS_LAST) {
991         if (class_table[class])
992             pa_proplist_sets(p, PA_PROP_DEVICE_CLASS, class_table[class]);
993         if (alsa_class_table[class])
994             pa_proplist_sets(p, "alsa.class", alsa_class_table[class]);
995     }
996     subclass = snd_pcm_info_get_subclass(pcm_info);
997     if (subclass <= SND_PCM_SUBCLASS_LAST)
998         if (alsa_subclass_table[subclass])
999             pa_proplist_sets(p, "alsa.subclass", alsa_subclass_table[subclass]);
1000
1001     if ((n = snd_pcm_info_get_name(pcm_info)))
1002         pa_proplist_sets(p, "alsa.name", n);
1003
1004     if ((id = snd_pcm_info_get_id(pcm_info)))
1005         pa_proplist_sets(p, "alsa.id", id);
1006
1007     pa_proplist_setf(p, "alsa.subdevice", "%u", snd_pcm_info_get_subdevice(pcm_info));
1008     if ((sdn = snd_pcm_info_get_subdevice_name(pcm_info)))
1009         pa_proplist_sets(p, "alsa.subdevice_name", sdn);
1010
1011     pa_proplist_setf(p, "alsa.device", "%u", snd_pcm_info_get_device(pcm_info));
1012
1013     if ((card = snd_pcm_info_get_card(pcm_info)) >= 0) {
1014         pa_proplist_setf(p, "alsa.card", "%i", card);
1015
1016         if (snd_card_get_name(card, &cn) >= 0)
1017             pa_proplist_sets(p, "alsa.card_name", cn);
1018
1019         if (snd_card_get_longname(card, &lcn) >= 0)
1020             pa_proplist_sets(p, "alsa.long_card_name", lcn);
1021     }
1022
1023     if (cn && n)
1024         pa_proplist_setf(p, PA_PROP_DEVICE_DESCRIPTION, "%s - %s", cn, n);
1025     else if (cn)
1026         pa_proplist_sets(p, PA_PROP_DEVICE_DESCRIPTION, cn);
1027     else if (n)
1028         pa_proplist_sets(p, PA_PROP_DEVICE_DESCRIPTION, n);
1029
1030     free(lcn);
1031     free(cn);
1032 }
1033
1034 int pa_alsa_recover_from_poll(snd_pcm_t *pcm, int revents) {
1035     snd_pcm_state_t state;
1036     int err;
1037
1038     pa_assert(pcm);
1039
1040     if (revents & POLLERR)
1041         pa_log_warn("Got POLLERR from ALSA");
1042     if (revents & POLLNVAL)
1043         pa_log_warn("Got POLLNVAL from ALSA");
1044     if (revents & POLLHUP)
1045         pa_log_warn("Got POLLHUP from ALSA");
1046
1047     state = snd_pcm_state(pcm);
1048     pa_log_warn("PCM state is %s", snd_pcm_state_name(state));
1049
1050     /* Try to recover from this error */
1051
1052     switch (state) {
1053
1054         case SND_PCM_STATE_XRUN:
1055             if ((err = snd_pcm_recover(pcm, -EPIPE, 1)) != 0) {
1056                 pa_log_warn("Could not recover from POLLERR|POLLNVAL|POLLHUP and XRUN: %s", snd_strerror(err));
1057                 return -1;
1058             }
1059             break;
1060
1061         case SND_PCM_STATE_SUSPENDED:
1062             if ((err = snd_pcm_recover(pcm, -ESTRPIPE, 1)) != 0) {
1063                 pa_log_warn("Could not recover from POLLERR|POLLNVAL|POLLHUP and SUSPENDED: %s", snd_strerror(err));
1064                 return -1;
1065             }
1066             break;
1067
1068         default:
1069
1070             snd_pcm_drop(pcm);
1071
1072             if ((err = snd_pcm_prepare(pcm)) < 0) {
1073                 pa_log_warn("Could not recover from POLLERR|POLLNVAL|POLLHUP with snd_pcm_prepare(): %s", snd_strerror(err));
1074                 return -1;
1075             }
1076             break;
1077     }
1078
1079     return 0;
1080 }
1081
1082 pa_rtpoll_item* pa_alsa_build_pollfd(snd_pcm_t *pcm, pa_rtpoll *rtpoll) {
1083     int n, err;
1084     struct pollfd *pollfd;
1085     pa_rtpoll_item *item;
1086
1087     pa_assert(pcm);
1088
1089     if ((n = snd_pcm_poll_descriptors_count(pcm)) < 0) {
1090         pa_log("snd_pcm_poll_descriptors_count() failed: %s", snd_strerror(n));
1091         return NULL;
1092     }
1093
1094     item = pa_rtpoll_item_new(rtpoll, PA_RTPOLL_NEVER, (unsigned) n);
1095     pollfd = pa_rtpoll_item_get_pollfd(item, NULL);
1096
1097     if ((err = snd_pcm_poll_descriptors(pcm, pollfd, (unsigned) n)) < 0) {
1098         pa_log("snd_pcm_poll_descriptors() failed: %s", snd_strerror(err));
1099         pa_rtpoll_item_free(item);
1100         return NULL;
1101     }
1102
1103     return item;
1104 }
1105
1106 pa_cvolume *pa_alsa_volume_divide(pa_cvolume *r, const pa_cvolume *t) {
1107     unsigned i;
1108
1109     pa_assert(r);
1110     pa_assert(t);
1111     pa_assert(r->channels == t->channels);
1112
1113     for (i = 0; i < r->channels; i++) {
1114         double a, b, c;
1115
1116         a = pa_sw_volume_to_linear(r->values[i]); /* the hw volume */
1117         b = pa_sw_volume_to_linear(t->values[i]); /* the intended volume */
1118
1119         if (a <= 0)
1120             c = 0;
1121         else
1122             c = b / a;
1123
1124         r->values[i] = pa_sw_volume_from_linear(c);
1125     }
1126
1127     return r;
1128 }