4 * Copyright (C) 2006-2007 Andrzej Zaborowski <balrog@zabor.org>
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License as
8 * published by the Free Software Foundation; either version 2 of
9 * the License, or (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License along
17 * with this program; if not, see <http://www.gnu.org/licenses/>.
20 #include "ui/console.h"
22 #include "hw/framebuffer.h"
23 #include "ui/pixel_ops.h"
25 struct omap_lcd_panel_s
{
42 struct omap_dma_lcd_channel_s
*dma
;
43 uint16_t palette
[256];
50 static void omap_lcd_interrupts(struct omap_lcd_panel_s
*s
)
52 if (s
->frame_done
&& (s
->interrupts
& 1)) {
53 qemu_irq_raise(s
->irq
);
57 if (s
->palette_done
&& (s
->interrupts
& 2)) {
58 qemu_irq_raise(s
->irq
);
63 qemu_irq_raise(s
->irq
);
67 qemu_irq_lower(s
->irq
);
70 #define draw_line_func drawfn
73 #include "hw/omap_lcd_template.h"
75 #include "hw/omap_lcd_template.h"
77 #include "hw/omap_lcd_template.h"
79 #include "hw/omap_lcd_template.h"
81 static draw_line_func draw_line_table2
[33] = {
87 }, draw_line_table4
[33] = {
93 }, draw_line_table8
[33] = {
99 }, draw_line_table12
[33] = {
102 [15] = draw_line12_15
,
103 [16] = draw_line12_16
,
104 [32] = draw_line12_32
,
105 }, draw_line_table16
[33] = {
108 [15] = draw_line16_15
,
109 [16] = draw_line16_16
,
110 [32] = draw_line16_32
,
113 static void omap_update_display(void *opaque
)
115 struct omap_lcd_panel_s
*omap_lcd
= (struct omap_lcd_panel_s
*) opaque
;
116 draw_line_func draw_line
;
117 int size
, height
, first
, last
;
118 int width
, linesize
, step
, bpp
, frame_offset
;
121 if (!omap_lcd
|| omap_lcd
->plm
== 1 ||
122 !omap_lcd
->enable
|| !ds_get_bits_per_pixel(omap_lcd
->state
))
126 if (omap_lcd
->plm
!= 2) {
127 cpu_physical_memory_read(omap_lcd
->dma
->phys_framebuffer
[
128 omap_lcd
->dma
->current_frame
],
129 (void *)omap_lcd
->palette
, 0x200);
130 switch (omap_lcd
->palette
[0] >> 12 & 7) {
132 frame_offset
+= 0x200;
135 frame_offset
+= 0x20;
140 switch ((omap_lcd
->palette
[0] >> 12) & 7) {
142 draw_line
= draw_line_table2
[ds_get_bits_per_pixel(omap_lcd
->state
)];
147 draw_line
= draw_line_table4
[ds_get_bits_per_pixel(omap_lcd
->state
)];
152 draw_line
= draw_line_table8
[ds_get_bits_per_pixel(omap_lcd
->state
)];
158 draw_line
= draw_line_table12
[ds_get_bits_per_pixel(omap_lcd
->state
)];
160 draw_line
= draw_line_table16
[ds_get_bits_per_pixel(omap_lcd
->state
)];
165 /* Unsupported at the moment. */
170 width
= omap_lcd
->width
;
171 if (width
!= ds_get_width(omap_lcd
->state
) ||
172 omap_lcd
->height
!= ds_get_height(omap_lcd
->state
)) {
173 qemu_console_resize(omap_lcd
->state
,
174 omap_lcd
->width
, omap_lcd
->height
);
175 omap_lcd
->invalidate
= 1;
178 if (omap_lcd
->dma
->current_frame
== 0)
179 size
= omap_lcd
->dma
->src_f1_bottom
- omap_lcd
->dma
->src_f1_top
;
181 size
= omap_lcd
->dma
->src_f2_bottom
- omap_lcd
->dma
->src_f2_top
;
183 if (frame_offset
+ ((width
* omap_lcd
->height
* bpp
) >> 3) > size
+ 2) {
184 omap_lcd
->sync_error
= 1;
185 omap_lcd_interrupts(omap_lcd
);
186 omap_lcd
->enable
= 0;
191 frame_base
= omap_lcd
->dma
->phys_framebuffer
[
192 omap_lcd
->dma
->current_frame
] + frame_offset
;
193 omap_lcd
->dma
->condition
|= 1 << omap_lcd
->dma
->current_frame
;
194 if (omap_lcd
->dma
->interrupts
& 1)
195 qemu_irq_raise(omap_lcd
->dma
->irq
);
196 if (omap_lcd
->dma
->dual
)
197 omap_lcd
->dma
->current_frame
^= 1;
199 if (!ds_get_bits_per_pixel(omap_lcd
->state
))
203 height
= omap_lcd
->height
;
204 if (omap_lcd
->subpanel
& (1 << 31)) {
205 if (omap_lcd
->subpanel
& (1 << 29))
206 first
= (omap_lcd
->subpanel
>> 16) & 0x3ff;
208 height
= (omap_lcd
->subpanel
>> 16) & 0x3ff;
209 /* TODO: fill the rest of the panel with DPD */
212 step
= width
* bpp
>> 3;
213 linesize
= ds_get_linesize(omap_lcd
->state
);
214 framebuffer_update_display(omap_lcd
->state
, omap_lcd
->sysmem
,
215 frame_base
, width
, height
,
217 omap_lcd
->invalidate
,
218 draw_line
, omap_lcd
->palette
,
221 dpy_gfx_update(omap_lcd
->state
, 0, first
, width
, last
- first
+ 1);
223 omap_lcd
->invalidate
= 0;
226 static void omap_ppm_save(const char *filename
, uint8_t *data
,
227 int w
, int h
, int linesize
, Error
**errp
)
234 f
= fopen(filename
, "wb");
236 error_setg(errp
, "failed to open file '%s': %s", filename
,
240 ret
= fprintf(f
, "P6\n%d %d\n%d\n", w
, h
, 255);
246 for (y
= 0; y
< h
; y
++) {
248 for (x
= 0; x
< w
; x
++) {
252 ret
= fputc((v
>> 8) & 0xf8, f
);
256 ret
= fputc((v
>> 3) & 0xfc, f
);
260 ret
= fputc((v
<< 3) & 0xf8, f
);
268 ret
= fputc((v
>> 16) & 0xff, f
);
272 ret
= fputc((v
>> 8) & 0xff, f
);
276 ret
= fputc((v
) & 0xff, f
);
291 error_setg(errp
, "failed to write to file '%s': %s", filename
,
297 static void omap_screen_dump(void *opaque
, const char *filename
, bool cswitch
,
300 struct omap_lcd_panel_s
*omap_lcd
= opaque
;
302 omap_update_display(opaque
);
303 if (omap_lcd
&& ds_get_data(omap_lcd
->state
))
304 omap_ppm_save(filename
, ds_get_data(omap_lcd
->state
),
305 omap_lcd
->width
, omap_lcd
->height
,
306 ds_get_linesize(omap_lcd
->state
), errp
);
309 static void omap_invalidate_display(void *opaque
) {
310 struct omap_lcd_panel_s
*omap_lcd
= opaque
;
311 omap_lcd
->invalidate
= 1;
314 static void omap_lcd_update(struct omap_lcd_panel_s
*s
) {
316 s
->dma
->current_frame
= -1;
320 omap_lcd_interrupts(s
);
324 if (s
->dma
->current_frame
== -1) {
327 s
->dma
->current_frame
= 0;
330 if (!s
->dma
->mpu
->port
[s
->dma
->src
].addr_valid(s
->dma
->mpu
,
331 s
->dma
->src_f1_top
) ||
333 s
->dma
->src
].addr_valid(s
->dma
->mpu
,
334 s
->dma
->src_f1_bottom
) ||
337 s
->dma
->src
].addr_valid(s
->dma
->mpu
,
338 s
->dma
->src_f2_top
) ||
340 s
->dma
->src
].addr_valid(s
->dma
->mpu
,
341 s
->dma
->src_f2_bottom
)))) {
342 s
->dma
->condition
|= 1 << 2;
343 if (s
->dma
->interrupts
& (1 << 1))
344 qemu_irq_raise(s
->dma
->irq
);
349 s
->dma
->phys_framebuffer
[0] = s
->dma
->src_f1_top
;
350 s
->dma
->phys_framebuffer
[1] = s
->dma
->src_f2_top
;
352 if (s
->plm
!= 2 && !s
->palette_done
) {
353 cpu_physical_memory_read(
354 s
->dma
->phys_framebuffer
[s
->dma
->current_frame
],
355 (void *)s
->palette
, 0x200);
357 omap_lcd_interrupts(s
);
361 static uint64_t omap_lcdc_read(void *opaque
, hwaddr addr
,
364 struct omap_lcd_panel_s
*s
= (struct omap_lcd_panel_s
*) opaque
;
367 case 0x00: /* LCD_CONTROL */
368 return (s
->tft
<< 23) | (s
->plm
<< 20) |
369 (s
->tft
<< 7) | (s
->interrupts
<< 3) |
370 (s
->mono
<< 1) | s
->enable
| s
->ctrl
| 0xfe000c34;
372 case 0x04: /* LCD_TIMING0 */
373 return (s
->timing
[0] << 10) | (s
->width
- 1) | 0x0000000f;
375 case 0x08: /* LCD_TIMING1 */
376 return (s
->timing
[1] << 10) | (s
->height
- 1);
378 case 0x0c: /* LCD_TIMING2 */
379 return s
->timing
[2] | 0xfc000000;
381 case 0x10: /* LCD_STATUS */
382 return (s
->palette_done
<< 6) | (s
->sync_error
<< 2) | s
->frame_done
;
384 case 0x14: /* LCD_SUBPANEL */
394 static void omap_lcdc_write(void *opaque
, hwaddr addr
,
395 uint64_t value
, unsigned size
)
397 struct omap_lcd_panel_s
*s
= (struct omap_lcd_panel_s
*) opaque
;
400 case 0x00: /* LCD_CONTROL */
401 s
->plm
= (value
>> 20) & 3;
402 s
->tft
= (value
>> 7) & 1;
403 s
->interrupts
= (value
>> 3) & 3;
404 s
->mono
= (value
>> 1) & 1;
405 s
->ctrl
= value
& 0x01cff300;
406 if (s
->enable
!= (value
& 1)) {
407 s
->enable
= value
& 1;
412 case 0x04: /* LCD_TIMING0 */
413 s
->timing
[0] = value
>> 10;
414 s
->width
= (value
& 0x3ff) + 1;
417 case 0x08: /* LCD_TIMING1 */
418 s
->timing
[1] = value
>> 10;
419 s
->height
= (value
& 0x3ff) + 1;
422 case 0x0c: /* LCD_TIMING2 */
423 s
->timing
[2] = value
;
426 case 0x10: /* LCD_STATUS */
429 case 0x14: /* LCD_SUBPANEL */
430 s
->subpanel
= value
& 0xa1ffffff;
438 static const MemoryRegionOps omap_lcdc_ops
= {
439 .read
= omap_lcdc_read
,
440 .write
= omap_lcdc_write
,
441 .endianness
= DEVICE_NATIVE_ENDIAN
,
444 void omap_lcdc_reset(struct omap_lcd_panel_s
*s
)
446 s
->dma
->current_frame
= -1;
466 struct omap_lcd_panel_s
*omap_lcdc_init(MemoryRegion
*sysmem
,
469 struct omap_dma_lcd_channel_s
*dma
,
472 struct omap_lcd_panel_s
*s
= (struct omap_lcd_panel_s
*)
473 g_malloc0(sizeof(struct omap_lcd_panel_s
));
480 memory_region_init_io(&s
->iomem
, &omap_lcdc_ops
, s
, "omap.lcdc", 0x100);
481 memory_region_add_subregion(sysmem
, base
, &s
->iomem
);
483 s
->state
= graphic_console_init(omap_update_display
,
484 omap_invalidate_display
,
485 omap_screen_dump
, NULL
, s
);