|
|
1.1 root 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 "hw.h"
25: #include "isa.h"
26: #include "pc.h"
1.1.1.3 root 27: #include "kvm.h"
1.1.1.4 root 28: #include "qdev.h"
1.1 root 29:
1.1.1.2 root 30: //#define VMPORT_DEBUG
31:
1.1 root 32: #define VMPORT_CMD_GETVERSION 0x0a
33: #define VMPORT_CMD_GETRAMSIZE 0x14
34:
35: #define VMPORT_ENTRIES 0x2c
36: #define VMPORT_MAGIC 0x564D5868
37:
38: typedef struct _VMPortState
39: {
1.1.1.4 root 40: ISADevice dev;
1.1.1.5 ! root 41: MemoryRegion io;
1.1 root 42: IOPortReadFunc *func[VMPORT_ENTRIES];
43: void *opaque[VMPORT_ENTRIES];
44: } VMPortState;
45:
1.1.1.4 root 46: static VMPortState *port_state;
1.1 root 47:
48: void vmport_register(unsigned char command, IOPortReadFunc *func, void *opaque)
49: {
50: if (command >= VMPORT_ENTRIES)
51: return;
52:
1.1.1.4 root 53: port_state->func[command] = func;
54: port_state->opaque[command] = opaque;
1.1 root 55: }
56:
57: static uint32_t vmport_ioport_read(void *opaque, uint32_t addr)
58: {
59: VMPortState *s = opaque;
1.1.1.2 root 60: CPUState *env = cpu_single_env;
1.1 root 61: unsigned char command;
62: uint32_t eax;
63:
1.1.1.3 root 64: cpu_synchronize_state(env);
65:
1.1.1.2 root 66: eax = env->regs[R_EAX];
1.1 root 67: if (eax != VMPORT_MAGIC)
68: return eax;
69:
1.1.1.2 root 70: command = env->regs[R_ECX];
1.1 root 71: if (command >= VMPORT_ENTRIES)
72: return eax;
73: if (!s->func[command])
74: {
1.1.1.2 root 75: #ifdef VMPORT_DEBUG
76: fprintf(stderr, "vmport: unknown command %x\n", command);
77: #endif
1.1 root 78: return eax;
79: }
80:
81: return s->func[command](s->opaque[command], addr);
82: }
83:
1.1.1.2 root 84: static void vmport_ioport_write(void *opaque, uint32_t addr, uint32_t val)
85: {
86: CPUState *env = cpu_single_env;
87:
88: env->regs[R_EAX] = vmport_ioport_read(opaque, addr);
89: }
90:
1.1 root 91: static uint32_t vmport_cmd_get_version(void *opaque, uint32_t addr)
92: {
1.1.1.2 root 93: CPUState *env = cpu_single_env;
1.1 root 94: env->regs[R_EBX] = VMPORT_MAGIC;
95: return 6;
96: }
97:
98: static uint32_t vmport_cmd_ram_size(void *opaque, uint32_t addr)
99: {
1.1.1.2 root 100: CPUState *env = cpu_single_env;
1.1 root 101: env->regs[R_EBX] = 0x1177;
102: return ram_size;
103: }
104:
1.1.1.4 root 105: /* vmmouse helpers */
106: void vmmouse_get_data(uint32_t *data)
1.1 root 107: {
1.1.1.4 root 108: CPUState *env = cpu_single_env;
109:
110: data[0] = env->regs[R_EAX]; data[1] = env->regs[R_EBX];
111: data[2] = env->regs[R_ECX]; data[3] = env->regs[R_EDX];
112: data[4] = env->regs[R_ESI]; data[5] = env->regs[R_EDI];
113: }
114:
115: void vmmouse_set_data(const uint32_t *data)
116: {
117: CPUState *env = cpu_single_env;
118:
119: env->regs[R_EAX] = data[0]; env->regs[R_EBX] = data[1];
120: env->regs[R_ECX] = data[2]; env->regs[R_EDX] = data[3];
121: env->regs[R_ESI] = data[4]; env->regs[R_EDI] = data[5];
122: }
123:
1.1.1.5 ! root 124: static const MemoryRegionPortio vmport_portio[] = {
! 125: {0, 1, 4, .read = vmport_ioport_read, .write = vmport_ioport_write },
! 126: PORTIO_END_OF_LIST(),
! 127: };
! 128:
! 129: static const MemoryRegionOps vmport_ops = {
! 130: .old_portio = vmport_portio
! 131: };
! 132:
1.1.1.4 root 133: static int vmport_initfn(ISADevice *dev)
134: {
135: VMPortState *s = DO_UPCAST(VMPortState, dev, dev);
1.1 root 136:
1.1.1.5 ! root 137: memory_region_init_io(&s->io, &vmport_ops, s, "vmport", 1);
! 138: isa_register_ioport(dev, &s->io, 0x5658);
! 139:
1.1.1.4 root 140: port_state = s;
1.1 root 141: /* Register some generic port commands */
1.1.1.2 root 142: vmport_register(VMPORT_CMD_GETVERSION, vmport_cmd_get_version, NULL);
143: vmport_register(VMPORT_CMD_GETRAMSIZE, vmport_cmd_ram_size, NULL);
1.1.1.4 root 144: return 0;
145: }
146:
147: static ISADeviceInfo vmport_info = {
148: .qdev.name = "vmport",
149: .qdev.size = sizeof(VMPortState),
150: .qdev.no_user = 1,
151: .init = vmport_initfn,
152: };
153:
154: static void vmport_dev_register(void)
155: {
156: isa_qdev_register(&vmport_info);
1.1 root 157: }
1.1.1.4 root 158: device_init(vmport_dev_register)
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.