resampling works

git-svn-id: file:///home/lennart/svn/public/libsydney/trunk@4 9ba3c220-e4d3-45a2-8aa3-73fcc9aff6ce

1 files changed, 57 insertions, 0 deletions

diff --git a/byteswap.c b/byteswap.c
new file mode 100644
index 0000000..0c80b8d
--- /dev/null
+++ b/byteswap.c
@@ -0,0 +1,57 @@
+#include <inttypes.h>
+
+#include "macro.h"
+#include "byteswap.h"
+
+static void byteswap16(void *_dst, size_t dstr, const void *_src, size_t sstr, size_t bytes) {
+    uint16_t *dst = _dst;
+    const uint16_t *src = _src;
+    unsigned n = bytes / sizeof(uint16_t);
+
+    for (; n > 0; n--) {
+        *dst = (*src >> 8) | (*src << 8);
+        src += sstr / sizeof(uint16_t);
+        dst += dstr / sizeof(uint16_t);
+    }
+}
+
+static void byteswap24(void *_dst, size_t dstr, const void *_src, size_t sstr, size_t bytes) {
+    uint8_t *dst = _dst;
+    const uint8_t *src = _src;
+    unsigned n = bytes / (sizeof(uint8_t)*3);
+    
+    for (; n > 0; n--) {
+        dst[0] = src[2];
+        dst[2] = src[0];
+        
+        src += sstr / (sizeof(uint8_t)*3);
+        dst += dstr / (sizeof(uint8_t)*3);
+    }
+}
+
+static void byteswap32(void *_dst, size_t dstr, const void *_src, size_t sstr, size_t bytes) {
+    uint32_t *dst = _dst;
+    const uint32_t *src = _src;
+    unsigned n = bytes / sizeof(uint32_t);
+    
+    for (; n > 0; n--) {
+        *dst = (*src << 24) | ((*src & 0xFF00) << 8) | ((*src >> 8) & 0xFF00) | (*src >> 24);
+        src += sstr / sizeof(uint32_t);
+        dst += dstr / sizeof(uint32_t);
+    }
+}
+
+byteswap_func_t get_byteswap_func(sa_pcm_format_t f) {
+    
+    static const byteswap_func_t funcs[SA_PCM_FORMAT_MAX] = {
+        [SA_PCM_FORMAT_S16_RE] = byteswap16,
+        [SA_PCM_FORMAT_S24_RE] = byteswap24,
+        [SA_PCM_FORMAT_S32_RE] = byteswap32,
+        [SA_PCM_FORMAT_FLOAT32_BE] = byteswap32,
+    };
+
+    sa_assert(f < SA_PCM_FORMAT_MAX); 
+
+    return funcs[f];
+}
+