[Qemu-devel] [PATCH v2 13/15] pc98mouse: add PC-9821 family bus mouse

[Qemu-devel] [PATCH v2 13/15] pc98mouse: add PC-9821 family bus mouse

[TAKEDA, toshiya]

diff --git a/qemu/hw/pc98mouse.c b/qemu/hw/pc98mouse.c
new file mode 100644
index 0000000..ff94340
--- /dev/null
+++ b/qemu/hw/pc98mouse.c
@@ -0,0 +1,254 @@
+/*
+ * QEMU NEC PC-98x1 bus mouse
+ *
+ * Copyright (c) 2009 TAKEDA, toshiya
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a copy
+ * of this software and associated documentation files (the "Software"), to deal
+ * in the Software without restriction, including without limitation the rights
+ * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
+ * copies of the Software, and to permit persons to whom the Software is
+ * furnished to do so, subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice shall be included in
+ * all copies or substantial portions of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
+ * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+ * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
+ * THE SOFTWARE.
+ */
+#include "hw.h"
+#include "pc.h"
+#include "console.h"
+#include "qemu-timer.h"
+#include "isa.h"
+#include "qdev-addr.h"
+
+static const int64_t mouse_expire[4] = {120, 60, 30, 15};
+
+struct mouse_t {
+    int button;
+    int dx, dy;
+    int lx, ly;
+    uint8_t freq;
+    uint8_t portc;
+
+    QEMUTimer *mouse_timer;
+    qemu_irq irq;
+};
+
+typedef struct mouse_isabus_t {
+    ISADevice busdev;
+    struct mouse_t state;
+} mouse_isabus_t;
+
+typedef struct mouse_t mouse_t;
+
+/* mouse */
+
+static void mouse_timer_handler(void *opaque)
+{
+    mouse_t *s = opaque;
+
+    if (!(s->portc & 0x10)) {
+        qemu_set_irq(s->irq, 1);
+        qemu_set_irq(s->irq, 0);
+    }
+
+    /* set next timer */
+    qemu_mod_timer(s->mouse_timer, qemu_get_clock(vm_clock) +
+                   get_ticks_per_sec() / mouse_expire[s->freq & 3]);
+}
+
+static void mouse_event_handler(void *opaque,
+                                int dx, int dy, int dz, int buttons_state)
+{
+    mouse_t *s = opaque;
+
+    s->button = buttons_state;
+    s->dx += dx;
+    s->dy += dy;
+}
+
+static void mouse_freq_write(void *opaque, uint32_t addr, uint32_t value)
+{
+    mouse_t *s = opaque;
+
+    if(!(value & 0xfc)) {
+        s->freq = value;
+    }
+}
+
+static uint32_t mouse_freq_read(void *opaque, uint32_t addr)
+{
+    mouse_t *s = opaque;
+
+    return s->freq & 3;
+}
+
+/* pio */
+
+static uint32_t pio_porta_read(void *opaque, uint32_t addr)
+{
+    mouse_t *s = opaque;
+    uint32_t val = 0;
+
+    if (!(s->button & 1)) {
+        val |= 0x80;
+    }
+    if (!(s->button & 2)) {
+        val |= 0x40;
+    }
+    if (!(s->button & 4)) {
+        val |= 0x20;
+    }
+    switch (s->portc & 0xe0) {
+    case 0x00:
+        val |= (s->dx >> 0) & 0x0f;
+        break;
+    case 0x20:
+        val |= (s->dx >> 4) & 0x0f;
+        break;
+    case 0x40:
+        val |= (s->dy >> 0) & 0x0f;
+        break;
+    case 0x60:
+        val |= (s->dy >> 4) & 0x0f;
+        break;
+    case 0x80:
+        val |= (s->lx >> 0) & 0x0f;
+        break;
+    case 0xa0:
+        val |= (s->lx >> 4) & 0x0f;
+        break;
+    case 0xc0:
+        val |= (s->ly >> 0) & 0x0f;
+        break;
+    case 0xe0:
+        val |= (s->ly >> 4) & 0x0f;
+        break;
+    }
+    return val;
+}
+
+static uint32_t pio_portb_read(void *opaque, uint32_t addr)
+{
+    return 0xff;
+}
+
+static void pio_portc_write(void *opaque, uint32_t addr, uint32_t value)
+{
+    mouse_t *s = opaque;
+
+    if (!(s->portc & 0x80) && (value & 0x80)) {
+        /* latch mouse count */
+        s->lx = s->dx;
+        s->ly = s->dy;
+        s->dx = s->dy = 0;
+    }
+    s->portc = (uint8_t)value;
+}
+
+static uint32_t pio_portc_read(void *opaque, uint32_t addr)
+{
+    mouse_t *s = opaque;
+
+    return (s->portc & 0xf0) | 0x08;
+}
+
+static void pio_ctrl_write(void *opaque, uint32_t addr, uint32_t value)
+{
+    mouse_t *s = opaque;
+
+    if (!(value & 0x80)) {
+        /* set/reset portc bit */
+        uint8_t portc = s->portc;
+        uint8_t bit = 1 << ((value >> 1) & 7);
+        if (value & 1) {
+            portc |= bit;
+        } else {
+            portc &= ~bit;
+        }
+        pio_portc_write(s, 0, portc);
+    }
+}
+
+/* interface */
+
+static void pc98_mouse_reset(void *opaque)
+{
+    mouse_t *s = opaque;
+
+    s->button = 0;
+    s->dx = s->dy = 0;
+    s->lx = s->ly = -1;
+    s->freq = 0;
+    s->portc = 0xf0;
+
+    qemu_mod_timer(s->mouse_timer, qemu_get_clock(vm_clock) +
+                   get_ticks_per_sec() / mouse_expire[0]);
+}
+
+static int pc98_mouse_pre_load(void *opaque)
+{
+    pc98_mouse_reset(opaque);
+    return 0;
+}
+
+static const VMStateDescription vmstate_mouse = {
+    .name = "pc98-mouse",
+    .version_id = 1,
+    .minimum_version_id = 1,
+    .minimum_version_id_old = 1,
+    .pre_load = pc98_mouse_pre_load,
+    .fields      = (VMStateField []) {
+        VMSTATE_INT32(lx, mouse_t),
+        VMSTATE_INT32(ly, mouse_t),
+        VMSTATE_UINT8(freq, mouse_t),
+        VMSTATE_UINT8(portc, mouse_t),
+        VMSTATE_END_OF_LIST()
+    }
+};
+
+static int pc98_mouse_init1(ISADevice *dev)
+{
+    mouse_isabus_t *isa = DO_UPCAST(mouse_isabus_t, busdev, dev);
+    mouse_t *s = &isa->state;
+    int isairq = 13;
+
+    register_ioport_read(0x7fd9, 1, 1, pio_porta_read, s);
+    register_ioport_read(0x7fdb, 1, 1, pio_portb_read, s);
+    register_ioport_write(0x7fdd, 1, 1, pio_portc_write, s);
+    register_ioport_read(0x7fdd, 1, 1, pio_portc_read, s);
+    register_ioport_write(0x7fdf, 1, 1, pio_ctrl_write, s);
+    register_ioport_write(0xbfdb, 1, 1, mouse_freq_write, s);
+    register_ioport_read(0xbfdb, 1, 1, mouse_freq_read, s);
+
+    isa_init_irq(&isa->busdev, &s->irq, isairq);
+
+    s->mouse_timer = qemu_new_timer(vm_clock, mouse_timer_handler, s);
+    qemu_add_mouse_event_handler(mouse_event_handler, s, 0, "pc98-mouse");
+
+    vmstate_register(-1, &vmstate_mouse, s);
+    pc98_mouse_reset(s);
+    qemu_register_reset(pc98_mouse_reset, s);
+
+    return 0;
+}
+
+static ISADeviceInfo pc98_mouse_info = {
+    .init = pc98_mouse_init1,
+    .qdev.name  = "pc98-mouse",
+    .qdev.size  = sizeof(mouse_isabus_t),
+};
+
+static void pc98_mouse_register_devices(void)
+{
+    isa_qdev_register(&pc98_mouse_info);
+}
+
+device_init(pc98_mouse_register_devices)