19010e4843b563818d00d574085d87eb90791516
[sdk/emulator/qemu.git] / hw / 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 "hw.h"
25 #include "isa.h"
26 #include "pc.h"
27 #include "sysemu.h"
28 #include "kvm.h"
29 #include "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 typedef struct _VMPortState
40 {
41     ISADevice dev;
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 uint32_t vmport_ioport_read(void *opaque, uint32_t addr)
58 {
59     VMPortState *s = opaque;
60     CPUState *env = cpu_single_env;
61     unsigned char command;
62     uint32_t eax;
63
64     cpu_synchronize_state(env);
65
66     eax = env->regs[R_EAX];
67     if (eax != VMPORT_MAGIC)
68         return eax;
69
70     command = env->regs[R_ECX];
71     if (command >= VMPORT_ENTRIES)
72         return eax;
73     if (!s->func[command])
74     {
75 #ifdef VMPORT_DEBUG
76         fprintf(stderr, "vmport: unknown command %x\n", command);
77 #endif
78         return eax;
79     }
80
81     return s->func[command](s->opaque[command], addr);
82 }
83
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
91 static uint32_t vmport_cmd_get_version(void *opaque, uint32_t addr)
92 {
93     CPUState *env = cpu_single_env;
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 {
100     CPUState *env = cpu_single_env;
101     env->regs[R_EBX] = 0x1177;
102     return ram_size;
103 }
104
105 /* vmmouse helpers */
106 void vmmouse_get_data(uint32_t *data)
107 {
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
124 static int vmport_initfn(ISADevice *dev)
125 {
126     VMPortState *s = DO_UPCAST(VMPortState, dev, dev);
127
128     register_ioport_read(0x5658, 1, 4, vmport_ioport_read, s);
129     register_ioport_write(0x5658, 1, 4, vmport_ioport_write, s);
130     isa_init_ioport(dev, 0x5658);
131     port_state = s;
132     /* Register some generic port commands */
133     vmport_register(VMPORT_CMD_GETVERSION, vmport_cmd_get_version, NULL);
134     vmport_register(VMPORT_CMD_GETRAMSIZE, vmport_cmd_ram_size, NULL);
135     return 0;
136 }
137
138 static ISADeviceInfo vmport_info = {
139     .qdev.name     = "vmport",
140     .qdev.size     = sizeof(VMPortState),
141     .qdev.no_user  = 1,
142     .init          = vmport_initfn,
143 };
144
145 static void vmport_dev_register(void)
146 {
147     isa_qdev_register(&vmport_info);
148 }
149 device_init(vmport_dev_register)