/*****************************************************************************
 *   board.c:  BIOSBOX 開發板相關函數
 *
 *   Copyright(C) 2007, uCdragon
 *   All rights reserved.
 *
 *   History
 *   2007.03.16  lqm@ucdragon.net
 *
******************************************************************************/
#include "LPC230x.h"                        /* LPC23xx/24xx definitions */
#include "def.h"
#include "target.h"
#include "irq.h"
#include "utils.h"
#include "board.h"
#if NAND_FLASH_SUPPORT
	#define	NandFlash_DATA  0x81000000
	#define	NandFlash_ALE   0x81400000
	#define	NandFlash_CLE   0x81200000
	#define	NFChipEn()     (IOCLR0 = (1<<11))
	#define	NFChipDs()     (IOSET0 = (1<<11))
	#define	NFIsBusy()     (!(IOPIN0 & (1<<10)))
	#include "nand.c"
#endif

#define UnRBR          (*(volatile unsigned long *)(UARTn_BASE_ADDR + 0x00))
#define UnTHR          (*(volatile unsigned long *)(UARTn_BASE_ADDR + 0x00))
#define UnDLL          (*(volatile unsigned long *)(UARTn_BASE_ADDR + 0x00))
#define UnDLM          (*(volatile unsigned long *)(UARTn_BASE_ADDR + 0x04))
#define UnIER          (*(volatile unsigned long *)(UARTn_BASE_ADDR + 0x04))
#define UnIIR          (*(volatile unsigned long *)(UARTn_BASE_ADDR + 0x08))
#define UnFCR          (*(volatile unsigned long *)(UARTn_BASE_ADDR + 0x08))
#define UnLCR          (*(volatile unsigned long *)(UARTn_BASE_ADDR + 0x0C))
#define UnLSR          (*(volatile unsigned long *)(UARTn_BASE_ADDR + 0x14))
#define UnSCR          (*(volatile unsigned long *)(UARTn_BASE_ADDR + 0x1C))
#define UnACR          (*(volatile unsigned long *)(UARTn_BASE_ADDR + 0x20))
#define UnICR          (*(volatile unsigned long *)(UARTn_BASE_ADDR + 0x24))
#define UnFDR          (*(volatile unsigned long *)(UARTn_BASE_ADDR + 0x28))
#define UnTER          (*(volatile unsigned long *)(UARTn_BASE_ADDR + 0x30))

DWORD UARTn_BASE_ADDR = UART0_BASE_ADDR;

void SerialSwitch( DWORD port )
{
	switch(port)
	{
		case 0:
			UARTn_BASE_ADDR = UART0_BASE_ADDR;
			PINSEL0 &= ~(0xF << 4);
			PINSEL0 |=  (0x5 << 4);
			break;
		case 1:
			UARTn_BASE_ADDR = UART1_BASE_ADDR;
			PINSEL0 &= ~0xC0000000;
			PINSEL0 |=  0x40000000;
			PINSEL1 &= ~0x3;
			PINSEL1 |=  0x1;
			break;
		case 2:
			UARTn_BASE_ADDR = UART2_BASE_ADDR;
			PINSEL0 &= ~0xF;
			PINSEL0 |=  0xA;
			break;
		case 3:
			UARTn_BASE_ADDR = UART3_BASE_ADDR;
			PINSEL0 &= ~(0xF << 20);
			PINSEL0 |=  (0x5 << 20);
			break;
	}
}

void InitUart(DWORD port,DWORD baud )
{
	DWORD Fdiv;

	SerialSwitch(port);
	UnLCR = 0x80;   							/* 允許訪問分頻因子寄存器 */
	Fdiv = ( Fpclk / 16 ) / baud ;  				/* 設置波特率 */
	UnDLM = Fdiv / 256;							
	UnDLL = Fdiv % 256;						
	UnLCR = 0x03;   							/* 禁止訪問分頻因子寄存器 */
	/* 且設置為8,1,n */
	UnIER = 0x00;   							/* 禁止接收和發送中斷 */
	UnFCR = 0x00;   							/* 初始化FIFO */
	
}

void putch( char data )
{
	static char od = 0;
	if ( data == '\n' && od != '\r') putch('\r');
	while ( !( UnLSR & 0x20 ) );     //還有數據未發送完，等待
	UnTHR = data;					 // 發送數據
	od = data;
}

char PollUart(char * pc)
{
	if(UnLSR & 0x01)
	{
		*pc = UnRBR;
		return 1;
	}
	return 0;
}
/*
return char when key is pressed
*/
char PollKey(void)
{
	return 0;
}

/*
led is on if bit is set
*/
void DisplayLed(U8 led)
{
	FIO2PIN0 = led;
}

void Beep(U32 frequency,U32 ms)
{
}
void Delay(U32 ms)
{
  /*
  * setup timer #1 for delay
  */
  T1TCR = 0x02;		/* reset timer */
  T1PR  = 0x00;		/* set prescaler to zero */
  T1MR0 = ms * (Fpclk / 1000);
  T1IR  = 0xff;		/* reset all interrrupts */
  T1MCR = 0x04;		/* stop timer on match */
  T1TCR = 0x01;		/* start timer */
  
  /* wait until delay time has elapsed */
  while (T1TCR & 0x01);
}
/*
  provide by board
  id interrupt need by biosbox
  entry interrupt entry for this interrupt
*/
void SetInterrupt(U32 id,U32 entry)
{
}
#pragma arm section code = "ram_area"
#if IAP_SUPPORT
void IAP(U32 *,U32 *);
void Reset_Handler(void);
U32 GetSector(U32 add)
{
	if(add < 0x8000) return add >> 12;
	else if(add >= 0x78000) return (add >> 12) - 0x62;
	else return (add >> 15) + 7;
}
/*
 program to local flash use iap
*/

int SectorProg(U32 begin, U32 data, U32 size)
{
	U32 command[5];
	U32 result[2];
	U32 cclk = Fcclk/1000;
	BOOL reboot;
	begin &= 0xFFFFF000;//4k align
	data &= 0xFFFFFFFC;//dword align
	printf("program from %x,Len %x to Flash %x ...",data,size,begin);
	size = (size + 0xff) >> 8; //size in 256 byte
	command[2] = GetSector(begin + (size << 8));
	if(command[2] > 26) //max sector 26
	{
		puts("\nprogram address or size is too big\n");
		return 0;
	}
	puts("are you sure?[n/y]\n");
	if(getch() != 'y') 
	{
		puts("program cancelled\n");
		return 0;
	}
	command[1] = GetSector(begin);
	//erase sectors
	command[0] = 50;//prepare
	IAP(command,result);
	if(result[0]) return result[0]; 
	command[3] = cclk;
	command[0] = 52;//erase
	IAP(command,result);
	if(result[0]) return result[0]; 
	
	reboot = !begin;
	while(size--)
	{
		command[1] = command[2] = GetSector(begin);
		command[0] = 50;
		IAP(command,result);
		if(result[0]) return result[0];
		command[1] = begin;
		command[2] = data;
		command[3] = 256;
		command[4] = cclk;
		command[0] = 51; //copy ram to flash
		IAP(command,result);
		if(result[0]) return result[0];
		begin += 256;
		data += 256;
		//putch('.');
		UnTHR = '.';
	}
	if(reboot)
	{
		Reset_Handler();
	}
	return 0;			
}
#endif //IAP_SUPPORT
#pragma arm section code 

#if MCI_SUPPORT
	#include "mci.c"
#endif //MCI_SUPPORT
//init uart,led......
void InitBoard()
{
	//SCS |= 1;//fast gpio for p0,p1
	InitUart(1,57600);
	//led config
	PINSEL4 &= 0xFFFF0000; //2.0-2.7 as gpio
	FIO2DIR = 0xFFFFFFFF;
#if NAND_FLASH_SUPPORT
	EMC_CTRL = 0x00000001;
	PCONP  |= 0x00000800;		/* Turn On EMC PCLK */

//  FIO2DIR &= ~(1 << 12);	/* make P2.12 pin as input */
//  FIO2MASK &= ~(1 << 12); 

	//PINSEL4 = 0x50000000;
	//PINSEL5 = 0x05050555;
	PINSEL6 = 0x55555555;//p4.0-p4.15 as A0-A15
	PINSEL8 = 0x55555555;//p4.0-p4.15 as A0-A15
	PINSEL9 = 0x50555555;//跟手冊有出入？ 0x5000A000:p4.24,p4.25 as OE,WE,p4.30,p4.31 as cs0,cs1

	EMC_STA_CFG1      = 0x00000080;
	/* for NAND FLASH */
	//EMC_STA_WAITWEN1  = 0x2;
	//EMC_STA_WAITOEN1  = 0x2;
	//EMC_STA_WAITRD1   = 0x1F;
	//EMC_STA_WAITPAGE1 = 0x1F;
	//EMC_STA_WAITWR1   = 0x1F;
	//EMC_STA_WAITTURN1 = 0xF;

	PINSEL0 &= ~(0xF << 20); //0.10,0.11 as gpio
	IODIR0 &= ~(1 << 10);  //0.10 input
	IODIR0 |= 1 << 11;     //0.11 output

	//EMC_CONFIG = 0;//little endian
	//EMC_STA_CFG1 = 0;//8 bit,buffer...disabled
	//EMC_STA_WAITWEN1 = 0;
	//EMC_STA_WAITOEN1 = 0;
	EMC_STA_WAITRD1 = 8; //2 should be enough
	EMC_STA_WAITWR1 = 8;
	//EMC_CTRL = 1;//enable,no map,normal mode

#endif
}
void SecInitBoard()
{
	U32 led = 1<<7;
#if MCI_SUPPORT
	printf("MCI Init %s\n",MCI_Init()?"ok":"fail");
#endif //MCI_SUPPORT
#if NAND_FLASH_SUPPORT
	NandInit();
	if(pNand) printf("Flash id %x,size %dM\n",pNand->id,pNand->size >> 20);
	else puts("No Flash found\n");
#endif //MCI_SUPPORT
	while(led)
	{
		DisplayLed(led);
		led >>= 1;
		Delay(50);
	}
	
}