2440lib.c

2440的bootloader

    while(*pt)
        Uart_SendByte(*pt++);
}
#if 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 result   = 0;
    int lastIndex;    
    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(lastIndex<0)
        return -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(isalpha(string[i]))
            {
                if(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;
}


//=====================================================================
//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);
}

#endif
//**************************[ BOARD LED ]*********************************
void Led_Display(int data)
{
          //Active is low.(LED On)
          // GPF7  GPF6   GPF5   GPF4
          //nLED_8 nLED4 nLED_2 nLED_1
//    rGPFDAT = (rGPFDAT & 0xf) | !((data & 0xf)<<4);
    rGPFDAT = (rGPFDAT & ~(0xf<<4)) | ((~data & 0xf)<<4);    
}


//*************************[ Timer ]********************************
void Timer_Start(int divider)  //0:16us,1:32us 2:64us 3:128us
{
    rWTCON = ((PreScaler )<<8)|(divider<<3);  //Watch-dog timer control register
    rWTDAT = 0xffff;  //Watch-dog timer data register
    rWTCNT = 0xffff;  //Watch-dog count register

      // Watch-dog timer enable & interrupt  disable
    rWTCON = (rWTCON & ~(1<<5) & ~(1<<2)) |(1<<5);
}

//=================================================================
int Timer_Stop(void)
{
    rWTCON = ((PreScaler )<<8);
    return (0xffff - rWTCNT);
}


//*************************[ MPLL ]*******************************
void ChangeMPllValue(int mdiv,int pdiv,int sdiv)
{
    rMPLLCON = (mdiv<<12) | (pdiv<<4) | sdiv;
}


//************************[ HCLK, PCLK ]***************************
/*
// for 2410.
void ChangeClockDivider(int hdivn,int 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();
}
*/
// Modified for 2440.
void ChangeClockDivider(int hdivn_val,int pdivn_val)
{
	int hdivn=2, pdivn=0;
	
     // hdivn_val (FCLK:HCLK)ratio hdivn
     // 11           1:1       (0)
     // 12           1:2       (1)
     // 13           1:3       (3) 
     // 14           1:4       (2)
     // pdivn_val (HCLK:PCLK)ratio pdivn
     // 11           1:1       (0)
     // 12           1:2       (1)
	switch(hdivn_val) {
		case 11: hdivn=0; break;
		case 12: hdivn=1; break;
		case 13: hdivn=3; break;
		case 14: hdivn=2; break;
	}
	
	switch(pdivn_val) {
		case 11: pdivn=0; break;
		case 12: pdivn=1; break;
	}
	
	//Uart_Printf("Clock division change [hdiv:%x, pdiv:%x]\n", hdivn, pdivn);
    rCLKDIVN = (hdivn<<1) | pdivn;

    if(hdivn!=0)
        MMU_SetAsyncBusMode();
	/* else 
		MMU_SetFastBusMode();
	*/
}



//**************************[ UPLL ]*******************************
void ChangeUPllValue(int mdiv,int pdiv,int sdiv)
{
    rUPLLCON = (mdiv<<12) | (pdiv<<4) | sdiv;
}




void Max1718_Set(int voltage)
{

     int vtg;
	//////////////////////////////////////////////
	 //   D4  D3  D2  D1  D0
	 //	0	1	 0 	0	0		// 1.35V
	 //	0	1	 0 	0	1		// 1.30V
	 //	0	1	 0 	1	0		// 1.25V
	 //	0	1	 0 	1	1		// 1.20V
	 //	0	1	 1 	0	0		// 1.15V
	 //	0	1	 1 	0	1		// 1.10V
	 //	0	1	 1 	1	0		// 1.05V
	 //	0	1	 1 	1	1		// 1.00V
	 //	1	0	 0 	0	1		// 0.95V
	 //	1	0	 0 	1	1		// 0.90V
	 //	1	0	 1 	0	1		// 0.85V
	 //	1	0	 1 	1	1		// 0.80V
	 
    vtg=voltage;
     switch (vtg)
	{
	/*
	case 135:
		rGPBDAT=(rGPBDAT&0x77f)|(0<<7);	//D4
		rGPFDAT=(rGPFDAT&0x0f)|(1<<7)|(0<<6)|(0<<5)|(0<<4);	//D3~0
	break;
	
	
	case 125:
		rGPBDAT=(rGPBDAT&0x77f)|(0<<7);    //D4
		rGPFDAT=(rGPFDAT&0x0f)|(1<<7)|(0<<6)|(1<<5)|(0<<4); //D3~0
	break;*/
	
	case 130:
		rGPBDAT=(rGPBDAT&0x77f)|(0<<7);	//D4
		rGPFDAT=(rGPFDAT&0x0f)|(1<<7)|(0<<6)|(0<<5)|(1<<4); //D3~0
		break;
		
	case 120:
		rGPBDAT=(rGPBDAT&0x77f)|(0<<7);	//D4
		rGPFDAT=(rGPFDAT&0x0f)|(1<<7)|(0<<6)|(1<<5)|(1<<4); //D3~0
	break;
/*
	case 115:
		rGPBDAT=(rGPBDAT&0x77f)|(0<<7);	//D4
		rGPFDAT=(rGPFDAT&0x0f)|(1<<7)|(1<<6)|(0<<5)|(0<<4); //D3~0
	break;
*/
	case 110:
		rGPBDAT=(rGPBDAT&0x77f)|(0<<7);	//D4
		rGPFDAT=(rGPFDAT&0x0f)|(1<<7)|(1<<6)|(0<<5)|(1<<4); //D3~0
	break;
/*
	case 105:
		rGPBDAT=(rGPBDAT&0x77f)|(0<<7);	//D4
		rGPFDAT=(rGPFDAT&0x0f)|(1<<7)|(1<<6)|(1<<5)|(0<<4); //D3~0
	break;

	case 100:
		rGPBDAT=(rGPBDAT&0x77f)|(0<<7);	//D4
		rGPFDAT=(rGPFDAT&0x0f)|(1<<7)|(1<<6)|(1<<5)|(1<<4); //D3~0
	break;
	*/
/*
	case 95:
		rGPBDAT=(rGPBDAT&0x77f)|(1<<7);	//D4
		rGPFDAT=(rGPFDAT&0x0f)|(0<<7)|(0<<6)|(0<<5)|(1<<4); //D3~0
	break;

	case 90:
		rGPBDAT=(rGPBDAT&0x77f)|(1<<7);	//D4
		rGPFDAT=(rGPFDAT&0x0f)|(0<<7)|(0<<6)|(1<<5)|(1<<4); //D3~0
	break;

	case 85:
		 rGPBDAT=(rGPBDAT&0x77f)|(1<<7);	//D4
		 rGPFDAT=(rGPFDAT&0x0f)|(0<<7)|(1<<6)|(0<<5)|(1<<4); //D3~0
	break;

    case 80:
		rGPBDAT=(rGPBDAT&0x77f)|(1<<7);    //D4
	   rGPFDAT=(rGPFDAT&0x0f)|(0<<7)|(1<<6)|(1<<5)|(1<<4); //D3~0
	break;
*/
	default:	// 1.2V
		rGPBDAT=(rGPBDAT&0x77f)|(0<<7);	//D4
		rGPFDAT=(rGPFDAT&0x0f)|(1<<7)|(0<<6)|(1<<5)|(1<<4); //D3~0
	break;

		
	}
	 
	
	 rGPBCON=(rGPBCON&0x3f3fff)|(1<<14);	// GPB7: Output
	
	 rGPFCON=(rGPFCON&0x00ff)|(0x5500);  // GPF4~7: Output 
	
		  
	 rGPBDAT&=~(1<<8);   //Latch enable
	 rGPBCON=(rGPBCON&0x3cffff)|(1<<16);	// GPB8: Output
	
	 rGPBDAT|=(1<<10);   //Output enable
	 rGPBCON=(rGPBCON&0x0fffff)|(1<<20);	// GPB10: Output
		
	 rGPBDAT|=(1<<8);	//Latch disable


}