1 // SPDX-License-Identifier: GPL-2.0-only 1
2 /*
3 * Copyright (C) 2015 - ARM Ltd
4 * Author: Marc Zyngier <marc.zyngier@arm.com>
5 */
6
7 #include <hyp/debug-sr.h>
8
9 #include <linux/compiler.h>
10 #include <linux/kvm_host.h>
11
12 #include <asm/debug-monitors.h>
13 #include <asm/kvm_asm.h>
14 #include <asm/kvm_hyp.h>
15 #include <asm/kvm_mmu.h>
16
17 static void __debug_save_spe(u64 *pmscr_el1)
18 {
19 u64 reg;
20
21 /* Clear pmscr in case of early return
22 *pmscr_el1 = 0;
23
24 /*
25 * At this point, we know that this CP
26 * SPE and is available to the host.
27 * Check if the host is actually using
28 */
29 reg = read_sysreg_s(SYS_PMBLIMITR_EL1)
30 if (!(reg & BIT(PMBLIMITR_EL1_E_SHIFT)
31 return;
32
33 /* Yes; save the control register and
34 *pmscr_el1 = read_sysreg_el1(SYS_PMSCR
35 write_sysreg_el1(0, SYS_PMSCR);
36 isb();
37
38 /* Now drain all buffered data to memo
39 psb_csync();
40 }
41
42 static void __debug_restore_spe(u64 pmscr_el1)
43 {
44 if (!pmscr_el1)
45 return;
46
47 /* The host page table is installed, b
48 isb();
49
50 /* Re-enable data generation */
51 write_sysreg_el1(pmscr_el1, SYS_PMSCR)
52 }
53
54 static void __debug_save_trace(u64 *trfcr_el1)
55 {
56 *trfcr_el1 = 0;
57
58 /* Check if the TRBE is enabled */
59 if (!(read_sysreg_s(SYS_TRBLIMITR_EL1)
60 return;
61 /*
62 * Prohibit trace generation while we
63 * Since access to TRFCR_EL1 is trappe
64 * modify the filtering set by the hos
65 */
66 *trfcr_el1 = read_sysreg_el1(SYS_TRFCR
67 write_sysreg_el1(0, SYS_TRFCR);
68 isb();
69 /* Drain the trace buffer to memory */
70 tsb_csync();
71 }
72
73 static void __debug_restore_trace(u64 trfcr_el
74 {
75 if (!trfcr_el1)
76 return;
77
78 /* Restore trace filter controls */
79 write_sysreg_el1(trfcr_el1, SYS_TRFCR)
80 }
81
82 void __debug_save_host_buffers_nvhe(struct kvm
83 {
84 /* Disable and flush SPE data generati
85 if (vcpu_get_flag(vcpu, DEBUG_STATE_SA
86 __debug_save_spe(host_data_ptr
87 /* Disable and flush Self-Hosted Trace
88 if (vcpu_get_flag(vcpu, DEBUG_STATE_SA
89 __debug_save_trace(host_data_p
90 }
91
92 void __debug_switch_to_guest(struct kvm_vcpu *
93 {
94 __debug_switch_to_guest_common(vcpu);
95 }
96
97 void __debug_restore_host_buffers_nvhe(struct
98 {
99 if (vcpu_get_flag(vcpu, DEBUG_STATE_SA
100 __debug_restore_spe(*host_data
101 if (vcpu_get_flag(vcpu, DEBUG_STATE_SA
102 __debug_restore_trace(*host_da
103 }
104
105 void __debug_switch_to_host(struct kvm_vcpu *v
106 {
107 __debug_switch_to_host_common(vcpu);
108 }
109
110 u64 __kvm_get_mdcr_el2(void)
111 {
112 return read_sysreg(mdcr_el2);
113 }
114
Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.