trunk/src/modules/audio_coding/codecs/iSAC/fix/source/decode.c - vendor/opensource/webrtc - Git at Google

 /*
  *  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.
  */

 /*
  * decode.c
  *
  * This C file contains the internal decoding function.
  *
  */

 #include <string.h>

 #include "bandwidth_estimator.h"
 #include "codec.h"
 #include "entropy_coding.h"
 #include "pitch_estimator.h"
 #include "settings.h"
 #include "structs.h"


 WebRtc_Word16 WebRtcIsacfix_DecodeImpl(WebRtc_Word16       *signal_out16,
                                        ISACFIX_DecInst_t *ISACdec_obj,
                                        WebRtc_Word16       *current_framesamples)
 {
   int k;
   int err;
   WebRtc_Word16 BWno;
   WebRtc_Word16 len = 0;

   WebRtc_Word16 model;


   WebRtc_Word16 Vector_Word16_1[FRAMESAMPLES/2];
   WebRtc_Word16 Vector_Word16_2[FRAMESAMPLES/2];

   WebRtc_Word32 Vector_Word32_1[FRAMESAMPLES/2];
   WebRtc_Word32 Vector_Word32_2[FRAMESAMPLES/2];

   WebRtc_Word16 lofilt_coefQ15[ORDERLO*SUBFRAMES]; //refl. coeffs
   WebRtc_Word16 hifilt_coefQ15[ORDERHI*SUBFRAMES]; //refl. coeffs
   WebRtc_Word32 gain_lo_hiQ17[2*SUBFRAMES];

   WebRtc_Word16 PitchLags_Q7[PITCH_SUBFRAMES];
   WebRtc_Word16 PitchGains_Q12[PITCH_SUBFRAMES];
   WebRtc_Word16 AvgPitchGain_Q12;

   WebRtc_Word16 tmp_1, tmp_2;
   WebRtc_Word32 tmp32a, tmp32b;
   WebRtc_Word16 gainQ13;


   WebRtc_Word16 frame_nb; /* counter */
   WebRtc_Word16 frame_mode; /* 0 for 20ms and 30ms, 1 for 60ms */
   WebRtc_Word16 processed_samples;

   /* PLC */
   WebRtc_Word16 overlapWin[ 240 ];

   (ISACdec_obj->bitstr_obj).W_upper = 0xFFFFFFFF;
   (ISACdec_obj->bitstr_obj).streamval = 0;
   (ISACdec_obj->bitstr_obj).stream_index = 0;
   (ISACdec_obj->bitstr_obj).full = 1;


   /* decode framelength and BW estimation - not used, only for stream pointer*/
   err = WebRtcIsacfix_DecodeFrameLen(&ISACdec_obj->bitstr_obj, current_framesamples);
   if (err<0)  // error check
     return err;

   frame_mode = (WebRtc_Word16)WEBRTC_SPL_DIV(*current_framesamples, MAX_FRAMESAMPLES); /* 0, or 1 */
   processed_samples = (WebRtc_Word16)WEBRTC_SPL_DIV(*current_framesamples, frame_mode+1); /* either 320 (20ms) or 480 (30, 60 ms) */

   err = WebRtcIsacfix_DecodeSendBandwidth(&ISACdec_obj->bitstr_obj, &BWno);
   if (err<0)  // error check
     return err;

   /* one loop if it's one frame (20 or 30ms), 2 loops if 2 frames bundled together (60ms) */
   for (frame_nb = 0; frame_nb <= frame_mode; frame_nb++) {

     /* decode & dequantize pitch parameters */
     err = WebRtcIsacfix_DecodePitchGain(&(ISACdec_obj->bitstr_obj), PitchGains_Q12);
     if (err<0)  // error check
       return err;

     err = WebRtcIsacfix_DecodePitchLag(&ISACdec_obj->bitstr_obj, PitchGains_Q12, PitchLags_Q7);
     if (err<0)  // error check
       return err;

     AvgPitchGain_Q12 = (WebRtc_Word16)(((WebRtc_Word32)PitchGains_Q12[0] + PitchGains_Q12[1] + PitchGains_Q12[2] + PitchGains_Q12[3])>>2);

     /* decode & dequantize FiltCoef */
     err = WebRtcIsacfix_DecodeLpc(gain_lo_hiQ17, lofilt_coefQ15, hifilt_coefQ15,
                                   &ISACdec_obj->bitstr_obj, &model);

     if (err<0)  // error check
       return err;

     /* decode & dequantize spectrum */
     len = WebRtcIsacfix_DecodeSpec(&ISACdec_obj->bitstr_obj, Vector_Word16_1, Vector_Word16_2, AvgPitchGain_Q12);
     if (len < 0)  // error check
       return len;

     // Why does this need Q16 in and out? /JS
     WebRtcIsacfix_Spec2Time(Vector_Word16_1, Vector_Word16_2, Vector_Word32_1, Vector_Word32_2);

     for (k=0; k<FRAMESAMPLES/2; k++) {
       Vector_Word16_1[k] = (WebRtc_Word16)WEBRTC_SPL_RSHIFT_W32(Vector_Word32_1[k]+64, 7); //Q16 -> Q9
     }

     /* ----  If this is recovery frame ---- */
     if( (ISACdec_obj->plcstr_obj).used == PLC_WAS_USED )
     {
       (ISACdec_obj->plcstr_obj).used = PLC_NOT_USED;
       if( (ISACdec_obj->plcstr_obj).B < 1000 )
       {
         (ISACdec_obj->plcstr_obj).decayCoeffPriodic = 4000;
       }

       ISACdec_obj->plcstr_obj.decayCoeffPriodic = WEBRTC_SPL_WORD16_MAX;    /* DECAY_RATE is in Q15 */
       ISACdec_obj->plcstr_obj.decayCoeffNoise = WEBRTC_SPL_WORD16_MAX;    /* DECAY_RATE is in Q15 */
       ISACdec_obj->plcstr_obj.pitchCycles = 0;

       PitchGains_Q12[0] = (WebRtc_Word16)WEBRTC_SPL_MUL_16_16_RSFT(PitchGains_Q12[0], 700, 10 );

       /* ---- Add-overlap ---- */
       WebRtcSpl_GetHanningWindow( overlapWin, RECOVERY_OVERLAP );
       for( k = 0; k < RECOVERY_OVERLAP; k++ )
         Vector_Word16_1[k] = WEBRTC_SPL_ADD_SAT_W16(
             (WebRtc_Word16)WEBRTC_SPL_MUL_16_16_RSFT( (ISACdec_obj->plcstr_obj).overlapLP[k], overlapWin[RECOVERY_OVERLAP - k - 1], 14),
             (WebRtc_Word16)WEBRTC_SPL_MUL_16_16_RSFT( Vector_Word16_1[k], overlapWin[k], 14) );


     }

     /* --- Store side info --- */
     if( frame_nb == frame_mode )
     {
       /* --- LPC info */
       WEBRTC_SPL_MEMCPY_W16( (ISACdec_obj->plcstr_obj).lofilt_coefQ15, &lofilt_coefQ15[(SUBFRAMES-1)*ORDERLO], ORDERLO );
       WEBRTC_SPL_MEMCPY_W16( (ISACdec_obj->plcstr_obj).hifilt_coefQ15, &hifilt_coefQ15[(SUBFRAMES-1)*ORDERHI], ORDERHI );
       (ISACdec_obj->plcstr_obj).gain_lo_hiQ17[0] = gain_lo_hiQ17[(SUBFRAMES-1) * 2];
       (ISACdec_obj->plcstr_obj).gain_lo_hiQ17[1] = gain_lo_hiQ17[(SUBFRAMES-1) * 2 + 1];

       /* --- LTP info */
       (ISACdec_obj->plcstr_obj).AvgPitchGain_Q12 = PitchGains_Q12[3];
       (ISACdec_obj->plcstr_obj).lastPitchGain_Q12 = PitchGains_Q12[3];
       (ISACdec_obj->plcstr_obj).lastPitchLag_Q7 = PitchLags_Q7[3];

       if( PitchLags_Q7[3] < 3000 )
         (ISACdec_obj->plcstr_obj).lastPitchLag_Q7 += PitchLags_Q7[3];

       WEBRTC_SPL_MEMCPY_W16( (ISACdec_obj->plcstr_obj).prevPitchInvIn, Vector_Word16_1, FRAMESAMPLES/2 );

     }
     /* ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ */

     /* inverse pitch filter */
     WebRtcIsacfix_PitchFilter(Vector_Word16_1, Vector_Word16_2, &ISACdec_obj->pitchfiltstr_obj, PitchLags_Q7, PitchGains_Q12, 4);

     if( frame_nb == frame_mode )
     {
       WEBRTC_SPL_MEMCPY_W16( (ISACdec_obj->plcstr_obj).prevPitchInvOut, &(Vector_Word16_2[FRAMESAMPLES/2 - (PITCH_MAX_LAG + 10)]), PITCH_MAX_LAG );
     }


     /* reduce gain to compensate for pitch enhancer */
     /* gain = 1.0f - 0.45f * AvgPitchGain; */
     tmp32a = WEBRTC_SPL_MUL_16_16_RSFT(AvgPitchGain_Q12, 29, 0); // Q18
     tmp32b = 262144 - tmp32a;  // Q18
     gainQ13 = (WebRtc_Word16) WEBRTC_SPL_RSHIFT_W32(tmp32b, 5); // Q13

     for (k = 0; k < FRAMESAMPLES/2; k++)
     {
       Vector_Word32_1[k] = (WebRtc_Word32) WEBRTC_SPL_LSHIFT_W32(WEBRTC_SPL_MUL_16_16(Vector_Word16_2[k], gainQ13), 3); // Q25
     }


     /* perceptual post-filtering (using normalized lattice filter) */
     WebRtcIsacfix_NormLatticeFilterAr(ORDERLO, (ISACdec_obj->maskfiltstr_obj).PostStateLoGQ0,
                                       Vector_Word32_1, lofilt_coefQ15, gain_lo_hiQ17, 0, Vector_Word16_1);

     /* --- Store Highpass Residual --- */
     for (k = 0; k < FRAMESAMPLES/2; k++)
       Vector_Word32_1[k]    = WEBRTC_SPL_LSHIFT_W32(Vector_Word32_2[k], 9); // Q16 -> Q25

     for( k = 0; k < PITCH_MAX_LAG + 10; k++ )
       (ISACdec_obj->plcstr_obj).prevHP[k] = Vector_Word32_1[FRAMESAMPLES/2 - (PITCH_MAX_LAG + 10) + k];


     WebRtcIsacfix_NormLatticeFilterAr(ORDERHI, (ISACdec_obj->maskfiltstr_obj).PostStateHiGQ0,
                                       Vector_Word32_1, hifilt_coefQ15, gain_lo_hiQ17, 1, Vector_Word16_2);

     /* recombine the 2 bands */

     /* Form the polyphase signals, and compensate for DC offset */
     for (k=0;k<FRAMESAMPLES/2;k++) {
       tmp_1 = (WebRtc_Word16)WebRtcSpl_SatW32ToW16(((WebRtc_Word32)Vector_Word16_1[k]+Vector_Word16_2[k] + 1)); /* Construct a new upper channel signal*/
       tmp_2 = (WebRtc_Word16)WebRtcSpl_SatW32ToW16(((WebRtc_Word32)Vector_Word16_1[k]-Vector_Word16_2[k])); /* Construct a new lower channel signal*/
       Vector_Word16_1[k] = tmp_1;
       Vector_Word16_2[k] = tmp_2;
     }

     WebRtcIsacfix_FilterAndCombine1(Vector_Word16_1, Vector_Word16_2, signal_out16 + frame_nb * processed_samples, &ISACdec_obj->postfiltbankstr_obj);

   }
   return len;
 }
	/*
	* 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.
	*/

	/*
	* decode.c
	*
	* This C file contains the internal decoding function.
	*
	*/

	#include <string.h>

	#include "bandwidth_estimator.h"
	#include "codec.h"
	#include "entropy_coding.h"
	#include "pitch_estimator.h"
	#include "settings.h"
	#include "structs.h"




	WebRtc_Word16 WebRtcIsacfix_DecodeImpl(WebRtc_Word16 *signal_out16,
	ISACFIX_DecInst_t *ISACdec_obj,
	WebRtc_Word16 *current_framesamples)
	{
	int k;
	int err;
	WebRtc_Word16 BWno;
	WebRtc_Word16 len = 0;

	WebRtc_Word16 model;


	WebRtc_Word16 Vector_Word16_1[FRAMESAMPLES/2];
	WebRtc_Word16 Vector_Word16_2[FRAMESAMPLES/2];

	WebRtc_Word32 Vector_Word32_1[FRAMESAMPLES/2];
	WebRtc_Word32 Vector_Word32_2[FRAMESAMPLES/2];

	WebRtc_Word16 lofilt_coefQ15[ORDERLO*SUBFRAMES]; //refl. coeffs
	WebRtc_Word16 hifilt_coefQ15[ORDERHI*SUBFRAMES]; //refl. coeffs
	WebRtc_Word32 gain_lo_hiQ17[2*SUBFRAMES];

	WebRtc_Word16 PitchLags_Q7[PITCH_SUBFRAMES];
	WebRtc_Word16 PitchGains_Q12[PITCH_SUBFRAMES];
	WebRtc_Word16 AvgPitchGain_Q12;

	WebRtc_Word16 tmp_1, tmp_2;
	WebRtc_Word32 tmp32a, tmp32b;
	WebRtc_Word16 gainQ13;


	WebRtc_Word16 frame_nb; /* counter */
	WebRtc_Word16 frame_mode; /* 0 for 20ms and 30ms, 1 for 60ms */
	WebRtc_Word16 processed_samples;

	/* PLC */
	WebRtc_Word16 overlapWin[ 240 ];

	(ISACdec_obj->bitstr_obj).W_upper = 0xFFFFFFFF;
	(ISACdec_obj->bitstr_obj).streamval = 0;
	(ISACdec_obj->bitstr_obj).stream_index = 0;
	(ISACdec_obj->bitstr_obj).full = 1;


	/* decode framelength and BW estimation - not used, only for stream pointer*/
	err = WebRtcIsacfix_DecodeFrameLen(&ISACdec_obj->bitstr_obj, current_framesamples);
	if (err<0) // error check
	return err;

	frame_mode = (WebRtc_Word16)WEBRTC_SPL_DIV(current_framesamples, MAX_FRAMESAMPLES); / 0, or 1 */
	processed_samples = (WebRtc_Word16)WEBRTC_SPL_DIV(current_framesamples, frame_mode+1); / either 320 (20ms) or 480 (30, 60 ms) */

	err = WebRtcIsacfix_DecodeSendBandwidth(&ISACdec_obj->bitstr_obj, &BWno);
	if (err<0) // error check
	return err;

	/* one loop if it's one frame (20 or 30ms), 2 loops if 2 frames bundled together (60ms) */
	for (frame_nb = 0; frame_nb <= frame_mode; frame_nb++) {

	/* decode & dequantize pitch parameters */
	err = WebRtcIsacfix_DecodePitchGain(&(ISACdec_obj->bitstr_obj), PitchGains_Q12);
	if (err<0) // error check
	return err;

	err = WebRtcIsacfix_DecodePitchLag(&ISACdec_obj->bitstr_obj, PitchGains_Q12, PitchLags_Q7);
	if (err<0) // error check
	return err;

	AvgPitchGain_Q12 = (WebRtc_Word16)(((WebRtc_Word32)PitchGains_Q12[0] + PitchGains_Q12[1] + PitchGains_Q12[2] + PitchGains_Q12[3])>>2);

	/* decode & dequantize FiltCoef */
	err = WebRtcIsacfix_DecodeLpc(gain_lo_hiQ17, lofilt_coefQ15, hifilt_coefQ15,
	&ISACdec_obj->bitstr_obj, &model);

	if (err<0) // error check
	return err;

	/* decode & dequantize spectrum */
	len = WebRtcIsacfix_DecodeSpec(&ISACdec_obj->bitstr_obj, Vector_Word16_1, Vector_Word16_2, AvgPitchGain_Q12);
	if (len < 0) // error check
	return len;

	// Why does this need Q16 in and out? /JS
	WebRtcIsacfix_Spec2Time(Vector_Word16_1, Vector_Word16_2, Vector_Word32_1, Vector_Word32_2);

	for (k=0; k<FRAMESAMPLES/2; k++) {
	Vector_Word16_1[k] = (WebRtc_Word16)WEBRTC_SPL_RSHIFT_W32(Vector_Word32_1[k]+64, 7); //Q16 -> Q9
	}

	/* ---- If this is recovery frame ---- */
	if( (ISACdec_obj->plcstr_obj).used == PLC_WAS_USED )
	{
	(ISACdec_obj->plcstr_obj).used = PLC_NOT_USED;
	if( (ISACdec_obj->plcstr_obj).B < 1000 )
	{
	(ISACdec_obj->plcstr_obj).decayCoeffPriodic = 4000;
	}

	ISACdec_obj->plcstr_obj.decayCoeffPriodic = WEBRTC_SPL_WORD16_MAX; /* DECAY_RATE is in Q15 */
	ISACdec_obj->plcstr_obj.decayCoeffNoise = WEBRTC_SPL_WORD16_MAX; /* DECAY_RATE is in Q15 */
	ISACdec_obj->plcstr_obj.pitchCycles = 0;

	PitchGains_Q12[0] = (WebRtc_Word16)WEBRTC_SPL_MUL_16_16_RSFT(PitchGains_Q12[0], 700, 10 );

	/* ---- Add-overlap ---- */
	WebRtcSpl_GetHanningWindow( overlapWin, RECOVERY_OVERLAP );
	for( k = 0; k < RECOVERY_OVERLAP; k++ )
	Vector_Word16_1[k] = WEBRTC_SPL_ADD_SAT_W16(
	(WebRtc_Word16)WEBRTC_SPL_MUL_16_16_RSFT( (ISACdec_obj->plcstr_obj).overlapLP[k], overlapWin[RECOVERY_OVERLAP - k - 1], 14),
	(WebRtc_Word16)WEBRTC_SPL_MUL_16_16_RSFT( Vector_Word16_1[k], overlapWin[k], 14) );



	}

	/* --- Store side info --- */
	if( frame_nb == frame_mode )
	{
	/* --- LPC info */
	WEBRTC_SPL_MEMCPY_W16( (ISACdec_obj->plcstr_obj).lofilt_coefQ15, &lofilt_coefQ15[(SUBFRAMES-1)*ORDERLO], ORDERLO );
	WEBRTC_SPL_MEMCPY_W16( (ISACdec_obj->plcstr_obj).hifilt_coefQ15, &hifilt_coefQ15[(SUBFRAMES-1)*ORDERHI], ORDERHI );
	(ISACdec_obj->plcstr_obj).gain_lo_hiQ17[0] = gain_lo_hiQ17[(SUBFRAMES-1) * 2];
	(ISACdec_obj->plcstr_obj).gain_lo_hiQ17[1] = gain_lo_hiQ17[(SUBFRAMES-1) * 2 + 1];

	/* --- LTP info */
	(ISACdec_obj->plcstr_obj).AvgPitchGain_Q12 = PitchGains_Q12[3];
	(ISACdec_obj->plcstr_obj).lastPitchGain_Q12 = PitchGains_Q12[3];
	(ISACdec_obj->plcstr_obj).lastPitchLag_Q7 = PitchLags_Q7[3];

	if( PitchLags_Q7[3] < 3000 )
	(ISACdec_obj->plcstr_obj).lastPitchLag_Q7 += PitchLags_Q7[3];

	WEBRTC_SPL_MEMCPY_W16( (ISACdec_obj->plcstr_obj).prevPitchInvIn, Vector_Word16_1, FRAMESAMPLES/2 );

	}
	/* ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ */

	/* inverse pitch filter */
	WebRtcIsacfix_PitchFilter(Vector_Word16_1, Vector_Word16_2, &ISACdec_obj->pitchfiltstr_obj, PitchLags_Q7, PitchGains_Q12, 4);

	if( frame_nb == frame_mode )
	{
	WEBRTC_SPL_MEMCPY_W16( (ISACdec_obj->plcstr_obj).prevPitchInvOut, &(Vector_Word16_2[FRAMESAMPLES/2 - (PITCH_MAX_LAG + 10)]), PITCH_MAX_LAG );
	}


	/* reduce gain to compensate for pitch enhancer */
	/* gain = 1.0f - 0.45f * AvgPitchGain; */
	tmp32a = WEBRTC_SPL_MUL_16_16_RSFT(AvgPitchGain_Q12, 29, 0); // Q18
	tmp32b = 262144 - tmp32a; // Q18
	gainQ13 = (WebRtc_Word16) WEBRTC_SPL_RSHIFT_W32(tmp32b, 5); // Q13

	for (k = 0; k < FRAMESAMPLES/2; k++)
	{
	Vector_Word32_1[k] = (WebRtc_Word32) WEBRTC_SPL_LSHIFT_W32(WEBRTC_SPL_MUL_16_16(Vector_Word16_2[k], gainQ13), 3); // Q25
	}


	/* perceptual post-filtering (using normalized lattice filter) */
	WebRtcIsacfix_NormLatticeFilterAr(ORDERLO, (ISACdec_obj->maskfiltstr_obj).PostStateLoGQ0,
	Vector_Word32_1, lofilt_coefQ15, gain_lo_hiQ17, 0, Vector_Word16_1);

	/* --- Store Highpass Residual --- */
	for (k = 0; k < FRAMESAMPLES/2; k++)
	Vector_Word32_1[k] = WEBRTC_SPL_LSHIFT_W32(Vector_Word32_2[k], 9); // Q16 -> Q25

	for( k = 0; k < PITCH_MAX_LAG + 10; k++ )
	(ISACdec_obj->plcstr_obj).prevHP[k] = Vector_Word32_1[FRAMESAMPLES/2 - (PITCH_MAX_LAG + 10) + k];


	WebRtcIsacfix_NormLatticeFilterAr(ORDERHI, (ISACdec_obj->maskfiltstr_obj).PostStateHiGQ0,
	Vector_Word32_1, hifilt_coefQ15, gain_lo_hiQ17, 1, Vector_Word16_2);

	/* recombine the 2 bands */

	/* Form the polyphase signals, and compensate for DC offset */
	for (k=0;k<FRAMESAMPLES/2;k++) {
	tmp_1 = (WebRtc_Word16)WebRtcSpl_SatW32ToW16(((WebRtc_Word32)Vector_Word16_1[k]+Vector_Word16_2[k] + 1)); /* Construct a new upper channel signal*/
	tmp_2 = (WebRtc_Word16)WebRtcSpl_SatW32ToW16(((WebRtc_Word32)Vector_Word16_1[k]-Vector_Word16_2[k])); /* Construct a new lower channel signal*/
	Vector_Word16_1[k] = tmp_1;
	Vector_Word16_2[k] = tmp_2;
	}

	WebRtcIsacfix_FilterAndCombine1(Vector_Word16_1, Vector_Word16_2, signal_out16 + frame_nb * processed_samples, &ISACdec_obj->postfiltbankstr_obj);

	}
	return len;
	}