X-Git-Url: http://v3vee.org/palacios/gitweb/gitweb.cgi?a=blobdiff_plain;f=palacios%2Fsrc%2Fpalacios%2Fsvm_io.c;h=e273466a4f529a6df1763091731fb5ace989316c;hb=5e5c8ee949fa45116d58b904fc11aab082f61607;hp=4c85ec72d878b437718f4aa9fd7ce70f990fece2;hpb=29e825c5f095066bbb5ebbec5a5af1419d883264;p=palacios.git diff --git a/palacios/src/palacios/svm_io.c b/palacios/src/palacios/svm_io.c index 4c85ec7..e273466 100644 --- a/palacios/src/palacios/svm_io.c +++ b/palacios/src/palacios/svm_io.c @@ -17,20 +17,21 @@ * redistribute, and modify it as specified in the file "V3VEE_LICENSE". */ + #include #include #include #include #include -#ifndef DEBUG_IO +#ifndef V3_CONFIG_DEBUG_IO #undef PrintDebug #define PrintDebug(fmt, args...) #endif -static int update_map(struct guest_info * info, uint16_t port, int hook_read, int hook_write) { - uchar_t * bitmap = (uint8_t *)(info->io_map.arch_data);; +static int update_map(struct v3_vm_info * vm, uint16_t port, int hook_read, int hook_write) { + uchar_t * bitmap = (uint8_t *)(vm->io_map.arch_data);; int major = port / 8; int minor = port % 8; @@ -44,33 +45,30 @@ static int update_map(struct guest_info * info, uint16_t port, int hook_read, in } -int v3_init_svm_io_map(struct guest_info * info) { - info->io_map.update_map = update_map; +int v3_init_svm_io_map(struct v3_vm_info * vm) { + vm->io_map.update_map = update_map; + + vm->io_map.arch_data = V3_VAddr(V3_AllocPages(3)); + memset(vm->io_map.arch_data, 0xff, PAGE_SIZE_4KB * 3); + - info->io_map.arch_data = V3_VAddr(V3_AllocPages(3)); - memset(info->io_map.arch_data, 0, PAGE_SIZE_4KB * 3); + v3_refresh_io_map(vm); return 0; } +int v3_deinit_svm_io_map(struct v3_vm_info * vm) { + V3_FreePages(V3_PAddr(vm->io_map.arch_data), 3); + return 0; +} -// This should package up an IO request and call vmm_handle_io -int v3_handle_svm_io_in(struct guest_info * info) { - vmcb_ctrl_t * ctrl_area = GET_VMCB_CTRL_AREA((vmcb_t *)(info->vmm_data)); - // vmcb_saved_state_t * guest_state = GET_VMCB_SAVE_STATE_AREA((vmcb_t*)(info->vmm_data)); - struct svm_io_info * io_info = (struct svm_io_info *)&(ctrl_area->exit_info1); - struct v3_io_hook * hook = v3_get_io_hook(info, io_info->port); +// This should package up an IO request and call vmm_handle_io +int v3_handle_svm_io_in(struct guest_info * core, struct svm_io_info * io_info) { + struct v3_io_hook * hook = v3_get_io_hook(core->vm_info, io_info->port); int read_size = 0; - if (hook == NULL) { - PrintError("Hook Not present for in on port %x\n", io_info->port); - // error, we should not have exited on this port - return -1; - } - - if (io_info->sz8) { read_size = 1; } else if (io_info->sz16) { @@ -81,13 +79,20 @@ int v3_handle_svm_io_in(struct guest_info * info) { PrintDebug("IN of %d bytes on port %d (0x%x)\n", read_size, io_info->port, io_info->port); - if (hook->read(io_info->port, &(info->vm_regs.rax), read_size, hook->priv_data) != read_size) { - // not sure how we handle errors..... - PrintError("Read Failure for in on port %x\n", io_info->port); - return -1; - } + if (hook == NULL) { + PrintDebug("IN operation on unhooked IO port 0x%x\n", io_info->port); - info->rip = ctrl_area->exit_info2; + /* What are the HW semantics for an IN on an invalid port? + * Do we need to clear the register value or leave it untouched??? + */ + } else { + if (hook->read(core, io_info->port, &(core->vm_regs.rax), read_size, hook->priv_data) != read_size) { + // not sure how we handle errors..... + PrintError("Read Failure for in on port 0x%x\n", io_info->port); + return -1; + } + } + return 0; } @@ -99,18 +104,13 @@ int v3_handle_svm_io_in(struct guest_info * info) { /* We might not handle wrap around of the RDI register correctly... * In that if we do wrap around the effect will manifest in the higher bits of the register */ -int v3_handle_svm_io_ins(struct guest_info * info) { - vmcb_ctrl_t * ctrl_area = GET_VMCB_CTRL_AREA((vmcb_t *)(info->vmm_data)); - vmcb_saved_state_t * guest_state = GET_VMCB_SAVE_STATE_AREA((vmcb_t*)(info->vmm_data)); - - struct svm_io_info * io_info = (struct svm_io_info *)&(ctrl_area->exit_info1); - - struct v3_io_hook * hook = v3_get_io_hook(info, io_info->port); +int v3_handle_svm_io_ins(struct guest_info * core, struct svm_io_info * io_info) { + struct v3_io_hook * hook = v3_get_io_hook(core->vm_info, io_info->port); int read_size = 0; addr_t dst_addr = 0; uint_t rep_num = 1; ullong_t mask = 0; - struct v3_segment * theseg = &(info->segments.es); // default is ES + struct v3_segment * theseg = &(core->segments.es); // default is ES addr_t inst_ptr; @@ -118,22 +118,14 @@ int v3_handle_svm_io_ins(struct guest_info * info) { // direction can equal either 1 or -1 // We will multiply the final added offset by this value to go the correct direction int direction = 1; - struct rflags * flags = (struct rflags *)&(guest_state->rflags); + struct rflags * flags = (struct rflags *)&(core->ctrl_regs.rflags); if (flags->df) { direction = -1; } + - - if (hook == NULL) { - PrintError("Hook Not present for ins on port %x\n", io_info->port); - // error, we should not have exited on this port - return -1; - } - - - - if (guest_va_to_host_va(info, get_addr_linear(info, info->rip, &(info->segments.cs)), &inst_ptr) == -1) { + if (v3_gva_to_hva(core, get_addr_linear(core, core->rip, &(core->segments.cs)), &inst_ptr) == -1) { PrintError("Can't access instruction\n"); return -1; } @@ -141,22 +133,22 @@ int v3_handle_svm_io_ins(struct guest_info * info) { while (is_prefix_byte(*((char *)inst_ptr))) { switch (*((char *)inst_ptr)) { case PREFIX_CS_OVERRIDE: - theseg = &(info->segments.cs); + theseg = &(core->segments.cs); break; case PREFIX_SS_OVERRIDE: - theseg = &(info->segments.ss); + theseg = &(core->segments.ss); break; case PREFIX_DS_OVERRIDE: - theseg = &(info->segments.ds); + theseg = &(core->segments.ds); break; case PREFIX_ES_OVERRIDE: - theseg = &(info->segments.es); + theseg = &(core->segments.es); break; case PREFIX_FS_OVERRIDE: - theseg = &(info->segments.fs); + theseg = &(core->segments.fs); break; case PREFIX_GS_OVERRIDE: - theseg = &(info->segments.gs); + theseg = &(core->segments.gs); break; default: break; @@ -187,7 +179,7 @@ int v3_handle_svm_io_ins(struct guest_info * info) { mask = 0xffffffffffffffffLL; } else { // This value should be set depending on the host register size... - mask = get_gpr_mask(info); + mask = get_gpr_mask(core); PrintDebug("INS io_info invalid address size, mask=0x%p, io_info=0x%p\n", (void *)(addr_t)mask, (void *)(addr_t)(io_info)); @@ -196,61 +188,53 @@ int v3_handle_svm_io_ins(struct guest_info * info) { } if (io_info->rep) { - rep_num = info->vm_regs.rcx & mask; + rep_num = core->vm_regs.rcx & mask; //rep_num = info->vm_regs.rcx; } - PrintDebug("INS size=%d for %d steps\n", read_size, rep_num); while (rep_num > 0) { addr_t host_addr; - dst_addr = get_addr_linear(info, (info->vm_regs.rdi & mask), theseg); + dst_addr = get_addr_linear(core, (core->vm_regs.rdi & mask), theseg); // PrintDebug("Writing 0x%p\n", (void *)dst_addr); - if (guest_va_to_host_va(info, dst_addr, &host_addr) == -1) { + if (v3_gva_to_hva(core, dst_addr, &host_addr) == -1) { // either page fault or gpf... PrintError("Could not convert Guest VA to host VA\n"); return -1; } - if (hook->read(io_info->port, (char *)host_addr, read_size, hook->priv_data) != read_size) { - // not sure how we handle errors..... - PrintError("Read Failure for ins on port %x\n", io_info->port); - return -1; + if (hook == NULL) { + PrintDebug("INS operation on unhooked IO port 0x%x\n", io_info->port); + /* What are the HW semantics for an INS on an invalid port? + * Do we need to clear the memory region or leave it untouched??? + */ + } else { + if (hook->read(core, io_info->port, (char *)host_addr, read_size, hook->priv_data) != read_size) { + // not sure how we handle errors..... + PrintError("Read Failure for ins on port 0x%x\n", io_info->port); + return -1; + } } - - info->vm_regs.rdi += (read_size * direction); + + core->vm_regs.rdi += (read_size * direction); if (io_info->rep) { - info->vm_regs.rcx--; + core->vm_regs.rcx--; } rep_num--; } - - info->rip = ctrl_area->exit_info2; - return 0; } -int v3_handle_svm_io_out(struct guest_info * info) { - vmcb_ctrl_t * ctrl_area = GET_VMCB_CTRL_AREA((vmcb_t *)(info->vmm_data)); - // vmcb_saved_state_t * guest_state = GET_VMCB_SAVE_STATE_AREA((vmcb_t*)(info->vmm_data)); - struct svm_io_info * io_info = (struct svm_io_info *)&(ctrl_area->exit_info1); - - struct v3_io_hook * hook = v3_get_io_hook(info, io_info->port); +int v3_handle_svm_io_out(struct guest_info * core, struct svm_io_info * io_info) { + struct v3_io_hook * hook = v3_get_io_hook(core->vm_info, io_info->port); int write_size = 0; - if (hook == NULL) { - PrintError("Hook Not present for out on port %x\n", io_info->port); - // error, we should not have exited on this port - return -1; - } - - if (io_info->sz8) { write_size = 1; } else if (io_info->sz16) { @@ -261,13 +245,16 @@ int v3_handle_svm_io_out(struct guest_info * info) { PrintDebug("OUT of %d bytes on port %d (0x%x)\n", write_size, io_info->port, io_info->port); - if (hook->write(io_info->port, &(info->vm_regs.rax), write_size, hook->priv_data) != write_size) { - // not sure how we handle errors..... - PrintError("Write Failure for out on port %x\n", io_info->port); - return -1; + if (hook == NULL) { + PrintDebug("OUT operation on unhooked IO port 0x%x\n", io_info->port); + } else { + if (hook->write(core, io_info->port, &(core->vm_regs.rax), write_size, hook->priv_data) != write_size) { + // not sure how we handle errors..... + PrintError("Write Failure for out on port 0x%x\n", io_info->port); + return -1; + } } - - info->rip = ctrl_area->exit_info2; + return 0; } @@ -277,38 +264,26 @@ int v3_handle_svm_io_out(struct guest_info * info) { * In that if we do wrap around the effect will manifest in the higher bits of the register */ -int v3_handle_svm_io_outs(struct guest_info * info) { - vmcb_ctrl_t * ctrl_area = GET_VMCB_CTRL_AREA((vmcb_t *)(info->vmm_data)); - vmcb_saved_state_t * guest_state = GET_VMCB_SAVE_STATE_AREA((vmcb_t*)(info->vmm_data)); - - - struct svm_io_info * io_info = (struct svm_io_info *)&(ctrl_area->exit_info1); - - struct v3_io_hook * hook = v3_get_io_hook(info, io_info->port); +int v3_handle_svm_io_outs(struct guest_info * core, struct svm_io_info * io_info) { + + struct v3_io_hook * hook = v3_get_io_hook(core->vm_info, io_info->port); int write_size = 0; addr_t dst_addr = 0; uint_t rep_num = 1; ullong_t mask = 0; addr_t inst_ptr; - struct v3_segment * theseg = &(info->segments.es); // default is ES + struct v3_segment * theseg = &(core->segments.ds); // default is DS // This is kind of hacky... // direction can equal either 1 or -1 // We will multiply the final added offset by this value to go the correct direction int direction = 1; - struct rflags * flags = (struct rflags *)&(guest_state->rflags); + struct rflags * flags = (struct rflags *)&(core->ctrl_regs.rflags); if (flags->df) { direction = -1; } - - if (hook == NULL) { - PrintError("Hook Not present for outs on port %x\n", io_info->port); - // error, we should not have exited on this port - return -1; - } - PrintDebug("OUTS on port %d (0x%x)\n", io_info->port, io_info->port); if (io_info->sz8) { @@ -328,7 +303,7 @@ int v3_handle_svm_io_outs(struct guest_info * info) { mask = 0xffffffffffffffffLL; } else { // This value should be set depending on the host register size... - mask = get_gpr_mask(info); + mask = get_gpr_mask(core); PrintDebug("OUTS io_info invalid address size, mask=0%p, io_info=0x%p\n", (void *)(addr_t)mask, (void *)(addr_t)io_info); @@ -340,13 +315,13 @@ int v3_handle_svm_io_outs(struct guest_info * info) { } if (io_info->rep) { - rep_num = info->vm_regs.rcx & mask; + rep_num = core->vm_regs.rcx & mask; } - if (guest_va_to_host_va(info, get_addr_linear(info, info->rip, &(info->segments.cs)), &inst_ptr) == -1) { + if (v3_gva_to_hva(core, get_addr_linear(core, core->rip, &(core->segments.cs)), &inst_ptr) == -1) { PrintError("Can't access instruction\n"); return -1; } @@ -354,22 +329,22 @@ int v3_handle_svm_io_outs(struct guest_info * info) { while (is_prefix_byte(*((char *)inst_ptr))) { switch (*((char *)inst_ptr)) { case PREFIX_CS_OVERRIDE: - theseg = &(info->segments.cs); + theseg = &(core->segments.cs); break; case PREFIX_SS_OVERRIDE: - theseg = &(info->segments.ss); + theseg = &(core->segments.ss); break; case PREFIX_DS_OVERRIDE: - theseg = &(info->segments.ds); + theseg = &(core->segments.ds); break; case PREFIX_ES_OVERRIDE: - theseg = &(info->segments.es); + theseg = &(core->segments.es); break; case PREFIX_FS_OVERRIDE: - theseg = &(info->segments.fs); + theseg = &(core->segments.fs); break; case PREFIX_GS_OVERRIDE: - theseg = &(info->segments.gs); + theseg = &(core->segments.gs); break; default: break; @@ -380,32 +355,34 @@ int v3_handle_svm_io_outs(struct guest_info * info) { PrintDebug("OUTS size=%d for %d steps\n", write_size, rep_num); while (rep_num > 0) { - addr_t host_addr; + addr_t host_addr = 0; - dst_addr = get_addr_linear(info, (info->vm_regs.rsi & mask), theseg); + dst_addr = get_addr_linear(core, (core->vm_regs.rsi & mask), theseg); - if (guest_va_to_host_va(info, dst_addr, &host_addr) == -1) { - // either page fault or gpf... + if (v3_gva_to_hva(core, dst_addr, &host_addr) == -1) { + PrintError("Could not translate outs dest addr, either page fault or gpf...\n"); + return -1; } - if (hook->write(io_info->port, (char*)host_addr, write_size, hook->priv_data) != write_size) { - // not sure how we handle errors..... - PrintError("Write Failure for outs on port %x\n", io_info->port); - return -1; + if (hook == NULL) { + PrintDebug("OUTS operation on unhooked IO port 0x%x\n", io_info->port); + } else { + if (hook->write(core, io_info->port, (char*)host_addr, write_size, hook->priv_data) != write_size) { + // not sure how we handle errors..... + PrintError("Write Failure for outs on port 0x%x\n", io_info->port); + return -1; + } } + - info->vm_regs.rsi += write_size * direction; + core->vm_regs.rsi += write_size * direction; if (io_info->rep) { - info->vm_regs.rcx--; + core->vm_regs.rcx--; } rep_num--; } - - info->rip = ctrl_area->exit_info2; - - return 0; }