#include <stdio.h>
|
#include <string.h>
|
#include <sru.h>
|
#include <alg.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;
|
short reply_status;
|
unsigned short size;////////////////////////////////////////////////
|
extern int clock_ok ;
|
|
extern int sp_flag ;
|
extern int inputcnt;
|
extern int dma_count[2];
|
extern int usb_dma_count;
|
extern void* htx_que;
|
extern int msg_process(void);
|
extern int dsp_index ;
|
extern int dsp_status;
|
extern int handshake_successful;
|
extern int topo_state;
|
|
int request_topo_count =0 ; //if no preset after handshare 8's, request one time.
|
int clock_check_count =0;
|
int first_scene_done = 0;
|
int no_clock = 0;
|
|
memset(dma_count, 0, sizeof(int)*2);
|
|
|
initPLL_SDRAM(); //Initialize the PLL and SDRAM controller
|
|
InitDAI();
|
|
|
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-recv
|
SRU(LOW,DPI_PB11_I);
|
SRU(LOW,DPI_PB12_I);
|
|
|
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();
|
//test();
|
spi_init(DEVICE_DMA);
|
|
htx_que = queue_create(SPI_PKT_SIZE*4);
|
|
//sdram check help find problem
|
if(mem_test != 0xefbcdda5){
|
dsp_status = dsp_mem_err;
|
device_status_report(DSP_RUNNING_STATUS,(short*)&dsp_status ,1);
|
msg_report_dsp_status(MSG_DSP_STATUS_REPORT);
|
|
//֪ͨ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();
|
|
output_empty();
|
|
|
//InitSRC();
|
//InitSPORT(0x3,RATE_SAMPLES);
|
|
//interruptcb(SIG_SP1, sport_isr);
|
//interruptcb(SIG_SP3, sport3_isr);
|
//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[0] - 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);
|
|
reply_status = no_clock ? dsp_clock_ok : dsp_status;
|
device_status_report(DSP_RUNNING_STATUS,(short*)&reply_status ,1);
|
|
//do not use this function to other place .only here.
|
msg_report_dsp_status(MSG_DSP_STATUS_REPORT);
|
|
no_clock = 0;
|
led_on=!led_on;
|
led_count = dma_count[0];
|
}
|
|
//8s request
|
if(clock_ok && dma_count[0] - request_topo_count > (8*(RATE_SAMPLES/NUM_SAMPLES))){
|
if(topo_state == PRESET_NONE) {
|
device_status_report(DSP_SCENE_REQUEST,0 ,0);
|
}
|
else if(topo_state == PRESET_DONE && !first_scene_done){
|
device_status_report(DSP_SCENE_DONE,0 ,0);
|
topo_state = PRESET_NORMAL;
|
first_scene_done = 1;
|
}
|
else if(topo_state == PRESET_DONE){
|
//If the scene completion response is continuously reported, it will cause the ADC to keep resetting.
|
//device_status_report(DSP_SCENE_DONE,0 ,0);
|
topo_state = PRESET_NORMAL;
|
}
|
request_topo_count = dma_count[0];
|
}
|
|
//clock state will change after running,it need check always.
|
//about 2.5s
|
if(++loop_cnt>10000000){
|
if(clock_ok && !no_clock && clock_check_count == dma_count[0]) {
|
dsp_status = dsp_no_clock;
|
device_status_report(DSP_RUNNING_STATUS,(short*)&dsp_status ,1);
|
msg_report_dsp_status(MSG_DSP_STATUS_REPORT);
|
|
no_clock = 1;
|
}
|
|
loop_cnt =0;
|
clock_check_count = dma_count[0];
|
}
|
|
if(clock_ok == 0 && dsp_status==dsp_running_ok && handshake_successful){
|
//DSP²úÉúʱÖÓÉϱ¨MCUÕý³£ÔË×÷
|
device_status_report(DSP_CLOCK_STATUS,0 ,0 );
|
|
request_topo_count = dma_count[0];
|
clock_ok = 1;
|
}
|
}
|
}
|
