1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24#include "qemu/osdep.h"
25#include "qemu/units.h"
26#include "hw/hw.h"
27#include "hw/display/vga.h"
28#include "vga_int.h"
29#include "ui/pixel_ops.h"
30
31#define VGA_RAM_SIZE (8 * MiB)
32
33typedef struct ISAVGAMMState {
34 VGACommonState vga;
35 int it_shift;
36} ISAVGAMMState;
37
38
39static uint32_t vga_mm_readb (void *opaque, hwaddr addr)
40{
41 ISAVGAMMState *s = opaque;
42
43 return vga_ioport_read(&s->vga, addr >> s->it_shift) & 0xff;
44}
45
46static void vga_mm_writeb (void *opaque,
47 hwaddr addr, uint32_t value)
48{
49 ISAVGAMMState *s = opaque;
50
51 vga_ioport_write(&s->vga, addr >> s->it_shift, value & 0xff);
52}
53
54static uint32_t vga_mm_readw (void *opaque, hwaddr addr)
55{
56 ISAVGAMMState *s = opaque;
57
58 return vga_ioport_read(&s->vga, addr >> s->it_shift) & 0xffff;
59}
60
61static void vga_mm_writew (void *opaque,
62 hwaddr addr, uint32_t value)
63{
64 ISAVGAMMState *s = opaque;
65
66 vga_ioport_write(&s->vga, addr >> s->it_shift, value & 0xffff);
67}
68
69static uint32_t vga_mm_readl (void *opaque, hwaddr addr)
70{
71 ISAVGAMMState *s = opaque;
72
73 return vga_ioport_read(&s->vga, addr >> s->it_shift);
74}
75
76static void vga_mm_writel (void *opaque,
77 hwaddr addr, uint32_t value)
78{
79 ISAVGAMMState *s = opaque;
80
81 vga_ioport_write(&s->vga, addr >> s->it_shift, value);
82}
83
84static const MemoryRegionOps vga_mm_ctrl_ops = {
85 .old_mmio = {
86 .read = {
87 vga_mm_readb,
88 vga_mm_readw,
89 vga_mm_readl,
90 },
91 .write = {
92 vga_mm_writeb,
93 vga_mm_writew,
94 vga_mm_writel,
95 },
96 },
97 .endianness = DEVICE_NATIVE_ENDIAN,
98};
99
100static void vga_mm_init(ISAVGAMMState *s, hwaddr vram_base,
101 hwaddr ctrl_base, int it_shift,
102 MemoryRegion *address_space)
103{
104 MemoryRegion *s_ioport_ctrl, *vga_io_memory;
105
106 s->it_shift = it_shift;
107 s_ioport_ctrl = g_malloc(sizeof(*s_ioport_ctrl));
108 memory_region_init_io(s_ioport_ctrl, NULL, &vga_mm_ctrl_ops, s,
109 "vga-mm-ctrl", 0x100000);
110 memory_region_set_flush_coalesced(s_ioport_ctrl);
111
112 vga_io_memory = g_malloc(sizeof(*vga_io_memory));
113
114 memory_region_init_io(vga_io_memory, NULL, &vga_mem_ops, &s->vga,
115 "vga-mem", 0x20000);
116
117 vmstate_register(NULL, 0, &vmstate_vga_common, s);
118
119 memory_region_add_subregion(address_space, ctrl_base, s_ioport_ctrl);
120 s->vga.bank_offset = 0;
121 memory_region_add_subregion(address_space,
122 vram_base + 0x000a0000, vga_io_memory);
123 memory_region_set_coalescing(vga_io_memory);
124}
125
126int isa_vga_mm_init(hwaddr vram_base,
127 hwaddr ctrl_base, int it_shift,
128 MemoryRegion *address_space)
129{
130 ISAVGAMMState *s;
131
132 s = g_malloc0(sizeof(*s));
133
134 s->vga.vram_size_mb = VGA_RAM_SIZE / MiB;
135 s->vga.global_vmstate = true;
136 vga_common_init(&s->vga, NULL);
137 vga_mm_init(s, vram_base, ctrl_base, it_shift, address_space);
138
139 s->vga.con = graphic_console_init(NULL, 0, s->vga.hw_ops, s);
140
141 vga_init_vbe(&s->vga, NULL, address_space);
142 return 0;
143}
144