func.c

ARM9（S3C2410）的TFTLCD控制器原码

#include "def.h"
#include "2410addr.h"
#include "func.h"
#include "2410slib.h"

#include <stdarg.h>
#include <stdio.h>

//#define DEBUG

/*********************************************************************************************************************************/
/******************************************************   系统初始化子程序   *****************************************************/

/*系统时钟初始化*/
void SysCLK_Init(void)
{
	rCLKDIVN=0x03;			/*设置HCLK=FCLK/2，PCLK=HCLK/2  */
    if(rCLKDIVN&0x02)
        MMU_SetAsyncBusMode();
    else 
        MMU_SetFastBusMode();	

	rMPLLCON=(0xa1<<12) | (0x3<<4) | 0x1;    /*设置MPLL输出为202.8MHz*/
	rCLKCON=0x7fff0;		/*使能所有外围部件时钟，其实0x7fff0是复位值*/
}

/* I/O口初始化*/
void IO_Port_Init(void)
{
    rGPACON = 0x7fffff; 

    rGPBCON = 0x044555;
    rGPBUP  = 0x7ff;     

    rGPCCON = 0xaaaaaaaa;       
    rGPCUP  = 0xffff;    

    rGPDCON = 0xaaaaaaaa;       
    rGPDUP  = 0xffff;    

    rGPECON = 0xaaaaaaaa;       
    rGPEUP  = 0xffff;    

    rGPFCON = 0x55aa;
    rGPFUP  = 0xff;     

    rGPGCON = 0xff95ffba;
    rGPGUP  = 0xffff;   

    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] 外部中断下降沿触发

}

/*延时子程序*/
static int delayLoopCount = 202800000/10000/10;

void Delay(int time)
{
      // time=0: adjust the Delay function by WatchDog timer.
      // time>0: the number of loop time
      // resolution of time is 100us.
    int i,adjust=0;
    if(time==0)
    {
        time   = 200;
        adjust = 1;
        delayLoopCount = 400;
            //PCLK/1M,Watch-dog disable,1/64,interrupt disable,reset disable
        rWTCON = ((101400000/1000000-1)<<8)|(2<<3); 
        rWTDAT = 0xffff;                              //for first update
        rWTCNT = 0xffff;                              //resolution=64us @any PCLK 
        rWTCON = ((101400000/1000000-1)<<8)|(2<<3)|(1<<5); //Watch-dog timer start
    }
    for(;time>0;time--)
        for(i=0;i<delayLoopCount;i++);
    if(adjust==1)
    {
        rWTCON = ((101400000/1000000-1)<<8)|(2<<3);   //Watch-dog timer stop
        i = 0xffff - rWTCNT;                     //1count->64us, 200*400 cycle runtime = 64*i us
        delayLoopCount = 8000000/(i*64);         //200*400:64*i=1*x:100 -> x=80000*100/(64*i)   
    }
}



/*按键I/O口初始化*/
void KEY_PORT_Init(void)
{
	rGPFCON=rGPFCON&0xffc0;   /*设置I/O口的GPF0,GPF1,GPF2为输入*/
	rGPFUP=0xffff;
	
	rGPGCON=rGPGCON&0xfffff3ff;	/*设置I/O口的GPG5为输入*/
	rGPGUP=0xffff;
}


/*********************************************************************************************************************************/
/********************************************************   UART子程序   *********************************************************/

volatile U8 RBuff[256];    

/* UART初始化 */
void UART_Init(void)
{
	rGPHCON=rGPHCON & (~(0x00f0));
	rGPHCON=rGPHCON | (0x00a0);
	rGPHUP=0xffff;

	rULCON0=0x03;           /*设置UART0传输模式：8位数据，一位停止位，无奇偶位*/
	rUCON0=0x0245;          /*设置UART0工作模式：串口时钟，中断OR DMA方式等等*/
	rUFCON0=0x0;            /*禁止FIFO*/
	rUMCON0=0x0;			/*禁止Auto Flow Control(AFC)*/
	rUBRDIV0=( (int)(50700000/16./115200+0.5) -1 );    /*设置UART0的波特率为115200bps */
}

/* UART接收一个字节数据 */
char Uart_Getch(void)
{
    while(!(rUTRSTAT0 & 0x1)); //Receive data ready
    return RdURXH0();
}

/* UART发送一个字节数据 */
void Uart_SendByte(int data)
{
	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);
    rUTXH0=data;
}  

/* UART发送字符串 */
void Uart_SendString(char *pt)
{
    while(*pt)
        Uart_SendByte(*pt++);
}


/* UART格式化输出 */
//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);
}



/*********************************************************************************************************************************/
/********************************************************   LCD子程序   **********************************************************/
//volatile unsigned short LCD_BUFFER[SCR_ySIZE][SCR_xSIZE];
U32 vLCDBANK;
U32 vLCDBASEU;
U32 vLCDBASEL;
U8  vPWREN;
U16 (* volatile LCD_BUFFER)[SCR_xSIZE];

BITMAPFILEHEADER bmfh;
BITMAPINFOHEADER bmih;

int BMP_Displayed;

/* LCD初始化 */
void LCD_Init(void)
{
	//初始化LCD Port
	rGPCCON=rGPCCON & (~(0xffffffff));  
	rGPCCON=rGPCCON | (0xaaaaaaaa);
	rGPCUP=0xffff;
	rGPDCON=rGPDCON & (~(0xffffffff));
	rGPDCON=rGPDCON | (0xaaaaaaaa);
	rGPDUP=0xffff;
	Uart_Printf("Initializing GPIO ports Complete.\n");
	
	//初始化LCD Register
	LCD_BUFFER=(U16 (*)[SCR_xSIZE])LCDFRAMEBUFFER;
	vLCDBANK=(U32)LCD_BUFFER>>22;
	vLCDBASEU=(((U32)LCD_BUFFER)&0x3fffff)>>1;
	vLCDBASEL=(U32)vLCDBASEU+(PAGEWIDTH+OFFSIZE)*(LINEVAL+1);
	
	rLCDCON1=(CLKVAL<<8)|(MMODE<<7)|(0x3<<5)|(BPPMODE<<1)|(0);
	rLCDCON2=(VBPD<<24)|(LINEVAL<<14)|(VFPD<<6)|(VSPW);
	rLCDCON3=(HBPD<<19)|(HOZVAL<<8)|(HFPD);
	rLCDCON4=(MVAL<<8)|(HSPW);
	rLCDCON5=(BPP24BL<<12)|(FRM565<<11)|(INVVCLK<<10)|(INVVLINE<<9)|(INVVFRAME<<8)|(INVVD<<7)\
				|(INVVDEN<<6)|(INVPWREN<<5)|(INVLEND<<4)|(vPWREN<<3)|(ENLEND<<2)|(BSWP<<1)|(HWSWP);
	rLCDSADDR1=(vLCDBANK<<21)|(vLCDBASEU);
	rLCDSADDR2=vLCDBASEL;
	rLCDSADDR3=(OFFSIZE<<11)|(PAGEWIDTH);
	TPAL_TurnOnOff(1,0xff00ff);
	Lcd_EnvidOnOff(1);
	rLCDINTMSK=(FIWSEL<<2)|(INT_FrSyn)<<1|(INT_FiCnt);    // 屏蔽LCD中断
	rLPCSEL=rLPCSEL & (~0x7);

	#ifdef DEBUG
    	Uart_Printf( "rLCDSADDR1=0x%x\n", rLCDSADDR1 );
    	Uart_Printf( "rLCDSADDR2=0x%x\n", rLCDSADDR2 );
    	Uart_Printf( "rLCDSADDR3=0x%x\n\n", rLCDSADDR3 );
	#endif	


}

/* LCD视频和控制信号输出或者停止，1开启视频输出 */
void Lcd_EnvidOnOff(int onoff)
{
    if(onoff==1)
		rLCDCON1|=1; // ENVID=ON
    else
		rLCDCON1 =rLCDCON1 & 0x3fffe; // ENVID Off
}

void TPAL_TurnOnOff(U8 TPALEN,U32 vTPALVAL)
{
	if(TPALEN==1)
		rTPAL=(1<<24)|(vTPALVAL&0xffffff);
	else
		rTPAL=(0<<24)|(vTPALVAL&0xffffff);
}


/* 填充矩形*/
void Glib_FilledRectangle(int x1,int y1,int x2,int y2,int color)
{
    int i;

    for(i=y1;i<=y2;i++)
	Glib_Line(x1,i,x2,i,color);
}


void PutPixel(U32 x,U32 y,U32 c)
{
	if ( (x < SCR_xSIZE) && (y < SCR_ySIZE) )
	LCD_BUFFER[(y)][(x)] = c;
}



/* 画线*/
void Glib_Line(int x1,int y1,int x2,int y2,int color)
{
	int dx,dy,e;
	dx=x2-x1; 
	dy=y2-y1;
    
	if(dx>=0)
	{
		if(dy >= 0) // dy>=0
		{
			if(dx>=dy) // 1/8 octant
			{
				e=dy-dx/2;
				while(x1<=x2)
				{
					PutPixel(x1,y1,color);
					if(e>0){y1+=1;e-=dx;}	
					x1+=1;
					e+=dy;
				}
			}
			else		// 2/8 octant
			{
				e=dx-dy/2;
				while(y1<=y2)
				{
					PutPixel(x1,y1,color);
					if(e>0){x1+=1;e-=dy;}	
					y1+=1;
					e+=dx;
				}
			}
		}
		else		   // dy<0
		{
			dy=-dy;   // dy=abs(dy)

			if(dx>=dy) // 8/8 octant
			{
				e=dy-dx/2;
				while(x1<=x2)
				{
					PutPixel(x1,y1,color);
					if(e>0){y1-=1;e-=dx;}	
					x1+=1;
					e+=dy;
				}
			}
			else		// 7/8 octant
			{
				e=dx-dy/2;
				while(y1>=y2)
				{
					PutPixel(x1,y1,color);
					if(e>0){x1+=1;e-=dy;}	
					y1-=1;
					e+=dx;
				}
			}
		}	
	}
	else //dx<0
	{
		dx=-dx;		//dx=abs(dx)
		if(dy >= 0) // dy>=0
		{
			if(dx>=dy) // 4/8 octant
			{
				e=dy-dx/2;
				while(x1>=x2)
				{
					PutPixel(x1,y1,color);
					if(e>0){y1+=1;e-=dx;}	
					x1-=1;
					e+=dy;
				}
			}
			else		// 3/8 octant
			{
				e=dx-dy/2;
				while(y1<=y2)
				{
					PutPixel(x1,y1,color);
					if(e>0){x1-=1;e-=dy;}	
					y1+=1;
					e+=dx;
				}
			}
		}
		else		   // dy<0
		{
			dy=-dy;   // dy=abs(dy)

			if(dx>=dy) // 5/8 octant
			{
				e=dy-dx/2;
				while(x1>=x2)
				{
					PutPixel(x1,y1,color);
					if(e>0){y1-=1;e-=dx;}	
					x1-=1;
					e+=dy;
				}
			}
			else		// 6/8 octant
			{
				e=dx-dy/2;