src/pulsecore/sconv.c

   1 /***
   2   This file is part of PulseAudio.
   3
   4   Copyright 2004-2006 Lennart Poettering
   5   Copyright 2006 Pierre Ossman <ossman@cendio.se> for Cendio AB
   6
   7   PulseAudio is free software; you can redistribute it and/or modify
   8   it under the terms of the GNU Lesser General Public License as published
   9   by the Free Software Foundation; either version 2 of the License,
  10   or (at your option) any later version.
  11
  12   PulseAudio is distributed in the hope that it will be useful, but
  13   WITHOUT ANY WARRANTY; without even the implied warranty of
  14   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  15   General Public License for more details.
  16
  17   You should have received a copy of the GNU Lesser General Public License
  18   along with PulseAudio; if not, write to the Free Software
  19   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
  20   USA.
  21 ***/
  22
  23 #ifdef HAVE_CONFIG_H
  24 #include <config.h>
  25 #endif
  26
  27 #include <stdio.h>
  28 #include <stdlib.h>
  29
  30 #include <liboil/liboilfuncs.h>
  31 #include <liboil/liboil.h>
  32
  33 #include <pulsecore/g711.h>
  34 #include <pulsecore/macro.h>
  35
  36 #include "endianmacros.h"
  37 #include "sconv-s16le.h"
  38 #include "sconv-s16be.h"
  39
  40 #include "sconv.h"
  41
  42 /* u8 */
  43 static void u8_to_float32ne(unsigned n, const uint8_t *a, float *b) {
  44     static const double add = -1, factor = 1.0/128.0;
  45
  46     pa_assert(a);
  47     pa_assert(b);
  48
  49     oil_scaleconv_f32_u8(b, a, (int) n, &add, &factor);
  50 }
  51
  52 static void u8_from_float32ne(unsigned n, const float *a, uint8_t *b) {
  53     static const double add = 128, factor = 127.0;
  54
  55     pa_assert(a);
  56     pa_assert(b);
  57
  58     oil_scaleconv_u8_f32(b, a, (int) n, &add, &factor);
  59 }
  60
  61 static void u8_to_s16ne(unsigned n, const uint8_t *a, int16_t *b) {
  62     static const int16_t add = -0x80, factor = 0x100;
  63
  64     pa_assert(a);
  65     pa_assert(b);
  66
  67     oil_conv_s16_u8(b, 2, a, 1, (int) n);
  68     oil_scalaradd_s16(b, 2, b, 2, &add, (int) n);
  69     oil_scalarmult_s16(b, 2, b, 2, &factor, (int) n);
  70 }
  71
  72 static void u8_from_s16ne(unsigned n, const int16_t *a, uint8_t *b) {
  73
  74     pa_assert(a);
  75     pa_assert(b);
  76
  77     for (; n > 0; n--, a++, b++)
  78         *b = (uint8_t) (*a / 0x100 + 0x80);
  79 }
  80
  81 /* float32 */
  82
  83 static void float32ne_to_float32ne(unsigned n, const float *a, float *b) {
  84     pa_assert(a);
  85     pa_assert(b);
  86
  87     oil_memcpy(b, a, (int) (sizeof(float) * n));
  88 }
  89
  90 static void float32re_to_float32ne(unsigned n, const float *a, float *b) {
  91     pa_assert(a);
  92     pa_assert(b);
  93
  94     for (; n > 0; n--, a++, b++)
  95         *((uint32_t *) b) = PA_UINT32_SWAP(*((uint32_t *) a));
  96 }
  97
  98 /* s16 */
  99
 100 static void s16ne_to_s16ne(unsigned n, const int16_t *a, int16_t *b) {
 101     pa_assert(a);
 102     pa_assert(b);
 103
 104     oil_memcpy(b, a, (int) (sizeof(int16_t) * n));
 105 }
 106
 107 static void s16re_to_s16ne(unsigned n, const int16_t *a, int16_t *b) {
 108     pa_assert(a);
 109     pa_assert(b);
 110
 111     for (; n > 0; n--, a++, b++)
 112         *b = PA_INT16_SWAP(*a);
 113 }
 114
 115 /* ulaw */
 116
 117 static void ulaw_to_float32ne(unsigned n, const uint8_t *a, float *b) {
 118     pa_assert(a);
 119     pa_assert(b);
 120
 121     for (; n > 0; n--)
 122         *(b++) = (float) st_ulaw2linear16(*(a++)) / 0x8000;
 123 }
 124
 125 static void ulaw_from_float32ne(unsigned n, const float *a, uint8_t *b) {
 126     pa_assert(a);
 127     pa_assert(b);
 128
 129     for (; n > 0; n--) {
 130         float v = *(a++);
 131         v = PA_CLAMP_UNLIKELY(v, -1.0f, 1.0f);
 132         v *= 0x1FFF;
 133         *(b++) = st_14linear2ulaw((int16_t) v);
 134     }
 135 }
 136
 137 static void ulaw_to_s16ne(unsigned n, const uint8_t *a, int16_t *b) {
 138     pa_assert(a);
 139     pa_assert(b);
 140
 141     for (; n > 0; n--, a++, b++)
 142         *b = st_ulaw2linear16(*a);
 143 }
 144
 145 static void ulaw_from_s16ne(unsigned n, const int16_t *a, uint8_t *b) {
 146     pa_assert(a);
 147     pa_assert(b);
 148
 149     for (; n > 0; n--, a++, b++)
 150         *b = st_14linear2ulaw(*a >> 2);
 151 }
 152
 153 /* alaw */
 154
 155 static void alaw_to_float32ne(unsigned n, const uint8_t *a, float *b) {
 156     pa_assert(a);
 157     pa_assert(b);
 158
 159     for (; n > 0; n--, a++, b++)
 160         *b = (float) st_alaw2linear16(*a) / 0x8000;
 161 }
 162
 163 static void alaw_from_float32ne(unsigned n, const float *a, uint8_t *b) {
 164     pa_assert(a);
 165     pa_assert(b);
 166
 167     for (; n > 0; n--, a++, b++) {
 168         float v = *a;
 169         v = PA_CLAMP_UNLIKELY(v, -1.0f, 1.0f);
 170         v *= 0xFFF;
 171         *b = st_13linear2alaw((int16_t) v);
 172     }
 173 }
 174
 175 static void alaw_to_s16ne(unsigned n, const int8_t *a, int16_t *b) {
 176     pa_assert(a);
 177     pa_assert(b);
 178
 179     for (; n > 0; n--, a++, b++)
 180         *b = st_alaw2linear16((uint8_t) *a);
 181 }
 182
 183 static void alaw_from_s16ne(unsigned n, const int16_t *a, uint8_t *b) {
 184     pa_assert(a);
 185     pa_assert(b);
 186
 187     for (; n > 0; n--, a++, b++)
 188         *b = st_13linear2alaw(*a >> 3);
 189 }
 190
 191 pa_convert_func_t pa_get_convert_to_float32ne_function(pa_sample_format_t f) {
 192
 193     static const pa_convert_func_t table[] = {
 194         [PA_SAMPLE_U8]        = (pa_convert_func_t) u8_to_float32ne,
 195         [PA_SAMPLE_ALAW]      = (pa_convert_func_t) alaw_to_float32ne,
 196         [PA_SAMPLE_ULAW]      = (pa_convert_func_t) ulaw_to_float32ne,
 197         [PA_SAMPLE_S16LE]     = (pa_convert_func_t) pa_sconv_s16le_to_float32ne,
 198         [PA_SAMPLE_S16BE]     = (pa_convert_func_t) pa_sconv_s16be_to_float32ne,
 199         [PA_SAMPLE_S32LE]     = (pa_convert_func_t) pa_sconv_s32le_to_float32ne,
 200         [PA_SAMPLE_S32BE]     = (pa_convert_func_t) pa_sconv_s32be_to_float32ne,
 201         [PA_SAMPLE_FLOAT32NE] = (pa_convert_func_t) float32ne_to_float32ne,
 202         [PA_SAMPLE_FLOAT32RE] = (pa_convert_func_t) float32re_to_float32ne,
 203     };
 204
 205     pa_assert(f >= 0);
 206     pa_assert(f < PA_SAMPLE_MAX);
 207
 208     return table[f];
 209 }
 210
 211 pa_convert_func_t pa_get_convert_from_float32ne_function(pa_sample_format_t f) {
 212
 213     static const pa_convert_func_t table[] = {
 214         [PA_SAMPLE_U8]        = (pa_convert_func_t) u8_from_float32ne,
 215         [PA_SAMPLE_S16LE]     = (pa_convert_func_t) pa_sconv_s16le_from_float32ne,
 216         [PA_SAMPLE_S16BE]     = (pa_convert_func_t) pa_sconv_s16be_from_float32ne,
 217         [PA_SAMPLE_S32LE]     = (pa_convert_func_t) pa_sconv_s32le_from_float32ne,
 218         [PA_SAMPLE_S32BE]     = (pa_convert_func_t) pa_sconv_s32be_from_float32ne,
 219         [PA_SAMPLE_FLOAT32NE] = (pa_convert_func_t) float32ne_to_float32ne,
 220         [PA_SAMPLE_FLOAT32RE] = (pa_convert_func_t) float32re_to_float32ne,
 221         [PA_SAMPLE_ALAW]      = (pa_convert_func_t) alaw_from_float32ne,
 222         [PA_SAMPLE_ULAW]      = (pa_convert_func_t) ulaw_from_float32ne
 223     };
 224
 225     pa_assert(f >= 0);
 226     pa_assert(f < PA_SAMPLE_MAX);
 227
 228     return table[f];
 229 }
 230
 231 pa_convert_func_t pa_get_convert_to_s16ne_function(pa_sample_format_t f) {
 232
 233     static const pa_convert_func_t table[] = {
 234         [PA_SAMPLE_U8]        = (pa_convert_func_t) u8_to_s16ne,
 235         [PA_SAMPLE_S16NE]     = (pa_convert_func_t) s16ne_to_s16ne,
 236         [PA_SAMPLE_S16RE]     = (pa_convert_func_t) s16re_to_s16ne,
 237         [PA_SAMPLE_FLOAT32BE] = (pa_convert_func_t) pa_sconv_float32be_to_s16ne,
 238         [PA_SAMPLE_FLOAT32LE] = (pa_convert_func_t) pa_sconv_float32le_to_s16ne,
 239         [PA_SAMPLE_S32BE]     = (pa_convert_func_t) pa_sconv_s32be_to_s16ne,
 240         [PA_SAMPLE_S32LE]     = (pa_convert_func_t) pa_sconv_s32le_to_s16ne,
 241         [PA_SAMPLE_ALAW]      = (pa_convert_func_t) alaw_to_s16ne,
 242         [PA_SAMPLE_ULAW]      = (pa_convert_func_t) ulaw_to_s16ne
 243     };
 244
 245     pa_assert(f >= 0);
 246     pa_assert(f < PA_SAMPLE_MAX);
 247
 248     return table[f];
 249 }
 250
 251 pa_convert_func_t pa_get_convert_from_s16ne_function(pa_sample_format_t f) {
 252
 253     static const pa_convert_func_t table[] = {
 254         [PA_SAMPLE_U8]        = (pa_convert_func_t) u8_from_s16ne,
 255         [PA_SAMPLE_S16NE]     = (pa_convert_func_t) s16ne_to_s16ne,
 256         [PA_SAMPLE_S16RE]     = (pa_convert_func_t) s16re_to_s16ne,
 257         [PA_SAMPLE_FLOAT32BE] = (pa_convert_func_t) pa_sconv_float32be_from_s16ne,
 258         [PA_SAMPLE_FLOAT32LE] = (pa_convert_func_t) pa_sconv_float32le_from_s16ne,
 259         [PA_SAMPLE_S32BE]     = (pa_convert_func_t) pa_sconv_s32be_from_s16ne,
 260         [PA_SAMPLE_S32LE]     = (pa_convert_func_t) pa_sconv_s32le_from_s16ne,
 261         [PA_SAMPLE_ALAW]      = (pa_convert_func_t) alaw_from_s16ne,
 262         [PA_SAMPLE_ULAW]      = (pa_convert_func_t) ulaw_from_s16ne,
 263     };
 264
 265     pa_assert(f >= 0);
 266     pa_assert(f < PA_SAMPLE_MAX);
 267
 268     return table[f];
 269 }