736 lines
22 KiB
C
736 lines
22 KiB
C
/*
|
|
* Copyright (c) 2011 The WebRTC project authors. All Rights Reserved.
|
|
*
|
|
* Use of this source code is governed by a BSD-style license
|
|
* that can be found in the LICENSE file in the root of the source
|
|
* tree. An additional intellectual property rights grant can be found
|
|
* in the file PATENTS. All contributing project authors may
|
|
* be found in the AUTHORS file in the root of the source tree.
|
|
*/
|
|
|
|
|
|
#include <string.h>
|
|
#include <stdlib.h>
|
|
|
|
#include "webrtc_cng.h"
|
|
#include "signal_processing_library.h"
|
|
#include "cng_helpfuns.h"
|
|
#include "stdio.h"
|
|
|
|
|
|
typedef struct WebRtcCngDecInst_t_ {
|
|
|
|
WebRtc_UWord32 dec_seed;
|
|
WebRtc_Word32 dec_target_energy;
|
|
WebRtc_Word32 dec_used_energy;
|
|
WebRtc_Word16 dec_target_reflCoefs[WEBRTC_CNG_MAX_LPC_ORDER+1];
|
|
WebRtc_Word16 dec_used_reflCoefs[WEBRTC_CNG_MAX_LPC_ORDER+1];
|
|
WebRtc_Word16 dec_filtstate[WEBRTC_CNG_MAX_LPC_ORDER+1];
|
|
WebRtc_Word16 dec_filtstateLow[WEBRTC_CNG_MAX_LPC_ORDER+1];
|
|
WebRtc_Word16 dec_Efiltstate[WEBRTC_CNG_MAX_LPC_ORDER+1];
|
|
WebRtc_Word16 dec_EfiltstateLow[WEBRTC_CNG_MAX_LPC_ORDER+1];
|
|
WebRtc_Word16 dec_order;
|
|
WebRtc_Word16 dec_target_scale_factor; /*Q29*/
|
|
WebRtc_Word16 dec_used_scale_factor; /*Q29*/
|
|
WebRtc_Word16 target_scale_factor; /* Q13 */
|
|
WebRtc_Word16 errorcode;
|
|
WebRtc_Word16 initflag;
|
|
|
|
} WebRtcCngDecInst_t;
|
|
|
|
|
|
typedef struct WebRtcCngEncInst_t_ {
|
|
|
|
WebRtc_Word16 enc_nrOfCoefs;
|
|
WebRtc_Word16 enc_sampfreq;
|
|
WebRtc_Word16 enc_interval;
|
|
WebRtc_Word16 enc_msSinceSID;
|
|
WebRtc_Word32 enc_Energy;
|
|
WebRtc_Word16 enc_reflCoefs[WEBRTC_CNG_MAX_LPC_ORDER+1];
|
|
WebRtc_Word32 enc_corrVector[WEBRTC_CNG_MAX_LPC_ORDER+1];
|
|
WebRtc_Word16 enc_filtstate[WEBRTC_CNG_MAX_LPC_ORDER+1];
|
|
WebRtc_Word16 enc_filtstateLow[WEBRTC_CNG_MAX_LPC_ORDER+1];
|
|
WebRtc_UWord32 enc_seed;
|
|
WebRtc_Word16 errorcode;
|
|
WebRtc_Word16 initflag;
|
|
|
|
} WebRtcCngEncInst_t;
|
|
|
|
const WebRtc_Word32 WebRtcCng_kDbov[94]={
|
|
1081109975, 858756178, 682134279, 541838517, 430397633, 341876992,
|
|
271562548, 215709799, 171344384, 136103682, 108110997, 85875618,
|
|
68213428, 54183852, 43039763, 34187699, 27156255, 21570980,
|
|
17134438, 13610368, 10811100, 8587562, 6821343, 5418385,
|
|
4303976, 3418770, 2715625, 2157098, 1713444, 1361037,
|
|
1081110, 858756, 682134, 541839, 430398, 341877,
|
|
271563, 215710, 171344, 136104, 108111, 85876,
|
|
68213, 54184, 43040, 34188, 27156, 21571,
|
|
17134, 13610, 10811, 8588, 6821, 5418,
|
|
4304, 3419, 2716, 2157, 1713, 1361,
|
|
1081, 859, 682, 542, 430, 342,
|
|
272, 216, 171, 136, 108, 86,
|
|
68, 54, 43, 34, 27, 22,
|
|
17, 14, 11, 9, 7, 5,
|
|
4, 3, 3, 2, 2, 1,
|
|
1, 1, 1, 1
|
|
};
|
|
const WebRtc_Word16 WebRtcCng_kCorrWindow[WEBRTC_CNG_MAX_LPC_ORDER] = {
|
|
32702, 32636, 32570, 32505, 32439, 32374,
|
|
32309, 32244, 32179, 32114, 32049, 31985
|
|
};
|
|
|
|
/****************************************************************************
|
|
* WebRtcCng_Version(...)
|
|
*
|
|
* These functions returns the version name (string must be at least
|
|
* 500 characters long)
|
|
*
|
|
* Output:
|
|
* - version : Pointer to character string
|
|
*
|
|
* Return value : 0 - Ok
|
|
* -1 - Error
|
|
*/
|
|
|
|
WebRtc_Word16 WebRtcCng_Version(WebRtc_Word8 *version)
|
|
{
|
|
strcpy((char*)version,(const char*)"1.2.0\n");
|
|
return(0);
|
|
}
|
|
|
|
|
|
/****************************************************************************
|
|
* WebRtcCng_AssignSizeEnc/Dec(...)
|
|
*
|
|
* These functions get the size needed for storing the instance for encoder
|
|
* and decoder, respectively
|
|
*
|
|
* Input/Output:
|
|
* - sizeinbytes : Pointer to integer where the size is returned
|
|
*
|
|
* Return value : 0
|
|
*/
|
|
|
|
WebRtc_Word16 WebRtcCng_AssignSizeEnc(int *sizeinbytes)
|
|
{
|
|
*sizeinbytes=sizeof(WebRtcCngEncInst_t)*2/sizeof(WebRtc_Word16);
|
|
return(0);
|
|
}
|
|
|
|
WebRtc_Word16 WebRtcCng_AssignSizeDec(int *sizeinbytes)
|
|
{
|
|
*sizeinbytes=sizeof(WebRtcCngDecInst_t)*2/sizeof(WebRtc_Word16);
|
|
return(0);
|
|
}
|
|
|
|
|
|
/****************************************************************************
|
|
* WebRtcCng_AssignEnc/Dec(...)
|
|
*
|
|
* These functions Assignes memory for the instances.
|
|
*
|
|
* Input:
|
|
* - CNG_inst_Addr : Adress to where to assign memory
|
|
* Output:
|
|
* - inst : Pointer to the instance that should be created
|
|
*
|
|
* Return value : 0 - Ok
|
|
* -1 - Error
|
|
*/
|
|
|
|
WebRtc_Word16 WebRtcCng_AssignEnc(CNG_enc_inst **inst, void *CNG_inst_Addr)
|
|
{
|
|
if (CNG_inst_Addr!=NULL) {
|
|
*inst = (CNG_enc_inst*)CNG_inst_Addr;
|
|
(*(WebRtcCngEncInst_t**) inst)->errorcode = 0;
|
|
(*(WebRtcCngEncInst_t**) inst)->initflag = 0;
|
|
return(0);
|
|
} else {
|
|
/* The memory could not be allocated */
|
|
return(-1);
|
|
}
|
|
}
|
|
|
|
WebRtc_Word16 WebRtcCng_AssignDec(CNG_dec_inst **inst, void *CNG_inst_Addr)
|
|
{
|
|
if (CNG_inst_Addr!=NULL) {
|
|
*inst = (CNG_dec_inst*)CNG_inst_Addr;
|
|
(*(WebRtcCngDecInst_t**) inst)->errorcode = 0;
|
|
(*(WebRtcCngDecInst_t**) inst)->initflag = 0;
|
|
return(0);
|
|
} else {
|
|
/* The memory could not be allocated */
|
|
return(-1);
|
|
}
|
|
}
|
|
|
|
|
|
/****************************************************************************
|
|
* WebRtcCng_CreateEnc/Dec(...)
|
|
*
|
|
* These functions create an instance to the specified structure
|
|
*
|
|
* Input:
|
|
* - XXX_inst : Pointer to created instance that should be created
|
|
*
|
|
* Return value : 0 - Ok
|
|
* -1 - Error
|
|
*/
|
|
|
|
WebRtc_Word16 WebRtcCng_CreateEnc(CNG_enc_inst **cng_inst)
|
|
{
|
|
*cng_inst=(CNG_enc_inst*)malloc(sizeof(WebRtcCngEncInst_t));
|
|
if(cng_inst!=NULL) {
|
|
(*(WebRtcCngEncInst_t**) cng_inst)->errorcode = 0;
|
|
(*(WebRtcCngEncInst_t**) cng_inst)->initflag = 0;
|
|
return(0);
|
|
}
|
|
else {
|
|
/* The memory could not be allocated */
|
|
return(-1);
|
|
}
|
|
}
|
|
|
|
WebRtc_Word16 WebRtcCng_CreateDec(CNG_dec_inst **cng_inst)
|
|
{
|
|
*cng_inst=(CNG_dec_inst*)malloc(sizeof(WebRtcCngDecInst_t));
|
|
if(cng_inst!=NULL) {
|
|
(*(WebRtcCngDecInst_t**) cng_inst)->errorcode = 0;
|
|
(*(WebRtcCngDecInst_t**) cng_inst)->initflag = 0;
|
|
return(0);
|
|
}
|
|
else {
|
|
/* The memory could not be allocated */
|
|
return(-1);
|
|
}
|
|
}
|
|
|
|
|
|
/****************************************************************************
|
|
* WebRtcCng_InitEnc/Dec(...)
|
|
*
|
|
* This function initializes a instance
|
|
*
|
|
* Input:
|
|
* - cng_inst : Instance that should be initialized
|
|
*
|
|
* - fs : 8000 for narrowband and 16000 for wideband
|
|
* - interval : generate SID data every interval ms
|
|
* - quality : TBD
|
|
*
|
|
* Output:
|
|
* - cng_inst : Initialized instance
|
|
*
|
|
* Return value : 0 - Ok
|
|
* -1 - Error
|
|
*/
|
|
|
|
|
|
WebRtc_Word16 WebRtcCng_InitEnc(CNG_enc_inst *cng_inst,
|
|
WebRtc_Word16 fs,
|
|
WebRtc_Word16 interval,
|
|
WebRtc_Word16 quality)
|
|
{
|
|
int i;
|
|
|
|
WebRtcCngEncInst_t* inst=(WebRtcCngEncInst_t*)cng_inst;
|
|
|
|
memset(inst, 0, sizeof(WebRtcCngEncInst_t));
|
|
|
|
/* Check LPC order */
|
|
|
|
if (quality>WEBRTC_CNG_MAX_LPC_ORDER) {
|
|
inst->errorcode = CNG_DISALLOWED_LPC_ORDER;
|
|
return (-1);
|
|
}
|
|
|
|
if (fs<=0) {
|
|
inst->errorcode = CNG_DISALLOWED_SAMPLING_FREQUENCY;
|
|
return (-1);
|
|
}
|
|
|
|
inst->enc_sampfreq=fs;
|
|
inst->enc_interval=interval;
|
|
inst->enc_nrOfCoefs=quality;
|
|
inst->enc_msSinceSID=0;
|
|
inst->enc_seed=7777; /*For debugging only*/
|
|
inst->enc_Energy=0;
|
|
for(i=0;i<(WEBRTC_CNG_MAX_LPC_ORDER+1);i++){
|
|
inst->enc_reflCoefs[i]=0;
|
|
inst->enc_corrVector[i]=0;
|
|
}
|
|
inst->initflag=1;
|
|
|
|
return(0);
|
|
}
|
|
|
|
WebRtc_Word16 WebRtcCng_InitDec(CNG_dec_inst *cng_inst)
|
|
{
|
|
int i;
|
|
|
|
WebRtcCngDecInst_t* inst=(WebRtcCngDecInst_t*)cng_inst;
|
|
|
|
memset(inst, 0, sizeof(WebRtcCngDecInst_t));
|
|
inst->dec_seed=7777; /*For debugging only*/
|
|
inst->dec_order=5;
|
|
inst->dec_target_scale_factor=0;
|
|
inst->dec_used_scale_factor=0;
|
|
for(i=0;i<(WEBRTC_CNG_MAX_LPC_ORDER+1);i++){
|
|
inst->dec_filtstate[i]=0;
|
|
inst->dec_target_reflCoefs[i]=0;
|
|
inst->dec_used_reflCoefs[i]=0;
|
|
}
|
|
inst->dec_target_reflCoefs[0]=0;
|
|
inst->dec_used_reflCoefs[0]=0;
|
|
inst ->dec_used_energy=0;
|
|
inst->initflag=1;
|
|
|
|
return(0);
|
|
}
|
|
|
|
/****************************************************************************
|
|
* WebRtcCng_FreeEnc/Dec(...)
|
|
*
|
|
* These functions frees the dynamic memory of a specified instance
|
|
*
|
|
* Input:
|
|
* - cng_inst : Pointer to created instance that should be freed
|
|
*
|
|
* Return value : 0 - Ok
|
|
* -1 - Error
|
|
*/
|
|
|
|
|
|
WebRtc_Word16 WebRtcCng_FreeEnc(CNG_enc_inst *cng_inst)
|
|
{
|
|
free(cng_inst);
|
|
return(0);
|
|
}
|
|
|
|
WebRtc_Word16 WebRtcCng_FreeDec(CNG_dec_inst *cng_inst)
|
|
{
|
|
free(cng_inst);
|
|
return(0);
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
* WebRtcCng_Encode(...)
|
|
*
|
|
* These functions analyzes background noise
|
|
*
|
|
* Input:
|
|
* - cng_inst : Pointer to created instance
|
|
* - speech : Signal (noise) to be analyzed
|
|
* - nrOfSamples : Size of speech vector
|
|
* - bytesOut : Nr of bytes to transmit, might be 0
|
|
*
|
|
* Return value : 0 - Ok
|
|
* -1 - Error
|
|
*/
|
|
WebRtc_Word16 WebRtcCng_Encode(CNG_enc_inst *cng_inst,
|
|
WebRtc_Word16 *speech,
|
|
WebRtc_Word16 nrOfSamples,
|
|
WebRtc_UWord8* SIDdata,
|
|
WebRtc_Word16* bytesOut,
|
|
WebRtc_Word16 forceSID)
|
|
{
|
|
WebRtcCngEncInst_t* inst=(WebRtcCngEncInst_t*)cng_inst;
|
|
|
|
WebRtc_Word16 arCoefs[WEBRTC_CNG_MAX_LPC_ORDER+1];
|
|
WebRtc_Word32 corrVector[WEBRTC_CNG_MAX_LPC_ORDER+1];
|
|
WebRtc_Word16 refCs[WEBRTC_CNG_MAX_LPC_ORDER+1];
|
|
WebRtc_Word16 hanningW[WEBRTC_CNG_MAX_OUTSIZE_ORDER];
|
|
WebRtc_Word16 ReflBeta=19661; /*0.6 in q15*/
|
|
WebRtc_Word16 ReflBetaComp=13107; /*0.4 in q15*/
|
|
WebRtc_Word32 outEnergy;
|
|
int outShifts;
|
|
int i, stab;
|
|
int acorrScale;
|
|
int index;
|
|
WebRtc_Word32 diff;
|
|
WebRtc_Word16 ind,factor;
|
|
WebRtc_Word32 *bptr, blo, bhi;
|
|
WebRtc_Word16 negate;
|
|
const WebRtc_Word16 *aptr;
|
|
|
|
WebRtc_Word16 speechBuf[WEBRTC_CNG_MAX_OUTSIZE_ORDER];
|
|
|
|
|
|
/* check if encoder initiated */
|
|
if (inst->initflag != 1) {
|
|
inst->errorcode = CNG_ENCODER_NOT_INITIATED;
|
|
return (-1);
|
|
}
|
|
|
|
|
|
/* check framesize */
|
|
if (nrOfSamples>WEBRTC_CNG_MAX_OUTSIZE_ORDER) {
|
|
inst->errorcode = CNG_DISALLOWED_FRAME_SIZE;
|
|
return (-1);
|
|
}
|
|
|
|
|
|
for(i=0;i<nrOfSamples;i++){
|
|
speechBuf[i]=speech[i];
|
|
}
|
|
|
|
factor=nrOfSamples;
|
|
|
|
/* Calculate energy and a coefficients */
|
|
outEnergy =WebRtcSpl_Energy(speechBuf, nrOfSamples, &outShifts);
|
|
while(outShifts>0){
|
|
if(outShifts>5){ /*We can only do 5 shifts without destroying accuracy in division factor*/
|
|
outEnergy<<=(outShifts-5);
|
|
outShifts=5;
|
|
}
|
|
else{
|
|
factor/=2;
|
|
outShifts--;
|
|
}
|
|
}
|
|
outEnergy=WebRtcSpl_DivW32W16(outEnergy,factor);
|
|
|
|
if (outEnergy > 1){
|
|
/* Create Hanning Window */
|
|
WebRtcSpl_GetHanningWindow(hanningW, nrOfSamples/2);
|
|
for( i=0;i<(nrOfSamples/2);i++ )
|
|
hanningW[nrOfSamples-i-1]=hanningW[i];
|
|
|
|
WebRtcSpl_ElementwiseVectorMult(speechBuf, hanningW, speechBuf, nrOfSamples, 14);
|
|
|
|
WebRtcSpl_AutoCorrelation( speechBuf, nrOfSamples, inst->enc_nrOfCoefs, corrVector, &acorrScale );
|
|
|
|
if( *corrVector==0 )
|
|
*corrVector = WEBRTC_SPL_WORD16_MAX;
|
|
|
|
/* Adds the bandwidth expansion */
|
|
aptr = WebRtcCng_kCorrWindow;
|
|
bptr = corrVector;
|
|
|
|
// (zzz) lpc16_1 = 17+1+820+2+2 = 842 (ordo2=700)
|
|
for( ind=0; ind<inst->enc_nrOfCoefs; ind++ )
|
|
{
|
|
// The below code multiplies the 16 b corrWindow values (Q15) with
|
|
// the 32 b corrvector (Q0) and shifts the result down 15 steps.
|
|
|
|
negate = *bptr<0;
|
|
if( negate )
|
|
*bptr = -*bptr;
|
|
|
|
blo = (WebRtc_Word32)*aptr * (*bptr & 0xffff);
|
|
bhi = ((blo >> 16) & 0xffff) + ((WebRtc_Word32)(*aptr++) * ((*bptr >> 16) & 0xffff));
|
|
blo = (blo & 0xffff) | ((bhi & 0xffff) << 16);
|
|
|
|
*bptr = (( (bhi>>16) & 0x7fff) << 17) | ((WebRtc_UWord32)blo >> 15);
|
|
if( negate )
|
|
*bptr = -*bptr;
|
|
bptr++;
|
|
}
|
|
|
|
// end of bandwidth expansion
|
|
|
|
stab=WebRtcSpl_LevinsonDurbin(corrVector, arCoefs, refCs, inst->enc_nrOfCoefs);
|
|
|
|
if(!stab){
|
|
// disregard from this frame
|
|
*bytesOut=0;
|
|
return(0);
|
|
}
|
|
|
|
}
|
|
else {
|
|
for(i=0;i<inst->enc_nrOfCoefs; i++)
|
|
refCs[i]=0;
|
|
}
|
|
|
|
if(forceSID){
|
|
/*Read instantaneous values instead of averaged*/
|
|
for(i=0;i<inst->enc_nrOfCoefs;i++)
|
|
inst->enc_reflCoefs[i]=refCs[i];
|
|
inst->enc_Energy=outEnergy;
|
|
}
|
|
else{
|
|
/*Average history with new values*/
|
|
for(i=0;i<(inst->enc_nrOfCoefs);i++){
|
|
inst->enc_reflCoefs[i]=(WebRtc_Word16)WEBRTC_SPL_MUL_16_16_RSFT(inst->enc_reflCoefs[i],ReflBeta,15);
|
|
inst->enc_reflCoefs[i]+=(WebRtc_Word16)WEBRTC_SPL_MUL_16_16_RSFT(refCs[i],ReflBetaComp,15);
|
|
}
|
|
inst->enc_Energy=(outEnergy>>2)+(inst->enc_Energy>>1)+(inst->enc_Energy>>2);
|
|
}
|
|
|
|
|
|
if(inst->enc_Energy<1){
|
|
inst->enc_Energy=1;
|
|
}
|
|
|
|
if((inst->enc_msSinceSID>(inst->enc_interval-1))||forceSID){
|
|
|
|
/* Search for best dbov value */
|
|
/* Clumsy linear search that can be optimized since database is sorted */
|
|
index=0;
|
|
diff=WEBRTC_SPL_ABS_W32(inst->enc_Energy-WebRtcCng_kDbov[index]);
|
|
for(i=1;i<93;i++){
|
|
/* Always round downwards */
|
|
if((inst->enc_Energy-WebRtcCng_kDbov[i])>0){
|
|
index=i;
|
|
break;
|
|
}
|
|
}
|
|
if((i==93)&&(index==0))
|
|
index=94;
|
|
SIDdata[0]=index;
|
|
|
|
|
|
/* Quantize coefs with tweak for WebRtc implementation of RFC3389 */
|
|
if(inst->enc_nrOfCoefs==WEBRTC_CNG_MAX_LPC_ORDER){
|
|
for(i=0;i<inst->enc_nrOfCoefs;i++){
|
|
SIDdata[i+1]=((inst->enc_reflCoefs[i]+128)>>8); /* Q15 to Q7*/ /* +127 */
|
|
}
|
|
}else{
|
|
for(i=0;i<inst->enc_nrOfCoefs;i++){
|
|
SIDdata[i+1]=(127+((inst->enc_reflCoefs[i]+128)>>8)); /* Q15 to Q7*/ /* +127 */
|
|
}
|
|
}
|
|
|
|
inst->enc_msSinceSID=0;
|
|
*bytesOut=inst->enc_nrOfCoefs+1;
|
|
|
|
inst->enc_msSinceSID+=(1000*nrOfSamples)/inst->enc_sampfreq;
|
|
return(inst->enc_nrOfCoefs+1);
|
|
}else{
|
|
inst->enc_msSinceSID+=(1000*nrOfSamples)/inst->enc_sampfreq;
|
|
*bytesOut=0;
|
|
return(0);
|
|
}
|
|
}
|
|
|
|
|
|
/****************************************************************************
|
|
* WebRtcCng_UpdateSid(...)
|
|
*
|
|
* These functions updates the CN state, when a new SID packet arrives
|
|
*
|
|
* Input:
|
|
* - cng_inst : Pointer to created instance that should be freed
|
|
* - SID : SID packet, all headers removed
|
|
* - length : Length in bytes of SID packet
|
|
*
|
|
* Return value : 0 - Ok
|
|
* -1 - Error
|
|
*/
|
|
|
|
WebRtc_Word16 WebRtcCng_UpdateSid(CNG_dec_inst *cng_inst,
|
|
WebRtc_UWord8 *SID,
|
|
WebRtc_Word16 length)
|
|
{
|
|
|
|
WebRtcCngDecInst_t* inst=(WebRtcCngDecInst_t*)cng_inst;
|
|
WebRtc_Word16 refCs[WEBRTC_CNG_MAX_LPC_ORDER];
|
|
WebRtc_Word32 targetEnergy;
|
|
int i;
|
|
|
|
if (inst->initflag != 1) {
|
|
inst->errorcode = CNG_DECODER_NOT_INITIATED;
|
|
return (-1);
|
|
}
|
|
|
|
/*Throw away reflection coefficients of higher order than we can handle*/
|
|
if(length> (WEBRTC_CNG_MAX_LPC_ORDER+1))
|
|
length=WEBRTC_CNG_MAX_LPC_ORDER+1;
|
|
|
|
inst->dec_order=length-1;
|
|
|
|
if(SID[0]>93)
|
|
SID[0]=93;
|
|
targetEnergy=WebRtcCng_kDbov[SID[0]];
|
|
/* Take down target energy to 75% */
|
|
targetEnergy=targetEnergy>>1;
|
|
targetEnergy+=targetEnergy>>2;
|
|
|
|
inst->dec_target_energy=targetEnergy;
|
|
|
|
/* Reconstruct coeffs with tweak for WebRtc implementation of RFC3389 */
|
|
if(inst->dec_order==WEBRTC_CNG_MAX_LPC_ORDER){
|
|
for(i=0;i<(inst->dec_order);i++){
|
|
refCs[i]=SID[i+1]<<8; /* Q7 to Q15*/
|
|
inst->dec_target_reflCoefs[i]=refCs[i];
|
|
}
|
|
}else{
|
|
for(i=0;i<(inst->dec_order);i++){
|
|
refCs[i]=(SID[i+1]-127)<<8; /* Q7 to Q15*/
|
|
inst->dec_target_reflCoefs[i]=refCs[i];
|
|
}
|
|
}
|
|
|
|
for(i=(inst->dec_order);i<WEBRTC_CNG_MAX_LPC_ORDER;i++){
|
|
refCs[i]=0;
|
|
inst->dec_target_reflCoefs[i]=refCs[i];
|
|
}
|
|
|
|
return(0);
|
|
}
|
|
|
|
|
|
/****************************************************************************
|
|
* WebRtcCng_Generate(...)
|
|
*
|
|
* These functions generates CN data when needed
|
|
*
|
|
* Input:
|
|
* - cng_inst : Pointer to created instance that should be freed
|
|
* - outData : pointer to area to write CN data
|
|
* - nrOfSamples : How much data to generate
|
|
*
|
|
* Return value : 0 - Ok
|
|
* -1 - Error
|
|
*/
|
|
WebRtc_Word16 WebRtcCng_Generate(CNG_dec_inst *cng_inst,
|
|
WebRtc_Word16 *outData,
|
|
WebRtc_Word16 nrOfSamples,
|
|
WebRtc_Word16 new_period)
|
|
{
|
|
WebRtcCngDecInst_t* inst=(WebRtcCngDecInst_t*)cng_inst;
|
|
|
|
int i;
|
|
WebRtc_Word16 excitation[WEBRTC_CNG_MAX_OUTSIZE_ORDER];
|
|
WebRtc_Word16 low[WEBRTC_CNG_MAX_OUTSIZE_ORDER];
|
|
WebRtc_Word16 lpPoly[WEBRTC_CNG_MAX_LPC_ORDER+1];
|
|
WebRtc_Word16 ReflBetaStd=26214; /*0.8 in q15*/
|
|
WebRtc_Word16 ReflBetaCompStd=6553; /*0.2in q15*/
|
|
WebRtc_Word16 ReflBetaNewP=19661; /*0.6 in q15*/
|
|
WebRtc_Word16 ReflBetaCompNewP=13107; /*0.4 in q15*/
|
|
WebRtc_Word16 Beta,BetaC, tmp1, tmp2, tmp3;
|
|
WebRtc_Word32 targetEnergy;
|
|
WebRtc_Word16 En;
|
|
WebRtc_Word16 temp16;
|
|
|
|
if (nrOfSamples>WEBRTC_CNG_MAX_OUTSIZE_ORDER) {
|
|
inst->errorcode = CNG_DISALLOWED_FRAME_SIZE;
|
|
return (-1);
|
|
}
|
|
|
|
|
|
if (new_period) {
|
|
inst->dec_used_scale_factor=inst->dec_target_scale_factor;
|
|
Beta=ReflBetaNewP;
|
|
BetaC=ReflBetaCompNewP;
|
|
} else {
|
|
Beta=ReflBetaStd;
|
|
BetaC=ReflBetaCompStd;
|
|
}
|
|
|
|
/*Here we use a 0.5 weighting, should possibly be modified to 0.6*/
|
|
tmp1=inst->dec_used_scale_factor<<2; /* Q13->Q15 */
|
|
tmp2=inst->dec_target_scale_factor<<2; /* Q13->Q15 */
|
|
tmp3=(WebRtc_Word16)WEBRTC_SPL_MUL_16_16_RSFT(tmp1,Beta,15);
|
|
tmp3+=(WebRtc_Word16)WEBRTC_SPL_MUL_16_16_RSFT(tmp2,BetaC,15);
|
|
inst->dec_used_scale_factor=tmp3>>2; /* Q15->Q13 */
|
|
|
|
inst->dec_used_energy=inst->dec_used_energy>>1;
|
|
inst->dec_used_energy+=inst->dec_target_energy>>1;
|
|
|
|
|
|
/* Do the same for the reflection coeffs */
|
|
for (i=0;i<WEBRTC_CNG_MAX_LPC_ORDER;i++) {
|
|
inst->dec_used_reflCoefs[i]=(WebRtc_Word16)WEBRTC_SPL_MUL_16_16_RSFT(inst->dec_used_reflCoefs[i],Beta,15);
|
|
inst->dec_used_reflCoefs[i]+=(WebRtc_Word16)WEBRTC_SPL_MUL_16_16_RSFT(inst->dec_target_reflCoefs[i],BetaC,15);
|
|
}
|
|
|
|
/* Compute the polynomial coefficients */
|
|
WebRtcCng_K2a16(inst->dec_used_reflCoefs, WEBRTC_CNG_MAX_LPC_ORDER, lpPoly);
|
|
|
|
/***/
|
|
|
|
targetEnergy=inst->dec_used_energy;
|
|
|
|
// Calculate scaling factor based on filter energy
|
|
En=8192; //1.0 in Q13
|
|
for (i=0; i<(WEBRTC_CNG_MAX_LPC_ORDER); i++) {
|
|
|
|
// Floating point value for reference
|
|
// E*=1.0-((float)inst->dec_used_reflCoefs[i]/32768.0)*((float)inst->dec_used_reflCoefs[i]/32768.0);
|
|
|
|
// Same in fixed point
|
|
temp16=(WebRtc_Word16)WEBRTC_SPL_MUL_16_16_RSFT(inst->dec_used_reflCoefs[i],inst->dec_used_reflCoefs[i],15); // K(i).^2 in Q15
|
|
temp16=0x7fff - temp16; // 1 - K(i).^2 in Q15
|
|
En=(WebRtc_Word16)WEBRTC_SPL_MUL_16_16_RSFT(En,temp16,15);
|
|
|
|
}
|
|
|
|
//float scaling= sqrt(E*inst->dec_target_energy/((1<<24)));
|
|
|
|
//Calculate sqrt(En*target_energy/exctiation energy)
|
|
|
|
targetEnergy=WebRtcSpl_Sqrt(inst->dec_used_energy);
|
|
|
|
En=(WebRtc_Word16)WebRtcSpl_Sqrt(En)<<6; //We are missing a factor sqrt(2) here
|
|
En=(En*3)>>1; //1.5 estimates sqrt(2)
|
|
|
|
inst->dec_used_scale_factor=(WebRtc_Word16)((En*targetEnergy)>>12);
|
|
|
|
|
|
/***/
|
|
|
|
/*Generate excitation*/
|
|
/*Excitation energy per sample is 2.^24 - Q13 N(0,1) */
|
|
for(i=0;i<nrOfSamples;i++){
|
|
excitation[i]=WebRtcSpl_RandN(&inst->dec_seed)>>1;
|
|
}
|
|
|
|
/*Scale to correct energy*/
|
|
WebRtcSpl_ScaleVector(excitation, excitation, inst->dec_used_scale_factor, nrOfSamples, 13);
|
|
|
|
WebRtcSpl_FilterAR(
|
|
lpPoly, /* Coefficients in Q12 */
|
|
WEBRTC_CNG_MAX_LPC_ORDER+1,
|
|
excitation, /* Speech samples */
|
|
nrOfSamples,
|
|
inst->dec_filtstate, /* State preservation */
|
|
WEBRTC_CNG_MAX_LPC_ORDER,
|
|
inst->dec_filtstateLow, /* State preservation */
|
|
WEBRTC_CNG_MAX_LPC_ORDER,
|
|
outData, /* Filtered speech samples */
|
|
low,
|
|
nrOfSamples
|
|
);
|
|
|
|
return(0);
|
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
* WebRtcCng_GetErrorCodeEnc/Dec(...)
|
|
*
|
|
* This functions can be used to check the error code of a CNG instance. When
|
|
* a function returns -1 a error code will be set for that instance. The
|
|
* function below extract the code of the last error that occured in the
|
|
* specified instance.
|
|
*
|
|
* Input:
|
|
* - CNG_inst : CNG enc/dec instance
|
|
*
|
|
* Return value : Error code
|
|
*/
|
|
|
|
WebRtc_Word16 WebRtcCng_GetErrorCodeEnc(CNG_enc_inst *cng_inst)
|
|
{
|
|
|
|
/* typecast pointer to real structure */
|
|
WebRtcCngEncInst_t* inst=(WebRtcCngEncInst_t*)cng_inst;
|
|
|
|
return inst->errorcode;
|
|
}
|
|
|
|
WebRtc_Word16 WebRtcCng_GetErrorCodeDec(CNG_dec_inst *cng_inst)
|
|
{
|
|
|
|
/* typecast pointer to real structure */
|
|
WebRtcCngDecInst_t* inst=(WebRtcCngDecInst_t*)cng_inst;
|
|
|
|
return inst->errorcode;
|
|
}
|