vmport.c 4.3 KB

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