| /* GStreamer |
| * Copyright (C) 2005 Wim Taymans <wim at fluendo dot com> |
| * |
| * audioconvert.c: Convert audio to different audio formats automatically |
| * |
| * This library is free software; you can redistribute it and/or |
| * modify it under the terms of the GNU Library General Public |
| * License as published by the Free Software Foundation; either |
| * version 2 of the License, or (at your option) any later version. |
| * |
| * This library 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 |
| * Library General Public License for more details. |
| * |
| * You should have received a copy of the GNU Library General Public |
| * License along with this library; if not, write to the |
| * Free Software Foundation, Inc., 51 Franklin St, Fifth Floor, |
| * Boston, MA 02110-1301, USA. |
| */ |
| |
| #ifdef HAVE_CONFIG_H |
| #include "config.h" |
| #endif |
| |
| #include <math.h> |
| #include <string.h> |
| |
| #include "gstchannelmix.h" |
| #include "gstaudioquantize.h" |
| #include "audioconvert.h" |
| #include "gstaudioconvertorc.h" |
| |
| #if G_BYTE_ORDER == G_LITTLE_ENDIAN |
| #define audio_convert_orc_unpack_u16_le audio_convert_orc_unpack_u16 |
| #define audio_convert_orc_unpack_u16_be audio_convert_orc_unpack_u16_swap |
| #define audio_convert_orc_unpack_s16_le audio_convert_orc_unpack_s16 |
| #define audio_convert_orc_unpack_s16_be audio_convert_orc_unpack_s16_swap |
| #define audio_convert_orc_unpack_u32_le audio_convert_orc_unpack_u32 |
| #define audio_convert_orc_unpack_u32_be audio_convert_orc_unpack_u32_swap |
| #define audio_convert_orc_unpack_s32_le audio_convert_orc_unpack_s32 |
| #define audio_convert_orc_unpack_s32_be audio_convert_orc_unpack_s32_swap |
| #define audio_convert_orc_unpack_float_le audio_convert_orc_unpack_float_s32 |
| #define audio_convert_orc_unpack_float_be audio_convert_orc_unpack_float_s32_swap |
| #define audio_convert_orc_unpack_double_le audio_convert_orc_unpack_double_s32 |
| #define audio_convert_orc_unpack_double_be audio_convert_orc_unpack_double_s32_swap |
| #define audio_convert_orc_unpack_float_hq_le audio_convert_orc_unpack_float_double |
| #define audio_convert_orc_unpack_float_hq_be audio_convert_orc_unpack_float_double_swap |
| #define audio_convert_orc_unpack_double_hq_le audio_convert_orc_unpack_double_double |
| #define audio_convert_orc_unpack_double_hq_be audio_convert_orc_unpack_double_double_swap |
| #define audio_convert_orc_unpack_u8_float audio_convert_orc_unpack_u8_double |
| #define audio_convert_orc_unpack_u16_le_float audio_convert_orc_unpack_u16_double |
| #define audio_convert_orc_unpack_u16_be_float audio_convert_orc_unpack_u16_double_swap |
| #define audio_convert_orc_unpack_u32_le_float audio_convert_orc_unpack_u32_double |
| #define audio_convert_orc_unpack_u32_be_float audio_convert_orc_unpack_u32_double_swap |
| #define audio_convert_orc_unpack_s8_float audio_convert_orc_unpack_s8_double |
| #define audio_convert_orc_unpack_s16_le_float audio_convert_orc_unpack_s16_double |
| #define audio_convert_orc_unpack_s16_be_float audio_convert_orc_unpack_s16_double_swap |
| #define audio_convert_orc_unpack_s32_le_float audio_convert_orc_unpack_s32_double |
| #define audio_convert_orc_unpack_s32_be_float audio_convert_orc_unpack_s32_double_swap |
| #define audio_convert_orc_pack_u8 audio_convert_orc_pack_u8 |
| #define audio_convert_orc_pack_u16_le audio_convert_orc_pack_u16 |
| #define audio_convert_orc_pack_u16_be audio_convert_orc_pack_u16_swap |
| #define audio_convert_orc_pack_s16_le audio_convert_orc_pack_s16 |
| #define audio_convert_orc_pack_s16_be audio_convert_orc_pack_s16_swap |
| #define audio_convert_orc_pack_u32_le audio_convert_orc_pack_u32 |
| #define audio_convert_orc_pack_u32_be audio_convert_orc_pack_u32_swap |
| #define audio_convert_orc_pack_s32_le audio_convert_orc_pack_s32 |
| #define audio_convert_orc_pack_s32_be audio_convert_orc_pack_s32_swap |
| #define audio_convert_orc_pack_float_le audio_convert_orc_pack_s32_float |
| #define audio_convert_orc_pack_float_be audio_convert_orc_pack_s32_float_swap |
| #define audio_convert_orc_pack_double_le audio_convert_orc_pack_s32_double |
| #define audio_convert_orc_pack_double_be audio_convert_orc_pack_s32_double_swap |
| #define audio_convert_orc_pack_float_hq_le audio_convert_orc_pack_double_float |
| #define audio_convert_orc_pack_float_hq_be audio_convert_orc_pack_double_float_swap |
| #define audio_convert_orc_pack_s8_float audio_convert_orc_pack_double_s8 |
| #define audio_convert_orc_pack_s16_le_float audio_convert_orc_pack_double_s16 |
| #define audio_convert_orc_pack_s16_be_float audio_convert_orc_pack_double_s16_swap |
| #define audio_convert_orc_pack_s32_le_float audio_convert_orc_pack_double_s32 |
| #define audio_convert_orc_pack_s32_be_float audio_convert_orc_pack_double_s32_swap |
| #define audio_convert_orc_pack_u8_float audio_convert_orc_pack_double_u8 |
| #define audio_convert_orc_pack_u16_le_float audio_convert_orc_pack_double_u16 |
| #define audio_convert_orc_pack_u16_be_float audio_convert_orc_pack_double_u16_swap |
| #define audio_convert_orc_pack_u32_le_float audio_convert_orc_pack_double_u32 |
| #define audio_convert_orc_pack_u32_be_float audio_convert_orc_pack_double_u32_swap |
| #else |
| #define audio_convert_orc_unpack_u16_be audio_convert_orc_unpack_u16 |
| #define audio_convert_orc_unpack_u16_le audio_convert_orc_unpack_u16_swap |
| #define audio_convert_orc_unpack_s16_be audio_convert_orc_unpack_s16 |
| #define audio_convert_orc_unpack_s16_le audio_convert_orc_unpack_s16_swap |
| #define audio_convert_orc_unpack_u32_be audio_convert_orc_unpack_u32 |
| #define audio_convert_orc_unpack_u32_le audio_convert_orc_unpack_u32_swap |
| #define audio_convert_orc_unpack_s32_be audio_convert_orc_unpack_s32 |
| #define audio_convert_orc_unpack_s32_le audio_convert_orc_unpack_s32_swap |
| #define audio_convert_orc_unpack_float_be audio_convert_orc_unpack_float_s32 |
| #define audio_convert_orc_unpack_float_le audio_convert_orc_unpack_float_s32_swap |
| #define audio_convert_orc_unpack_double_be audio_convert_orc_unpack_double_s32 |
| #define audio_convert_orc_unpack_double_le audio_convert_orc_unpack_double_s32_swap |
| #define audio_convert_orc_unpack_float_hq_be audio_convert_orc_unpack_float_double |
| #define audio_convert_orc_unpack_float_hq_le audio_convert_orc_unpack_float_double_swap |
| #define audio_convert_orc_unpack_double_hq_be audio_convert_orc_unpack_double_double |
| #define audio_convert_orc_unpack_double_hq_le audio_convert_orc_unpack_double_double_swap |
| #define audio_convert_orc_unpack_u8_float audio_convert_orc_unpack_u8_double |
| #define audio_convert_orc_unpack_u16_be_float audio_convert_orc_unpack_u16_double |
| #define audio_convert_orc_unpack_u16_le_float audio_convert_orc_unpack_u16_double_swap |
| #define audio_convert_orc_unpack_u32_be_float audio_convert_orc_unpack_u32_double |
| #define audio_convert_orc_unpack_u32_le_float audio_convert_orc_unpack_u32_double_swap |
| #define audio_convert_orc_unpack_s8_float audio_convert_orc_unpack_s8_double |
| #define audio_convert_orc_unpack_s16_be_float audio_convert_orc_unpack_s16_double |
| #define audio_convert_orc_unpack_s16_le_float audio_convert_orc_unpack_s16_double_swap |
| #define audio_convert_orc_unpack_s32_be_float audio_convert_orc_unpack_s32_double |
| #define audio_convert_orc_unpack_s32_le_float audio_convert_orc_unpack_s32_double_swap |
| #define audio_convert_orc_pack_u8 audio_convert_orc_pack_u8 |
| #define audio_convert_orc_pack_u16_be audio_convert_orc_pack_u16 |
| #define audio_convert_orc_pack_u16_le audio_convert_orc_pack_u16_swap |
| #define audio_convert_orc_pack_s16_be audio_convert_orc_pack_s16 |
| #define audio_convert_orc_pack_s16_le audio_convert_orc_pack_s16_swap |
| #define audio_convert_orc_pack_u32_be audio_convert_orc_pack_u32 |
| #define audio_convert_orc_pack_u32_le audio_convert_orc_pack_u32_swap |
| #define audio_convert_orc_pack_s32_be audio_convert_orc_pack_s32 |
| #define audio_convert_orc_pack_s32_le audio_convert_orc_pack_s32_swap |
| #define audio_convert_orc_pack_float_be audio_convert_orc_pack_s32_float |
| #define audio_convert_orc_pack_float_le audio_convert_orc_pack_s32_float_swap |
| #define audio_convert_orc_pack_double_be audio_convert_orc_pack_s32_double |
| #define audio_convert_orc_pack_double_le audio_convert_orc_pack_s32_double_swap |
| #define audio_convert_orc_pack_float_hq_be audio_convert_orc_pack_double_float |
| #define audio_convert_orc_pack_float_hq_le audio_convert_orc_pack_double_float_swap |
| #define audio_convert_orc_pack_s8_float audio_convert_orc_pack_double_s8 |
| #define audio_convert_orc_pack_s16_be_float audio_convert_orc_pack_double_s16 |
| #define audio_convert_orc_pack_s16_le_float audio_convert_orc_pack_double_s16_swap |
| #define audio_convert_orc_pack_s32_be_float audio_convert_orc_pack_double_s32 |
| #define audio_convert_orc_pack_s32_le_float audio_convert_orc_pack_double_s32_swap |
| #define audio_convert_orc_pack_u8_float audio_convert_orc_pack_double_u8 |
| #define audio_convert_orc_pack_u16_be_float audio_convert_orc_pack_double_u16 |
| #define audio_convert_orc_pack_u16_le_float audio_convert_orc_pack_double_u16_swap |
| #define audio_convert_orc_pack_u32_be_float audio_convert_orc_pack_double_u32 |
| #define audio_convert_orc_pack_u32_le_float audio_convert_orc_pack_double_u32_swap |
| #endif |
| |
| /* sign bit in the intermediate format */ |
| #define SIGNED (1U<<31) |
| |
| /*** |
| * unpack code |
| */ |
| #define MAKE_UNPACK_FUNC_NAME(name) \ |
| audio_convert_unpack_##name |
| #define MAKE_ORC_UNPACK_FUNC_NAME(name) \ |
| audio_convert_orc_unpack_##name |
| |
| /* unpack from integer to signed integer 32 */ |
| #define MAKE_UNPACK_FUNC_II(name, stride, sign, READ_FUNC) \ |
| static void \ |
| MAKE_UNPACK_FUNC_NAME (name) (guint8 *src, gint32 *dst, \ |
| gint scale, gint count) \ |
| { \ |
| for (;count; count--) { \ |
| *dst++ = (((gint32) READ_FUNC (src)) << scale) ^ (sign); \ |
| src+=stride; \ |
| } \ |
| } |
| |
| /* unpack from integer to signed integer 32 with orc */ |
| #define MAKE_UNPACK_FUNC_ORC_II(name, stride, sign, READ_FUNC) \ |
| static void \ |
| MAKE_UNPACK_FUNC_NAME (name) (guint8 *src, gint32 *dst, \ |
| gint scale, gint count) \ |
| { \ |
| MAKE_ORC_UNPACK_FUNC_NAME (name) (dst, src, scale, count); \ |
| } |
| |
| /* unpack from float to signed integer 32 */ |
| #define MAKE_UNPACK_FUNC_FI(name, type, READ_FUNC) \ |
| static void \ |
| MAKE_UNPACK_FUNC_NAME (name) (type * src, gint32 * dst, gint s, gint count) \ |
| { \ |
| gdouble temp; \ |
| \ |
| for (; count; count--) { \ |
| /* blow up to 32 bit */ \ |
| temp = floor ((READ_FUNC (*src++) * 2147483647.0) + 0.5); \ |
| *dst++ = (gint32) CLAMP (temp, G_MININT32, G_MAXINT32); \ |
| } \ |
| } |
| |
| /* unpack from float to signed integer 32 with orc */ |
| #define MAKE_UNPACK_FUNC_ORC_FI(name, type, READ_FUNC) \ |
| static void \ |
| MAKE_UNPACK_FUNC_NAME (name) (type * src, gint32 * dst, gint s, gint count) \ |
| { \ |
| MAKE_ORC_UNPACK_FUNC_NAME (name) ((guint32 *) dst, src, count); \ |
| } |
| |
| /* unpack from float to float 64 (double) */ |
| #define MAKE_UNPACK_FUNC_FF(name, type, FUNC) \ |
| static void \ |
| MAKE_UNPACK_FUNC_NAME (name) (type * src, gdouble * dst, gint s, \ |
| gint count) \ |
| { \ |
| for (; count; count--) \ |
| *dst++ = (gdouble) FUNC (*src++); \ |
| } |
| |
| /* unpack from float to float 64 (double) with orc */ |
| #define MAKE_UNPACK_FUNC_ORC_FF(name, type, FUNC) \ |
| static void \ |
| MAKE_UNPACK_FUNC_NAME (name) (type * src, gdouble * dst, gint s, \ |
| gint count) \ |
| { \ |
| MAKE_ORC_UNPACK_FUNC_NAME (name) ((gdouble *) dst, src, count); \ |
| } |
| |
| /* unpack from int to float 64 (double) */ |
| #define MAKE_UNPACK_FUNC_IF(name, stride, sign, READ_FUNC) \ |
| static void \ |
| MAKE_UNPACK_FUNC_NAME (name) (guint8 * src, gdouble * dst, gint scale, \ |
| gint count) \ |
| { \ |
| gdouble tmp; \ |
| for (; count; count--) { \ |
| tmp = (gdouble) ((((gint32) READ_FUNC (src)) << scale) ^ (sign)); \ |
| *dst++ = tmp * (1.0 / 2147483647.0); \ |
| src += stride; \ |
| } \ |
| } |
| |
| #define MAKE_UNPACK_FUNC_ORC_IF(name, stride, sign, READ_FUNC) \ |
| static void \ |
| MAKE_UNPACK_FUNC_NAME (name) (guint8 *src, gdouble *dst, \ |
| gint scale, gint count) \ |
| { \ |
| MAKE_ORC_UNPACK_FUNC_NAME (name) (dst, src, scale, count); \ |
| } |
| |
| #define READ8(p) GST_READ_UINT8(p) |
| #define READ16_FROM_LE(p) GST_READ_UINT16_LE (p) |
| #define READ16_FROM_BE(p) GST_READ_UINT16_BE (p) |
| #define READ24_FROM_LE(p) (p[0] | (p[1] << 8) | (p[2] << 16)) |
| #define READ24_FROM_BE(p) (p[2] | (p[1] << 8) | (p[0] << 16)) |
| #define READ32_FROM_LE(p) GST_READ_UINT32_LE (p) |
| #define READ32_FROM_BE(p) GST_READ_UINT32_BE (p) |
| |
| |
| |
| MAKE_UNPACK_FUNC_ORC_II (u8, 1, SIGNED, READ8); |
| MAKE_UNPACK_FUNC_ORC_II (s8, 1, 0, READ8); |
| MAKE_UNPACK_FUNC_ORC_II (u16_le, 2, SIGNED, READ16_FROM_LE); |
| MAKE_UNPACK_FUNC_ORC_II (s16_le, 2, 0, READ16_FROM_LE); |
| MAKE_UNPACK_FUNC_ORC_II (u16_be, 2, SIGNED, READ16_FROM_BE); |
| MAKE_UNPACK_FUNC_ORC_II (s16_be, 2, 0, READ16_FROM_BE); |
| MAKE_UNPACK_FUNC_II (u24_le, 3, SIGNED, READ24_FROM_LE); |
| MAKE_UNPACK_FUNC_II (s24_le, 3, 0, READ24_FROM_LE); |
| MAKE_UNPACK_FUNC_II (u24_be, 3, SIGNED, READ24_FROM_BE); |
| MAKE_UNPACK_FUNC_II (s24_be, 3, 0, READ24_FROM_BE); |
| MAKE_UNPACK_FUNC_ORC_II (u32_le, 4, SIGNED, READ32_FROM_LE); |
| MAKE_UNPACK_FUNC_ORC_II (s32_le, 4, 0, READ32_FROM_LE); |
| MAKE_UNPACK_FUNC_ORC_II (u32_be, 4, SIGNED, READ32_FROM_BE); |
| MAKE_UNPACK_FUNC_ORC_II (s32_be, 4, 0, READ32_FROM_BE); |
| MAKE_UNPACK_FUNC_ORC_FI (float_le, gfloat, GFLOAT_FROM_LE); |
| MAKE_UNPACK_FUNC_ORC_FI (float_be, gfloat, GFLOAT_FROM_BE); |
| MAKE_UNPACK_FUNC_ORC_FI (double_le, gdouble, GDOUBLE_FROM_LE); |
| MAKE_UNPACK_FUNC_ORC_FI (double_be, gdouble, GDOUBLE_FROM_BE); |
| MAKE_UNPACK_FUNC_ORC_FF (float_hq_le, gfloat, GFLOAT_FROM_LE); |
| MAKE_UNPACK_FUNC_ORC_FF (float_hq_be, gfloat, GFLOAT_FROM_BE); |
| MAKE_UNPACK_FUNC_ORC_FF (double_hq_le, gdouble, GDOUBLE_FROM_LE); |
| MAKE_UNPACK_FUNC_ORC_FF (double_hq_be, gdouble, GDOUBLE_FROM_BE); |
| MAKE_UNPACK_FUNC_ORC_IF (u8_float, 1, SIGNED, READ8); |
| MAKE_UNPACK_FUNC_ORC_IF (s8_float, 1, 0, READ8); |
| MAKE_UNPACK_FUNC_ORC_IF (u16_le_float, 2, SIGNED, READ16_FROM_LE); |
| MAKE_UNPACK_FUNC_ORC_IF (s16_le_float, 2, 0, READ16_FROM_LE); |
| MAKE_UNPACK_FUNC_ORC_IF (u16_be_float, 2, SIGNED, READ16_FROM_BE); |
| MAKE_UNPACK_FUNC_ORC_IF (s16_be_float, 2, 0, READ16_FROM_BE); |
| MAKE_UNPACK_FUNC_IF (u24_le_float, 3, SIGNED, READ24_FROM_LE); |
| MAKE_UNPACK_FUNC_IF (s24_le_float, 3, 0, READ24_FROM_LE); |
| MAKE_UNPACK_FUNC_IF (u24_be_float, 3, SIGNED, READ24_FROM_BE); |
| MAKE_UNPACK_FUNC_IF (s24_be_float, 3, 0, READ24_FROM_BE); |
| MAKE_UNPACK_FUNC_ORC_IF (u32_le_float, 4, SIGNED, READ32_FROM_LE); |
| MAKE_UNPACK_FUNC_ORC_IF (s32_le_float, 4, 0, READ32_FROM_LE); |
| MAKE_UNPACK_FUNC_ORC_IF (u32_be_float, 4, SIGNED, READ32_FROM_BE); |
| MAKE_UNPACK_FUNC_ORC_IF (s32_be_float, 4, 0, READ32_FROM_BE); |
| |
| /* One of the double_hq_* functions generated above is inefficient, but it's |
| * never used anyway. The same is true for one of the s32_* functions. */ |
| |
| /*** |
| * packing code |
| */ |
| #define MAKE_PACK_FUNC_NAME(name) \ |
| audio_convert_pack_##name |
| #define MAKE_PACK_FUNC_NAME_ORC(name) \ |
| audio_convert_orc_pack_##name |
| |
| /* |
| * These functions convert the signed 32 bit integers to the |
| * target format. For this to work the following steps are done: |
| * |
| * 1) If the output format is unsigned we will XOR the sign bit. This |
| * will do the same as if we add 1<<31. |
| * 2) Afterwards we shift to the target depth. It's necessary to left-shift |
| * on signed values here to get arithmetical shifting. |
| * 3) This is then written into our target array by the corresponding write |
| * function for the target width. |
| */ |
| |
| /* pack from signed integer 32 to integer using Orc */ |
| #define MAKE_PACK_FUNC_ORC_II(name, stride, sign, WRITE_FUNC) \ |
| static void \ |
| MAKE_PACK_FUNC_NAME (name) (gint32 *src, guint8 * dst, \ |
| gint scale, gint count) \ |
| { \ |
| MAKE_PACK_FUNC_NAME_ORC (name) (dst, src, scale, count); \ |
| } |
| |
| /* pack from signed integer 32 to integer */ |
| #define MAKE_PACK_FUNC_II(name, stride, sign, WRITE_FUNC) \ |
| static void \ |
| MAKE_PACK_FUNC_NAME (name) (gint32 *src, guint8 * dst, \ |
| gint scale, gint count) \ |
| { \ |
| gint32 tmp; \ |
| for (;count; count--) { \ |
| tmp = (*src++ ^ (sign)) >> scale; \ |
| WRITE_FUNC (dst, tmp); \ |
| dst += stride; \ |
| } \ |
| } |
| |
| /* pack from signed integer 32 to float using orc */ |
| #define MAKE_PACK_FUNC_ORC_IF(name, type, FUNC) \ |
| static void \ |
| MAKE_PACK_FUNC_NAME (name) (gint32 * src, type * dst, gint scale, \ |
| gint count) \ |
| { \ |
| MAKE_PACK_FUNC_NAME_ORC (name) (dst, src, count); \ |
| } |
| |
| /* pack from signed integer 32 to float */ |
| #define MAKE_PACK_FUNC_IF(name, type, FUNC) \ |
| static void \ |
| MAKE_PACK_FUNC_NAME (name) (gint32 * src, type * dst, gint scale, \ |
| gint count) \ |
| { \ |
| for (; count; count--) \ |
| *dst++ = FUNC ((type) ((*src++) * (1.0 / 2147483647.0))); \ |
| } |
| |
| /* pack from float 64 (double) to float */ |
| #define MAKE_PACK_FUNC_FF(name, type, FUNC) \ |
| static void \ |
| MAKE_PACK_FUNC_NAME (name) (gdouble * src, type * dst, gint s, \ |
| gint count) \ |
| { \ |
| for (; count; count--) \ |
| *dst++ = FUNC ((type) (*src++)); \ |
| } |
| |
| /* pack from float 64 (double) to float with orc */ |
| #define MAKE_PACK_FUNC_ORC_FF(name, type, FUNC) \ |
| static void \ |
| MAKE_PACK_FUNC_NAME (name) (gdouble * src, type * dst, gint s, \ |
| gint count) \ |
| { \ |
| MAKE_PACK_FUNC_NAME_ORC (name) (dst, src, count); \ |
| } |
| |
| /* pack from float 64 (double) to signed int. |
| * the floats are already in the correct range. Only a cast is needed. |
| */ |
| #define MAKE_PACK_FUNC_FI_S(name, stride, WRITE_FUNC) \ |
| static void \ |
| MAKE_PACK_FUNC_NAME (name) (gdouble * src, guint8 * dst, gint scale, \ |
| gint count) \ |
| { \ |
| gint32 tmp; \ |
| for (; count; count--) { \ |
| tmp = (gint32) (*src); \ |
| WRITE_FUNC (dst, tmp); \ |
| src++; \ |
| dst += stride; \ |
| } \ |
| } |
| |
| /* pack from float 64 (double) to unsigned int. |
| * the floats are already in the correct range. Only a cast is needed |
| * and an addition of 2^(target_depth-1) to get in the correct unsigned |
| * range. */ |
| #define MAKE_PACK_FUNC_FI_U(name, stride, WRITE_FUNC) \ |
| static void \ |
| MAKE_PACK_FUNC_NAME (name) (gdouble * src, guint8 * dst, gint scale, \ |
| gint count) \ |
| { \ |
| guint32 tmp; \ |
| gdouble limit = (1U<<(32-scale-1)); \ |
| for (; count; count--) { \ |
| tmp = (guint32) (*src + limit); \ |
| WRITE_FUNC (dst, tmp); \ |
| src++; \ |
| dst += stride; \ |
| } \ |
| } |
| |
| /* pack from float 64 (double) to signed int with orc. |
| * the floats are already in the correct range. Only a cast is needed. |
| */ |
| #define MAKE_PACK_FUNC_ORC_FI_S(name, stride, WRITE_FUNC) \ |
| static void \ |
| MAKE_PACK_FUNC_NAME (name) (gdouble * src, guint8 * dst, gint scale, \ |
| gint count) \ |
| { \ |
| MAKE_PACK_FUNC_NAME_ORC (name) (dst, src, scale, count); \ |
| } |
| |
| /* pack from float 64 (double) to unsigned int with orc. |
| * the floats are already in the correct range. Only a cast is needed. |
| */ |
| #define MAKE_PACK_FUNC_ORC_FI_U(name, stride, WRITE_FUNC) \ |
| static void \ |
| MAKE_PACK_FUNC_NAME (name) (gdouble * src, guint8 * dst, gint scale, \ |
| gint count) \ |
| { \ |
| MAKE_PACK_FUNC_NAME_ORC (name) (dst, src, scale, count); \ |
| } |
| |
| #define WRITE8(p, v) GST_WRITE_UINT8 (p, v) |
| #define WRITE16_TO_LE(p,v) GST_WRITE_UINT16_LE (p, (guint16)(v)) |
| #define WRITE16_TO_BE(p,v) GST_WRITE_UINT16_BE (p, (guint16)(v)) |
| #define WRITE24_TO_LE(p,v) p[0] = v & 0xff; p[1] = (v >> 8) & 0xff; p[2] = (v >> 16) & 0xff |
| #define WRITE24_TO_BE(p,v) p[2] = v & 0xff; p[1] = (v >> 8) & 0xff; p[0] = (v >> 16) & 0xff |
| #define WRITE32_TO_LE(p,v) GST_WRITE_UINT32_LE (p, (guint32)(v)) |
| #define WRITE32_TO_BE(p,v) GST_WRITE_UINT32_BE (p, (guint32)(v)) |
| |
| MAKE_PACK_FUNC_ORC_II (u8, 1, SIGNED, WRITE8); |
| MAKE_PACK_FUNC_ORC_II (s8, 1, 0, WRITE8); |
| MAKE_PACK_FUNC_ORC_II (u16_le, 2, SIGNED, WRITE16_TO_LE); |
| MAKE_PACK_FUNC_ORC_II (s16_le, 2, 0, WRITE16_TO_LE); |
| MAKE_PACK_FUNC_ORC_II (u16_be, 2, SIGNED, WRITE16_TO_BE); |
| MAKE_PACK_FUNC_ORC_II (s16_be, 2, 0, WRITE16_TO_BE); |
| MAKE_PACK_FUNC_II (u24_le, 3, SIGNED, WRITE24_TO_LE); |
| MAKE_PACK_FUNC_II (s24_le, 3, 0, WRITE24_TO_LE); |
| MAKE_PACK_FUNC_II (u24_be, 3, SIGNED, WRITE24_TO_BE); |
| MAKE_PACK_FUNC_II (s24_be, 3, 0, WRITE24_TO_BE); |
| MAKE_PACK_FUNC_ORC_II (u32_le, 4, SIGNED, WRITE32_TO_LE); |
| MAKE_PACK_FUNC_ORC_II (s32_le, 4, 0, WRITE32_TO_LE); |
| MAKE_PACK_FUNC_ORC_II (u32_be, 4, SIGNED, WRITE32_TO_BE); |
| MAKE_PACK_FUNC_ORC_II (s32_be, 4, 0, WRITE32_TO_BE); |
| MAKE_PACK_FUNC_ORC_IF (float_le, gfloat, GFLOAT_TO_LE); |
| MAKE_PACK_FUNC_ORC_IF (float_be, gfloat, GFLOAT_TO_BE); |
| MAKE_PACK_FUNC_ORC_IF (double_le, gdouble, GDOUBLE_TO_LE); |
| MAKE_PACK_FUNC_ORC_IF (double_be, gdouble, GDOUBLE_TO_BE); |
| MAKE_PACK_FUNC_ORC_FF (float_hq_le, gfloat, GFLOAT_TO_LE); |
| MAKE_PACK_FUNC_ORC_FF (float_hq_be, gfloat, GFLOAT_TO_BE); |
| MAKE_PACK_FUNC_ORC_FI_U (u8_float, 1, WRITE8); |
| MAKE_PACK_FUNC_ORC_FI_S (s8_float, 1, WRITE8); |
| MAKE_PACK_FUNC_ORC_FI_U (u16_le_float, 2, WRITE16_TO_LE); |
| MAKE_PACK_FUNC_ORC_FI_S (s16_le_float, 2, WRITE16_TO_LE); |
| MAKE_PACK_FUNC_ORC_FI_U (u16_be_float, 2, WRITE16_TO_BE); |
| MAKE_PACK_FUNC_ORC_FI_S (s16_be_float, 2, WRITE16_TO_BE); |
| MAKE_PACK_FUNC_FI_U (u24_le_float, 3, WRITE24_TO_LE); |
| MAKE_PACK_FUNC_FI_S (s24_le_float, 3, WRITE24_TO_LE); |
| MAKE_PACK_FUNC_FI_U (u24_be_float, 3, WRITE24_TO_BE); |
| MAKE_PACK_FUNC_FI_S (s24_be_float, 3, WRITE24_TO_BE); |
| MAKE_PACK_FUNC_ORC_FI_U (u32_le_float, 4, WRITE32_TO_LE); |
| MAKE_PACK_FUNC_ORC_FI_S (s32_le_float, 4, WRITE32_TO_LE); |
| MAKE_PACK_FUNC_ORC_FI_U (u32_be_float, 4, WRITE32_TO_BE); |
| MAKE_PACK_FUNC_ORC_FI_S (s32_be_float, 4, WRITE32_TO_BE); |
| |
| /* For double_hq, packing and unpacking is the same, so we reuse the unpacking |
| * functions here. */ |
| #define audio_convert_pack_double_hq_le MAKE_UNPACK_FUNC_NAME (double_hq_le) |
| #define audio_convert_pack_double_hq_be MAKE_UNPACK_FUNC_NAME (double_hq_be) |
| |
| static const AudioConvertUnpack unpack_funcs[] = { |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (u8), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (s8), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (u8), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (s8), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (u16_le), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (s16_le), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (u16_be), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (s16_be), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (u24_le), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (s24_le), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (u24_be), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (s24_be), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (u32_le), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (s32_le), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (u32_be), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (s32_be), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (float_le), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (float_be), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (double_le), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (double_be), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (float_hq_le), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (float_hq_be), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (double_hq_le), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (double_hq_be), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (u8_float), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (s8_float), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (u8_float), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (s8_float), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (u16_le_float), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (s16_le_float), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (u16_be_float), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (s16_be_float), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (u24_le_float), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (s24_le_float), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (u24_be_float), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (s24_be_float), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (u32_le_float), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (s32_le_float), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (u32_be_float), |
| (AudioConvertUnpack) MAKE_UNPACK_FUNC_NAME (s32_be_float), |
| }; |
| |
| static const AudioConvertPack pack_funcs[] = { |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (u8), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (s8), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (u8), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (s8), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (u16_le), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (s16_le), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (u16_be), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (s16_be), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (u24_le), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (s24_le), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (u24_be), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (s24_be), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (u32_le), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (s32_le), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (u32_be), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (s32_be), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (float_le), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (float_be), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (double_le), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (double_be), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (float_hq_le), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (float_hq_be), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (double_hq_le), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (double_hq_be), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (u8_float), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (s8_float), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (u8_float), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (s8_float), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (u16_le_float), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (s16_le_float), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (u16_be_float), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (s16_be_float), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (u24_le_float), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (s24_le_float), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (u24_be_float), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (s24_be_float), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (u32_le_float), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (s32_le_float), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (u32_be_float), |
| (AudioConvertPack) MAKE_PACK_FUNC_NAME (s32_be_float), |
| }; |
| |
| #define DOUBLE_INTERMEDIATE_FORMAT(ctx) \ |
| ((!GST_AUDIO_FORMAT_INFO_IS_INTEGER (ctx->in.finfo) && \ |
| !GST_AUDIO_FORMAT_INFO_IS_INTEGER (ctx->out.finfo)) || \ |
| (ctx->ns != NOISE_SHAPING_NONE)) |
| |
| static gint |
| audio_convert_get_func_index (AudioConvertCtx * ctx, |
| const GstAudioFormatInfo * fmt) |
| { |
| gint index = 0; |
| |
| if (GST_AUDIO_FORMAT_INFO_IS_INTEGER (fmt)) { |
| index += (GST_AUDIO_FORMAT_INFO_WIDTH (fmt) / 8 - 1) * 4; |
| index += GST_AUDIO_FORMAT_INFO_IS_LITTLE_ENDIAN (fmt) ? 0 : 2; |
| index += GST_AUDIO_FORMAT_INFO_IS_SIGNED (fmt) ? 1 : 0; |
| index += (ctx->ns == NOISE_SHAPING_NONE) ? 0 : 24; |
| } else { |
| /* this is float/double */ |
| index = 16; |
| index += (GST_AUDIO_FORMAT_INFO_WIDTH (fmt) == 32) ? 0 : 2; |
| index += GST_AUDIO_FORMAT_INFO_IS_LITTLE_ENDIAN (fmt) ? 0 : 1; |
| index += (DOUBLE_INTERMEDIATE_FORMAT (ctx)) ? 4 : 0; |
| } |
| |
| return index; |
| } |
| |
| static inline gboolean |
| check_default (AudioConvertCtx * ctx, const GstAudioFormatInfo * fmt) |
| { |
| if (!DOUBLE_INTERMEDIATE_FORMAT (ctx)) { |
| return GST_AUDIO_FORMAT_INFO_FORMAT (fmt) == GST_AUDIO_FORMAT_S32; |
| } else { |
| return GST_AUDIO_FORMAT_INFO_FORMAT (fmt) == GST_AUDIO_FORMAT_F64; |
| } |
| } |
| |
| gboolean |
| audio_convert_prepare_context (AudioConvertCtx * ctx, GstAudioInfo * in, |
| GstAudioInfo * out, GstAudioConvertDithering dither, |
| GstAudioConvertNoiseShaping ns) |
| { |
| gint idx_in, idx_out; |
| gint in_depth, out_depth; |
| |
| g_return_val_if_fail (ctx != NULL, FALSE); |
| g_return_val_if_fail (in != NULL, FALSE); |
| g_return_val_if_fail (out != NULL, FALSE); |
| |
| /* first clean the existing context */ |
| audio_convert_clean_context (ctx); |
| if ((GST_AUDIO_INFO_CHANNELS (in) != GST_AUDIO_INFO_CHANNELS (out)) && |
| (GST_AUDIO_INFO_IS_UNPOSITIONED (in) |
| || GST_AUDIO_INFO_IS_UNPOSITIONED (out))) |
| goto unpositioned; |
| |
| ctx->in = *in; |
| ctx->out = *out; |
| |
| in_depth = GST_AUDIO_FORMAT_INFO_DEPTH (in->finfo); |
| out_depth = GST_AUDIO_FORMAT_INFO_DEPTH (out->finfo); |
| |
| GST_INFO ("depth in %d, out %d", in_depth, out_depth); |
| |
| /* Don't dither or apply noise shaping if target depth is bigger than 20 bits |
| * as DA converters only can do a SNR up to 20 bits in reality. |
| * Also don't dither or apply noise shaping if target depth is larger than |
| * source depth. */ |
| if (out_depth <= 20 && (!GST_AUDIO_FORMAT_INFO_IS_INTEGER (in->finfo) |
| || in_depth >= out_depth)) { |
| ctx->dither = dither; |
| ctx->ns = ns; |
| GST_INFO ("using dither %d and noise shaping %d", dither, ns); |
| } else { |
| ctx->dither = DITHER_NONE; |
| ctx->ns = NOISE_SHAPING_NONE; |
| GST_INFO ("using no dither and noise shaping"); |
| } |
| |
| /* Use simple error feedback when output sample rate is smaller than |
| * 32000 as the other methods might move the noise to audible ranges */ |
| if (ctx->ns > NOISE_SHAPING_ERROR_FEEDBACK && out->rate < 32000) |
| ctx->ns = NOISE_SHAPING_ERROR_FEEDBACK; |
| |
| gst_channel_mix_setup_matrix (ctx); |
| |
| idx_in = audio_convert_get_func_index (ctx, in->finfo); |
| ctx->unpack = unpack_funcs[idx_in]; |
| |
| idx_out = audio_convert_get_func_index (ctx, out->finfo); |
| ctx->pack = pack_funcs[idx_out]; |
| |
| GST_INFO ("func index in %d, out %d", idx_in, idx_out); |
| |
| /* if both formats are float/double or we use noise shaping use double as |
| * intermediate format and switch mixing */ |
| if (!DOUBLE_INTERMEDIATE_FORMAT (ctx)) { |
| GST_INFO ("use int mixing"); |
| ctx->channel_mix = (AudioConvertMix) gst_channel_mix_mix_int; |
| } else { |
| GST_INFO ("use float mixing"); |
| ctx->channel_mix = (AudioConvertMix) gst_channel_mix_mix_float; |
| } |
| GST_INFO ("unitsizes: %d -> %d", in->bpf, out->bpf); |
| |
| /* check if input is in default format */ |
| ctx->in_default = check_default (ctx, in->finfo); |
| /* check if channel mixer is passthrough */ |
| ctx->mix_passthrough = gst_channel_mix_passthrough (ctx); |
| /* check if output is in default format */ |
| ctx->out_default = check_default (ctx, out->finfo); |
| |
| GST_INFO ("in default %d, mix passthrough %d, out default %d", |
| ctx->in_default, ctx->mix_passthrough, ctx->out_default); |
| |
| ctx->in_scale = |
| GST_AUDIO_FORMAT_INFO_IS_INTEGER (in->finfo) ? (32 - in_depth) : 0; |
| ctx->out_scale = |
| GST_AUDIO_FORMAT_INFO_IS_INTEGER (out->finfo) ? (32 - out_depth) : 0; |
| |
| GST_INFO ("scale in %d, out %d", ctx->in_scale, ctx->out_scale); |
| |
| gst_audio_quantize_setup (ctx); |
| |
| return TRUE; |
| |
| /* ERRORS */ |
| unpositioned: |
| { |
| GST_WARNING ("unpositioned channels"); |
| return FALSE; |
| } |
| } |
| |
| gboolean |
| audio_convert_clean_context (AudioConvertCtx * ctx) |
| { |
| g_return_val_if_fail (ctx != NULL, FALSE); |
| |
| gst_audio_quantize_free (ctx); |
| gst_channel_mix_unset_matrix (ctx); |
| gst_audio_info_init (&ctx->in); |
| gst_audio_info_init (&ctx->out); |
| |
| g_free (ctx->tmpbuf); |
| ctx->tmpbuf = NULL; |
| ctx->tmpbufsize = 0; |
| |
| return TRUE; |
| } |
| |
| gboolean |
| audio_convert_get_sizes (AudioConvertCtx * ctx, gint samples, gint * srcsize, |
| gint * dstsize) |
| { |
| g_return_val_if_fail (ctx != NULL, FALSE); |
| |
| if (srcsize) |
| *srcsize = samples * ctx->in.bpf; |
| if (dstsize) |
| *dstsize = samples * ctx->out.bpf; |
| |
| return TRUE; |
| } |
| |
| gboolean |
| audio_convert_convert (AudioConvertCtx * ctx, gpointer src, |
| gpointer dst, gint samples, gboolean src_writable) |
| { |
| guint insize, outsize, size; |
| gpointer outbuf, tmpbuf; |
| guint intemp = 0, outtemp = 0, biggest; |
| gint in_width, out_width; |
| |
| g_return_val_if_fail (ctx != NULL, FALSE); |
| g_return_val_if_fail (src != NULL, FALSE); |
| g_return_val_if_fail (dst != NULL, FALSE); |
| g_return_val_if_fail (samples >= 0, FALSE); |
| |
| if (samples == 0) |
| return TRUE; |
| |
| insize = ctx->in.bpf * samples; |
| outsize = ctx->out.bpf * samples; |
| |
| in_width = GST_AUDIO_FORMAT_INFO_WIDTH (ctx->in.finfo); |
| out_width = GST_AUDIO_FORMAT_INFO_WIDTH (ctx->out.finfo); |
| |
| /* find biggest temp buffer size */ |
| size = (DOUBLE_INTERMEDIATE_FORMAT (ctx)) ? sizeof (gdouble) |
| : sizeof (gint32); |
| |
| if (!ctx->in_default) |
| intemp = gst_util_uint64_scale (insize, size * 8, in_width); |
| if (!ctx->mix_passthrough || !ctx->out_default) |
| outtemp = gst_util_uint64_scale (outsize, size * 8, out_width); |
| biggest = MAX (intemp, outtemp); |
| |
| /* see if one of the buffers can be used as temp */ |
| if ((outsize >= biggest) && (ctx->out.bpf <= size)) |
| tmpbuf = dst; |
| else if ((insize >= biggest) && src_writable && (ctx->in.bpf >= size)) |
| tmpbuf = src; |
| else { |
| if (biggest > ctx->tmpbufsize) { |
| ctx->tmpbuf = g_realloc (ctx->tmpbuf, biggest); |
| ctx->tmpbufsize = biggest; |
| } |
| tmpbuf = ctx->tmpbuf; |
| } |
| |
| /* start conversion */ |
| if (!ctx->in_default) { |
| /* check if final conversion */ |
| if (!(ctx->out_default && ctx->mix_passthrough)) |
| outbuf = tmpbuf; |
| else |
| outbuf = dst; |
| |
| /* unpack to default format */ |
| ctx->unpack (src, outbuf, ctx->in_scale, samples * ctx->in.channels); |
| |
| src = outbuf; |
| } |
| |
| if (!ctx->mix_passthrough) { |
| /* check if final conversion */ |
| if (!ctx->out_default) |
| outbuf = tmpbuf; |
| else |
| outbuf = dst; |
| |
| /* convert channels */ |
| ctx->channel_mix (ctx, src, outbuf, samples); |
| |
| src = outbuf; |
| } |
| |
| /* we only need to quantize if output format is int */ |
| if (GST_AUDIO_FORMAT_INFO_IS_INTEGER (ctx->out.finfo)) { |
| if (ctx->out_default) |
| outbuf = dst; |
| else |
| outbuf = tmpbuf; |
| ctx->quantize (ctx, src, outbuf, samples); |
| } |
| |
| if (!ctx->out_default) { |
| /* pack default format into dst */ |
| ctx->pack (src, dst, ctx->out_scale, samples * ctx->out.channels); |
| } |
| |
| return TRUE; |
| } |
