amf_delayntapnoutoffchip_s.c

ADI SHARC DSP 音频算法标准模块库

// Copyright(c) 2005 Analog Devices, Inc. All Rights Reserved. ADI Confidential.

#include "AMF_DelayNTapNOutOffChip_S.h"

void AMF_DelayNTapNOutOffChip_S_Render(AMF_DelayNTapNOutOffChip_S * restrict instance,float * restrict * buffers,int tickSize);

#if 1
#pragma optimize_for_speed
SEG_MOD_FAST_CODE  void AMF_DelayNTapNOutOffChip_S_Render(AMF_DelayNTapNOutOffChip_S * restrict instance,float * restrict * buffers,int tickSize) {
    int delaySize = instance->delaySize*2; 					// length in samples of delay buffer *2
    float *delayBuffer = &instance->delayBuffer[0];		 	// delay buffer
    int writeIndex = instance->delayWritePtr-delayBuffer;	// delay index
    int *delays = &instance->delays[0];
    int numTaps = instance->numTaps;
    int i, j;
    float * restrict in;
    float * restrict out;
	float pm *bufPtr;
	float pm *readBufPtr;
	
 	in = buffers[0];
		
	// write loop
/*   	// weird kludge to get the compiler to actually set the B0 register...
	bufPtr = (float pm *)((int)delayBuffer);
	bufPtr = (float pm *)__builtin_circptr(bufPtr, writeIndex, (float pm *)((int)delayBuffer), delaySize);		
#pragma loop_count(8,256,8)
#pragma no_alias
    for (i=0; i<2*tickSize; i++) {
		*bufPtr = in[i];
		bufPtr = (float pm *)__builtin_circptr(bufPtr, 1, (float pm *)((int)delayBuffer), delaySize);		
    } */
    
asm("	R0 = dm(I0,M6);\
	LCNTR=%4, do (pc,1) until lce;\
		R0 = dm(I0,M6), pm(I12,M14)=R0;"\
	:"+I12"(instance->delayWritePtr) \
	:"B12"(delayBuffer),"L12"(delaySize),"#I0"(in),"d"(2*tickSize) \
	:"R0","I0");
		
#pragma loop_count(1,256,1)
    for(j=0;j<numTaps;j++) {
		out = buffers[j+1];

/*		readBufPtr = (float pm *)((int)delayBuffer);
		readBufPtr = (float pm *)__builtin_circptr(readBufPtr, writeIndex-delays[j]*2, (float pm *)((int)delayBuffer), delaySize);
		// read loop
#pragma loop_count(8,256,8)
#pragma no_alias		
        for (i=0; i<2*tickSize; i++) {
			out[i] = *readBufPtr;
			readBufPtr = (float pm *)__builtin_circptr(readBufPtr, 1, (float pm *)((int)delayBuffer), delaySize);		
    	} */

asm("modify(i11,%5);\
		R0=pm(I11,M14);\
	LCNTR=%4, do (pc,1) until lce;\
		dm(I0,M6)=R0, R0=pm(I11,M14);"\
	: \
	:"#I11"(delayBuffer), "B11"(delayBuffer),"L11"(delaySize),"#I0"(out),"d"(2*tickSize),"z"(writeIndex-delays[j]*2) \
	:"R0","I0","I11");
          
    }
  	
//    instance->delayWritePtr = bufPtr;
}
#endif

SEG_MOD_SLOW_CONST const AMF_ModuleClass AMFClassDelayNTapNOutOffChip_S = {
    
    /* Flags */
    AMFModuleClassFlag_VARIABLE_PIN_COUNT,
     
    (AMF_RenderFunction)AMF_DelayNTapNOutOffChip_S_Render,  // render function 

    /* Default bypass */
	(void *)0,
};