/*=============================================================================
--------------------------------- Copy Left -----------------------------------
						Illidan Fly's Project
						Power by BigFly Network
						http://bigfly.happybobby.com
						
						Released under GPL2 License

----------------------------- File Description --------------------------------
 Filename:	target.c
 Date:		2006.10.04
 Version:	0.0.1
 Description:
			Target board init & int handler.

----------------------------- Version History ---------------------------------
 0.0.1: First release

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

#include "target.h"

#include "2410addr.h"
#include "2410lib.h"
#include "def.h"
#include "mmu.h"

void HaltUndef(void)
{
	Uart_Printf("Undefined instruction exception.\n");
	while(1);
}

void HaltSwi(void)
{
	Uart_Printf("SWI exception.\n");
	while(1);
}

void HaltPabort(void)
{
	Uart_Printf("Pabort exception.\n");
	while(1);
}

void HaltDabort(void)
{
	Uart_Printf("Dabort exception.\n");
	while(1);
}

void Isr_Init(void)
{
	pISR_UNDEF	=	(unsigned)HaltUndef;
	pISR_SWI	=	(unsigned)HaltSwi;
	pISR_PABORT	=	(unsigned)HaltPabort;
	pISR_DABORT	=	(unsigned)HaltDabort;
	
	rINTMOD		=	0x0;					// All in IRQ mode
	rINTMSK		=	BIT_ALLMSK;				// All interrupt is masked
	rINTSUBMSK	=	BIT_SUB_ALLMSK;			// All sub-interrupt is masked
}

void Port_Init(void)
{
	// CAUTION:Follow the configuration order for setting the ports.
	// 1) setting value(GPnDAT)
	// 2) setting control register  (GPnCON)
	// 3) configure pull-up resistor(GPnUP)

	//=== PORT A GROUP
	//Ports  : GPA22 GPA21  GPA20 GPA19 GPA18 GPA17 GPA16 GPA15 GPA14 GPA13 GPA12
	//Signal : nFCE nRSTOUT nFRE   nFWE  ALE   CLE  nGCS5 nGCS4 nGCS3 nGCS2 nGCS1
	//Binary :   1     1      1  ,   1    1     1     1   , 1     1     1     1
	//Ports  : GPA11   GPA10  GPA9   GPA8   GPA7   GPA6   GPA5   GPA4   GPA3   GPA2   GPA1  GPA0
	//Signal : ADDR26 ADDR25 ADDR24 ADDR23 ADDR22 ADDR21 ADDR20 ADDR19 ADDR18 ADDR17 ADDR16 ADDR0
	//Binary :   1      1      1      1   ,  1      1      1      1   ,  1      1      1      1
	rGPACON = 0x7fffff;
	
	//=== PORT B GROUP
	//Ports  : GPB10    GPB9    GPB8    GPB7    GPB6     GPB5    GPB4   GPB3   GPB2     GPB1      GPB0
	//Signal : nXDREQ0 nXDACK0 nXDREQ1 nXDACK1 nSS_KBD nDIS_OFF L3CLOCK L3DATA L3MODE nIrDATXDEN Keyboard
	//Setting: INPUT   OUTPUT  INPUT   OUTPUT  INPUT   OUTPUT   OUTPUT OUTPUT  OUTPUT   OUTPUT    OUTPUT
	//Binary :   00  ,  01       00  ,   01      00   ,   01      01  ,  01      01   ,   01        01
	rGPBCON = 0x044555;
	rGPBUP  = 0x7ff;
	
	//=== PORT C GROUP
	//Ports  : GPC15 GPC14 GPC13 GPC12 GPC11 GPC10 GPC9 GPC8  GPC7   GPC6   GPC5 GPC4 GPC3  GPC2  GPC1 GPC0
	//Signal : VD7   VD6   VD5   VD4   VD3   VD2   VD1  VD0 LCDVF2 LCDVF1 LCDVF0 VM VFRAME VLINE VCLK LEND
	//Binary :  10   10  , 10    10  , 10    10  , 10   10  ,  10     10  ,  10   10 , 10     10 , 10   10
	rGPCCON = 0xaaaaaaaa;
	rGPCUP  = 0xffff;
	
	//=== PORT D GROUP
	//Ports  : GPD15 GPD14 GPD13 GPD12 GPD11 GPD10 GPD9 GPD8 GPD7 GPD6 GPD5 GPD4 GPD3 GPD2 GPD1 GPD0
	//Signal : VD23  VD22  VD21  VD20  VD19  VD18  VD17 VD16 VD15 VD14 VD13 VD12 VD11 VD10 VD9  VD8
	//Binary :  10    10  , 10    10  , 10    10  , 10   10 , 10   10 , 10   10 , 10   10 ,10   10
	rGPDCON = 0xaaaaaaaa;
	rGPDUP  = 0xffff;
	
	//=== PORT E GROUP
	//Ports  : GPE15  GPE14 GPE13   GPE12   GPE11   GPE10   GPE9    GPE8     GPE7  GPE6  GPE5   GPE4
	//Signal : IICSDA IICSCL SPICLK SPIMOSI SPIMISO SDDATA3 SDDATA2 SDDATA1 SDDATA0 SDCMD SDCLK I2SSDO
	//Binary :  10      10  ,  10     10  ,   10      10   ,  10      10   ,  10     10  , 10    10  ,
	//-------------------------------------------------------------------------------------------------------
	//Ports  :  GPE3   GPE2  GPE1    GPE0
	//Signal : I2SSDI CDCLK I2SSCLK I2SLRCK
	//Binary :   10    10  ,  10      10
	rGPECON = 0xaaaaaaaa;
	rGPEUP  = 0xffff;
	
	//=== PORT F GROUP
	//Ports  : GPF7   GPF6   GPF5   GPF4      GPF3     GPF2  GPF1   GPF0
	//Signal : nLED_8 nLED_4 nLED_2 nLED_1 nIRQ_PCMCIA EINT2 KBDINT EINT0
	//Setting: Output Output Output Output    EINT3    EINT2 EINT1  EINT0
	//Binary :  01      01 ,  01     01  ,     10       10  ,   10     10
	rGPFCON = 0x55aa;
	rGPFUP  = 0xff;

	//=== PORT G GROUP
	//Ports  : GPG15 GPG14 GPG13 GPG12 GPG11    GPG10    GPG9     GPG8     GPG7      GPG6
	//Signal : nYPON  YMON nXPON XMON  EINT19 DMAMODE1 DMAMODE0 DMASTART KBDSPICLK KBDSPIMOSI
	//Setting: nYPON  YMON nXPON XMON  EINT19  Output   Output   Output   SPICLK1    SPIMOSI1
	//Binary :    11    11 , 11     11  , 10      01    ,   01       01   ,    11         11
	//-----------------------------------------------------------------------------------------
	//Ports  :    GPG5       GPG4    GPG3    GPG2    GPG1    GPG0
	//Signal : KBDSPIMISO LCD_PWREN EINT11 nSS_SPI IRQ_LAN IRQ_PCMCIA
	//Setting:  SPIMISO1  LCD_PWRDN EINT11   nSS0   EINT9    EINT8
	//Binary :     11         11   ,  10      11  ,  10        10
	rGPGCON = 0xff95ffba;
	rGPGUP  = 0xffff;
	
	//=== PORT H GROUP
	//Ports  :  GPH10   GPH9   GPH8 GPH7  GPH6  GPH5 GPH4 GPH3 GPH2 GPH1  GPH0
	//Signal : CLKOUT1 CLKOUT0 UCLK nCTS1 nRTS1 RXD1 TXD1 RXD0 TXD0 nRTS0 nCTS0
	//Binary :   10   ,   10     10 , 11    11  , 10   10 , 10   10 , 10    10
	rGPHCON = 0x2afaaa;
	rGPHUP  = 0x7ff;
	
	// External interrupt will be falling edge triggered.
	rEXTINT0 = 0x22222222;    // EINT[7:0]
	rEXTINT1 = 0x22222222;    // EINT[15:8]
	rEXTINT2 = 0x22222222;    // EINT[23:16]
}

void Target_Init(void)
{
	MMU_Init();
	ChangeMPllValue(0xa1,0x3,0x1);	// FCLK = 202.8MHz
	ChangeClockDivider(1,1);		// 1:2:4
	Delay(0);						// Adjust delay timer
	Port_Init();
	Isr_Init();
	
	Uart_Init(0,115200);
	Uart_Select(0);
}