You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
113 lines
3.3 KiB
C++
113 lines
3.3 KiB
C++
1 year ago
|
/*
|
||
|
|
* Project 25 IMBE Encoder/Decoder Fixed-Point implementation
|
||
|
|
* Developed by Pavel Yazev E-mail: pyazev@gmail.com
|
||
|
|
* Version 1.0 (c) Copyright 2009
|
||
|
|
*
|
||
|
|
* This 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 3, or (at your option)
|
||
|
|
* any later version.
|
||
|
|
*
|
||
|
|
* The software 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 this; see the file COPYING. If not, write to the Free
|
||
|
|
* Software Foundation, Inc., 51 Franklin Street, Boston, MA
|
||
|
|
* 02110-1301, USA.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include "typedef.h"
|
||
|
|
#include "globals.h"
|
||
|
|
#include "imbe.h"
|
||
|
|
#include "ch_decode.h"
|
||
|
|
#include "sa_decode.h"
|
||
|
|
#include "sa_enh.h"
|
||
|
|
#include "v_synt.h"
|
||
|
|
#include "uv_synt.h"
|
||
|
|
#include "basic_op.h"
|
||
|
|
#include "aux_sub.h"
|
||
|
|
#include "encode.h"
|
||
|
|
#include "dsp_sub.h"
|
||
|
|
#include "imbe_vocoder_impl.h"
|
||
|
|
|
||
|
|
#include <cstring>
|
||
|
|
|
||
|
|
const uint8_t BIT_MASK_TABLE8[] = { 0x80U, 0x40U, 0x20U, 0x10U, 0x08U, 0x04U, 0x02U, 0x01U };
|
||
|
|
#define READ_BIT(p,i) (p[(i)>>3] & BIT_MASK_TABLE8[(i)&7])
|
||
|
|
|
||
|
|
|
||
|
|
void imbe_vocoder_impl::decode_init(IMBE_PARAM *imbe_param)
|
||
|
|
{
|
||
|
|
v_synt_init();
|
||
|
|
uv_synt_init();
|
||
|
|
sa_decode_init();
|
||
|
|
|
||
|
|
// Make previous frame for the first frame
|
||
|
|
memset((char *)imbe_param, 0, sizeof(IMBE_PARAM));
|
||
|
|
imbe_param->fund_freq = 0x0cf6474a;
|
||
|
|
imbe_param->num_harms = 9;
|
||
|
|
imbe_param->num_bands = 3;
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
void imbe_vocoder_impl::decode(IMBE_PARAM *imbe_param, Word16 *frame_vector, Word16 *snd)
|
||
|
|
{
|
||
|
|
Word16 snd_tmp[FRAME];
|
||
|
|
Word16 j;
|
||
|
|
|
||
|
|
decode_frame_vector(imbe_param, frame_vector);
|
||
|
|
v_uv_decode(imbe_param);
|
||
|
|
sa_decode(imbe_param);
|
||
|
|
sa_enh(imbe_param);
|
||
|
|
v_synt(imbe_param, snd);
|
||
|
|
uv_synt(imbe_param, snd_tmp);
|
||
|
|
|
||
|
|
for(j = 0; j < FRAME; j++)
|
||
|
|
snd[j] = add(snd[j], snd_tmp[j]);
|
||
|
|
}
|
||
|
|
|
||
|
|
void imbe_vocoder_impl::decode_4400(int16_t *snd, uint8_t *imbe)
|
||
|
|
{
|
||
|
|
int16_t frame[8U] = {0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000};
|
||
|
|
unsigned int offset = 0U;
|
||
|
|
|
||
|
|
int16_t mask = 0x0800;
|
||
|
|
for (unsigned int i = 0U; i < 12U; i++, mask >>= 1, offset++)
|
||
|
|
frame[0U] |= READ_BIT(imbe, offset) != 0x00U ? mask : 0x0000;
|
||
|
|
|
||
|
|
mask = 0x0800;
|
||
|
|
for (unsigned int i = 0U; i < 12U; i++, mask >>= 1, offset++)
|
||
|
|
frame[1U] |= READ_BIT(imbe, offset) != 0x00U ? mask : 0x0000;
|
||
|
|
|
||
|
|
mask = 0x0800;
|
||
|
|
for (unsigned int i = 0U; i < 12U; i++, mask >>= 1, offset++)
|
||
|
|
frame[2U] |= READ_BIT(imbe, offset) != 0x00U ? mask : 0x0000;
|
||
|
|
|
||
|
|
mask = 0x0800;
|
||
|
|
for (unsigned int i = 0U; i < 12U; i++, mask >>= 1, offset++)
|
||
|
|
frame[3U] |= READ_BIT(imbe, offset) != 0x00U ? mask : 0x0000;
|
||
|
|
|
||
|
|
mask = 0x0400;
|
||
|
|
for (unsigned int i = 0U; i < 11U; i++, mask >>= 1, offset++)
|
||
|
|
frame[4U] |= READ_BIT(imbe, offset) != 0x00U ? mask : 0x0000;
|
||
|
|
|
||
|
|
mask = 0x0400;
|
||
|
|
for (unsigned int i = 0U; i < 11U; i++, mask >>= 1, offset++)
|
||
|
|
frame[5U] |= READ_BIT(imbe, offset) != 0x00U ? mask : 0x0000;
|
||
|
|
|
||
|
|
mask = 0x0400;
|
||
|
|
for (unsigned int i = 0U; i < 11U; i++, mask >>= 1, offset++)
|
||
|
|
frame[6U] |= READ_BIT(imbe, offset) != 0x00U ? mask : 0x0000;
|
||
|
|
|
||
|
|
mask = 0x0040;
|
||
|
|
for (unsigned int i = 0U; i < 7U; i++, mask >>= 1, offset++)
|
||
|
|
frame[7U] |= READ_BIT(imbe, offset) != 0x00U ? mask : 0x0000;
|
||
|
|
|
||
|
|
imbe_decode(frame, snd);
|
||
|
|
}
|
||
|
|
|