arch/arm64/kvm/hyp/debug-sr.c

   1 /*
   2  * Copyright (C) 2015 - ARM Ltd
   3  * Author: Marc Zyngier <marc.zyngier@arm.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, see <http://www.gnu.org/licenses/>.
  16  */
  17
  18 #include <linux/compiler.h>
  19 #include <linux/kvm_host.h>
  20
  21 #include <asm/debug-monitors.h>
  22 #include <asm/kvm_asm.h>
  23 #include <asm/kvm_mmu.h>
  24
  25 #include "hyp.h"
  26
  27 #define read_debug(r,n)         read_sysreg(r##n##_el1)
  28 #define write_debug(v,r,n)      write_sysreg(v, r##n##_el1)
  29
  30 #define save_debug(ptr,reg,nr)                                          \
  31         switch (nr) {                                                   \
  32         case 15:        ptr[15] = read_debug(reg, 15);                  \
  33         case 14:        ptr[14] = read_debug(reg, 14);                  \
  34         case 13:        ptr[13] = read_debug(reg, 13);                  \
  35         case 12:        ptr[12] = read_debug(reg, 12);                  \
  36         case 11:        ptr[11] = read_debug(reg, 11);                  \
  37         case 10:        ptr[10] = read_debug(reg, 10);                  \
  38         case 9:         ptr[9] = read_debug(reg, 9);                    \
  39         case 8:         ptr[8] = read_debug(reg, 8);                    \
  40         case 7:         ptr[7] = read_debug(reg, 7);                    \
  41         case 6:         ptr[6] = read_debug(reg, 6);                    \
  42         case 5:         ptr[5] = read_debug(reg, 5);                    \
  43         case 4:         ptr[4] = read_debug(reg, 4);                    \
  44         case 3:         ptr[3] = read_debug(reg, 3);                    \
  45         case 2:         ptr[2] = read_debug(reg, 2);                    \
  46         case 1:         ptr[1] = read_debug(reg, 1);                    \
  47         default:        ptr[0] = read_debug(reg, 0);                    \
  48         }
  49
  50 #define restore_debug(ptr,reg,nr)                                       \
  51         switch (nr) {                                                   \
  52         case 15:        write_debug(ptr[15], reg, 15);                  \
  53         case 14:        write_debug(ptr[14], reg, 14);                  \
  54         case 13:        write_debug(ptr[13], reg, 13);                  \
  55         case 12:        write_debug(ptr[12], reg, 12);                  \
  56         case 11:        write_debug(ptr[11], reg, 11);                  \
  57         case 10:        write_debug(ptr[10], reg, 10);                  \
  58         case 9:         write_debug(ptr[9], reg, 9);                    \
  59         case 8:         write_debug(ptr[8], reg, 8);                    \
  60         case 7:         write_debug(ptr[7], reg, 7);                    \
  61         case 6:         write_debug(ptr[6], reg, 6);                    \
  62         case 5:         write_debug(ptr[5], reg, 5);                    \
  63         case 4:         write_debug(ptr[4], reg, 4);                    \
  64         case 3:         write_debug(ptr[3], reg, 3);                    \
  65         case 2:         write_debug(ptr[2], reg, 2);                    \
  66         case 1:         write_debug(ptr[1], reg, 1);                    \
  67         default:        write_debug(ptr[0], reg, 0);                    \
  68         }
  69
  70 void __hyp_text __debug_save_state(struct kvm_vcpu *vcpu,
  71                                    struct kvm_guest_debug_arch *dbg,
  72                                    struct kvm_cpu_context *ctxt)
  73 {
  74         u64 aa64dfr0;
  75         int brps, wrps;
  76
  77         if (!(vcpu->arch.debug_flags & KVM_ARM64_DEBUG_DIRTY))
  78                 return;
  79
  80         aa64dfr0 = read_sysreg(id_aa64dfr0_el1);
  81         brps = (aa64dfr0 >> 12) & 0xf;
  82         wrps = (aa64dfr0 >> 20) & 0xf;
  83
  84         save_debug(dbg->dbg_bcr, dbgbcr, brps);
  85         save_debug(dbg->dbg_bvr, dbgbvr, brps);
  86         save_debug(dbg->dbg_wcr, dbgwcr, wrps);
  87         save_debug(dbg->dbg_wvr, dbgwvr, wrps);
  88
  89         ctxt->sys_regs[MDCCINT_EL1] = read_sysreg(mdccint_el1);
  90 }
  91
  92 void __hyp_text __debug_restore_state(struct kvm_vcpu *vcpu,
  93                                       struct kvm_guest_debug_arch *dbg,
  94                                       struct kvm_cpu_context *ctxt)
  95 {
  96         u64 aa64dfr0;
  97         int brps, wrps;
  98
  99         if (!(vcpu->arch.debug_flags & KVM_ARM64_DEBUG_DIRTY))
 100                 return;
 101
 102         aa64dfr0 = read_sysreg(id_aa64dfr0_el1);
 103
 104         brps = (aa64dfr0 >> 12) & 0xf;
 105         wrps = (aa64dfr0 >> 20) & 0xf;
 106
 107         restore_debug(dbg->dbg_bcr, dbgbcr, brps);
 108         restore_debug(dbg->dbg_bvr, dbgbvr, brps);
 109         restore_debug(dbg->dbg_wcr, dbgwcr, wrps);
 110         restore_debug(dbg->dbg_wvr, dbgwvr, wrps);
 111
 112         write_sysreg(ctxt->sys_regs[MDCCINT_EL1], mdccint_el1);
 113 }
 114
 115 void __hyp_text __debug_cond_save_host_state(struct kvm_vcpu *vcpu)
 116 {
 117         /* If any of KDE, MDE or KVM_ARM64_DEBUG_DIRTY is set, perform
 118          * a full save/restore cycle. */
 119         if ((vcpu->arch.ctxt.sys_regs[MDSCR_EL1] & DBG_MDSCR_KDE) ||
 120             (vcpu->arch.ctxt.sys_regs[MDSCR_EL1] & DBG_MDSCR_MDE))
 121                 vcpu->arch.debug_flags |= KVM_ARM64_DEBUG_DIRTY;
 122
 123         __debug_save_state(vcpu, &vcpu->arch.host_debug_state,
 124                            kern_hyp_va(vcpu->arch.host_cpu_context));
 125 }
 126
 127 void __hyp_text __debug_cond_restore_host_state(struct kvm_vcpu *vcpu)
 128 {
 129         __debug_restore_state(vcpu, &vcpu->arch.host_debug_state,
 130                               kern_hyp_va(vcpu->arch.host_cpu_context));
 131
 132         if (vcpu->arch.debug_flags & KVM_ARM64_DEBUG_DIRTY)
 133                 vcpu->arch.debug_flags &= ~KVM_ARM64_DEBUG_DIRTY;
 134 }
 135
 136 static u32 __hyp_text __debug_read_mdcr_el2(void)
 137 {
 138         return read_sysreg(mdcr_el2);
 139 }
 140
 141 __alias(__debug_read_mdcr_el2) u32 __kvm_get_mdcr_el2(void);