code.delx.au - pulseaudio/blob - src/modules/module-alsa-sink.c

   1 /* $Id$ */
   2
   3 /***
   4   This file is part of polypaudio.
   5
   6   polypaudio is free software; you can redistribute it and/or modify
   7   it under the terms of the GNU Lesser General Public License as published
   8   by the Free Software Foundation; either version 2 of the License,
   9   or (at your option) any later version.
  10
  11   polypaudio is distributed in the hope that it will be useful, but
  12   WITHOUT ANY WARRANTY; without even the implied warranty of
  13   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  14   General Public License for more details.
  15
  16   You should have received a copy of the GNU Lesser General Public License
  17   along with polypaudio; if not, write to the Free Software
  18   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
  19   USA.
  20 ***/
  21
  22 #ifdef HAVE_CONFIG_H
  23 #include <config.h>
  24 #endif
  25
  26 #include <assert.h>
  27 #include <stdio.h>
  28
  29 #ifdef HAVE_SYS_POLL_H
  30 #include <sys/poll.h>
  31 #else
  32 #include "poll.h"
  33 #endif
  34
  35 #include <asoundlib.h>
  36
  37 #include <polypcore/core.h>
  38 #include <polypcore/module.h>
  39 #include <polypcore/memchunk.h>
  40 #include <polypcore/sink.h>
  41 #include <polypcore/modargs.h>
  42 #include <polypcore/util.h>
  43 #include <polypcore/sample-util.h>
  44 #include <polypcore/xmalloc.h>
  45 #include <polypcore/log.h>
  46
  47 #include "alsa-util.h"
  48 #include "module-alsa-sink-symdef.h"
  49
  50 PA_MODULE_AUTHOR("Lennart Poettering")
  51 PA_MODULE_DESCRIPTION("ALSA Sink")
  52 PA_MODULE_VERSION(PACKAGE_VERSION)
  53 PA_MODULE_USAGE("sink_name=<name for the sink> device=<ALSA device> format=<sample format> channels=<number of channels> rate=<sample rate> fragments=<number of fragments> fragment_size=<fragment size>")
  54
  55 struct userdata {
  56     snd_pcm_t *pcm_handle;
  57     snd_mixer_t *mixer_handle;
  58     snd_mixer_elem_t *mixer_elem;
  59     pa_sink *sink;
  60     struct pa_alsa_fdlist *pcm_fdl;
  61     struct pa_alsa_fdlist *mixer_fdl;
  62     long hw_volume_max, hw_volume_min;
  63
  64     size_t frame_size, fragment_size;
  65     pa_memchunk memchunk, silence;
  66     pa_module *module;
  67 };
  68
  69 static const char* const valid_modargs[] = {
  70     "device",
  71     "sink_name",
  72     "format",
  73     "channels",
  74     "rate",
  75     "fragments",
  76     "fragment_size",
  77     NULL
  78 };
  79
  80 #define DEFAULT_SINK_NAME "alsa_output"
  81 #define DEFAULT_DEVICE "default"
  82
  83 static void update_usage(struct userdata *u) {
  84    pa_module_set_used(u->module,
  85                       (u->sink ? pa_idxset_size(u->sink->inputs) : 0) +
  86                       (u->sink ? pa_idxset_size(u->sink->monitor_source->outputs) : 0));
  87 }
  88
  89 static void xrun_recovery(struct userdata *u) {
  90     assert(u);
  91
  92     pa_log(__FILE__": *** ALSA-XRUN (playback) ***");
  93
  94     if (snd_pcm_prepare(u->pcm_handle) < 0)
  95         pa_log(__FILE__": snd_pcm_prepare() failed");
  96 }
  97
  98 static void do_write(struct userdata *u) {
  99     assert(u);
 100
 101     update_usage(u);
 102
 103     for (;;) {
 104         pa_memchunk *memchunk = NULL;
 105         snd_pcm_sframes_t frames;
 106
 107         if (u->memchunk.memblock)
 108             memchunk = &u->memchunk;
 109         else {
 110             if (pa_sink_render(u->sink, u->fragment_size, &u->memchunk) < 0)
 111                 memchunk = &u->silence;
 112             else
 113                 memchunk = &u->memchunk;
 114         }
 115
 116         assert(memchunk->memblock && memchunk->memblock->data && memchunk->length && memchunk->memblock->length && (memchunk->length % u->frame_size) == 0);
 117
 118         if ((frames = snd_pcm_writei(u->pcm_handle, (uint8_t*) memchunk->memblock->data + memchunk->index, memchunk->length / u->frame_size)) < 0) {
 119             if (frames == -EAGAIN)
 120                 return;
 121
 122             if (frames == -EPIPE) {
 123                 xrun_recovery(u);
 124                 continue;
 125             }
 126
 127             pa_log(__FILE__": snd_pcm_writei() failed: %s", snd_strerror(frames));
 128             return;
 129         }
 130
 131         if (memchunk == &u->memchunk) {
 132             size_t l = frames * u->frame_size;
 133             memchunk->index += l;
 134             memchunk->length -= l;
 135
 136             if (memchunk->length == 0) {
 137                 pa_memblock_unref(memchunk->memblock);
 138                 memchunk->memblock = NULL;
 139                 memchunk->index = memchunk->length = 0;
 140             }
 141         }
 142
 143         break;
 144     }
 145 }
 146
 147 static void fdl_callback(void *userdata) {
 148     struct userdata *u = userdata;
 149     assert(u);
 150
 151     if (snd_pcm_state(u->pcm_handle) == SND_PCM_STATE_XRUN)
 152         xrun_recovery(u);
 153
 154     do_write(u);
 155 }
 156
 157 static int mixer_callback(snd_mixer_elem_t *elem, unsigned int mask) {
 158     struct userdata *u = snd_mixer_elem_get_callback_private(elem);
 159
 160     assert(u && u->mixer_handle);
 161
 162     if (mask & SND_CTL_EVENT_MASK_VALUE) {
 163         if (u->sink->get_hw_volume)
 164             u->sink->get_hw_volume(u->sink);
 165         if (u->sink->get_hw_mute)
 166             u->sink->get_hw_mute(u->sink);
 167         pa_subscription_post(u->sink->core,
 168             PA_SUBSCRIPTION_EVENT_SINK|PA_SUBSCRIPTION_EVENT_CHANGE,
 169             u->sink->index);
 170     }
 171
 172     return 0;
 173 }
 174
 175 static pa_usec_t sink_get_latency_cb(pa_sink *s) {
 176     pa_usec_t r = 0;
 177     struct userdata *u = s->userdata;
 178     snd_pcm_sframes_t frames;
 179     int err;
 180
 181     assert(s && u && u->sink);
 182
 183     if ((err = snd_pcm_delay(u->pcm_handle, &frames)) < 0) {
 184         pa_log(__FILE__": failed to get delay: %s", snd_strerror(err));
 185         s->get_latency = NULL;
 186         return 0;
 187     }
 188
 189     if (frames < 0)
 190         frames = 0;
 191
 192     r += pa_bytes_to_usec(frames * u->frame_size, &s->sample_spec);
 193
 194     if (u->memchunk.memblock)
 195         r += pa_bytes_to_usec(u->memchunk.length, &s->sample_spec);
 196
 197     return r;
 198 }
 199
 200 static int sink_get_hw_volume_cb(pa_sink *s) {
 201     struct userdata *u = s->userdata;
 202     long vol;
 203     int err;
 204
 205     assert(u && u->mixer_elem);
 206
 207     if (snd_mixer_selem_has_playback_volume_joined(u->mixer_elem)) {
 208         err = snd_mixer_selem_get_playback_volume(u->mixer_elem, 0, &vol);
 209         if (err < 0)
 210             goto fail;
 211         pa_cvolume_set(&s->hw_volume, s->hw_volume.channels,
 212             (vol - u->hw_volume_min) * PA_VOLUME_NORM / (u->hw_volume_max - u->hw_volume_min));
 213     } else {
 214         int i;
 215
 216         for (i = 0;i < s->hw_volume.channels;i++) {
 217             err = snd_mixer_selem_get_playback_volume(u->mixer_elem, i, &vol);
 218             if (err < 0)
 219                 goto fail;
 220             s->hw_volume.values[i] =
 221                 (vol - u->hw_volume_min) * PA_VOLUME_NORM / (u->hw_volume_max - u->hw_volume_min);
 222         }
 223     }
 224
 225     return 0;
 226
 227 fail:
 228     pa_log_error(__FILE__": Unable to read volume: %s", snd_strerror(err));
 229     s->get_hw_volume = NULL;
 230     s->set_hw_volume = NULL;
 231     return -1;
 232 }
 233
 234 static int sink_set_hw_volume_cb(pa_sink *s) {
 235     struct userdata *u = s->userdata;
 236     int err;
 237     pa_volume_t vol;
 238
 239     assert(u && u->mixer_elem);
 240
 241     if (snd_mixer_selem_has_playback_volume_joined(u->mixer_elem)) {
 242         vol = pa_cvolume_avg(&s->hw_volume) * (u->hw_volume_max - u->hw_volume_min) /
 243             PA_VOLUME_NORM + u->hw_volume_min;
 244         err = snd_mixer_selem_set_playback_volume_all(u->mixer_elem, vol);
 245         if (err < 0)
 246             goto fail;
 247     } else {
 248         int i;
 249
 250         for (i = 0;i < s->hw_volume.channels;i++) {
 251             vol = s->hw_volume.values[i] * (u->hw_volume_max - u->hw_volume_min) /
 252                 PA_VOLUME_NORM + u->hw_volume_min;
 253             err = snd_mixer_selem_set_playback_volume(u->mixer_elem, i, vol);
 254             if (err < 0)
 255                 goto fail;
 256         }
 257     }
 258
 259     return 0;
 260
 261 fail:
 262     pa_log_error(__FILE__": Unable to set volume: %s", snd_strerror(err));
 263     s->get_hw_volume = NULL;
 264     s->set_hw_volume = NULL;
 265     return -1;
 266 }
 267
 268 static int sink_get_hw_mute_cb(pa_sink *s) {
 269     struct userdata *u = s->userdata;
 270     int err, sw;
 271
 272     assert(u && u->mixer_elem);
 273
 274     err = snd_mixer_selem_get_playback_switch(u->mixer_elem, 0, &sw);
 275     if (err) {
 276         pa_log_error(__FILE__": Unable to get switch: %s", snd_strerror(err));
 277         s->get_hw_mute = NULL;
 278         s->set_hw_mute = NULL;
 279         return -1;
 280     }
 281
 282     s->hw_muted = !sw;
 283
 284     return 0;
 285 }
 286
 287 static int sink_set_hw_mute_cb(pa_sink *s) {
 288     struct userdata *u = s->userdata;
 289     int err;
 290
 291     assert(u && u->mixer_elem);
 292
 293     err = snd_mixer_selem_set_playback_switch_all(u->mixer_elem, !s->hw_muted);
 294     if (err) {
 295         pa_log_error(__FILE__": Unable to set switch: %s", snd_strerror(err));
 296         s->get_hw_mute = NULL;
 297         s->set_hw_mute = NULL;
 298         return -1;
 299     }
 300
 301     return 0;
 302 }
 303
 304 int pa__init(pa_core *c, pa_module*m) {
 305     pa_modargs *ma = NULL;
 306     int ret = -1;
 307     struct userdata *u = NULL;
 308     const char *dev;
 309     pa_sample_spec ss;
 310     uint32_t periods, fragsize;
 311     snd_pcm_uframes_t period_size;
 312     size_t frame_size;
 313     snd_pcm_info_t *pcm_info = NULL;
 314     int err;
 315
 316     if (!(ma = pa_modargs_new(m->argument, valid_modargs))) {
 317         pa_log(__FILE__": failed to parse module arguments");
 318         goto fail;
 319     }
 320
 321     ss = c->default_sample_spec;
 322     if (pa_modargs_get_sample_spec(ma, &ss) < 0) {
 323         pa_log(__FILE__": failed to parse sample specification");
 324         goto fail;
 325     }
 326     frame_size = pa_frame_size(&ss);
 327
 328     periods = 8;
 329     fragsize = 1024;
 330     if (pa_modargs_get_value_u32(ma, "fragments", &periods) < 0 || pa_modargs_get_value_u32(ma, "fragment_size", &fragsize) < 0) {
 331         pa_log(__FILE__": failed to parse buffer metrics");
 332         goto fail;
 333     }
 334     period_size = fragsize;
 335
 336     u = pa_xmalloc0(sizeof(struct userdata));
 337     m->userdata = u;
 338     u->module = m;
 339
 340     snd_config_update_free_global();
 341     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) {
 342         pa_log(__FILE__": Error opening PCM device %s: %s", dev, snd_strerror(err));
 343         goto fail;
 344     }
 345
 346     if ((err = snd_pcm_info_malloc(&pcm_info)) < 0 ||
 347         (err = snd_pcm_info(u->pcm_handle, pcm_info)) < 0) {
 348         pa_log(__FILE__": Error fetching PCM info: %s", snd_strerror(err));
 349         goto fail;
 350     }
 351
 352     if ((err = pa_alsa_set_hw_params(u->pcm_handle, &ss, &periods, &period_size)) < 0) {
 353         pa_log(__FILE__": Failed to set hardware parameters: %s", snd_strerror(err));
 354         goto fail;
 355     }
 356
 357     if ((err = snd_mixer_open(&u->mixer_handle, 0)) < 0) {
 358         pa_log(__FILE__": Error opening mixer: %s", snd_strerror(err));
 359         goto fail;
 360     }
 361
 362     if ((pa_alsa_prepare_mixer(u->mixer_handle, dev) < 0) ||
 363         !(u->mixer_elem = pa_alsa_find_elem(u->mixer_handle, "PCM"))) {
 364         snd_mixer_close(u->mixer_handle);
 365         u->mixer_handle = NULL;
 366     }
 367
 368     u->sink = pa_sink_new(c, __FILE__, pa_modargs_get_value(ma, "sink_name", DEFAULT_SINK_NAME), 0, &ss, NULL);
 369     assert(u->sink);
 370
 371     u->sink->get_latency = sink_get_latency_cb;
 372     if (u->mixer_handle) {
 373         assert(u->mixer_elem);
 374         if (snd_mixer_selem_has_playback_volume(u->mixer_elem)) {
 375             u->sink->get_hw_volume = sink_get_hw_volume_cb;
 376             u->sink->set_hw_volume = sink_set_hw_volume_cb;
 377             snd_mixer_selem_get_playback_volume_range(
 378                 u->mixer_elem, &u->hw_volume_min, &u->hw_volume_max);
 379         }
 380         if (snd_mixer_selem_has_playback_switch(u->mixer_elem)) {
 381             u->sink->get_hw_mute = sink_get_hw_mute_cb;
 382             u->sink->set_hw_mute = sink_set_hw_mute_cb;
 383         }
 384     }
 385     u->sink->userdata = u;
 386     pa_sink_set_owner(u->sink, m);
 387     u->sink->description = pa_sprintf_malloc("Advanced Linux Sound Architecture PCM on '%s' (%s)", dev, snd_pcm_info_get_name(pcm_info));
 388
 389     u->pcm_fdl = pa_alsa_fdlist_new();
 390     assert(u->pcm_fdl);
 391     if (pa_alsa_fdlist_init_pcm(u->pcm_fdl, u->pcm_handle, c->mainloop, fdl_callback, u) < 0) {
 392         pa_log(__FILE__": failed to initialise file descriptor monitoring");
 393         goto fail;
 394     }
 395
 396     if (u->mixer_handle) {
 397         u->mixer_fdl = pa_alsa_fdlist_new();
 398         assert(u->mixer_fdl);
 399         if (pa_alsa_fdlist_init_mixer(u->mixer_fdl, u->mixer_handle, c->mainloop) < 0) {
 400             pa_log(__FILE__": failed to initialise file descriptor monitoring");
 401             goto fail;
 402         }
 403         snd_mixer_elem_set_callback(u->mixer_elem, mixer_callback);
 404         snd_mixer_elem_set_callback_private(u->mixer_elem, u);
 405     }
 406
 407     u->frame_size = frame_size;
 408     u->fragment_size = period_size;
 409
 410     pa_log_info(__FILE__": using %u fragments of size %lu bytes.", periods, (long unsigned)u->fragment_size);
 411
 412     u->silence.memblock = pa_memblock_new(u->silence.length = u->fragment_size, c->memblock_stat);
 413     assert(u->silence.memblock);
 414     pa_silence_memblock(u->silence.memblock, &ss);
 415     u->silence.index = 0;
 416
 417     u->memchunk.memblock = NULL;
 418     u->memchunk.index = u->memchunk.length = 0;
 419
 420     ret = 0;
 421
 422     /* Get initial mixer settings */
 423     if (u->sink->get_hw_volume)
 424         u->sink->get_hw_volume(u->sink);
 425     if (u->sink->get_hw_mute)
 426         u->sink->get_hw_mute(u->sink);
 427
 428 finish:
 429      if (ma)
 430          pa_modargs_free(ma);
 431
 432     if (pcm_info)
 433         snd_pcm_info_free(pcm_info);
 434
 435     return ret;
 436
 437 fail:
 438
 439     if (u)
 440         pa__done(c, m);
 441
 442     goto finish;
 443 }
 444
 445 void pa__done(pa_core *c, pa_module*m) {
 446     struct userdata *u;
 447     assert(c && m);
 448
 449     if (!(u = m->userdata))
 450         return;
 451
 452     if (u->sink) {
 453         pa_sink_disconnect(u->sink);
 454         pa_sink_unref(u->sink);
 455     }
 456
 457     if (u->pcm_fdl)
 458         pa_alsa_fdlist_free(u->pcm_fdl);
 459     if (u->mixer_fdl)
 460         pa_alsa_fdlist_free(u->mixer_fdl);
 461
 462     if (u->mixer_handle)
 463         snd_mixer_close(u->mixer_handle);
 464
 465     if (u->pcm_handle) {
 466         snd_pcm_drop(u->pcm_handle);
 467         snd_pcm_close(u->pcm_handle);
 468     }
 469
 470     if (u->memchunk.memblock)
 471         pa_memblock_unref(u->memchunk.memblock);
 472     if (u->silence.memblock)
 473         pa_memblock_unref(u->silence.memblock);
 474
 475     pa_xfree(u);
 476 }
 477