1 files changed, 404 insertions, 0 deletions

diff --git a/polyp/module-oss-mmap.c b/polyp/module-oss-mmap.c
new file mode 100644
index 00000000..800eaf25
--- /dev/null
+++ b/polyp/module-oss-mmap.c
@@ -0,0 +1,404 @@
+/* $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 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 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
+
+#include <sys/soundcard.h>
+#include <sys/ioctl.h>
+#include <stdlib.h>
+#include <sys/stat.h>
+#include <stdio.h>
+#include <assert.h>
+#include <errno.h>
+#include <string.h>
+#include <fcntl.h>
+#include <unistd.h>
+#include <limits.h>
+#include <sys/mman.h>
+
+#include "iochannel.h"
+#include "sink.h"
+#include "source.h"
+#include "module.h"
+#include "oss-util.h"
+#include "sample-util.h"
+#include "util.h"
+#include "modargs.h"
+
+struct userdata {
+    struct pa_sink *sink;
+    struct pa_source *source;
+    struct pa_core *core;
+    struct pa_sample_spec sample_spec;
+
+    size_t in_fragment_size, out_fragment_size, in_fragments, out_fragments, out_fill;
+
+    int fd;
+
+    void *in_mmap, *out_mmap;
+    size_t in_mmap_length, out_mmap_length;
+
+    void *mainloop_source;
+
+    struct pa_memblock **in_memblocks, **out_memblocks;
+    unsigned out_current, in_current;
+};
+
+static const char* const valid_modargs[] = {
+    "sink_name",
+    "source_name",
+    "device",
+    "record",
+    "playback",
+    "fragments",
+    "fragment_size",
+    "format",
+    "rate",
+    "channels",
+    NULL
+};
+
+#define DEFAULT_SINK_NAME "oss_output"
+#define DEFAULT_SOURCE_NAME "oss_input"
+#define DEFAULT_DEVICE "/dev/dsp"
+
+static void out_fill_memblocks(struct userdata *u, unsigned n) {
+    assert(u && u->out_memblocks);
+    
+    while (n > 0) {
+        struct pa_memchunk chunk;
+        
+        if (u->out_memblocks[u->out_current])
+            pa_memblock_unref_fixed(u->out_memblocks[u->out_current]);
+            
+        chunk.memblock = u->out_memblocks[u->out_current] = pa_memblock_new_fixed(u->out_mmap+u->out_fragment_size*u->out_current, u->out_fragment_size);
+        assert(chunk.memblock);
+        chunk.length = chunk.memblock->length;
+        chunk.index = 0;
+        
+        pa_sink_render_into_full(u->sink, &chunk);
+            
+        u->out_current++;
+        while (u->out_current >= u->out_fragments)
+            u->out_current -= u->out_fragments;
+        
+        n--;
+    }
+}
+
+static void do_write(struct userdata *u) {
+    struct count_info info;
+    assert(u && u->sink);
+
+    if (ioctl(u->fd, SNDCTL_DSP_GETOPTR, &info) < 0) {
+        fprintf(stderr, "SNDCTL_DSP_GETOPTR: %s\n", strerror(errno));
+        return;
+    }
+
+    u->out_fill = (u->out_fragment_size * u->out_fragments) - (info.ptr % u->out_fragment_size);
+
+    if (!info.blocks)
+        return;
+    
+    out_fill_memblocks(u, info.blocks);
+}
+
+static void in_post_memblocks(struct userdata *u, unsigned n) {
+    assert(u && u->in_memblocks);
+    
+    while (n > 0) {
+        struct pa_memchunk chunk;
+        
+        if (!u->in_memblocks[u->in_current]) {
+            chunk.memblock = u->in_memblocks[u->in_current] = pa_memblock_new_fixed(u->in_mmap+u->in_fragment_size*u->in_current, u->in_fragment_size);
+            chunk.length = chunk.memblock->length;
+            chunk.index = 0;
+            
+            pa_source_post(u->source, &chunk);
+        }
+
+        u->in_current++;
+        while (u->in_current >= u->in_fragments)
+            u->in_current -= u->in_fragments;
+        
+        n--;
+    }
+}
+
+static void in_clear_memblocks(struct userdata*u, unsigned n) {
+    unsigned i = u->in_current;
+    assert(u && u->in_memblocks);
+
+    if (n > u->in_fragments)
+        n = u->in_fragments;
+    
+    while (n > 0) {
+        if (u->in_memblocks[i]) {
+            pa_memblock_unref_fixed(u->in_memblocks[i]);
+            u->in_memblocks[i] = NULL;
+        }
+
+        i++;
+        while (i >= u->in_fragments)
+            i -= u->in_fragments;
+
+        n--;
+    }
+}
+
+static void do_read(struct userdata *u) {
+    struct count_info info;
+    assert(u && u->source);
+
+    if (ioctl(u->fd, SNDCTL_DSP_GETIPTR, &info) < 0) {
+        fprintf(stderr, "SNDCTL_DSP_GETIPTR: %s\n", strerror(errno));
+        return;
+    }
+
+    if (!info.blocks)
+        return;
+    
+    in_post_memblocks(u, info.blocks);
+    in_clear_memblocks(u, u->in_fragments/2);
+};
+
+static void io_callback(struct pa_mainloop_api *m, void *id, int fd, enum pa_mainloop_api_io_events events, void *userdata) {
+    struct userdata *u = userdata;
+
+    assert (u && u->core->mainloop == m && u->mainloop_source == id);
+
+    if (events & PA_MAINLOOP_API_IO_EVENT_INPUT)
+        do_read(u);
+    if (events & PA_MAINLOOP_API_IO_EVENT_OUTPUT)
+        do_write(u);
+}
+
+static uint32_t sink_get_latency_cb(struct pa_sink *s) {
+    struct userdata *u = s->userdata;
+    assert(s && u);
+
+    do_write(u);
+    return pa_samples_usec(u->out_fill, &s->sample_spec);
+}
+
+int pa_module_init(struct pa_core *c, struct pa_module*m) {
+    struct audio_buf_info info;
+    struct userdata *u = NULL;
+    const char *p;
+    int nfrags, frag_size;
+    int mode, caps;
+    int enable_bits = 0, zero = 0;
+    int playback = 1, record = 1;
+    struct pa_modargs *ma = NULL;
+    assert(c && m);
+
+    m->userdata = u = malloc(sizeof(struct userdata));
+    assert(u);
+    memset(u, 0, sizeof(struct userdata));
+    u->fd = -1;
+    u->core = c;
+
+    if (!(ma = pa_modargs_new(m->argument, valid_modargs))) {
+        fprintf(stderr, __FILE__": failed to parse module arguments.\n");
+        goto fail;
+    }
+    
+    if (pa_modargs_get_value_u32(ma, "record", &record) < 0 || pa_modargs_get_value_u32(ma, "playback", &playback) < 0) {
+        fprintf(stderr, __FILE__": record= and playback= expect numeric arguments.\n");
+        goto fail;
+    }
+
+    mode = (playback&&record) ? O_RDWR : (playback ? O_WRONLY : (record ? O_RDONLY : 0));
+    if (mode == 0) {
+        fprintf(stderr, __FILE__": neither playback nor record enabled for device.\n");
+        goto fail;
+    }
+
+    nfrags = 12;
+    frag_size = 1024;
+    if (pa_modargs_get_value_u32(ma, "fragments", &nfrags) < 0 || nfrags < 2 || pa_modargs_get_value_u32(ma, "fragment_size", &frag_size) < 0 || frag_size < 1) {
+        fprintf(stderr, __FILE__": failed to parse fragments arguments\n");
+        goto fail;
+    }
+
+    u->sample_spec = c->default_sample_spec;
+    if (pa_modargs_get_sample_spec(ma, &u->sample_spec) < 0) {
+        fprintf(stderr, __FILE__": failed to parse sample specification\n");
+        goto fail;
+    }
+
+    if ((u->fd = pa_oss_open(p = pa_modargs_get_value(ma, "device", DEFAULT_DEVICE), &mode, &caps)) < 0)
+        goto fail;
+
+    if (!(caps & DSP_CAP_MMAP) || !(caps & DSP_CAP_REALTIME) || !(caps & DSP_CAP_TRIGGER)) {
+        fprintf(stderr, "OSS device not mmap capable.\n");
+        goto fail;
+    }
+
+    fprintf(stderr, "module-oss: device opened in %s mode.\n", mode == O_WRONLY ? "O_WRONLY" : (mode == O_RDONLY ? "O_RDONLY" : "O_RDWR"));
+    
+    if (pa_oss_set_fragments(u->fd, nfrags, frag_size) < 0)
+        goto fail;
+    
+    if (pa_oss_auto_format(u->fd, &u->sample_spec) < 0)
+        goto fail;
+
+    if (mode != O_WRONLY) {
+        if (ioctl(u->fd, SNDCTL_DSP_GETISPACE, &info) < 0) {
+            fprintf(stderr, "SNDCTL_DSP_GETISPACE: %s\n", strerror(errno));
+            goto fail;
+        }
+
+        fprintf(stderr, "module-oss-mmap: input -- %u fragments of size %u.\n", info.fragstotal, info.fragsize);
+        u->in_mmap_length = (u->in_fragment_size = info.fragsize) * (u->in_fragments = info.fragstotal);
+
+        if ((u->in_mmap = mmap(NULL, u->in_mmap_length, PROT_READ, MAP_SHARED, u->fd, 0)) == MAP_FAILED) {
+            if (mode == O_RDWR) {
+                fprintf(stderr, "module-oss-mmap: mmap failed for input. Changing to O_WRONLY mode.\n");
+                mode = O_WRONLY;
+            } else {
+                fprintf(stderr, "modeule-oss-mmap: mmap(): %s\n", strerror(errno));
+                goto fail;
+            }
+        } else {
+        
+            u->source = pa_source_new(c, pa_modargs_get_value(ma, "source_name", DEFAULT_SOURCE_NAME), 0, &u->sample_spec);
+            assert(u->source);
+            u->source->userdata = u;
+            pa_source_set_owner(u->source, m);
+            u->source->description = pa_sprintf_malloc("Open Sound System PCM/mmap() on '%s'", p);
+            
+            
+            u->in_memblocks = malloc(sizeof(struct pa_memblock *)*u->in_fragments);
+            memset(u->in_memblocks, 0, sizeof(struct pa_memblock *)*u->in_fragments);
+            
+            enable_bits |= PCM_ENABLE_INPUT;
+        }
+    }
+
+    if (mode != O_RDONLY) {
+        if (ioctl(u->fd, SNDCTL_DSP_GETOSPACE, &info) < 0) {
+            fprintf(stderr, "SNDCTL_DSP_GETOSPACE: %s\n", strerror(errno));
+            goto fail;
+        }
+        
+        fprintf(stderr, "module-oss: output -- %u fragments of size %u.\n", info.fragstotal, info.fragsize);
+        u->out_mmap_length = (u->out_fragment_size = info.fragsize) * (u->out_fragments = info.fragstotal);
+
+        if ((u->out_mmap = mmap(NULL, u->out_mmap_length, PROT_WRITE, MAP_SHARED, u->fd, 0))  == MAP_FAILED) {
+            if (mode == O_RDWR) {
+                fprintf(stderr, "module-oss-mmap: mmap filed for output. Changing to O_RDONLY mode.\n");
+                mode = O_RDONLY;
+            } else {
+                fprintf(stderr, "module-oss-mmap: mmap(): %s\n", strerror(errno));
+                goto fail;
+            }
+        } else {
+            pa_silence_memory(u->out_mmap, u->out_mmap_length, &u->sample_spec);
+            
+            u->sink = pa_sink_new(c, pa_modargs_get_value(ma, "sink_name", DEFAULT_SINK_NAME), 0, &u->sample_spec);
+            assert(u->sink);
+            u->sink->get_latency = sink_get_latency_cb;
+            u->sink->userdata = u;
+            pa_sink_set_owner(u->sink, m);
+            u->sink->description = pa_sprintf_malloc("Open Sound System PCM/mmap() on '%s'", p);
+            
+            u->out_memblocks = malloc(sizeof(struct memblock *)*u->out_fragments);
+            memset(u->out_memblocks, 0, sizeof(struct pa_memblock *)*u->out_fragments);
+            
+            enable_bits |= PCM_ENABLE_OUTPUT;
+        }
+    }
+
+    zero = 0;
+    if (ioctl(u->fd, SNDCTL_DSP_SETTRIGGER, &zero) < 0) {
+        fprintf(stderr, "SNDCTL_DSP_SETTRIGGER: %s\n", strerror(errno));
+        goto fail;
+    }
+    
+    if (ioctl(u->fd, SNDCTL_DSP_SETTRIGGER, &enable_bits) < 0) {
+        fprintf(stderr, "SNDCTL_DSP_SETTRIGGER: %s\n", strerror(errno));
+        goto fail;
+    }
+        
+    assert(u->source || u->sink);
+
+    u->mainloop_source = c->mainloop->source_io(c->mainloop, u->fd, (u->source ? PA_MAINLOOP_API_IO_EVENT_INPUT : 0) | (u->sink ? PA_MAINLOOP_API_IO_EVENT_OUTPUT : 0), io_callback, u);
+    assert(u->mainloop_source);
+
+    pa_modargs_free(ma);
+    
+    return 0;
+
+fail:
+    pa_module_done(c, m);
+
+    if (ma)
+        pa_modargs_free(ma);
+    
+    return -1;
+}
+
+void pa_module_done(struct pa_core *c, struct pa_module*m) {
+    struct userdata *u;
+    assert(c && m);
+
+    u = m->userdata;
+    assert(u);
+
+    if (u->out_memblocks) {
+        unsigned i;
+        for (i = 0; i < u->out_fragments; i++)
+            if (u->out_memblocks[i])
+                pa_memblock_unref_fixed(u->out_memblocks[i]);
+        free(u->out_memblocks);
+    }
+
+    if (u->in_memblocks) {
+        unsigned i;
+        for (i = 0; i < u->in_fragments; i++)
+            if (u->in_memblocks[i])
+                pa_memblock_unref_fixed(u->in_memblocks[i]);
+        free(u->in_memblocks);
+    }
+    
+    if (u->in_mmap && u->in_mmap != MAP_FAILED)
+        munmap(u->in_mmap, u->in_mmap_length);
+    
+    if (u->out_mmap && u->out_mmap != MAP_FAILED)
+        munmap(u->out_mmap, u->out_mmap_length);
+    
+    if (u->sink)
+        pa_sink_free(u->sink);
+
+    if (u->source)
+        pa_source_free(u->source);
+
+    if (u->mainloop_source)
+        u->core->mainloop->cancel_io(u->core->mainloop, u->mainloop_source);
+
+    if (u->fd >= 0)
+        close(u->fd);
+
+    free(u);
+}