lib.c

一个简单的基于s3c2410的bootloader

#include <math.h>
#include <stdarg.h>
#include <string.h>
#include <stdlib.h>
#include <stdio.h>
#include <ctype.h>

#include "addr.h"
#include "def.h"
#include "libs.h"
#include "option.h"

#include "lib.h"

void HaltUndef( void );
void HaltSwi( void );
void HaltPabort( void );
void HaltDabort( void );

U32 Current_PCLK = 0;

void Delay( U32 iDelay )
{
	U32 i;
	for( i = 0; i < iDelay; i++);
}

void ChangeClockDivider( U32 hdivn, U32 pdivn )
{
     // hdivn,pdivn FCLK:HCLK:PCLK
     //     0,0         1:1:1 
     //     0,1         1:1:2 
     //     1,0         1:2:2
     //     1,1         1:2:4
    rCLKDIVN = ( hdivn << 1 ) | pdivn;
    
	if( hdivn )
		MMU_SetAsyncBusMode();
    else 
		MMU_SetFastBusMode();
}

void ChangeMPllValue( U32 mdiv, U32 pdiv, U32 sdiv )
{
	rMPLLCON = ( mdiv << 12 ) | ( pdiv << 4 ) | sdiv;
}

void ChangeUPllValue( U32 mdiv, U32 pdiv, U32 sdiv )
{
	rUPLLCON = ( mdiv << 12 ) | ( pdiv << 4 ) | sdiv;
}

void Uart0_Init( U32 bps )
{	
	U32 data;
	
	//	open corresponding ports for Uart function
	data = rGPHCON;
	data = ( ( data >> 8 ) << 8 ) | 0xAA;
	rGPHCON = data;
	
	//	config Uart 0 register
	rUFCON0 = 0;			//	diabale FIFO control
	rUMCON0 = 0;			//	diabale MODEM control
	rULCON0 = 0x03;			//	normal mode, No parity, One stop, 8-bit
	rUCON0 = 0x245;			//	Select PCLK, polling mode
	rUBRDIV0 = ( U32 )( Current_PCLK/16./bps + 0.5 ) -1;	
	
	Delay(100);
}

U8 Uart0_Getch( void )
{
	if( rUTRSTAT0 & 0x01 )
		return RdURXH0();
	else
		return 0;
}

void Uart0_Putch( U8 ch )
{
	if( ch == '\n' )
	{
		while( !( rUTRSTAT0 & 0x02 ) );
		//Delay( 10 );					//because the slow response of hyper_terminal 
		WrUTXH0( '\r' );
	}
	while( !( rUTRSTAT0 & 0x02 ) );		//Wait until THR is empty.
	//Delay( 10 );
	WrUTXH0( ch );
}

void Uart0_PutString( S8 *pString )
{
    while( *pString )
        Uart0_Putch( *pString++ );
}

void Uart0_Printf( S8 *fmt, ... )
{
    va_list ap;
    S8 string[256];

    va_start( ap, fmt);
    vsprintf( string, fmt, ap);
    Uart0_PutString( string );
    va_end( ap );
}

void Irq_InstallHandler( U32 BIT_IrqType, void __irq (*Irq_Handle)( void ) )
{
	U32 nOffset = log( BIT_IrqType )/log( 2 );
	nOffset <<= 2;
	*( ( U32 * )( _IRQ_STARTADDRESS + nOffset ) ) = ( U32 )Irq_Handle;
}

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)  

    //32bit data bus configuration  
    //*** 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 : nLED_8  nLED_4  nLED_2  nLED_1 nSS_KBD nDIS_OFF L3CLOCK L3DATA L3MODE nIrDATXDEN Keyboard
    //Setting: OUTPUT  OUTPUT  OUTPUT  OUTPUT   INPUT   OUTPUT   OUTPUT OUTPUT OUTPUT   OUTPUT    OUTPUT 
    //Binary :   01  ,  01       01  ,   01      00   ,  01       01  ,   01     01   ,  01        01  
    rGPBCON = 0x054555;
    rGPBUP  = 0x7Ff;     // The pull up function is disabled GPB[10:0]

    //*** 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;     // The pull up function is disabled GPC[15:0] 

    //*** 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;     // The pull up function is disabled GPD[15:0]

    //*** 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;     // The pull up function is disabled GPE[15:0]

    //*** PORT F GROUP
    //Ports  : GPF7   GPF6   GPF5   GPF4      GPF3     GPF2  GPF1   GPF0
    //Signal : EINT7  EINT6  EINT5  EINT4  nIRQ_PCMCIA EINT2 KBDINT EINT0
    //Setting: Output Output Output Output    EINT3    EINT2 EINT1  EINT0
    //Binary :  10     10     10     10  ,     10       10  , 10     10
    rGPFCON = 0xAAAA;
    rGPFUP  = 0xFF;     // The pull up function is disabled GPF[7:0]

    //*** 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;    // The pull up function is disabled GPG[15:0]

    //*** 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 :   01   ,  01     10 , 11    11  , 10   10 , 10   10 , 10    10
    //rGPHCON = 0x16faaa;
    //Binary :   10   ,  10     10 , 11    11  , 10   10 , 10   10 , 10    10
    rGPHCON = 0x2AFAAA;
    rGPHUP  = 0x7FF;    // The pull up function is disabled GPH[10:0]
    
    //External interrupt will be falling edge triggered. 
    rEXTINT0 = 0x22222222;    // EINT[7:0]
    rEXTINT1 = 0x22222222;    // EINT[15:8]
    rEXTINT2 = 0x22222222;    // EINT[23:16]
}

void Init_Halt( void )
{
	//*( ( U32 * )( _RAM_STARTADDRESS + 0x00 ) ) = ( U32 )Reset;
	*( ( U32 * )( _RAM_STARTADDRESS + 0x04 ) ) = ( U32 )HaltUndef;
	*( ( U32 * )( _RAM_STARTADDRESS + 0x08 ) ) = ( U32 )HaltSwi;
	*( ( U32 * )( _RAM_STARTADDRESS + 0x0C ) ) = ( U32 )HaltPabort;
	*( ( U32 * )( _RAM_STARTADDRESS + 0x10 ) ) = ( U32 )HaltDabort;
	//*( ( U32 * )( _RAM_STARTADDRESS + 0x14 ) ) = ( U32 )Reserved;
	//*( ( U32 * )( _RAM_STARTADDRESS + 0x18 ) ) = ( U32 )Irq;
	//*( ( U32 * )( _RAM_STARTADDRESS + 0x1c ) ) = ( U32 )Fiq;
}

void HaltUndef( void )
{
    Uart0_Printf( "Undefined instruction exception!!!\n" );
    while(1);
}

void HaltSwi( void )
{
    Uart0_Printf( "SWI exception!!!\n" );
    while(1);
}

void HaltPabort( void )
{
    Uart0_Printf( "Pabort exception!!!\n" );
    while(1);
}

void HaltDabort( void )
{
    Uart0_Printf( "Dabort exception!!!\n" );
    while(1);
}