pulseaudio/src/utils/padsp.c

1813 lines
45 KiB
C
Raw Normal View History

/* $Id$ */
/***
This file is part of polypaudio.
polypaudio 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 of the License,
or (at your option) any later version.
polypaudio 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 polypaudio; if not, write to the Free Software
Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
USA.
***/
#ifdef HAVE_CONFIG_H
#include <config.h>
#endif
#ifdef _FILE_OFFSET_BITS
#undef _FILE_OFFSET_BITS
#endif
#ifndef _LARGEFILE64_SOURCE
#define _LARGEFILE64_SOURCE 1
#endif
#include <sys/soundcard.h>
#include <sys/ioctl.h>
#include <pthread.h>
#include <unistd.h>
#include <sys/socket.h>
#include <dlfcn.h>
#include <errno.h>
#include <fcntl.h>
#include <string.h>
#include <stdarg.h>
#include <stdio.h>
#include <signal.h>
#include <linux/sockios.h>
#include <polyp/polypaudio.h>
#include <polypcore/llist.h>
#include <polypcore/gccmacro.h>
typedef enum {
FD_INFO_MIXER,
FD_INFO_PLAYBACK
} fd_info_type_t;
typedef struct fd_info fd_info;
struct fd_info {
pthread_mutex_t mutex;
int ref;
int unusable;
fd_info_type_t type;
int app_fd, thread_fd;
pa_sample_spec sample_spec;
size_t fragment_size;
unsigned n_fragments;
pa_threaded_mainloop *mainloop;
pa_context *context;
pa_stream *stream;
pa_io_event *io_event;
void *buf;
int operation_success;
pa_cvolume volume;
uint32_t sink_index;
int volume_modify_count;
PA_LLIST_FIELDS(fd_info);
};
static int dsp_drain(fd_info *i);
static void fd_info_remove_from_list(fd_info *i);
static pthread_mutex_t fd_infos_mutex = PTHREAD_MUTEX_INITIALIZER;
static pthread_mutex_t func_mutex = PTHREAD_MUTEX_INITIALIZER;
static PA_LLIST_HEAD(fd_info, fd_infos) = NULL;
static int (*_ioctl)(int, int, void*) = NULL;
static int (*_close)(int) = NULL;
static int (*_open)(const char *, int, mode_t) = NULL;
static FILE* (*_fopen)(const char *path, const char *mode) = NULL;
static int (*_open64)(const char *, int, mode_t) = NULL;
static FILE* (*_fopen64)(const char *path, const char *mode) = NULL;
static int (*_fclose)(FILE *f) = NULL;
/* dlsym() violates ISO C, so confide the breakage into this function to
* avoid warnings. */
typedef void (*fnptr)(void);
static inline fnptr dlsym_fn(void *handle, const char *symbol) {
return (fnptr) (long) dlsym(handle, symbol);
}
#define LOAD_IOCTL_FUNC() \
do { \
pthread_mutex_lock(&func_mutex); \
if (!_ioctl) \
_ioctl = (int (*)(int, int, void*)) dlsym_fn(RTLD_NEXT, "ioctl"); \
pthread_mutex_unlock(&func_mutex); \
} while(0)
#define LOAD_OPEN_FUNC() \
do { \
pthread_mutex_lock(&func_mutex); \
if (!_open) \
_open = (int (*)(const char *, int, mode_t)) dlsym_fn(RTLD_NEXT, "open"); \
pthread_mutex_unlock(&func_mutex); \
} while(0)
#define LOAD_OPEN64_FUNC() \
do { \
pthread_mutex_lock(&func_mutex); \
if (!_open64) \
_open64 = (int (*)(const char *, int, mode_t)) dlsym_fn(RTLD_NEXT, "open64"); \
pthread_mutex_unlock(&func_mutex); \
} while(0)
#define LOAD_CLOSE_FUNC() \
do { \
pthread_mutex_lock(&func_mutex); \
if (!_close) \
_close = (int (*)(int)) dlsym_fn(RTLD_NEXT, "close"); \
pthread_mutex_unlock(&func_mutex); \
} while(0)
#define LOAD_FOPEN_FUNC() \
do { \
pthread_mutex_lock(&func_mutex); \
if (!_fopen) \
_fopen = (FILE* (*)(const char *, const char*)) dlsym_fn(RTLD_NEXT, "fopen"); \
pthread_mutex_unlock(&func_mutex); \
} while(0)
#define LOAD_FOPEN64_FUNC() \
do { \
pthread_mutex_lock(&func_mutex); \
if (!_fopen64) \
_fopen64 = (FILE* (*)(const char *, const char*)) dlsym_fn(RTLD_NEXT, "fopen64"); \
pthread_mutex_unlock(&func_mutex); \
} while(0)
#define LOAD_FCLOSE_FUNC() \
do { \
pthread_mutex_lock(&func_mutex); \
if (!_fclose) \
_fclose = (int (*)(FILE *)) dlsym_fn(RTLD_NEXT, "fclose"); \
pthread_mutex_unlock(&func_mutex); \
} while(0)
#define CONTEXT_CHECK_DEAD_GOTO(i, label) do { \
if (!(i)->context || pa_context_get_state((i)->context) != PA_CONTEXT_READY) { \
debug(__FILE__": Not connected: %s", (i)->context ? pa_strerror(pa_context_errno((i)->context)) : "NULL"); \
goto label; \
} \
} while(0);
#define STREAM_CHECK_DEAD_GOTO(i, label) do { \
if (!(i)->context || pa_context_get_state((i)->context) != PA_CONTEXT_READY || \
!(i)->stream || pa_stream_get_state((i)->stream) != PA_STREAM_READY) { \
debug(__FILE__": Not connected: %s", (i)->context ? pa_strerror(pa_context_errno((i)->context)) : "NULL"); \
goto label; \
} \
} while(0);
static void debug(const char *format, ...) PA_GCC_PRINTF_ATTR(1,2);
static void debug(const char *format, ...) {
va_list ap;
if (getenv("PADSP_DEBUG")) {
va_start(ap, format);
vfprintf(stderr, format, ap);
va_end(ap);
}
}
static int padsp_disabled(void) {
static int *sym;
static int sym_resolved = 0;
/* If the current process has a symbol __padsp_disabled__ we use
* it to detect whether we should enable our stuff or not. A
* program needs to be compiled with -rdynamic for this to work!
* The symbol must be an int containing a three bit bitmask: bit 1
* -> disable /dev/dsp emulation, bit 2 -> disable /dev/sndstat
* emulation, bit 3 -> disable /dev/mixer emulation. Hence a value
* 7 disables padsp entirely. */
pthread_mutex_lock(&func_mutex);
if (!sym_resolved) {
sym = (int*) dlsym_fn(RTLD_DEFAULT, "__padsp_disabled__");
sym_resolved = 1;
}
pthread_mutex_unlock(&func_mutex);
if (!sym)
return 0;
return *sym;
}
static int dsp_cloak_enable(void) {
if (padsp_disabled() & 1)
return 0;
if (getenv("PADSP_NO_DSP"))
return 0;
return 1;
}
static int sndstat_cloak_enable(void) {
if (padsp_disabled() & 2)
return 0;
if (getenv("PADSP_NO_SNDSTAT"))
return 0;
return 1;
}
static int mixer_cloak_enable(void) {
if (padsp_disabled() & 4)
return 0;
if (getenv("PADSP_NO_MIXER"))
return 0;
return 1;
}
static pthread_key_t recursion_key;
static void recursion_key_alloc(void) {
pthread_key_create(&recursion_key, NULL);
}
static int function_enter(void) {
/* Avoid recursive calls */
static pthread_once_t recursion_key_once = PTHREAD_ONCE_INIT;
pthread_once(&recursion_key_once, recursion_key_alloc);
if (pthread_getspecific(recursion_key))
return 0;
pthread_setspecific(recursion_key, (void*) 1);
return 1;
}
static void function_exit(void) {
pthread_setspecific(recursion_key, NULL);
}
static void fd_info_free(fd_info *i) {
assert(i);
debug(__FILE__": freeing fd info (fd=%i)\n", i->app_fd);
dsp_drain(i);
if (i->mainloop)
pa_threaded_mainloop_stop(i->mainloop);
if (i->stream) {
pa_stream_disconnect(i->stream);
pa_stream_unref(i->stream);
}
if (i->context) {
pa_context_disconnect(i->context);
pa_context_unref(i->context);
}
if (i->mainloop)
pa_threaded_mainloop_free(i->mainloop);
if (i->app_fd >= 0) {
LOAD_CLOSE_FUNC();
_close(i->app_fd);
}
if (i->thread_fd >= 0) {
LOAD_CLOSE_FUNC();
_close(i->thread_fd);
}
free(i->buf);
pthread_mutex_destroy(&i->mutex);
free(i);
}
static fd_info *fd_info_ref(fd_info *i) {
assert(i);
pthread_mutex_lock(&i->mutex);
assert(i->ref >= 1);
i->ref++;
/* debug(__FILE__": ref++, now %i\n", i->ref); */
pthread_mutex_unlock(&i->mutex);
return i;
}
static void fd_info_unref(fd_info *i) {
int r;
pthread_mutex_lock(&i->mutex);
assert(i->ref >= 1);
r = --i->ref;
/* debug(__FILE__": ref--, now %i\n", i->ref); */
pthread_mutex_unlock(&i->mutex);
if (r <= 0)
fd_info_free(i);
}
static void context_state_cb(pa_context *c, void *userdata) {
fd_info *i = userdata;
assert(c);
switch (pa_context_get_state(c)) {
case PA_CONTEXT_READY:
case PA_CONTEXT_TERMINATED:
case PA_CONTEXT_FAILED:
pa_threaded_mainloop_signal(i->mainloop, 0);
break;
case PA_CONTEXT_UNCONNECTED:
case PA_CONTEXT_CONNECTING:
case PA_CONTEXT_AUTHORIZING:
case PA_CONTEXT_SETTING_NAME:
break;
}
}
static void reset_params(fd_info *i) {
assert(i);
i->sample_spec.format = PA_SAMPLE_ULAW;
i->sample_spec.channels = 1;
i->sample_spec.rate = 8000;
i->fragment_size = 1024;
i->n_fragments = 0;
}
static char *client_name(char *buf, size_t n) {
char p[PATH_MAX];
if (pa_get_binary_name(p, sizeof(p)))
snprintf(buf, n, "oss[%s]", pa_path_get_filename(p));
else
snprintf(buf, n, "oss");
return buf;
}
static void atfork_prepare(void) {
fd_info *i;
debug(__FILE__": atfork_prepare() enter\n");
function_enter();
pthread_mutex_lock(&fd_infos_mutex);
for (i = fd_infos; i; i = i->next) {
pthread_mutex_lock(&i->mutex);
pa_threaded_mainloop_lock(i->mainloop);
}
pthread_mutex_lock(&func_mutex);
debug(__FILE__": atfork_prepare() exit\n");
}
static void atfork_parent(void) {
fd_info *i;
debug(__FILE__": atfork_parent() enter\n");
pthread_mutex_unlock(&func_mutex);
for (i = fd_infos; i; i = i->next) {
pa_threaded_mainloop_unlock(i->mainloop);
pthread_mutex_unlock(&i->mutex);
}
pthread_mutex_unlock(&fd_infos_mutex);
function_exit();
debug(__FILE__": atfork_parent() exit\n");
}
static void atfork_child(void) {
fd_info *i;
debug(__FILE__": atfork_child() enter\n");
/* We do only the bare minimum to get all fds closed */
pthread_mutex_init(&func_mutex, NULL);
pthread_mutex_init(&fd_infos_mutex, NULL);
for (i = fd_infos; i; i = i->next) {
pthread_mutex_init(&i->mutex, NULL);
if (i->context) {
pa_context_disconnect(i->context);
pa_context_unref(i->context);
i->context = NULL;
}
if (i->stream) {
pa_stream_unref(i->stream);
i->stream = NULL;
}
if (i->app_fd >= 0) {
close(i->app_fd);
i->app_fd = -1;
}
if (i->thread_fd >= 0) {
close(i->thread_fd);
i->thread_fd = -1;
}
i->unusable = 1;
}
function_exit();
debug(__FILE__": atfork_child() exit\n");
}
static void install_atfork(void) {
pthread_atfork(atfork_prepare, atfork_parent, atfork_child);
}
static void stream_success_cb(pa_stream *s, int success, void *userdata) {
fd_info *i = userdata;
assert(s);
assert(i);
i->operation_success = success;
pa_threaded_mainloop_signal(i->mainloop, 0);
}
static void context_success_cb(pa_context *c, int success, void *userdata) {
fd_info *i = userdata;
assert(c);
assert(i);
i->operation_success = success;
pa_threaded_mainloop_signal(i->mainloop, 0);
}
static fd_info* fd_info_new(fd_info_type_t type, int *_errno) {
fd_info *i;
int sfds[2] = { -1, -1 };
char name[64];
static pthread_once_t install_atfork_once = PTHREAD_ONCE_INIT;
debug(__FILE__": fd_info_new()\n");
signal(SIGPIPE, SIG_IGN); /* Yes, ugly as hell */
pthread_once(&install_atfork_once, install_atfork);
if (!(i = malloc(sizeof(fd_info)))) {
*_errno = ENOMEM;
goto fail;
}
i->app_fd = i->thread_fd = -1;
i->type = type;
i->mainloop = NULL;
i->context = NULL;
i->stream = NULL;
i->io_event = NULL;
pthread_mutex_init(&i->mutex, NULL);
i->ref = 1;
i->buf = NULL;
i->unusable = 0;
pa_cvolume_reset(&i->volume, 2);
i->volume_modify_count = 0;
i->sink_index = (uint32_t) -1;
PA_LLIST_INIT(fd_info, i);
reset_params(i);
if (socketpair(AF_UNIX, SOCK_STREAM, 0, sfds) < 0) {
*_errno = errno;
debug(__FILE__": socket() failed: %s\n", strerror(errno));
goto fail;
}
i->app_fd = sfds[0];
i->thread_fd = sfds[1];
if (!(i->mainloop = pa_threaded_mainloop_new())) {
*_errno = EIO;
debug(__FILE__": pa_threaded_mainloop_new() failed\n");
goto fail;
}
if (!(i->context = pa_context_new(pa_threaded_mainloop_get_api(i->mainloop), client_name(name, sizeof(name))))) {
*_errno = EIO;
debug(__FILE__": pa_context_new() failed\n");
goto fail;
}
pa_context_set_state_callback(i->context, context_state_cb, i);
if (pa_context_connect(i->context, NULL, 0, NULL) < 0) {
*_errno = ECONNREFUSED;
debug(__FILE__": pa_context_connect() failed: %s\n", pa_strerror(pa_context_errno(i->context)));
goto fail;
}
pa_threaded_mainloop_lock(i->mainloop);
if (pa_threaded_mainloop_start(i->mainloop) < 0) {
*_errno = EIO;
debug(__FILE__": pa_threaded_mainloop_start() failed\n");
goto unlock_and_fail;
}
/* Wait until the context is ready */
pa_threaded_mainloop_wait(i->mainloop);
if (pa_context_get_state(i->context) != PA_CONTEXT_READY) {
*_errno = ECONNREFUSED;
debug(__FILE__": pa_context_connect() failed: %s\n", pa_strerror(pa_context_errno(i->context)));
goto unlock_and_fail;
}
pa_threaded_mainloop_unlock(i->mainloop);
return i;
unlock_and_fail:
pa_threaded_mainloop_unlock(i->mainloop);
fail:
if (i)
fd_info_unref(i);
return NULL;
}
static void fd_info_add_to_list(fd_info *i) {
assert(i);
pthread_mutex_lock(&fd_infos_mutex);
PA_LLIST_PREPEND(fd_info, fd_infos, i);
pthread_mutex_unlock(&fd_infos_mutex);
fd_info_ref(i);
}
static void fd_info_remove_from_list(fd_info *i) {
assert(i);
pthread_mutex_lock(&fd_infos_mutex);
PA_LLIST_REMOVE(fd_info, fd_infos, i);
pthread_mutex_unlock(&fd_infos_mutex);
fd_info_unref(i);
}
static fd_info* fd_info_find(int fd) {
fd_info *i;
pthread_mutex_lock(&fd_infos_mutex);
for (i = fd_infos; i; i = i->next)
if (i->app_fd == fd && !i->unusable) {
fd_info_ref(i);
break;
}
pthread_mutex_unlock(&fd_infos_mutex);
return i;
}
static void fix_metrics(fd_info *i) {
size_t fs;
char t[PA_SAMPLE_SPEC_SNPRINT_MAX];
fs = pa_frame_size(&i->sample_spec);
i->fragment_size = (i->fragment_size/fs)*fs;
if (i->n_fragments < 2)
i->n_fragments = 12;
if (i->fragment_size <= 0)
if ((i->fragment_size = pa_bytes_per_second(&i->sample_spec) / 2 / i->n_fragments) <= 0)
i->fragment_size = 1024;
debug(__FILE__": sample spec: %s\n", pa_sample_spec_snprint(t, sizeof(t), &i->sample_spec));
debug(__FILE__": fixated metrics to %i fragments, %li bytes each.\n", i->n_fragments, (long)i->fragment_size);
}
static void stream_request_cb(pa_stream *s, size_t length, void *userdata) {
fd_info *i = userdata;
assert(s);
if (i->io_event) {
pa_mainloop_api *api;
api = pa_threaded_mainloop_get_api(i->mainloop);
api->io_enable(i->io_event, PA_IO_EVENT_INPUT);
}
}
static void stream_latency_update_cb(pa_stream *s, void *userdata) {
fd_info *i = userdata;
assert(s);
pa_threaded_mainloop_signal(i->mainloop, 0);
}
static void fd_info_shutdown(fd_info *i) {
assert(i);
if (i->io_event) {
pa_mainloop_api *api;
api = pa_threaded_mainloop_get_api(i->mainloop);
api->io_free(i->io_event);
i->io_event = NULL;
}
if (i->thread_fd >= 0) {
close(i->thread_fd);
i->thread_fd = -1;
}
}
static int fd_info_copy_data(fd_info *i, int force) {
size_t n;
if (!i->stream)
return -1;
if ((n = pa_stream_writable_size(i->stream)) == (size_t) -1) {
debug(__FILE__": pa_stream_writable_size(): %s\n", pa_strerror(pa_context_errno(i->context)));
return -1;
}
while (n >= i->fragment_size || force) {
ssize_t r;
if (!i->buf) {
if (!(i->buf = malloc(i->fragment_size))) {
debug(__FILE__": malloc() failed.\n");
return -1;
}
}
if ((r = read(i->thread_fd, i->buf, i->fragment_size)) <= 0) {
if (errno == EAGAIN)
break;
debug(__FILE__": read(): %s\n", r == 0 ? "EOF" : strerror(errno));
return -1;
}
if (pa_stream_write(i->stream, i->buf, r, free, 0, PA_SEEK_RELATIVE) < 0) {
debug(__FILE__": pa_stream_write(): %s\n", pa_strerror(pa_context_errno(i->context)));
return -1;
}
i->buf = NULL;
assert(n >= (size_t) r);
n -= r;
}
if (i->io_event) {
pa_mainloop_api *api;
api = pa_threaded_mainloop_get_api(i->mainloop);
api->io_enable(i->io_event, n >= i->fragment_size ? PA_IO_EVENT_INPUT : 0);
}
return 0;
}
static void stream_state_cb(pa_stream *s, void * userdata) {
fd_info *i = userdata;
assert(s);
switch (pa_stream_get_state(s)) {
case PA_STREAM_READY:
debug(__FILE__": stream established.\n");
break;
case PA_STREAM_FAILED:
debug(__FILE__": pa_stream_connect_playback() failed: %s\n", pa_strerror(pa_context_errno(i->context)));
fd_info_shutdown(i);
break;
case PA_STREAM_TERMINATED:
case PA_STREAM_UNCONNECTED:
case PA_STREAM_CREATING:
break;
}
}
static int create_stream(fd_info *i) {
pa_buffer_attr attr;
int n;
assert(i);
fix_metrics(i);
if (!(i->stream = pa_stream_new(i->context, "Audio Stream", &i->sample_spec, NULL))) {
debug(__FILE__": pa_stream_new() failed: %s\n", pa_strerror(pa_context_errno(i->context)));
goto fail;
}
pa_stream_set_state_callback(i->stream, stream_state_cb, i);
pa_stream_set_write_callback(i->stream, stream_request_cb, i);
pa_stream_set_latency_update_callback(i->stream, stream_latency_update_cb, i);
memset(&attr, 0, sizeof(attr));
attr.maxlength = i->fragment_size * (i->n_fragments+1);
attr.tlength = i->fragment_size * i->n_fragments;
attr.prebuf = i->fragment_size;
attr.minreq = i->fragment_size;
if (pa_stream_connect_playback(i->stream, NULL, &attr, PA_STREAM_INTERPOLATE_TIMING|PA_STREAM_AUTO_TIMING_UPDATE, NULL, NULL) < 0) {
debug(__FILE__": pa_stream_connect_playback() failed: %s\n", pa_strerror(pa_context_errno(i->context)));
goto fail;
}
n = i->fragment_size;
setsockopt(i->app_fd, SOL_SOCKET, SO_SNDBUF, &n, sizeof(n));
n = i->fragment_size;
setsockopt(i->thread_fd, SOL_SOCKET, SO_RCVBUF, &n, sizeof(n));
return 0;
fail:
return -1;
}
static void free_stream(fd_info *i) {
assert(i);
if (i->stream) {
pa_stream_disconnect(i->stream);
pa_stream_unref(i->stream);
i->stream = NULL;
}
}
static void io_event_cb(pa_mainloop_api *api, pa_io_event *e, int fd, pa_io_event_flags_t flags, void *userdata) {
fd_info *i = userdata;
pa_threaded_mainloop_signal(i->mainloop, 0);
if (flags & PA_IO_EVENT_INPUT) {
if (!i->stream) {
api->io_enable(e, 0);
if (create_stream(i) < 0)
goto fail;
} else {
if (fd_info_copy_data(i, 0) < 0)
goto fail;
}
} else if (flags & (PA_IO_EVENT_HANGUP|PA_IO_EVENT_ERROR))
goto fail;
return;
fail:
/* We can't do anything better than removing the event source */
fd_info_shutdown(i);
}
static int dsp_open(int flags, int *_errno) {
fd_info *i;
pa_mainloop_api *api;
int ret;
int f;
if ((flags != O_WRONLY) && (flags != (O_WRONLY|O_NONBLOCK))) {
*_errno = EACCES;
return -1;
}
if (!(i = fd_info_new(FD_INFO_PLAYBACK, _errno)))
return -1;
shutdown(i->thread_fd, SHUT_WR);
shutdown(i->app_fd, SHUT_RD);
if ((flags & O_NONBLOCK) == O_NONBLOCK) {
if ((f = fcntl(i->app_fd, F_GETFL)) >= 0)
fcntl(i->app_fd, F_SETFL, f|O_NONBLOCK);
}
if ((f = fcntl(i->thread_fd, F_GETFL)) >= 0)
fcntl(i->thread_fd, F_SETFL, f|O_NONBLOCK);
fcntl(i->app_fd, F_SETFD, FD_CLOEXEC);
fcntl(i->thread_fd, F_SETFD, FD_CLOEXEC);
pa_threaded_mainloop_lock(i->mainloop);
api = pa_threaded_mainloop_get_api(i->mainloop);
if (!(i->io_event = api->io_new(api, i->thread_fd, PA_IO_EVENT_INPUT, io_event_cb, i)))
goto fail;
pa_threaded_mainloop_unlock(i->mainloop);
debug(__FILE__": dsp_open() succeeded, fd=%i\n", i->app_fd);
fd_info_add_to_list(i);
ret = i->app_fd;
fd_info_unref(i);
return ret;
fail:
pa_threaded_mainloop_unlock(i->mainloop);
if (i)
fd_info_unref(i);
*_errno = EIO;
debug(__FILE__": dsp_open() failed\n");
return -1;
}
static void sink_info_cb(pa_context *context, const pa_sink_info *si, int eol, void *userdata) {
fd_info *i = userdata;
if (!si && eol < 0) {
i->operation_success = 0;
pa_threaded_mainloop_signal(i->mainloop, 0);
return;
}
if (eol)
return;
if (!pa_cvolume_equal(&i->volume, &si->volume))
i->volume_modify_count++;
i->volume = si->volume;
i->sink_index = si->index;
i->operation_success = 1;
pa_threaded_mainloop_signal(i->mainloop, 0);
}
static void subscribe_cb(pa_context *context, pa_subscription_event_type_t t, uint32_t idx, void *userdata) {
fd_info *i = userdata;
pa_operation *o = NULL;
if (i->sink_index != idx)
return;
if ((t & PA_SUBSCRIPTION_EVENT_TYPE_MASK) != PA_SUBSCRIPTION_EVENT_CHANGE)
return;
if (!(o = pa_context_get_sink_info_by_index(i->context, i->sink_index, sink_info_cb, i))) {
debug(__FILE__": Failed to get sink info: %s", pa_strerror(pa_context_errno(i->context)));
return;
}
pa_operation_unref(o);
}
static int mixer_open(int flags, int *_errno) {
fd_info *i;
pa_operation *o;
int ret;
if (!(i = fd_info_new(FD_INFO_MIXER, _errno)))
return -1;
pa_threaded_mainloop_lock(i->mainloop);
pa_context_set_subscribe_callback(i->context, subscribe_cb, i);
if (!(o = pa_context_subscribe(i->context, PA_SUBSCRIPTION_MASK_SINK, context_success_cb, i))) {
debug(__FILE__": Failed to subscribe to events: %s", pa_strerror(pa_context_errno(i->context)));
*_errno = EIO;
goto fail;
}
i->operation_success = 0;
while (pa_operation_get_state(o) != PA_OPERATION_DONE) {
pa_threaded_mainloop_wait(i->mainloop);
CONTEXT_CHECK_DEAD_GOTO(i, fail);
}
if (!i->operation_success) {
debug(__FILE__":Failed to subscribe to events: %s", pa_strerror(pa_context_errno(i->context)));
*_errno = EIO;
goto fail;
}
/* Get sink info */
pa_operation_unref(o);
if (!(o = pa_context_get_sink_info_by_name(i->context, NULL, sink_info_cb, i))) {
debug(__FILE__": Failed to get sink info: %s", pa_strerror(pa_context_errno(i->context)));
*_errno = EIO;
goto fail;
}
i->operation_success = 0;
while (pa_operation_get_state(o) != PA_OPERATION_DONE) {
pa_threaded_mainloop_wait(i->mainloop);
CONTEXT_CHECK_DEAD_GOTO(i, fail);
}
if (!i->operation_success) {
debug(__FILE__": Failed to get sink info: %s", pa_strerror(pa_context_errno(i->context)));
*_errno = EIO;
goto fail;
}
pa_threaded_mainloop_unlock(i->mainloop);
debug(__FILE__": mixer_open() succeeded, fd=%i\n", i->app_fd);
fd_info_add_to_list(i);
ret = i->app_fd;
fd_info_unref(i);
return ret;
fail:
pa_threaded_mainloop_unlock(i->mainloop);
if (i)
fd_info_unref(i);
*_errno = EIO;
debug(__FILE__": mixer_open() failed\n");
return -1;
}
static int sndstat_open(int flags, int *_errno) {
static const char sndstat[] =
"Sound Driver:3.8.1a-980706 (Polypaudio Virtual OSS)\n"
"Kernel: POSIX\n"
"Config options: 0\n"
"\n"
"Installed drivers:\n"
"Type 255: Polypaudio Virtual OSS\n"
"\n"
"Card config:\n"
"Polypaudio Virtual OSS\n"
"\n"
"Audio devices:\n"
"0: Polypaudio Virtual OSS\n"
"\n"
"Synth devices: NOT ENABLED IN CONFIG\n"
"\n"
"Midi devices:\n"
"\n"
"Timers:\n"
"\n"
"Mixers:\n"
"0: Polypaudio Virtual OSS\n";
char fn[] = "/tmp/padsp-sndstat-XXXXXX";
mode_t u;
int fd = -1;
int e;
debug(__FILE__": sndstat_open()\n");
if (flags != O_RDONLY && flags != (O_RDONLY|O_LARGEFILE)) {
*_errno = EACCES;
debug(__FILE__": bad access!\n");
goto fail;
}
u = umask(0077);
fd = mkstemp(fn);
e = errno;
umask(u);
if (fd < 0) {
*_errno = e;
debug(__FILE__": mkstemp() failed: %s\n", strerror(errno));
goto fail;
}
unlink(fn);
if (write(fd, sndstat, sizeof(sndstat) -1) != sizeof(sndstat)-1) {
*_errno = errno;
debug(__FILE__": write() failed: %s\n", strerror(errno));
goto fail;
}
if (lseek(fd, SEEK_SET, 0) < 0) {
*_errno = errno;
debug(__FILE__": lseek() failed: %s\n", strerror(errno));
goto fail;
}
return fd;
fail:
if (fd >= 0)
close(fd);
return -1;
}
int open(const char *filename, int flags, ...) {
va_list args;
mode_t mode = 0;
int r, _errno = 0;
debug(__FILE__": open(%s)\n", filename);
va_start(args, flags);
if (flags & O_CREAT)
mode = va_arg(args, mode_t);
va_end(args);
if (!function_enter()) {
LOAD_OPEN_FUNC();
return _open(filename, flags, mode);
}
if (dsp_cloak_enable() && (strcmp(filename, "/dev/dsp") == 0 || strcmp(filename, "/dev/adsp") == 0)) {
r = dsp_open(flags, &_errno);
} else if (mixer_cloak_enable() && strcmp(filename, "/dev/mixer") == 0) {
r = mixer_open(flags, &_errno);
} else if (sndstat_cloak_enable() && strcmp(filename, "/dev/sndstat") == 0) {
r = sndstat_open(flags, &_errno);
} else {
function_exit();
LOAD_OPEN_FUNC();
return _open(filename, flags, mode);
}
function_exit();
if (_errno)
errno = _errno;
return r;
}
static int mixer_ioctl(fd_info *i, unsigned long request, void*argp, int *_errno) {
int ret = -1;
switch (request) {
case SOUND_MIXER_READ_DEVMASK :
debug(__FILE__": SOUND_MIXER_READ_DEVMASK\n");
*(int*) argp = SOUND_MASK_PCM;
break;
case SOUND_MIXER_READ_RECMASK :
debug(__FILE__": SOUND_MIXER_READ_RECMASK\n");
*(int*) argp = 0;
break;
case SOUND_MIXER_READ_STEREODEVS:
debug(__FILE__": SOUND_MIXER_READ_STEREODEVS\n");
pa_threaded_mainloop_lock(i->mainloop);
*(int*) argp = i->volume.channels > 1 ? SOUND_MASK_PCM : 0;
pa_threaded_mainloop_unlock(i->mainloop);
break;
case SOUND_MIXER_READ_RECSRC:
debug(__FILE__": SOUND_MIXER_READ_RECSRC\n");
*(int*) argp = 0;
break;
case SOUND_MIXER_CAPS:
debug(__FILE__": SOUND_MIXER_CAPS\n");
*(int*) argp = 0;
break;
case SOUND_MIXER_READ_PCM:
debug(__FILE__": SOUND_MIXER_READ_PCM\n");
pa_threaded_mainloop_lock(i->mainloop);
*(int*) argp =
((i->volume.values[0]*100/PA_VOLUME_NORM)) |
((i->volume.values[i->volume.channels > 1 ? 1 : 0]*100/PA_VOLUME_NORM) << 8);
pa_threaded_mainloop_unlock(i->mainloop);
break;
case SOUND_MIXER_WRITE_PCM: {
pa_cvolume v;
debug(__FILE__": SOUND_MIXER_WRITE_PCM\n");
pa_threaded_mainloop_lock(i->mainloop);
v = i->volume;
i->volume.values[0] = ((*(int*) argp & 0xFF)*PA_VOLUME_NORM)/100;
i->volume.values[1] = ((*(int*) argp >> 8)*PA_VOLUME_NORM)/100;
if (!pa_cvolume_equal(&i->volume, &v)) {
pa_operation *o;
if (!(o = pa_context_set_sink_volume_by_index(i->context, i->sink_index, &i->volume, NULL, NULL)))
debug(__FILE__":Failed set volume: %s", pa_strerror(pa_context_errno(i->context)));
else {
i->operation_success = 0;
while (pa_operation_get_state(o) != PA_OPERATION_DONE) {
CONTEXT_CHECK_DEAD_GOTO(i, exit_loop);
pa_threaded_mainloop_wait(i->mainloop);
}
exit_loop:
if (!i->operation_success)
debug(__FILE__": Failed to set volume: %s\n", pa_strerror(pa_context_errno(i->context)));
pa_operation_unref(o);
}
/* We don't wait for completion here */
i->volume_modify_count++;
}
pa_threaded_mainloop_unlock(i->mainloop);
break;
}
case SOUND_MIXER_INFO: {
mixer_info *mi = argp;
memset(mi, 0, sizeof(mixer_info));
strncpy(mi->id, "POLYPAUDIO", sizeof(mi->id));
strncpy(mi->name, "Polypaudio Virtual OSS", sizeof(mi->name));
pa_threaded_mainloop_lock(i->mainloop);
mi->modify_counter = i->volume_modify_count;
pa_threaded_mainloop_unlock(i->mainloop);
break;
}
default:
debug(__FILE__": unknwon ioctl 0x%08lx\n", request);
*_errno = EINVAL;
goto fail;
}
ret = 0;
fail:
return ret;
}
static int map_format(int *fmt, pa_sample_spec *ss) {
switch (*fmt) {
case AFMT_MU_LAW:
ss->format = PA_SAMPLE_ULAW;
break;
case AFMT_A_LAW:
ss->format = PA_SAMPLE_ALAW;
break;
case AFMT_S8:
*fmt = AFMT_U8;
/* fall through */
case AFMT_U8:
ss->format = PA_SAMPLE_U8;
break;
case AFMT_U16_BE:
*fmt = AFMT_S16_BE;
/* fall through */
case AFMT_S16_BE:
ss->format = PA_SAMPLE_S16BE;
break;
case AFMT_U16_LE:
*fmt = AFMT_S16_LE;
/* fall through */
case AFMT_S16_LE:
ss->format = PA_SAMPLE_S16LE;
break;
default:
ss->format = PA_SAMPLE_S16NE;
*fmt = AFMT_S16_NE;
break;
}
return 0;
}
static int map_format_back(pa_sample_format_t format) {
switch (format) {
case PA_SAMPLE_S16LE: return AFMT_S16_LE;
case PA_SAMPLE_S16BE: return AFMT_S16_BE;
case PA_SAMPLE_ULAW: return AFMT_MU_LAW;
case PA_SAMPLE_ALAW: return AFMT_A_LAW;
case PA_SAMPLE_U8: return AFMT_U8;
default:
abort();
}
}
static int dsp_flush_socket(fd_info *i) {
int l;
if (i->thread_fd < 0)
return -1;
if (ioctl(i->thread_fd, SIOCINQ, &l) < 0) {
debug(__FILE__": SIOCINQ: %s\n", strerror(errno));
return -1;
}
while (l > 0) {
char buf[1024];
size_t k;
k = (size_t) l > sizeof(buf) ? sizeof(buf) : (size_t) l;
if (read(i->thread_fd, buf, k) < 0)
debug(__FILE__": read(): %s\n", strerror(errno));
l -= k;
}
return 0;
}
static int dsp_empty_socket(fd_info *i) {
int ret = -1;
/* Empty the socket */
for (;;) {
int l;
if (i->thread_fd < 0)
break;
if (ioctl(i->thread_fd, SIOCINQ, &l) < 0) {
debug(__FILE__": SIOCINQ: %s\n", strerror(errno));
break;
}
if (!l) {
ret = 0;
break;
}
pa_threaded_mainloop_wait(i->mainloop);
}
return ret;
}
static int dsp_drain(fd_info *i) {
pa_operation *o = NULL;
int r = -1;
if (!i->mainloop)
return 0;
debug(__FILE__": Draining.\n");
pa_threaded_mainloop_lock(i->mainloop);
if (dsp_empty_socket(i) < 0)
goto fail;
if (!i->stream)
goto fail;
debug(__FILE__": Really draining.\n");
if (!(o = pa_stream_drain(i->stream, stream_success_cb, i))) {
debug(__FILE__": pa_stream_drain(): %s\n", pa_strerror(pa_context_errno(i->context)));
goto fail;
}
i->operation_success = 0;
while (pa_operation_get_state(o) != PA_OPERATION_DONE) {
STREAM_CHECK_DEAD_GOTO(i, fail);
pa_threaded_mainloop_wait(i->mainloop);
}
if (!i->operation_success) {
debug(__FILE__": pa_stream_drain() 2: %s\n", pa_strerror(pa_context_errno(i->context)));
goto fail;
}
r = 0;
fail:
if (o)
pa_operation_unref(o);
pa_threaded_mainloop_unlock(i->mainloop);
return 0;
}
static int dsp_trigger(fd_info *i) {
pa_operation *o = NULL;
int r = -1;
if (!i->stream)
return 0;
pa_threaded_mainloop_lock(i->mainloop);
if (dsp_empty_socket(i) < 0)
goto fail;
debug(__FILE__": Triggering.\n");
if (!(o = pa_stream_trigger(i->stream, stream_success_cb, i))) {
debug(__FILE__": pa_stream_trigger(): %s\n", pa_strerror(pa_context_errno(i->context)));
goto fail;
}
i->operation_success = 0;
while (!pa_operation_get_state(o) != PA_OPERATION_DONE) {
STREAM_CHECK_DEAD_GOTO(i, fail);
pa_threaded_mainloop_wait(i->mainloop);
}
if (!i->operation_success) {
debug(__FILE__": pa_stream_trigger(): %s\n", pa_strerror(pa_context_errno(i->context)));
goto fail;
}
r = 0;
fail:
if (o)
pa_operation_unref(o);
pa_threaded_mainloop_unlock(i->mainloop);
return 0;
}
static int dsp_ioctl(fd_info *i, unsigned long request, void*argp, int *_errno) {
int ret = -1;
switch (request) {
case SNDCTL_DSP_SETFMT: {
debug(__FILE__": SNDCTL_DSP_SETFMT: %i\n", *(int*) argp);
pa_threaded_mainloop_lock(i->mainloop);
if (*(int*) argp == AFMT_QUERY)
*(int*) argp = map_format_back(i->sample_spec.format);
else {
map_format((int*) argp, &i->sample_spec);
free_stream(i);
}
pa_threaded_mainloop_unlock(i->mainloop);
break;
}
case SNDCTL_DSP_SPEED: {
pa_sample_spec ss;
int valid;
char t[256];
debug(__FILE__": SNDCTL_DSP_SPEED: %i\n", *(int*) argp);
pa_threaded_mainloop_lock(i->mainloop);
ss = i->sample_spec;
ss.rate = *(int*) argp;
if ((valid = pa_sample_spec_valid(&ss))) {
i->sample_spec = ss;
free_stream(i);
}
debug(__FILE__": ss: %s\n", pa_sample_spec_snprint(t, sizeof(t), &i->sample_spec));
pa_threaded_mainloop_unlock(i->mainloop);
if (!valid) {
*_errno = EINVAL;
goto fail;
}
break;
}
case SNDCTL_DSP_STEREO:
debug(__FILE__": SNDCTL_DSP_STEREO: %i\n", *(int*) argp);
pa_threaded_mainloop_lock(i->mainloop);
i->sample_spec.channels = *(int*) argp ? 2 : 1;
free_stream(i);
pa_threaded_mainloop_unlock(i->mainloop);
return 0;
case SNDCTL_DSP_CHANNELS: {
pa_sample_spec ss;
int valid;
debug(__FILE__": SNDCTL_DSP_CHANNELS: %i\n", *(int*) argp);
pa_threaded_mainloop_lock(i->mainloop);
ss = i->sample_spec;
ss.channels = *(int*) argp;
if ((valid = pa_sample_spec_valid(&ss))) {
i->sample_spec = ss;
free_stream(i);
}
pa_threaded_mainloop_unlock(i->mainloop);
if (!valid) {
*_errno = EINVAL;
goto fail;
}
break;
}
case SNDCTL_DSP_GETBLKSIZE:
debug(__FILE__": SNDCTL_DSP_GETBLKSIZE\n");
pa_threaded_mainloop_lock(i->mainloop);
fix_metrics(i);
*(int*) argp = i->fragment_size;
pa_threaded_mainloop_unlock(i->mainloop);
break;
case SNDCTL_DSP_SETFRAGMENT:
debug(__FILE__": SNDCTL_DSP_SETFRAGMENT: 0x%8x\n", *(int*) argp);
pa_threaded_mainloop_lock(i->mainloop);
i->fragment_size = 1 << (*(int*) argp);
i->n_fragments = (*(int*) argp) >> 16;
free_stream(i);
pa_threaded_mainloop_unlock(i->mainloop);
break;
case SNDCTL_DSP_GETCAPS:
debug(__FILE__": SNDCTL_DSP_CAPS\n");
*(int*) argp = DSP_CAP_MULTI;
break;
case SNDCTL_DSP_GETODELAY: {
int l;
debug(__FILE__": SNDCTL_DSP_GETODELAY\n");
pa_threaded_mainloop_lock(i->mainloop);
*(int*) argp = 0;
for (;;) {
pa_usec_t usec;
STREAM_CHECK_DEAD_GOTO(i, exit_loop);
if (pa_stream_get_latency(i->stream, &usec, NULL) >= 0) {
*(int*) argp = pa_usec_to_bytes(usec, &i->sample_spec);
break;
}
if (pa_context_errno(i->context) != PA_ERR_NODATA) {
debug(__FILE__": pa_stream_get_latency(): %s\n", pa_strerror(pa_context_errno(i->context)));
break;
}
pa_threaded_mainloop_wait(i->mainloop);
}
exit_loop:
if (ioctl(i->thread_fd, SIOCINQ, &l) < 0)
debug(__FILE__": SIOCINQ failed: %s\n", strerror(errno));
else
*(int*) argp += l;
pa_threaded_mainloop_unlock(i->mainloop);
debug(__FILE__": ODELAY: %i\n", *(int*) argp);
break;
}
case SNDCTL_DSP_RESET: {
debug(__FILE__": SNDCTL_DSP_RESET\n");
pa_threaded_mainloop_lock(i->mainloop);
free_stream(i);
dsp_flush_socket(i);
reset_params(i);
pa_threaded_mainloop_unlock(i->mainloop);
break;
}
case SNDCTL_DSP_GETFMTS: {
debug(__FILE__": SNDCTL_DSP_GETFMTS\n");
*(int*) argp = AFMT_MU_LAW|AFMT_A_LAW|AFMT_U8|AFMT_S16_LE|AFMT_S16_BE;
break;
}
case SNDCTL_DSP_POST:
debug(__FILE__": SNDCTL_DSP_POST\n");
if (dsp_trigger(i) < 0)
*_errno = EIO;
break;
case SNDCTL_DSP_SYNC:
debug(__FILE__": SNDCTL_DSP_SYNC\n");
if (dsp_drain(i) < 0)
*_errno = EIO;
break;
case SNDCTL_DSP_GETOSPACE: {
audio_buf_info *bi = (audio_buf_info*) argp;
int l;
size_t k = 0;
debug(__FILE__": SNDCTL_DSP_GETOSPACE\n");
pa_threaded_mainloop_lock(i->mainloop);
fix_metrics(i);
if (i->stream) {
if ((k = pa_stream_writable_size(i->stream)) == (size_t) -1)
debug(__FILE__": pa_stream_writable_size(): %s\n", pa_strerror(pa_context_errno(i->context)));
} else
k = i->fragment_size * i->n_fragments;
if (ioctl(i->thread_fd, SIOCINQ, &l) < 0) {
debug(__FILE__": SIOCINQ failed: %s\n", strerror(errno));
l = 0;
}
bi->fragsize = i->fragment_size;
bi->fragstotal = i->n_fragments;
bi->bytes = k > (size_t) l ? k - l : 0;
bi->fragments = bi->bytes / bi->fragsize;
pa_threaded_mainloop_unlock(i->mainloop);
debug(__FILE__": fragsize=%i, fragstotal=%i, bytes=%i, fragments=%i\n", bi->fragsize, bi->fragstotal, bi->bytes, bi->fragments);
break;
}
default:
debug(__FILE__": unknwon ioctl 0x%08lx\n", request);
*_errno = EINVAL;
goto fail;
}
ret = 0;
fail:
return ret;
}
int ioctl(int fd, unsigned long request, ...) {
fd_info *i;
va_list args;
void *argp;
int r, _errno = 0;
debug(__FILE__": ioctl()\n");
va_start(args, request);
argp = va_arg(args, void *);
va_end(args);
if (!function_enter()) {
LOAD_IOCTL_FUNC();
return _ioctl(fd, request, argp);
}
if (!(i = fd_info_find(fd))) {
function_exit();
LOAD_IOCTL_FUNC();
return _ioctl(fd, request, argp);
}
if (i->type == FD_INFO_MIXER)
r = mixer_ioctl(i, request, argp, &_errno);
else
r = dsp_ioctl(i, request, argp, &_errno);
fd_info_unref(i);
if (_errno)
errno = _errno;
function_exit();
return r;
}
int close(int fd) {
fd_info *i;
debug(__FILE__": close()\n");
if (!function_enter()) {
LOAD_CLOSE_FUNC();
return _close(fd);
}
if (!(i = fd_info_find(fd))) {
function_exit();
LOAD_CLOSE_FUNC();
return _close(fd);
}
fd_info_remove_from_list(i);
fd_info_unref(i);
function_exit();
return 0;
}
int open64(const char *filename, int flags, ...) {
va_list args;
mode_t mode = 0;
debug(__FILE__": open64(%s)\n", filename);
va_start(args, flags);
if (flags & O_CREAT)
mode = va_arg(args, mode_t);
va_end(args);
if (strcmp(filename, "/dev/dsp") != 0 &&
strcmp(filename, "/dev/adsp") != 0 &&
strcmp(filename, "/dev/sndstat") != 0 &&
strcmp(filename, "/dev/mixer") != 0) {
LOAD_OPEN64_FUNC();
return _open64(filename, flags, mode);
}
return open(filename, flags, mode);
}
FILE* fopen(const char *filename, const char *mode) {
FILE *f = NULL;
int fd;
mode_t m;
debug(__FILE__": fopen(%s)\n", filename);
if (strcmp(filename, "/dev/dsp") == 0 ||
strcmp(filename, "/dev/adsp") == 0) {
if (strcmp(mode, "wb") != 0) {
errno = EACCES;
return NULL;
}
m = O_WRONLY;
} else if (strcmp(filename, "/dev/sndstat") == 0) {
if (strcmp(mode, "r") != 0) {
errno = EACCES;
return NULL;
}
m = O_RDONLY;
} else if (strcmp(filename, "/dev/mixer") == 0)
m = O_RDWR;
else {
LOAD_FOPEN_FUNC();
return _fopen(filename, mode);
}
if ((fd = open(filename, m)) < 0)
return NULL;
if (!(f = fdopen(fd, mode))) {
close(fd);
return NULL;
}
return f;
}
FILE *fopen64(const char *filename, const char *mode) {
debug(__FILE__": fopen64(%s)\n", filename);
if (strcmp(filename, "/dev/dsp") != 0 &&
strcmp(filename, "/dev/adsp") != 0 &&
strcmp(filename, "/dev/sndstat") != 0 &&
strcmp(filename, "/dev/mixer") != 0) {
LOAD_FOPEN64_FUNC();
return _fopen64(filename, mode);
}
return fopen(filename, mode);
}
int fclose(FILE *f) {
fd_info *i;
debug(__FILE__": fclose()\n");
if (!function_enter()) {
LOAD_FCLOSE_FUNC();
return _fclose(f);
}
if (!(i = fd_info_find(fileno(f)))) {
function_exit();
LOAD_FCLOSE_FUNC();
return _fclose(f);
}
fd_info_remove_from_list(i);
/* Dirty trick to avoid that the fd is not freed twice, once by us
* and once by the real fclose() */
i->app_fd = -1;
fd_info_unref(i);
function_exit();
LOAD_FCLOSE_FUNC();
return _fclose(f);
}