LCD display text function-ARM system-2440

/*

* LCD displays Chinese characters

*Input parameters:

* x: starting position horizontal coordinate

* y: starting position ordinate

* color: font color

* ch[]: text

*

*/

void Draw_Text16(int x, int y, int color, const unsigned char ch[])  

{  

    unsigned short i, j ;  

    unsigned char mask, tem;  

    for(i=0; i<16; i++)  

    {  

        mask = 0x80 ;  

        tem = ch[i*2] ; //Two bytes in a group of 16 bits, take the first byte  

        for(j=0; j<8; j++)  

        {  

            if(term & mask)  

            {  

                PutPixel(x+j, y+i, color);  

            }  

            mask = mask >> 1 ;  

        }   

        mask = 0x80 ;  

        tem = ch[i*2 + 1] ;  

        for(j=0; j<8; j++)  

        {  

            if(term & mask)  

            {  

                PutPixel(x+j+8, y+i, color);  

            }  

            mask = mask >> 1 ;  

        }  

    }  

} 

/* 

 * Draw a dot

 * Input parameters:

 * x, y: pixel coordinates

 * color: color value

 * For 16BPP: color format is 0xAARRGGBB (AA = transparency),

 * Need to be converted to 5:6:5 format

 * For 8BPP: color is the index value in the palette,

 * Its color depends on the value in the palette

 */

void PutPixel(UINT32 x, UINT32 y, UINT32 color)

{

    UINT8 red,green,blue;

    switch (bpp){

        case 16:

        {

            UINT16 *addr = (UINT16 *)fb_base_addr + (y * xsize + x);

            red = (color >> 19) & 0x1f;

            green = (color >> 10) & 0x3f;

            blue = (color >> 3) & 0x1f;

            color = (red << 11) | (green << 5) | blue; // format 5:6:5

            *addr = (UINT16) color;

            break;

        }

        case 8:

        {

            UINT8 *addr = (UINT8 *)fb_base_addr + (y * xsize + x);

            *addr = (UINT8) color;

            break;

        }

        default:

            break;

    }

}