| /*** | |
| This file is part of PulseAudio. | |
| Copyright 2004-2006 Lennart Poettering | |
| Copyright 2006 Pierre Ossman <ossman@cendio.se> for Cendio AB | |
| PulseAudio is free software; you can redistribute it and/or modify | |
| it under the terms of the GNU Lesser General Public License as published | |
| by the Free Software Foundation; either version 2.1 of the License, | |
| or (at your option) any later version. | |
| PulseAudio is distributed in the hope that it will be useful, but | |
| WITHOUT ANY WARRANTY; without even the implied warranty of | |
| MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
| General Public License for more details. | |
| You should have received a copy of the GNU Lesser General Public License | |
| along with PulseAudio; if not, see <http://www.gnu.org/licenses/>. | |
| ***/ | |
| /* General power management rules: | |
| * | |
| * When SUSPENDED we close the audio device. | |
| * | |
| * We make no difference between IDLE and RUNNING in our handling. | |
| * | |
| * As long as we are in RUNNING/IDLE state we will *always* write data to | |
| * the device. If none is available from the inputs, we write silence | |
| * instead. | |
| * | |
| * If power should be saved on IDLE module-suspend-on-idle should be used. | |
| * | |
| */ | |
| #ifdef HAVE_CONFIG_H | |
| #include <config.h> | |
| #endif | |
| #ifdef HAVE_SYS_MMAN_H | |
| #include <sys/mman.h> | |
| #endif | |
| #include <sys/soundcard.h> | |
| #include <sys/ioctl.h> | |
| #include <stdlib.h> | |
| #include <stdio.h> | |
| #include <errno.h> | |
| #include <fcntl.h> | |
| #include <unistd.h> | |
| #include <pulse/xmalloc.h> | |
| #include <pulse/util.h> | |
| #include <pulsecore/core-error.h> | |
| #include <pulsecore/thread.h> | |
| #include <pulsecore/sink.h> | |
| #include <pulsecore/source.h> | |
| #include <pulsecore/module.h> | |
| #include <pulsecore/sample-util.h> | |
| #include <pulsecore/core-util.h> | |
| #include <pulsecore/modargs.h> | |
| #include <pulsecore/log.h> | |
| #include <pulsecore/macro.h> | |
| #include <pulsecore/thread-mq.h> | |
| #include <pulsecore/rtpoll.h> | |
| #include <pulsecore/poll.h> | |
| #if defined(__NetBSD__) && !defined(SNDCTL_DSP_GETODELAY) | |
| #include <sys/audioio.h> | |
| #include <sys/syscall.h> | |
| #endif | |
| #include "oss-util.h" | |
| PA_MODULE_AUTHOR("Lennart Poettering"); | |
| PA_MODULE_DESCRIPTION("OSS Sink/Source"); | |
| PA_MODULE_VERSION(PACKAGE_VERSION); | |
| PA_MODULE_LOAD_ONCE(false); | |
| PA_MODULE_USAGE( | |
| "sink_name=<name for the sink> " | |
| "sink_properties=<properties for the sink> " | |
| "source_name=<name for the source> " | |
| "source_properties=<properties for the source> " | |
| "device=<OSS device> " | |
| "record=<enable source?> " | |
| "playback=<enable sink?> " | |
| "format=<sample format> " | |
| "rate=<sample rate> " | |
| "channels=<number of channels> " | |
| "channel_map=<channel map> " | |
| "fragments=<number of fragments> " | |
| "fragment_size=<fragment size> " | |
| "mmap=<enable memory mapping?>"); | |
| #ifdef __linux__ | |
| PA_MODULE_DEPRECATED("Please use module-alsa-card instead of module-oss!"); | |
| #endif | |
| #define DEFAULT_DEVICE "/dev/dsp" | |
| struct userdata { | |
| pa_core *core; | |
| pa_module *module; | |
| pa_sink *sink; | |
| pa_source *source; | |
| pa_thread *thread; | |
| pa_thread_mq thread_mq; | |
| pa_rtpoll *rtpoll; | |
| char *device_name; | |
| pa_memchunk memchunk; | |
| size_t frame_size; | |
| uint32_t in_fragment_size, out_fragment_size, in_nfrags, out_nfrags, in_hwbuf_size, out_hwbuf_size; | |
| bool use_getospace, use_getispace; | |
| bool use_getodelay; | |
| bool sink_suspended, source_suspended; | |
| int fd; | |
| int mode; | |
| int mixer_fd; | |
| int mixer_devmask; | |
| int nfrags, frag_size, orig_frag_size; | |
| bool shutdown; | |
| bool use_mmap; | |
| unsigned out_mmap_current, in_mmap_current; | |
| void *in_mmap, *out_mmap; | |
| pa_memblock **in_mmap_memblocks, **out_mmap_memblocks; | |
| int in_mmap_saved_nfrags, out_mmap_saved_nfrags; | |
| pa_rtpoll_item *rtpoll_item; | |
| }; | |
| static const char* const valid_modargs[] = { | |
| "sink_name", | |
| "sink_properties", | |
| "source_name", | |
| "source_properties", | |
| "device", | |
| "record", | |
| "playback", | |
| "fragments", | |
| "fragment_size", | |
| "format", | |
| "rate", | |
| "channels", | |
| "channel_map", | |
| "mmap", | |
| NULL | |
| }; | |
| /* Sink and source states are passed as arguments, because this is called | |
| * during state changes, and we need the new state, but thread_info.state | |
| * has not yet been updated. */ | |
| static void trigger(struct userdata *u, pa_sink_state_t sink_state, pa_source_state_t source_state, bool quick) { | |
| int enable_bits = 0, zero = 0; | |
| pa_assert(u); | |
| if (u->fd < 0) | |
| return; | |
| pa_log_debug("trigger"); | |
| if (u->source && PA_SOURCE_IS_OPENED(source_state)) | |
| enable_bits |= PCM_ENABLE_INPUT; | |
| if (u->sink && PA_SINK_IS_OPENED(sink_state)) | |
| enable_bits |= PCM_ENABLE_OUTPUT; | |
| pa_log_debug("trigger: %i", enable_bits); | |
| if (u->use_mmap) { | |
| if (!quick) | |
| ioctl(u->fd, SNDCTL_DSP_SETTRIGGER, &zero); | |
| #ifdef SNDCTL_DSP_HALT | |
| if (enable_bits == 0) | |
| if (ioctl(u->fd, SNDCTL_DSP_HALT, NULL) < 0) | |
| pa_log_warn("SNDCTL_DSP_HALT: %s", pa_cstrerror(errno)); | |
| #endif | |
| if (ioctl(u->fd, SNDCTL_DSP_SETTRIGGER, &enable_bits) < 0) | |
| pa_log_warn("SNDCTL_DSP_SETTRIGGER: %s", pa_cstrerror(errno)); | |
| if (u->sink && !(enable_bits & PCM_ENABLE_OUTPUT)) { | |
| pa_log_debug("clearing playback buffer"); | |
| pa_silence_memory(u->out_mmap, u->out_hwbuf_size, &u->sink->sample_spec); | |
| } | |
| } else { | |
| if (enable_bits) | |
| if (ioctl(u->fd, SNDCTL_DSP_POST, NULL) < 0) | |
| pa_log_warn("SNDCTL_DSP_POST: %s", pa_cstrerror(errno)); | |
| if (!quick) { | |
| /* | |
| * Some crappy drivers do not start the recording until we | |
| * read something. Without this snippet, poll will never | |
| * register the fd as ready. | |
| */ | |
| if (u->source && PA_SOURCE_IS_OPENED(source_state)) { | |
| uint8_t *buf = pa_xnew(uint8_t, u->in_fragment_size); | |
| /* XXX: Shouldn't this be done only when resuming the source? | |
| * Currently this code path is executed also when resuming the | |
| * sink while the source is already running. */ | |
| if (pa_read(u->fd, buf, u->in_fragment_size, NULL) < 0) | |
| pa_log("pa_read() failed: %s", pa_cstrerror(errno)); | |
| pa_xfree(buf); | |
| } | |
| } | |
| } | |
| } | |
| static void mmap_fill_memblocks(struct userdata *u, unsigned n) { | |
| pa_assert(u); | |
| pa_assert(u->out_mmap_memblocks); | |
| /* pa_log("Mmmap writing %u blocks", n); */ | |
| while (n > 0) { | |
| pa_memchunk chunk; | |
| if (u->out_mmap_memblocks[u->out_mmap_current]) | |
| pa_memblock_unref_fixed(u->out_mmap_memblocks[u->out_mmap_current]); | |
| chunk.memblock = u->out_mmap_memblocks[u->out_mmap_current] = | |
| pa_memblock_new_fixed( | |
| u->core->mempool, | |
| (uint8_t*) u->out_mmap + u->out_fragment_size * u->out_mmap_current, | |
| u->out_fragment_size, | |
| 1); | |
| chunk.length = pa_memblock_get_length(chunk.memblock); | |
| chunk.index = 0; | |
| pa_sink_render_into_full(u->sink, &chunk); | |
| u->out_mmap_current++; | |
| while (u->out_mmap_current >= u->out_nfrags) | |
| u->out_mmap_current -= u->out_nfrags; | |
| n--; | |
| } | |
| } | |
| static int mmap_write(struct userdata *u) { | |
| struct count_info info; | |
| pa_assert(u); | |
| pa_assert(u->sink); | |
| /* pa_log("Mmmap writing..."); */ | |
| if (ioctl(u->fd, SNDCTL_DSP_GETOPTR, &info) < 0) { | |
| pa_log("SNDCTL_DSP_GETOPTR: %s", pa_cstrerror(errno)); | |
| return -1; | |
| } | |
| info.blocks += u->out_mmap_saved_nfrags; | |
| u->out_mmap_saved_nfrags = 0; | |
| if (info.blocks > 0) | |
| mmap_fill_memblocks(u, (unsigned) info.blocks); | |
| return info.blocks; | |
| } | |
| static void mmap_post_memblocks(struct userdata *u, unsigned n) { | |
| pa_assert(u); | |
| pa_assert(u->in_mmap_memblocks); | |
| /* pa_log("Mmmap reading %u blocks", n); */ | |
| while (n > 0) { | |
| pa_memchunk chunk; | |
| if (!u->in_mmap_memblocks[u->in_mmap_current]) { | |
| chunk.memblock = u->in_mmap_memblocks[u->in_mmap_current] = | |
| pa_memblock_new_fixed( | |
| u->core->mempool, | |
| (uint8_t*) u->in_mmap + u->in_fragment_size*u->in_mmap_current, | |
| u->in_fragment_size, | |
| 1); | |
| chunk.length = pa_memblock_get_length(chunk.memblock); | |
| chunk.index = 0; | |
| pa_source_post(u->source, &chunk); | |
| } | |
| u->in_mmap_current++; | |
| while (u->in_mmap_current >= u->in_nfrags) | |
| u->in_mmap_current -= u->in_nfrags; | |
| n--; | |
| } | |
| } | |
| static void mmap_clear_memblocks(struct userdata*u, unsigned n) { | |
| unsigned i = u->in_mmap_current; | |
| pa_assert(u); | |
| pa_assert(u->in_mmap_memblocks); | |
| if (n > u->in_nfrags) | |
| n = u->in_nfrags; | |
| while (n > 0) { | |
| if (u->in_mmap_memblocks[i]) { | |
| pa_memblock_unref_fixed(u->in_mmap_memblocks[i]); | |
| u->in_mmap_memblocks[i] = NULL; | |
| } | |
| i++; | |
| while (i >= u->in_nfrags) | |
| i -= u->in_nfrags; | |
| n--; | |
| } | |
| } | |
| static int mmap_read(struct userdata *u) { | |
| struct count_info info; | |
| pa_assert(u); | |
| pa_assert(u->source); | |
| /* pa_log("Mmmap reading..."); */ | |
| if (ioctl(u->fd, SNDCTL_DSP_GETIPTR, &info) < 0) { | |
| pa_log("SNDCTL_DSP_GETIPTR: %s", pa_cstrerror(errno)); | |
| return -1; | |
| } | |
| /* pa_log("... %i", info.blocks); */ | |
| info.blocks += u->in_mmap_saved_nfrags; | |
| u->in_mmap_saved_nfrags = 0; | |
| if (info.blocks > 0) { | |
| mmap_post_memblocks(u, (unsigned) info.blocks); | |
| mmap_clear_memblocks(u, u->in_nfrags/2); | |
| } | |
| return info.blocks; | |
| } | |
| static pa_usec_t mmap_sink_get_latency(struct userdata *u) { | |
| struct count_info info; | |
| size_t bpos, n; | |
| pa_assert(u); | |
| if (ioctl(u->fd, SNDCTL_DSP_GETOPTR, &info) < 0) { | |
| pa_log("SNDCTL_DSP_GETOPTR: %s", pa_cstrerror(errno)); | |
| return 0; | |
| } | |
| u->out_mmap_saved_nfrags += info.blocks; | |
| bpos = ((u->out_mmap_current + (unsigned) u->out_mmap_saved_nfrags) * u->out_fragment_size) % u->out_hwbuf_size; | |
| if (bpos <= (size_t) info.ptr) | |
| n = u->out_hwbuf_size - ((size_t) info.ptr - bpos); | |
| else | |
| n = bpos - (size_t) info.ptr; | |
| /* pa_log("n = %u, bpos = %u, ptr = %u, total=%u, fragsize = %u, n_frags = %u\n", n, bpos, (unsigned) info.ptr, total, u->out_fragment_size, u->out_fragments); */ | |
| return pa_bytes_to_usec(n, &u->sink->sample_spec); | |
| } | |
| static pa_usec_t mmap_source_get_latency(struct userdata *u) { | |
| struct count_info info; | |
| size_t bpos, n; | |
| pa_assert(u); | |
| if (ioctl(u->fd, SNDCTL_DSP_GETIPTR, &info) < 0) { | |
| pa_log("SNDCTL_DSP_GETIPTR: %s", pa_cstrerror(errno)); | |
| return 0; | |
| } | |
| u->in_mmap_saved_nfrags += info.blocks; | |
| bpos = ((u->in_mmap_current + (unsigned) u->in_mmap_saved_nfrags) * u->in_fragment_size) % u->in_hwbuf_size; | |
| if (bpos <= (size_t) info.ptr) | |
| n = (size_t) info.ptr - bpos; | |
| else | |
| n = u->in_hwbuf_size - bpos + (size_t) info.ptr; | |
| /* pa_log("n = %u, bpos = %u, ptr = %u, total=%u, fragsize = %u, n_frags = %u\n", n, bpos, (unsigned) info.ptr, total, u->in_fragment_size, u->in_fragments); */ | |
| return pa_bytes_to_usec(n, &u->source->sample_spec); | |
| } | |
| static pa_usec_t io_sink_get_latency(struct userdata *u) { | |
| pa_usec_t r = 0; | |
| pa_assert(u); | |
| if (u->use_getodelay) { | |
| int arg; | |
| #if defined(__NetBSD__) && !defined(SNDCTL_DSP_GETODELAY) | |
| #if defined(AUDIO_GETBUFINFO) | |
| struct audio_info info; | |
| if (syscall(SYS_ioctl, u->fd, AUDIO_GETBUFINFO, &info) < 0) { | |
| pa_log_info("Device doesn't support AUDIO_GETBUFINFO: %s", pa_cstrerror(errno)); | |
| u->use_getodelay = 0; | |
| } else { | |
| arg = info.play.seek + info.blocksize / 2; | |
| r = pa_bytes_to_usec((size_t) arg, &u->sink->sample_spec); | |
| } | |
| #else | |
| pa_log_info("System doesn't support AUDIO_GETBUFINFO"); | |
| u->use_getodelay = 0; | |
| #endif | |
| #else | |
| if (ioctl(u->fd, SNDCTL_DSP_GETODELAY, &arg) < 0) { | |
| pa_log_info("Device doesn't support SNDCTL_DSP_GETODELAY: %s", pa_cstrerror(errno)); | |
| u->use_getodelay = 0; | |
| } else | |
| r = pa_bytes_to_usec((size_t) arg, &u->sink->sample_spec); | |
| #endif | |
| } | |
| if (!u->use_getodelay && u->use_getospace) { | |
| struct audio_buf_info info; | |
| if (ioctl(u->fd, SNDCTL_DSP_GETOSPACE, &info) < 0) { | |
| pa_log_info("Device doesn't support SNDCTL_DSP_GETOSPACE: %s", pa_cstrerror(errno)); | |
| u->use_getospace = 0; | |
| } else | |
| r = pa_bytes_to_usec((size_t) info.bytes, &u->sink->sample_spec); | |
| } | |
| if (u->memchunk.memblock) | |
| r += pa_bytes_to_usec(u->memchunk.length, &u->sink->sample_spec); | |
| return r; | |
| } | |
| static pa_usec_t io_source_get_latency(struct userdata *u) { | |
| pa_usec_t r = 0; | |
| pa_assert(u); | |
| if (u->use_getispace) { | |
| struct audio_buf_info info; | |
| if (ioctl(u->fd, SNDCTL_DSP_GETISPACE, &info) < 0) { | |
| pa_log_info("Device doesn't support SNDCTL_DSP_GETISPACE: %s", pa_cstrerror(errno)); | |
| u->use_getispace = 0; | |
| } else | |
| r = pa_bytes_to_usec((size_t) info.bytes, &u->source->sample_spec); | |
| } | |
| return r; | |
| } | |
| static void build_pollfd(struct userdata *u) { | |
| struct pollfd *pollfd; | |
| pa_assert(u); | |
| pa_assert(u->fd >= 0); | |
| if (u->rtpoll_item) | |
| pa_rtpoll_item_free(u->rtpoll_item); | |
| u->rtpoll_item = pa_rtpoll_item_new(u->rtpoll, PA_RTPOLL_NEVER, 1); | |
| pollfd = pa_rtpoll_item_get_pollfd(u->rtpoll_item, NULL); | |
| pollfd->fd = u->fd; | |
| pollfd->events = 0; | |
| pollfd->revents = 0; | |
| } | |
| /* Called from IO context */ | |
| static void suspend(struct userdata *u) { | |
| pa_assert(u); | |
| pa_assert(u->fd >= 0); | |
| pa_log_info("Suspending..."); | |
| if (u->out_mmap_memblocks) { | |
| unsigned i; | |
| for (i = 0; i < u->out_nfrags; i++) | |
| if (u->out_mmap_memblocks[i]) { | |
| pa_memblock_unref_fixed(u->out_mmap_memblocks[i]); | |
| u->out_mmap_memblocks[i] = NULL; | |
| } | |
| } | |
| if (u->in_mmap_memblocks) { | |
| unsigned i; | |
| for (i = 0; i < u->in_nfrags; i++) | |
| if (u->in_mmap_memblocks[i]) { | |
| pa_memblock_unref_fixed(u->in_mmap_memblocks[i]); | |
| u->in_mmap_memblocks[i] = NULL; | |
| } | |
| } | |
| if (u->in_mmap && u->in_mmap != MAP_FAILED) { | |
| munmap(u->in_mmap, u->in_hwbuf_size); | |
| u->in_mmap = NULL; | |
| } | |
| if (u->out_mmap && u->out_mmap != MAP_FAILED) { | |
| munmap(u->out_mmap, u->out_hwbuf_size); | |
| u->out_mmap = NULL; | |
| } | |
| /* Let's suspend */ | |
| ioctl(u->fd, SNDCTL_DSP_SYNC, NULL); | |
| pa_close(u->fd); | |
| u->fd = -1; | |
| if (u->rtpoll_item) { | |
| pa_rtpoll_item_free(u->rtpoll_item); | |
| u->rtpoll_item = NULL; | |
| } | |
| pa_log_info("Device suspended..."); | |
| } | |
| /* Called from IO context */ | |
| static int unsuspend(struct userdata *u) { | |
| int m; | |
| pa_sample_spec ss, *ss_original; | |
| int frag_size, in_frag_size, out_frag_size; | |
| int in_nfrags, out_nfrags; | |
| struct audio_buf_info info; | |
| pa_assert(u); | |
| pa_assert(u->fd < 0); | |
| m = u->mode; | |
| pa_log_info("Trying resume..."); | |
| if ((u->fd = pa_oss_open(u->device_name, &m, NULL)) < 0) { | |
| pa_log_warn("Resume failed, device busy (%s)", pa_cstrerror(errno)); | |
| return -1; | |
| } | |
| if (m != u->mode) { | |
| pa_log_warn("Resume failed, couldn't open device with original access mode."); | |
| goto fail; | |
| } | |
| if (u->nfrags >= 2 && u->frag_size >= 1) | |
| if (pa_oss_set_fragments(u->fd, u->nfrags, u->orig_frag_size) < 0) { | |
| pa_log_warn("Resume failed, couldn't set original fragment settings."); | |
| goto fail; | |
| } | |
| ss = *(ss_original = u->sink ? &u->sink->sample_spec : &u->source->sample_spec); | |
| if (pa_oss_auto_format(u->fd, &ss) < 0 || !pa_sample_spec_equal(&ss, ss_original)) { | |
| pa_log_warn("Resume failed, couldn't set original sample format settings."); | |
| goto fail; | |
| } | |
| if (ioctl(u->fd, SNDCTL_DSP_GETBLKSIZE, &frag_size) < 0) { | |
| pa_log_warn("SNDCTL_DSP_GETBLKSIZE: %s", pa_cstrerror(errno)); | |
| goto fail; | |
| } | |
| in_frag_size = out_frag_size = frag_size; | |
| in_nfrags = out_nfrags = u->nfrags; | |
| if (ioctl(u->fd, SNDCTL_DSP_GETISPACE, &info) >= 0) { | |
| in_frag_size = info.fragsize; | |
| in_nfrags = info.fragstotal; | |
| } | |
| if (ioctl(u->fd, SNDCTL_DSP_GETOSPACE, &info) >= 0) { | |
| out_frag_size = info.fragsize; | |
| out_nfrags = info.fragstotal; | |
| } | |
| if ((u->source && (in_frag_size != (int) u->in_fragment_size || in_nfrags != (int) u->in_nfrags)) || | |
| (u->sink && (out_frag_size != (int) u->out_fragment_size || out_nfrags != (int) u->out_nfrags))) { | |
| pa_log_warn("Resume failed, input fragment settings don't match."); | |
| goto fail; | |
| } | |
| if (u->use_mmap) { | |
| if (u->source) { | |
| if ((u->in_mmap = mmap(NULL, u->in_hwbuf_size, PROT_READ, MAP_SHARED, u->fd, 0)) == MAP_FAILED) { | |
| pa_log("Resume failed, mmap(): %s", pa_cstrerror(errno)); | |
| goto fail; | |
| } | |
| } | |
| if (u->sink) { | |
| if ((u->out_mmap = mmap(NULL, u->out_hwbuf_size, PROT_WRITE, MAP_SHARED, u->fd, 0)) == MAP_FAILED) { | |
| pa_log("Resume failed, mmap(): %s", pa_cstrerror(errno)); | |
| if (u->in_mmap && u->in_mmap != MAP_FAILED) { | |
| munmap(u->in_mmap, u->in_hwbuf_size); | |
| u->in_mmap = NULL; | |
| } | |
| goto fail; | |
| } | |
| pa_silence_memory(u->out_mmap, u->out_hwbuf_size, &ss); | |
| } | |
| } | |
| u->out_mmap_current = u->in_mmap_current = 0; | |
| u->out_mmap_saved_nfrags = u->in_mmap_saved_nfrags = 0; | |
| pa_assert(!u->rtpoll_item); | |
| build_pollfd(u); | |
| if (u->sink && u->sink->get_volume) | |
| u->sink->get_volume(u->sink); | |
| if (u->source && u->source->get_volume) | |
| u->source->get_volume(u->source); | |
| pa_log_info("Resumed successfully..."); | |
| return 0; | |
| fail: | |
| pa_close(u->fd); | |
| u->fd = -1; | |
| return -1; | |
| } | |
| /* Called from IO context */ | |
| static int sink_process_msg(pa_msgobject *o, int code, void *data, int64_t offset, pa_memchunk *chunk) { | |
| struct userdata *u = PA_SINK(o)->userdata; | |
| switch (code) { | |
| case PA_SINK_MESSAGE_GET_LATENCY: { | |
| pa_usec_t r = 0; | |
| if (u->fd >= 0) { | |
| if (u->use_mmap) | |
| r = mmap_sink_get_latency(u); | |
| else | |
| r = io_sink_get_latency(u); | |
| } | |
| *((int64_t*) data) = (int64_t)r; | |
| return 0; | |
| } | |
| } | |
| return pa_sink_process_msg(o, code, data, offset, chunk); | |
| } | |
| /* Called from the IO thread. */ | |
| static int sink_set_state_in_io_thread_cb(pa_sink *s, pa_sink_state_t new_state, pa_suspend_cause_t new_suspend_cause) { | |
| struct userdata *u; | |
| bool do_trigger = false; | |
| bool quick = true; | |
| pa_assert(s); | |
| pa_assert_se(u = s->userdata); | |
| /* It may be that only the suspend cause is changing, in which case there's | |
| * nothing to do. */ | |
| if (new_state == s->thread_info.state) | |
| return 0; | |
| switch (new_state) { | |
| case PA_SINK_SUSPENDED: | |
| pa_assert(PA_SINK_IS_OPENED(s->thread_info.state)); | |
| if (!u->source || u->source_suspended) | |
| suspend(u); | |
| do_trigger = true; | |
| u->sink_suspended = true; | |
| break; | |
| case PA_SINK_IDLE: | |
| case PA_SINK_RUNNING: | |
| if (s->thread_info.state == PA_SINK_INIT) { | |
| do_trigger = true; | |
| quick = u->source && PA_SOURCE_IS_OPENED(u->source->thread_info.state); | |
| } | |
| if (s->thread_info.state == PA_SINK_SUSPENDED) { | |
| if (!u->source || u->source_suspended) { | |
| if (unsuspend(u) < 0) | |
| return -1; | |
| quick = false; | |
| } | |
| do_trigger = true; | |
| u->out_mmap_current = 0; | |
| u->out_mmap_saved_nfrags = 0; | |
| u->sink_suspended = false; | |
| } | |
| break; | |
| case PA_SINK_INVALID_STATE: | |
| case PA_SINK_UNLINKED: | |
| case PA_SINK_INIT: | |
| ; | |
| } | |
| if (do_trigger) | |
| trigger(u, new_state, u->source ? u->source->thread_info.state : PA_SOURCE_INVALID_STATE, quick); | |
| return 0; | |
| } | |
| static int source_process_msg(pa_msgobject *o, int code, void *data, int64_t offset, pa_memchunk *chunk) { | |
| struct userdata *u = PA_SOURCE(o)->userdata; | |
| switch (code) { | |
| case PA_SOURCE_MESSAGE_GET_LATENCY: { | |
| pa_usec_t r = 0; | |
| if (u->fd >= 0) { | |
| if (u->use_mmap) | |
| r = mmap_source_get_latency(u); | |
| else | |
| r = io_source_get_latency(u); | |
| } | |
| *((int64_t*) data) = (int64_t)r; | |
| return 0; | |
| } | |
| } | |
| return pa_source_process_msg(o, code, data, offset, chunk); | |
| } | |
| /* Called from the IO thread. */ | |
| static int source_set_state_in_io_thread_cb(pa_source *s, pa_source_state_t new_state, pa_suspend_cause_t new_suspend_cause) { | |
| struct userdata *u; | |
| bool do_trigger = false; | |
| bool quick = true; | |
| pa_assert(s); | |
| pa_assert_se(u = s->userdata); | |
| /* It may be that only the suspend cause is changing, in which case there's | |
| * nothing to do. */ | |
| if (new_state == s->thread_info.state) | |
| return 0; | |
| switch (new_state) { | |
| case PA_SOURCE_SUSPENDED: | |
| pa_assert(PA_SOURCE_IS_OPENED(s->thread_info.state)); | |
| if (!u->sink || u->sink_suspended) | |
| suspend(u); | |
| do_trigger = true; | |
| u->source_suspended = true; | |
| break; | |
| case PA_SOURCE_IDLE: | |
| case PA_SOURCE_RUNNING: | |
| if (s->thread_info.state == PA_SOURCE_INIT) { | |
| do_trigger = true; | |
| quick = u->sink && PA_SINK_IS_OPENED(u->sink->thread_info.state); | |
| } | |
| if (s->thread_info.state == PA_SOURCE_SUSPENDED) { | |
| if (!u->sink || u->sink_suspended) { | |
| if (unsuspend(u) < 0) | |
| return -1; | |
| quick = false; | |
| } | |
| do_trigger = true; | |
| u->in_mmap_current = 0; | |
| u->in_mmap_saved_nfrags = 0; | |
| u->source_suspended = false; | |
| } | |
| break; | |
| case PA_SOURCE_UNLINKED: | |
| case PA_SOURCE_INIT: | |
| case PA_SOURCE_INVALID_STATE: | |
| ; | |
| } | |
| if (do_trigger) | |
| trigger(u, u->sink ? u->sink->thread_info.state : PA_SINK_INVALID_STATE, new_state, quick); | |
| return 0; | |
| } | |
| static void sink_get_volume(pa_sink *s) { | |
| struct userdata *u; | |
| pa_assert_se(u = s->userdata); | |
| pa_assert(u->mixer_devmask & (SOUND_MASK_VOLUME|SOUND_MASK_PCM)); | |
| if (u->mixer_devmask & SOUND_MASK_VOLUME) | |
| if (pa_oss_get_volume(u->mixer_fd, SOUND_MIXER_READ_VOLUME, &s->sample_spec, &s->real_volume) >= 0) | |
| return; | |
| if (u->mixer_devmask & SOUND_MASK_PCM) | |
| if (pa_oss_get_volume(u->mixer_fd, SOUND_MIXER_READ_PCM, &s->sample_spec, &s->real_volume) >= 0) | |
| return; | |
| pa_log_info("Device doesn't support reading mixer settings: %s", pa_cstrerror(errno)); | |
| } | |
| static void sink_set_volume(pa_sink *s) { | |
| struct userdata *u; | |
| pa_assert_se(u = s->userdata); | |
| pa_assert(u->mixer_devmask & (SOUND_MASK_VOLUME|SOUND_MASK_PCM)); | |
| if (u->mixer_devmask & SOUND_MASK_VOLUME) | |
| (void) pa_oss_set_volume(u->mixer_fd, SOUND_MIXER_WRITE_VOLUME, &s->sample_spec, &s->real_volume); | |
| if (u->mixer_devmask & SOUND_MASK_PCM) | |
| (void) pa_oss_set_volume(u->mixer_fd, SOUND_MIXER_WRITE_PCM, &s->sample_spec, &s->real_volume); | |
| } | |
| static void source_get_volume(pa_source *s) { | |
| struct userdata *u; | |
| pa_assert_se(u = s->userdata); | |
| pa_assert(u->mixer_devmask & (SOUND_MASK_MIC|SOUND_MASK_IGAIN|SOUND_MASK_RECLEV)); | |
| if (u->mixer_devmask & SOUND_MASK_IGAIN) | |
| if (pa_oss_get_volume(u->mixer_fd, SOUND_MIXER_READ_IGAIN, &s->sample_spec, &s->real_volume) >= 0) | |
| return; | |
| if (u->mixer_devmask & SOUND_MASK_RECLEV) | |
| if (pa_oss_get_volume(u->mixer_fd, SOUND_MIXER_READ_RECLEV, &s->sample_spec, &s->real_volume) >= 0) | |
| return; | |
| if (u->mixer_devmask & SOUND_MASK_MIC) | |
| if (pa_oss_get_volume(u->mixer_fd, SOUND_MIXER_READ_MIC, &s->sample_spec, &s->real_volume) >= 0) | |
| return; | |
| pa_log_info("Device doesn't support reading mixer settings: %s", pa_cstrerror(errno)); | |
| } | |
| static void source_set_volume(pa_source *s) { | |
| struct userdata *u; | |
| pa_assert_se(u = s->userdata); | |
| pa_assert(u->mixer_devmask & (SOUND_MASK_MIC|SOUND_MASK_IGAIN|SOUND_MASK_RECLEV)); | |
| if (u->mixer_devmask & SOUND_MASK_IGAIN) | |
| (void) pa_oss_set_volume(u->mixer_fd, SOUND_MIXER_WRITE_IGAIN, &s->sample_spec, &s->real_volume); | |
| if (u->mixer_devmask & SOUND_MASK_RECLEV) | |
| (void) pa_oss_set_volume(u->mixer_fd, SOUND_MIXER_WRITE_RECLEV, &s->sample_spec, &s->real_volume); | |
| if (u->mixer_devmask & SOUND_MASK_MIC) | |
| (void) pa_oss_set_volume(u->mixer_fd, SOUND_MIXER_WRITE_MIC, &s->sample_spec, &s->real_volume); | |
| } | |
| static void thread_func(void *userdata) { | |
| struct userdata *u = userdata; | |
| int write_type = 0, read_type = 0; | |
| short revents = 0; | |
| pa_assert(u); | |
| pa_log_debug("Thread starting up"); | |
| if (u->core->realtime_scheduling) | |
| pa_thread_make_realtime(u->core->realtime_priority); | |
| pa_thread_mq_install(&u->thread_mq); | |
| for (;;) { | |
| int ret; | |
| /* pa_log("loop"); */ | |
| if (PA_UNLIKELY(u->sink && u->sink->thread_info.rewind_requested)) | |
| pa_sink_process_rewind(u->sink, 0); | |
| /* Render some data and write it to the dsp */ | |
| if (u->sink && PA_SINK_IS_OPENED(u->sink->thread_info.state) && ((revents & POLLOUT) || u->use_mmap || u->use_getospace)) { | |
| if (u->use_mmap) { | |
| if ((ret = mmap_write(u)) < 0) | |
| goto fail; | |
| revents &= ~POLLOUT; | |
| if (ret > 0) | |
| continue; | |
| } else { | |
| ssize_t l; | |
| bool loop = false, work_done = false; | |
| l = (ssize_t) u->out_fragment_size; | |
| if (u->use_getospace) { | |
| audio_buf_info info; | |
| if (ioctl(u->fd, SNDCTL_DSP_GETOSPACE, &info) < 0) { | |
| pa_log_info("Device doesn't support SNDCTL_DSP_GETOSPACE: %s", pa_cstrerror(errno)); | |
| u->use_getospace = false; | |
| } else { | |
| l = info.bytes; | |
| /* We loop only if GETOSPACE worked and we | |
| * actually *know* that we can write more than | |
| * one fragment at a time */ | |
| loop = true; | |
| } | |
| } | |
| /* Round down to multiples of the fragment size, | |
| * because OSS needs that (at least some versions | |
| * do) */ | |
| l = (l/(ssize_t) u->out_fragment_size) * (ssize_t) u->out_fragment_size; | |
| /* Hmm, so poll() signalled us that we can read | |
| * something, but GETOSPACE told us there was nothing? | |
| * Hmm, make the best of it, try to read some data, to | |
| * avoid spinning forever. */ | |
| if (l <= 0 && (revents & POLLOUT)) { | |
| l = (ssize_t) u->out_fragment_size; | |
| loop = false; | |
| } | |
| while (l > 0) { | |
| void *p; | |
| ssize_t t; | |
| if (u->memchunk.length <= 0) | |
| pa_sink_render(u->sink, (size_t) l, &u->memchunk); | |
| pa_assert(u->memchunk.length > 0); | |
| p = pa_memblock_acquire(u->memchunk.memblock); | |
| t = pa_write(u->fd, (uint8_t*) p + u->memchunk.index, u->memchunk.length, &write_type); | |
| pa_memblock_release(u->memchunk.memblock); | |
| /* pa_log("wrote %i bytes of %u", t, l); */ | |
| pa_assert(t != 0); | |
| if (t < 0) { | |
| if (errno == EAGAIN) { | |
| pa_log_debug("EAGAIN"); | |
| revents &= ~POLLOUT; | |
| break; | |
| } else { | |
| pa_log("Failed to write data to DSP: %s", pa_cstrerror(errno)); | |
| goto fail; | |
| } | |
| } else { | |
| u->memchunk.index += (size_t) t; | |
| u->memchunk.length -= (size_t) t; | |
| if (u->memchunk.length <= 0) { | |
| pa_memblock_unref(u->memchunk.memblock); | |
| pa_memchunk_reset(&u->memchunk); | |
| } | |
| l -= t; | |
| revents &= ~POLLOUT; | |
| work_done = true; | |
| } | |
| if (!loop) | |
| break; | |
| } | |
| if (work_done) | |
| continue; | |
| } | |
| } | |
| /* Try to read some data and pass it on to the source driver. */ | |
| if (u->source && PA_SOURCE_IS_OPENED(u->source->thread_info.state) && ((revents & POLLIN) || u->use_mmap || u->use_getispace)) { | |
| if (u->use_mmap) { | |
| if ((ret = mmap_read(u)) < 0) | |
| goto fail; | |
| revents &= ~POLLIN; | |
| if (ret > 0) | |
| continue; | |
| } else { | |
| void *p; | |
| ssize_t l; | |
| pa_memchunk memchunk; | |
| bool loop = false, work_done = false; | |
| l = (ssize_t) u->in_fragment_size; | |
| if (u->use_getispace) { | |
| audio_buf_info info; | |
| if (ioctl(u->fd, SNDCTL_DSP_GETISPACE, &info) < 0) { | |
| pa_log_info("Device doesn't support SNDCTL_DSP_GETISPACE: %s", pa_cstrerror(errno)); | |
| u->use_getispace = false; | |
| } else { | |
| l = info.bytes; | |
| loop = true; | |
| } | |
| } | |
| l = (l/(ssize_t) u->in_fragment_size) * (ssize_t) u->in_fragment_size; | |
| if (l <= 0 && (revents & POLLIN)) { | |
| l = (ssize_t) u->in_fragment_size; | |
| loop = false; | |
| } | |
| while (l > 0) { | |
| ssize_t t; | |
| size_t k; | |
| pa_assert(l > 0); | |
| memchunk.memblock = pa_memblock_new(u->core->mempool, (size_t) -1); | |
| k = pa_memblock_get_length(memchunk.memblock); | |
| if (k > (size_t) l) | |
| k = (size_t) l; | |
| k = (k/u->frame_size)*u->frame_size; | |
| p = pa_memblock_acquire(memchunk.memblock); | |
| t = pa_read(u->fd, p, k, &read_type); | |
| pa_memblock_release(memchunk.memblock); | |
| pa_assert(t != 0); /* EOF cannot happen */ | |
| /* pa_log("read %i bytes of %u", t, l); */ | |
| if (t < 0) { | |
| pa_memblock_unref(memchunk.memblock); | |
| if (errno == EAGAIN) { | |
| pa_log_debug("EAGAIN"); | |
| revents &= ~POLLIN; | |
| break; | |
| } else { | |
| pa_log("Failed to read data from DSP: %s", pa_cstrerror(errno)); | |
| goto fail; | |
| } | |
| } else { | |
| memchunk.index = 0; | |
| memchunk.length = (size_t) t; | |
| pa_source_post(u->source, &memchunk); | |
| pa_memblock_unref(memchunk.memblock); | |
| l -= t; | |
| revents &= ~POLLIN; | |
| work_done = true; | |
| } | |
| if (!loop) | |
| break; | |
| } | |
| if (work_done) | |
| continue; | |
| } | |
| } | |
| /* pa_log("loop2 revents=%i", revents); */ | |
| if (u->rtpoll_item) { | |
| struct pollfd *pollfd; | |
| pa_assert(u->fd >= 0); | |
| pollfd = pa_rtpoll_item_get_pollfd(u->rtpoll_item, NULL); | |
| pollfd->events = (short) | |
| (((u->source && PA_SOURCE_IS_OPENED(u->source->thread_info.state)) ? POLLIN : 0) | | |
| ((u->sink && PA_SINK_IS_OPENED(u->sink->thread_info.state)) ? POLLOUT : 0) | | |
| POLLHUP); | |
| } | |
| /* set a watchdog timeout of one second */ | |
| pa_rtpoll_set_timer_relative(u->rtpoll, 1000000); | |
| /* Hmm, nothing to do. Let's sleep */ | |
| if ((ret = pa_rtpoll_run(u->rtpoll)) < 0) { | |
| goto fail; | |
| } | |
| /* check for shutdown */ | |
| if (u->shutdown) { | |
| goto fail; | |
| } | |
| if (u->rtpoll_item) { | |
| struct pollfd *pollfd; | |
| pollfd = pa_rtpoll_item_get_pollfd(u->rtpoll_item, NULL); | |
| if (pollfd->revents & ~(POLLOUT|POLLIN)) { | |
| pa_log("DSP shutdown."); | |
| goto fail; | |
| } | |
| revents = pollfd->revents; | |
| } else | |
| revents = 0; | |
| /* check for mixer shutdown, if any */ | |
| if ((revents & (POLLOUT | POLLIN)) == 0) { | |
| int mixer_fd = u->mixer_fd; | |
| int devmask; | |
| if (mixer_fd > -1 && ioctl(mixer_fd, SOUND_MIXER_READ_DEVMASK, &devmask) < 0) { | |
| pa_log("Mixer shutdown."); | |
| goto fail; | |
| } | |
| } | |
| } | |
| fail: | |
| /* If this was no regular exit from the loop we have to continue | |
| * processing messages until we received PA_MESSAGE_SHUTDOWN */ | |
| pa_asyncmsgq_post(u->thread_mq.outq, PA_MSGOBJECT(u->core), PA_CORE_MESSAGE_UNLOAD_MODULE, u->module, 0, NULL, NULL); | |
| pa_asyncmsgq_wait_for(u->thread_mq.inq, PA_MESSAGE_SHUTDOWN); | |
| } | |
| int pa__init(pa_module*m) { | |
| struct audio_buf_info info; | |
| struct userdata *u = NULL; | |
| const char *dev; | |
| int fd = -1; | |
| int nfrags, orig_frag_size, frag_size; | |
| int mode, caps; | |
| bool record = true, playback = true, use_mmap = true; | |
| pa_sample_spec ss; | |
| pa_channel_map map; | |
| pa_modargs *ma = NULL; | |
| char hwdesc[64]; | |
| const char *name; | |
| bool namereg_fail; | |
| pa_sink_new_data sink_new_data; | |
| pa_source_new_data source_new_data; | |
| pa_assert(m); | |
| if (!(ma = pa_modargs_new(m->argument, valid_modargs))) { | |
| pa_log("Failed to parse module arguments."); | |
| goto fail; | |
| } | |
| if (pa_modargs_get_value_boolean(ma, "record", &record) < 0 || pa_modargs_get_value_boolean(ma, "playback", &playback) < 0) { | |
| pa_log("record= and playback= expect boolean argument."); | |
| goto fail; | |
| } | |
| if (!playback && !record) { | |
| pa_log("Neither playback nor record enabled for device."); | |
| goto fail; | |
| } | |
| mode = (playback && record) ? O_RDWR : (playback ? O_WRONLY : O_RDONLY); | |
| ss = m->core->default_sample_spec; | |
| map = m->core->default_channel_map; | |
| if (pa_modargs_get_sample_spec_and_channel_map(ma, &ss, &map, PA_CHANNEL_MAP_OSS) < 0) { | |
| pa_log("Failed to parse sample specification or channel map"); | |
| goto fail; | |
| } | |
| nfrags = (int) m->core->default_n_fragments; | |
| frag_size = (int) pa_usec_to_bytes(m->core->default_fragment_size_msec*1000, &ss); | |
| if (frag_size <= 0) | |
| frag_size = (int) pa_frame_size(&ss); | |
| if (pa_modargs_get_value_s32(ma, "fragments", &nfrags) < 0 || pa_modargs_get_value_s32(ma, "fragment_size", &frag_size) < 0) { | |
| pa_log("Failed to parse fragments arguments"); | |
| goto fail; | |
| } | |
| if (pa_modargs_get_value_boolean(ma, "mmap", &use_mmap) < 0) { | |
| pa_log("Failed to parse mmap argument."); | |
| goto fail; | |
| } | |
| if ((fd = pa_oss_open(dev = pa_modargs_get_value(ma, "device", DEFAULT_DEVICE), &mode, &caps)) < 0) | |
| goto fail; | |
| if (use_mmap && (!(caps & DSP_CAP_MMAP) || !(caps & DSP_CAP_TRIGGER))) { | |
| pa_log_info("OSS device not mmap capable, falling back to UNIX read/write mode."); | |
| use_mmap = false; | |
| } | |
| #ifndef __FreeBSD__ | |
| if (use_mmap && mode == O_WRONLY) { | |
| pa_log_info("Device opened for playback only, cannot do memory mapping, falling back to UNIX write() mode."); | |
| use_mmap = false; | |
| } | |
| #endif | |
| if (pa_oss_get_hw_description(dev, hwdesc, sizeof(hwdesc)) >= 0) | |
| pa_log_info("Hardware name is '%s'.", hwdesc); | |
| else | |
| hwdesc[0] = 0; | |
| pa_log_info("Device opened in %s mode.", mode == O_WRONLY ? "O_WRONLY" : (mode == O_RDONLY ? "O_RDONLY" : "O_RDWR")); | |
| orig_frag_size = frag_size; | |
| if (nfrags >= 2 && frag_size >= 1) | |
| if (pa_oss_set_fragments(fd, nfrags, frag_size) < 0) | |
| goto fail; | |
| if (pa_oss_auto_format(fd, &ss) < 0) | |
| goto fail; | |
| if (ioctl(fd, SNDCTL_DSP_GETBLKSIZE, &frag_size) < 0) { | |
| pa_log("SNDCTL_DSP_GETBLKSIZE: %s", pa_cstrerror(errno)); | |
| goto fail; | |
| } | |
| pa_assert(frag_size > 0); | |
| u = pa_xnew0(struct userdata, 1); | |
| u->core = m->core; | |
| u->module = m; | |
| m->userdata = u; | |
| u->fd = fd; | |
| u->mixer_fd = -1; | |
| u->mixer_devmask = 0; | |
| u->use_getospace = u->use_getispace = true; | |
| u->use_getodelay = true; | |
| u->mode = mode; | |
| u->frame_size = pa_frame_size(&ss); | |
| u->device_name = pa_xstrdup(dev); | |
| u->in_nfrags = u->out_nfrags = (uint32_t) (u->nfrags = nfrags); | |
| u->out_fragment_size = u->in_fragment_size = (uint32_t) (u->frag_size = frag_size); | |
| u->orig_frag_size = orig_frag_size; | |
| u->use_mmap = use_mmap; | |
| u->rtpoll = pa_rtpoll_new(); | |
| if (pa_thread_mq_init(&u->thread_mq, m->core->mainloop, u->rtpoll) < 0) { | |
| pa_log("pa_thread_mq_init() failed."); | |
| goto fail; | |
| } | |
| u->rtpoll_item = NULL; | |
| build_pollfd(u); | |
| if (ioctl(fd, SNDCTL_DSP_GETISPACE, &info) >= 0) { | |
| pa_log_info("Input -- %u fragments of size %u.", info.fragstotal, info.fragsize); | |
| u->in_fragment_size = (uint32_t) info.fragsize; | |
| u->in_nfrags = (uint32_t) info.fragstotal; | |
| u->use_getispace = true; | |
| } | |
| if (ioctl(fd, SNDCTL_DSP_GETOSPACE, &info) >= 0) { | |
| pa_log_info("Output -- %u fragments of size %u.", info.fragstotal, info.fragsize); | |
| u->out_fragment_size = (uint32_t) info.fragsize; | |
| u->out_nfrags = (uint32_t) info.fragstotal; | |
| u->use_getospace = true; | |
| } | |
| u->in_hwbuf_size = u->in_nfrags * u->in_fragment_size; | |
| u->out_hwbuf_size = u->out_nfrags * u->out_fragment_size; | |
| if (mode != O_WRONLY) { | |
| char *name_buf = NULL; | |
| if (use_mmap) { | |
| if ((u->in_mmap = mmap(NULL, u->in_hwbuf_size, PROT_READ, MAP_SHARED, fd, 0)) == MAP_FAILED) { | |
| pa_log_warn("mmap(PROT_READ) failed, reverting to non-mmap mode: %s", pa_cstrerror(errno)); | |
| use_mmap = u->use_mmap = false; | |
| u->in_mmap = NULL; | |
| } else | |
| pa_log_debug("Successfully mmap()ed input buffer."); | |
| } | |
| if ((name = pa_modargs_get_value(ma, "source_name", NULL))) | |
| namereg_fail = true; | |
| else { | |
| name = name_buf = pa_sprintf_malloc("oss_input.%s", pa_path_get_filename(dev)); | |
| namereg_fail = false; | |
| } | |
| pa_source_new_data_init(&source_new_data); | |
| source_new_data.driver = __FILE__; | |
| source_new_data.module = m; | |
| pa_source_new_data_set_name(&source_new_data, name); | |
| source_new_data.namereg_fail = namereg_fail; | |
| pa_source_new_data_set_sample_spec(&source_new_data, &ss); | |
| pa_source_new_data_set_channel_map(&source_new_data, &map); | |
| pa_proplist_sets(source_new_data.proplist, PA_PROP_DEVICE_STRING, dev); | |
| pa_proplist_sets(source_new_data.proplist, PA_PROP_DEVICE_API, "oss"); | |
| pa_proplist_sets(source_new_data.proplist, PA_PROP_DEVICE_DESCRIPTION, hwdesc[0] ? hwdesc : dev); | |
| pa_proplist_sets(source_new_data.proplist, PA_PROP_DEVICE_ACCESS_MODE, use_mmap ? "mmap" : "serial"); | |
| pa_proplist_setf(source_new_data.proplist, PA_PROP_DEVICE_BUFFERING_BUFFER_SIZE, "%lu", (unsigned long) (u->in_hwbuf_size)); | |
| pa_proplist_setf(source_new_data.proplist, PA_PROP_DEVICE_BUFFERING_FRAGMENT_SIZE, "%lu", (unsigned long) (u->in_fragment_size)); | |
| if (pa_modargs_get_proplist(ma, "source_properties", source_new_data.proplist, PA_UPDATE_REPLACE) < 0) { | |
| pa_log("Invalid properties"); | |
| pa_source_new_data_done(&source_new_data); | |
| pa_xfree(name_buf); | |
| goto fail; | |
| } | |
| u->source = pa_source_new(m->core, &source_new_data, PA_SOURCE_HARDWARE|PA_SOURCE_LATENCY); | |
| pa_source_new_data_done(&source_new_data); | |
| pa_xfree(name_buf); | |
| if (!u->source) { | |
| pa_log("Failed to create source object"); | |
| goto fail; | |
| } | |
| u->source->parent.process_msg = source_process_msg; | |
| u->source->set_state_in_io_thread = source_set_state_in_io_thread_cb; | |
| u->source->userdata = u; | |
| pa_source_set_asyncmsgq(u->source, u->thread_mq.inq); | |
| pa_source_set_rtpoll(u->source, u->rtpoll); | |
| pa_source_set_fixed_latency(u->source, pa_bytes_to_usec(u->in_hwbuf_size, &u->source->sample_spec)); | |
| u->source->refresh_volume = true; | |
| if (use_mmap) | |
| u->in_mmap_memblocks = pa_xnew0(pa_memblock*, u->in_nfrags); | |
| } | |
| if (mode != O_RDONLY) { | |
| char *name_buf = NULL; | |
| if (use_mmap) { | |
| if ((u->out_mmap = mmap(NULL, u->out_hwbuf_size, PROT_WRITE, MAP_SHARED, fd, 0)) == MAP_FAILED) { | |
| if (mode == O_RDWR) { | |
| pa_log_debug("mmap() failed for input. Changing to O_WRONLY mode."); | |
| mode = O_WRONLY; | |
| goto go_on; | |
| } else { | |
| pa_log_warn("mmap(PROT_WRITE) failed, reverting to non-mmap mode: %s", pa_cstrerror(errno)); | |
| u->use_mmap = use_mmap = false; | |
| u->out_mmap = NULL; | |
| } | |
| } else { | |
| pa_log_debug("Successfully mmap()ed output buffer."); | |
| pa_silence_memory(u->out_mmap, u->out_hwbuf_size, &ss); | |
| } | |
| } | |
| if ((name = pa_modargs_get_value(ma, "sink_name", NULL))) | |
| namereg_fail = true; | |
| else { | |
| name = name_buf = pa_sprintf_malloc("oss_output.%s", pa_path_get_filename(dev)); | |
| namereg_fail = false; | |
| } | |
| pa_sink_new_data_init(&sink_new_data); | |
| sink_new_data.driver = __FILE__; | |
| sink_new_data.module = m; | |
| pa_sink_new_data_set_name(&sink_new_data, name); | |
| sink_new_data.namereg_fail = namereg_fail; | |
| pa_sink_new_data_set_sample_spec(&sink_new_data, &ss); | |
| pa_sink_new_data_set_channel_map(&sink_new_data, &map); | |
| pa_proplist_sets(sink_new_data.proplist, PA_PROP_DEVICE_STRING, dev); | |
| pa_proplist_sets(sink_new_data.proplist, PA_PROP_DEVICE_API, "oss"); | |
| pa_proplist_sets(sink_new_data.proplist, PA_PROP_DEVICE_DESCRIPTION, hwdesc[0] ? hwdesc : dev); | |
| pa_proplist_sets(sink_new_data.proplist, PA_PROP_DEVICE_ACCESS_MODE, use_mmap ? "mmap" : "serial"); | |
| pa_proplist_setf(sink_new_data.proplist, PA_PROP_DEVICE_BUFFERING_BUFFER_SIZE, "%lu", (unsigned long) (u->out_hwbuf_size)); | |
| pa_proplist_setf(sink_new_data.proplist, PA_PROP_DEVICE_BUFFERING_FRAGMENT_SIZE, "%lu", (unsigned long) (u->out_fragment_size)); | |
| if (pa_modargs_get_proplist(ma, "sink_properties", sink_new_data.proplist, PA_UPDATE_REPLACE) < 0) { | |
| pa_log("Invalid properties"); | |
| pa_sink_new_data_done(&sink_new_data); | |
| pa_xfree(name_buf); | |
| goto fail; | |
| } | |
| u->sink = pa_sink_new(m->core, &sink_new_data, PA_SINK_HARDWARE|PA_SINK_LATENCY); | |
| pa_sink_new_data_done(&sink_new_data); | |
| pa_xfree(name_buf); | |
| if (!u->sink) { | |
| pa_log("Failed to create sink object"); | |
| goto fail; | |
| } | |
| u->sink->parent.process_msg = sink_process_msg; | |
| u->sink->set_state_in_io_thread = sink_set_state_in_io_thread_cb; | |
| u->sink->userdata = u; | |
| pa_sink_set_asyncmsgq(u->sink, u->thread_mq.inq); | |
| pa_sink_set_rtpoll(u->sink, u->rtpoll); | |
| pa_sink_set_fixed_latency(u->sink, pa_bytes_to_usec(u->out_hwbuf_size, &u->sink->sample_spec)); | |
| u->sink->refresh_volume = true; | |
| pa_sink_set_max_request(u->sink, u->out_hwbuf_size); | |
| if (use_mmap) | |
| u->out_mmap_memblocks = pa_xnew0(pa_memblock*, u->out_nfrags); | |
| } | |
| if ((u->mixer_fd = pa_oss_open_mixer_for_device(u->device_name)) >= 0) { | |
| bool do_close = true; | |
| if (ioctl(u->mixer_fd, SOUND_MIXER_READ_DEVMASK, &u->mixer_devmask) < 0) | |
| pa_log_warn("SOUND_MIXER_READ_DEVMASK failed: %s", pa_cstrerror(errno)); | |
| else { | |
| if (u->sink && (u->mixer_devmask & (SOUND_MASK_VOLUME|SOUND_MASK_PCM))) { | |
| pa_log_debug("Found hardware mixer track for playback."); | |
| pa_sink_set_get_volume_callback(u->sink, sink_get_volume); | |
| pa_sink_set_set_volume_callback(u->sink, sink_set_volume); | |
| u->sink->n_volume_steps = 101; | |
| do_close = false; | |
| } | |
| if (u->source && (u->mixer_devmask & (SOUND_MASK_MIC|SOUND_MASK_RECLEV|SOUND_MASK_IGAIN))) { | |
| pa_log_debug("Found hardware mixer track for recording."); | |
| pa_source_set_get_volume_callback(u->source, source_get_volume); | |
| pa_source_set_set_volume_callback(u->source, source_set_volume); | |
| u->source->n_volume_steps = 101; | |
| do_close = false; | |
| } | |
| } | |
| if (do_close) { | |
| pa_close(u->mixer_fd); | |
| u->mixer_fd = -1; | |
| u->mixer_devmask = 0; | |
| } | |
| } | |
| go_on: | |
| pa_assert(u->source || u->sink); | |
| pa_memchunk_reset(&u->memchunk); | |
| if (!(u->thread = pa_thread_new("oss", thread_func, u))) { | |
| pa_log("Failed to create thread."); | |
| goto fail; | |
| } | |
| /* Read mixer settings */ | |
| if (u->sink) { | |
| if (sink_new_data.volume_is_set) { | |
| if (u->sink->set_volume) | |
| u->sink->set_volume(u->sink); | |
| } else { | |
| if (u->sink->get_volume) | |
| u->sink->get_volume(u->sink); | |
| } | |
| } | |
| if (u->source) { | |
| if (source_new_data.volume_is_set) { | |
| if (u->source->set_volume) | |
| u->source->set_volume(u->source); | |
| } else { | |
| if (u->source->get_volume) | |
| u->source->get_volume(u->source); | |
| } | |
| } | |
| if (u->sink) | |
| pa_sink_put(u->sink); | |
| if (u->source) | |
| pa_source_put(u->source); | |
| pa_modargs_free(ma); | |
| return 0; | |
| fail: | |
| if (u) | |
| pa__done(m); | |
| else if (fd >= 0) | |
| pa_close(fd); | |
| if (ma) | |
| pa_modargs_free(ma); | |
| return -1; | |
| } | |
| void pa__done(pa_module*m) { | |
| struct userdata *u; | |
| pa_assert(m); | |
| if (!(u = m->userdata)) | |
| return; | |
| if (u->sink) | |
| pa_sink_unlink(u->sink); | |
| if (u->source) | |
| pa_source_unlink(u->source); | |
| if (u->thread) { | |
| u->shutdown = true; | |
| pa_asyncmsgq_send(u->thread_mq.inq, NULL, PA_MESSAGE_SHUTDOWN, NULL, 0, NULL); | |
| pa_thread_free(u->thread); | |
| } | |
| pa_thread_mq_done(&u->thread_mq); | |
| if (u->sink) | |
| pa_sink_unref(u->sink); | |
| if (u->source) | |
| pa_source_unref(u->source); | |
| if (u->memchunk.memblock) | |
| pa_memblock_unref(u->memchunk.memblock); | |
| if (u->rtpoll_item) | |
| pa_rtpoll_item_free(u->rtpoll_item); | |
| if (u->rtpoll) | |
| pa_rtpoll_free(u->rtpoll); | |
| if (u->out_mmap_memblocks) { | |
| unsigned i; | |
| for (i = 0; i < u->out_nfrags; i++) | |
| if (u->out_mmap_memblocks[i]) | |
| pa_memblock_unref_fixed(u->out_mmap_memblocks[i]); | |
| pa_xfree(u->out_mmap_memblocks); | |
| } | |
| if (u->in_mmap_memblocks) { | |
| unsigned i; | |
| for (i = 0; i < u->in_nfrags; i++) | |
| if (u->in_mmap_memblocks[i]) | |
| pa_memblock_unref_fixed(u->in_mmap_memblocks[i]); | |
| pa_xfree(u->in_mmap_memblocks); | |
| } | |
| if (u->in_mmap && u->in_mmap != MAP_FAILED) | |
| munmap(u->in_mmap, u->in_hwbuf_size); | |
| if (u->out_mmap && u->out_mmap != MAP_FAILED) | |
| munmap(u->out_mmap, u->out_hwbuf_size); | |
| if (u->fd >= 0) | |
| pa_close(u->fd); | |
| if (u->mixer_fd >= 0) | |
| pa_close(u->mixer_fd); | |
| pa_xfree(u->device_name); | |
| pa_xfree(u); | |
| } |