reset.c 2.5 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788
  1. /*
  2. * Copyright (C) 2012 - Virtual Open Systems and Columbia University
  3. * Author: Christoffer Dall <c.dall@virtualopensystems.com>
  4. *
  5. * This program is free software; you can redistribute it and/or modify
  6. * it under the terms of the GNU General Public License, version 2, as
  7. * published by the Free Software Foundation.
  8. *
  9. * This program is distributed in the hope that it will be useful,
  10. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  12. * GNU General Public License for more details.
  13. *
  14. * You should have received a copy of the GNU General Public License
  15. * along with this program; if not, write to the Free Software
  16. * Foundation, 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
  17. */
  18. #include <linux/compiler.h>
  19. #include <linux/errno.h>
  20. #include <linux/sched.h>
  21. #include <linux/kvm_host.h>
  22. #include <linux/kvm.h>
  23. #include <asm/unified.h>
  24. #include <asm/ptrace.h>
  25. #include <asm/cputype.h>
  26. #include <asm/kvm_arm.h>
  27. #include <asm/kvm_coproc.h>
  28. #include <kvm/arm_arch_timer.h>
  29. /******************************************************************************
  30. * Cortex-A15 and Cortex-A7 Reset Values
  31. */
  32. static struct kvm_regs cortexa_regs_reset = {
  33. .usr_regs.ARM_cpsr = SVC_MODE | PSR_A_BIT | PSR_I_BIT | PSR_F_BIT,
  34. };
  35. static const struct kvm_irq_level cortexa_ptimer_irq = {
  36. { .irq = 30 },
  37. .level = 1,
  38. };
  39. static const struct kvm_irq_level cortexa_vtimer_irq = {
  40. { .irq = 27 },
  41. .level = 1,
  42. };
  43. /*******************************************************************************
  44. * Exported reset function
  45. */
  46. /**
  47. * kvm_reset_vcpu - sets core registers and cp15 registers to reset value
  48. * @vcpu: The VCPU pointer
  49. *
  50. * This function finds the right table above and sets the registers on the
  51. * virtual CPU struct to their architecturally defined reset values.
  52. */
  53. int kvm_reset_vcpu(struct kvm_vcpu *vcpu)
  54. {
  55. struct kvm_regs *reset_regs;
  56. const struct kvm_irq_level *cpu_vtimer_irq;
  57. const struct kvm_irq_level *cpu_ptimer_irq;
  58. switch (vcpu->arch.target) {
  59. case KVM_ARM_TARGET_CORTEX_A7:
  60. case KVM_ARM_TARGET_CORTEX_A15:
  61. reset_regs = &cortexa_regs_reset;
  62. vcpu->arch.midr = read_cpuid_id();
  63. cpu_vtimer_irq = &cortexa_vtimer_irq;
  64. cpu_ptimer_irq = &cortexa_ptimer_irq;
  65. break;
  66. default:
  67. return -ENODEV;
  68. }
  69. /* Reset core registers */
  70. memcpy(&vcpu->arch.ctxt.gp_regs, reset_regs, sizeof(vcpu->arch.ctxt.gp_regs));
  71. /* Reset CP15 registers */
  72. kvm_reset_coprocs(vcpu);
  73. /* Reset arch_timer context */
  74. return kvm_timer_vcpu_reset(vcpu, cpu_vtimer_irq, cpu_ptimer_irq);
  75. }