]>
Commit | Line | Data |
---|---|---|
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" | |
27 | #include "sysemu/kvm.h" | |
28 | #include "qdev.h" | |
29 | ||
30 | //#define VMPORT_DEBUG | |
31 | ||
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 | { | |
40 | ISADevice dev; | |
41 | MemoryRegion io; | |
42 | IOPortReadFunc *func[VMPORT_ENTRIES]; | |
43 | void *opaque[VMPORT_ENTRIES]; | |
44 | } VMPortState; | |
45 | ||
46 | static VMPortState *port_state; | |
47 | ||
48 | void vmport_register(unsigned char command, IOPortReadFunc *func, void *opaque) | |
49 | { | |
50 | if (command >= VMPORT_ENTRIES) | |
51 | return; | |
52 | ||
53 | port_state->func[command] = func; | |
54 | port_state->opaque[command] = opaque; | |
55 | } | |
56 | ||
57 | static uint64_t vmport_ioport_read(void *opaque, hwaddr addr, | |
58 | unsigned size) | |
59 | { | |
60 | VMPortState *s = opaque; | |
61 | CPUX86State *env = cpu_single_env; | |
62 | unsigned char command; | |
63 | uint32_t eax; | |
64 | ||
65 | cpu_synchronize_state(env); | |
66 | ||
67 | eax = env->regs[R_EAX]; | |
68 | if (eax != VMPORT_MAGIC) | |
69 | return eax; | |
70 | ||
71 | command = env->regs[R_ECX]; | |
72 | if (command >= VMPORT_ENTRIES) | |
73 | return eax; | |
74 | if (!s->func[command]) | |
75 | { | |
76 | #ifdef VMPORT_DEBUG | |
77 | fprintf(stderr, "vmport: unknown command %x\n", command); | |
78 | #endif | |
79 | return eax; | |
80 | } | |
81 | ||
82 | return s->func[command](s->opaque[command], addr); | |
83 | } | |
84 | ||
85 | static void vmport_ioport_write(void *opaque, hwaddr addr, | |
86 | uint64_t val, unsigned size) | |
87 | { | |
88 | CPUX86State *env = cpu_single_env; | |
89 | ||
90 | env->regs[R_EAX] = vmport_ioport_read(opaque, addr, 4); | |
91 | } | |
92 | ||
93 | static uint32_t vmport_cmd_get_version(void *opaque, uint32_t addr) | |
94 | { | |
95 | CPUX86State *env = cpu_single_env; | |
96 | env->regs[R_EBX] = VMPORT_MAGIC; | |
97 | return 6; | |
98 | } | |
99 | ||
100 | static uint32_t vmport_cmd_ram_size(void *opaque, uint32_t addr) | |
101 | { | |
102 | CPUX86State *env = cpu_single_env; | |
103 | env->regs[R_EBX] = 0x1177; | |
104 | return ram_size; | |
105 | } | |
106 | ||
107 | /* vmmouse helpers */ | |
108 | void vmmouse_get_data(uint32_t *data) | |
109 | { | |
110 | CPUX86State *env = cpu_single_env; | |
111 | ||
112 | data[0] = env->regs[R_EAX]; data[1] = env->regs[R_EBX]; | |
113 | data[2] = env->regs[R_ECX]; data[3] = env->regs[R_EDX]; | |
114 | data[4] = env->regs[R_ESI]; data[5] = env->regs[R_EDI]; | |
115 | } | |
116 | ||
117 | void vmmouse_set_data(const uint32_t *data) | |
118 | { | |
119 | CPUX86State *env = cpu_single_env; | |
120 | ||
121 | env->regs[R_EAX] = data[0]; env->regs[R_EBX] = data[1]; | |
122 | env->regs[R_ECX] = data[2]; env->regs[R_EDX] = data[3]; | |
123 | env->regs[R_ESI] = data[4]; env->regs[R_EDI] = data[5]; | |
124 | } | |
125 | ||
126 | static const MemoryRegionOps vmport_ops = { | |
127 | .read = vmport_ioport_read, | |
128 | .write = vmport_ioport_write, | |
129 | .impl = { | |
130 | .min_access_size = 4, | |
131 | .max_access_size = 4, | |
132 | }, | |
133 | .endianness = DEVICE_LITTLE_ENDIAN, | |
134 | }; | |
135 | ||
136 | static int vmport_initfn(ISADevice *dev) | |
137 | { | |
138 | VMPortState *s = DO_UPCAST(VMPortState, dev, dev); | |
139 | ||
140 | memory_region_init_io(&s->io, &vmport_ops, s, "vmport", 1); | |
141 | isa_register_ioport(dev, &s->io, 0x5658); | |
142 | ||
143 | port_state = s; | |
144 | /* Register some generic port commands */ | |
145 | vmport_register(VMPORT_CMD_GETVERSION, vmport_cmd_get_version, NULL); | |
146 | vmport_register(VMPORT_CMD_GETRAMSIZE, vmport_cmd_ram_size, NULL); | |
147 | return 0; | |
148 | } | |
149 | ||
150 | static void vmport_class_initfn(ObjectClass *klass, void *data) | |
151 | { | |
152 | DeviceClass *dc = DEVICE_CLASS(klass); | |
153 | ISADeviceClass *ic = ISA_DEVICE_CLASS(klass); | |
154 | ic->init = vmport_initfn; | |
155 | dc->no_user = 1; | |
156 | } | |
157 | ||
158 | static const TypeInfo vmport_info = { | |
159 | .name = "vmport", | |
160 | .parent = TYPE_ISA_DEVICE, | |
161 | .instance_size = sizeof(VMPortState), | |
162 | .class_init = vmport_class_initfn, | |
163 | }; | |
164 | ||
165 | static void vmport_register_types(void) | |
166 | { | |
167 | type_register_static(&vmport_info); | |
168 | } | |
169 | ||
170 | type_init(vmport_register_types) |