diff options
Diffstat (limited to 'audio/filter/af_format.c')
-rw-r--r-- | audio/filter/af_format.c | 519 |
1 files changed, 519 insertions, 0 deletions
diff --git a/audio/filter/af_format.c b/audio/filter/af_format.c new file mode 100644 index 0000000000..4ac9caaa85 --- /dev/null +++ b/audio/filter/af_format.c @@ -0,0 +1,519 @@ +/* + * This audio filter changes the format of a data block. Valid + * formats are: AFMT_U8, AFMT_S8, AFMT_S16_LE, AFMT_S16_BE + * AFMT_U16_LE, AFMT_U16_BE, AFMT_S32_LE and AFMT_S32_BE. + * + * This file is part of MPlayer. + * + * MPlayer 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. + * + * MPlayer 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 MPlayer; if not, write to the Free Software Foundation, Inc., + * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. + */ + +#include <stdio.h> +#include <stdlib.h> +#include <string.h> +#include <inttypes.h> +#include <limits.h> +#include <math.h> +#include <sys/types.h> + +#include "config.h" +#include "af.h" +#include "mpbswap.h" + +/* Functions used by play to convert the input audio to the correct + format */ + +/* The below includes retrieves functions for converting to and from + ulaw and alaw */ +#include "af_format_ulaw.h" +#include "af_format_alaw.h" + +// Switch endianness +static void endian(void* in, void* out, int len, int bps); +// From signed to unsigned and the other way +static void si2us(void* data, int len, int bps); +// Change the number of bits per sample +static void change_bps(void* in, void* out, int len, int inbps, int outbps); +// From float to int signed +static void float2int(float* in, void* out, int len, int bps); +// From signed int to float +static void int2float(void* in, float* out, int len, int bps); + +static struct mp_audio* play(struct af_instance* af, struct mp_audio* data); +static struct mp_audio* play_swapendian(struct af_instance* af, struct mp_audio* data); +static struct mp_audio* play_float_s16(struct af_instance* af, struct mp_audio* data); +static struct mp_audio* play_s16_float(struct af_instance* af, struct mp_audio* data); + +// Helper functions to check sanity for input arguments + +// Sanity check for bytes per sample +static int check_bps(int bps) +{ + if(bps != 4 && bps != 3 && bps != 2 && bps != 1){ + mp_msg(MSGT_AFILTER, MSGL_ERR, "[format] The number of bytes per sample" + " must be 1, 2, 3 or 4. Current value is %i \n",bps); + return AF_ERROR; + } + return AF_OK; +} + +// Check for unsupported formats +static int check_format(int format) +{ + char buf[256]; + switch(format & AF_FORMAT_SPECIAL_MASK){ + case(AF_FORMAT_IMA_ADPCM): + case(AF_FORMAT_MPEG2): + case(AF_FORMAT_AC3): + mp_msg(MSGT_AFILTER, MSGL_ERR, "[format] Sample format %s not yet supported \n", + af_fmt2str(format,buf,256)); + return AF_ERROR; + } + return AF_OK; +} + +// Initialization and runtime control +static int control(struct af_instance* af, int cmd, void* arg) +{ + switch(cmd){ + case AF_CONTROL_REINIT:{ + char buf1[256]; + char buf2[256]; + struct mp_audio *data = arg; + + // Make sure this filter isn't redundant + if(af->data->format == data->format && + af->data->bps == data->bps) + return AF_DETACH; + + // Allow trivial AC3-endianness conversion + if (!AF_FORMAT_IS_AC3(af->data->format) || !AF_FORMAT_IS_AC3(data->format)) + // Check for errors in configuration + if((AF_OK != check_bps(data->bps)) || + (AF_OK != check_format(data->format)) || + (AF_OK != check_bps(af->data->bps)) || + (AF_OK != check_format(af->data->format))) + return AF_ERROR; + + mp_msg(MSGT_AFILTER, MSGL_V, "[format] Changing sample format from %s to %s\n", + af_fmt2str(data->format,buf1,256), + af_fmt2str(af->data->format,buf2,256)); + + af->data->rate = data->rate; + af->data->nch = data->nch; + af->mul = (double)af->data->bps / data->bps; + + af->play = play; // set default + + // look whether only endianness differences are there + if ((af->data->format & ~AF_FORMAT_END_MASK) == + (data->format & ~AF_FORMAT_END_MASK)) + { + mp_msg(MSGT_AFILTER, MSGL_V, "[format] Accelerated endianness conversion only\n"); + af->play = play_swapendian; + } + if ((data->format == AF_FORMAT_FLOAT_NE) && + (af->data->format == AF_FORMAT_S16_NE)) + { + mp_msg(MSGT_AFILTER, MSGL_V, "[format] Accelerated %s to %s conversion\n", + af_fmt2str(data->format,buf1,256), + af_fmt2str(af->data->format,buf2,256)); + af->play = play_float_s16; + } + if ((data->format == AF_FORMAT_S16_NE) && + (af->data->format == AF_FORMAT_FLOAT_NE)) + { + mp_msg(MSGT_AFILTER, MSGL_V, "[format] Accelerated %s to %s conversion\n", + af_fmt2str(data->format,buf1,256), + af_fmt2str(af->data->format,buf2,256)); + af->play = play_s16_float; + } + return AF_OK; + } + case AF_CONTROL_COMMAND_LINE:{ + int format = af_str2fmt_short(bstr0(arg)); + if (format == -1) { + mp_msg(MSGT_AFILTER, MSGL_ERR, "[format] %s is not a valid format\n", (char *)arg); + return AF_ERROR; + } + if(AF_OK != af->control(af,AF_CONTROL_FORMAT_FMT | AF_CONTROL_SET,&format)) + return AF_ERROR; + return AF_OK; + } + case AF_CONTROL_FORMAT_FMT | AF_CONTROL_SET:{ + // Check for errors in configuration + if(!AF_FORMAT_IS_AC3(*(int*)arg) && AF_OK != check_format(*(int*)arg)) + return AF_ERROR; + + af->data->format = *(int*)arg; + af->data->bps = af_fmt2bits(af->data->format)/8; + + return AF_OK; + } + } + return AF_UNKNOWN; +} + +// Deallocate memory +static void uninit(struct af_instance* af) +{ + if (af->data) + free(af->data->audio); + free(af->data); + af->setup = 0; +} + +static struct mp_audio* play_swapendian(struct af_instance* af, struct mp_audio* data) +{ + struct mp_audio* l = af->data; // Local data + struct mp_audio* c = data; // Current working data + int len = c->len/c->bps; // Length in samples of current audio block + + if(AF_OK != RESIZE_LOCAL_BUFFER(af,data)) + return NULL; + + endian(c->audio,l->audio,len,c->bps); + + c->audio = l->audio; + c->format = l->format; + + return c; +} + +static struct mp_audio* play_float_s16(struct af_instance* af, struct mp_audio* data) +{ + struct mp_audio* l = af->data; // Local data + struct mp_audio* c = data; // Current working data + int len = c->len/4; // Length in samples of current audio block + + if(AF_OK != RESIZE_LOCAL_BUFFER(af,data)) + return NULL; + + float2int(c->audio, l->audio, len, 2); + + c->audio = l->audio; + c->len = len*2; + c->bps = 2; + c->format = l->format; + + return c; +} + +static struct mp_audio* play_s16_float(struct af_instance* af, struct mp_audio* data) +{ + struct mp_audio* l = af->data; // Local data + struct mp_audio* c = data; // Current working data + int len = c->len/2; // Length in samples of current audio block + + if(AF_OK != RESIZE_LOCAL_BUFFER(af,data)) + return NULL; + + int2float(c->audio, l->audio, len, 2); + + c->audio = l->audio; + c->len = len*4; + c->bps = 4; + c->format = l->format; + + return c; +} + +// Filter data through filter +static struct mp_audio* play(struct af_instance* af, struct mp_audio* data) +{ + struct mp_audio* l = af->data; // Local data + struct mp_audio* c = data; // Current working data + int len = c->len/c->bps; // Length in samples of current audio block + + if(AF_OK != RESIZE_LOCAL_BUFFER(af,data)) + return NULL; + + // Change to cpu native endian format + if((c->format&AF_FORMAT_END_MASK)!=AF_FORMAT_NE) + endian(c->audio,c->audio,len,c->bps); + + // Conversion table + if((c->format & AF_FORMAT_SPECIAL_MASK) == AF_FORMAT_MU_LAW) { + from_ulaw(c->audio, l->audio, len, l->bps, l->format&AF_FORMAT_POINT_MASK); + if(AF_FORMAT_A_LAW == (l->format&AF_FORMAT_SPECIAL_MASK)) + to_ulaw(l->audio, l->audio, len, 1, AF_FORMAT_SI); + if((l->format&AF_FORMAT_SIGN_MASK) == AF_FORMAT_US) + si2us(l->audio,len,l->bps); + } else if((c->format & AF_FORMAT_SPECIAL_MASK) == AF_FORMAT_A_LAW) { + from_alaw(c->audio, l->audio, len, l->bps, l->format&AF_FORMAT_POINT_MASK); + if(AF_FORMAT_A_LAW == (l->format&AF_FORMAT_SPECIAL_MASK)) + to_alaw(l->audio, l->audio, len, 1, AF_FORMAT_SI); + if((l->format&AF_FORMAT_SIGN_MASK) == AF_FORMAT_US) + si2us(l->audio,len,l->bps); + } else if((c->format & AF_FORMAT_POINT_MASK) == AF_FORMAT_F) { + switch(l->format&AF_FORMAT_SPECIAL_MASK){ + case(AF_FORMAT_MU_LAW): + to_ulaw(c->audio, l->audio, len, c->bps, c->format&AF_FORMAT_POINT_MASK); + break; + case(AF_FORMAT_A_LAW): + to_alaw(c->audio, l->audio, len, c->bps, c->format&AF_FORMAT_POINT_MASK); + break; + default: + float2int(c->audio, l->audio, len, l->bps); + if((l->format&AF_FORMAT_SIGN_MASK) == AF_FORMAT_US) + si2us(l->audio,len,l->bps); + break; + } + } else { + // Input must be int + + // Change signed/unsigned + if((c->format&AF_FORMAT_SIGN_MASK) != (l->format&AF_FORMAT_SIGN_MASK)){ + si2us(c->audio,len,c->bps); + } + // Convert to special formats + switch(l->format&(AF_FORMAT_SPECIAL_MASK|AF_FORMAT_POINT_MASK)){ + case(AF_FORMAT_MU_LAW): + to_ulaw(c->audio, l->audio, len, c->bps, c->format&AF_FORMAT_POINT_MASK); + break; + case(AF_FORMAT_A_LAW): + to_alaw(c->audio, l->audio, len, c->bps, c->format&AF_FORMAT_POINT_MASK); + break; + case(AF_FORMAT_F): + int2float(c->audio, l->audio, len, c->bps); + break; + default: + // Change the number of bits + if(c->bps != l->bps) + change_bps(c->audio,l->audio,len,c->bps,l->bps); + else + memcpy(l->audio,c->audio,len*c->bps); + break; + } + } + + // Switch from cpu native endian to the correct endianness + if((l->format&AF_FORMAT_END_MASK)!=AF_FORMAT_NE) + endian(l->audio,l->audio,len,l->bps); + + // Set output data + c->audio = l->audio; + c->len = len*l->bps; + c->bps = l->bps; + c->format = l->format; + return c; +} + +// Allocate memory and set function pointers +static int af_open(struct af_instance* af){ + af->control=control; + af->uninit=uninit; + af->play=play; + af->mul=1; + af->data=calloc(1,sizeof(struct mp_audio)); + if(af->data == NULL) + return AF_ERROR; + return AF_OK; +} + +// Description of this filter +struct af_info af_info_format = { + "Sample format conversion", + "format", + "Anders", + "", + AF_FLAGS_REENTRANT, + af_open +}; + +static inline uint32_t load24bit(void* data, int pos) { +#if BYTE_ORDER == BIG_ENDIAN + return (((uint32_t)((uint8_t*)data)[3*pos])<<24) | + (((uint32_t)((uint8_t*)data)[3*pos+1])<<16) | + (((uint32_t)((uint8_t*)data)[3*pos+2])<<8); +#else + return (((uint32_t)((uint8_t*)data)[3*pos])<<8) | + (((uint32_t)((uint8_t*)data)[3*pos+1])<<16) | + (((uint32_t)((uint8_t*)data)[3*pos+2])<<24); +#endif +} + +static inline void store24bit(void* data, int pos, uint32_t expanded_value) { +#if BYTE_ORDER == BIG_ENDIAN + ((uint8_t*)data)[3*pos]=expanded_value>>24; + ((uint8_t*)data)[3*pos+1]=expanded_value>>16; + ((uint8_t*)data)[3*pos+2]=expanded_value>>8; +#else + ((uint8_t*)data)[3*pos]=expanded_value>>8; + ((uint8_t*)data)[3*pos+1]=expanded_value>>16; + ((uint8_t*)data)[3*pos+2]=expanded_value>>24; +#endif +} + +// Function implementations used by play +static void endian(void* in, void* out, int len, int bps) +{ + register int i; + switch(bps){ + case(2):{ + for(i=0;i<len;i++){ + ((uint16_t*)out)[i]=bswap_16(((uint16_t*)in)[i]); + } + break; + } + case(3):{ + register uint8_t s; + for(i=0;i<len;i++){ + s=((uint8_t*)in)[3*i]; + ((uint8_t*)out)[3*i]=((uint8_t*)in)[3*i+2]; + if (in != out) + ((uint8_t*)out)[3*i+1]=((uint8_t*)in)[3*i+1]; + ((uint8_t*)out)[3*i+2]=s; + } + break; + } + case(4):{ + for(i=0;i<len;i++){ + ((uint32_t*)out)[i]=bswap_32(((uint32_t*)in)[i]); + } + break; + } + } +} + +static void si2us(void* data, int len, int bps) +{ + register long i = -(len * bps); + register uint8_t *p = &((uint8_t *)data)[len * bps]; +#if AF_FORMAT_NE == AF_FORMAT_LE + p += bps - 1; +#endif + if (len <= 0) return; + do { + p[i] ^= 0x80; + } while (i += bps); +} + +static void change_bps(void* in, void* out, int len, int inbps, int outbps) +{ + register int i; + switch(inbps){ + case(1): + switch(outbps){ + case(2): + for(i=0;i<len;i++) + ((uint16_t*)out)[i]=((uint16_t)((uint8_t*)in)[i])<<8; + break; + case(3): + for(i=0;i<len;i++) + store24bit(out, i, ((uint32_t)((uint8_t*)in)[i])<<24); + break; + case(4): + for(i=0;i<len;i++) + ((uint32_t*)out)[i]=((uint32_t)((uint8_t*)in)[i])<<24; + break; + } + break; + case(2): + switch(outbps){ + case(1): + for(i=0;i<len;i++) + ((uint8_t*)out)[i]=(uint8_t)((((uint16_t*)in)[i])>>8); + break; + case(3): + for(i=0;i<len;i++) + store24bit(out, i, ((uint32_t)((uint16_t*)in)[i])<<16); + break; + case(4): + for(i=0;i<len;i++) + ((uint32_t*)out)[i]=((uint32_t)((uint16_t*)in)[i])<<16; + break; + } + break; + case(3): + switch(outbps){ + case(1): + for(i=0;i<len;i++) + ((uint8_t*)out)[i]=(uint8_t)(load24bit(in, i)>>24); + break; + case(2): + for(i=0;i<len;i++) + ((uint16_t*)out)[i]=(uint16_t)(load24bit(in, i)>>16); + break; + case(4): + for(i=0;i<len;i++) + ((uint32_t*)out)[i]=(uint32_t)load24bit(in, i); + break; + } + break; + case(4): + switch(outbps){ + case(1): + for(i=0;i<len;i++) + ((uint8_t*)out)[i]=(uint8_t)((((uint32_t*)in)[i])>>24); + break; + case(2): + for(i=0;i<len;i++) + ((uint16_t*)out)[i]=(uint16_t)((((uint32_t*)in)[i])>>16); + break; + case(3): + for(i=0;i<len;i++) + store24bit(out, i, ((uint32_t*)in)[i]); + break; + } + break; + } +} + +static void float2int(float* in, void* out, int len, int bps) +{ + register int i; + switch(bps){ + case(1): + for(i=0;i<len;i++) + ((int8_t*)out)[i] = lrintf(127.0 * clamp(in[i], -1.0f, +1.0f)); + break; + case(2): + for(i=0;i<len;i++) + ((int16_t*)out)[i] = lrintf(32767.0 * clamp(in[i], -1.0f, +1.0f)); + break; + case(3): + for(i=0;i<len;i++) + store24bit(out, i, lrintf(2147483647.0 * clamp(in[i], -1.0f, +1.0f))); + break; + case(4): + for(i=0;i<len;i++) + ((int32_t*)out)[i] = lrintf(2147483647.0 * clamp(in[i], -1.0f, +1.0f)); + break; + } +} + +static void int2float(void* in, float* out, int len, int bps) +{ + register int i; + switch(bps){ + case(1): + for(i=0;i<len;i++) + out[i]=(1.0/128.0)*((int8_t*)in)[i]; + break; + case(2): + for(i=0;i<len;i++) + out[i]=(1.0/32768.0)*((int16_t*)in)[i]; + break; + case(3): + for(i=0;i<len;i++) + out[i]=(1.0/2147483648.0)*((int32_t)load24bit(in, i)); + break; + case(4): + for(i=0;i<len;i++) + out[i]=(1.0/2147483648.0)*((int32_t*)in)[i]; + break; + } +} |