/*LINTLIBRARY*/          /*PROTOLIB1*/#include <math.h>/*#include "main.h"*/#include "celpfilt.h"#include "adapt.h"#include "submult.h"#include "del_tab.h"#include "acb_parm.h"#include "delay.h"#include "bwexp.h"#include "setarray.h"#include "acb_code.h"#include "movarray.h"#include "con_adap.h"

/* I can't figure out how to set this in the makefile using MS developer, so
I'm just going to set it here */
#define NEW_ACB 1#ifdef INTGint	fraction = FALSE;int	neigh = FALSE;#else /* INTG */#ifdef FULLint	fraction = TRUE;int	neigh = FALSE;#else /* FULL -- 	if no compile-time options are specified, the hierarchical 	search below is used (FS1016 method) */int	fraction = FALSE;int	neigh = TRUE;int	NeighborhoodRange = 3;#endif /* FULL */#endif /* INTG */#define START 		B_PTR - SF_LEN + 1/*  Length of truncated impulse response *//*	IR values past 30 are nearly zero */#define LEN_TRUNC_H	30static void CalcPointers(int 	even, int 	PrevDelayPtr, int 	*MinDelayPtr, int 	*MaxDelayPtr);static void TopMatch(float 	match[MAX_NUM_ADAPT], int 	MinDelayPtr, int 	MaxDelayPtr, int 	*BestDelayPtr);static void SelectDelay(int 	*BestDelayPtr, int 	SubMult[256][4], float 	match[MAX_NUM_ADAPT], int 	MinDelayPtr, int 	MaxDelayPtr);static void Neighborhood(float 	lp_imp[SF_LEN], float 	residual[RES_LEN], float 	match[MAX_NUM_ADAPT], int 	MinDelayPtr, int 	MaxDelayPtr, float	DelayTable[],float 	AdaptCB[MAX_ABUF_LEN], int 	*BestDelayPtr, float 	gain[MAX_NUM_ADAPT]);static void CalcIntAdaptParms(float	AdaptCB[MAX_ABUF_LEN],float	pc_imp[SF_LEN],int	MinDelayPtr,int	MaxDelayPtr,float	DelayTable[MAX_NUM_ADAPT],float	residual[RES_LEN],float	gain[MAX_NUM_ADAPT],float	match[MAX_NUM_ADAPT]);static void CalcFracAdaptParms(float	AdaptCB[MAX_ABUF_LEN],float	pc_imp[SF_LEN],int	MinDelayPtr,int	MaxDelayPtr,float	DelayTable[MAX_NUM_ADAPT],float	residual[RES_LEN],float	gain[MAX_NUM_ADAPT],float	match[MAX_NUM_ADAPT]);static void FindAdaptResidual(float	speech[SF_LEN],float	AdaptCB[MAX_ABUF_LEN],float	pc[ORDER+1],float	AdaptGain,float	AdaptDelay,float	residual[RES_LEN]);/*****************************************************************************                                                                         ** ROUTINE*		AdaptiveAnalysis** FUNCTION*		Subframe adaptive codebook search* SYNOPSIS*		AdaptiveAnalysis(speech_in, pc, h, AdaptCB, *			residual_in, AdaptDelay, AdaptGain, residual_out)**   formal**                       data    I/O*       name            type    type    function*       -------------------------------------------------------------------*	SpeechIn	float	 i	Subframe of speech*	pc		float	 i	Predictor Coefficients (PCs)*	pc_imp		float	 i	Impulse response of PCs*	AdaptCB		float	 i	Adaptive codebook vector*	residual_in	float	 i	Residual from LPC analysis*	AdaptDelay	float	 o	pitch delay parameter to TX*	AdaptGain	float	 o	pitch gain parameter to TX*	residual_out	float	 o	residual remaining after comparison***************************************************************************/void AdaptiveAnalysis(float 	SpeechIn[SF_LEN], float 	pc[ORDER], float 	pc_imp[SF_LEN], float 	AdaptCB[MAX_ABUF_LEN], float 	residual_in[RES_LEN], float 	*AdaptDelay, float 	*AdaptGain, float 	residual_out[RES_LEN]){	float	match[MAX_NUM_ADAPT], gain[MAX_NUM_ADAPT];	int	MaxDelayPtr, MinDelayPtr, BestDelayPtr;static 	int	even=FALSE, PrevDelayPtr=1, first=TRUE;	int	index;	float	TempAdaptCB[B_PTR];#ifdef NEW_ACB	int	i, Delay;	float	pcexp[ORDER];#endif/*  Update temporary adaptive codebook */	SetArray(B_PTR, 0.0, TempAdaptCB);	MoveArray(ACB_SIZE, AdaptCB, &TempAdaptCB[B_PTR-(ACB_SIZE)-SF_LEN]);/*  Set up initial conditions on first subframe */	if (first)	{	  first = FALSE;	  *AdaptGain = 0.0;	  *AdaptDelay = MIN_DELAY;	}/*  Calculate adaptive gain and delay for subsequent subframes */	else	{  /*  Determine allowable pointer range for full/delta searches on *//*	even/odd subframes */	  CalcPointers(even, PrevDelayPtr, &MinDelayPtr, &MaxDelayPtr);/*  Initialize arrays */	  SetArray(MAX_NUM_ADAPT, 0.0, match);	  SetArray(MAX_NUM_ADAPT, 0.0, gain);/*  Calculate gain and match scores for integer adaptive delays */	  CalcIntAdaptParms(TempAdaptCB, pc_imp, MinDelayPtr, MaxDelayPtr, 		DelayTable, residual_in, gain, match);	  if (fraction)/*  Calculate gain and match scores for fractional delays */	    CalcFracAdaptParms(TempAdaptCB, pc_imp, MinDelayPtr, MaxDelayPtr, 		DelayTable, residual_in, gain, match);/*  Determine top match score from those computed */	  TopMatch(match, MinDelayPtr, MaxDelayPtr, &BestDelayPtr);/*  Select shortest delay */	  if(!even)	    SelectDelay(&BestDelayPtr, submult, match, MinDelayPtr, 		MaxDelayPtr);	  if(neigh)	{/*  Find best neighborhood match */	    Neighborhood(pc_imp, residual_in, match, MinDelayPtr, MaxDelayPtr, 		DelayTable, TempAdaptCB, &BestDelayPtr, gain);	  }/*  Assign pitch (adaptive codebook) parameters */	  *AdaptGain = gain[BestDelayPtr];	  *AdaptDelay = DelayTable[BestDelayPtr];/*  Save pointer to detrmine delta delay */	  PrevDelayPtr = BestDelayPtr;/*  Encode adaptive gain (quantize) */	  *AdaptGain = ACBGainEncode(*AdaptGain, &index);#ifdef NEW_ACB/*  ACB contribution to LP Impulse Response */	  if(*AdaptDelay < SF_LEN)	{/*  Lay out pulses at multiples of the pitch period	*/	    Delay = (int)(*AdaptDelay);	    SetArray(SF_LEN, 0.0, pc_imp);	    pc_imp[0] = 1.0;	    for(i=Delay;i<SF_LEN;i+=Delay)	      pc_imp[i] = *AdaptGain;/*  Filter the new signal with expanded PCs (no history on filter)	*/	    BWExpand(GAMMA, pc, pcexp);	    FilterImpulseResponse(pc_imp, pcexp);	  }#endif	}/*  Calculate residual after pitch analysis */	SetArray(B_PTR, 0.0, TempAdaptCB);	MoveArray(ACB_SIZE, AdaptCB, TempAdaptCB);	FindAdaptResidual(SpeechIn, TempAdaptCB, pc, *AdaptGain, *AdaptDelay, 		residual_out);/*  Update values for next subframe */	even = (even) ? FALSE : TRUE;}/***************************************************************************                                                                         ** ROUTINE*		CalcPointers** FUNCTION*		Calculate allowable pointer range* SYNOPSIS*		CalcPointers(even, oldptr, minptr, maxptr)**   formal**                       data    I/O*       name            type    type    function*       -------------------------------------------------------------------*	even		int	 i	Even/Odd subframe marker*	PrevDelayPtr	int	 i	Previous delay pointer*	MinDelayPtr	int	 o	Pointer to minimum delay*	MaxDelayPtr	int	 o	Pointer to maximum delay***************************************************************************/void CalcPointers(int 	even, int 	PrevDelayPtr, int 	*MinDelayPtr, int 	*MaxDelayPtr){/*  Delta delay coding on even subframes */	if(even)	{	  *MinDelayPtr = PrevDelayPtr - (NUM_DELTA_ADELAYS / 2 - 1);	  *MaxDelayPtr = PrevDelayPtr + (NUM_DELTA_ADELAYS / 2);	  if (*MinDelayPtr < 0)	{	    *MinDelayPtr = 0;	    *MaxDelayPtr = NUM_DELTA_ADELAYS - 1;	  }	  if (*MaxDelayPtr > NUM_FULL_ADELAYS-1)	{	    *MaxDelayPtr = NUM_FULL_ADELAYS - 1;	    *MinDelayPtr = NUM_FULL_ADELAYS - NUM_DELTA_ADELAYS;	  }	}/*  Full range coding on odd subframes */	else	{	  *MinDelayPtr = 0;	  *MaxDelayPtr = NUM_FULL_ADELAYS - 1;	}}/***************************************************************************                                                                         ** ROUTINE*		TopMatch** FUNCTION*		Find pointer to top (MSPE) match score (BestDelayPtr)*		search for best match score (max -error term)* SYNOPSIS*		TopMatch(match, MinDelayPtr, MaxDelayPtr, BestDelayPtr)**   formal**                       data    I/O*       name            type    type    function*       -------------------------------------------------------------------*	match		float	 i	Match score array*	MinDelayPtr	int	 i	Pointer to minimum delay to search*	MaxDelayPtr	int	 i	Pointer to maximum delay to search*	BestDelayPtr	int	 o	Pointer to best delay***************************************************************************/void TopMatch(float 	match[MAX_NUM_ADAPT], int 	MinDelayPtr, int 	MaxDelayPtr, int 	*BestDelayPtr){int	i;float	emax;	*BestDelayPtr = MinDelayPtr;	emax = match[*BestDelayPtr];	for(i=MinDelayPtr; i<=MaxDelayPtr; i++)	{	  if (match[i] > emax)	{