X-Git-Url: http://v3vee.org/palacios/gitweb/gitweb.cgi?a=blobdiff_plain;f=palacios%2Fsrc%2Fpalacios%2Fsvm_io.c;h=04b488bddc853b17d98bf0c42be22626e010d156;hb=03a41b18bdb6ce4bf666f18acdaf302e2360efdc;hp=ce126693d70876059e8466041f569e130f011d6d;hpb=1c63b0651a5d039076d8027c7cd87960e4151408;p=palacios.git diff --git a/palacios/src/palacios/svm_io.c b/palacios/src/palacios/svm_io.c index ce12669..04b488b 100644 --- a/palacios/src/palacios/svm_io.c +++ b/palacios/src/palacios/svm_io.c @@ -1,26 +1,55 @@ +/* + * This file is part of the Palacios Virtual Machine Monitor developed + * by the V3VEE Project with funding from the United States National + * Science Foundation and the Department of Energy. + * + * The V3VEE Project is a joint project between Northwestern University + * and the University of New Mexico. You can find out more at + * http://www.v3vee.org + * + * Copyright (c) 2008, Jack Lange + * Copyright (c) 2008, The V3VEE Project + * All rights reserved. + * + * Author: Jack Lange + * + * This is free software. You are permitted to use, + * redistribute, and modify it as specified in the file "V3VEE_LICENSE". + */ + + + + #include #include #include #include #include +#ifndef DEBUG_IO +#undef PrintDebug +#define PrintDebug(fmt, args...) +#endif + + + + // This should package up an IO request and call vmm_handle_io -int handle_svm_io_in(struct guest_info * info) { +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); - vmm_io_hook_t * hook = get_io_hook(&(info->io_map), io_info->port); - uint_t read_size = 0; + struct vmm_io_hook * hook = v3_get_io_hook(&(info->io_map), io_info->port); + int read_size = 0; if (hook == NULL) { - PrintDebug("Hook Not present for in on port %x\n", io_info->port); + PrintError("Hook Not present for in on port %x\n", io_info->port); // error, we should not have exited on this port return -1; } - PrintDebug("IN on port %d (0x%x)\n", io_info->port, io_info->port); if (io_info->sz8) { read_size = 1; @@ -30,10 +59,11 @@ int handle_svm_io_in(struct guest_info * info) { read_size = 4; } + 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..... - PrintDebug("Read Failure for in on port %x\n", io_info->port); + PrintError("Read Failure for in on port %x\n", io_info->port); return -1; } @@ -49,14 +79,14 @@ int 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 handle_svm_io_ins(struct guest_info * info) { +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); - vmm_io_hook_t * hook = get_io_hook(&(info->io_map), io_info->port); - uint_t read_size = 0; + struct vmm_io_hook * hook = v3_get_io_hook(&(info->io_map), io_info->port); + int read_size = 0; addr_t dst_addr = 0; uint_t rep_num = 1; @@ -75,11 +105,47 @@ int handle_svm_io_ins(struct guest_info * info) { if (hook == NULL) { - PrintDebug("Hook Not present for ins on port %x\n", io_info->port); + PrintError("Hook Not present for ins on port %x\n", io_info->port); // error, we should not have exited on this port return -1; } + struct v3_segment *theseg = &(info->segments.es); // default is ES + + addr_t inst_ptr; + + if (guest_va_to_host_va(info, get_addr_linear(info, info->rip, &(info->segments.cs)), &inst_ptr) == -1) { + PrintError("Can't access instruction\n"); + return -1; + } + + while (is_prefix_byte(*((char*)inst_ptr))) { + switch (*((char*)inst_ptr)) { + case PREFIX_CS_OVERRIDE: + theseg = &(info->segments.cs); + break; + case PREFIX_SS_OVERRIDE: + theseg = &(info->segments.ss); + break; + case PREFIX_DS_OVERRIDE: + theseg = &(info->segments.ds); + break; + case PREFIX_ES_OVERRIDE: + theseg = &(info->segments.es); + break; + case PREFIX_FS_OVERRIDE: + theseg = &(info->segments.fs); + break; + case PREFIX_GS_OVERRIDE: + theseg = &(info->segments.gs); + break; + default: + break; + } + inst_ptr++; + } + + PrintDebug("INS on port %d (0x%x)\n", io_info->port, io_info->port); if (io_info->sz8) { @@ -89,7 +155,7 @@ int handle_svm_io_ins(struct guest_info * info) { } else if (io_info->sz32) { read_size = 4; } else { - PrintDebug("io_info Invalid Size\n"); + PrintError("io_info Invalid Size\n"); return -1; } @@ -104,9 +170,10 @@ int handle_svm_io_ins(struct guest_info * info) { // This value should be set depending on the host register size... mask = get_gpr_mask(info); - - PrintDebug("INS Aborted... Check implementation\n"); - return -1; + PrintDebug("INS io_info invalid address size, mask=0x%p, io_info=0x%p\n", + (void *)(addr_t)mask, (void *)(addr_t)(io_info)); + // PrintDebug("INS Aborted... Check implementation\n"); + //return -1; } if (io_info->rep) { @@ -119,17 +186,19 @@ int handle_svm_io_ins(struct guest_info * info) { while (rep_num > 0) { addr_t host_addr; - dst_addr = get_addr_linear(info, info->vm_regs.rdi & mask, &(info->segments.es)); + dst_addr = get_addr_linear(info, info->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) { // either page fault or gpf... - PrintDebug("Could not convert Guest VA to host VA\n"); + 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..... - PrintDebug("Read Failure for ins on port %x\n", io_info->port); + PrintError("Read Failure for ins on port %x\n", io_info->port); return -1; } @@ -147,21 +216,20 @@ int handle_svm_io_ins(struct guest_info * info) { return 0; } -int handle_svm_io_out(struct guest_info * info) { +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); - vmm_io_hook_t * hook = get_io_hook(&(info->io_map), io_info->port); - uint_t write_size = 0; + struct vmm_io_hook * hook = v3_get_io_hook(&(info->io_map), io_info->port); + int write_size = 0; if (hook == NULL) { - PrintDebug("Hook Not present for out on port %x\n", io_info->port); + PrintError("Hook Not present for out on port %x\n", io_info->port); // error, we should not have exited on this port return -1; } - PrintDebug("OUT on port %d (0x%x)\n", io_info->port, io_info->port); if (io_info->sz8) { write_size = 1; @@ -171,10 +239,11 @@ int handle_svm_io_out(struct guest_info * info) { write_size = 4; } + 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..... - PrintDebug("Write Failure for out on port %x\n", io_info->port); + PrintError("Write Failure for out on port %x\n", io_info->port); return -1; } @@ -188,14 +257,15 @@ int 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 handle_svm_io_outs(struct guest_info * info) { +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); - vmm_io_hook_t * hook = get_io_hook(&(info->io_map), io_info->port); - uint_t write_size = 0; + struct vmm_io_hook * hook = v3_get_io_hook(&(info->io_map), io_info->port); + int write_size = 0; addr_t dst_addr = 0; uint_t rep_num = 1; @@ -214,7 +284,7 @@ int handle_svm_io_outs(struct guest_info * info) { if (hook == NULL) { - PrintDebug("Hook Not present for outs on port %x\n", io_info->port); + PrintError("Hook Not present for outs on port %x\n", io_info->port); // error, we should not have exited on this port return -1; } @@ -237,19 +307,65 @@ int handle_svm_io_outs(struct guest_info * info) { } else if (io_info->addr64) { mask = 0xffffffffffffffffLL; } else { + // This value should be set depending on the host register size... + mask = get_gpr_mask(info); + + PrintDebug("OUTS io_info invalid address size, mask=0%p, io_info=0x%p\n", + (void *)(addr_t)mask, (void *)(addr_t)io_info); + // PrintDebug("INS Aborted... Check implementation\n"); + //return -1; // should never happen - PrintDebug("Invalid Address length\n"); - return -1; + //PrintDebug("Invalid Address length\n"); + //return -1; } if (io_info->rep) { rep_num = info->vm_regs.rcx & mask; } + struct v3_segment *theseg = &(info->segments.es); // default is ES + + addr_t inst_ptr; + + if (guest_va_to_host_va(info,get_addr_linear(info,info->rip,&(info->segments.cs)),&inst_ptr)==-1) { + PrintError("Can't access instruction\n"); + return -1; + } + + while (is_prefix_byte(*((char*)inst_ptr))) { + switch (*((char*)inst_ptr)) { + case PREFIX_CS_OVERRIDE: + theseg = &(info->segments.cs); + break; + case PREFIX_SS_OVERRIDE: + theseg = &(info->segments.ss); + break; + case PREFIX_DS_OVERRIDE: + theseg = &(info->segments.ds); + break; + case PREFIX_ES_OVERRIDE: + theseg = &(info->segments.es); + break; + case PREFIX_FS_OVERRIDE: + theseg = &(info->segments.fs); + break; + case PREFIX_GS_OVERRIDE: + theseg = &(info->segments.gs); + break; + default: + break; + } + inst_ptr++; + } + + PrintDebug("OUTS size=%d for %d steps\n", write_size, rep_num); while (rep_num > 0) { addr_t host_addr; - dst_addr = get_addr_linear(info, (info->vm_regs.rsi & mask), &(info->segments.ds)); + + + + dst_addr = get_addr_linear(info, (info->vm_regs.rsi & mask), theseg); if (guest_va_to_host_va(info, dst_addr, &host_addr) == -1) { // either page fault or gpf... @@ -257,7 +373,7 @@ int handle_svm_io_outs(struct guest_info * info) { if (hook->write(io_info->port, (char*)host_addr, write_size, hook->priv_data) != write_size) { // not sure how we handle errors..... - PrintDebug("Write Failure for outs on port %x\n", io_info->port); + PrintError("Write Failure for outs on port %x\n", io_info->port); return -1; }