pipewire/spa/plugins/audioconvert/fmt-ops.c

787 lines
20 KiB
C
Raw Normal View History

2018-04-02 11:21:29 +02:00
/* Spa
*
* Copyright © 2018 Wim Taymans
2018-04-02 11:21:29 +02:00
*
* Permission is hereby granted, free of charge, to any person obtaining a
* copy of this software and associated documentation files (the "Software"),
* to deal in the Software without restriction, including without limitation
* the rights to use, copy, modify, merge, publish, distribute, sublicense,
* and/or sell copies of the Software, and to permit persons to whom the
* Software is furnished to do so, subject to the following conditions:
2018-04-02 11:21:29 +02:00
*
* The above copyright notice and this permission notice (including the next
* paragraph) shall be included in all copies or substantial portions of the
* Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
* DEALINGS IN THE SOFTWARE.
2018-04-02 11:21:29 +02:00
*/
#include <string.h>
#include <stdio.h>
#include <spa/utils/defs.h>
2018-04-05 15:38:10 +02:00
#define U8_MIN 0
2018-05-08 10:42:17 +02:00
#define U8_MAX 255
#define U8_SCALE 127
#define U8_OFFS 128
2018-04-02 20:05:11 +02:00
2018-05-08 10:42:17 +02:00
#define S16_MIN -32767
#define S16_MAX 32767
#define S16_MAX_F 32767.0f
2018-05-08 10:42:17 +02:00
#define S16_SCALE 32767
2018-04-02 20:05:11 +02:00
2018-05-08 10:42:17 +02:00
#define S24_MIN -8388607
#define S24_MAX 8388607
#define S24_MAX_F 8388607.0f
2018-05-08 10:42:17 +02:00
#define S24_SCALE 8388607
2018-04-02 11:21:29 +02:00
2018-05-08 10:42:17 +02:00
#define S32_MIN -2147483647
#define S32_MAX 2147483647
#define S32_SCALE 2147483647
2018-04-05 15:38:10 +02:00
#if defined (__SSE__)
#include "fmt-ops-sse.c"
#endif
2018-04-05 15:38:10 +02:00
static void
conv_copy(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
int i;
for (i = 0; i < n_src; i++)
memcpy(dst[i], src[i], n_bytes);
}
#define U8_TO_F32(v) (((v) * (1.0f / U8_OFFS)) - 1.0)
static void
conv_u8_to_f32(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
int i, j;
for (i = 0; i < n_src; i++) {
const uint8_t *s = src[i];
2018-04-05 15:38:10 +02:00
float *d = dst[i];
for (j = 0; j < n_bytes; j++)
d[j] = U8_TO_F32(s[j]);
}
}
static void
conv_u8_to_f32d(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
const uint8_t *s = src[0];
2018-04-05 15:38:10 +02:00
float **d = (float **) dst;
int i, j;
n_bytes /= n_dst;
for (j = 0; j < n_bytes; j++) {
for (i = 0; i < n_dst; i++)
d[i][j] = U8_TO_F32(*s++);
}
}
2018-04-02 11:21:29 +02:00
static void
2018-04-05 15:38:10 +02:00
conv_u8d_to_f32(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
2018-04-02 11:21:29 +02:00
{
const uint8_t **s = (const uint8_t **) src;
2018-04-05 15:38:10 +02:00
float *d = dst[0];
int i, j;
n_bytes /= n_src;
for (j = 0; j < n_bytes; j++) {
for (i = 0; i < n_src; i++)
*d++ = U8_TO_F32(s[i][j]);
}
}
#define S16_TO_F32(v) ((v) * (1.0f / S16_SCALE))
static void
conv_s16_to_f32(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
int i, j;
2018-04-02 11:21:29 +02:00
n_bytes /= sizeof(int16_t);
2018-04-05 15:38:10 +02:00
for (i = 0; i < n_src; i++) {
const int16_t *s = src[i];
float *d = dst[i];
for (j = 0; j < n_bytes; j++)
d[j] = S16_TO_F32(s[j]);
}
2018-04-02 11:21:29 +02:00
}
static void
2018-04-05 15:38:10 +02:00
conv_s16_to_f32d(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
2018-04-02 11:21:29 +02:00
{
2018-04-05 15:38:10 +02:00
const int16_t *s = src[0];
2018-04-02 11:21:29 +02:00
float **d = (float **) dst;
2018-04-05 15:38:10 +02:00
int i, j;
2018-04-02 11:21:29 +02:00
2018-04-02 20:05:11 +02:00
n_bytes /= (sizeof(int16_t) * n_dst);
2018-04-05 15:38:10 +02:00
for (j = 0; j < n_bytes; j++) {
2018-04-02 11:21:29 +02:00
for (i = 0; i < n_dst; i++)
2018-04-05 15:38:10 +02:00
d[i][j] = S16_TO_F32(*s++);
}
2018-04-02 11:21:29 +02:00
}
static void
2018-04-05 15:38:10 +02:00
conv_s16d_to_f32(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
2018-04-02 11:21:29 +02:00
{
2018-04-02 20:05:11 +02:00
const int16_t **s = (const int16_t **) src;
2018-04-05 15:38:10 +02:00
float *d = dst[0];
int i, n, n_samples;
2018-04-02 11:21:29 +02:00
n_samples = n_bytes / sizeof(int16_t);
for (n = 0; n < n_samples; n++) {
2018-04-02 11:21:29 +02:00
for (i = 0; i < n_src; i++)
*d++ = S16_TO_F32(s[i][n]);
2018-04-05 15:38:10 +02:00
}
2018-04-02 11:21:29 +02:00
}
2018-04-05 15:38:10 +02:00
#define S32_TO_F32(v) ((v) * (1.0f / S32_SCALE))
2018-04-02 11:21:29 +02:00
static void
2018-04-05 15:38:10 +02:00
conv_s32_to_f32(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
2018-04-02 11:21:29 +02:00
{
2018-04-05 15:38:10 +02:00
int i, j;
2018-04-02 11:21:29 +02:00
2018-04-05 15:38:10 +02:00
n_bytes /= sizeof(int32_t);
for (i = 0; i < n_src; i++) {
const int32_t *s = src[i];
float *d = dst[i];
for (j = 0; j < n_bytes; j++)
d[j] = S32_TO_F32(s[j]);
}
2018-04-02 20:05:11 +02:00
}
2018-04-05 15:38:10 +02:00
static void
conv_s32_to_f32d(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
const int32_t *s = src[0];
float **d = (float **) dst;
int i, j;
n_bytes /= (sizeof(int32_t) * n_dst);
for (j = 0; j < n_bytes; j++) {
for (i = 0; i < n_dst; i++)
d[i][j] = S32_TO_F32(*s++);
}
}
2018-04-02 20:05:11 +02:00
static void
2018-04-05 15:38:10 +02:00
conv_s32d_to_f32(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
2018-04-02 20:05:11 +02:00
{
2018-04-05 15:38:10 +02:00
const int32_t **s = (const int32_t **) src;
float *d = dst[0];
int i, n, n_samples;
2018-04-02 20:05:11 +02:00
n_samples = n_bytes / sizeof(int32_t);
for (n = 0; n < n_samples; n++) {
2018-04-05 15:38:10 +02:00
for (i = 0; i < n_src; i++)
*d++ = S32_TO_F32(s[i][n]);
2018-04-05 15:38:10 +02:00
}
2018-04-02 20:05:11 +02:00
}
2018-08-01 18:10:12 +02:00
#if __BYTE_ORDER == __LITTLE_ENDIAN
#define READ24(s) (((uint32_t)s[2] << 16) | ((uint32_t)s[1] << 8) | ((uint32_t)s[0]))
#else
2018-04-05 15:38:10 +02:00
#define READ24(s) (((uint32_t)s[0] << 16) | ((uint32_t)s[1] << 8) | ((uint32_t)s[2]))
2018-08-01 18:10:12 +02:00
#endif
2018-04-05 15:38:10 +02:00
#define S24_TO_F32(v) ((((int32_t)v)<<8) * (1.0f / S32_SCALE))
2018-04-05 15:38:10 +02:00
2018-04-02 20:05:11 +02:00
static void
2018-04-05 15:38:10 +02:00
conv_s24_to_f32(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
2018-04-02 20:05:11 +02:00
{
2018-04-05 15:38:10 +02:00
int i, j;
n_bytes /= 3;
for (i = 0; i < n_src; i++) {
const int8_t *s = src[i];
float *d = dst[i];
for (j = 0; j < n_bytes; j++) {
d[j] = S24_TO_F32(READ24(s));
s += 3;
}
}
}
static void
conv_s24_to_f32d(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
const uint8_t *s = src[0];
2018-04-02 20:05:11 +02:00
float **d = (float **) dst;
2018-04-05 15:38:10 +02:00
int i, j;
2018-04-02 20:05:11 +02:00
2018-04-05 15:38:10 +02:00
n_bytes /= (3 * n_dst);
for (j = 0; j < n_bytes; j++) {
for (i = 0; i < n_dst; i++) {
d[i][j] = S24_TO_F32(READ24(s));
s += 3;
}
}
}
static void
conv_s24d_to_f32(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
const uint8_t **s = (const uint8_t **) src;
2018-04-05 15:38:10 +02:00
float *d = dst[0];
int i, n, n_samples;
2018-04-05 15:38:10 +02:00
n_samples = n_bytes / 3;
for (n = 0; n < n_samples; n++) {
2018-04-05 15:38:10 +02:00
for (i = 0; i < n_src; i++) {
*d++ = S24_TO_F32(READ24(s[i]));
s += 3;
}
}
}
static void
conv_s24_32_to_f32(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
int i, j;
n_bytes /= sizeof(int32_t);
for (i = 0; i < n_src; i++) {
const int32_t *s = src[i];
float *d = dst[i];
for (j = 0; j < n_bytes; j++)
d[j] = S24_TO_F32(s[j]);
}
}
static void
conv_s24_32_to_f32d(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
const int32_t *s = src[0];
float **d = (float **) dst;
int i, j;
n_bytes /= (sizeof(int32_t) * n_dst);
for (j = 0; j < n_bytes; j++) {
for (i = 0; i < n_dst; i++)
d[i][j] = S24_TO_F32(*s++);
}
}
static void
conv_s24_32d_to_f32(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
const int32_t **s = (const int32_t **) src;
float *d = dst[0];
int i, n, n_samples;
2018-04-05 15:38:10 +02:00
n_samples = n_bytes / sizeof(int32_t);
for (n = 0; n < n_samples; n++) {
2018-04-05 15:38:10 +02:00
for (i = 0; i < n_src; i++)
*d++ = S24_TO_F32(s[i][n]);
2018-04-05 15:38:10 +02:00
}
}
#define F32_TO_U8(v) \
({ \
typeof(v) _v = (v); \
_v < -1.0f ? U8_MIN : \
_v >= 1.0f ? U8_MAX : \
(_v * U8_SCALE) + U8_OFFS; \
})
static void
conv_f32_to_u8(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
int i, j;
n_bytes /= sizeof(float);
for (i = 0; i < n_src; i++) {
const float *s = src[i];
int8_t *d = dst[i];
for (j = 0; j < n_bytes; j++)
d[j] = F32_TO_U8(s[j]);
}
}
static void
conv_f32_to_u8d(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
const float *s = src[0];
int8_t **d = (int8_t **) dst;
int i, j;
n_bytes /= (sizeof(float) * n_dst);
for (j = 0; j < n_bytes; j++) {
2018-04-02 20:05:11 +02:00
for (i = 0; i < n_dst; i++)
2018-04-05 15:38:10 +02:00
d[i][j] = F32_TO_U8(*s++);
}
2018-04-02 11:21:29 +02:00
}
static void
2018-04-05 15:38:10 +02:00
conv_f32d_to_u8(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
2018-04-02 20:05:11 +02:00
{
2018-06-25 17:08:34 +02:00
const float **s = (const float **) src;
int8_t *d = dst[0];
int i, n, n_samples;
2018-04-05 15:38:10 +02:00
n_samples = n_bytes / sizeof(float);
for (n = 0; n < n_samples; n++) {
2018-04-05 15:38:10 +02:00
for (i = 0; i < n_src; i++)
*d++ = F32_TO_U8(s[i][n]);
2018-04-05 15:38:10 +02:00
}
}
#define F32_TO_S16(v) \
({ \
typeof(v) _v = (v); \
_v < -1.0f ? S16_MIN : \
_v >= 1.0f ? S16_MAX : \
_v * S16_SCALE; \
})
static void
conv_f32_to_s16(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
int i, n, n_samples;
n_samples = n_bytes / sizeof(float);
for (i = 0; i < n_src; i++) {
const float *s = src[i];
int16_t *d = dst[i];
for (n = 0; n < n_samples; n++)
d[n] = F32_TO_S16(s[n]);
}
}
static void
conv_f32_to_s16d(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
const float *s = src[0];
int16_t **d = (int16_t **) dst;
int i, n, n_samples;
n_samples = n_bytes / (sizeof(float) * n_dst);
for (n = 0; n < n_samples; n++) {
for (i = 0; i < n_dst; i++)
d[i][n] = F32_TO_S16(*s++);
}
}
static void
conv_f32d_to_s16(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
const float **s = (const float **) src;
int16_t *d = dst[0];
int i, n, n_samples;
2018-04-02 20:05:11 +02:00
n_samples = n_bytes / sizeof(float);
for (n = 0; n < n_samples; n++) {
2018-04-02 20:05:11 +02:00
for (i = 0; i < n_src; i++)
*d++ = F32_TO_S16(s[i][n]);
2018-04-05 15:38:10 +02:00
}
2018-04-02 20:05:11 +02:00
}
2018-04-05 15:38:10 +02:00
#define F32_TO_S32(v) \
({ \
typeof(v) _v = (v); \
_v < -1.0f ? S32_MIN : \
_v >= 1.0f ? S32_MAX : \
_v * S32_SCALE; \
})
2018-04-02 20:05:11 +02:00
static void
2018-04-05 15:38:10 +02:00
conv_f32_to_s32(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
2018-04-02 20:05:11 +02:00
{
2018-04-05 15:38:10 +02:00
int i, j;
2018-04-02 20:05:11 +02:00
n_bytes /= sizeof(float);
2018-04-05 15:38:10 +02:00
for (i = 0; i < n_src; i++) {
const float *s = src[i];
int32_t *d = dst[i];
for (j = 0; j < n_bytes; j++)
d[j] = F32_TO_S32(s[j]);
}
2018-04-02 20:05:11 +02:00
}
static void
2018-04-05 15:38:10 +02:00
conv_f32_to_s32d(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
2018-04-02 11:21:29 +02:00
{
2018-04-05 15:38:10 +02:00
const float *s = src[0];
int32_t **d = (int32_t **) dst;
int i, j;
n_bytes /= (sizeof(float) * n_dst);
for (j = 0; j < n_bytes; j++) {
for (i = 0; i < n_dst; i++)
d[i][j] = F32_TO_S32(*s++);
}
}
static void
conv_f32d_to_s32(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
const float **s = (const float **) src;
int32_t *d = dst[0];
int i, n, n_samples;
2018-04-05 15:38:10 +02:00
n_samples = n_bytes / sizeof(float);
for (n = 0; n < n_samples; n++) {
2018-04-05 15:38:10 +02:00
for (i = 0; i < n_src; i++)
*d++ = F32_TO_S32(s[i][n]);
2018-04-05 15:38:10 +02:00
}
}
2018-04-05 15:38:10 +02:00
#define F32_TO_S24(v) \
({ \
typeof(v) _v = (v); \
_v < -1.0f ? S24_MIN : \
_v >= 1.0f ? S24_MAX : \
(uint32_t) (_v * S24_SCALE); \
})
#define WRITE24(d,v) \
({ \
typeof(v) _v = (v); \
d[0] = (uint8_t) (_v >> 16); \
d[1] = (uint8_t) (_v >> 8); \
d[2] = (uint8_t) _v; \
})
static void
conv_f32_to_s24(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
int i, j;
n_bytes /= sizeof(float);
for (i = 0; i < n_src; i++) {
const float *s = src[i];
int8_t *d = dst[i];
for (j = 0; j < n_bytes; j++)
WRITE24(d, F32_TO_S24(s[j]));
d += 3;
}
}
static void
conv_f32_to_s24d(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
const float *s = src[0];
int8_t **d = (int8_t **) dst;
int i, j;
n_bytes /= (sizeof(float) * n_dst);
for (j = 0; j < n_bytes; j++) {
for (i = 0; i < n_dst; i++) {
WRITE24(d[i], F32_TO_S24(*s++));
d[i] += 3;
}
}
}
static void
conv_f32d_to_s24(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
const float **s = (const float **) src;
int8_t *d = dst[0];
int i, n, n_samples;
2018-04-05 15:38:10 +02:00
n_samples = n_bytes / sizeof(float);
for (n = 0; n < n_samples; n++) {
2018-04-05 15:38:10 +02:00
for (i = 0; i < n_src; i++) {
WRITE24(d, F32_TO_S24(s[i][n]));
2018-04-05 15:38:10 +02:00
d += 3;
}
}
}
static void
conv_f32_to_s24_32(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
int i, j;
n_bytes /= sizeof(float);
for (i = 0; i < n_src; i++) {
const float *s = src[i];
int32_t *d = dst[i];
for (j = 0; j < n_bytes; j++)
d[j] = F32_TO_S24(s[j]);
}
}
static void
conv_f32_to_s24_32d(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
const float *s = src[0];
int32_t **d = (int32_t **) dst;
int i, j;
n_bytes /= (sizeof(float) * n_dst);
for (j = 0; j < n_bytes; j++) {
for (i = 0; i < n_dst; i++)
d[i][j] = F32_TO_S24(*s++);
}
}
static void
conv_f32d_to_s24_32(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
const float **s = (const float **) src;
int32_t *d = dst[0];
int i, n, n_samples;
2018-04-05 15:38:10 +02:00
n_samples = n_bytes / sizeof(float);
for (n = 0; n < n_samples; n++) {
2018-04-05 15:38:10 +02:00
for (i = 0; i < n_src; i++)
*d++ = F32_TO_S24(s[i][n]);
2018-04-05 15:38:10 +02:00
}
}
static void
deinterleave_8(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
const uint8_t *s = src[0];
2018-04-02 11:21:29 +02:00
uint8_t **d = (uint8_t **) dst;
2018-04-05 15:38:10 +02:00
int i, j;
2018-04-02 11:21:29 +02:00
2018-04-06 18:39:07 +02:00
n_bytes /= (sizeof(uint8_t) * n_dst);
2018-04-05 15:38:10 +02:00
for (j = 0; j < n_bytes; j++) {
2018-04-02 11:21:29 +02:00
for (i = 0; i < n_dst; i++)
2018-04-05 15:38:10 +02:00
d[i][j] = *s++;
2018-04-02 11:21:29 +02:00
}
}
static void
2018-04-05 15:38:10 +02:00
deinterleave_16(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
2018-04-02 11:21:29 +02:00
{
2018-04-05 15:38:10 +02:00
const uint16_t *s = src[0];
2018-04-02 11:21:29 +02:00
uint16_t **d = (uint16_t **) dst;
2018-04-05 15:38:10 +02:00
int i, j;
2018-04-02 11:21:29 +02:00
2018-04-02 20:05:11 +02:00
n_bytes /= (sizeof(uint16_t) * n_dst);
2018-04-05 15:38:10 +02:00
for (j = 0; j < n_bytes; j++) {
2018-04-02 11:21:29 +02:00
for (i = 0; i < n_dst; i++)
2018-04-05 15:38:10 +02:00
d[i][j] = *s++;
}
}
static void
deinterleave_24(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
const uint8_t *s = src[0];
uint8_t **d = (uint8_t **) dst;
int i, j;
n_bytes /= (3 * n_dst);
for (j = 0; j < n_bytes; j++) {
for (i = 0; i < n_dst; i++) {
WRITE24(d[i], READ24(s));
d += 3;
s += 3;
}
2018-04-02 11:21:29 +02:00
}
}
static void
2018-04-05 15:38:10 +02:00
deinterleave_32(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
2018-04-02 11:21:29 +02:00
{
2018-04-05 15:38:10 +02:00
const uint32_t *s = src[0];
2018-04-02 11:21:29 +02:00
uint32_t **d = (uint32_t **) dst;
2018-04-05 15:38:10 +02:00
int i, j;
2018-04-02 11:21:29 +02:00
2018-04-02 20:05:11 +02:00
n_bytes /= (sizeof(uint32_t) * n_dst);
2018-04-05 15:38:10 +02:00
for (j = 0; j < n_bytes; j++) {
2018-04-02 11:21:29 +02:00
for (i = 0; i < n_dst; i++)
2018-04-05 15:38:10 +02:00
d[i][j] = *s++;
}
}
static void
interleave_8(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
const int8_t **s = (const int8_t **) src;
uint8_t *d = dst[0];
int i, j;
2018-04-06 18:39:07 +02:00
n_bytes /= sizeof(uint8_t);
2018-04-05 15:38:10 +02:00
for (j = 0; j < n_bytes; j++) {
for (i = 0; i < n_src; i++)
*d++ = s[i][j];
2018-04-02 11:21:29 +02:00
}
}
2018-04-02 20:05:11 +02:00
static void
2018-04-05 15:38:10 +02:00
interleave_16(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
const int16_t **s = (const int16_t **) src;
uint16_t *d = dst[0];
int i, j;
2018-04-06 18:39:07 +02:00
n_bytes /= sizeof(uint16_t);
2018-04-05 15:38:10 +02:00
for (j = 0; j < n_bytes; j++) {
for (i = 0; i < n_src; i++)
*d++ = s[i][j];
}
}
static void
interleave_24(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
{
const int8_t **s = (const int8_t **) src;
uint8_t *d = dst[0];
int i, j;
2018-04-06 18:39:07 +02:00
n_bytes /= 3;
2018-04-05 15:38:10 +02:00
for (j = 0; j < n_bytes; j++) {
for (i = 0; i < n_src; i++) {
WRITE24(d, READ24(s[i]));
d += 3;
s += 3;
}
}
}
static void
interleave_32(void *data, int n_dst, void *dst[n_dst], int n_src, const void *src[n_src], int n_bytes)
2018-04-02 20:05:11 +02:00
{
const int32_t **s = (const int32_t **) src;
2018-04-05 15:38:10 +02:00
uint32_t *d = dst[0];
int i, j;
2018-04-02 20:05:11 +02:00
2018-04-06 18:39:07 +02:00
n_bytes /= sizeof(uint32_t);
2018-04-05 15:38:10 +02:00
for (j = 0; j < n_bytes; j++) {
2018-04-02 20:05:11 +02:00
for (i = 0; i < n_src; i++)
2018-04-05 15:38:10 +02:00
*d++ = s[i][j];
2018-04-02 20:05:11 +02:00
}
}
2018-04-06 18:39:07 +02:00
typedef void (*convert_func_t) (void *data, int n_dst, void *dst[n_dst],
int n_src, const void *src[n_src], int n_bytes);
static const struct conv_info {
uint32_t src_fmt;
uint32_t dst_fmt;
#define FEATURE_SSE (1<<0)
uint32_t features;
2018-04-06 18:39:07 +02:00
convert_func_t func;
2018-04-06 18:39:07 +02:00
} conv_table[] =
{
/* to f32 */
{ SPA_AUDIO_FORMAT_U8, SPA_AUDIO_FORMAT_F32, 0, conv_u8_to_f32 },
{ SPA_AUDIO_FORMAT_U8, SPA_AUDIO_FORMAT_F32P, 0, conv_u8_to_f32d },
{ SPA_AUDIO_FORMAT_U8P, SPA_AUDIO_FORMAT_F32, 0, conv_u8d_to_f32 },
{ SPA_AUDIO_FORMAT_S16, SPA_AUDIO_FORMAT_F32, 0, conv_s16_to_f32 },
#if defined (__SSE2__)
{ SPA_AUDIO_FORMAT_S16, SPA_AUDIO_FORMAT_F32P, FEATURE_SSE, conv_s16_to_f32d_sse },
#endif
{ SPA_AUDIO_FORMAT_S16, SPA_AUDIO_FORMAT_F32P, 0, conv_s16_to_f32d },
{ SPA_AUDIO_FORMAT_S16P, SPA_AUDIO_FORMAT_F32, 0, conv_s16d_to_f32 },
{ SPA_AUDIO_FORMAT_F32, SPA_AUDIO_FORMAT_F32, 0, conv_copy },
{ SPA_AUDIO_FORMAT_F32P, SPA_AUDIO_FORMAT_F32P, 0, conv_copy },
{ SPA_AUDIO_FORMAT_F32, SPA_AUDIO_FORMAT_F32P, 0, deinterleave_32 },
{ SPA_AUDIO_FORMAT_F32P, SPA_AUDIO_FORMAT_F32, 0, interleave_32 },
{ SPA_AUDIO_FORMAT_S32, SPA_AUDIO_FORMAT_F32, 0, conv_s32_to_f32 },
{ SPA_AUDIO_FORMAT_S32, SPA_AUDIO_FORMAT_F32P, 0, conv_s32_to_f32d },
{ SPA_AUDIO_FORMAT_S32P, SPA_AUDIO_FORMAT_F32, 0, conv_s32d_to_f32 },
{ SPA_AUDIO_FORMAT_S24, SPA_AUDIO_FORMAT_F32, 0, conv_s24_to_f32 },
{ SPA_AUDIO_FORMAT_S24, SPA_AUDIO_FORMAT_F32P, 0, conv_s24_to_f32d },
{ SPA_AUDIO_FORMAT_S24P, SPA_AUDIO_FORMAT_F32, 0, conv_s24d_to_f32 },
{ SPA_AUDIO_FORMAT_S24_32, SPA_AUDIO_FORMAT_F32, 0, conv_s24_32_to_f32 },
{ SPA_AUDIO_FORMAT_S24_32, SPA_AUDIO_FORMAT_F32P, 0, conv_s24_32_to_f32d },
{ SPA_AUDIO_FORMAT_S24_32P, SPA_AUDIO_FORMAT_F32, 0, conv_s24_32d_to_f32 },
2018-04-06 18:39:07 +02:00
/* from f32 */
{ SPA_AUDIO_FORMAT_F32, SPA_AUDIO_FORMAT_U8, 0, conv_f32_to_u8 },
{ SPA_AUDIO_FORMAT_F32, SPA_AUDIO_FORMAT_U8P, 0, conv_f32_to_u8d },
{ SPA_AUDIO_FORMAT_F32P, SPA_AUDIO_FORMAT_U8, 0, conv_f32d_to_u8 },
{ SPA_AUDIO_FORMAT_F32, SPA_AUDIO_FORMAT_S16, 0, conv_f32_to_s16 },
{ SPA_AUDIO_FORMAT_F32, SPA_AUDIO_FORMAT_S16P, 0, conv_f32_to_s16d },
#if defined (__SSE2__)
{ SPA_AUDIO_FORMAT_F32P, SPA_AUDIO_FORMAT_S16, FEATURE_SSE, conv_f32d_to_s16_sse },
#endif
{ SPA_AUDIO_FORMAT_F32P, SPA_AUDIO_FORMAT_S16, 0, conv_f32d_to_s16 },
{ SPA_AUDIO_FORMAT_F32, SPA_AUDIO_FORMAT_S32, 0, conv_f32_to_s32 },
{ SPA_AUDIO_FORMAT_F32, SPA_AUDIO_FORMAT_S32P, 0, conv_f32_to_s32d },
#if defined (__SSE2__)
{ SPA_AUDIO_FORMAT_F32P, SPA_AUDIO_FORMAT_S32, FEATURE_SSE, conv_f32d_to_s32_sse },
#endif
{ SPA_AUDIO_FORMAT_F32P, SPA_AUDIO_FORMAT_S32, 0, conv_f32d_to_s32 },
{ SPA_AUDIO_FORMAT_F32, SPA_AUDIO_FORMAT_S24, 0, conv_f32_to_s24 },
{ SPA_AUDIO_FORMAT_F32, SPA_AUDIO_FORMAT_S24P, 0, conv_f32_to_s24d },
{ SPA_AUDIO_FORMAT_F32P, SPA_AUDIO_FORMAT_S24, 0, conv_f32d_to_s24 },
{ SPA_AUDIO_FORMAT_F32, SPA_AUDIO_FORMAT_S24_32, 0, conv_f32_to_s24_32 },
{ SPA_AUDIO_FORMAT_F32, SPA_AUDIO_FORMAT_S24_32P, 0, conv_f32_to_s24_32d },
{ SPA_AUDIO_FORMAT_F32P, SPA_AUDIO_FORMAT_S24_32, 0, conv_f32d_to_s24_32 },
2018-04-06 18:39:07 +02:00
/* u8 */
{ SPA_AUDIO_FORMAT_U8, SPA_AUDIO_FORMAT_U8, 0, conv_copy },
{ SPA_AUDIO_FORMAT_U8P, SPA_AUDIO_FORMAT_U8P, 0, conv_copy },
{ SPA_AUDIO_FORMAT_U8, SPA_AUDIO_FORMAT_U8P, 0, deinterleave_8 },
{ SPA_AUDIO_FORMAT_U8P, SPA_AUDIO_FORMAT_U8, 0, interleave_8 },
2018-04-06 18:39:07 +02:00
/* s16 */
{ SPA_AUDIO_FORMAT_S16, SPA_AUDIO_FORMAT_S16, 0, conv_copy },
{ SPA_AUDIO_FORMAT_S16P, SPA_AUDIO_FORMAT_S16P, 0, conv_copy },
{ SPA_AUDIO_FORMAT_S16, SPA_AUDIO_FORMAT_S16P, 0, deinterleave_16 },
{ SPA_AUDIO_FORMAT_S16P, SPA_AUDIO_FORMAT_S16, 0, interleave_16 },
2018-04-06 18:39:07 +02:00
/* s32 */
{ SPA_AUDIO_FORMAT_S32, SPA_AUDIO_FORMAT_S32, 0, conv_copy },
{ SPA_AUDIO_FORMAT_S32P, SPA_AUDIO_FORMAT_S32P, 0, conv_copy },
{ SPA_AUDIO_FORMAT_S32, SPA_AUDIO_FORMAT_S32P, 0, deinterleave_32 },
{ SPA_AUDIO_FORMAT_S32P, SPA_AUDIO_FORMAT_S32, 0, interleave_32 },
2018-04-06 18:39:07 +02:00
/* s24 */
{ SPA_AUDIO_FORMAT_S24, SPA_AUDIO_FORMAT_S24, 0, conv_copy },
{ SPA_AUDIO_FORMAT_S24P, SPA_AUDIO_FORMAT_S24P, 0, conv_copy },
{ SPA_AUDIO_FORMAT_S24, SPA_AUDIO_FORMAT_S24P, 0, deinterleave_24 },
{ SPA_AUDIO_FORMAT_S24P, SPA_AUDIO_FORMAT_S24, 0, interleave_24 },
2018-04-06 18:39:07 +02:00
/* s24_32 */
{ SPA_AUDIO_FORMAT_S24_32, SPA_AUDIO_FORMAT_S24_32, 0, conv_copy },
{ SPA_AUDIO_FORMAT_S24_32P, SPA_AUDIO_FORMAT_S24_32P, 0, conv_copy },
{ SPA_AUDIO_FORMAT_S24_32, SPA_AUDIO_FORMAT_S24_32P, 0, deinterleave_32 },
{ SPA_AUDIO_FORMAT_S24_32P, SPA_AUDIO_FORMAT_S24_32, 0, interleave_32 },
2018-04-06 18:39:07 +02:00
};
static const struct conv_info *find_conv_info(uint32_t src_fmt, uint32_t dst_fmt, uint32_t features)
2018-04-06 18:39:07 +02:00
{
int i;
for (i = 0; i < SPA_N_ELEMENTS(conv_table); i++) {
if (conv_table[i].src_fmt == src_fmt &&
conv_table[i].dst_fmt == dst_fmt &&
(conv_table[i].features == 0 || (conv_table[i].features & features) != 0))
2018-04-06 18:39:07 +02:00
return &conv_table[i];
}
return NULL;
}