#define LCD_RES_H 320
#define LCD_RES_V 240
#define LCD_BUF_SIZE (LCD_RES_H*LCD_RES_V*2)

unsigned char VideoBuf[LCD_BUF_SIZE] __attribute__((at(NOR_FLASH_BASE))); //SDRAM

void InitLCD()
{
  int i, testnum = 0;
  int k=0;
  unsigned short *Pall = (unsigned short *)&LCD_PAL;
  unsigned short *Vbuf = (unsigned short *)&VideoBuf;
  unsigned short *Curs = (unsigned short *)&CRSR_IMG;
    
    PCONP|= (1<<20); //LCD

    PINSEL11 = (6<<1)|(1<<0);// bit0=1 - LCD port is enabled.    bit1...3 = 110 TFT 16-bit. (1:5:5:5 mode)
  
  LCD_CFG    = 10;//72 MHz div 11
  //1
//  LCD_TIMH   = (((42-1)<<24) | ((67-1)<<16) | ((11-1)<<8) | (((LCD_RES_H/16)-1)<<2));
//  LCD_TIMV   = ((6<<24) | (16<<16) | ((3-1)<<10) | (LCD_RES_V-1));
  //2
  //LCD_TIMH   = (((31-1)<<24) | ((67-1)<<16) | ((11-1)<<8) | (((LCD_RES_H/16)-1)<<2));
  //LCD_TIMV   = ((3<<24) | (16<<16) | ((3-1)<<10) | (LCD_RES_V-1));
  //kartinka posredine
  LCD_TIMH   = (((61-1)<<24) | ((67-1)<<16) | ((11-1)<<8) | (((LCD_RES_H/16)-1)<<2));
  LCD_TIMV   = ((33<<24) | (16<<16) | ((3-1)<<10) | (LCD_RES_V-1));

  LCD_POL    = ((0<<27) | (1<<26) | (((LCD_RES_H/1)-1)<<16) | (0<<14)
                  | (1<<13)| (1<<12) | (1<<11)| (0<<6) | (0<<5) | (2<<0));

  LCD_CTRL   = ((0<<10) | (0<<9) | (0<<8) | (1<<5) | (4<<1)); // 100 = 16 bpp, 1:5:5:5 mode.

  for(i=0; i<256; i++)
      Curs[i] = 0xFFFF;

  CRSR_CFG = 0;
  CRSR_XY = (110<<16)|(160<<0);
  CRSR_CTRL = 1;//Cursor on

  LCD_UPBASE = (unsigned long)VideoBuf;
  LCD_LPBASE = (unsigned long)VideoBuf;    

    
    for(i=0; i<256; i++)//test
    {
        Pall[i] = 0xFF00+i;
    }
                            

  LCD_CTRL |= 1;//Enable
  LCD_CTRL |= 1<<11;//PWR ON

    testnum = 3;
    while(1)
    {
          switch(testnum)
          {
              case 0://bleklie tsveta
              for(i=0; i<(LCD_BUF_SIZE/2); i++)
                  if(i < (LCD_BUF_SIZE/4))
                    Vbuf[i]= (32<<10)|(0<<5)|(0<<0);
                else
                    Vbuf[i]= (0<<10)|(0<<5)|(32<<0);
            testnum = -1;
            break;
        
            case 1://ne vivodit - vse beloe
              for(i=0; i<(LCD_BUF_SIZE/2); i++)
                  if(i < (LCD_BUF_SIZE/4))
                    Vbuf[i]= 0;
                else
                    Vbuf[i]= 0xFFFF;
            testnum = -1;
            break;
        
            case 2://sverhu beloe, vnizu-4ernoe
              for(i=0; i<(LCD_BUF_SIZE/2); i++)
                  if(i < (LCD_BUF_SIZE/4))
                    Vbuf[i]= 0xFFFF;
                else
                    Vbuf[i]= 0;
            testnum = -1;
            break;
        
            case 3://poloski
              for(i=0; i<(LCD_BUF_SIZE/2); i++)
            {
                if((i % (320*20)) == 0)
                    k = rand();
                Vbuf[i]= k;
            }
            testnum = -1;
            break;
        
            case 4://random
              for(i=0; i<(LCD_BUF_SIZE/2); i++)
                Vbuf[i]= rand() & 0xFFFF;
            testnum = -1;
            break;

            default:
            break;
          }
    }

}

// init Horizontal Timing
  LCD_TIMH_bit.HBP   =  C_GLCD_H_BACK_PORCH - 1;
  LCD_TIMH_bit.HFP   =  C_GLCD_H_FRONT_PORCH - 1;
  LCD_TIMH_bit.HSW   =  C_GLCD_H_PULSE - 1;
  LCD_TIMH_bit.PPL   = (C_GLCD_H_SIZE/16) - 1;
  // init Vertical Timing
  LCD_TIMV_bit.VBP   =  C_GLCD_V_BACK_PORCH;
  LCD_TIMV_bit.VFP   =  C_GLCD_V_FRONT_PORCH;
  LCD_TIMV_bit.VSW   =  C_GLCD_V_PULSE;
  LCD_TIMV_bit.LPP   =  C_GLCD_V_SIZE - 1;

*|------------|
  |  курсор   |
  |               |
*|               |
  |----------- |

#define LCD_RES_H 320
#define LCD_RES_V 240
#define LCD_BUF_SIZE (LCD_RES_H*LCD_RES_V*2)

#define LCD_TIMH_HBP    (61-1)    //42-1(ili 31-1 ??) po datasheet na TFT
#define LCD_TIMH_HFP    (67-1)
#define LCD_TIMH_HSW    (11-1)
#define LCD_TIMH_PPL    ((LCD_RES_H/16)-1)

#define LCD_TIMV_VBP    33        //6(ili 3 ??) po datasheet na TFT
#define LCD_TIMV_VFP    16
#define LCD_TIMV_VSW    (3-1)
#define LCD_TIMV_LPP    (LCD_RES_V-1)

#define LCD_POL_BCD        1
#define LCD_POL_CPL        ((LCD_RES_H/1)-1)
#define LCD_POL_IOE        0
#define LCD_POL_IPC        1
#define LCD_POL_IHS        1
#define LCD_POL_IVS        1
#define LCD_POL_CLKSEL     0
#define LCD_POL_PCD_LO    1

#define LCD_CTRL_BEPO    0
#define LCD_CTRL_BEBO    0
#define LCD_CTRL_BGR    0
#define LCD_CTRL_LCDTFT    1
#define LCD_CTRL_LCDBPP    4


unsigned char VideoBuf[LCD_BUF_SIZE] __attribute__((at(NOR_FLASH_BASE))); //SDRAM

void InitLCD()
{
  int i, testnum = 0;
  int k=0;
  unsigned short *Pall = (unsigned short *)&LCD_PAL;
  unsigned short *Vbuf = (unsigned short *)&VideoBuf;
  unsigned short *Curs = (unsigned short *)&CRSR_IMG;
    
    PCONP|= (1<<20); //LCD
    
    PINSEL11 = (6<<1)|(1<<0);// bit0=1 - LCD port is enabled.    bit1...3 = 110 TFT 16-bit. (1:5:5:5 mode)

  //AHBCFG1    = ((0<<0)|(3<<1)|(1<<4)|(3<<4)|(1<<8)|(4<<12)|(3<<16)|(2<<20)|(1<<24)|(5<<28));
  
  LCD_CFG    = 10;//72 MHz div 11

  LCD_TIMH   = (LCD_TIMH_HBP<<24) | (LCD_TIMH_HFP<<16) | (LCD_TIMH_HSW<<8) | (LCD_TIMH_PPL<<2);
  LCD_TIMV   = (LCD_TIMV_VBP<<24) | (LCD_TIMV_VFP<<16) | (LCD_TIMV_VSW<<10) | LCD_TIMV_LPP;

  LCD_POL    = (0<<27) | (LCD_POL_BCD<<26) | (LCD_POL_CPL<<16) | (LCD_POL_IOE<<14)
                  | (LCD_POL_IPC<<13)| (LCD_POL_IHS<<12) | (LCD_POL_IVS<<11)| (0<<6) | (LCD_POL_CLKSEL<<5) | (LCD_POL_PCD_LO<<0);

  LCD_CTRL   = (LCD_CTRL_BEPO<<10) | (LCD_CTRL_BEBO<<9) | (LCD_CTRL_BGR<<8) | (LCD_CTRL_LCDTFT<<5) | (LCD_CTRL_LCDBPP<<1); // 100 = 16 bpp, 1:5:5:5 mode. 011=8bit(palette?);

  for(i=0; i<256; i++)
      Curs[i] = 0xFFFF;

  CRSR_CFG = 0;
  CRSR_XY = (110<<16)|(160<<0);
  CRSR_CTRL = 1;//Cursor on

  LCD_UPBASE = (unsigned long)VideoBuf;
  LCD_LPBASE = (unsigned long)VideoBuf;    

    
    for(i=0; i<256; i++)//test
    {
        Pall[i] = 0xFF00+i;
    }                                                   
  
  LCD_CTRL |= 1;//Enable
  LCD_CTRL |= 1<<11;//PWR ON

...
}