void InitPeriph(void)
{
CRC_Configure();
TIM_Configure();
GPIO_Configure();
USART_Configure();
ADC_Configure();
RTC_Configure();
RTC_Time_Configure(0, 0, 0);
RTC_Alarm_Configure(0xFF, 20, 0); //Alarm each 20 min (Check humidity)
dxdev_out(USART_SendChar);
SPI_Configure();
}
int main(void){
float Es,E;
unsigned int i, j;
unsigned int doa_aux[3];
int diff[3];
#ifdef _FLASH
memcpy(&RamfuncsRunStart, &RamfuncsLoadStart, (size_t)&RamfuncsLoadSize);
#endif
/*------------------------------------------------------*/
/* Inicialización */
/*------------------------------------------------------*/
InitSysCtrl();
InitSysPll(XTAL_OSC,IMULT_20,FMULT_0,PLLCLK_BY_2);
EDIS;
InitGpio();
InitPieCtrl();
IER = 0x0000;
IFR = 0x0000;
InitPieVectTable();
//Configura operación del ADC-A
ADC_Configure(ADCA,16000);
//Configura los canales 2,3,4 y 5 del ADC-A
ADC_Init(ADCA, 2);
ADC_Init(ADCA, 3);
ADC_Init(ADCA, 4);
//La interrupción del ADC-A se da cuando termine el canal 4
ADC_Int(ADCA, 4);
hnd_cfft->OutPtr = CFFToutBuff; // Apuntador al Buffer de salida
hnd_cfft->Stages = STAGE; // Número de etapas de la FFT
hnd_cfft->FFTSize = N; // Tamaño de la FFT
hnd_cfft->CoefPtr = CFFTF32Coef; // Auntador a los coeficientes de Fourier
CFFT_f32_sincostable(hnd_cfft); // Calcula los factores de Fourier
//Configura el puerto serial
Serial_Init();
Serial_Configure(BR9600);
Serial_Start();
ADC_Start(ADCA); //Inicia la conversión del ADC-A
cont = 0;
//calculo de la energía del silencio (que filosófico suena esto)
EINT;
Es = 0;
while(cont<(N<<1));
ServiceDog();
cont = 0;
Es = energy(x);
while(cont<(N<<1));
ServiceDog();
cont = 0;
Es += energy(x);
Es = Es/2;
doaG = 0;
while(1){
#ifndef DEBUG
init = false;
while(!init);
#endif
E = Es;
for(j=0;j<3;j++){
//recibe datos y verifica si es ruido o no
do{
ADC_Start(ADCA);
while(cont<(N<<1));
cont = 0; //Una vez llenos los buffers de datos procedemos a realizar el algoritmo
ADC_Stop(ADCA); //detiene la adquisición para obtener las FFT
ServiceDog();
}while(!vad(x,E));
//FFT mic 1
hnd_cfft->InPtr = x1;
CFFT_f32u(hnd_cfft);
for(i=0;i<(N<<1);i++){
xw1[i] = hnd_cfft->CurrentInPtr[i];
}
//FFT mic 2
hnd_cfft->InPtr = x2;
CFFT_f32u(hnd_cfft);
for(i=0;i<(N<<1);i++){
xw2[i] = hnd_cfft->CurrentInPtr[i];
}
//FFT mic 3
hnd_cfft->InPtr = x3;
CFFT_f32u(hnd_cfft);
for(i=0;i<(N<<1);i++){
xw3[i] = hnd_cfft->CurrentInPtr[i];
}
ServiceDog();
doa_aux[j] = doa_est(xw1,xw2,xw3,30); //50
//doaG +=doa_aux[j];
DELAY_US(100000); //retraso de 100ms
ServiceDog();
E = 0.8*E;
}//for j
diff[0] = doa_aux[0]-doa_aux[1]; //diferencia entre primer y segundo frame
diff[1] = doa_aux[1]-doa_aux[2]; //diferencia entre segundo y tercer frame
diff[2] = doa_aux[0]-doa_aux[2]; //diferencia entre primer y tercer frame
if(diff[0]<0)
diff[0] = -diff[0];
if(diff[1]<0)
diff[1] = -diff[1];
if(diff[2]<0)
diff[2] = -diff[2];
if( diff[0]<=diff[1] && diff[0]<=diff[2] )
doaG = (doa_aux[0]+doa_aux[1])>>1;
else if ( diff[1]<=diff[0] && diff[1]<=diff[2] )
doaG = (doa_aux[1]+doa_aux[2])>>1;
else
