/* * QEMU model of the Milkymist VGA framebuffer. * * Copyright (c) 2010-2012 Michael Walle <michael@walle.cc> * * This library is free software; you can redistribute it and/or * modify it under the terms of the GNU Lesser General Public * License as published by the Free Software Foundation; either * version 2 of the License, or (at your option) any later version. * * This library is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU * Lesser General Public License for more details. * * You should have received a copy of the GNU Lesser General Public * License along with this library; if not, see <http://www.gnu.org/licenses/>. * * * Specification available at: * http://www.milkymist.org/socdoc/vgafb.pdf */ #include "hw/hw.h" #include "hw/sysbus.h" #include "trace.h" #include "ui/console.h" #include "hw/framebuffer.h" #include "ui/pixel_ops.h" #include "qemu/error-report.h" #define BITS 8 #include "hw/milkymist-vgafb_template.h" #define BITS 15 #include "hw/milkymist-vgafb_template.h" #define BITS 16 #include "hw/milkymist-vgafb_template.h" #define BITS 24 #include "hw/milkymist-vgafb_template.h" #define BITS 32 #include "hw/milkymist-vgafb_template.h" enum { R_CTRL = 0, R_HRES, R_HSYNC_START, R_HSYNC_END, R_HSCAN, R_VRES, R_VSYNC_START, R_VSYNC_END, R_VSCAN, R_BASEADDRESS, R_BASEADDRESS_ACT, R_BURST_COUNT, R_DDC, R_SOURCE_CLOCK, R_MAX }; enum { CTRL_RESET = (1<<0), }; struct MilkymistVgafbState { SysBusDevice busdev; MemoryRegion regs_region; QemuConsole *con; int invalidate; uint32_t fb_offset; uint32_t fb_mask; uint32_t regs[R_MAX]; }; typedef struct MilkymistVgafbState MilkymistVgafbState; static int vgafb_enabled(MilkymistVgafbState *s) { return !(s->regs[R_CTRL] & CTRL_RESET); } static void vgafb_update_display(void *opaque) { MilkymistVgafbState *s = opaque; DisplaySurface *surface = qemu_console_surface(s->con); int first = 0; int last = 0; drawfn fn; if (!vgafb_enabled(s)) { return; } int dest_width = s->regs[R_HRES]; switch (surface_bits_per_pixel(surface)) { case 0: return; case 8: fn = draw_line_8; break; case 15: fn = draw_line_15; dest_width *= 2; break; case 16: fn = draw_line_16; dest_width *= 2; break; case 24: fn = draw_line_24; dest_width *= 3; break; case 32: fn = draw_line_32; dest_width *= 4; break; default: hw_error("milkymist_vgafb: bad color depth\n"); break; } framebuffer_update_display(surface, sysbus_address_space(&s->busdev), s->regs[R_BASEADDRESS] + s->fb_offset, s->regs[R_HRES], s->regs[R_VRES], s->regs[R_HRES] * 2, dest_width, 0, s->invalidate, fn, NULL, &first, &last); if (first >= 0) { dpy_gfx_update(s->con, 0, first, s->regs[R_HRES], last - first + 1); } s->invalidate = 0; } static void vgafb_invalidate_display(void *opaque) { MilkymistVgafbState *s = opaque; s->invalidate = 1; } static void vgafb_resize(MilkymistVgafbState *s) { if (!vgafb_enabled(s)) { return; } qemu_console_resize(s->con, s->regs[R_HRES], s->regs[R_VRES]); s->invalidate = 1; } static uint64_t vgafb_read(void *opaque, hwaddr addr, unsigned size) { MilkymistVgafbState *s = opaque; uint32_t r = 0; addr >>= 2; switch (addr) { case R_CTRL: case R_HRES: case R_HSYNC_START: case R_HSYNC_END: case R_HSCAN: case R_VRES: case R_VSYNC_START: case R_VSYNC_END: case R_VSCAN: case R_BASEADDRESS: case R_BURST_COUNT: case R_DDC: case R_SOURCE_CLOCK: r = s->regs[addr]; break; case R_BASEADDRESS_ACT: r = s->regs[R_BASEADDRESS]; break; default: error_report("milkymist_vgafb: read access to unknown register 0x" TARGET_FMT_plx, addr << 2); break; } trace_milkymist_vgafb_memory_read(addr << 2, r); return r; } static void vgafb_write(void *opaque, hwaddr addr, uint64_t value, unsigned size) { MilkymistVgafbState *s = opaque; trace_milkymist_vgafb_memory_write(addr, value); addr >>= 2; switch (addr) { case R_CTRL: s->regs[addr] = value; vgafb_resize(s); break; case R_HSYNC_START: case R_HSYNC_END: case R_HSCAN: case R_VSYNC_START: case R_VSYNC_END: case R_VSCAN: case R_BURST_COUNT: case R_DDC: case R_SOURCE_CLOCK: s->regs[addr] = value; break; case R_BASEADDRESS: if (value & 0x1f) { error_report("milkymist_vgafb: framebuffer base address have to " "be 32 byte aligned"); break; } s->regs[addr] = value & s->fb_mask; s->invalidate = 1; break; case R_HRES: case R_VRES: s->regs[addr] = value; vgafb_resize(s); break; case R_BASEADDRESS_ACT: error_report("milkymist_vgafb: write to read-only register 0x" TARGET_FMT_plx, addr << 2); break; default: error_report("milkymist_vgafb: write access to unknown register 0x" TARGET_FMT_plx, addr << 2); break; } } static const MemoryRegionOps vgafb_mmio_ops = { .read = vgafb_read, .write = vgafb_write, .valid = { .min_access_size = 4, .max_access_size = 4, }, .endianness = DEVICE_NATIVE_ENDIAN, }; static void milkymist_vgafb_reset(DeviceState *d) { MilkymistVgafbState *s = container_of(d, MilkymistVgafbState, busdev.qdev); int i; for (i = 0; i < R_MAX; i++) { s->regs[i] = 0; } /* defaults */ s->regs[R_CTRL] = CTRL_RESET; s->regs[R_HRES] = 640; s->regs[R_VRES] = 480; s->regs[R_BASEADDRESS] = 0; } static int milkymist_vgafb_init(SysBusDevice *dev) { MilkymistVgafbState *s = FROM_SYSBUS(typeof(*s), dev); memory_region_init_io(&s->regs_region, &vgafb_mmio_ops, s, "milkymist-vgafb", R_MAX * 4); sysbus_init_mmio(dev, &s->regs_region); s->con = graphic_console_init(vgafb_update_display, vgafb_invalidate_display, NULL, NULL, s); return 0; } static int vgafb_post_load(void *opaque, int version_id) { vgafb_invalidate_display(opaque); return 0; } static const VMStateDescription vmstate_milkymist_vgafb = { .name = "milkymist-vgafb", .version_id = 1, .minimum_version_id = 1, .minimum_version_id_old = 1, .post_load = vgafb_post_load, .fields = (VMStateField[]) { VMSTATE_UINT32_ARRAY(regs, MilkymistVgafbState, R_MAX), VMSTATE_END_OF_LIST() } }; static Property milkymist_vgafb_properties[] = { DEFINE_PROP_UINT32("fb_offset", MilkymistVgafbState, fb_offset, 0x0), DEFINE_PROP_UINT32("fb_mask", MilkymistVgafbState, fb_mask, 0xffffffff), DEFINE_PROP_END_OF_LIST(), }; static void milkymist_vgafb_class_init(ObjectClass *klass, void *data) { DeviceClass *dc = DEVICE_CLASS(klass); SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass); k->init = milkymist_vgafb_init; dc->reset = milkymist_vgafb_reset; dc->vmsd = &vmstate_milkymist_vgafb; dc->props = milkymist_vgafb_properties; } static const TypeInfo milkymist_vgafb_info = { .name = "milkymist-vgafb", .parent = TYPE_SYS_BUS_DEVICE, .instance_size = sizeof(MilkymistVgafbState), .class_init = milkymist_vgafb_class_init, }; static void milkymist_vgafb_register_types(void) { type_register_static(&milkymist_vgafb_info); } type_init(milkymist_vgafb_register_types)