firmware/target/arm/as3525/sansa-e200v2/lcd-e200v2.c

   1 /***************************************************************************
   2  *             __________               __   ___.
   3  *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
   4  *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
   5  *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
   6  *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
   7  *                     \/            \/     \/    \/            \/
   8  * $Id$
   9  *
  10  * Copyright (C) 2004 by Linus Nielsen Feltzing
  11  *
  12  * This program is free software; you can redistribute it and/or
  13  * modify it under the terms of the GNU General Public License
  14  * as published by the Free Software Foundation; either version 2
  15  * of the License, or (at your option) any later version.
  16  *
  17  * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
  18  * KIND, either express or implied.
  19  *
  20  ****************************************************************************/
  21 #include "config.h"
  22
  23 #include "cpu.h"
  24 #include "lcd.h"
  25 #include "file.h"
  26 #include "debug.h"
  27 #include "system.h"
  28 #include "clock-target.h"
  29 #include "dbop-as3525.h"
  30
  31 /* The controller is unknown, but some registers appear to be the same as the
  32    HD66789R */
  33 static bool display_on = false; /* is the display turned on? */
  34
  35 /* register defines */
  36 #define R_START_OSC             0x00
  37 #define R_DRV_OUTPUT_CONTROL    0x01
  38 #define R_DRV_WAVEFORM_CONTROL  0x02
  39 #define R_ENTRY_MODE            0x03
  40 #define R_COMPARE_REG1          0x04
  41 #define R_COMPARE_REG2          0x05
  42
  43 #define R_DISP_CONTROL1     0x07
  44 #define R_DISP_CONTROL2     0x08
  45 #define R_DISP_CONTROL3     0x09
  46
  47 #define R_FRAME_CYCLE_CONTROL 0x0b
  48 #define R_EXT_DISP_IF_CONTROL 0x0c
  49
  50 #define R_POWER_CONTROL1    0x10
  51 #define R_POWER_CONTROL2    0x11
  52 #define R_POWER_CONTROL3    0x12
  53 #define R_POWER_CONTROL4    0x13
  54
  55 #define R_RAM_ADDR_SET  0x21
  56 #define R_WRITE_DATA_2_GRAM 0x22
  57
  58 #define R_GAMMA_FINE_ADJ_POS1   0x30
  59 #define R_GAMMA_FINE_ADJ_POS2   0x31
  60 #define R_GAMMA_FINE_ADJ_POS3   0x32
  61 #define R_GAMMA_GRAD_ADJ_POS    0x33
  62
  63 #define R_GAMMA_FINE_ADJ_NEG1   0x34
  64 #define R_GAMMA_FINE_ADJ_NEG2   0x35
  65 #define R_GAMMA_FINE_ADJ_NEG3   0x36
  66 #define R_GAMMA_GRAD_ADJ_NEG    0x37
  67
  68 #define R_GAMMA_AMP_ADJ_RES_POS     0x38
  69 #define R_GAMMA_AMP_AVG_ADJ_RES_NEG 0x39
  70
  71 #define R_GATE_SCAN_POS         0x40
  72 #define R_VERT_SCROLL_CONTROL   0x41
  73 #define R_1ST_SCR_DRV_POS       0x42
  74 #define R_2ND_SCR_DRV_POS       0x43
  75 #define R_HORIZ_RAM_ADDR_POS    0x44
  76 #define R_VERT_RAM_ADDR_POS     0x45
  77
  78 /* Flip Flag */
  79 #define R_ENTRY_MODE_HORZ_NORMAL 0x7030
  80 #define R_ENTRY_MODE_HORZ_FLIPPED 0x7000
  81 static unsigned short r_entry_mode = R_ENTRY_MODE_HORZ_NORMAL;
  82 #define R_ENTRY_MODE_VERT 0x7038
  83 #define R_ENTRY_MODE_SOLID_VERT  0x1038
  84 #define R_ENTRY_MODE_VIDEO_NORMAL 0x7020
  85 #define R_ENTRY_MODE_VIDEO_FLIPPED 0x7010
  86
  87
  88 /* Reverse Flag */
  89 #define R_DISP_CONTROL_NORMAL 0x0004
  90 #define R_DISP_CONTROL_REV    0x0000
  91 static unsigned short r_disp_control_rev = R_DISP_CONTROL_NORMAL;
  92
  93 static inline void lcd_delay(int x)
  94 {
  95     do {
  96         asm volatile ("nop\n");
  97     } while (x--);
  98 }
  99
 100 static void as3525_dbop_init(void)
 101 {
 102     CGU_DBOP = (1<<3) | AS3525_DBOP_DIV;
 103
 104     DBOP_TIMPOL_01 = 0xe167e167;
 105     DBOP_TIMPOL_23 = 0xe167006e;
 106
 107     /* short count: 16 | output data width: 16 | readstrobe line */
 108     DBOP_CTRL = (1<<18|1<<12|1<<3);
 109
 110     GPIOB_AFSEL = 0xfc;
 111     GPIOC_AFSEL = 0xff;
 112
 113     DBOP_TIMPOL_23 = 0x6000e;
 114
 115     /* short count: 16|enable write|output data width: 16|read strobe line */
 116     DBOP_CTRL = (1<<18|1<<16|1<<12|1<<3);
 117     DBOP_TIMPOL_01 = 0x6e167;
 118     DBOP_TIMPOL_23 = 0xa167e06f;
 119
 120     /* TODO: The OF calls some other functions here, but maybe not important */
 121 }
 122
 123 static void lcd_write_value16(unsigned short value)
 124 {
 125     DBOP_CTRL &= ~(1<<14|1<<13);
 126     lcd_delay(10);
 127     DBOP_DOUT16 = value;
 128     while ((DBOP_STAT & (1<<10)) == 0);
 129 }
 130
 131 static void lcd_write_cmd(int cmd)
 132 {
 133     /* Write register */
 134     DBOP_TIMPOL_23 = 0xa167006e;
 135     lcd_write_value16(cmd);
 136
 137     /* Wait for fifo to empty */
 138     while ((DBOP_STAT & (1<<10)) == 0);
 139
 140     /* Fuze OF has this loop and it seems to help us now also */
 141     int delay = 8;
 142     while(delay--);
 143
 144     DBOP_TIMPOL_23 = 0xa167e06f;
 145 }
 146
 147 void lcd_write_data(const fb_data* p_bytes, int count)
 148 {
 149     const long *data;
 150     if ((int)p_bytes & 0x3)
 151     {   /* need to do a single 16bit write beforehand if the address is
 152          * not word aligned */
 153         lcd_write_value16(*p_bytes);
 154         count--;p_bytes++;
 155     }
 156     /* from here, 32bit transfers are save
 157      * set it to transfer 4*(outputwidth) units at a time,
 158      * if bit 12 is set it only does 2 halfwords though */
 159     DBOP_CTRL |= (1<<13|1<<14);
 160     data = (long*)p_bytes;
 161     while (count > 1)
 162     {
 163         DBOP_DOUT32 = *data++;
 164         count -= 2;
 165
 166         /* Wait if push fifo is full */
 167         while ((DBOP_STAT & (1<<6)) != 0);
 168     }
 169     /* While push fifo is not empty */
 170     while ((DBOP_STAT & (1<<10)) == 0);
 171
 172     /* due to the 32bit alignment requirement or uneven count,
 173      * we possibly need to do a 16bit transfer at the end also */
 174     if (count > 0)
 175         lcd_write_value16(*(fb_data*)data);
 176 }
 177
 178 static void lcd_write_reg(int reg, int value)
 179 {
 180     fb_data data = value;
 181
 182     lcd_write_cmd(reg);
 183     lcd_write_value16(data);
 184 }
 185
 186 /*** hardware configuration ***/
 187
 188 void lcd_set_contrast(int val)
 189 {
 190     (void)val;
 191 }
 192
 193 void lcd_set_invert_display(bool yesno)
 194 {
 195     r_disp_control_rev = yesno ? R_DISP_CONTROL_REV :
 196                                  R_DISP_CONTROL_NORMAL;
 197
 198     if (display_on)
 199     {
 200         lcd_write_reg(R_DISP_CONTROL1, 0x0033 | r_disp_control_rev);
 201     }
 202
 203 }
 204
 205 static bool display_flipped = false;
 206
 207 /* turn the display upside down  */
 208 void lcd_set_flip(bool yesno)
 209 {
 210     display_flipped = yesno;
 211
 212     r_entry_mode = yesno ? R_ENTRY_MODE_HORZ_FLIPPED :
 213                            R_ENTRY_MODE_HORZ_NORMAL;
 214 }
 215
 216 static void lcd_window(int xmin, int ymin, int xmax, int ymax)
 217 {
 218     if (!display_flipped)
 219     {
 220         lcd_write_reg(R_HORIZ_RAM_ADDR_POS, (xmax << 8) | xmin);
 221         lcd_write_reg(R_VERT_RAM_ADDR_POS,  (ymax << 8) | ymin);
 222         lcd_write_reg(R_RAM_ADDR_SET,       (ymin << 8) | xmin);
 223     }
 224     else
 225     {
 226         lcd_write_reg(R_HORIZ_RAM_ADDR_POS,
 227             ((LCD_WIDTH-1 - xmin) << 8) | (LCD_WIDTH-1 - xmax));
 228         lcd_write_reg(R_VERT_RAM_ADDR_POS,
 229             ((LCD_HEIGHT-1 - ymin) << 8) | (LCD_HEIGHT-1 - ymax));
 230         lcd_write_reg(R_RAM_ADDR_SET,
 231             ((LCD_HEIGHT-1 - ymin) << 8) | (LCD_WIDTH-1 - xmin));
 232     }
 233 }
 234
 235 static void _display_on(void)
 236 {
 237     /* Initialisation the display the same way as the original firmware */
 238
 239     lcd_write_reg(R_START_OSC, 0x0001); /* Start Oscilation */
 240
 241     lcd_write_reg(R_DRV_OUTPUT_CONTROL, 0x011b); /* 220 lines, GS=0, SS=1 */
 242
 243     /* B/C = 1: n-line inversion form
 244      * EOR = 1: polarity inversion occurs by applying an EOR to odd/even
 245      *          frame select signal and an n-line inversion signal.
 246      * FLD = 01b: 1 field interlaced scan, external display iface */
 247     lcd_write_reg(R_DRV_WAVEFORM_CONTROL, 0x0700);
 248
 249     /* Address counter updated in horizontal direction; left to right;
 250      * vertical increment horizontal increment.
 251      * data format for 8bit transfer or spi = 65k (5,6,5) */
 252     lcd_write_reg(R_ENTRY_MODE, r_entry_mode);
 253
 254     /* Replace data on writing to GRAM */
 255     lcd_write_reg(R_COMPARE_REG1, 0);
 256     lcd_write_reg(R_COMPARE_REG2, 0);
 257
 258     /* GON = 0, DTE = 0, D1-0 = 00b */
 259     lcd_write_reg(R_DISP_CONTROL1, 0x0000 | r_disp_control_rev);
 260
 261     /* Front porch lines: 2; Back porch lines: 2; */
 262     lcd_write_reg(R_DISP_CONTROL2, 0x0203);
 263
 264     /* Scan cycle = 0 frames */
 265     lcd_write_reg(R_DISP_CONTROL3, 0x0000);
 266
 267     /* 16 clocks */
 268     lcd_write_reg(R_FRAME_CYCLE_CONTROL, 0x0000);
 269
 270     /* 18-bit RGB interface (one transfer/pixel)
 271      * internal clock operation;
 272      * System interface/VSYNC interface */
 273     lcd_write_reg(R_EXT_DISP_IF_CONTROL, 0x0000);
 274
 275
 276     /* zero everything*/
 277     lcd_write_reg(R_POWER_CONTROL1, 0x0000); /* STB = 0, SLP = 0 */
 278
 279     lcd_delay(10);
 280
 281     /* initialise power supply */
 282
 283     /* DC12-10 = 000b: Step-up1 = clock/8,
 284      * DC02-00 = 000b: Step-up2 = clock/16,
 285      * VC2-0   = 010b: VciOUT = 0.87 * VciLVL */
 286     lcd_write_reg(R_POWER_CONTROL2, 0x0002);
 287
 288     /* VRH3-0 = 1000b: Vreg1OUT = REGP * 1.90 */
 289     lcd_write_reg(R_POWER_CONTROL3, 0x0008);
 290
 291     lcd_delay(40);
 292
 293     lcd_write_reg(R_POWER_CONTROL4, 0x0000); /* VCOMG = 0 */
 294
 295     /* This register is unknown */
 296     lcd_write_reg(0x56, 0x80f);
 297
 298
 299     lcd_write_reg(R_POWER_CONTROL1, 0x4140);
 300
 301     lcd_delay(10);
 302
 303     lcd_write_reg(R_POWER_CONTROL2, 0x0000);
 304     lcd_write_reg(R_POWER_CONTROL3, 0x0013);
 305
 306     lcd_delay(20);
 307
 308     lcd_write_reg(R_POWER_CONTROL4, 0x6d0e);
 309
 310     lcd_delay(20);
 311
 312     lcd_write_reg(R_POWER_CONTROL4, 0x6d0e);
 313
 314     lcd_write_reg(R_GAMMA_FINE_ADJ_POS1, 0x0002);
 315     lcd_write_reg(R_GAMMA_FINE_ADJ_POS2, 0x0707);
 316     lcd_write_reg(R_GAMMA_FINE_ADJ_POS3, 0x0182);
 317     lcd_write_reg(R_GAMMA_GRAD_ADJ_POS, 0x0203);
 318     lcd_write_reg(R_GAMMA_FINE_ADJ_NEG1, 0x0706);
 319     lcd_write_reg(R_GAMMA_FINE_ADJ_NEG2, 0x0006);
 320     lcd_write_reg(R_GAMMA_FINE_ADJ_NEG3, 0x0706);
 321     lcd_write_reg(R_GAMMA_GRAD_ADJ_NEG, 0x0000);
 322     lcd_write_reg(R_GAMMA_AMP_ADJ_RES_POS, 0x030f);
 323     lcd_write_reg(R_GAMMA_AMP_AVG_ADJ_RES_NEG, 0x0f08);
 324
 325
 326     lcd_write_reg(R_GATE_SCAN_POS, 0);
 327     lcd_write_reg(R_VERT_SCROLL_CONTROL, 0);
 328
 329     lcd_window(0, 0, LCD_WIDTH-1, LCD_HEIGHT-1);
 330     lcd_write_reg(R_1ST_SCR_DRV_POS, (LCD_HEIGHT-1) << 8);
 331     lcd_write_reg(R_2ND_SCR_DRV_POS, (LCD_HEIGHT-1) << 8);
 332
 333     lcd_write_reg(R_DISP_CONTROL1, 0x0033 | r_disp_control_rev);
 334
 335     display_on = true;  /* must be done before calling lcd_update() */
 336     lcd_update();
 337 }
 338
 339 void lcd_init_device(void)
 340 {
 341     as3525_dbop_init();
 342
 343     GPIOA_DIR |= (1<<5);
 344     GPIOA_PIN(5) = 0;
 345     GPIOA_PIN(4) = 0;
 346
 347     lcd_delay(1);
 348     GPIOA_PIN(5) = (1<<5);
 349     lcd_delay(1);
 350
 351     _display_on();
 352 }
 353
 354 #if defined(HAVE_LCD_ENABLE)
 355 void lcd_enable(bool on)
 356 {
 357     if (display_on == on)
 358         return;
 359
 360     if(on)
 361     {
 362         _display_on();
 363         send_event(LCD_EVENT_ACTIVATION, NULL);
 364     }
 365     else
 366     {
 367         display_on = false;
 368         lcd_write_reg(R_POWER_CONTROL1, 0x0001);
 369     }
 370 }
 371 #endif
 372
 373 #if defined(HAVE_LCD_ENABLE) || defined(HAVE_LCD_SLEEP)
 374 bool lcd_active(void)
 375 {
 376     return display_on;
 377 }
 378 #endif
 379
 380 /*** update functions ***/
 381
 382 static unsigned lcd_yuv_options = 0;
 383
 384 void lcd_yuv_set_options(unsigned options)
 385 {
 386     lcd_yuv_options = options;
 387 }
 388
 389 static void lcd_window_blit(int xmin, int ymin, int xmax, int ymax)
 390 {
 391     if (!display_flipped)
 392     {
 393         lcd_write_reg(R_HORIZ_RAM_ADDR_POS,
 394             ((LCD_WIDTH-1 - xmin) << 8) | (LCD_WIDTH-1 - xmax));
 395         lcd_write_reg(R_VERT_RAM_ADDR_POS,  (ymax << 8) | ymin);
 396         lcd_write_reg(R_RAM_ADDR_SET,
 397             (ymin << 8) | (LCD_WIDTH-1 - xmin));
 398         }
 399         else
 400     {
 401         lcd_write_reg(R_HORIZ_RAM_ADDR_POS, (xmax << 8) | xmin);
 402         lcd_write_reg(R_VERT_RAM_ADDR_POS,  (ymax << 8) | ymin);
 403         lcd_write_reg(R_RAM_ADDR_SET,       (ymax << 8) | xmin);
 404     }
 405 }
 406
 407 /* Line write helper function for lcd_yuv_blit. Write two lines of yuv420. */
 408 extern void lcd_write_yuv420_lines(unsigned char const * const src[3],
 409                                    int width,
 410                                    int stride);
 411 extern void lcd_write_yuv420_lines_odither(unsigned char const * const src[3],
 412                                    int width,
 413                                    int stride,
 414                                    int x_screen, /* To align dither pattern */
 415                                    int y_screen);
 416
 417 /* Performance function to blit a YUV bitmap directly to the LCD
 418  * src_x, src_y, width and height should be even
 419  * x, y, width and height have to be within LCD bounds
 420  */
 421 void lcd_blit_yuv(unsigned char * const src[3],
 422                   int src_x, int src_y, int stride,
 423                   int x, int y, int width, int height)
 424 {
 425     unsigned char const * yuv_src[3];
 426     off_t z;
 427
 428     /* Sorry, but width and height must be >= 2 or else */
 429     width &= ~1;
 430     height >>= 1;
 431
 432     z = stride*src_y;
 433     yuv_src[0] = src[0] + z + src_x;
 434     yuv_src[1] = src[1] + (z >> 2) + (src_x >> 1);
 435     yuv_src[2] = src[2] + (yuv_src[1] - src[1]);
 436
 437     lcd_write_reg(R_ENTRY_MODE,
 438         display_flipped ? R_ENTRY_MODE_VIDEO_FLIPPED : R_ENTRY_MODE_VIDEO_NORMAL
 439     );
 440
 441     if (lcd_yuv_options & LCD_YUV_DITHER)
 442     {
 443         do
 444         {
 445             lcd_window_blit(y, x, y+1, x+width-1);
 446
 447             lcd_write_cmd(R_WRITE_DATA_2_GRAM);
 448
 449             lcd_write_yuv420_lines_odither(yuv_src, width, stride, x, y);
 450             yuv_src[0] += stride << 1; /* Skip down two luma lines */
 451             yuv_src[1] += stride >> 1; /* Skip down one chroma line */
 452             yuv_src[2] += stride >> 1;
 453             y += 2;
 454         }
 455         while (--height > 0);
 456     }
 457     else
 458     {
 459         do
 460         {
 461             lcd_window_blit(y, x, y+1, x+width-1);
 462
 463             lcd_write_cmd(R_WRITE_DATA_2_GRAM);
 464
 465             lcd_write_yuv420_lines(yuv_src, width, stride);
 466             yuv_src[0] += stride << 1; /* Skip down two luma lines */
 467             yuv_src[1] += stride >> 1; /* Skip down one chroma line */
 468             yuv_src[2] += stride >> 1;
 469             y += 2;
 470         }
 471         while (--height > 0);
 472     }
 473 }
 474
 475 /* Update the display.
 476    This must be called after all other LCD functions that change the display. */
 477 void lcd_update(void)
 478 {
 479     if (!display_on)
 480         return;
 481
 482     lcd_write_reg(R_ENTRY_MODE, r_entry_mode);
 483
 484     /* Set start position and window */
 485     lcd_window(0, 0, LCD_WIDTH-1, LCD_HEIGHT-1);
 486
 487     lcd_write_cmd(R_WRITE_DATA_2_GRAM);
 488
 489     lcd_write_data((fb_data*)lcd_framebuffer, LCD_WIDTH*LCD_HEIGHT);
 490 }
 491
 492 /* Update a fraction of the display. */
 493 void lcd_update_rect(int x, int y, int width, int height)
 494 {
 495     const fb_data *ptr;
 496
 497     if (!display_on)
 498         return;
 499
 500     /* nothing to draw? */
 501     if ((width <= 0) || (height <= 0) || (x >= LCD_WIDTH) ||
 502         (y >= LCD_HEIGHT) || (x + width <= 0) || (y + height <= 0))
 503         return;
 504
 505     if (x < 0)
 506     {   /* clip left */
 507         width += x;
 508         x = 0;
 509     }
 510     if (y < 0)
 511     {   /* clip top */
 512         height += y;
 513         y = 0;
 514     }
 515     if (x + width > LCD_WIDTH)
 516         width = LCD_WIDTH - x; /* clip right */
 517     if (y + height > LCD_HEIGHT)
 518         height = LCD_HEIGHT - y; /* clip bottom */
 519
 520     lcd_write_reg(R_ENTRY_MODE, r_entry_mode);
 521
 522     lcd_window(x, y, x+width-1, y+height-1);
 523     lcd_write_cmd(R_WRITE_DATA_2_GRAM);
 524
 525     ptr = &lcd_framebuffer[y][x];
 526
 527     do
 528     {
 529         lcd_write_data(ptr, width);
 530         ptr += LCD_WIDTH;
 531     }
 532     while (--height > 0);
 533 }