1 #include <geekos/vmm_stubs.h>
2 #include <palacios/vmm.h>
3 #include <geekos/debug.h>
4 #include <geekos/serial.h>
6 #include <geekos/screen.h>
7 #include <palacios/vmm_dev_mgr.h>
8 #include <devices/nvram.h>
9 #include <devices/timer.h>
10 #include <devices/simple_pic.h>
11 #include <palacios/vmm_intr.h>
14 #define SPEAKER_PORT 0x61
19 inline void VM_Out_Byte(ushort_t port, uchar_t value)
21 __asm__ __volatile__ (
24 : "a" (value), "Nd" (port)
29 * Read a byte from an I/O port.
31 inline uchar_t VM_In_Byte(ushort_t port)
35 __asm__ __volatile__ (
46 int IO_Read(ushort_t port, void * dst, uint_t length, void * priv_data) {
52 *(uchar_t*)dst = VM_In_Byte(port);
58 int IO_Write(ushort_t port, void * src, uint_t length, void * priv_data) {
64 VM_Out_Byte(port, *(uchar_t *)src);
70 int IO_Read_to_Serial(ushort_t port, void * dst, uint_t length, void * priv_data) {
71 PrintBoth("Input from Guest on port %d (0x%x) Length=%d\n", port, port, length);
77 char * bochs_debug_buf = NULL;
78 int bochs_debug_offset = 0;
81 int IO_BOCHS_debug(ushort_t port, void * src, uint_t length, void * priv_data) {
82 if (!bochs_debug_buf) {
83 bochs_debug_buf = (char*)Malloc(1024);
86 bochs_debug_buf[bochs_debug_offset++] = *(char*)src;
88 if ((*(char*)src == 0xa) || (bochs_debug_offset == 1023)) {
89 SerialPrint("BOCHS>%s", bochs_debug_buf);
90 memset(bochs_debug_buf, 0, 1024);
91 bochs_debug_offset = 0;
98 int IO_Write_to_Serial(ushort_t port, void * src, uint_t length, void * priv_data) {
99 SerialPrint("Output from Guest on port %d (0x%x) Length=%d\n", port, port, length);
103 SerialPrint(">0x%.2x\n", *(char*)src);
106 SerialPrint(">0x%.4x\n", *(ushort_t*)src);
109 SerialPrint(">0x%.8x\n", *(uint_t*)src);
115 // SerialMemDump(src, length);
128 __asm__ __volatile__ (
134 PrintBoth("Starting To Buzz\n");
136 init=VM_In_Byte(SPEAKER_PORT);
139 VM_Out_Byte(SPEAKER_PORT, init|0x2);
140 for (j=0;j<1000000;j++) {
143 VM_Out_Byte(SPEAKER_PORT, init);
144 for (j=0;j<1000000;j++) {
155 int RunVMM(struct Boot_Info * bootInfo) {
157 struct vmm_os_hooks os_hooks;
158 struct vmm_ctrl_ops vmm_ops;
159 struct guest_info vm_info;
165 memset(&os_hooks, 0, sizeof(struct vmm_os_hooks));
166 memset(&vmm_ops, 0, sizeof(struct vmm_ctrl_ops));
167 memset(&vm_info, 0, sizeof(struct guest_info));
169 os_hooks.print_debug = &SerialPrint;
170 os_hooks.print_info = &Print;
171 os_hooks.print_trace = &SerialPrint;
172 os_hooks.allocate_pages = &Allocate_VMM_Pages;
173 os_hooks.free_page = &Free_VMM_Page;
174 os_hooks.malloc = &VMM_Malloc;
175 os_hooks.free = &VMM_Free;
176 os_hooks.vaddr_to_paddr = &Identity;
177 os_hooks.paddr_to_vaddr = &Identity;
181 Init_VMM(&os_hooks, &vmm_ops);
183 init_shadow_map(&(vm_info.mem_map));
184 init_shadow_page_state(&(vm_info.shdw_pg_state));
185 vm_info.page_mode = SHADOW_PAGING;
187 vm_info.cpu_mode = REAL;
189 //init_irq_map(&(vm_info.irq_map));
190 init_vmm_io_map(&(vm_info.io_map));
191 init_interrupt_state(&vm_info);
193 dev_mgr_init(&(vm_info.dev_mgr));
197 // add_shared_mem_range(&(vm_info.mem_layout), 0, 0x800000, 0x10000);
198 // add_shared_mem_range(&(vm_info.mem_layout), 0, 0x1000000, 0);
200 rip = (ulong_t)(void*)&BuzzVM;
202 // rip = (addr_t)(void*)&exit_test;
205 rsp = (addr_t)Alloc_Page();
207 vm_info.vm_regs.rsp = (rsp +4092 );// - 0x2000;
211 //add_shared_mem_range(&(vm_info.mem_layout), 0x0, 0x1000, 0x100000);
212 // add_shared_mem_range(&(vm_info.mem_layout), 0x0, 0x100000, 0x0);
215 shadow_region_t *ent = Malloc(sizeof(shadow_region_t));;
216 init_shadow_region_physical(ent,0,0x100000,GUEST_REGION_PHYSICAL_MEMORY,
217 0x100000, HOST_REGION_PHYSICAL_MEMORY);
218 add_shadow_region(&(vm_info.mem_map),ent);
221 add_shadow_region_passthrough(&vm_info, 0x0, 0x100000, 0x100000);
223 hook_io_port(&(vm_info.io_map), 0x61, &IO_Read, &IO_Write, NULL);
224 hook_io_port(&(vm_info.io_map), 0x05, &IO_Read, &IO_Write_to_Serial, NULL);
228 vm_info.cs.base=0xf000;
229 vm_info.cs.limit=0xffff;
231 //vm_info.rip = 0xfff0;
234 vm_info.vm_regs.rsp = 0x0;
240 PrintDebug("Guest Size: %lu\n", bootInfo->guest_size);
242 struct guest_mem_layout * layout = (struct guest_mem_layout *)0x100000;
244 if (layout->magic != MAGIC_CODE) {
245 PrintDebug("Layout Magic Mismatch (0x%x)\n", layout->magic);
248 PrintDebug("%d layout regions\n", layout->num_regions);
250 region_start = (void *)&(layout->regions[layout->num_regions]);
252 PrintDebug("region start = 0x%x\n", region_start);
254 for (i = 0; i < layout->num_regions; i++) {
255 struct layout_region * reg = &(layout->regions[i]);
256 uint_t num_pages = (reg->length / PAGE_SIZE) + ((reg->length % PAGE_SIZE) ? 1 : 0);
257 void * guest_mem = Allocate_VMM_Pages(num_pages);
259 PrintDebug("Layout Region %d bytes\n", reg->length);
260 memcpy(guest_mem, region_start, reg->length);
262 SerialMemDump((unsigned char *)(guest_mem), 16);
264 add_shadow_region_passthrough(&vm_info, reg->final_addr, reg->final_addr + (num_pages * PAGE_SIZE), (addr_t)guest_mem);
266 PrintDebug("Adding Shadow Region (0x%x-0x%x) -> 0x%x\n", reg->final_addr, reg->final_addr + (num_pages * PAGE_SIZE), guest_mem);
268 region_start += reg->length;
271 add_shadow_region_passthrough(&vm_info, 0xc0000, 0xc8000, 0xc0000);
272 add_shadow_region_passthrough(&vm_info, 0x0, 0xa0000, (addr_t)Allocate_VMM_Pages(160));
273 add_shadow_region_passthrough(&vm_info, 0xa0000, 0xc0000, 0xa0000);
274 if (add_shadow_region_passthrough(&vm_info, 0xc8000, 0xf0000, (addr_t)Allocate_VMM_Pages(40)) == -1) {
275 PrintDebug("Error adding shadow region\n");
279 print_shadow_map(&(vm_info.mem_map));
281 hook_io_port(&(vm_info.io_map), 0x61, &IO_Read, &IO_Write, NULL);
282 hook_io_port(&(vm_info.io_map), 0x05, &IO_Read, &IO_Write_to_Serial, NULL);
284 hook_io_port(&(vm_info.io_map), 0x20, &IO_Read, &IO_Write_to_Serial, NULL);
285 hook_io_port(&(vm_info.io_map), 0x21, &IO_Read, &IO_Write_to_Serial, NULL);
286 hook_io_port(&(vm_info.io_map), 0xa0, &IO_Read, &IO_Write_to_Serial, NULL);
287 hook_io_port(&(vm_info.io_map), 0xa1, &IO_Read, &IO_Write_to_Serial, NULL);
289 hook_io_port(&(vm_info.io_map), 0x400, &IO_Read, &IO_Write_to_Serial, NULL);
290 hook_io_port(&(vm_info.io_map), 0x401, &IO_Read, &IO_Write_to_Serial, NULL);
291 hook_io_port(&(vm_info.io_map), 0x402, &IO_Read, &IO_BOCHS_debug, NULL);
292 hook_io_port(&(vm_info.io_map), 0x403, &IO_Read, &IO_Write_to_Serial, NULL);
295 //struct vm_device * nvram = create_nvram();
296 //struct vm_device * timer = create_timer();
297 struct vm_device * pic = create_pic();
299 //attach_device(&(vm_info), nvram);
300 //attach_device(&(vm_info), timer);
301 attach_device(&(vm_info), pic);
303 PrintDebugDevMgr(&(vm_info.dev_mgr));
310 hook_irq(&vm_info, 6);
312 vm_info.rip = 0xfff0;
313 vm_info.vm_regs.rsp = 0x0;
316 PrintBoth("Initializing Guest (eip=0x%.8x) (esp=0x%.8x)\n", (uint_t)vm_info.rip,(uint_t)vm_info.vm_regs.rsp);
317 (vmm_ops).init_guest(&vm_info);
318 PrintBoth("Starting Guest\n");
320 (vmm_ops).start_guest(&vm_info);