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/hw_accel.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 VMPORT(obj) OBJECT_CHECK(VMPortState, (obj), TYPE_VMPORT) 40 41 typedef struct VMPortState { 42 ISADevice parent_obj; 43 44 MemoryRegion io; 45 VMPortReadFunc *func[VMPORT_ENTRIES]; 46 void *opaque[VMPORT_ENTRIES]; 47 } VMPortState; 48 49 static VMPortState *port_state; 50 51 void vmport_register(unsigned char command, VMPortReadFunc *func, void *opaque) 52 { 53 if (command >= VMPORT_ENTRIES) { 54 return; 55 } 56 57 port_state->func[command] = func; 58 port_state->opaque[command] = opaque; 59 } 60 61 static uint64_t vmport_ioport_read(void *opaque, hwaddr addr, 62 unsigned size) 63 { 64 VMPortState *s = opaque; 65 CPUState *cs = current_cpu; 66 X86CPU *cpu = X86_CPU(cs); 67 CPUX86State *env = &cpu->env; 68 unsigned char command; 69 uint32_t eax; 70 71 cpu_synchronize_state(cs); 72 73 eax = env->regs[R_EAX]; 74 if (eax != VMPORT_MAGIC) { 75 return eax; 76 } 77 78 command = env->regs[R_ECX]; 79 if (command >= VMPORT_ENTRIES) { 80 return eax; 81 } 82 if (!s->func[command]) { 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 92 static 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 100 static 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 108 static 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 */ 117 void 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 127 void 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 137 static 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 147 static 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 161 static 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->user_creatable = false; 168 } 169 170 static 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 177 static void vmport_register_types(void) 178 { 179 type_register_static(&vmport_info); 180 } 181 182 type_init(vmport_register_types) 183