44blib.c

这是在linux下

/************************************************
 * NAME    : 44BLIB.C				*
 ************************************************/
#include "../inc/44b.h"
#include "../inc/44blib.h"
#include "../inc/option.h"

#include "../inc/util.h"

unsigned int tmp_mclk;
struct{
	U32 mclk;
	U32 pclk;
	U32 sclk;
	U32 freq;
} ClkPara;

/************************* SYSTEM *************************/
static int delayLoopCount=400;

void Delay(int time)
// time=0: adjust the Delay function by WatchDog timer.
// time>0: the number of loop time
// 100us resolution.
{
    int i,adjust=0;
    if(time==0)
    {
	time=200;
	adjust=1;
	delayLoopCount=400;
	rWTCON=((MCLK/1000000-1)<<8)|(2<<3);  // 1M/64,Watch-dog,nRESET,interrupt disable
	rWTDAT=0xffff;
	rWTCNT=0xffff;	 
	rWTCON=((MCLK/1000000-1)<<8)|(2<<3)|(1<<5); // 1M/64,Watch-dog enable,nRESET,interrupt disable 
    }
    for(;time>0;time--)
	for(i=0;i<delayLoopCount;i++);
    if(adjust==1)
    {
	rWTCON=((MCLK/1000000-1)<<8)|(2<<3);
	i=0xffff-rWTCNT;   //  1count/16us
	//delayLoopCount=8000000/(i*64);	//400*100/(i*64/200)  
        delayLoopCount=do_div(8000000,(i*64));
    }
}

/************************* PORTS ****************************/
void MemCfgInit(void)
{
	rNCACHBE0 = ((unsigned int)(Non_Cache_End>>12)<<16)|(Non_Cache_Start>>12);
}
void CacheDisable(void)
{
	rSYSCFG = SYSCFG_0KB;		//窽ゎCache
}

void CacheEnable(void)
{
	rSYSCFG = SYSCFG_8KB;	//ㄏ8K Cache
}

void CacheFlush(void)
{
    int i,saveSyscfg;
    
    saveSyscfg=rSYSCFG;
    //clear TAG & LRU
    rSYSCFG=SYSCFG_0KB; 		      
    for(i=0x10004000;i<0x10004800;i+=16)    
    {					   
	*((int *)i)=0x0;		   
    }
    rSYSCFG=saveSyscfg; 			    
}

void PortInit(void)
{
    //ADB V1.0 B/D Status
    //USB D12SUSPD 
    //    PC0
    //LED D0  D1  D2
    //	  PC1 PC2 PC3
    //KEY K0  K1  K2  K3
    //	  PG4 PG5 PG6 PG7

    //CAUTION:Follow the configuration order for setting the ports. 
    // 1) setting value MCLK
    // 2) setting control register 
    // 3) configure pull-up resistor.  
	     
    //16bit data bus configuration  
    //PORT A GROUP
    //rPCONA[9:0]
    //|BIT9  |.......................................................|BIT0
    //|ADDR24|ADDR23|ADDR22|ADDR21|ADDR20|ADDR19|ADDR18|ADDR17|ADDR16|ADDR0		      
    //|     0|     1|	  1|     1|     1|     1|     1|	 1|     1|    1
    rPCONA=0x1ff;	

    //PORT B GROUP
    //rPCONB[10:0]
    //|BIT10|....................................................|BIT0
    //|nGCS5|nGCS4|nGCS3|nGCS2|nGCS1|nWBE3|nWBE2|nSRAS|nSCAS|SCLK|SCKE
    //|    1|    1|    1|	 1|    1|    1|    1|	 1|    1|   1|   1
    rPDATB=0x3ff;
    rPCONB=0x3ff;
    
    //PORT C GROUP
    //BUSWIDTH=16
    //PORT C GROUP
    //rPCONC[31:0]
    //|GPC15|....................................................................|    GPC0
    //|BIT31|....................................................................|    BIT0
    //|nCTS0|nRTS0|RXD1|TXD1|nCTS1|nRTS1|nEL|nDISP|VD4|VD6|VD5|VD7|LED2|LED1|LED0|D12SUSPD
    //|   00|   00|  11|  11|   00|   00| 01|   01| 11| 11| 11| 11|  01|  01|  01|      01
    //rPUPC[15:0]
    //|    0|    0|   1|   1|    0|    0|  0|    0|  1|  1|  1|  1|   0|   0|   0|       0
    rPDATC=0xffff;	//All I/O Is High
    rPCONC=0x0f05ff55;	
    rPUPC=0x30f0;	//PULL UP RESISTOR should be enabled to I/O

    //PORT D GROUP
    //rPCOND
    //| BIT15|.........................|BIT0 
    //|VFRAME|VM|VLINE|VCLK|VD3|VD2|VD1|VD0
    //|    10|10|   10|	 10| 10| 10| 10| 10  
    rPDATD=0xff;
    rPCOND= 0x0;
	rPUPD = 0x0;
	//These pins must be set only after CPU's internal LCD controller is enable
	
	//rPCOND=0xaaaa;	
    //rPUPD=0xff;

    //PORT E GROUP
    //rPCONE
    //| BIT17 |..............................|BIT0
    //|CODECLK|PE7|PE6|BEEP|PE4|PE3|RXD0|TXD0| PE0
    //|     10| 00| 00|  01| 00| 00|  10|  10|  00
    //|rPUPE[7:0]
    //        |  0|  0|   0|  0|  0|   1|   1|   0
    rPDATE=0x1ff;  	//All I/O Is High
    rPCONE=0x20428;	//All NC is INPUT	
    rPUPE=0x06;	//PE8 do not have programmable pull-up resistor.  

    //PORT F GROUP
    //rPCONF[21:0]
    //| BIT21|....................................|  BIT0
    //|IISCLK|PF7|IISDO|IISLRCK|PF4|PF3|PF2|IICSDA|IICSCL
    //|   100|000|  100|    100| 00| 00| 00|    10|    10
    //rPUPF[8:0]
    //|     1|  0|    1|      1|  0|  0|  0|     1|     1
    rPDATF=0x1ff;	//All I/O Is High
    rPCONF=0x20900a;//All NC is INPUT
    rPUPF=0x163;

    //PORT G GROUP
    //rPCONG[15:0]
    //|BIT15|....................................|   BIT0
    //| KEY3|KEY2|KEY1|KEY0|EXINT3|EXINT2|NET_INT|USB_INT
    //|   11|  11|  11|  11|    11|    11|     11|     11
    rPDATG=0xff;
    rPCONG=0xffff;		
    rPUPG=0x0;		//should be enabled  
    
    rSPUCR=0x7; 	//D15-D0 pull-up disable
    
	rEXTINT=0x0;	//All EXTINT0-7 Low level interrupt
	
}

 void set_pll(void)
{
	U32 i, j;
	
	if(ClkPara.mclk>255)
		ClkPara.mclk = 255;
	if(ClkPara.pclk>63)
		ClkPara.pclk = 63;
	if(ClkPara.sclk>3)
		ClkPara.sclk = 3;	
		
	j = ClkPara.sclk;
	i = 1<<j;
	
	ClkPara.freq = EXT_OSC_CLK*do_div((ClkPara.mclk+8),((ClkPara.pclk+2)*i));
        
	if((ClkPara.freq>=90000000)||(ClkPara.freq<EXT_OSC_CLK)) {
		ClkPara.mclk = 114;
		ClkPara.pclk = 8;
		ClkPara.sclk = 1;
		ClkPara.freq = EXT_OSC_CLK*122/20;
	}
        tmp_mclk=ClkPara.freq;
	rPLLCON = (ClkPara.mclk << 12) | (ClkPara.pclk << 4) | ClkPara.sclk;
}

void SystemClockInit(void)
{
	ClkPara.mclk = PLL_M;	//	((m+8)*EXT_OSC_CLK)/((p+2)*(1<<s))
	ClkPara.pclk = PLL_P;	//
	ClkPara.sclk = PLL_S;	//
	set_pll();
}

void Led_Display(int LedStatus)
{
	//PC1,PC2,PC3 High available
    rPDATC=(rPDATC & 0x1f1) | ((LedStatus & 0x7)<<1);
}

/************************* UART ****************************/
static int whichUart=0;

void Uart_Init(int mclk,int baud)
{
    int i;
    if(mclk==0)
	mclk=tmp_mclk;
    rUFCON0=0x0;     //FIFO disable
    rUFCON1=0x0;
    rUMCON0=0x0;
    rUMCON1=0x0;
//UART0
    rULCON0=0x3;     //Normal,No parity,1 stop,8 bit
    rUCON0=0x245;    //rx=edge,tx=level,disable timeout int.,enable rx error int.,normal,interrupt or polling
 //   rUBRDIV0=( (int)(mclk/16./baud + 0.5) -1 );
    rUBRDIV0=do_div(mclk,baud<<4);
//UART1
    rULCON1=0x3;
    rUCON1=0x245;
 //   rUBRDIV1=( (int)(mclk/16./baud + 0.5) -1 );
    rUBRDIV1=do_div(mclk,baud<<4);
    for(i=0;i<100;i++);
}


void Uart_Select(int ch)
{
    whichUart=ch;
}

/*
void Uart_TxEmpty(int ch)
{
    if(ch==0)
	while(!(rUTRSTAT0 & 0x4)); //wait until tx shifter is empty.
    else
    	while(!(rUTRSTAT1 & 0x4)); //wait until tx shifter is empty.
}
*/

char Uart_Getch(void)
{
    if(whichUart==0)
    {	    
	while(!(rUTRSTAT0 & 0x1)); //Receive data read
	return RdURXH0();
    }
    else
    {
	while(!(rUTRSTAT1 & 0x1)); //Receive data ready
	return	rURXH1;
    }
}

/*
char Uart_GetKey(void)
{
    if(whichUart==0)
    {	    
	if(rUTRSTAT0 & 0x1)    //Receive data ready
    	    return RdURXH0();
	else
	    return 0;
    }
    else
    {
	if(rUTRSTAT1 & 0x1)    //Receive data ready
	    return rURXH1;
	else
	    return 0;
    }
}
*/

void Uart_GetString(char *string)
{
    char *string2=string;
    char c;
    while((c=Uart_Getch())!='\r')
    {
	if(c=='\b')
	{
	    if(	(int)string2 < (int)string )
	    {
		Uart_Printf("\b \b");
		string--;
	    }
	}
	else 
	{
	    *string++=c;
	    Uart_SendByte(c);
	}
    }
    *string='\0';
    Uart_SendByte('\n');
}


int Uart_GetIntNum(void)
{
    char str[30];
    char *string=str;
    int base=10;
    int minus=0;
    int lastIndex;
    int result=0;
    int i;
    
    Uart_GetString(string);
    
    if(string[0]=='-')
    {
        minus=1;
        string++;
    }
    
    if(string[0]=='0' && (string[1]=='x' || string[1]=='X'))
    {
	base=16;
	string+=2;
    }
    
    lastIndex=strlen(string)-1;
    if( string[lastIndex]=='h' || string[lastIndex]=='H' )
    {
	base=16;
	string[lastIndex]=0;
	lastIndex--;
    }

    if(base==10)
    {
	result=atoi(string);
	result=minus ? (-1*result):result;
    }
    else
    {
	for(i=0;i<=lastIndex;i++)
	{
    	    if(u_isalpha(string[i]))
	    {
		if(u_isupper(string[i]))
		    result=(result<<4)+string[i]-'A'+10;
		else
		    result=(result<<4)+string[i]-'a'+10;
	    }
	    else
	    {
		result=(result<<4)+string[i]-'0';
	    }
	}
	result=minus ? (-1*result):result;
    }
    return result;
}


void Uart_SendByte(int data)
{
    if(whichUart==0)
    {
	if(data=='\n')
	{
	    while(!(rUTRSTAT0 & 0x2));
	    Delay(10);	//because the slow response of hyper_terminal 
	    WrUTXH0('\r');
	}
	while(!(rUTRSTAT0 & 0x2)); //Wait until THR is empty.
	Delay(10);
	WrUTXH0(data);
    }
    else
    {
	if(data=='\n')
	{
    	    while(!(rUTRSTAT1 & 0x2));
	    Delay(10);	//because the slow response of hyper_terminal 
	    rUTXH1='\r';
	}
	while(!(rUTRSTAT1 & 0x2));  //Wait until THR is empty.
	Delay(10);
	rUTXH1=data;
    }	
}		


void Uart_SendString(char *pt)
{
    while(*pt)
	Uart_SendByte(*pt++);
}


//if you don't use vsprintf(), the code size is reduced very much.

void Uart_Printf(char *fmt,...)
{
    va_list ap;
    char string[256];

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


/************************* PLL ********************************/

void ChangePllValue(int mdiv,int pdiv,int sdiv)
{
	ClkPara.mclk = mdiv;	//	((m+8)*EXT_OSC_CLK)/((p+2)*(1<<s))
	ClkPara.pclk = pdiv;	//
	ClkPara.sclk = sdiv;	//
	set_pll();
}


void Beep(U32 freq, U32 ms)
{
	rPCONE &= ~(3<<10);
	rPCONE |= (2<<10);
	
	rTCON  	&= ~0xf000;				// clear manual update bit, stop Timer2
	rTCFG0 	&= ~0xff00;				// set Timer 2&3 prescaler 0
	rTCFG1 	&= ~0xf00;				// set Timer 2 MUX 1/16
	rTCFG1  |= 0x300;	
	rTCNTB2	 = tmp_mclk/(2100*16);	//if set inverter off, when TCNT2<=TCMP2, TOUT is high, TCNT2>TCMP2, TOUT is low
	rTCMPB2  = rTCNTB2>>1;		//if set inverter on,  when TCNT2<=TCMP2, TOUT is low,  TCNT2>TCMP2, TOUT is high
	rTCON	|= 0x2000;				// manual update
	rTCON	&= ~0x2000;				// clear manal update bit
	rTCON   |= 0xd000;				// auto reload, inverter on, start Timer 2	
	
	Delay(ms);
	
	rTCON &= ~0x1000;
	
	rPCONE &= ~(3<<10);
	rPCONE |= 1<<10;
	rPDATE &= ~(1<<5);
}