📄 2440lib.c
字号:
{
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(whichUart==1)
{
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;
}
else if(whichUart==2)
{
if(data=='\n')
{
while(!(rUTRSTAT2 & 0x2));
Delay(10); //because the slow response of hyper_terminal
rUTXH2 = '\r';
}
while(!(rUTRSTAT2 & 0x2)); //Wait until THR is empty.
Delay(10);
rUTXH2 = data;
}
}
//====================================================================
void Uart_SendString(char *pt)
{
while(*pt)
Uart_SendByte(*pt++);
}
#if !USE_MAIN
//If you don't use vsprintf(), the code size is reduced very much.
void Uart_Printf(const 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 = ((PCLK/1000000-1)<<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 = ((PCLK/1000000-1)<<8);
return (0xffff - rWTCNT);
}
//*************************[ MPLL ]*******************************
void ChangeMPllValue(int mdiv,int pdiv,int sdiv)
{
//Led_Display(0x8);
rMPLLCON = (mdiv<<12) | (pdiv<<4) | sdiv;
//Led_Display(0x0);
}
//************************[ 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:
case 16: hdivn=3; break;
case 14:
case 18: 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;
//Uart_Printf("rCLKDIVN:%x]\n", rCLKDIVN);
switch(hdivn_val) {
case 16: // when 1, HCLK=FCLK/6.
rCAMDIVN = (rCAMDIVN & ~(3<<8)) | (1<<8);
break;
case 18: // when 1, HCLK=FCLK/8.
rCAMDIVN = (rCAMDIVN & ~(3<<8)) | (1<<9);
break;
}
//Uart_Printf("rCAMDIVN:%x]\n", rCAMDIVN);
if(hdivn!=0)
MMU_SetAsyncBusMode();
else
MMU_SetFastBusMode();
}
//**************************[ UPLL ]*******************************
void ChangeUPllValue(int mdiv,int pdiv,int sdiv)
{
rUPLLCON = (mdiv<<12) | (pdiv<<4) | sdiv;
}
//*************************[ General Library ]**********************
#if 0//!USE_MAIN
void * malloc(unsigned nbyte)
//Very simple; Use malloc() & free() like Stack
//void *mallocPt=Image$$RW$$Limit;
{
void *returnPt = mallocPt;
mallocPt = (int *)mallocPt+nbyte/4+((nbyte%4)>0); //To align 4byte
if( (int)mallocPt > HEAPEND )
{
mallocPt = returnPt;
return NULL;
}
return returnPt;
}
//-------------------------------------------------------------------
void free(void *pt)
{
mallocPt = pt;
}
#endif
void ChangeSromParameter(char bank, char minacc) // only for Tacc
{
int acc;
//1000000/(hclk/1000000.)=Unit Period(ns)*1000
acc = (int)(minacc*(HCLK/1000000.)/1000+0.5);
if(acc<=1)
acc=0;
else if(acc==2)
acc=1;
else if(acc==3)
acc=2;
else if(acc==4)
acc=3;
else if((5<acc)&&(acc<=6))
acc=4;
else if((7<acc)&&(acc<=8))
acc=5;
else if((9<acc)&&(acc<=10))
acc=6;
else if(11<acc)
acc=7;
switch(bank)
{
case 0 : rBANKCON0 |= (acc<<8); break;
case 1 : rBANKCON1 |= (acc<<8); break;
case 2 : rBANKCON2 |= (acc<<8); break;
case 3 : rBANKCON3 |= (acc<<8); break;
case 4 : rBANKCON4 |= (acc<<8); break;
case 5 : rBANKCON5 |= (acc<<8); break;
}
}
// each timing parameter's unit is nano second..
void ChangeSdramParameter(char bank_num, int minrc, int minrcd, int minrp, int refresh, int col_addr, int cl, char banksize)
{
int rc, rcd, rp, rcnt, scan;
//1000000/(hclk/1000000.)=Unit Period(ns)*1000
rc = (int)(minrc*(HCLK/1000000.)/1000+0.5)-4;
rcd = (int)(minrcd*(HCLK/1000000.)/1000+0.5)-2;
rp = (int)(minrp*(HCLK/1000000.)/1000+0.5)-2;
rcnt = (int)(2048+1-(HCLK/1000000.)*(refresh/1000.)+0.5);
scan = col_addr-8;
if (rc<0) rc=0; if (rc>3) rc = 3;
if (rcd<0) rcd=0; if (rcd>2) rcd = 2;
if (rp<0) rp=0; if (rp>2) rp = 2;
if (cl==1) cl = 0;
switch(banksize)
{
case 2 : banksize = 4; break;
case 4 : banksize = 5; break;
case 8 : banksize = 6; break;
case 16 : banksize = 7; break;
case 32 : banksize = 0; break;
case 64 : banksize = 1; break;
default : banksize = 2; break; // 128MB/128MB
}
// Uart_Printf("rc=%d, rcd=%d, rp=%d, rcnt=%d, scan=%d, cl=%d, banksize=%d\n", rc, rcd, rp, rcnt, scan, cl, banksize);
switch(bank_num)
{
case 0:
case 6:
default:
rBANKCON6 = ( rBANKCON6 & ~((3<<15)|(0xf<<0)) ) | (3<<15)|(rcd<<2)|(scan); // SDRAM, Trcd, column address number
rMRSRB6 = (rMRSRB6 & ~(3<<4)) | (cl<<4);
break;
case 1:
case 7: // bank 7
rBANKCON7 = ( rBANKCON7 & ~((3<<15)|(0xf<<0)) ) | (3<<15)|(rcd<<2)|(scan); // SDRAM, Trcd, column address number
rMRSRB7 = (rMRSRB7 & ~(3<<4)) | (cl<<4);
break;
}
rREFRESH = (rREFRESH & ~(0x3f<<18)) | (1<<23)|(0<<22)|(rp<<20)|(rc<<18)|(rcnt); // refresh enable, auto refresh, Trp, Trc, Refresh counter
rBANKSIZE = (rBANKSIZE & ~(7<<0)) | (banksize); // SCLK power save mode, 128/128 bank
}
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;
rGPBCON = (rGPBCON&~((3<<20) |(3<<16) |(3<<14))) | (1<<20) | (1<<16) | (1<<14);
// GPB7, 8, 10 : Output
rGPFCON=(rGPFCON&~(0xff<<8))|(0x55<<8); // GPF4~7: Output , shared with LED4~7
switch (vtg)
{
case 135:
rGPBDAT=(rGPBDAT&~(1<<7)) |(0<<7); //D4
rGPFDAT=(rGPFDAT&~(0xf<<4))|(1<<7)|(0<<6)|(0<<5)|(0<<4); //D3~0
break;
case 130:
rGPBDAT=(rGPBDAT&~(1<<7)) |(0<<7); //D4
rGPFDAT=(rGPFDAT&~(0xf<<4))|(1<<7)|(0<<6)|(0<<5)|(1<<4); //D3~0
break;
case 125:
rGPBDAT=(rGPBDAT&~(1<<7)) |(0<<7); //D4
rGPFDAT=(rGPFDAT&~(0xf<<4))|(1<<7)|(0<<6)|(1<<5)|(0<<4); //D3~0
break;
case 120:
rGPBDAT=(rGPBDAT&~(1<<7)) |(0<<7); //D4
rGPFDAT=(rGPFDAT&~(0xf<<4))|(1<<7)|(0<<6)|(1<<5)|(1<<4); //D3~0
break;
case 115:
rGPBDAT=(rGPBDAT&~(1<<7)) |(0<<7); //D4
rGPFDAT=(rGPFDAT&~(0xf<<4))|(1<<7)|(1<<6)|(0<<5)|(0<<4); //D3~0
break;
case 110:
rGPBDAT=(rGPBDAT&~(1<<7)) |(0<<7); //D4
rGPFDAT=(rGPFDAT&~(0xf<<4))|(1<<7)|(1<<6)|(0<<5)|(1<<4); //D3~0
break;
case 105:
rGPBDAT=(rGPBDAT&~(1<<7)) |(0<<7); //D4
rGPFDAT=(rGPFDAT&~(0xf<<4))|(1<<7)|(1<<6)|(1<<5)|(0<<4); //D3~0
break;
case 100:
rGPBDAT=(rGPBDAT&~(1<<7)) |(0<<7); //D4
rGPFDAT=(rGPFDAT&~(0xf<<4))|(1<<7)|(1<<6)|(1<<5)|(1<<4); //D3~0
break;
case 95:
rGPBDAT=(rGPBDAT&~(1<<7)) |(1<<7); //D4
rGPFDAT=(rGPFDAT&~(0xf<<4))|(0<<7)|(0<<6)|(0<<5)|(1<<4); //D3~0
break;
case 90:
rGPBDAT=(rGPBDAT&~(1<<7)) |(1<<7); //D4
rGPFDAT=(rGPFDAT&~(0xf<<4))|(0<<7)|(0<<6)|(1<<5)|(1<<4); //D3~0
break;
case 85:
rGPBDAT=(rGPBDAT&~(1<<7)) |(1<<7); //D4
rGPFDAT=(rGPFDAT&~(0xf<<4))|(0<<7)|(1<<6)|(0<<5)|(1<<4); //D3~0
break;
case 80:
rGPBDAT=(rGPBDAT&~(1<<7)) |(1<<7); //D4
rGPFDAT=(rGPFDAT&~(0xf<<4))|(0<<7)|(1<<6)|(1<<5)|(1<<4); //D3~0
break;
default: // 1.2V
rGPBDAT=(rGPBDAT&~(1<<7)) |(0<<7); //D4
rGPFDAT=(rGPFDAT&~(0xf<<4))|(1<<7)|(0<<6)|(1<<5)|(1<<4); //D3~0
break;
}
rGPBDAT&=~(1<<8); //Latch enable
rGPBDAT|=(1<<10); //Output enable
rGPBDAT|=(1<<8); //Latch disable
}
int change(char *string,int lastIndex)
{
int j,i = pow(10,lastIndex);
int sum = 0;
for(j=0;j <=lastIndex; j++)
{
sum = sum + (*string - 0x30)*i;
i = i / 10;
string++;
}
return sum;
}
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -