#include <stdio.h>
#include <stdlib.h>

#include "2413addr.h"
#include "System.h"
#include "Exception.h"
#include "Console.h"

#include "MmuCache.h"
#include "PLL.h"
#include "DRAM.h"
#include "flash.h"

#include "dma.h"
//#include "cs8900.h"
#include "lcd.h"
#include "iis.h"
#include "adcts.h"
#include "nand.h"
#include "spi.h"
#include "camif.h"
#include "power.h"
#include "iic.h"


void *function[][2]=
{   //  								"123456789012345678901"
	(void *) ProgramFlash,				"NOR Flash            ",
	(void *) Test_DMA,					"DMA Test             ",
	(void *) Lcd_Test,					"LCD Test             ",
	(void *) IIS_Test,				    "IIS Test             ",
	(void *) Ch15_ADC,					"ADC & TS Test        ",
	(void *) Test_Nand,					"Nand Test            ",
	(void *) Ch20_IIC,					"IIC Test             ",
	(void *) Ch21_SPI,					"SPI Test             ",
	(void *) Ch22_CAMERA,				"Camera Test          ",
	(void *) Power_Test,				"Power Test           ",

0,0
};


int main( void)
{
	int i;

    //To make margin

	//rBANK_CFG = 0xfc;
	
	PreChangeSDRAMParameter();

	SetCLKDIV( Startup_ARMCLKdiv, Startup_HCLKdiv, Startup_PCLKdiv);
	SetMPLL( Startup_MDIV, Startup_PDIV, Startup_SDIV);
	SystemCLK();
	ChangeSDRAMParameter(HCLK);
	
	
    Isr_Init();
    MMU_Init();
    
    Test_Lcd_Tft_16Bit_240320On();


    Delay(0); //calibrate Delay()
    
//--------------------------------------------------------------------------------------------
    while(1)
    {
 		Console();
	
	printf("bankcon2=%08x\n", rBANKCON2);
	printf("clkdiv=%08x\n", rCLKDIVN);
	
		
		Init_LED();
	    Led_Display(0xf);//all on
		
	   	printf("\n\nSMDK2413 Test Program Ver 0.0 (20050923)\n");
	   	printf("MPLL=%.2fMHz, ARMCLK=%.2fMHz (%d:%d:%d), HCLK=%.2fMHz, PCLK=%.2fMHz\n\n",
	   		(float)MPLL/1000000,(float)ARMCLK/1000000,ARMCLKdiv+1,(ARMCLKdiv+1)*(HCLKdiv+1),(ARMCLKdiv+1)*(HCLKdiv+1)*(PCLKdiv+1),(float)HCLK/1000000,(float)PCLK/1000000);

		i = 0;
		while(1)
		{   //display menu
	    	printf("%2d:%s",i,function[i][1]);
	    	i++;
	    	if((int)(function[i][0])==0)
	    	{
				printf("\n");
				break;
	    	}
	    	if((i%4)==0) printf("\n");
		}

		printf("\nSelect the function to test : ");
		i = GetIntNum();
		printf("\n");

		if( i>=0 && (i<sizeof(function)/8-1) ) 
		   ( (void (*)(void)) (function[i][0]) )();
    }	
}