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 updating
40 * 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;
116 DBOP_CTRL
= (1<<18)|(1<<12)|(8<<0); /* short count, 16bit write, read-timing =8 */
121 DBOP_TIMPOL_23
= 0x6000e;
122 DBOP_CTRL
= (1<<18)|(1<<16)|(1<<12)|(8<<0);/* short count,write enable, 16bit write, read-timing =8 */
123 DBOP_TIMPOL_01
= 0x6e167;
124 DBOP_TIMPOL_23
= 0xa167e06f;
126 /* TODO: The OF calls some other functions here, but maybe not important */
130 static void lcd_write_cmd(int cmd
)
133 DBOP_CTRL
&= ~(1<<14);
135 DBOP_TIMPOL_23
= 0xa167006e;
139 /* Wait for fifo to empty */
140 while ((DBOP_STAT
& (1<<10)) == 0);
142 /* Fuze OF has this loop and it seems to help us now also */
146 DBOP_TIMPOL_23
= 0xa167e06f;
149 void lcd_write_data(const fb_data
* p_bytes
, int count
)
153 DBOP_DOUT
= *p_bytes
++;
155 /* Wait for fifo to empty */
156 while ((DBOP_STAT
& (1<<10)) == 0);
160 static void lcd_write_reg(int reg
, int value
)
162 fb_data data
= value
;
165 lcd_write_data(&data
, 1);
168 /*** hardware configuration ***/
170 void lcd_set_contrast(int val
)
175 void lcd_set_invert_display(bool yesno
)
177 r_disp_control_rev
= yesno
? R_DISP_CONTROL_REV
:
178 R_DISP_CONTROL_NORMAL
;
182 lcd_write_reg(R_DISP_CONTROL1
, 0x0033 | r_disp_control_rev
);
187 /* turn the display upside down */
188 void lcd_set_flip(bool yesno
)
190 display_flipped
= yesno
;
192 r_entry_mode
= yesno
? R_ENTRY_MODE_HORZ_FLIPPED
:
193 R_ENTRY_MODE_HORZ_NORMAL
;
196 static void lcd_window(int xmin
, int ymin
, int xmax
, int ymax
)
198 if (!display_flipped
)
200 lcd_write_reg(R_HORIZ_RAM_ADDR_POS
, (xmax
<< 8) | xmin
);
201 lcd_write_reg(R_VERT_RAM_ADDR_POS
, (ymax
<< 8) | ymin
);
202 lcd_write_reg(R_RAM_ADDR_SET
, (ymin
<< 8) | xmin
);
206 lcd_write_reg(R_HORIZ_RAM_ADDR_POS
, ((LCD_WIDTH
-1 - xmin
) << 8) | (LCD_WIDTH
-1 - xmax
));
207 lcd_write_reg(R_VERT_RAM_ADDR_POS
, ((LCD_HEIGHT
-1 - ymin
) << 8) | (LCD_HEIGHT
-1 - ymax
));
208 lcd_write_reg(R_RAM_ADDR_SET
, ((LCD_HEIGHT
-1 - ymin
) << 8) | (LCD_WIDTH
-1 - xmin
));
212 static void _display_on(void)
214 /* Initialisation the display the same way as the original firmware */
216 lcd_write_reg(R_START_OSC
, 0x0001); /* Start Oscilation */
218 lcd_write_reg(R_DRV_OUTPUT_CONTROL
, 0x011b); /* 220 lines, GS=0, SS=1 */
220 /* B/C = 1: n-line inversion form
221 * EOR = 1: polarity inversion occurs by applying an EOR to odd/even
222 * frame select signal and an n-line inversion signal.
223 * FLD = 01b: 1 field interlaced scan, external display iface */
224 lcd_write_reg(R_DRV_WAVEFORM_CONTROL
, 0x0700);
226 /* Address counter updated in horizontal direction; left to right;
227 * vertical increment horizontal increment.
228 * data format for 8bit transfer or spi = 65k (5,6,5) */
229 lcd_write_reg(R_ENTRY_MODE
, r_entry_mode
);
231 /* Replace data on writing to GRAM */
232 lcd_write_reg(R_COMPARE_REG1
, 0);
233 lcd_write_reg(R_COMPARE_REG2
, 0);
235 lcd_write_reg(R_DISP_CONTROL1
, 0x0000 | r_disp_control_rev
); /* GON = 0, DTE = 0, D1-0 = 00b */
237 /* Front porch lines: 2; Back porch lines: 2; */
238 lcd_write_reg(R_DISP_CONTROL2
, 0x0203);
240 /* Scan cycle = 0 frames */
241 lcd_write_reg(R_DISP_CONTROL3
, 0x0000);
244 lcd_write_reg(R_FRAME_CYCLE_CONTROL
, 0x0000);
246 /* 18-bit RGB interface (one transfer/pixel)
247 * internal clock operation;
248 * System interface/VSYNC interface */
249 lcd_write_reg(R_EXT_DISP_IF_CONTROL
, 0x0000);
253 lcd_write_reg(R_POWER_CONTROL1
, 0x0000); /* STB = 0, SLP = 0 */
257 /* initialise power supply */
259 /* DC12-10 = 000b: Step-up1 = clock/8,
260 * DC02-00 = 000b: Step-up2 = clock/16,
261 * VC2-0 = 010b: VciOUT = 0.87 * VciLVL */
262 lcd_write_reg(R_POWER_CONTROL2
, 0x0002);
264 /* VRH3-0 = 1000b: Vreg1OUT = REGP * 1.90 */
265 lcd_write_reg(R_POWER_CONTROL3
, 0x0008);
269 lcd_write_reg(R_POWER_CONTROL4
, 0x0000); /* VCOMG = 0 */
271 /* This register is unknown */
272 lcd_write_reg(0x56, 0x80f);
275 lcd_write_reg(R_POWER_CONTROL1
, 0x4140);
279 lcd_write_reg(R_POWER_CONTROL2
, 0x0000);
280 lcd_write_reg(R_POWER_CONTROL3
, 0x0013);
284 lcd_write_reg(R_POWER_CONTROL4
, 0x6d0e);
288 lcd_write_reg(R_POWER_CONTROL4
, 0x6d0e);
290 lcd_write_reg(R_GAMMA_FINE_ADJ_POS1
, 0x0002);
291 lcd_write_reg(R_GAMMA_FINE_ADJ_POS2
, 0x0707);
292 lcd_write_reg(R_GAMMA_FINE_ADJ_POS3
, 0x0182);
293 lcd_write_reg(R_GAMMA_GRAD_ADJ_POS
, 0x0203);
294 lcd_write_reg(R_GAMMA_FINE_ADJ_NEG1
, 0x0706);
295 lcd_write_reg(R_GAMMA_FINE_ADJ_NEG2
, 0x0006);
296 lcd_write_reg(R_GAMMA_FINE_ADJ_NEG3
, 0x0706);
297 lcd_write_reg(R_GAMMA_GRAD_ADJ_NEG
, 0x0000);
298 lcd_write_reg(R_GAMMA_AMP_ADJ_RES_POS
, 0x030f);
299 lcd_write_reg(R_GAMMA_AMP_AVG_ADJ_RES_NEG
, 0x0f08);
302 lcd_write_reg(R_GATE_SCAN_POS
, 0);
303 lcd_write_reg(R_VERT_SCROLL_CONTROL
, 0);
305 lcd_window(0, 0, LCD_WIDTH
-1, LCD_HEIGHT
-1);
306 lcd_write_reg(R_1ST_SCR_DRV_POS
, (LCD_HEIGHT
-1) << 8);
307 lcd_write_reg(R_2ND_SCR_DRV_POS
, (LCD_HEIGHT
-1) << 8);
309 lcd_write_reg(R_DISP_CONTROL1
, 0x0033 | r_disp_control_rev
);
311 display_on
=true; /* must be done before calling lcd_update() */
316 void lcd_init_device(void)
320 /* Init GPIOs the same as the OF */
325 GPIOA_PIN(4) = 0; /*c80b0040 := 0;*/
329 GPIOA_PIN(5) = (1<<5);
336 #if defined(HAVE_LCD_ENABLE)
337 void lcd_enable(bool on
)
344 lcd_activation_call_hook();
349 lcd_write_reg(R_POWER_CONTROL1
, 0x0001);
355 #if defined(HAVE_LCD_ENABLE) || defined(HAVE_LCD_SLEEP)
356 bool lcd_active(void)
363 /*** update functions ***/
365 static unsigned lcd_yuv_options
= 0;
367 /* Line write helper function for lcd_yuv_blit. Write two lines of yuv420. */
368 extern void lcd_write_yuv420_lines(unsigned char const * const src
[3],
371 extern void lcd_write_yuv420_lines_odither(unsigned char const * const src
[3],
374 int x_screen
, /* To align dither pattern */
377 void lcd_yuv_set_options(unsigned options
)
379 lcd_yuv_options
= options
;
382 static void lcd_window_blit(int xmin
, int ymin
, int xmax
, int ymax
)
384 if (!display_flipped
)
386 lcd_write_reg(R_HORIZ_RAM_ADDR_POS
, ((LCD_WIDTH
-1 - xmin
) << 8) | (LCD_WIDTH
-1 - xmax
));
387 lcd_write_reg(R_VERT_RAM_ADDR_POS
, (ymax
<< 8) | ymin
);
388 lcd_write_reg(R_RAM_ADDR_SET
, (ymin
<< 8) | (LCD_WIDTH
-1 - xmin
));
392 lcd_write_reg(R_HORIZ_RAM_ADDR_POS
, (xmax
<< 8) | xmin
);
393 lcd_write_reg(R_VERT_RAM_ADDR_POS
, (ymax
<< 8) | ymin
);
394 lcd_write_reg(R_RAM_ADDR_SET
, (ymax
<< 8) | xmin
);
398 /* Performance function to blit a YUV bitmap directly to the LCD
399 * src_x, src_y, width and height should be even
400 * x, y, width and height have to be within LCD bounds
402 void lcd_blit_yuv(unsigned char * const src
[3],
403 int src_x
, int src_y
, int stride
,
404 int x
, int y
, int width
, int height
)
406 unsigned char const * yuv_src
[3];
411 /* Sorry, but width and height must be >= 2 or else */
416 yuv_src
[0] = src
[0] + z
+ src_x
;
417 yuv_src
[1] = src
[1] + (z
>> 2) + (src_x
>> 1);
418 yuv_src
[2] = src
[2] + (yuv_src
[1] - src
[1]);
420 if (!display_flipped
)
422 lcd_write_reg(R_ENTRY_MODE
, R_ENTRY_MODE_VIDEO_NORMAL
);
426 lcd_write_reg(R_ENTRY_MODE
, R_ENTRY_MODE_VIDEO_FLIPPED
);
429 if (lcd_yuv_options
& LCD_YUV_DITHER
)
433 lcd_window_blit(y
, x
, y
+1, x
+width
-1);
435 /* Start write to GRAM */
436 lcd_write_cmd(R_WRITE_DATA_2_GRAM
);
438 lcd_write_yuv420_lines_odither(yuv_src
, width
, stride
, x
, y
);
439 yuv_src
[0] += stride
<< 1; /* Skip down two luma lines */
440 yuv_src
[1] += stride
>> 1; /* Skip down one chroma line */
441 yuv_src
[2] += stride
>> 1;
444 while (--height
> 0);
450 lcd_window_blit(y
, x
, y
+1, x
+width
-1);
452 /* Start write to GRAM */
453 lcd_write_cmd(R_WRITE_DATA_2_GRAM
);
455 lcd_write_yuv420_lines(yuv_src
, width
, stride
);
456 yuv_src
[0] += stride
<< 1; /* Skip down two luma lines */
457 yuv_src
[1] += stride
>> 1; /* Skip down one chroma line */
458 yuv_src
[2] += stride
>> 1;
461 while (--height
> 0);
467 /* Update the display.
468 This must be called after all other LCD functions that change the display. */
469 void lcd_update(void)
474 lcd_write_reg(R_ENTRY_MODE
, r_entry_mode
);
477 /* Set start position and window */
478 lcd_window(0, 0, LCD_WIDTH
-1, LCD_HEIGHT
-1);
480 lcd_write_cmd(R_WRITE_DATA_2_GRAM
);
482 lcd_write_data((fb_data
*)lcd_framebuffer
, LCD_WIDTH
*LCD_HEIGHT
);
488 /* Update a fraction of the display. */
489 void lcd_update_rect(int x
, int y
, int width
, int height
)
499 if (xmax
>= LCD_WIDTH
)
500 xmax
= LCD_WIDTH
- 1; /* Clip right */
502 x
= 0; /* Clip left */
504 return; /* nothing left to do */
506 width
= xmax
- x
+ 1; /* Fix width */
509 if (ymax
>= LCD_HEIGHT
)
510 ymax
= LCD_HEIGHT
- 1; /* Clip bottom */
512 y
= 0; /* Clip top */
514 return; /* nothing left to do */
516 lcd_write_reg(R_ENTRY_MODE
, r_entry_mode
);
518 lcd_window(x
, y
, xmax
, ymax
);
519 lcd_write_cmd(R_WRITE_DATA_2_GRAM
);
521 ptr
= (fb_data
*)&lcd_framebuffer
[y
][x
];
525 lcd_write_data(ptr
, width
);
531 } /* lcd_update_rect */
533 /* writes one read pixel outside the visible area, needed for correct dbop reads */
534 bool lcd_button_support(void)
536 fb_data data
= (0xf<<12);
541 lcd_write_reg(R_ENTRY_MODE
, r_entry_mode
);
542 /* Set start position and window */
543 lcd_window(LCD_WIDTH
+1, LCD_HEIGHT
+1, LCD_WIDTH
+2, LCD_HEIGHT
+2);
545 lcd_write_cmd(R_WRITE_DATA_2_GRAM
);
547 lcd_write_data(&data
, 1);