ref: b547a29888c8b6452b3f14c24bb4dda01ade6cd3
dir: /src/amr.h/
/* File format: AMR (c) 2007 robs@users.sourceforge.net
*
* This library is free software; you can redistribute it and/or modify it
* under the terms of the GNU Lesser General Public License as published by
* the Free Software Foundation; either version 2.1 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 Lesser
* General Public License for more details.
*
* You should have received a copy of the GNU Lesser General Public License
* along with this library; if not, write to the Free Software Foundation,
* Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
*/
#include <string.h>
#include <math.h>
#ifdef AMR_OPENCORE
LSX_DLENTRIES_TO_FUNCTIONS(AMR_OPENCORE_FUNC_ENTRIES)
typedef struct amr_opencore_funcs {
LSX_DLENTRIES_TO_PTRS(AMR_OPENCORE_FUNC_ENTRIES, amr_dl);
} amr_opencore_funcs;
#endif /* AMR_OPENCORE */
#ifdef AMR_GP3
LSX_DLENTRIES_TO_FUNCTIONS(AMR_GP3_FUNC_ENTRIES)
typedef struct amr_gp3_funcs {
LSX_DLENTRIES_TO_PTRS(AMR_GP3_FUNC_ENTRIES, amr_dl);
} amr_gp3_funcs;
#endif /* AMR_GP3 */
#if defined(AMR_OPENCORE) && defined (AMR_GP3)
#define AMR_CALL(p, opencoreFunc, gp3Func, args) \
((p)->loaded_opencore ? ((p)->opencore.opencoreFunc args) : ((p)->gp3.gp3Func args))
#if AMR_OPENCORE_ENABLE_ENCODE
#define AMR_CALL_ENCODER AMR_CALL
#else
#define AMR_CALL_ENCODER(p, opencoreFunc, gp3Func, args) \
((p)->gp3.gp3Func args)
#endif
#elif defined(AMR_OPENCORE)
#define AMR_CALL(p, opencoreFunc, gp3Func, args) \
((p)->opencore.opencoreFunc args)
#define AMR_CALL_ENCODER AMR_CALL
#elif defined(AMR_GP3)
#define AMR_CALL(p, opencoreFunc, gp3Func, args) \
((p)->gp3.gp3Func args)
#define AMR_CALL_ENCODER AMR_CALL
#endif
typedef struct amr_priv_t {
void* state;
unsigned mode;
size_t pcm_index;
int loaded_opencore;
#ifdef AMR_OPENCORE
amr_opencore_funcs opencore;
#endif /* AMR_OPENCORE */
#ifdef AMR_GP3
amr_gp3_funcs gp3;
#endif /* AMR_GP3 */
short pcm[AMR_FRAME];
} priv_t;
static size_t decode_1_frame(sox_format_t * ft)
{
priv_t * p = (priv_t *)ft->priv;
size_t n_1;
uint8_t coded[AMR_CODED_MAX];
if (lsx_readbuf(ft, &coded[0], (size_t)1) != 1)
return AMR_FRAME;
n_1 = amr_block_size[(coded[0] >> 3) & 0x0F] - 1;
if (lsx_readbuf(ft, &coded[1], n_1) != n_1)
return AMR_FRAME;
AMR_CALL(p, AmrOpencoreDecoderDecode, AmrGp3DecoderDecode, (p->state, coded, p->pcm, 0));
return 0;
}
static int openlibrary(priv_t* p, int encoding)
{
int open_library_result;
(void)encoding;
#ifdef AMR_OPENCORE
if (AMR_OPENCORE_ENABLE_ENCODE || !encoding)
{
LSX_DLLIBRARY_TRYOPEN(
0,
&p->opencore,
amr_dl,
AMR_OPENCORE_FUNC_ENTRIES,
AMR_OPENCORE_DESC,
amr_opencore_library_names,
open_library_result);
if (!open_library_result)
{
p->loaded_opencore = 1;
return SOX_SUCCESS;
}
}
else
{
lsx_report("Not attempting to load " AMR_OPENCORE_DESC " because it does not support encoding.");
}
#endif /* AMR_OPENCORE */
#ifdef AMR_GP3
LSX_DLLIBRARY_TRYOPEN(
0,
&p->gp3,
amr_dl,
AMR_GP3_FUNC_ENTRIES,
AMR_GP3_DESC,
amr_gp3_library_names,
open_library_result);
if (!open_library_result)
return SOX_SUCCESS;
#endif /* AMR_GP3 */
lsx_fail(
"Unable to open "
#ifdef AMR_OPENCORE
AMR_OPENCORE_DESC
#endif
#if defined(AMR_OPENCORE) && defined(AMR_GP3)
" or "
#endif
#ifdef AMR_GP3
AMR_GP3_DESC
#endif
".");
return SOX_EOF;
}
static void closelibrary(priv_t* p)
{
#ifdef AMR_OPENCORE
LSX_DLLIBRARY_CLOSE(&p->opencore, amr_dl);
#endif
#ifdef AMR_GP3
LSX_DLLIBRARY_CLOSE(&p->gp3, amr_dl);
#endif
}
static size_t amr_duration_frames(sox_format_t * ft)
{
off_t frame_size, data_start_offset = lsx_tell(ft);
size_t frames;
uint8_t coded;
for (frames = 0; lsx_readbuf(ft, &coded, (size_t)1) == 1; ++frames) {
frame_size = amr_block_size[coded >> 3 & 15];
if (lsx_seeki(ft, frame_size - 1, SEEK_CUR)) {
lsx_fail("seek");
break;
}
}
lsx_debug("frames=%lu", (unsigned long)frames);
lsx_seeki(ft, data_start_offset, SEEK_SET);
return frames;
}
static int startread(sox_format_t * ft)
{
priv_t * p = (priv_t *)ft->priv;
char buffer[sizeof(amr_magic) - 1];
int open_library_result;
if (lsx_readchars(ft, buffer, sizeof(buffer)))
return SOX_EOF;
if (memcmp(buffer, amr_magic, sizeof(buffer))) {
lsx_fail_errno(ft, SOX_EHDR, "invalid magic number");
return SOX_EOF;
}
open_library_result = openlibrary(p, 0);
if (open_library_result != SOX_SUCCESS)
return open_library_result;
p->pcm_index = AMR_FRAME;
p->state = AMR_CALL(p, AmrOpencoreDecoderInit, AmrGp3DecoderInit, ());
if (!p->state)
{
closelibrary(p);
lsx_fail("AMR decoder failed to initialize.");
return SOX_EOF;
}
ft->signal.rate = AMR_RATE;
ft->encoding.encoding = AMR_ENCODING;
ft->signal.channels = 1;
ft->signal.length = ft->signal.length != SOX_IGNORE_LENGTH && ft->seekable?
(size_t)(amr_duration_frames(ft) * .02 * ft->signal.rate +.5) : SOX_UNSPEC;
return SOX_SUCCESS;
}
static size_t read_samples(sox_format_t * ft, sox_sample_t * buf, size_t len)
{
priv_t * p = (priv_t *)ft->priv;
size_t done;
for (done = 0; done < len; done++) {
if (p->pcm_index >= AMR_FRAME)
p->pcm_index = decode_1_frame(ft);
if (p->pcm_index >= AMR_FRAME)
break;
*buf++ = SOX_SIGNED_16BIT_TO_SAMPLE(p->pcm[p->pcm_index++], ft->clips);
}
return done;
}
static int stopread(sox_format_t * ft)
{
priv_t * p = (priv_t *)ft->priv;
AMR_CALL(p, AmrOpencoreDecoderExit, AmrGp3DecoderExit, (p->state));
closelibrary(p);
return SOX_SUCCESS;
}
static int startwrite(sox_format_t * ft)
{
#if !defined(AMR_GP3) && !AMR_OPENCORE_ENABLE_ENCODE
lsx_fail_errno(ft, SOX_EOF, "SoX was compiled without AMR-WB encoding support.");
return SOX_EOF;
#else
priv_t * p = (priv_t *)ft->priv;
int open_library_result;
if (ft->encoding.compression != HUGE_VAL) {
p->mode = (unsigned)ft->encoding.compression;
if (p->mode != ft->encoding.compression || p->mode > AMR_MODE_MAX) {
lsx_fail_errno(ft, SOX_EINVAL, "compression level must be a whole number from 0 to %i", AMR_MODE_MAX);
return SOX_EOF;
}
}
else p->mode = 0;
open_library_result = openlibrary(p, 1);
if (open_library_result != SOX_SUCCESS)
return open_library_result;
#define IGNORE_WARNING \
p->state = AMR_CALL_ENCODER(p, AmrOpencoreEncoderInit, AmrGp3EncoderInit, ());
#include "ignore-warning.h"
if (!p->state)
{
closelibrary(p);
lsx_fail("AMR encoder failed to initialize.");
return SOX_EOF;
}
lsx_writes(ft, amr_magic);
p->pcm_index = 0;
return SOX_SUCCESS;
#endif
}
#if defined(AMR_GP3) || AMR_OPENCORE_ENABLE_ENCODE
static sox_bool encode_1_frame(sox_format_t * ft)
{
priv_t * p = (priv_t *)ft->priv;
uint8_t coded[AMR_CODED_MAX];
#define IGNORE_WARNING \
int n = AMR_CALL_ENCODER(p, AmrOpencoreEncoderEncode, AmrGp3EncoderEncode, (p->state, p->mode, p->pcm, coded, 1));
#include "ignore-warning.h"
sox_bool result = lsx_writebuf(ft, coded, (size_t) (size_t) (unsigned)n) == (unsigned)n;
if (!result)
lsx_fail_errno(ft, errno, "write error");
return result;
}
static size_t write_samples(sox_format_t * ft, const sox_sample_t * buf, size_t len)
{
priv_t * p = (priv_t *)ft->priv;
size_t done;
for (done = 0; done < len; ++done) {
SOX_SAMPLE_LOCALS;
p->pcm[p->pcm_index++] = SOX_SAMPLE_TO_SIGNED_16BIT(*buf++, ft->clips);
if (p->pcm_index == AMR_FRAME) {
p->pcm_index = 0;
if (!encode_1_frame(ft))
return 0;
}
}
return done;
}
static int stopwrite(sox_format_t * ft)
{
priv_t * p = (priv_t *)ft->priv;
int result = SOX_SUCCESS;
if (p->pcm_index) {
do {
p->pcm[p->pcm_index++] = 0;
} while (p->pcm_index < AMR_FRAME);
if (!encode_1_frame(ft))
result = SOX_EOF;
}
AMR_CALL_ENCODER(p, AmrOpencoreEncoderExit, AmrGp3EncoderExit, (p->state));
return result;
}
#else
#define write_samples NULL
#define stopwrite NULL
#endif /* defined(AMR_GP3) || AMR_OPENCORE_ENABLE_ENCODE */
sox_format_handler_t const * AMR_FORMAT_FN(void);
sox_format_handler_t const * AMR_FORMAT_FN(void)
{
static char const * const names[] = {AMR_NAMES, NULL};
static sox_rate_t const write_rates[] = {AMR_RATE, 0};
static unsigned const write_encodings[] = {AMR_ENCODING, 0, 0};
static sox_format_handler_t handler = {
SOX_LIB_VERSION_CODE,
AMR_DESC,
names, SOX_FILE_MONO,
startread, read_samples, stopread,
startwrite, write_samples, stopwrite,
NULL, write_encodings, write_rates, sizeof(priv_t)
};
return &handler;
}