2 * Samsung S3C24xx series LCD controller.
4 * Copyright (c) 2007 OpenMoko, Inc.
5 * Author: Andrzej Zaborowski <andrew@openedhand.com>
6 * With: Michel Pollet <buserror@gmail.com>
8 * This code is licenced under the GNU GPL v2.
14 #include "framebuffer.h"
18 struct s3c_lcd_state_s
{
19 target_phys_addr_t base
;
36 uint16_t raw_pal
[0x100];
44 uint32_t palette
[0x100];
52 static void s3c_lcd_update(struct s3c_lcd_state_s
*s
)
54 s
->intpnd
|= s
->srcpnd
& ~s
->intmsk
;
55 qemu_set_irq(s
->irq
, !!s
->intpnd
);
58 void s3c_lcd_reset(struct s3c_lcd_state_s
*s
)
66 s
->con
[0] = 0x00000000;
67 s
->con
[1] = 0x00000000;
68 s
->con
[2] = 0x00000000;
69 s
->con
[3] = 0x00000000;
70 s
->con
[4] = 0x00000000;
71 s
->saddr
[0] = 0x00000000;
72 s
->saddr
[1] = 0x00000000;
73 s
->saddr
[2] = 0x00000000;
77 s
->dithmode
= 0x00000;
86 #define S3C_LCDCON1 0x00 /* LCD Control register 1 */
87 #define S3C_LCDCON2 0x04 /* LCD Control register 2 */
88 #define S3C_LCDCON3 0x08 /* LCD Control register 3 */
89 #define S3C_LCDCON4 0x0c /* LCD Control register 4 */
90 #define S3C_LCDCON5 0x10 /* LCD Control register 5 */
91 #define S3C_LCDSADDR1 0x14 /* Framebuffer Start Address 1 register */
92 #define S3C_LCDSADDR2 0x18 /* Framebuffer Start Address 2 register */
93 #define S3C_LCDSADDR3 0x1c /* Framebuffer Start Address 3 register */
94 #define S3C_REDLUT 0x20 /* Red Lookup Table register */
95 #define S3C_GREENLUT 0x24 /* Green Lookup Table register */
96 #define S3C_BLUELUT 0x28 /* Blue Lookup Table register */
97 #define S3C_DITHMODE 0x4c /* Dithering Mode register */
98 #define S3C_TPAL 0x50 /* Temporary Palette register */
99 #define S3C_LCDINTPND 0x54 /* LCD Interrupt Pending register */
100 #define S3C_LCDSRCPND 0x58 /* LCD Interrupt Source Pending register */
101 #define S3C_LCDINTMSK 0x5c /* LCD Interrupt Mask register */
102 #define S3C_LPCSEL 0x60 /* LPC3600 Control register */
104 #define S3C_PALETTE 0x400 /* Palette IO start offset */
105 #define S3C_PALETTEEND 0x5ff /* Palette IO end offset */
107 static uint32_t s3c_lcd_read(void *opaque
, target_phys_addr_t addr
)
109 struct s3c_lcd_state_s
*s
= (struct s3c_lcd_state_s
*) opaque
;
113 return s
->con
[0]; /* XXX Return random LINECNT? */
121 return s
->con
[4]; /* XXX Return random STATUS? */
146 case S3C_PALETTE
... S3C_PALETTEEND
:
147 /* XXX assuming 16bit access */
148 return s
->raw_pal
[(addr
- S3C_PALETTE
) >> 1];
150 printf("%s: Bad register 0x%lx\n", __FUNCTION__
, (unsigned long)addr
);
156 static void s3c_lcd_write(void *opaque
, target_phys_addr_t addr
,
159 struct s3c_lcd_state_s
*s
= (struct s3c_lcd_state_s
*) opaque
;
163 s
->con
[0] = value
& 0x0003ffff;
164 s
->enable
= value
& 1;
165 s
->bpp
= (value
>> 1) & 0xf;
178 s
->con
[3] = value
& 0xffff;
181 s
->con
[4] = value
& 0x1fff;
182 s
->frm565
= (value
>> 11) & 1;
183 s
->msb
= (value
>> 12) & 1;
223 s
->intpnd
= value
& 3;
226 s
->srcpnd
= value
& 3;
229 s
->intmsk
= value
& 7;
233 s
->lpcsel
= (value
& 3) | 4;
235 printf("%s: attempt to enable LPC3600\n", __FUNCTION__
);
237 case S3C_PALETTE
... S3C_PALETTEEND
:
238 /* XXX assuming 16bit access */
239 s
->raw_pal
[(addr
- S3C_PALETTE
) >> 1] = value
;
242 printf("%s: Bad register 0x%lx\n", __FUNCTION__
, (unsigned long)addr
);
246 static CPUReadMemoryFunc
*s3c_lcd_readfn
[] = {
252 static CPUWriteMemoryFunc
*s3c_lcd_writefn
[] = {
258 static inline void s3c_lcd_resize(struct s3c_lcd_state_s
*s
)
260 int new_width
, new_height
;
261 new_height
= ((s
->con
[1] >> 14) & 0x3ff) + 1;
262 new_width
= ((s
->con
[2] >> 8) & 0x7ff) + 1;
263 if (s
->width
!= new_width
|| s
->height
!= new_height
) {
264 s
->width
= new_width
;
265 s
->height
= new_height
;
267 if (graphic_rotate
) {
268 qemu_console_resize(s
->ds
, s
->height
, s
->width
);
270 qemu_console_resize(s
->ds
, s
->width
, s
->height
);
277 uint32_t s3c_rgb_to_pixel8(unsigned int r
, unsigned int g
, unsigned b
)
279 return ((r
>> 5) << 5) | ((g
>> 5) << 2) | (b
>> 6);
283 uint32_t s3c_rgb_to_pixel15(unsigned int r
, unsigned int g
, unsigned b
)
285 return ((r
>> 3) << 10) | ((g
>> 3) << 5) | (b
>> 3);
289 uint32_t s3c_rgb_to_pixel16(unsigned int r
, unsigned int g
, unsigned b
)
291 return ((r
>> 3) << 11) | ((g
>> 2) << 5) | (b
>> 3);
295 uint32_t s3c_rgb_to_pixel24(unsigned int r
, unsigned int g
, unsigned b
)
297 return (r
<< 16) | (g
<< 8) | b
;
301 uint32_t s3c_rgb_to_pixel32(unsigned int r
, unsigned int g
, unsigned b
)
303 return (r
<< 16) | (g
<< 8) | b
;
306 static inline uint32_t s3c_rgb(struct s3c_lcd_state_s
*s
,
307 unsigned int r
, unsigned int g
, unsigned b
)
309 switch (ds_get_bits_per_pixel(s
->ds
)) {
311 return s3c_rgb_to_pixel32(r
<< 2, g
<< 2, b
<< 2);
313 return s3c_rgb_to_pixel15(r
<< 2, g
<< 2, b
<< 2);
315 return s3c_rgb_to_pixel16(r
<< 2, g
<< 2, b
<< 2);
317 return s3c_rgb_to_pixel24(r
<< 2, g
<< 2, b
<< 2);
319 return s3c_rgb_to_pixel32(r
<< 2, g
<< 2, b
<< 2);
321 fprintf(stderr
, "%s: Bad color depth\n", __FUNCTION__
);
326 static void s3c_lcd_palette_load(struct s3c_lcd_state_s
*s
)
333 s
->src_width
= s
->width
>> 3;
334 s
->fn
= s
->line_fn
[0];
339 s
->src_width
= s
->width
>> 2;
340 s
->fn
= s
->line_fn
[1];
345 s
->src_width
= s
->width
>> 1;
346 s
->fn
= s
->line_fn
[2];
351 s
->src_width
= s
->width
>> 0;
352 s
->fn
= s
->line_fn
[3];
355 s
->src_width
= (s
->width
* 3) >> 1;
356 s
->fn
= s
->line_fn
[4];
359 s
->src_width
= s
->width
<< 1;
361 s
->fn
= s
->line_fn
[5];
363 s
->fn
= s
->line_fn
[6];
366 s
->src_width
= s
->width
<< 2;
367 s
->fn
= s
->line_fn
[7];
373 for (i
= 0; i
< n
; i
++)
375 s
->palette
[i
] = s3c_rgb(s
,
376 (s
->raw_pal
[i
] >> 10) & 0x3e,
377 (s
->raw_pal
[i
] >> 5) & 0x3f,
378 (s
->raw_pal
[i
] << 1) & 0x3e);
380 s
->palette
[i
] = s3c_rgb(s
,
381 ((s
->raw_pal
[i
] >> 10) & 0x3e) | (s
->raw_pal
[i
] & 1),
382 ((s
->raw_pal
[i
] >> 6) & 0x3e) | (s
->raw_pal
[i
] & 1),
383 s
->raw_pal
[i
] & 0x3f);
385 for (i
= 0; i
< n
; i
++)
387 s
->palette
[i
] = s3c_rgb(s
,
388 ((s
->r
>> (i
* 4)) & 0xf) << 2,
389 ((s
->g
>> (i
* 4)) & 0xf) << 2,
390 ((s
->b
>> (i
* 4)) & 0xf) << 2);
392 s
->palette
[i
] = s3c_rgb(s
,
393 ((s
->r
>> (((i
>> 5) & 7) * 4)) & 0xf) << 2,
394 ((s
->g
>> (((i
>> 2) & 7) * 4)) & 0xf) << 2,
395 ((s
->b
>> ((i
& 3) * 4)) & 0xf) << 2);
399 static void s3c_update_display(void *opaque
)
401 struct s3c_lcd_state_s
*s
= (struct s3c_lcd_state_s
*) opaque
;
405 int dest_row_pitch
, dest_col_pitch
;
409 if (s
->invalidatep
) {
410 s3c_lcd_palette_load(s
);
414 addr
= s
->saddr
[0]<<1;
416 if (graphic_rotate
) {
417 dest_row_pitch
= s
->dest_width
;
418 dest_col_pitch
= -s
->height
* s
->dest_width
;
420 dest_row_pitch
= s
->width
* s
->dest_width
;
421 dest_col_pitch
= s
->dest_width
;
423 src_width
= s
->src_width
;
426 framebuffer_update_display(s
->ds
,
427 addr
, s
->width
, s
->height
,
428 src_width
, dest_row_pitch
, dest_col_pitch
,
433 s
->srcpnd
|= (1 << 1); /* INT_FrSyn */
437 dpy_update(s
->ds
, first
, 0, last
- first
+ 1, s
->width
);
439 dpy_update(s
->ds
, 0, first
, s
->width
, last
- first
+ 1);
444 static void s3c_invalidate_display(void *opaque
)
446 struct s3c_lcd_state_s
*s
= (struct s3c_lcd_state_s
*) opaque
;
450 static void s3c_screen_dump(void *opaque
, const char *filename
)
456 #include "s3c24xx_template.h"
458 #include "s3c24xx_template.h"
460 #include "s3c24xx_template.h"
462 #include "s3c24xx_template.h"
464 #include "s3c24xx_template.h"
466 static void s3c_lcd_save(QEMUFile
*f
, void *opaque
)
468 struct s3c_lcd_state_s
*s
= (struct s3c_lcd_state_s
*) opaque
;
470 for (i
= 0; i
< 5; i
++)
471 qemu_put_be32s(f
, &s
->con
[i
]);
472 for (i
= 0; i
< 3; i
++)
473 qemu_put_be32s(f
, &s
->saddr
[i
]);
474 qemu_put_be32s(f
, &s
->r
);
475 qemu_put_be32s(f
, &s
->g
);
476 qemu_put_be16s(f
, &s
->b
);
477 qemu_put_be32s(f
, &s
->dithmode
);
478 qemu_put_be32s(f
, &s
->tpal
);
479 qemu_put_8s(f
, &s
->intpnd
);
480 qemu_put_8s(f
, &s
->srcpnd
);
481 qemu_put_8s(f
, &s
->intmsk
);
482 qemu_put_8s(f
, &s
->lpcsel
);
483 for (i
= 0; i
< 0x100; i
++)
484 qemu_put_be16s(f
, &s
->raw_pal
[i
]);
487 static int s3c_lcd_load(QEMUFile
*f
, void *opaque
, int version_id
)
489 struct s3c_lcd_state_s
*s
= (struct s3c_lcd_state_s
*) opaque
;
491 for (i
= 0; i
< 5; i
++)
492 qemu_get_be32s(f
, &s
->con
[i
]);
493 for (i
= 0; i
< 3; i
++)
494 qemu_get_be32s(f
, &s
->saddr
[i
]);
495 qemu_get_be32s(f
, &s
->r
);
496 qemu_get_be32s(f
, &s
->g
);
497 qemu_get_be16s(f
, &s
->b
);
498 qemu_get_be32s(f
, &s
->dithmode
);
499 qemu_get_be32s(f
, &s
->tpal
);
500 qemu_get_8s(f
, &s
->intpnd
);
501 qemu_get_8s(f
, &s
->srcpnd
);
502 qemu_get_8s(f
, &s
->intmsk
);
503 qemu_get_8s(f
, &s
->lpcsel
);
509 s
->bpp
= (s
->con
[0] >> 1) & 0xf;
510 s
->enable
= s
->con
[0] & 1;
511 s
->msb
= (s
->con
[4] >> 12) & 1;
512 s
->frm565
= (s
->con
[4] >> 11) & 1;
514 for (i
= 0; i
< 0x100; i
++)
515 qemu_get_be16s(f
, &s
->raw_pal
[i
]);
520 struct s3c_lcd_state_s
*s3c_lcd_init(target_phys_addr_t base
,
524 struct s3c_lcd_state_s
*s
= (struct s3c_lcd_state_s
*)
525 qemu_mallocz(sizeof(struct s3c_lcd_state_s
));
532 s
->ds
= graphic_console_init(
534 s3c_invalidate_display
,
535 s3c_screen_dump
, NULL
, s
);
537 iomemtype
= cpu_register_io_memory(0, s3c_lcd_readfn
,
539 cpu_register_physical_memory(s
->base
, 0xffffff, iomemtype
);
541 register_savevm("s3c24xx_lcd", 0, 0, s3c_lcd_save
, s3c_lcd_load
, s
);
543 switch (ds_get_bits_per_pixel(s
->ds
)) {
548 s
->line_fn
= s3c_draw_fn_8
;
552 s
->line_fn
= s3c_draw_fn_15
;
556 s
->line_fn
= s3c_draw_fn_16
;
560 s
->line_fn
= s3c_draw_fn_24
;
564 s
->line_fn
= s3c_draw_fn_32
;
568 fprintf(stderr
, "%s: Bad color depth\n", __FUNCTION__
);