#include <stdio.h>
#include <string.h>
#include <sru.h>
#include <time.h>
#include <math.h>
#include <sysreg.h>
#include <alg.h>
#include "drv/global.h"
#include "drv/pll.h"
#include "drv/board_sru.h"
#include "drv/ad1939.h"
#include "drv/sport.h"
#include "drv/hmem.h"
#include "drv/spi.h"
#include "drv/fft.h"
#include "f2f.h"
#include "execute.h"
#include "queue.h"
#include "jitter.h"
#include "report.h"

extern double proc_secs;///////////////////////////////////////////////////////
extern void* hans,* haec, *hafc;
double cpu_get_process_ulitity(void);

#pragma section("scene_mem")
static   int mem_test = 0xefbcdda5;


//jitter_mem* pusb_input_jitter =0;
//jitter_mem* pusb_output_jitter =0;


static short cpu_cal_ulitily(void)
{	
	double aec_secs = alg_aec_get_ulitily(haec);
	double ans_secs = alg_ans_get_ulitily(hans);
	
	double total_secs;
	
	total_secs = proc_secs*7.5+ (aec_secs+ans_secs);
	proc_secs = 0 ;
	
	return (total_secs*100000/10);

}


void main()
{

	int i ;
	int led_on=0;
	int led_count=0;
	int loop_cnt=0;
	
	short value;
	unsigned short size;////////////////////////////////////////////////
	extern int clock_ok ;
	
	extern  int sp_flag ;
	extern  int inputcnt; 
	extern  int dma_count;
	extern  void* htx_que;
	extern  int msg_process(void);
	extern  int dsp_index  ;
	extern int dsp_status;
	extern  int handshake_successful;

  	initPLL_SDRAM();  //Initialize the PLL and SDRAM controller
	  	
	InitDAI();

	//float t = NORMALIZE(0x0000b32f)*(1.0f/0x7fff);
	
	i = sizeof(tag_parameters);
	
	SRU(DPI_PB06_O, FLAG6_I);
	sysreg_bit_set(sysreg_FLAGS, FLG6);
	dsp_index = sysreg_bit_tst(sysreg_FLAGS , FLG6);
	
	//GPIO 
	SRU(HIGH, DPI_PBEN11_I); //0-busy,1-idle
	SRU(HIGH, DPI_PBEN12_I); //0-send, 1-recva
	SRU(LOW,DPI_PB11_I);
	SRU(LOW,DPI_PB12_I);
	

//	test_dft();
	
	SRU(HIGH,DPI_PBEN13_I);//led
	SRU(HIGH,DPI_PBEN14_I);
	for(i=0;i<3;i++){
		SRU(LOW,DPI_PB13_I);
		SRU(LOW,DPI_PB14_I);
		Delay(1000000);
		SRU(HIGH,DPI_PB13_I);
		SRU(HIGH,DPI_PB14_I);
		Delay(1000000);
	}
	

	hmem_init();
	
	spi_init(DEVICE_DMA);

	
	   // hrx_que = queue_create(8*16);
	htx_que = queue_create(SPI_PKT_SIZE*2);
	//pusb_input_jitter = jitter_create(512);
//	pusb_output_jitter = jitter_create(512);
	
	//sdram check help find problem
	if( mem_test != 0xefbcdda5){
		dsp_status = dsp_mem_err;
		//֪ͨMCUÆô¶¯Íê³É
		SRU(HIGH,DPI_PB11_I);
		SRU(HIGH,DPI_PB12_I);
		while(1){
			loop_cnt++;
			if(loop_cnt>=1000000){
				if(led_on){
					SRU(HIGH,DPI_PB13_I);
				}
				else{
					SRU(LOW,DPI_PB13_I);
				}	
				led_on = !led_on;
				loop_cnt =0;	
			}	
			msg_process();
		}
	}

	alg_lib_init();
	
    //fft_init();
 
	output_empty();
	
	InitSRC();
    InitSPORT(0x3,RATE_SAMPLES);
    //InitSRC();
	//interrupts(SIG_SP1, sport_isr);
    interruptcb(SIG_SP1, sport_isr);
    
    //usb
    interruptcb(SIG_SP5, sport_usb_isr);

    
    //debug״̬ÇëÇóMCUÖØз¢ËÍÊý¾Ý
	device_status_report(DSP_EMULATE_DEBUG,0, 0);
	msg_report_dsp_status(MSG_DSP_STATUS_REPORT);
	
	
	//֪ͨMCUÆô¶¯Íê³É
	SRU(HIGH,DPI_PB11_I);
	SRU(HIGH,DPI_PB12_I);
		
    #define LED_PERIOD (1000*RATE_SAMPLES/(NUM_SAMPLES*1000))

	//main loop 
	while(1){
		if(haec != NULL ){
			alg_aec_process_asy(haec);
		}

		if(hans != NULL){
			alg_ans_process_asy(hans);
		}
		

		msg_process();
			

		if(dma_count-led_count>LED_PERIOD){
			if(led_on){
				SRU(LOW,DPI_PB13_I);
			}
			else{
				SRU(HIGH,DPI_PB13_I);
			}

			size =  hmem_perused(SRAM_AUTO);        
            device_status_report(DSP_MEM_UTILITY,(short*)&size, 1);
            
			value = cpu_cal_ulitily();
			device_status_report(DSP_CPU_UTILITY,&value , 1);
			device_status_report(DSP_RUNNING_STATUS,(short*)&dsp_status ,1);
			
			msg_report_dsp_status(MSG_DSP_STATUS_REPORT);
			led_on=!led_on;
			led_count = dma_count;
			loop_cnt =0;
		}
		loop_cnt++;
		if(loop_cnt>10000000){
			dsp_status = dsp_no_clock;
			loop_cnt =0;	
		}
			
		if(clock_ok == 0 && dsp_status==dsp_running_ok && handshake_successful){
			//DSP²úÉúʱÖÓÉϱ¨MCUÕý³£ÔË×÷
			device_status_report(DSP_CLOCK_STATUS,0 ,0 );
			clock_ok = 1;	
		}
	}
}