code.delx.au - pulseaudio/blob - src/modules/module-alsa-source.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-error.h>
  43 #include <pulsecore/core.h>
  44 #include <pulsecore/module.h>
  45 #include <pulsecore/memchunk.h>
  46 #include <pulsecore/sink.h>
  47 #include <pulsecore/modargs.h>
  48 #include <pulsecore/core-util.h>
  49 #include <pulsecore/sample-util.h>
  50 #include <pulsecore/log.h>
  51 #include <pulsecore/macro.h>
  52 #include <pulsecore/thread.h>
  53 #include <pulsecore/core-error.h>
  54
  55 #include "alsa-util.h"
  56 #include "module-alsa-source-symdef.h"
  57
  58 PA_MODULE_AUTHOR("Lennart Poettering")
  59 PA_MODULE_DESCRIPTION("ALSA Source")
  60 PA_MODULE_VERSION(PACKAGE_VERSION)
  61 PA_MODULE_USAGE(
  62         "source_name=<name for the source> "
  63         "device=<ALSA device> "
  64         "format=<sample format> "
  65         "channels=<number of channels> "
  66         "rate=<sample rate> "
  67         "fragments=<number of fragments> "
  68         "fragment_size=<fragment size> "
  69         "channel_map=<channel map> "
  70         "mmap=<enable memory mapping?>")
  71
  72 #define DEFAULT_DEVICE "default"
  73 #define DEFAULT_NFRAGS 4
  74 #define DEFAULT_FRAGSIZE_MSEC 25
  75
  76 struct userdata {
  77     pa_core *core;
  78     pa_module *module;
  79     pa_source *source;
  80     pa_thread *thread;
  81     pa_asyncmsgq *asyncmsgq;
  82
  83     snd_pcm_t *pcm_handle;
  84
  85     pa_alsa_fdlist *mixer_fdl;
  86     snd_mixer_t *mixer_handle;
  87     snd_mixer_elem_t *mixer_elem;
  88     long hw_volume_max, hw_volume_min;
  89
  90     size_t frame_size, fragment_size, hwbuf_size;
  91     unsigned nfragments;
  92
  93     char *device_name;
  94
  95     int use_mmap;
  96 };
  97
  98 static const char* const valid_modargs[] = {
  99     "device",
 100     "source_name",
 101     "channels",
 102     "rate",
 103     "format",
 104     "fragments",
 105     "fragment_size",
 106     "channel_map",
 107     "mmap",
 108     NULL
 109 };
 110
 111 static int mmap_read(struct userdata *u) {
 112     snd_pcm_sframes_t n;
 113     int err;
 114     const snd_pcm_channel_area_t *areas;
 115     snd_pcm_uframes_t offset, frames;
 116     int work_done = 0;
 117
 118     pa_assert(u);
 119     pa_assert(u->source);
 120
 121     for (;;) {
 122         pa_memchunk chunk;
 123         void *p;
 124
 125         if ((n = snd_pcm_avail_update(u->pcm_handle)) < 0) {
 126
 127             if (n == -EPIPE)
 128                 pa_log_debug("snd_pcm_avail_update: Buffer underrun!");
 129
 130             if ((err = snd_pcm_recover(u->pcm_handle, n, 1)) == 0)
 131                 continue;
 132
 133             if (err == -EAGAIN)
 134                 return work_done;
 135
 136             pa_log("snd_pcm_avail_update: %s", snd_strerror(n));
 137             return -1;
 138         }
 139
 140 /*         pa_log("Got request for %i samples", (int) n); */
 141
 142         if (n <= 0)
 143             return work_done;
 144
 145         frames = n;
 146
 147         if ((err = snd_pcm_mmap_begin(u->pcm_handle, &areas, &offset, &frames)) < 0) {
 148
 149             if (err == -EPIPE)
 150                 pa_log_debug("snd_pcm_mmap_begin: Buffer underrun!");
 151
 152             if ((err = snd_pcm_recover(u->pcm_handle, err, 1)) == 0)
 153                 continue;
 154
 155             if (err == -EAGAIN)
 156                 return work_done;
 157
 158             pa_log("Failed to write data to DSP: %s", snd_strerror(err));
 159             return -1;
 160         }
 161
 162         /* Check these are multiples of 8 bit */
 163         pa_assert((areas[0].first & 7) == 0);
 164         pa_assert((areas[0].step & 7)== 0);
 165
 166         /* We assume a single interleaved memory buffer */
 167         pa_assert((areas[0].first >> 3) == 0);
 168         pa_assert((areas[0].step >> 3) == u->frame_size);
 169
 170         p = (uint8_t*) areas[0].addr + (offset * u->frame_size);
 171
 172         chunk.memblock = pa_memblock_new_fixed(u->core->mempool, p, frames * u->frame_size, 1);
 173         chunk.length = pa_memblock_get_length(chunk.memblock);
 174         chunk.index = 0;
 175
 176         pa_source_post(u->source, &chunk);
 177
 178         /* FIXME: Maybe we can do something to keep this memory block
 179          * a little bit longer around? */
 180         pa_memblock_unref_fixed(chunk.memblock);
 181
 182         if ((err = snd_pcm_mmap_commit(u->pcm_handle, offset, frames)) < 0) {
 183
 184             if (err == -EPIPE)
 185                 pa_log_debug("snd_pcm_mmap_commit: Buffer underrun!");
 186
 187             if ((err = snd_pcm_recover(u->pcm_handle, err, 1)) == 0)
 188                 continue;
 189
 190             if (err == -EAGAIN)
 191                 return work_done;
 192
 193             pa_log("Failed to write data to DSP: %s", snd_strerror(err));
 194             return -1;
 195         }
 196
 197         work_done = 1;
 198
 199 /*         pa_log("wrote %i samples", (int) frames); */
 200     }
 201 }
 202
 203 static pa_usec_t source_get_latency(struct userdata *u) {
 204     pa_usec_t r = 0;
 205     snd_pcm_sframes_t frames = 0;
 206     int err;
 207
 208     pa_assert(u);
 209
 210     snd_pcm_avail_update(u->pcm_handle);
 211
 212     if ((err = snd_pcm_delay(u->pcm_handle, &frames)) < 0) {
 213         pa_log("Failed to get delay: %s", snd_strerror(err));
 214         return 0;
 215     }
 216
 217     if (frames > 0)
 218         r = pa_bytes_to_usec(frames * u->frame_size, &u->source->sample_spec);
 219
 220     return r;
 221 }
 222
 223 static int suspend(struct userdata *u) {
 224     pa_assert(u);
 225     pa_assert(u->pcm_handle);
 226
 227     /* Let's suspend */
 228     snd_pcm_close(u->pcm_handle);
 229     u->pcm_handle = NULL;
 230
 231     pa_log_debug("Device suspended...");
 232
 233     return 0;
 234 }
 235
 236 static int unsuspend(struct userdata *u) {
 237     pa_sample_spec ss;
 238     int err, b;
 239     unsigned nfrags;
 240     snd_pcm_uframes_t period_size;
 241
 242     pa_assert(u);
 243     pa_assert(!u->pcm_handle);
 244
 245     pa_log_debug("Trying resume...");
 246
 247     snd_config_update_free_global();
 248     if ((err = snd_pcm_open(&u->pcm_handle, u->device_name, SND_PCM_STREAM_CAPTURE, SND_PCM_NONBLOCK)) < 0) {
 249         pa_log("Error opening PCM device %s: %s", u->device_name, snd_strerror(err));
 250         goto fail;
 251     }
 252
 253     ss = u->source->sample_spec;
 254     nfrags = u->nfragments;
 255     period_size = u->fragment_size / u->frame_size;
 256     b = u->use_mmap;
 257
 258     if ((err = pa_alsa_set_hw_params(u->pcm_handle, &ss, &nfrags, &period_size, &b)) < 0) {
 259         pa_log("Failed to set hardware parameters: %s", snd_strerror(err));
 260         goto fail;
 261     }
 262
 263     if (b != u->use_mmap) {
 264         pa_log_warn("Resume failed, couldn't get original access mode.");
 265         goto fail;
 266     }
 267
 268     if (!pa_sample_spec_equal(&ss, &u->source->sample_spec)) {
 269         pa_log_warn("Resume failed, couldn't restore original sample settings.");
 270         goto fail;
 271     }
 272
 273     if (nfrags != u->nfragments || period_size*u->frame_size != u->fragment_size) {
 274         pa_log_warn("Resume failed, couldn't restore original fragment settings.");
 275         goto fail;
 276     }
 277
 278     if ((err = pa_alsa_set_sw_params(u->pcm_handle)) < 0) {
 279         pa_log("Failed to set software parameters: %s", snd_strerror(err));
 280         goto fail;
 281     }
 282
 283     snd_pcm_start(u->pcm_handle);
 284
 285     /* FIXME: We need to reload the volume somehow */
 286
 287     pa_log_debug("Resumed successfully...");
 288
 289     return 0;
 290
 291 fail:
 292     snd_pcm_close(u->pcm_handle);
 293     u->pcm_handle = NULL;
 294
 295     return -1;
 296 }
 297
 298 static int source_process_msg(pa_msgobject *o, int code, void *data, int64_t offset, pa_memchunk *chunk) {
 299     struct userdata *u = PA_SOURCE(o)->userdata;
 300
 301     switch (code) {
 302
 303         case PA_SOURCE_MESSAGE_GET_LATENCY: {
 304             pa_usec_t r = 0;
 305
 306             if (u->pcm_handle)
 307                 r = source_get_latency(u);
 308
 309             *((pa_usec_t*) data) = r;
 310
 311             break;
 312         }
 313
 314         case PA_SOURCE_MESSAGE_SET_STATE:
 315
 316             switch ((pa_source_state_t) PA_PTR_TO_UINT(data)) {
 317
 318                 case PA_SOURCE_SUSPENDED:
 319                     pa_assert(PA_SOURCE_OPENED(u->source->thread_info.state));
 320
 321                     if (suspend(u) < 0)
 322                         return -1;
 323
 324                     break;
 325
 326                 case PA_SOURCE_IDLE:
 327                 case PA_SOURCE_RUNNING:
 328
 329                     if (u->source->thread_info.state == PA_SOURCE_SUSPENDED) {
 330                         if (unsuspend(u) < 0)
 331                             return -1;
 332                     }
 333
 334                     break;
 335
 336                 case PA_SOURCE_DISCONNECTED:
 337                     ;
 338             }
 339
 340             break;
 341     }
 342
 343     return pa_source_process_msg(o, code, data, offset, chunk);
 344 }
 345
 346 static int mixer_callback(snd_mixer_elem_t *elem, unsigned int mask) {
 347     struct userdata *u = snd_mixer_elem_get_callback_private(elem);
 348
 349     pa_assert(u);
 350     pa_assert(u->mixer_handle);
 351
 352     if (mask == SND_CTL_EVENT_MASK_REMOVE)
 353         return 0;
 354
 355     if (mask & SND_CTL_EVENT_MASK_VALUE) {
 356         pa_source_get_volume(u->source);
 357         pa_source_get_mute(u->source);
 358     }
 359
 360     return 0;
 361 }
 362
 363 static int source_get_volume_cb(pa_source *s) {
 364     struct userdata *u = s->userdata;
 365     int err;
 366     int i;
 367
 368     pa_assert(u);
 369     pa_assert(u->mixer_elem);
 370
 371     for (i = 0; i < s->sample_spec.channels; i++) {
 372         long set_vol, vol;
 373
 374         pa_assert(snd_mixer_selem_has_capture_channel(u->mixer_elem, i));
 375
 376         if ((err = snd_mixer_selem_get_capture_volume(u->mixer_elem, i, &vol)) < 0)
 377             goto fail;
 378
 379         set_vol = (long) roundf(((float) s->volume.values[i] * (u->hw_volume_max - u->hw_volume_min)) / PA_VOLUME_NORM) + u->hw_volume_min;
 380
 381         /* Try to avoid superfluous volume changes */
 382         if (set_vol != vol)
 383             s->volume.values[i] = (pa_volume_t) roundf(((float) (vol - u->hw_volume_min) * PA_VOLUME_NORM) / (u->hw_volume_max - u->hw_volume_min));
 384     }
 385
 386     return 0;
 387
 388 fail:
 389     pa_log_error("Unable to read volume: %s", snd_strerror(err));
 390
 391     s->get_volume = NULL;
 392     s->set_volume = NULL;
 393     return -1;
 394 }
 395
 396 static int source_set_volume_cb(pa_source *s) {
 397     struct userdata *u = s->userdata;
 398     int err;
 399     int i;
 400
 401     pa_assert(u);
 402     pa_assert(u->mixer_elem);
 403
 404     for (i = 0; i < s->sample_spec.channels; i++) {
 405         long alsa_vol;
 406         pa_volume_t vol;
 407
 408         pa_assert(snd_mixer_selem_has_capture_channel(u->mixer_elem, i));
 409
 410         vol = s->volume.values[i];
 411
 412         if (vol > PA_VOLUME_NORM)
 413             vol = PA_VOLUME_NORM;
 414
 415         alsa_vol = (long) roundf(((float) vol * (u->hw_volume_max - u->hw_volume_min)) / PA_VOLUME_NORM) + u->hw_volume_min;
 416
 417         if ((err = snd_mixer_selem_set_capture_volume(u->mixer_elem, i, alsa_vol)) < 0)
 418             goto fail;
 419     }
 420
 421     return 0;
 422
 423 fail:
 424     pa_log_error("Unable to set volume: %s", snd_strerror(err));
 425
 426     s->get_volume = NULL;
 427     s->set_volume = NULL;
 428     return -1;
 429 }
 430
 431 static int source_get_mute_cb(pa_source *s) {
 432     struct userdata *u = s->userdata;
 433     int err, sw;
 434
 435     pa_assert(u);
 436     pa_assert(u->mixer_elem);
 437
 438     if ((err = snd_mixer_selem_get_capture_switch(u->mixer_elem, 0, &sw)) < 0) {
 439         pa_log_error("Unable to get switch: %s", snd_strerror(err));
 440
 441         s->get_mute = NULL;
 442         s->set_mute = NULL;
 443         return -1;
 444     }
 445
 446     s->muted = !sw;
 447
 448     return 0;
 449 }
 450
 451 static int source_set_mute_cb(pa_source *s) {
 452     struct userdata *u = s->userdata;
 453     int err;
 454
 455     pa_assert(u);
 456     pa_assert(u->mixer_elem);
 457
 458     if ((err = snd_mixer_selem_set_capture_switch_all(u->mixer_elem, !s->muted)) < 0) {
 459         pa_log_error("Unable to set switch: %s", snd_strerror(err));
 460
 461         s->get_mute = NULL;
 462         s->set_mute = NULL;
 463         return -1;
 464     }
 465
 466     return 0;
 467 }
 468
 469 static void thread_func(void *userdata) {
 470     enum {
 471         POLLFD_ASYNCQ,
 472         POLLFD_ALSA_BASE
 473     };
 474
 475     struct userdata *u = userdata;
 476     struct pollfd *pollfd = NULL;
 477     int n_alsa_fds, err;
 478     unsigned short revents = 0;
 479     snd_pcm_status_t *status;
 480
 481     pa_assert(u);
 482     snd_pcm_status_alloca(&status);
 483
 484     pa_log_debug("Thread starting up");
 485
 486     if ((n_alsa_fds = snd_pcm_poll_descriptors_count(u->pcm_handle)) < 0) {
 487         pa_log("snd_pcm_poll_descriptors_count() failed: %s", snd_strerror(n_alsa_fds));
 488         goto fail;
 489     }
 490
 491     pollfd = pa_xnew0(struct pollfd, POLLFD_ALSA_BASE + n_alsa_fds);
 492
 493     pollfd[POLLFD_ASYNCQ].fd = pa_asyncmsgq_get_fd(u->asyncmsgq);
 494     pollfd[POLLFD_ASYNCQ].events = POLLIN;
 495
 496     if ((err = snd_pcm_poll_descriptors(u->pcm_handle, pollfd+POLLFD_ALSA_BASE, n_alsa_fds)) < 0) {
 497         pa_log("snd_pcm_poll_descriptors() failed: %s", snd_strerror(err));
 498         goto fail;
 499     }
 500
 501     for (;;) {
 502         pa_msgobject *object;
 503         int code;
 504         void *data;
 505         int r;
 506         int64_t offset;
 507         pa_memchunk chunk;
 508
 509 /*         pa_log("loop");     */
 510
 511         /* Check whether there is a message for us to process */
 512         if (pa_asyncmsgq_get(u->asyncmsgq, &object, &code, &data, &offset, &chunk, 0) == 0) {
 513             int ret;
 514
 515 /*             pa_log("processing msg"); */
 516
 517             if (!object && code == PA_MESSAGE_SHUTDOWN) {
 518                 pa_asyncmsgq_done(u->asyncmsgq, 0);
 519                 goto finish;
 520             }
 521
 522             ret = pa_asyncmsgq_dispatch(object, code, data, offset, &chunk);
 523             pa_asyncmsgq_done(u->asyncmsgq, ret);
 524             continue;
 525         }
 526
 527 /*         pa_log("loop2"); */
 528
 529         /* Render some data and write it to the dsp */
 530
 531         if (PA_SOURCE_OPENED(u->source->thread_info.state) && (revents & POLLIN)) {
 532             int work_done = 0;
 533             pa_assert(u->pcm_handle);
 534
 535             if (u->use_mmap) {
 536
 537                 if ((work_done = mmap_read(u)) < 0)
 538                     goto fail;
 539
 540             } else {
 541
 542                 for (;;) {
 543                     void *p;
 544                     snd_pcm_sframes_t t;
 545                     ssize_t l;
 546
 547                     if ((err = snd_pcm_status(u->pcm_handle, status)) < 0) {
 548                         pa_log("Failed to query DSP status data: %s", snd_strerror(t));
 549                         goto fail;
 550                     }
 551
 552                     if (snd_pcm_status_get_avail_max(status)*u->frame_size >= u->hwbuf_size)
 553                         pa_log_debug("Buffer overrun!");
 554
 555                     l = snd_pcm_status_get_avail(status) * u->frame_size;
 556
 557                     if (l <= 0)
 558                         break;
 559
 560                     chunk.memblock = pa_memblock_new(u->core->mempool, l);
 561
 562                     p = pa_memblock_acquire(chunk.memblock);
 563                     t = snd_pcm_readi(u->pcm_handle, (uint8_t*) p, l / u->frame_size);
 564                     pa_memblock_release(chunk.memblock);
 565
 566 /*                     pa_log("wrote %i bytes of %u (%u)", t*u->frame_size, u->memchunk.length, l);   */
 567
 568                     pa_assert(t != 0);
 569
 570                     if (t < 0) {
 571                         pa_memblock_unref(chunk.memblock);
 572
 573                         if ((t = snd_pcm_recover(u->pcm_handle, t, 1)) == 0)
 574                             continue;
 575
 576                         if (t == -EAGAIN) {
 577                             pa_log_debug("EAGAIN");
 578                             break;
 579                         } else {
 580                             pa_log("Failed to read data from DSP: %s", snd_strerror(t));
 581                             goto fail;
 582                         }
 583
 584                     }
 585
 586                     chunk.index = 0;
 587                     chunk.length = t * u->frame_size;
 588
 589                     pa_source_post(u->source, &chunk);
 590                     pa_memblock_unref(chunk.memblock);
 591
 592                     work_done = 1;
 593
 594                     if (t * u->frame_size >= (unsigned) l)
 595                         break;
 596                 }
 597             }
 598
 599             revents &= ~POLLIN;
 600
 601             if (work_done)
 602                 continue;
 603         }
 604
 605         /* Hmm, nothing to do. Let's sleep */
 606         if (pa_asyncmsgq_before_poll(u->asyncmsgq) < 0)
 607             continue;
 608
 609 /*         pa_log("polling for %i", POLLFD_ALSA_BASE + (PA_SOURCE_OPENED(u->source->thread_info.state) ? n_alsa_fds : 0));   */
 610         r = poll(pollfd, POLLFD_ALSA_BASE + (PA_SOURCE_OPENED(u->source->thread_info.state) ? n_alsa_fds : 0), -1);
 611         /*pa_log("polling got dsp=%i amq=%i (%i)", r > 0 ? pollfd[POLLFD_DSP].revents : 0, r > 0 ? pollfd[POLLFD_ASYNCQ].revents : 0, r); */
 612 /*         pa_log("poll end"); */
 613
 614         pa_asyncmsgq_after_poll(u->asyncmsgq);
 615
 616         if (r < 0) {
 617             if (errno == EINTR) {
 618                 pollfd[POLLFD_ASYNCQ].revents = 0;
 619                 revents = 0;
 620                 continue;
 621             }
 622
 623             pa_log("poll() failed: %s", pa_cstrerror(errno));
 624             goto fail;
 625         }
 626
 627         pa_assert(r > 0);
 628
 629         if (PA_SOURCE_OPENED(u->source->thread_info.state)) {
 630             if ((err = snd_pcm_poll_descriptors_revents(u->pcm_handle, pollfd + POLLFD_ALSA_BASE, n_alsa_fds, &revents)) < 0) {
 631                 pa_log("snd_pcm_poll_descriptors_revents() failed: %s", snd_strerror(err));
 632                 goto fail;
 633             }
 634
 635 /*             pa_log("got alsa event"); */
 636         } else
 637             revents = 0;
 638
 639         pa_assert((pollfd[POLLFD_ASYNCQ].revents & ~POLLIN) == 0);
 640     }
 641
 642 fail:
 643     /* We have to continue processing messages until we receive the
 644      * SHUTDOWN message */
 645     pa_asyncmsgq_post(u->core->asyncmsgq, PA_MSGOBJECT(u->core), PA_CORE_MESSAGE_UNLOAD_MODULE, u->module, 0, NULL, NULL);
 646     pa_asyncmsgq_wait_for(u->asyncmsgq, PA_MESSAGE_SHUTDOWN);
 647
 648 finish:
 649     pa_log_debug("Thread shutting down");
 650
 651     pa_xfree(pollfd);
 652 }
 653
 654
 655 int pa__init(pa_core *c, pa_module*m) {
 656
 657     pa_modargs *ma = NULL;
 658     int ret = -1;
 659     struct userdata *u = NULL;
 660     const char *dev;
 661     pa_sample_spec ss;
 662     pa_channel_map map;
 663     unsigned nfrags, frag_size;
 664     snd_pcm_uframes_t period_size;
 665     size_t frame_size;
 666     snd_pcm_info_t *pcm_info = NULL;
 667     int err;
 668     char *t;
 669     const char *name;
 670     char *name_buf = NULL;
 671     int namereg_fail;
 672     int use_mmap = 1, b;
 673
 674     pa_assert(c);
 675     pa_assert(m);
 676
 677     if (!(ma = pa_modargs_new(m->argument, valid_modargs))) {
 678         pa_log("Failed to parse module arguments");
 679         goto fail;
 680     }
 681
 682     ss = c->default_sample_spec;
 683     if (pa_modargs_get_sample_spec_and_channel_map(ma, &ss, &map, PA_CHANNEL_MAP_ALSA) < 0) {
 684         pa_log("Failed to parse sample specification");
 685         goto fail;
 686     }
 687
 688     frame_size = pa_frame_size(&ss);
 689
 690     /* Fix latency to 100ms */
 691     nfrags = DEFAULT_NFRAGS;
 692     frag_size = pa_usec_to_bytes(DEFAULT_FRAGSIZE_MSEC*1000, &ss);
 693     if (frag_size <= 0)
 694         frag_size = frame_size;
 695
 696     if (pa_modargs_get_value_u32(ma, "fragments", &nfrags) < 0 || pa_modargs_get_value_u32(ma, "fragment_size", &frag_size) < 0) {
 697         pa_log("Failed to parse buffer metrics");
 698         goto fail;
 699     }
 700     period_size = frag_size/frame_size;
 701
 702     if (pa_modargs_get_value_boolean(ma, "mmap", &use_mmap) < 0) {
 703         pa_log("Failed to parse mmap argument.");
 704         goto fail;
 705     }
 706
 707     u = pa_xnew0(struct userdata, 1);
 708     u->core = c;
 709     u->module = m;
 710     m->userdata = u;
 711     u->use_mmap = use_mmap;
 712     pa_assert_se(u->asyncmsgq = pa_asyncmsgq_new(0));
 713
 714     snd_config_update_free_global();
 715     if ((err = snd_pcm_open(&u->pcm_handle, dev = pa_modargs_get_value(ma, "device", DEFAULT_DEVICE), SND_PCM_STREAM_CAPTURE, SND_PCM_NONBLOCK)) < 0) {
 716         pa_log("Error opening PCM device %s: %s", dev, snd_strerror(err));
 717         goto fail;
 718     }
 719
 720     u->device_name = pa_xstrdup(dev);
 721
 722     if ((err = snd_pcm_info_malloc(&pcm_info)) < 0 ||
 723         (err = snd_pcm_info(u->pcm_handle, pcm_info)) < 0) {
 724         pa_log("Error fetching PCM info: %s", snd_strerror(err));
 725         goto fail;
 726     }
 727
 728     b = use_mmap;
 729     if ((err = pa_alsa_set_hw_params(u->pcm_handle, &ss, &nfrags, &period_size, &b)) < 0) {
 730         pa_log("Failed to set hardware parameters: %s", snd_strerror(err));
 731         goto fail;
 732     }
 733
 734     if (use_mmap && !b) {
 735         pa_log_info("Device doesn't support mmap(), falling back to UNIX read/write mode.");
 736         u->use_mmap = use_mmap = b;
 737     }
 738
 739     if (u->use_mmap)
 740         pa_log_info("Successfully enabled mmap() mode.");
 741
 742     if ((err = pa_alsa_set_sw_params(u->pcm_handle)) < 0) {
 743         pa_log("Failed to set software parameters: %s", snd_strerror(err));
 744         goto fail;
 745     }
 746
 747     /* ALSA might tweak the sample spec, so recalculate the frame size */
 748     frame_size = pa_frame_size(&ss);
 749
 750     if (ss.channels != map.channels)
 751         /* Seems ALSA didn't like the channel number, so let's fix the channel map */
 752         pa_channel_map_init_auto(&map, ss.channels, PA_CHANNEL_MAP_ALSA);
 753
 754     if ((err = snd_mixer_open(&u->mixer_handle, 0)) < 0)
 755         pa_log("Error opening mixer: %s", snd_strerror(err));
 756     else {
 757
 758         if ((pa_alsa_prepare_mixer(u->mixer_handle, dev) < 0) ||
 759             !(u->mixer_elem = pa_alsa_find_elem(u->mixer_handle, "Capture", NULL))) {
 760             snd_mixer_close(u->mixer_handle);
 761             u->mixer_handle = NULL;
 762         }
 763     }
 764
 765     if ((name = pa_modargs_get_value(ma, "source_name", NULL)))
 766         namereg_fail = 1;
 767     else {
 768         name = name_buf = pa_sprintf_malloc("alsa_input.%s", dev);
 769         namereg_fail = 0;
 770     }
 771
 772     u->source = pa_source_new(c, __FILE__, name, namereg_fail, &ss, &map);
 773     pa_xfree(name_buf);
 774
 775     if (!u->source) {
 776         pa_log("Failed to create source object");
 777         goto fail;
 778     }
 779
 780     u->source->parent.process_msg = source_process_msg;
 781     u->source->userdata = u;
 782
 783     pa_source_set_module(u->source, m);
 784     pa_source_set_asyncmsgq(u->source, u->asyncmsgq);
 785     pa_source_set_description(u->source, t = pa_sprintf_malloc(
 786                                       "ALSA PCM on %s (%s)",
 787                                       dev,
 788                                       snd_pcm_info_get_name(pcm_info)));
 789     pa_xfree(t);
 790
 791     u->source->is_hardware = 1;
 792
 793     u->frame_size = frame_size;
 794     u->fragment_size = frag_size = period_size * frame_size;
 795     u->nfragments = nfrags;
 796     u->hwbuf_size = u->fragment_size * nfrags;
 797
 798     pa_log_info("Using %u fragments of size %lu bytes.", nfrags, (long unsigned) u->fragment_size);
 799
 800     if (u->mixer_handle) {
 801         assert(u->mixer_elem);
 802
 803         if (snd_mixer_selem_has_capture_volume(u->mixer_elem)) {
 804             int i;
 805
 806             for (i = 0;i < ss.channels;i++) {
 807                 if (!snd_mixer_selem_has_capture_channel(u->mixer_elem, i))
 808                     break;
 809             }
 810
 811             if (i == ss.channels) {
 812                 u->source->get_volume = source_get_volume_cb;
 813                 u->source->set_volume = source_set_volume_cb;
 814                 snd_mixer_selem_get_capture_volume_range(u->mixer_elem, &u->hw_volume_min, &u->hw_volume_max);
 815             }
 816         }
 817
 818         if (snd_mixer_selem_has_capture_switch(u->mixer_elem)) {
 819             u->source->get_mute = source_get_mute_cb;
 820             u->source->set_mute = source_set_mute_cb;
 821         }
 822
 823         u->mixer_fdl = pa_alsa_fdlist_new();
 824
 825         if (pa_alsa_fdlist_set_mixer(u->mixer_fdl, u->mixer_handle, c->mainloop) < 0) {
 826             pa_log("failed to initialise file descriptor monitoring");
 827             goto fail;
 828         }
 829
 830         snd_mixer_elem_set_callback(u->mixer_elem, mixer_callback);
 831         snd_mixer_elem_set_callback_private(u->mixer_elem, u);
 832     } else
 833         u->mixer_fdl = NULL;
 834
 835     if (!(u->thread = pa_thread_new(thread_func, u))) {
 836         pa_log("Failed to create thread.");
 837         goto fail;
 838     }
 839     /* Get initial mixer settings */
 840     if (u->source->get_volume)
 841         u->source->get_volume(u->source);
 842     if (u->source->get_mute)
 843         u->source->get_mute(u->source);
 844
 845     snd_pcm_start(u->pcm_handle);
 846
 847     ret = 0;
 848
 849 finish:
 850
 851     if (ma)
 852         pa_modargs_free(ma);
 853
 854     if (pcm_info)
 855         snd_pcm_info_free(pcm_info);
 856
 857     return ret;
 858
 859 fail:
 860
 861     if (u)
 862         pa__done(c, m);
 863
 864     goto finish;
 865 }
 866
 867 void pa__done(pa_core *c, pa_module*m) {
 868     struct userdata *u;
 869
 870     pa_assert(c);
 871     pa_assert(m);
 872
 873     if (!(u = m->userdata))
 874         return;
 875
 876     if (u->source)
 877         pa_source_disconnect(u->source);
 878
 879     if (u->thread) {
 880         pa_asyncmsgq_send(u->asyncmsgq, NULL, PA_MESSAGE_SHUTDOWN, NULL, 0, NULL);
 881         pa_thread_free(u->thread);
 882     }
 883
 884     if (u->asyncmsgq)
 885         pa_asyncmsgq_free(u->asyncmsgq);
 886
 887     if (u->source)
 888         pa_source_unref(u->source);
 889
 890     if (u->mixer_fdl)
 891         pa_alsa_fdlist_free(u->mixer_fdl);
 892
 893     if (u->mixer_handle)
 894         snd_mixer_close(u->mixer_handle);
 895
 896     if (u->pcm_handle) {
 897         snd_pcm_drop(u->pcm_handle);
 898         snd_pcm_close(u->pcm_handle);
 899     }
 900
 901     pa_xfree(u->device_name);
 902     pa_xfree(u);
 903
 904     snd_config_update_free_global();
 905 }
 906