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