2 * QEMU G364 framebuffer Emulator.
4 * Copyright (c) 2007-2008 Hervé Poussineau
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
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
24 #include "pixel_ops.h"
28 typedef struct G364State
{
29 target_phys_addr_t vram_base
;
30 unsigned int vram_size
;
33 uint8_t palette
[256][3];
34 /* display refresh support */
37 uint32_t scr_width
, scr_height
; /* in pixels */
38 uint32_t last_scr_width
, last_scr_height
; /* in pixels */
46 #include "g364fb_template.h"
51 #define PIXEL_WIDTH 16
52 #include "g364fb_template.h"
57 #define PIXEL_WIDTH 16
58 #include "g364fb_template.h"
63 #define PIXEL_WIDTH 32
64 #include "g364fb_template.h"
68 #define REG_DISPLAYX 0x0918
69 #define REG_DISPLAYY 0x0940
71 #define CTLA_FORCE_BLANK 0x400
73 static void g364fb_draw_graphic(G364State
*s
, int full_update
)
75 if (s
->scr_width
== 0 || s
->scr_height
== 0)
77 if (s
->scr_width
!= s
->last_scr_width
78 || s
->scr_height
!= s
->last_scr_height
) {
79 s
->last_scr_width
= s
->scr_width
;
80 s
->last_scr_height
= s
->scr_height
;
81 dpy_resize(s
->ds
, s
->last_scr_width
, s
->last_scr_height
);
85 switch (s
->ds
->depth
) {
87 g364fb_draw_graphic8(s
, full_update
);
90 g364fb_draw_graphic15(s
, full_update
);
93 g364fb_draw_graphic16(s
, full_update
);
96 g364fb_draw_graphic32(s
, full_update
);
99 printf("g364fb: unknown depth %d\n", s
->ds
->depth
);
103 dpy_update(s
->ds
, 0, 0, s
->last_scr_width
, s
->last_scr_height
);
106 static void g364fb_draw_blank(G364State
*s
, int full_update
)
113 if (s
->last_scr_width
<= 0 || s
->last_scr_height
<= 0)
116 w
= s
->last_scr_width
* ((s
->ds
->depth
+ 7) >> 3);
118 for(i
= 0; i
< s
->last_scr_height
; i
++) {
120 d
+= s
->ds
->linesize
;
122 dpy_update(s
->ds
, 0, 0,
123 s
->last_scr_width
, s
->last_scr_height
);
126 #define GMODE_GRAPH 0
127 #define GMODE_BLANK 1
129 static void g364fb_update_display(void *opaque
)
131 G364State
*s
= opaque
;
132 int full_update
, graphic_mode
;
134 if (s
->ctla
& CTLA_FORCE_BLANK
)
135 graphic_mode
= GMODE_BLANK
;
137 graphic_mode
= GMODE_GRAPH
;
139 if (graphic_mode
!= s
->graphic_mode
) {
140 s
->graphic_mode
= graphic_mode
;
143 switch(graphic_mode
) {
145 g364fb_draw_graphic(s
, full_update
);
149 g364fb_draw_blank(s
, full_update
);
154 /* force a full display refresh */
155 static void g364fb_invalidate_display(void *opaque
)
157 G364State
*s
= opaque
;
158 s
->graphic_mode
= -1; /* force full update */
161 static void g364fb_reset(void *opaque
)
163 G364State
*s
= opaque
;
165 memset(s
->palette
, 0, sizeof(s
->palette
));
166 s
->scr_width
= s
->scr_height
= 0;
167 s
->last_scr_width
= s
->last_scr_height
= 0;
168 memset(s
->vram_buffer
, 0, s
->vram_size
);
169 s
->graphic_mode
= -1; /* force full update */
172 static void g364fb_screen_dump(void *opaque
, const char *filename
)
174 G364State
*s
= opaque
;
177 uint8_t *data_buffer
;
180 f
= fopen(filename
, "wb");
184 data_buffer
= s
->vram_buffer
;
185 fprintf(f
, "P6\n%d %d\n%d\n",
186 s
->scr_width
, s
->scr_height
, 255);
187 for(y
= 0; y
< s
->scr_height
; y
++)
188 for(x
= 0; x
< s
->scr_width
; x
++, data_buffer
++) {
189 index
= *data_buffer
;
190 fputc(s
->palette
[index
][0], f
);
191 fputc(s
->palette
[index
][1], f
);
192 fputc(s
->palette
[index
][2], f
);
197 /* called for accesses to io ports */
198 static uint32_t g364fb_ctrl_readb(void *opaque
, target_phys_addr_t addr
)
200 //G364State *s = opaque;
208 printf("g364fb/ctrl: invalid read at [" TARGET_FMT_lx
"]\n", addr
);
215 printf("g364fb/ctrl: read 0x%02x at [" TARGET_FMT_lx
"]\n", val
, addr
);
221 static uint32_t g364fb_ctrl_readw(void *opaque
, target_phys_addr_t addr
)
224 v
= g364fb_ctrl_readb(opaque
, addr
);
225 v
|= g364fb_ctrl_readb(opaque
, addr
+ 1) << 8;
229 static uint32_t g364fb_ctrl_readl(void *opaque
, target_phys_addr_t addr
)
232 v
= g364fb_ctrl_readb(opaque
, addr
);
233 v
|= g364fb_ctrl_readb(opaque
, addr
+ 1) << 8;
234 v
|= g364fb_ctrl_readb(opaque
, addr
+ 2) << 16;
235 v
|= g364fb_ctrl_readb(opaque
, addr
+ 3) << 24;
239 static void g364fb_ctrl_writeb(void *opaque
, target_phys_addr_t addr
, uint32_t val
)
241 G364State
*s
= opaque
;
246 printf("g364fb/ctrl: write 0x%02x at [" TARGET_FMT_lx
"]\n", val
, addr
);
254 s
->palette
[idx
][c
] = (uint8_t)val
;
258 s
->scr_width
= (s
->scr_width
& 0xfffffc03) | (val
<< 2);
260 case REG_DISPLAYX
+ 1:
261 s
->scr_width
= (s
->scr_width
& 0xfffc03ff) | (val
<< 10);
264 s
->scr_height
= (s
->scr_height
& 0xffffff80) | (val
>> 1);
266 case REG_DISPLAYY
+ 1:
267 s
->scr_height
= (s
->scr_height
& 0xffff801f) | (val
<< 7);
271 printf("g364fb/ctrl: invalid write of 0x%02x at [" TARGET_FMT_lx
"]\n", val
, addr
);
278 static void g364fb_ctrl_writew(void *opaque
, target_phys_addr_t addr
, uint32_t val
)
280 g364fb_ctrl_writeb(opaque
, addr
, val
& 0xff);
281 g364fb_ctrl_writeb(opaque
, addr
+ 1, (val
>> 8) & 0xff);
284 static void g364fb_ctrl_writel(void *opaque
, target_phys_addr_t addr
, uint32_t val
)
286 g364fb_ctrl_writeb(opaque
, addr
, val
& 0xff);
287 g364fb_ctrl_writeb(opaque
, addr
+ 1, (val
>> 8) & 0xff);
288 g364fb_ctrl_writeb(opaque
, addr
+ 2, (val
>> 16) & 0xff);
289 g364fb_ctrl_writeb(opaque
, addr
+ 3, (val
>> 24) & 0xff);
292 static CPUReadMemoryFunc
*g364fb_ctrl_read
[3] = {
298 static CPUWriteMemoryFunc
*g364fb_ctrl_write
[3] = {
304 /* called for accesses to video ram */
305 static uint32_t g364fb_mem_readb(void *opaque
, target_phys_addr_t addr
)
307 G364State
*s
= opaque
;
308 target_phys_addr_t relative_addr
= addr
- s
->vram_base
;
310 return s
->vram_buffer
[relative_addr
];
313 static uint32_t g364fb_mem_readw(void *opaque
, target_phys_addr_t addr
)
316 v
= g364fb_mem_readb(opaque
, addr
);
317 v
|= g364fb_mem_readb(opaque
, addr
+ 1) << 8;
321 static uint32_t g364fb_mem_readl(void *opaque
, target_phys_addr_t addr
)
324 v
= g364fb_mem_readb(opaque
, addr
);
325 v
|= g364fb_mem_readb(opaque
, addr
+ 1) << 8;
326 v
|= g364fb_mem_readb(opaque
, addr
+ 2) << 16;
327 v
|= g364fb_mem_readb(opaque
, addr
+ 3) << 24;
331 static void g364fb_mem_writeb(void *opaque
, target_phys_addr_t addr
, uint32_t val
)
333 G364State
*s
= opaque
;
334 target_phys_addr_t relative_addr
= addr
- s
->vram_base
;
336 s
->vram_buffer
[relative_addr
] = val
;
339 static void g364fb_mem_writew(void *opaque
, target_phys_addr_t addr
, uint32_t val
)
341 g364fb_mem_writeb(opaque
, addr
, val
& 0xff);
342 g364fb_mem_writeb(opaque
, addr
+ 1, (val
>> 8) & 0xff);
345 static void g364fb_mem_writel(void *opaque
, target_phys_addr_t addr
, uint32_t val
)
347 g364fb_mem_writeb(opaque
, addr
, val
& 0xff);
348 g364fb_mem_writeb(opaque
, addr
+ 1, (val
>> 8) & 0xff);
349 g364fb_mem_writeb(opaque
, addr
+ 2, (val
>> 16) & 0xff);
350 g364fb_mem_writeb(opaque
, addr
+ 3, (val
>> 24) & 0xff);
353 static CPUReadMemoryFunc
*g364fb_mem_read
[3] = {
359 static CPUWriteMemoryFunc
*g364fb_mem_write
[3] = {
365 int g364fb_mm_init(DisplayState
*ds
,
366 int vram_size
, int it_shift
,
367 target_phys_addr_t vram_base
, target_phys_addr_t ctrl_base
)
370 int io_vram
, io_ctrl
;
372 s
= qemu_mallocz(sizeof(G364State
));
376 s
->vram_size
= vram_size
;
377 s
->vram_buffer
= qemu_mallocz(s
->vram_size
);
379 qemu_register_reset(g364fb_reset
, s
);
383 s
->vram_base
= vram_base
;
385 graphic_console_init(ds
, g364fb_update_display
,
386 g364fb_invalidate_display
, g364fb_screen_dump
,
389 io_vram
= cpu_register_io_memory(0, g364fb_mem_read
, g364fb_mem_write
, s
);
390 cpu_register_physical_memory(s
->vram_base
, vram_size
, io_vram
);
392 io_ctrl
= cpu_register_io_memory(0, g364fb_ctrl_read
, g364fb_ctrl_write
, s
);
393 cpu_register_physical_memory(ctrl_base
, 0x10000, io_ctrl
);