| /* | |
| * Copyright (C) 2012,2013 - ARM Ltd | |
| * Author: Marc Zyngier <marc.zyngier@arm.com> | |
| * | |
| * Derived from arch/arm/kvm/handle_exit.c: | |
| * Copyright (C) 2012 - Virtual Open Systems and Columbia University | |
| * Author: Christoffer Dall <c.dall@virtualopensystems.com> | |
| * | |
| * This program is free software; you can redistribute it and/or modify | |
| * it under the terms of the GNU General Public License version 2 as | |
| * published by the Free Software Foundation. | |
| * | |
| * This program is distributed in the hope that it will be useful, | |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
| * GNU General Public License for more details. | |
| * | |
| * You should have received a copy of the GNU General Public License | |
| * along with this program. If not, see <http://www.gnu.org/licenses/>. | |
| */ | |
| #include <linux/kvm.h> | |
| #include <linux/kvm_host.h> | |
| #include <asm/kvm_emulate.h> | |
| #include <asm/kvm_coproc.h> | |
| #include <asm/kvm_mmu.h> | |
| #include <asm/kvm_psci.h> | |
| typedef int (*exit_handle_fn)(struct kvm_vcpu *, struct kvm_run *); | |
| static int handle_hvc(struct kvm_vcpu *vcpu, struct kvm_run *run) | |
| { | |
| if (kvm_psci_call(vcpu)) | |
| return 1; | |
| kvm_inject_undefined(vcpu); | |
| return 1; | |
| } | |
| static int handle_smc(struct kvm_vcpu *vcpu, struct kvm_run *run) | |
| { | |
| kvm_inject_undefined(vcpu); | |
| return 1; | |
| } | |
| /** | |
| * kvm_handle_wfx - handle a wait-for-interrupts or wait-for-event | |
| * instruction executed by a guest | |
| * | |
| * @vcpu: the vcpu pointer | |
| * | |
| * WFE: Yield the CPU and come back to this vcpu when the scheduler | |
| * decides to. | |
| * WFI: Simply call kvm_vcpu_block(), which will halt execution of | |
| * world-switches and schedule other host processes until there is an | |
| * incoming IRQ or FIQ to the VM. | |
| */ | |
| static int kvm_handle_wfx(struct kvm_vcpu *vcpu, struct kvm_run *run) | |
| { | |
| if (kvm_vcpu_get_hsr(vcpu) & ESR_EL2_EC_WFI_ISS_WFE) | |
| kvm_vcpu_on_spin(vcpu); | |
| else | |
| kvm_vcpu_block(vcpu); | |
| return 1; | |
| } | |
| static exit_handle_fn arm_exit_handlers[] = { | |
| [ESR_EL2_EC_WFI] = kvm_handle_wfx, | |
| [ESR_EL2_EC_CP15_32] = kvm_handle_cp15_32, | |
| [ESR_EL2_EC_CP15_64] = kvm_handle_cp15_64, | |
| [ESR_EL2_EC_CP14_MR] = kvm_handle_cp14_access, | |
| [ESR_EL2_EC_CP14_LS] = kvm_handle_cp14_load_store, | |
| [ESR_EL2_EC_CP14_64] = kvm_handle_cp14_access, | |
| [ESR_EL2_EC_HVC32] = handle_hvc, | |
| [ESR_EL2_EC_SMC32] = handle_smc, | |
| [ESR_EL2_EC_HVC64] = handle_hvc, | |
| [ESR_EL2_EC_SMC64] = handle_smc, | |
| [ESR_EL2_EC_SYS64] = kvm_handle_sys_reg, | |
| [ESR_EL2_EC_IABT] = kvm_handle_guest_abort, | |
| [ESR_EL2_EC_DABT] = kvm_handle_guest_abort, | |
| }; | |
| static exit_handle_fn kvm_get_exit_handler(struct kvm_vcpu *vcpu) | |
| { | |
| u8 hsr_ec = kvm_vcpu_trap_get_class(vcpu); | |
| if (hsr_ec >= ARRAY_SIZE(arm_exit_handlers) || | |
| !arm_exit_handlers[hsr_ec]) { | |
| kvm_err("Unknown exception class: hsr: %#08x\n", | |
| (unsigned int)kvm_vcpu_get_hsr(vcpu)); | |
| BUG(); | |
| } | |
| return arm_exit_handlers[hsr_ec]; | |
| } | |
| /* | |
| * Return > 0 to return to guest, < 0 on error, 0 (and set exit_reason) on | |
| * proper exit to userspace. | |
| */ | |
| int handle_exit(struct kvm_vcpu *vcpu, struct kvm_run *run, | |
| int exception_index) | |
| { | |
| exit_handle_fn exit_handler; | |
| switch (exception_index) { | |
| case ARM_EXCEPTION_IRQ: | |
| return 1; | |
| case ARM_EXCEPTION_TRAP: | |
| /* | |
| * See ARM ARM B1.14.1: "Hyp traps on instructions | |
| * that fail their condition code check" | |
| */ | |
| if (!kvm_condition_valid(vcpu)) { | |
| kvm_skip_instr(vcpu, kvm_vcpu_trap_il_is32bit(vcpu)); | |
| return 1; | |
| } | |
| exit_handler = kvm_get_exit_handler(vcpu); | |
| return exit_handler(vcpu, run); | |
| default: | |
| kvm_pr_unimpl("Unsupported exception type: %d", | |
| exception_index); | |
| run->exit_reason = KVM_EXIT_INTERNAL_ERROR; | |
| return 0; | |
| } | |
| } |