1 /***************************************************************************
3 * Open \______ \ ____ ____ | | _\_ |__ _______ ___
4 * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
5 * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
6 * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
10 * Copyright (C) 2004 by Linus Nielsen Feltzing
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.
17 * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
18 * KIND, either express or implied.
20 ****************************************************************************/
34 #include "clock-target.h"
36 static bool display_on
= false; /* is the display turned on? */
37 static bool display_flipped
= false;
38 /* we need to write a red pixel for correct button reads
39 * (see lcd_button_support()), but that must not happen while the lcd is
40 * updating so block lcd_button_support the during updates */
41 static volatile bool lcd_busy
= false;
43 /* register defines */
44 #define R_START_OSC 0x00
45 #define R_DRV_OUTPUT_CONTROL 0x01
46 #define R_DRV_WAVEFORM_CONTROL 0x02
47 #define R_ENTRY_MODE 0x03
48 #define R_COMPARE_REG1 0x04
49 #define R_COMPARE_REG2 0x05
51 #define R_DISP_CONTROL1 0x07
52 #define R_DISP_CONTROL2 0x08
53 #define R_DISP_CONTROL3 0x09
55 #define R_FRAME_CYCLE_CONTROL 0x0b
56 #define R_EXT_DISP_IF_CONTROL 0x0c
58 #define R_POWER_CONTROL1 0x10
59 #define R_POWER_CONTROL2 0x11
60 #define R_POWER_CONTROL3 0x12
61 #define R_POWER_CONTROL4 0x13
63 #define R_RAM_ADDR_SET 0x21
64 #define R_WRITE_DATA_2_GRAM 0x22
66 #define R_GAMMA_FINE_ADJ_POS1 0x30
67 #define R_GAMMA_FINE_ADJ_POS2 0x31
68 #define R_GAMMA_FINE_ADJ_POS3 0x32
69 #define R_GAMMA_GRAD_ADJ_POS 0x33
71 #define R_GAMMA_FINE_ADJ_NEG1 0x34
72 #define R_GAMMA_FINE_ADJ_NEG2 0x35
73 #define R_GAMMA_FINE_ADJ_NEG3 0x36
74 #define R_GAMMA_GRAD_ADJ_NEG 0x37
76 #define R_GAMMA_AMP_ADJ_RES_POS 0x38
77 #define R_GAMMA_AMP_AVG_ADJ_RES_NEG 0x39
79 #define R_GATE_SCAN_POS 0x40
80 #define R_VERT_SCROLL_CONTROL 0x41
81 #define R_1ST_SCR_DRV_POS 0x42
82 #define R_2ND_SCR_DRV_POS 0x43
83 #define R_HORIZ_RAM_ADDR_POS 0x44
84 #define R_VERT_RAM_ADDR_POS 0x45
87 #define R_ENTRY_MODE_HORZ_NORMAL 0x7030
88 #define R_ENTRY_MODE_HORZ_FLIPPED 0x7000
89 static unsigned short r_entry_mode
= R_ENTRY_MODE_HORZ_NORMAL
;
90 #define R_ENTRY_MODE_VERT 0x7038
91 #define R_ENTRY_MODE_SOLID_VERT 0x1038
92 #define R_ENTRY_MODE_VIDEO_NORMAL 0x7020
93 #define R_ENTRY_MODE_VIDEO_FLIPPED 0x7010
97 #define R_DISP_CONTROL_NORMAL 0x0004
98 #define R_DISP_CONTROL_REV 0x0000
99 static unsigned short r_disp_control_rev
= R_DISP_CONTROL_NORMAL
;
101 /* TODO: Implement this function */
102 static void lcd_delay(int x
)
104 /* This is just arbitrary - the OF does something more complex */
109 /* DBOP initialisation, do what OF does */
110 static void ams3525_dbop_init(void)
112 CGU_DBOP
= (1<<3) | AS3525_DBOP_DIV
;
114 DBOP_TIMPOL_01
= 0xe167e167;
115 DBOP_TIMPOL_23
= 0xe167006e;
117 /* short count, 16bit write, read-timing =8 */
118 DBOP_CTRL
= (1<<18)|(1<<12)|(8<<0);
123 DBOP_TIMPOL_23
= 0x6000e;
125 /* short count,write enable, 16bit write, read-timing =8 */
126 DBOP_CTRL
= (1<<18)|(1<<16)|(1<<12)|(8<<0);
127 DBOP_TIMPOL_01
= 0x6e167;
128 DBOP_TIMPOL_23
= 0xa167e06f;
130 /* TODO: The OF calls some other functions here, but maybe not important */
133 #define lcd_write_single_data16(value) do {\
134 DBOP_CTRL &= ~(1<<14|1<<13); \
135 DBOP_DOUT16 = (fb_data)(value); \
138 static void lcd_write_cmd(int cmd
)
141 DBOP_TIMPOL_23
= 0xa167006e;
142 lcd_write_single_data16(cmd
);
144 /* Wait for fifo to empty */
145 while ((DBOP_STAT
& (1<<10)) == 0);
147 /* Fuze OF has this loop and it seems to help us now also */
151 DBOP_TIMPOL_23
= 0xa167e06f;
154 void lcd_write_data(const fb_data
* p_bytes
, int count
)
157 if ((int)p_bytes
& 0x3)
158 { /* need to do a single 16bit write beforehand if the address is */
159 /* not word aligned*/
160 lcd_write_single_data16(*p_bytes
);
163 /* from here, 32bit transfers are save */
164 /* set it to transfer 4*(outputwidth) units at a time, */
165 /* if bit 12 is set it only does 2 halfwords though */
166 DBOP_CTRL
|= (1<<13|1<<14);
167 data
= (long*)p_bytes
;
170 DBOP_DOUT32
= *data
++;
173 /* Wait if push fifo is full */
174 while ((DBOP_STAT
& (1<<6)) != 0);
176 /* While push fifo is not empty */
177 while ((DBOP_STAT
& (1<<10)) == 0);
179 /* due to the 32bit alignment requirement or uneven count,
180 * we possibly need to do a 16bit transfer at the end also */
182 lcd_write_single_data16(*(fb_data
*)data
);
185 static void lcd_write_reg(int reg
, int value
)
187 fb_data data
= value
;
190 lcd_write_single_data16(data
);
193 /*** hardware configuration ***/
195 void lcd_set_contrast(int val
)
200 void lcd_set_invert_display(bool yesno
)
202 r_disp_control_rev
= yesno
? R_DISP_CONTROL_REV
:
203 R_DISP_CONTROL_NORMAL
;
207 lcd_write_reg(R_DISP_CONTROL1
, 0x0033 | r_disp_control_rev
);
212 /* turn the display upside down */
213 void lcd_set_flip(bool yesno
)
215 display_flipped
= yesno
;
217 r_entry_mode
= yesno
? R_ENTRY_MODE_HORZ_FLIPPED
:
218 R_ENTRY_MODE_HORZ_NORMAL
;
221 static void lcd_window(int xmin
, int ymin
, int xmax
, int ymax
)
223 if (!display_flipped
)
225 lcd_write_reg(R_HORIZ_RAM_ADDR_POS
, (xmax
<< 8) | xmin
);
226 lcd_write_reg(R_VERT_RAM_ADDR_POS
, (ymax
<< 8) | ymin
);
227 lcd_write_reg(R_RAM_ADDR_SET
, (ymin
<< 8) | xmin
);
231 lcd_write_reg(R_HORIZ_RAM_ADDR_POS
,
232 ((LCD_WIDTH
-1 - xmin
) << 8) | (LCD_WIDTH
-1 - xmax
));
233 lcd_write_reg(R_VERT_RAM_ADDR_POS
,
234 ((LCD_HEIGHT
-1 - ymin
) << 8) | (LCD_HEIGHT
-1 - ymax
));
235 lcd_write_reg(R_RAM_ADDR_SET
,
236 ((LCD_HEIGHT
-1 - ymin
) << 8) | (LCD_WIDTH
-1 - xmin
));
240 static void _display_on(void)
242 /* Initialisation the display the same way as the original firmware */
244 lcd_write_reg(R_START_OSC
, 0x0001); /* Start Oscilation */
246 lcd_write_reg(R_DRV_OUTPUT_CONTROL
, 0x011b); /* 220 lines, GS=0, SS=1 */
248 /* B/C = 1: n-line inversion form
249 * EOR = 1: polarity inversion occurs by applying an EOR to odd/even
250 * frame select signal and an n-line inversion signal.
251 * FLD = 01b: 1 field interlaced scan, external display iface */
252 lcd_write_reg(R_DRV_WAVEFORM_CONTROL
, 0x0700);
254 /* Address counter updated in horizontal direction; left to right;
255 * vertical increment horizontal increment.
256 * data format for 8bit transfer or spi = 65k (5,6,5) */
257 lcd_write_reg(R_ENTRY_MODE
, r_entry_mode
);
259 /* Replace data on writing to GRAM */
260 lcd_write_reg(R_COMPARE_REG1
, 0);
261 lcd_write_reg(R_COMPARE_REG2
, 0);
263 /* GON = 0, DTE = 0, D1-0 = 00b */
264 lcd_write_reg(R_DISP_CONTROL1
, 0x0000 | r_disp_control_rev
);
266 /* Front porch lines: 2; Back porch lines: 2; */
267 lcd_write_reg(R_DISP_CONTROL2
, 0x0203);
269 /* Scan cycle = 0 frames */
270 lcd_write_reg(R_DISP_CONTROL3
, 0x0000);
273 lcd_write_reg(R_FRAME_CYCLE_CONTROL
, 0x0000);
275 /* 18-bit RGB interface (one transfer/pixel)
276 * internal clock operation;
277 * System interface/VSYNC interface */
278 lcd_write_reg(R_EXT_DISP_IF_CONTROL
, 0x0000);
282 lcd_write_reg(R_POWER_CONTROL1
, 0x0000); /* STB = 0, SLP = 0 */
286 /* initialise power supply */
288 /* DC12-10 = 000b: Step-up1 = clock/8,
289 * DC02-00 = 000b: Step-up2 = clock/16,
290 * VC2-0 = 010b: VciOUT = 0.87 * VciLVL */
291 lcd_write_reg(R_POWER_CONTROL2
, 0x0002);
293 /* VRH3-0 = 1000b: Vreg1OUT = REGP * 1.90 */
294 lcd_write_reg(R_POWER_CONTROL3
, 0x0008);
298 lcd_write_reg(R_POWER_CONTROL4
, 0x0000); /* VCOMG = 0 */
300 /* This register is unknown */
301 lcd_write_reg(0x56, 0x80f);
304 lcd_write_reg(R_POWER_CONTROL1
, 0x4140);
308 lcd_write_reg(R_POWER_CONTROL2
, 0x0000);
309 lcd_write_reg(R_POWER_CONTROL3
, 0x0013);
313 lcd_write_reg(R_POWER_CONTROL4
, 0x6d0e);
317 lcd_write_reg(R_POWER_CONTROL4
, 0x6d0e);
319 lcd_write_reg(R_GAMMA_FINE_ADJ_POS1
, 0x0002);
320 lcd_write_reg(R_GAMMA_FINE_ADJ_POS2
, 0x0707);
321 lcd_write_reg(R_GAMMA_FINE_ADJ_POS3
, 0x0182);
322 lcd_write_reg(R_GAMMA_GRAD_ADJ_POS
, 0x0203);
323 lcd_write_reg(R_GAMMA_FINE_ADJ_NEG1
, 0x0706);
324 lcd_write_reg(R_GAMMA_FINE_ADJ_NEG2
, 0x0006);
325 lcd_write_reg(R_GAMMA_FINE_ADJ_NEG3
, 0x0706);
326 lcd_write_reg(R_GAMMA_GRAD_ADJ_NEG
, 0x0000);
327 lcd_write_reg(R_GAMMA_AMP_ADJ_RES_POS
, 0x030f);
328 lcd_write_reg(R_GAMMA_AMP_AVG_ADJ_RES_NEG
, 0x0f08);
331 lcd_write_reg(R_GATE_SCAN_POS
, 0);
332 lcd_write_reg(R_VERT_SCROLL_CONTROL
, 0);
334 lcd_window(0, 0, LCD_WIDTH
-1, LCD_HEIGHT
-1);
335 lcd_write_reg(R_1ST_SCR_DRV_POS
, (LCD_HEIGHT
-1) << 8);
336 lcd_write_reg(R_2ND_SCR_DRV_POS
, (LCD_HEIGHT
-1) << 8);
338 lcd_write_reg(R_DISP_CONTROL1
, 0x0033 | r_disp_control_rev
);
340 display_on
=true; /* must be done before calling lcd_update() */
345 void lcd_init_device(void)
349 /* Init GPIOs the same as the OF */
354 GPIOA_PIN(4) = 0; /*c80b0040 := 0;*/
358 GPIOA_PIN(5) = (1<<5);
365 #if defined(HAVE_LCD_ENABLE)
366 void lcd_enable(bool on
)
373 lcd_activation_call_hook();
378 lcd_write_reg(R_POWER_CONTROL1
, 0x0001);
384 #if defined(HAVE_LCD_ENABLE) || defined(HAVE_LCD_SLEEP)
385 bool lcd_active(void)
392 /*** update functions ***/
394 static unsigned lcd_yuv_options
= 0;
396 /* Line write helper function for lcd_yuv_blit. Write two lines of yuv420. */
397 extern void lcd_write_yuv420_lines(unsigned char const * const src
[3],
400 extern void lcd_write_yuv420_lines_odither(unsigned char const * const src
[3],
403 int x_screen
, /* To align dither pattern */
406 void lcd_yuv_set_options(unsigned options
)
408 lcd_yuv_options
= options
;
411 static void lcd_window_blit(int xmin
, int ymin
, int xmax
, int ymax
)
413 if (!display_flipped
)
415 lcd_write_reg(R_HORIZ_RAM_ADDR_POS
,
416 ((LCD_WIDTH
-1 - xmin
) << 8) | (LCD_WIDTH
-1 - xmax
));
417 lcd_write_reg(R_VERT_RAM_ADDR_POS
, (ymax
<< 8) | ymin
);
418 lcd_write_reg(R_RAM_ADDR_SET
,
419 (ymin
<< 8) | (LCD_WIDTH
-1 - xmin
));
423 lcd_write_reg(R_HORIZ_RAM_ADDR_POS
, (xmax
<< 8) | xmin
);
424 lcd_write_reg(R_VERT_RAM_ADDR_POS
, (ymax
<< 8) | ymin
);
425 lcd_write_reg(R_RAM_ADDR_SET
, (ymax
<< 8) | xmin
);
429 /* Performance function to blit a YUV bitmap directly to the LCD
430 * src_x, src_y, width and height should be even
431 * x, y, width and height have to be within LCD bounds
433 void lcd_blit_yuv(unsigned char * const src
[3],
434 int src_x
, int src_y
, int stride
,
435 int x
, int y
, int width
, int height
)
437 unsigned char const * yuv_src
[3];
442 /* Sorry, but width and height must be >= 2 or else */
447 yuv_src
[0] = src
[0] + z
+ src_x
;
448 yuv_src
[1] = src
[1] + (z
>> 2) + (src_x
>> 1);
449 yuv_src
[2] = src
[2] + (yuv_src
[1] - src
[1]);
451 if (!display_flipped
)
453 lcd_write_reg(R_ENTRY_MODE
, R_ENTRY_MODE_VIDEO_NORMAL
);
457 lcd_write_reg(R_ENTRY_MODE
, R_ENTRY_MODE_VIDEO_FLIPPED
);
460 if (lcd_yuv_options
& LCD_YUV_DITHER
)
464 lcd_window_blit(y
, x
, y
+1, x
+width
-1);
466 /* Start write to GRAM */
467 lcd_write_cmd(R_WRITE_DATA_2_GRAM
);
469 lcd_write_yuv420_lines_odither(yuv_src
, width
, stride
, x
, y
);
470 yuv_src
[0] += stride
<< 1; /* Skip down two luma lines */
471 yuv_src
[1] += stride
>> 1; /* Skip down one chroma line */
472 yuv_src
[2] += stride
>> 1;
475 while (--height
> 0);
481 lcd_window_blit(y
, x
, y
+1, x
+width
-1);
483 /* Start write to GRAM */
484 lcd_write_cmd(R_WRITE_DATA_2_GRAM
);
486 lcd_write_yuv420_lines(yuv_src
, width
, stride
);
487 yuv_src
[0] += stride
<< 1; /* Skip down two luma lines */
488 yuv_src
[1] += stride
>> 1; /* Skip down one chroma line */
489 yuv_src
[2] += stride
>> 1;
492 while (--height
> 0);
498 /* Update the display.
499 This must be called after all other LCD functions that change the display. */
500 void lcd_update(void)
505 lcd_write_reg(R_ENTRY_MODE
, r_entry_mode
);
508 /* Set start position and window */
509 lcd_window(0, 0, LCD_WIDTH
-1, LCD_HEIGHT
-1);
511 lcd_write_cmd(R_WRITE_DATA_2_GRAM
);
513 lcd_write_data((fb_data
*)lcd_framebuffer
, LCD_WIDTH
*LCD_HEIGHT
);
519 /* Update a fraction of the display. */
520 void lcd_update_rect(int x
, int y
, int width
, int height
)
530 if (xmax
>= LCD_WIDTH
)
531 xmax
= LCD_WIDTH
- 1; /* Clip right */
533 x
= 0; /* Clip left */
535 return; /* nothing left to do */
537 width
= xmax
- x
+ 1; /* Fix width */
540 if (ymax
>= LCD_HEIGHT
)
541 ymax
= LCD_HEIGHT
- 1; /* Clip bottom */
543 y
= 0; /* Clip top */
545 return; /* nothing left to do */
547 lcd_write_reg(R_ENTRY_MODE
, r_entry_mode
);
549 lcd_window(x
, y
, xmax
, ymax
);
550 lcd_write_cmd(R_WRITE_DATA_2_GRAM
);
552 ptr
= (fb_data
*)&lcd_framebuffer
[y
][x
];
556 lcd_write_data(ptr
, width
);
562 } /* lcd_update_rect */
564 /* writes one red pixel outside the visible area, needed for correct
566 bool lcd_button_support(void)
568 fb_data data
= (0xf<<12);
573 lcd_write_reg(R_ENTRY_MODE
, r_entry_mode
);
574 /* Set start position and window */
575 lcd_window(LCD_WIDTH
+1, LCD_HEIGHT
+1, LCD_WIDTH
+2, LCD_HEIGHT
+2);
577 lcd_write_cmd(R_WRITE_DATA_2_GRAM
);
579 lcd_write_single_data16(data
);