LXR qemu/hw/misc/vmport.c

   1/*
   2 * QEMU VMPort emulation
   3 *
   4 * Copyright (C) 2007 Hervé Poussineau
   5 *
   6 * Permission is hereby granted, free of charge, to any person obtaining a copy
   7 * of this software and associated documentation files (the "Software"), to deal
   8 * in the Software without restriction, including without limitation the rights
   9 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  10 * copies of the Software, and to permit persons to whom the Software is
  11 * furnished to do so, subject to the following conditions:
  12 *
  13 * The above copyright notice and this permission notice shall be included in
  14 * all copies or substantial portions of the Software.
  15 *
  16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  19 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  20 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  21 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  22 * THE SOFTWARE.
  23 */
  24#include "qemu/osdep.h"
  25#include "hw/hw.h"
  26#include "hw/isa/isa.h"
  27#include "hw/i386/pc.h"
  28#include "sysemu/kvm.h"
  29#include "hw/qdev.h"
  30
  31//#define VMPORT_DEBUG
  32
  33#define VMPORT_CMD_GETVERSION 0x0a
  34#define VMPORT_CMD_GETRAMSIZE 0x14
  35
  36#define VMPORT_ENTRIES 0x2c
  37#define VMPORT_MAGIC   0x564D5868
  38
  39#define TYPE_VMPORT "vmport"
  40#define VMPORT(obj) OBJECT_CHECK(VMPortState, (obj), TYPE_VMPORT)
  41
  42typedef struct VMPortState
  43{
  44    ISADevice parent_obj;
  45
  46    MemoryRegion io;
  47    VMPortReadFunc *func[VMPORT_ENTRIES];
  48    void *opaque[VMPORT_ENTRIES];
  49} VMPortState;
  50
  51static VMPortState *port_state;
  52
  53void vmport_register(unsigned char command, VMPortReadFunc *func, void *opaque)
  54{
  55    if (command >= VMPORT_ENTRIES)
  56        return;
  57
  58    port_state->func[command] = func;
  59    port_state->opaque[command] = opaque;
  60}
  61
  62static uint64_t vmport_ioport_read(void *opaque, hwaddr addr,
  63                                   unsigned size)
  64{
  65    VMPortState *s = opaque;
  66    CPUState *cs = current_cpu;
  67    X86CPU *cpu = X86_CPU(cs);
  68    CPUX86State *env = &cpu->env;
  69    unsigned char command;
  70    uint32_t eax;
  71
  72    cpu_synchronize_state(cs);
  73
  74    eax = env->regs[R_EAX];
  75    if (eax != VMPORT_MAGIC)
  76        return eax;
  77
  78    command = env->regs[R_ECX];
  79    if (command >= VMPORT_ENTRIES)
  80        return eax;
  81    if (!s->func[command])
  82    {
  83#ifdef VMPORT_DEBUG
  84        fprintf(stderr, "vmport: unknown command %x\n", command);
  85#endif
  86        return eax;
  87    }
  88
  89    return s->func[command](s->opaque[command], addr);
  90}
  91
  92static void vmport_ioport_write(void *opaque, hwaddr addr,
  93                                uint64_t val, unsigned size)
  94{
  95    X86CPU *cpu = X86_CPU(current_cpu);
  96
  97    cpu->env.regs[R_EAX] = vmport_ioport_read(opaque, addr, 4);
  98}
  99
 100static uint32_t vmport_cmd_get_version(void *opaque, uint32_t addr)
 101{
 102    X86CPU *cpu = X86_CPU(current_cpu);
 103
 104    cpu->env.regs[R_EBX] = VMPORT_MAGIC;
 105    return 6;
 106}
 107
 108static uint32_t vmport_cmd_ram_size(void *opaque, uint32_t addr)
 109{
 110    X86CPU *cpu = X86_CPU(current_cpu);
 111
 112    cpu->env.regs[R_EBX] = 0x1177;
 113    return ram_size;
 114}
 115
 116/* vmmouse helpers */
 117void vmmouse_get_data(uint32_t *data)
 118{
 119    X86CPU *cpu = X86_CPU(current_cpu);
 120    CPUX86State *env = &cpu->env;
 121
 122    data[0] = env->regs[R_EAX]; data[1] = env->regs[R_EBX];
 123    data[2] = env->regs[R_ECX]; data[3] = env->regs[R_EDX];
 124    data[4] = env->regs[R_ESI]; data[5] = env->regs[R_EDI];
 125}
 126
 127void vmmouse_set_data(const uint32_t *data)
 128{
 129    X86CPU *cpu = X86_CPU(current_cpu);
 130    CPUX86State *env = &cpu->env;
 131
 132    env->regs[R_EAX] = data[0]; env->regs[R_EBX] = data[1];
 133    env->regs[R_ECX] = data[2]; env->regs[R_EDX] = data[3];
 134    env->regs[R_ESI] = data[4]; env->regs[R_EDI] = data[5];
 135}
 136
 137static const MemoryRegionOps vmport_ops = {
 138    .read = vmport_ioport_read,
 139    .write = vmport_ioport_write,
 140    .impl = {
 141        .min_access_size = 4,
 142        .max_access_size = 4,
 143    },
 144    .endianness = DEVICE_LITTLE_ENDIAN,
 145};
 146
 147static void vmport_realizefn(DeviceState *dev, Error **errp)
 148{
 149    ISADevice *isadev = ISA_DEVICE(dev);
 150    VMPortState *s = VMPORT(dev);
 151
 152    memory_region_init_io(&s->io, OBJECT(s), &vmport_ops, s, "vmport", 1);
 153    isa_register_ioport(isadev, &s->io, 0x5658);
 154
 155    port_state = s;
 156    /* Register some generic port commands */
 157    vmport_register(VMPORT_CMD_GETVERSION, vmport_cmd_get_version, NULL);
 158    vmport_register(VMPORT_CMD_GETRAMSIZE, vmport_cmd_ram_size, NULL);
 159}
 160
 161static void vmport_class_initfn(ObjectClass *klass, void *data)
 162{
 163    DeviceClass *dc = DEVICE_CLASS(klass);
 164
 165    dc->realize = vmport_realizefn;
 166    /* Reason: realize sets global port_state */
 167    dc->cannot_instantiate_with_device_add_yet = true;
 168}
 169
 170static const TypeInfo vmport_info = {
 171    .name          = TYPE_VMPORT,
 172    .parent        = TYPE_ISA_DEVICE,
 173    .instance_size = sizeof(VMPortState),
 174    .class_init    = vmport_class_initfn,
 175};
 176
 177static void vmport_register_types(void)
 178{
 179    type_register_static(&vmport_info);
 180}
 181
 182type_init(vmport_register_types)
 183