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>
8 #include <devices/generic.h>
9 #include <devices/nvram.h>
10 #include <devices/timer.h>
11 #include <devices/simple_pic.h>
12 #include <devices/8259a.h>
13 #include <devices/8254.h>
14 #include <devices/keyboard.h>
16 #include <palacios/vmm_intr.h>
17 #include <palacios/vmm_dev_mgr.h>
18 #include <palacios/vmm_time.h>
20 #define SPEAKER_PORT 0x61
22 static inline void VM_Out_Byte(ushort_t port, uchar_t value)
24 __asm__ __volatile__ (
27 : "a" (value), "Nd" (port)
32 * Read a byte from an I/O port.
34 static inline uchar_t VM_In_Byte(ushort_t port)
38 __asm__ __volatile__ (
50 int IO_Read(ushort_t port, void * dst, uint_t length, void * priv_data) {
56 *(uchar_t*)dst = VM_In_Byte(port);
62 int IO_Write(ushort_t port, void * src, uint_t length, void * priv_data) {
68 VM_Out_Byte(port, *(uchar_t *)src);
74 int IO_Read_to_Serial(ushort_t port, void * dst, uint_t length, void * priv_data) {
75 PrintBoth("Input from Guest on port %d (0x%x) Length=%d\n", port, port, length);
81 char * bochs_debug_buf = NULL;
82 int bochs_debug_offset = 0;
85 int IO_BOCHS_debug(ushort_t port, void * src, uint_t length, void * priv_data) {
86 if (!bochs_debug_buf) {
87 bochs_debug_buf = (char*)Malloc(1024);
90 bochs_debug_buf[bochs_debug_offset++] = *(char*)src;
92 if ((*(char*)src == 0xa) || (bochs_debug_offset == 1023)) {
93 SerialPrint("BOCHS>%s", bochs_debug_buf);
94 memset(bochs_debug_buf, 0, 1024);
95 bochs_debug_offset = 0;
102 int IO_Write_to_Serial(ushort_t port, void * src, uint_t length, void * priv_data) {
103 SerialPrint("Output from Guest on port %d (0x%x) Length=%d\n", port, port, length);
107 SerialPrint(">0x%.2x\n", *(char*)src);
110 SerialPrint(">0x%.4x\n", *(ushort_t*)src);
113 SerialPrint(">0x%.8x\n", *(uint_t*)src);
119 // SerialMemDump(src, length);
132 __asm__ __volatile__ (
138 PrintBoth("Starting To Buzz\n");
140 init=VM_In_Byte(SPEAKER_PORT);
143 VM_Out_Byte(SPEAKER_PORT, init|0x2);
144 for (j=0;j<1000000;j++) {
147 VM_Out_Byte(SPEAKER_PORT, init);
148 for (j=0;j<1000000;j++) {
156 int passthrough_mem_read(addr_t guest_addr, void * dst, uint_t length, void * priv_data) {
157 memcpy(dst, (void*)guest_addr, length);
161 int passthrough_mem_write(addr_t guest_addr, void * src, uint_t length, void * priv_data) {
162 memcpy((void*)guest_addr, src, length);
168 /* We need a configuration mechanism, so we can wrap this completely inside the VMM code,
169 * with no pollution into the HOST OS
172 int RunVMM(struct Boot_Info * bootInfo) {
174 struct vmm_os_hooks os_hooks;
175 struct vmm_ctrl_ops vmm_ops;
176 struct guest_info vm_info;
182 memset(&os_hooks, 0, sizeof(struct vmm_os_hooks));
183 memset(&vmm_ops, 0, sizeof(struct vmm_ctrl_ops));
184 memset(&vm_info, 0, sizeof(struct guest_info));
186 os_hooks.print_debug = &SerialPrint;
187 os_hooks.print_info = &Print;
188 os_hooks.print_trace = &SerialPrint;
189 os_hooks.allocate_pages = &Allocate_VMM_Pages;
190 os_hooks.free_page = &Free_VMM_Page;
191 os_hooks.malloc = &VMM_Malloc;
192 os_hooks.free = &VMM_Free;
193 os_hooks.vaddr_to_paddr = &Identity;
194 os_hooks.paddr_to_vaddr = &Identity;
195 os_hooks.hook_interrupt = &hook_irq_stub;
196 os_hooks.ack_irq = &ack_irq;
197 os_hooks.get_cpu_khz = &get_cpu_khz;
199 Init_VMM(&os_hooks, &vmm_ops);
202 /* MOVE THIS TO AN INIT GUEST ROUTINE */
203 init_shadow_map(&(vm_info.mem_map));
204 init_shadow_page_state(&(vm_info.shdw_pg_state));
205 v3_init_time(&(vm_info.time_state));
206 vm_info.page_mode = SHADOW_PAGING;
208 vm_info.cpu_mode = REAL;
210 //init_irq_map(&(vm_info.irq_map));
211 init_vmm_io_map(&(vm_info.io_map));
212 init_interrupt_state(&vm_info);
214 dev_mgr_init(&(vm_info.dev_mgr));
219 // add_shared_mem_range(&(vm_info.mem_layout), 0, 0x800000, 0x10000);
220 // add_shared_mem_range(&(vm_info.mem_layout), 0, 0x1000000, 0);
222 rip = (ulong_t)(void*)&BuzzVM;
224 // rip = (addr_t)(void*)&exit_test;
227 rsp = (addr_t)Alloc_Page();
229 vm_info.vm_regs.rsp = (rsp +4092 );// - 0x2000;
233 //add_shared_mem_range(&(vm_info.mem_layout), 0x0, 0x1000, 0x100000);
234 // add_shared_mem_range(&(vm_info.mem_layout), 0x0, 0x100000, 0x0);
237 shadow_region_t *ent = Malloc(sizeof(shadow_region_t));;
238 init_shadow_region_physical(ent,0,0x100000,GUEST_REGION_PHYSICAL_MEMORY,
239 0x100000, HOST_REGION_PHYSICAL_MEMORY);
240 add_shadow_region(&(vm_info.mem_map),ent);
243 add_shadow_region_passthrough(&vm_info, 0x0, 0x100000, 0x100000);
245 hook_io_port(&(vm_info.io_map), 0x61, &IO_Read, &IO_Write, NULL);
246 hook_io_port(&(vm_info.io_map), 0x05, &IO_Read, &IO_Write_to_Serial, NULL);
250 vm_info.cs.base=0xf000;
251 vm_info.cs.limit=0xffff;
253 //vm_info.rip = 0xfff0;
256 vm_info.vm_regs.rsp = 0x0;
262 PrintBoth("Guest Size: %lu\n", bootInfo->guest_size);
264 struct guest_mem_layout * layout = (struct guest_mem_layout *)0x100000;
266 if (layout->magic != MAGIC_CODE) {
267 PrintBoth("Layout Magic Mismatch (0x%x)\n", layout->magic);
270 PrintBoth("%d layout regions\n", layout->num_regions);
272 region_start = (void *)&(layout->regions[layout->num_regions]);
274 PrintBoth("region start = 0x%x\n", region_start);
276 for (i = 0; i < layout->num_regions; i++) {
277 struct layout_region * reg = &(layout->regions[i]);
278 uint_t num_pages = (reg->length / PAGE_SIZE) + ((reg->length % PAGE_SIZE) ? 1 : 0);
279 void * guest_mem = Allocate_VMM_Pages(num_pages);
281 PrintBoth("Layout Region %d bytes\n", reg->length);
282 memcpy(guest_mem, region_start, reg->length);
284 SerialMemDump((unsigned char *)(guest_mem), 16);
286 add_shadow_region_passthrough(&vm_info, reg->final_addr, reg->final_addr + (num_pages * PAGE_SIZE), (addr_t)guest_mem);
288 PrintBoth("Adding Shadow Region (0x%x-0x%x) -> 0x%x\n", reg->final_addr, reg->final_addr + (num_pages * PAGE_SIZE), guest_mem);
290 region_start += reg->length;
294 add_shadow_region_passthrough(&vm_info, 0x0, 0xa0000, (addr_t)Allocate_VMM_Pages(160));
296 add_shadow_region_passthrough(&vm_info, 0xa0000, 0xc0000, 0xa0000);
297 //hook_guest_mem(&vm_info, 0xa0000, 0xc0000, passthrough_mem_read, passthrough_mem_write, NULL);
301 //add_shadow_region_passthrough(&vm_info, 0xc0000, 0xc8000, 0xc0000);
304 add_shadow_region_passthrough(&vm_info, 0xc7000, 0xc8000, (addr_t)Allocate_VMM_Pages(1));
305 if (add_shadow_region_passthrough(&vm_info, 0xc8000, 0xf0000, (addr_t)Allocate_VMM_Pages(40)) == -1) {
306 PrintBoth("Error adding shadow region\n");
309 add_shadow_region_passthrough(&vm_info, 0xc0000, 0xc8000, 0xc0000);
310 add_shadow_region_passthrough(&vm_info, 0xc8000, 0xf0000, 0xc8000);
314 //add_shadow_region_passthrough(&vm_info, 0x100000, 0x2000000, (addr_t)Allocate_VMM_Pages(8192));
315 add_shadow_region_passthrough(&vm_info, 0x100000, 0x1000000, (addr_t)Allocate_VMM_Pages(4096));
318 print_shadow_map(&(vm_info.mem_map));
320 hook_io_port(&(vm_info.io_map), 0x61, &IO_Read, &IO_Write, NULL);
321 //hook_io_port(&(vm_info.io_map), 0x05, &IO_Read, &IO_Write_to_Serial, NULL);
324 hook_io_port(&(vm_info.io_map), 0x400, &IO_Read, &IO_Write_to_Serial, NULL);
325 hook_io_port(&(vm_info.io_map), 0x401, &IO_Read, &IO_Write_to_Serial, NULL);
326 hook_io_port(&(vm_info.io_map), 0x402, &IO_Read, &IO_BOCHS_debug, NULL);
327 hook_io_port(&(vm_info.io_map), 0x403, &IO_Read, &IO_Write_to_Serial, NULL);
331 struct vm_device * nvram = create_nvram();
332 //struct vm_device * timer = create_timer();
333 struct vm_device * pic = create_pic();
334 struct vm_device * keyboard = create_keyboard();
335 struct vm_device * pit = create_pit();
340 generic_port_range_type range[] = {
341 {0x00, 0x07}, // DMA 1 channels 0,1,2,3 (address, counter)
342 {0xc0, 0xc7}, // DMA 2 channels 4,5,6,7 (address, counter)
343 {0x87, 0x87}, // DMA 1 channel 0 page register
344 {0x83, 0x83}, // DMA 1 channel 1 page register
345 {0x81, 0x81}, // DMA 1 channel 2 page register
346 {0x82, 0x82}, // DMA 1 channel 3 page register
347 {0x8f, 0x8f}, // DMA 2 channel 4 page register
348 {0x8b, 0x8b}, // DMA 2 channel 5 page register
349 {0x89, 0x89}, // DMA 2 channel 6 page register
350 {0x8a, 0x8a}, // DMA 2 channel 7 page register
351 {0x08, 0x0f}, // DMA 1 misc registers (csr, req, smask,mode,clearff,reset,enable,mmask)
352 {0xd0, 0xde}, // DMA 2 misc registers
353 {0x3f0, 0x3f2}, // Primary floppy controller (base,statusa/statusb,DOR)
354 {0x3f4, 0x3f5}, // Primary floppy controller (mainstat/datarate,data)
355 {0x3f7, 0x3f7}, // Primary floppy controller (DIR)
356 {0x370, 0x372}, // Secondary floppy controller (base,statusa/statusb,DOR)
357 {0x374, 0x375}, // Secondary floppy controller (mainstat/datarate,data)
358 {0x377, 0x377}, // Secondary floppy controller (DIR)
362 struct vm_device * generic = create_generic(range,19,NULL,0,NULL,0);
366 attach_device(&(vm_info), nvram);
367 //attach_device(&(vm_info), timer);
368 attach_device(&(vm_info), pic);
369 attach_device(&(vm_info), pit);
370 attach_device(&(vm_info), keyboard);
374 // Important that this be attached last!
375 attach_device(&(vm_info), generic);
379 PrintDebugDevMgr(&(vm_info.dev_mgr));
382 // give keyboard interrupts to vm
383 //hook_irq(&vm_info, 1);
385 // give floppy controller to vm
386 //hook_irq(&vm_info, 6);
389 //hook_irq(&vm_info, 14);
392 //hook_irq(&vm_info, 15);
395 vm_info.rip = 0xfff0;
396 vm_info.vm_regs.rsp = 0x0;
399 PrintBoth("Initializing Guest (eip=0x%.8x) (esp=0x%.8x)\n", (uint_t)vm_info.rip,(uint_t)vm_info.vm_regs.rsp);
400 (vmm_ops).init_guest(&vm_info);
401 PrintBoth("Starting Guest\n");
403 (vmm_ops).start_guest(&vm_info);