/*
===============================================================================

 Ftune2 is SH7305 CPG&BSC tuning utility for fx-9860GII-2      v1.01

 copyright(c)2014,2015 by sentaro21
 e-mail sentaro21@pm.matrix.jp

===============================================================================
*/

#include "fxlib.h"
#include "timer.h"
#include "stdio.h"
#include "string.h"

#include "common.h"
#include "Ftune2_benchmark.h"

//---------------------------------------------------------------------------------------------

int t_t0,t_t1,t_t2,t_tt;

int gettimes(){ 	
	return( -*(unsigned int*)P7305_EXTRA_TMU5_COUNT );
}

void start_timer(){
	int cnt=0;

	t_t0=gettimes();
	while(gettimes()==t_t0);
	t_t1=t_t0+1;
	while(gettimes()==t_t1) cnt++;
	t_tt=cnt;
}

int get_timer(int prec){			// prec:1000  1/1000 count
	int cnt;
	cnt=0;
	t_t1=gettimes();
	while(gettimes()==t_t1) cnt++;
	t_t2=t_t1+1;
	return( ( (t_t2-t_t0-2)*prec-cnt*prec/t_tt )/32768 );
}


//---------------------------------------------------------------------------------------------

int cont_flag = 1;

void Timer_Routine(void){
    cont_flag = 0;
}

void Bench(int duration_ms, int display_count)
{
    int count = 0;
    char buffer[30];

    cont_flag = 1;
    SetTimer(ID_USER_TIMER1, duration_ms, &Timer_Routine);

//    while(cont_flag) {
//        count++;
//    }
	count=tcount(&cont_flag);

    KillTimer(ID_USER_TIMER1);

    if (display_count) {
		locate(1,7); PrintLine((unsigned char *) " ", 21);
        sprintf(buffer, " CPU.%d  ", count/100);
		PrintMini(0*6+0,6*8+1,(unsigned char *)buffer, MINI_REV);
    }
}


int BenchDD(int duration_ms)
{
    char buffer[30];
    int i,k,prec=1000000;
	int count=100000;

	start_timer();
	Bdisp_PutDisp_DD();
	count = get_timer(1000000) ;		// prec	
	
	start_timer();
	Bdisp_PutDisp_DD();
	count = get_timer(1000000) ;		// prec	

	if(	(count > 10000 ) || ( count < 0 ) ) {
		start_timer();
		Bdisp_PutDisp_DD();
		count = get_timer(10000) ;		// prec	
		prec=10000;
	}
	sprintf(buffer," PutDispDD %5.1ffps   ",(float)prec/count);

	PrintMini( 7*6- 0,6*8+1,(unsigned char *)buffer, MINI_REV);
	return k;
}


void Benchmem(int duration_ms)
{
    int count;
    int	k;
    char buffer[30];

    cont_flag = 1;
    SetTimer(ID_USER_TIMER1, duration_ms, &Timer_Routine);
	count=memread((unsigned int*)0xA0010000,&cont_flag);		// Flash ROM non cacheable
    KillTimer(ID_USER_TIMER1);
   	sprintf(buffer, " o.%d    ", count);
	PrintMini( 7*6- 0,6*8+1,(unsigned char *)buffer, MINI_REV);

    cont_flag = 1;
    SetTimer(ID_USER_TIMER1, duration_ms, &Timer_Routine);
	count=memread((unsigned int*)0xA8040000,&cont_flag);		// SRAM non cacheable
    KillTimer(ID_USER_TIMER1);
   	sprintf(buffer, "a.%d    ", count);
	PrintMini( 8*6+26,6*8+1,(unsigned char *)buffer, MINI_REV);
    
    cont_flag = 1;
    SetTimer(ID_USER_TIMER1, duration_ms, &Timer_Routine);
	count=memread((unsigned int*)0xA4150000,&cont_flag);		//   I/O non cacheable
    KillTimer(ID_USER_TIMER1);
   	sprintf(buffer, "p.%d   ", count);
	PrintMini( 8*6+54,6*8+1,(unsigned char *)buffer, MINI_REV);
}