#include <palacios/vmm_ctrl_regs.h>
#include <palacios/vmm_lock.h>
-#include <palacios/vm_guest_mem.h>
-#include <palacios/vmm_decoder.h>
-#ifndef CONFIG_DEBUG_INTERRUPTS
+#ifndef V3_CONFIG_DEBUG_INTERRUPTS
#undef PrintDebug
#define PrintDebug(fmt, args...)
#endif
+
struct intr_controller {
struct intr_ctrl_ops * ctrl_ops;
};
-
-
void v3_init_intr_controllers(struct guest_info * info) {
struct v3_intr_core_state * intr_state = &(info->intr_core_state);
struct intr_controller * tmp;
// clear out any controllers that were left around
- list_for_each_entry_safe(ctrlr, tmp, &(intr_state->controller_list), ctrl_node) {
- v3_remove_intr_controller(core, ctrlr);
+ if (*(void**)&intr_state->controller_list) {
+ list_for_each_entry_safe(ctrlr, tmp, &(intr_state->controller_list), ctrl_node) {
+ v3_remove_intr_controller(core, ctrlr);
+ }
+
+ v3_lock_deinit(&(intr_state->irq_lock));
}
+
}
struct intr_router * rtr = NULL;
struct intr_router * tmp = NULL;
- // clear out any controllers that were left around
- list_for_each_entry_safe(rtr, tmp, &(vm->intr_routers.router_list), router_node) {
- v3_remove_intr_router(vm, rtr);
- }
-}
+ // clear out any routers that were left around
+ if (*(void**)&vm->intr_routers.router_list) {
+ list_for_each_entry_safe(rtr, tmp, &(vm->intr_routers.router_list), router_node) {
+ v3_remove_intr_router(vm, rtr);
+ }
+ v3_lock_deinit(&(vm->intr_routers.irq_lock));
+ }
+}
void * v3_register_intr_controller(struct guest_info * info, struct intr_ctrl_ops * ops, void * priv_data) {
struct intr_controller * ctrlr = (struct intr_controller *)V3_Malloc(sizeof(struct intr_controller));
+ if (!ctrlr) {
+ PrintError(info->vm_info, info, "Cannot allocate in registering an interrupt controller\n");
+ return NULL;
+ }
+
ctrlr->priv_data = priv_data;
ctrlr->ctrl_ops = ops;
return (void *)ctrlr;
}
-
void v3_remove_intr_controller(struct guest_info * core, void * handle) {
struct v3_intr_core_state * intr_state = &(core->intr_core_state);
struct intr_controller * ctrlr = handle;
}
if (found == 0) {
- PrintError("Attempted to remove invalid interrupt controller handle\n");
+ PrintError(core->vm_info, core, "Attempted to remove invalid interrupt controller handle\n");
return;
}
V3_Free(ctrlr);
}
-
void * v3_register_intr_router(struct v3_vm_info * vm, struct intr_router_ops * ops, void * priv_data) {
struct intr_router * router = (struct intr_router *)V3_Malloc(sizeof(struct intr_router));
+ if (!router) {
+ PrintError(vm, VCORE_NONE,"Cannot allocate in registering an interrupt router\n");
+ return NULL;
+ }
+
router->priv_data = priv_data;
router->router_ops = ops;
return (void *)router;
}
-
void v3_remove_intr_router(struct v3_vm_info * vm, void * handle) {
struct intr_router * router = handle;
struct intr_router * tmp = NULL;
}
if (found == 0) {
- PrintError("Attempted to remove invalid interrupt router\n");
+ PrintError(vm, VCORE_NONE, "Attempted to remove invalid interrupt router\n");
return;
}
}
+
static inline struct v3_irq_hook * get_irq_hook(struct v3_vm_info * vm, uint_t irq) {
- V3_ASSERT(irq <= 255);
+ V3_ASSERT(vm, VCORE_NONE,irq <= 256);
return vm->intr_routers.hooks[irq];
}
{
struct v3_irq_hook * hook = (struct v3_irq_hook *)V3_Malloc(sizeof(struct v3_irq_hook));
+
if (hook == NULL) {
+ PrintError(vm, VCORE_NONE, "Cannot allocate when hooking an irq\n");
return -1;
}
if (get_irq_hook(vm, irq) != NULL) {
- PrintError("IRQ %d already hooked\n", irq);
+ PrintError(vm, VCORE_NONE, "IRQ %d already hooked\n", irq);
+ V3_Free(hook);
return -1;
}
vm->intr_routers.hooks[irq] = hook;
if (V3_Hook_Interrupt(vm, irq)) {
- PrintError("hook_irq: failed to hook irq %d\n", irq);
+ PrintError(vm, VCORE_NONE, "hook_irq: failed to hook irq %d\n", irq);
+ vm->intr_routers.hooks[irq] = NULL;
+ V3_Free(hook);
return -1;
} else {
- PrintDebug("hook_irq: hooked irq %d\n", irq);
+ PrintDebug(vm, VCORE_NONE, "hook_irq: hooked irq %d\n", irq);
return 0;
}
}
+
static int passthrough_irq_handler(struct v3_vm_info * vm, struct v3_interrupt * intr, void * priv_data) {
- PrintDebug("[passthrough_irq_handler] raise_irq=%d (guest=0x%p)\n",
+ PrintDebug(vm, VCORE_NONE, "[passthrough_irq_handler] raise_irq=%d (guest=0x%p)\n",
intr->irq, (void *)vm);
return v3_raise_irq(vm, intr->irq);
}
-
int v3_hook_passthrough_irq(struct v3_vm_info * vm, uint_t irq) {
int rc = v3_hook_irq(vm, irq, passthrough_irq_handler, NULL);
if (rc) {
- PrintError("guest_irq_injection: failed to hook irq 0x%x (guest=0x%p)\n", irq, (void *)vm);
+ PrintError(vm, VCORE_NONE, "guest_irq_injection: failed to hook irq 0x%x (guest=0x%p)\n", irq, (void *)vm);
return -1;
} else {
- PrintDebug("guest_irq_injection: hooked irq 0x%x (guest=0x%p)\n", irq, (void *)vm);
+ PrintDebug(vm, VCORE_NONE, "guest_irq_injection: hooked irq 0x%x (guest=0x%p)\n", irq, (void *)vm);
return 0;
}
}
+
+
+
int v3_deliver_irq(struct v3_vm_info * vm, struct v3_interrupt * intr) {
- PrintDebug("v3_deliver_irq: irq=%d state=0x%p, \n", intr->irq, (void *)intr);
+ PrintDebug(vm, VCORE_NONE, "v3_deliver_irq: irq=%d state=0x%p, \n", intr->irq, (void *)intr);
struct v3_irq_hook * hook = get_irq_hook(vm, intr->irq);
if (hook == NULL) {
- PrintError("Attempting to deliver interrupt to non registered hook(irq=%d)\n", intr->irq);
+ PrintError(vm, VCORE_NONE, "Attempting to deliver interrupt to non registered hook(irq=%d)\n", intr->irq);
return -1;
}
}
+
+
+int v3_raise_swintr (struct guest_info * core, uint8_t vector) {
+ struct v3_intr_core_state * intr_state = &(core->intr_core_state);
+
+ PrintDebug(core->vm_info, core, "Signaling software interrupt in v3_signal_swintr()\n");
+ PrintDebug(core->vm_info, core, "\tINT vector: %d\n", vector);
+
+ intr_state->swintr_posted = 1;
+ intr_state->swintr_vector = vector;
+ return 0;
+}
+
+
+
int v3_raise_virq(struct guest_info * info, int irq) {
struct v3_intr_core_state * intr_state = &(info->intr_core_state);
int major = irq / 8;
return 0;
}
-
int v3_lower_virq(struct guest_info * info, int irq) {
struct v3_intr_core_state * intr_state = &(info->intr_core_state);
int major = irq / 8;
int v3_lower_irq(struct v3_vm_info * vm, int irq) {
- struct intr_router * router = NULL;
- struct v3_intr_routers * routers = &(vm->intr_routers);
+ struct v3_irq irq_state;
- // PrintDebug("[v3_lower_irq]\n");
- addr_t irq_state = v3_lock_irqsave(routers->irq_lock);
+ irq_state.irq = irq;
+ irq_state.ack = NULL;
+ irq_state.private_data = NULL;
- list_for_each_entry(router, &(routers->router_list), router_node) {
- router->router_ops->lower_intr(vm, router->priv_data, irq);
- }
-
- v3_unlock_irqrestore(routers->irq_lock, irq_state);
+ return v3_lower_acked_irq(vm, irq_state);
+}
- return 0;
+int v3_raise_irq(struct v3_vm_info * vm, int irq) {
+ struct v3_irq irq_state;
+
+ irq_state.irq = irq;
+ irq_state.ack = NULL;
+ irq_state.private_data = NULL;
+
+ return v3_raise_acked_irq(vm, irq_state);
}
-int v3_raise_irq(struct v3_vm_info * vm, int irq) {
+int v3_raise_acked_irq(struct v3_vm_info * vm, struct v3_irq irq) {
struct intr_router * router = NULL;
struct v3_intr_routers * routers = &(vm->intr_routers);
- // PrintDebug("[v3_raise_irq (%d)]\n", irq);
+ // PrintDebug(info->vm_info, info, "[v3_raise_irq (%d)]\n", irq);
addr_t irq_state = v3_lock_irqsave(routers->irq_lock);
list_for_each_entry(router, &(routers->router_list), router_node) {
- router->router_ops->raise_intr(vm, router->priv_data, irq);
+ router->router_ops->raise_intr(vm, router->priv_data, &irq);
}
v3_unlock_irqrestore(routers->irq_lock, irq_state);
}
-int v3_signal_swintr(struct guest_info * core, int vector) {
- struct v3_intr_core_state * intr_state = &(core->intr_core_state);
-
- PrintDebug("Signaling software interrupt in vmm_intr.c\n");
- PrintDebug("\tINT vector: %d\n", vector);
-
- intr_state->swintr_posted = 1;
- intr_state->swintr_vector = vector;
- return 0;
-}
-
-
-int v3_handle_swintr(struct guest_info * core) {
-
- int ret = 0;
- void * instr_ptr = NULL;
- struct x86_instr instr;
-
- if (core->mem_mode == PHYSICAL_MEM) {
- ret = v3_gpa_to_hva(core, get_addr_linear(core, core->rip, &(core->segments.cs)), (addr_t *)&instr_ptr);
- } else {
- ret = v3_gva_to_hva(core, get_addr_linear(core, core->rip, &(core->segments.cs)), (addr_t *)&instr_ptr);
- }
-
- if (ret == -1) {
- PrintError("V3 Syscall Hijack: Could not translate Instruction Address (%p)\n", (void *)core->rip);
- return -1;
- }
-
- if (v3_decode(core, (addr_t)instr_ptr, &instr) == -1) {
- PrintError("V3 Syscall Hijack: Decoding Error\n");
- return -1;
- }
-
- uint8_t vector = instr.dst_operand.operand;
-
- //PrintDebug("KCH: SWINT\n");
- //PrintDebug("KCH: Data - %x\n",*((uint32_t*)instr_ptr));
- //PrintDebug("\t RIP: %llx CS: %x\n", core->rip, core->segments.cs.selector);
- //PrintDebug("KCH: Disassembling\n\t");
- //addr_t rip = (addr_t) core->rip;
- //v3_disasm(core, instr_ptr, &rip, 1);
-
- //v3_print_instr(&instr);
- // only consider system calls
-
- /*
- if (vector == 0x80) {
- print_syscall(0, core);
- }
- */
-
- struct v3_swintr_hook * hook = core->intr_core_state.swintr_hooks[vector];
- if (hook == NULL) {
-#ifdef CONFIG_SWINTR_PASSTHROUGH
- if (v3_hook_passthrough_swintr(core, vector) == -1) {
- PrintDebug("Error hooking passthrough swintr\n");
- return -1;
- }
- hook = core->intr_core_state.swintr_hooks[vector];
-#else
- core->rip += instr.instr_length;
- return v3_signal_swintr(core, vector);
-#endif
- }
-
- ret = hook->handler(core, vector, NULL);
- if (ret == -1) {
- PrintDebug("V3 SWINT Handler: Error in swint hook\n");
- return -1;
- }
-
- /* make software interrupts prioritized so they finish in time for the next
- instruction?? */
- core->rip += instr.instr_length;
- return v3_signal_swintr(core, vector);
-}
-
-
-static inline struct v3_swintr_hook * get_swintr_hook(struct guest_info * core, uint8_t vector) {
- return core->intr_core_state.swintr_hooks[vector];
-}
-
-
-int v3_hook_swintr(struct guest_info * core,
- uint8_t vector,
- int (*handler)(struct guest_info * core, uint8_t vector, void * priv_data),
- void * priv_data)
-{
-
- struct v3_swintr_hook * hook = (struct v3_swintr_hook *)V3_Malloc(sizeof(struct v3_swintr_hook));
+int v3_lower_acked_irq(struct v3_vm_info * vm, struct v3_irq irq) {
+ struct intr_router * router = NULL;
+ struct v3_intr_routers * routers = &(vm->intr_routers);
- if (hook == NULL) {
- return -1;
- }
+ // PrintDebug(info->vm_info, info, "[v3_lower_irq]\n");
+ addr_t irq_state = v3_lock_irqsave(routers->irq_lock);
- if (get_swintr_hook(core, vector) != NULL) {
- PrintError("SWINT %d already hooked\n", vector);
- return -1;
+ list_for_each_entry(router, &(routers->router_list), router_node) {
+ router->router_ops->lower_intr(vm, router->priv_data, &irq);
}
-
- hook->handler = handler;
- hook->priv_data = priv_data;
-
- core->intr_core_state.swintr_hooks[vector] = hook;
+
+ v3_unlock_irqrestore(routers->irq_lock, irq_state);
return 0;
-}
-
-
-static int passthrough_swintr_handler(struct guest_info * core, uint8_t vector, void * priv_data) {
-
- PrintDebug("[passthrough_swint_handler] INT vector=%d (guest=0x%p)\n",
- vector, (void *)core);
- return 0;
}
-int v3_hook_passthrough_swintr(struct guest_info * core, uint8_t vector) {
-
- int rc = v3_hook_swintr(core, vector, passthrough_swintr_handler, NULL);
-
- if (rc) {
- PrintError("guest_swintr_injection: failed to hook swint 0x%x (guest=0x%p)\n", vector, (void *)core);
- return -1;
- } else {
- PrintDebug("guest_swintr_injection: hooked swint 0x%x (guest=0x%p)\n", vector, (void *)core);
- return 0;
- }
-
- /* shouldn't get here */
- return 0;
-}
-
void v3_clear_pending_intr(struct guest_info * core) {
struct v3_intr_core_state * intr_state = &(core->intr_core_state);
intr_state->irq_pending = 0;
+
}
int ret = V3_INVALID_INTR;
int i = 0;
- // PrintDebug("[intr_pending]\n");
+ // PrintDebug(info->vm_info, info, "[intr_pending]\n");
addr_t irq_state = v3_lock_irqsave(intr_state->irq_lock);
- // VIRQs have priority
+ // External IRQs have lowest priority
+ list_for_each_entry(ctrl, &(intr_state->controller_list), ctrl_node) {
+ if (ctrl->ctrl_ops->intr_pending(info, ctrl->priv_data)) {
+ ret = V3_EXTERNAL_IRQ;
+ break;
+ }
+ }
+
+ // VIRQs have 2nd priority
for (i = 0; i < MAX_IRQ / 8; i++) {
if (intr_state->virq_map[i] != 0) {
ret = V3_VIRTUAL_IRQ;
}
}
- if (ret == V3_INVALID_INTR) {
- list_for_each_entry(ctrl, &(intr_state->controller_list), ctrl_node) {
- if (ctrl->ctrl_ops->intr_pending(info, ctrl->priv_data) == 1) {
- ret = V3_EXTERNAL_IRQ;
- break;
- }
- }
- }
-
- // KCH
+ /* SWINTRs have highest */
if (intr_state->swintr_posted == 1) {
ret = V3_SOFTWARE_INTR;
}
-
+
v3_unlock_irqrestore(intr_state->irq_lock, irq_state);
return ret;
}
-uint32_t v3_get_intr(struct guest_info * info) {
+int v3_get_intr(struct guest_info * info) {
struct v3_intr_core_state * intr_state = &(info->intr_core_state);
struct intr_controller * ctrl = NULL;
- uint_t ret = 0;
+ int ret = -1;
int i = 0;
int j = 0;
+ int found_virq=0;
+ int found_irq=0;
addr_t irq_state = v3_lock_irqsave(intr_state->irq_lock);
for (j = 0; j < 8; j++) {
if (intr_state->virq_map[i] & (1 << j)) {
ret = (i * 8) + j;
+ // need to be able to find virq 0
+ found_virq=1;
break;
}
}
}
}
- if (!ret) {
+ if (!found_virq) {
list_for_each_entry(ctrl, &(intr_state->controller_list), ctrl_node) {
if (ctrl->ctrl_ops->intr_pending(info, ctrl->priv_data)) {
- uint_t intr_num = ctrl->ctrl_ops->get_intr_number(info, ctrl->priv_data);
+ int intr_num = ctrl->ctrl_ops->get_intr_number(info, ctrl->priv_data);
- // PrintDebug("[get_intr_number] intr_number = %d\n", intr_num);
- ret = intr_num;
- break;
+ if (intr_num >= 0) {
+ // PrintDebug(info->vm_info, info, "[get_intr_number] intr_number = %d\n", intr_num);
+ ret = intr_num;
+ found_irq=1;
+ break;
+ }
+
}
}
}
v3_unlock_irqrestore(intr_state->irq_lock, irq_state);
+ if (!found_virq && !found_irq) {
+ PrintError(info->vm_info,info,"Strange... neither a VIRQ nor an IRQ was found...\n");
+ }
+
return ret;
}
list_for_each_entry(ctrl, &(intr_state->controller_list), ctrl_node) {
if (ctrl->ctrl_ops->intr_pending(ctrl->priv_data) == 1) {
- //PrintDebug("[get_intr_type] External_irq\n");
+ //PrintDebug(info->vm_info, info, "[get_intr_type] External_irq\n");
type = V3_EXTERNAL_IRQ;
break;
}
}
-#ifdef CONFIG_DEBUG_INTERRUPTS
+#ifdef V3_CONFIG_DEBUG_INTERRUPTS
if (type == V3_INVALID_INTR) {
- PrintError("[get_intr_type] Invalid_Intr\n");
+ PrintError(info->vm_info, info, "[get_intr_type] Invalid_Intr\n");
}
#endif
*/
+
+
+
int v3_injecting_intr(struct guest_info * info, uint_t intr_num, v3_intr_type_t type) {
struct v3_intr_core_state * intr_state = &(info->intr_core_state);
addr_t irq_state = v3_lock_irqsave(intr_state->irq_lock);
- // PrintDebug("[injecting_intr] External_Irq with intr_num = %x\n", intr_num);
+ // PrintDebug(info->vm_info, info, "[injecting_intr] External_Irq with intr_num = %x\n", intr_num);
list_for_each_entry(ctrl, &(intr_state->controller_list), ctrl_node) {
ctrl->ctrl_ops->begin_irq(info, ctrl->priv_data, intr_num);
}
