1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (C) 2016 - Linaro and Columbia University
4 * Author: Jintack Lim <jintack.lim@linaro.org>
5 */
6
7 #include <linux/kvm.h>
8 #include <linux/kvm_host.h>
9
10 #include <asm/kvm_emulate.h>
11 #include <asm/kvm_nested.h>
12
13 #include "hyp/include/hyp/adjust_pc.h"
14
15 #include "trace.h"
16
17 enum trap_behaviour {
18 BEHAVE_HANDLE_LOCALLY = 0,
19 BEHAVE_FORWARD_READ = BIT(0),
20 BEHAVE_FORWARD_WRITE = BIT(1),
21 BEHAVE_FORWARD_ANY = BEHAVE_FORWARD_READ | BEHAVE_FORWARD_WRITE,
22 };
23
24 struct trap_bits {
25 const enum vcpu_sysreg index;
26 const enum trap_behaviour behaviour;
27 const u64 value;
28 const u64 mask;
29 };
30
31 /* Coarse Grained Trap definitions */
32 enum cgt_group_id {
33 /* Indicates no coarse trap control */
34 __RESERVED__,
35
36 /*
37 * The first batch of IDs denote coarse trapping that are used
38 * on their own instead of being part of a combination of
39 * trap controls.
40 */
41 CGT_HCR_TID1,
42 CGT_HCR_TID2,
43 CGT_HCR_TID3,
44 CGT_HCR_IMO,
45 CGT_HCR_FMO,
46 CGT_HCR_TIDCP,
47 CGT_HCR_TACR,
48 CGT_HCR_TSW,
49 CGT_HCR_TPC,
50 CGT_HCR_TPU,
51 CGT_HCR_TTLB,
52 CGT_HCR_TVM,
53 CGT_HCR_TDZ,
54 CGT_HCR_TRVM,
55 CGT_HCR_TLOR,
56 CGT_HCR_TERR,
57 CGT_HCR_APK,
58 CGT_HCR_NV,
59 CGT_HCR_NV_nNV2,
60 CGT_HCR_NV1_nNV2,
61 CGT_HCR_AT,
62 CGT_HCR_nFIEN,
63 CGT_HCR_TID4,
64 CGT_HCR_TICAB,
65 CGT_HCR_TOCU,
66 CGT_HCR_ENSCXT,
67 CGT_HCR_TTLBIS,
68 CGT_HCR_TTLBOS,
69
70 CGT_MDCR_TPMCR,
71 CGT_MDCR_TPM,
72 CGT_MDCR_TDE,
73 CGT_MDCR_TDA,
74 CGT_MDCR_TDOSA,
75 CGT_MDCR_TDRA,
76 CGT_MDCR_E2PB,
77 CGT_MDCR_TPMS,
78 CGT_MDCR_TTRF,
79 CGT_MDCR_E2TB,
80 CGT_MDCR_TDCC,
81
82 /*
83 * Anything after this point is a combination of coarse trap
84 * controls, which must all be evaluated to decide what to do.
85 */
86 __MULTIPLE_CONTROL_BITS__,
87 CGT_HCR_IMO_FMO = __MULTIPLE_CONTROL_BITS__,
88 CGT_HCR_TID2_TID4,
89 CGT_HCR_TTLB_TTLBIS,
90 CGT_HCR_TTLB_TTLBOS,
91 CGT_HCR_TVM_TRVM,
92 CGT_HCR_TPU_TICAB,
93 CGT_HCR_TPU_TOCU,
94 CGT_HCR_NV1_nNV2_ENSCXT,
95 CGT_MDCR_TPM_TPMCR,
96 CGT_MDCR_TDE_TDA,
97 CGT_MDCR_TDE_TDOSA,
98 CGT_MDCR_TDE_TDRA,
99 CGT_MDCR_TDCC_TDE_TDA,
100
101 /*
102 * Anything after this point requires a callback evaluating a
103 * complex trap condition. Ugly stuff.
104 */
105 __COMPLEX_CONDITIONS__,
106 CGT_CNTHCTL_EL1PCTEN = __COMPLEX_CONDITIONS__,
107 CGT_CNTHCTL_EL1PTEN,
108
109 /* Must be last */
110 __NR_CGT_GROUP_IDS__
111 };
112
113 static const struct trap_bits coarse_trap_bits[] = {
114 [CGT_HCR_TID1] = {
115 .index = HCR_EL2,
116 .value = HCR_TID1,
117 .mask = HCR_TID1,
118 .behaviour = BEHAVE_FORWARD_READ,
119 },
120 [CGT_HCR_TID2] = {
121 .index = HCR_EL2,
122 .value = HCR_TID2,
123 .mask = HCR_TID2,
124 .behaviour = BEHAVE_FORWARD_ANY,
125 },
126 [CGT_HCR_TID3] = {
127 .index = HCR_EL2,
128 .value = HCR_TID3,
129 .mask = HCR_TID3,
130 .behaviour = BEHAVE_FORWARD_READ,
131 },
132 [CGT_HCR_IMO] = {
133 .index = HCR_EL2,
134 .value = HCR_IMO,
135 .mask = HCR_IMO,
136 .behaviour = BEHAVE_FORWARD_WRITE,
137 },
138 [CGT_HCR_FMO] = {
139 .index = HCR_EL2,
140 .value = HCR_FMO,
141 .mask = HCR_FMO,
142 .behaviour = BEHAVE_FORWARD_WRITE,
143 },
144 [CGT_HCR_TIDCP] = {
145 .index = HCR_EL2,
146 .value = HCR_TIDCP,
147 .mask = HCR_TIDCP,
148 .behaviour = BEHAVE_FORWARD_ANY,
149 },
150 [CGT_HCR_TACR] = {
151 .index = HCR_EL2,
152 .value = HCR_TACR,
153 .mask = HCR_TACR,
154 .behaviour = BEHAVE_FORWARD_ANY,
155 },
156 [CGT_HCR_TSW] = {
157 .index = HCR_EL2,
158 .value = HCR_TSW,
159 .mask = HCR_TSW,
160 .behaviour = BEHAVE_FORWARD_ANY,
161 },
162 [CGT_HCR_TPC] = { /* Also called TCPC when FEAT_DPB is implemented */
163 .index = HCR_EL2,
164 .value = HCR_TPC,
165 .mask = HCR_TPC,
166 .behaviour = BEHAVE_FORWARD_ANY,
167 },
168 [CGT_HCR_TPU] = {
169 .index = HCR_EL2,
170 .value = HCR_TPU,
171 .mask = HCR_TPU,
172 .behaviour = BEHAVE_FORWARD_ANY,
173 },
174 [CGT_HCR_TTLB] = {
175 .index = HCR_EL2,
176 .value = HCR_TTLB,
177 .mask = HCR_TTLB,
178 .behaviour = BEHAVE_FORWARD_ANY,
179 },
180 [CGT_HCR_TVM] = {
181 .index = HCR_EL2,
182 .value = HCR_TVM,
183 .mask = HCR_TVM,
184 .behaviour = BEHAVE_FORWARD_WRITE,
185 },
186 [CGT_HCR_TDZ] = {
187 .index = HCR_EL2,
188 .value = HCR_TDZ,
189 .mask = HCR_TDZ,
190 .behaviour = BEHAVE_FORWARD_ANY,
191 },
192 [CGT_HCR_TRVM] = {
193 .index = HCR_EL2,
194 .value = HCR_TRVM,
195 .mask = HCR_TRVM,
196 .behaviour = BEHAVE_FORWARD_READ,
197 },
198 [CGT_HCR_TLOR] = {
199 .index = HCR_EL2,
200 .value = HCR_TLOR,
201 .mask = HCR_TLOR,
202 .behaviour = BEHAVE_FORWARD_ANY,
203 },
204 [CGT_HCR_TERR] = {
205 .index = HCR_EL2,
206 .value = HCR_TERR,
207 .mask = HCR_TERR,
208 .behaviour = BEHAVE_FORWARD_ANY,
209 },
210 [CGT_HCR_APK] = {
211 .index = HCR_EL2,
212 .value = 0,
213 .mask = HCR_APK,
214 .behaviour = BEHAVE_FORWARD_ANY,
215 },
216 [CGT_HCR_NV] = {
217 .index = HCR_EL2,
218 .value = HCR_NV,
219 .mask = HCR_NV,
220 .behaviour = BEHAVE_FORWARD_ANY,
221 },
222 [CGT_HCR_NV_nNV2] = {
223 .index = HCR_EL2,
224 .value = HCR_NV,
225 .mask = HCR_NV | HCR_NV2,
226 .behaviour = BEHAVE_FORWARD_ANY,
227 },
228 [CGT_HCR_NV1_nNV2] = {
229 .index = HCR_EL2,
230 .value = HCR_NV | HCR_NV1,
231 .mask = HCR_NV | HCR_NV1 | HCR_NV2,
232 .behaviour = BEHAVE_FORWARD_ANY,
233 },
234 [CGT_HCR_AT] = {
235 .index = HCR_EL2,
236 .value = HCR_AT,
237 .mask = HCR_AT,
238 .behaviour = BEHAVE_FORWARD_ANY,
239 },
240 [CGT_HCR_nFIEN] = {
241 .index = HCR_EL2,
242 .value = 0,
243 .mask = HCR_FIEN,
244 .behaviour = BEHAVE_FORWARD_ANY,
245 },
246 [CGT_HCR_TID4] = {
247 .index = HCR_EL2,
248 .value = HCR_TID4,
249 .mask = HCR_TID4,
250 .behaviour = BEHAVE_FORWARD_ANY,
251 },
252 [CGT_HCR_TICAB] = {
253 .index = HCR_EL2,
254 .value = HCR_TICAB,
255 .mask = HCR_TICAB,
256 .behaviour = BEHAVE_FORWARD_ANY,
257 },
258 [CGT_HCR_TOCU] = {
259 .index = HCR_EL2,
260 .value = HCR_TOCU,
261 .mask = HCR_TOCU,
262 .behaviour = BEHAVE_FORWARD_ANY,
263 },
264 [CGT_HCR_ENSCXT] = {
265 .index = HCR_EL2,
266 .value = 0,
267 .mask = HCR_ENSCXT,
268 .behaviour = BEHAVE_FORWARD_ANY,
269 },
270 [CGT_HCR_TTLBIS] = {
271 .index = HCR_EL2,
272 .value = HCR_TTLBIS,
273 .mask = HCR_TTLBIS,
274 .behaviour = BEHAVE_FORWARD_ANY,
275 },
276 [CGT_HCR_TTLBOS] = {
277 .index = HCR_EL2,
278 .value = HCR_TTLBOS,
279 .mask = HCR_TTLBOS,
280 .behaviour = BEHAVE_FORWARD_ANY,
281 },
282 [CGT_MDCR_TPMCR] = {
283 .index = MDCR_EL2,
284 .value = MDCR_EL2_TPMCR,
285 .mask = MDCR_EL2_TPMCR,
286 .behaviour = BEHAVE_FORWARD_ANY,
287 },
288 [CGT_MDCR_TPM] = {
289 .index = MDCR_EL2,
290 .value = MDCR_EL2_TPM,
291 .mask = MDCR_EL2_TPM,
292 .behaviour = BEHAVE_FORWARD_ANY,
293 },
294 [CGT_MDCR_TDE] = {
295 .index = MDCR_EL2,
296 .value = MDCR_EL2_TDE,
297 .mask = MDCR_EL2_TDE,
298 .behaviour = BEHAVE_FORWARD_ANY,
299 },
300 [CGT_MDCR_TDA] = {
301 .index = MDCR_EL2,
302 .value = MDCR_EL2_TDA,
303 .mask = MDCR_EL2_TDA,
304 .behaviour = BEHAVE_FORWARD_ANY,
305 },
306 [CGT_MDCR_TDOSA] = {
307 .index = MDCR_EL2,
308 .value = MDCR_EL2_TDOSA,
309 .mask = MDCR_EL2_TDOSA,
310 .behaviour = BEHAVE_FORWARD_ANY,
311 },
312 [CGT_MDCR_TDRA] = {
313 .index = MDCR_EL2,
314 .value = MDCR_EL2_TDRA,
315 .mask = MDCR_EL2_TDRA,
316 .behaviour = BEHAVE_FORWARD_ANY,
317 },
318 [CGT_MDCR_E2PB] = {
319 .index = MDCR_EL2,
320 .value = 0,
321 .mask = BIT(MDCR_EL2_E2PB_SHIFT),
322 .behaviour = BEHAVE_FORWARD_ANY,
323 },
324 [CGT_MDCR_TPMS] = {
325 .index = MDCR_EL2,
326 .value = MDCR_EL2_TPMS,
327 .mask = MDCR_EL2_TPMS,
328 .behaviour = BEHAVE_FORWARD_ANY,
329 },
330 [CGT_MDCR_TTRF] = {
331 .index = MDCR_EL2,
332 .value = MDCR_EL2_TTRF,
333 .mask = MDCR_EL2_TTRF,
334 .behaviour = BEHAVE_FORWARD_ANY,
335 },
336 [CGT_MDCR_E2TB] = {
337 .index = MDCR_EL2,
338 .value = 0,
339 .mask = BIT(MDCR_EL2_E2TB_SHIFT),
340 .behaviour = BEHAVE_FORWARD_ANY,
341 },
342 [CGT_MDCR_TDCC] = {
343 .index = MDCR_EL2,
344 .value = MDCR_EL2_TDCC,
345 .mask = MDCR_EL2_TDCC,
346 .behaviour = BEHAVE_FORWARD_ANY,
347 },
348 };
349
350 #define MCB(id, ...) \
351 [id - __MULTIPLE_CONTROL_BITS__] = \
352 (const enum cgt_group_id[]){ \
353 __VA_ARGS__, __RESERVED__ \
354 }
355
356 static const enum cgt_group_id *coarse_control_combo[] = {
357 MCB(CGT_HCR_IMO_FMO, CGT_HCR_IMO, CGT_HCR_FMO),
358 MCB(CGT_HCR_TID2_TID4, CGT_HCR_TID2, CGT_HCR_TID4),
359 MCB(CGT_HCR_TTLB_TTLBIS, CGT_HCR_TTLB, CGT_HCR_TTLBIS),
360 MCB(CGT_HCR_TTLB_TTLBOS, CGT_HCR_TTLB, CGT_HCR_TTLBOS),
361 MCB(CGT_HCR_TVM_TRVM, CGT_HCR_TVM, CGT_HCR_TRVM),
362 MCB(CGT_HCR_TPU_TICAB, CGT_HCR_TPU, CGT_HCR_TICAB),
363 MCB(CGT_HCR_TPU_TOCU, CGT_HCR_TPU, CGT_HCR_TOCU),
364 MCB(CGT_HCR_NV1_nNV2_ENSCXT, CGT_HCR_NV1_nNV2, CGT_HCR_ENSCXT),
365 MCB(CGT_MDCR_TPM_TPMCR, CGT_MDCR_TPM, CGT_MDCR_TPMCR),
366 MCB(CGT_MDCR_TDE_TDA, CGT_MDCR_TDE, CGT_MDCR_TDA),
367 MCB(CGT_MDCR_TDE_TDOSA, CGT_MDCR_TDE, CGT_MDCR_TDOSA),
368 MCB(CGT_MDCR_TDE_TDRA, CGT_MDCR_TDE, CGT_MDCR_TDRA),
369 MCB(CGT_MDCR_TDCC_TDE_TDA, CGT_MDCR_TDCC, CGT_MDCR_TDE, CGT_MDCR_TDA),
370 };
371
372 typedef enum trap_behaviour (*complex_condition_check)(struct kvm_vcpu *);
373
374 /*
375 * Warning, maximum confusion ahead.
376 *
377 * When E2H=0, CNTHCTL_EL2[1:0] are defined as EL1PCEN:EL1PCTEN
378 * When E2H=1, CNTHCTL_EL2[11:10] are defined as EL1PTEN:EL1PCTEN
379 *
380 * Note the single letter difference? Yet, the bits have the same
381 * function despite a different layout and a different name.
382 *
383 * We don't try to reconcile this mess. We just use the E2H=0 bits
384 * to generate something that is in the E2H=1 format, and live with
385 * it. You're welcome.
386 */
387 static u64 get_sanitized_cnthctl(struct kvm_vcpu *vcpu)
388 {
389 u64 val = __vcpu_sys_reg(vcpu, CNTHCTL_EL2);
390
391 if (!vcpu_el2_e2h_is_set(vcpu))
392 val = (val & (CNTHCTL_EL1PCEN | CNTHCTL_EL1PCTEN)) << 10;
393
394 return val & ((CNTHCTL_EL1PCEN | CNTHCTL_EL1PCTEN) << 10);
395 }
396
check_cnthctl_el1pcten(struct kvm_vcpu * vcpu)397 static enum trap_behaviour check_cnthctl_el1pcten(struct kvm_vcpu *vcpu)
398 {
399 if (get_sanitized_cnthctl(vcpu) & (CNTHCTL_EL1PCTEN << 10))
400 return BEHAVE_HANDLE_LOCALLY;
401
402 return BEHAVE_FORWARD_ANY;
403 }
404
check_cnthctl_el1pten(struct kvm_vcpu * vcpu)405 static enum trap_behaviour check_cnthctl_el1pten(struct kvm_vcpu *vcpu)
406 {
407 if (get_sanitized_cnthctl(vcpu) & (CNTHCTL_EL1PCEN << 10))
408 return BEHAVE_HANDLE_LOCALLY;
409
410 return BEHAVE_FORWARD_ANY;
411 }
412
413 #define CCC(id, fn) \
414 [id - __COMPLEX_CONDITIONS__] = fn
415
416 static const complex_condition_check ccc[] = {
417 CCC(CGT_CNTHCTL_EL1PCTEN, check_cnthctl_el1pcten),
418 CCC(CGT_CNTHCTL_EL1PTEN, check_cnthctl_el1pten),
419 };
420
421 /*
422 * Bit assignment for the trap controls. We use a 64bit word with the
423 * following layout for each trapped sysreg:
424 *
425 * [9:0] enum cgt_group_id (10 bits)
426 * [13:10] enum fgt_group_id (4 bits)
427 * [19:14] bit number in the FGT register (6 bits)
428 * [20] trap polarity (1 bit)
429 * [25:21] FG filter (5 bits)
430 * [62:26] Unused (37 bits)
431 * [63] RES0 - Must be zero, as lost on insertion in the xarray
432 */
433 #define TC_CGT_BITS 10
434 #define TC_FGT_BITS 4
435 #define TC_FGF_BITS 5
436
437 union trap_config {
438 u64 val;
439 struct {
440 unsigned long cgt:TC_CGT_BITS; /* Coarse Grained Trap id */
441 unsigned long fgt:TC_FGT_BITS; /* Fine Grained Trap id */
442 unsigned long bit:6; /* Bit number */
443 unsigned long pol:1; /* Polarity */
444 unsigned long fgf:TC_FGF_BITS; /* Fine Grained Filter */
445 unsigned long unused:37; /* Unused, should be zero */
446 unsigned long mbz:1; /* Must Be Zero */
447 };
448 };
449
450 struct encoding_to_trap_config {
451 const u32 encoding;
452 const u32 end;
453 const union trap_config tc;
454 const unsigned int line;
455 };
456
457 #define SR_RANGE_TRAP(sr_start, sr_end, trap_id) \
458 { \
459 .encoding = sr_start, \
460 .end = sr_end, \
461 .tc = { \
462 .cgt = trap_id, \
463 }, \
464 .line = __LINE__, \
465 }
466
467 #define SR_TRAP(sr, trap_id) SR_RANGE_TRAP(sr, sr, trap_id)
468
469 /*
470 * Map encoding to trap bits for exception reported with EC=0x18.
471 * These must only be evaluated when running a nested hypervisor, but
472 * that the current context is not a hypervisor context. When the
473 * trapped access matches one of the trap controls, the exception is
474 * re-injected in the nested hypervisor.
475 */
476 static const struct encoding_to_trap_config encoding_to_cgt[] __initconst = {
477 SR_TRAP(SYS_REVIDR_EL1, CGT_HCR_TID1),
478 SR_TRAP(SYS_AIDR_EL1, CGT_HCR_TID1),
479 SR_TRAP(SYS_SMIDR_EL1, CGT_HCR_TID1),
480 SR_TRAP(SYS_CTR_EL0, CGT_HCR_TID2),
481 SR_TRAP(SYS_CCSIDR_EL1, CGT_HCR_TID2_TID4),
482 SR_TRAP(SYS_CCSIDR2_EL1, CGT_HCR_TID2_TID4),
483 SR_TRAP(SYS_CLIDR_EL1, CGT_HCR_TID2_TID4),
484 SR_TRAP(SYS_CSSELR_EL1, CGT_HCR_TID2_TID4),
485 SR_RANGE_TRAP(SYS_ID_PFR0_EL1,
486 sys_reg(3, 0, 0, 7, 7), CGT_HCR_TID3),
487 SR_TRAP(SYS_ICC_SGI0R_EL1, CGT_HCR_IMO_FMO),
488 SR_TRAP(SYS_ICC_ASGI1R_EL1, CGT_HCR_IMO_FMO),
489 SR_TRAP(SYS_ICC_SGI1R_EL1, CGT_HCR_IMO_FMO),
490 SR_RANGE_TRAP(sys_reg(3, 0, 11, 0, 0),
491 sys_reg(3, 0, 11, 15, 7), CGT_HCR_TIDCP),
492 SR_RANGE_TRAP(sys_reg(3, 1, 11, 0, 0),
493 sys_reg(3, 1, 11, 15, 7), CGT_HCR_TIDCP),
494 SR_RANGE_TRAP(sys_reg(3, 2, 11, 0, 0),
495 sys_reg(3, 2, 11, 15, 7), CGT_HCR_TIDCP),
496 SR_RANGE_TRAP(sys_reg(3, 3, 11, 0, 0),
497 sys_reg(3, 3, 11, 15, 7), CGT_HCR_TIDCP),
498 SR_RANGE_TRAP(sys_reg(3, 4, 11, 0, 0),
499 sys_reg(3, 4, 11, 15, 7), CGT_HCR_TIDCP),
500 SR_RANGE_TRAP(sys_reg(3, 5, 11, 0, 0),
501 sys_reg(3, 5, 11, 15, 7), CGT_HCR_TIDCP),
502 SR_RANGE_TRAP(sys_reg(3, 6, 11, 0, 0),
503 sys_reg(3, 6, 11, 15, 7), CGT_HCR_TIDCP),
504 SR_RANGE_TRAP(sys_reg(3, 7, 11, 0, 0),
505 sys_reg(3, 7, 11, 15, 7), CGT_HCR_TIDCP),
506 SR_RANGE_TRAP(sys_reg(3, 0, 15, 0, 0),
507 sys_reg(3, 0, 15, 15, 7), CGT_HCR_TIDCP),
508 SR_RANGE_TRAP(sys_reg(3, 1, 15, 0, 0),
509 sys_reg(3, 1, 15, 15, 7), CGT_HCR_TIDCP),
510 SR_RANGE_TRAP(sys_reg(3, 2, 15, 0, 0),
511 sys_reg(3, 2, 15, 15, 7), CGT_HCR_TIDCP),
512 SR_RANGE_TRAP(sys_reg(3, 3, 15, 0, 0),
513 sys_reg(3, 3, 15, 15, 7), CGT_HCR_TIDCP),
514 SR_RANGE_TRAP(sys_reg(3, 4, 15, 0, 0),
515 sys_reg(3, 4, 15, 15, 7), CGT_HCR_TIDCP),
516 SR_RANGE_TRAP(sys_reg(3, 5, 15, 0, 0),
517 sys_reg(3, 5, 15, 15, 7), CGT_HCR_TIDCP),
518 SR_RANGE_TRAP(sys_reg(3, 6, 15, 0, 0),
519 sys_reg(3, 6, 15, 15, 7), CGT_HCR_TIDCP),
520 SR_RANGE_TRAP(sys_reg(3, 7, 15, 0, 0),
521 sys_reg(3, 7, 15, 15, 7), CGT_HCR_TIDCP),
522 SR_TRAP(SYS_ACTLR_EL1, CGT_HCR_TACR),
523 SR_TRAP(SYS_DC_ISW, CGT_HCR_TSW),
524 SR_TRAP(SYS_DC_CSW, CGT_HCR_TSW),
525 SR_TRAP(SYS_DC_CISW, CGT_HCR_TSW),
526 SR_TRAP(SYS_DC_IGSW, CGT_HCR_TSW),
527 SR_TRAP(SYS_DC_IGDSW, CGT_HCR_TSW),
528 SR_TRAP(SYS_DC_CGSW, CGT_HCR_TSW),
529 SR_TRAP(SYS_DC_CGDSW, CGT_HCR_TSW),
530 SR_TRAP(SYS_DC_CIGSW, CGT_HCR_TSW),
531 SR_TRAP(SYS_DC_CIGDSW, CGT_HCR_TSW),
532 SR_TRAP(SYS_DC_CIVAC, CGT_HCR_TPC),
533 SR_TRAP(SYS_DC_CVAC, CGT_HCR_TPC),
534 SR_TRAP(SYS_DC_CVAP, CGT_HCR_TPC),
535 SR_TRAP(SYS_DC_CVADP, CGT_HCR_TPC),
536 SR_TRAP(SYS_DC_IVAC, CGT_HCR_TPC),
537 SR_TRAP(SYS_DC_CIGVAC, CGT_HCR_TPC),
538 SR_TRAP(SYS_DC_CIGDVAC, CGT_HCR_TPC),
539 SR_TRAP(SYS_DC_IGVAC, CGT_HCR_TPC),
540 SR_TRAP(SYS_DC_IGDVAC, CGT_HCR_TPC),
541 SR_TRAP(SYS_DC_CGVAC, CGT_HCR_TPC),
542 SR_TRAP(SYS_DC_CGDVAC, CGT_HCR_TPC),
543 SR_TRAP(SYS_DC_CGVAP, CGT_HCR_TPC),
544 SR_TRAP(SYS_DC_CGDVAP, CGT_HCR_TPC),
545 SR_TRAP(SYS_DC_CGVADP, CGT_HCR_TPC),
546 SR_TRAP(SYS_DC_CGDVADP, CGT_HCR_TPC),
547 SR_TRAP(SYS_IC_IVAU, CGT_HCR_TPU_TOCU),
548 SR_TRAP(SYS_IC_IALLU, CGT_HCR_TPU_TOCU),
549 SR_TRAP(SYS_IC_IALLUIS, CGT_HCR_TPU_TICAB),
550 SR_TRAP(SYS_DC_CVAU, CGT_HCR_TPU_TOCU),
551 SR_TRAP(OP_TLBI_RVAE1, CGT_HCR_TTLB),
552 SR_TRAP(OP_TLBI_RVAAE1, CGT_HCR_TTLB),
553 SR_TRAP(OP_TLBI_RVALE1, CGT_HCR_TTLB),
554 SR_TRAP(OP_TLBI_RVAALE1, CGT_HCR_TTLB),
555 SR_TRAP(OP_TLBI_VMALLE1, CGT_HCR_TTLB),
556 SR_TRAP(OP_TLBI_VAE1, CGT_HCR_TTLB),
557 SR_TRAP(OP_TLBI_ASIDE1, CGT_HCR_TTLB),
558 SR_TRAP(OP_TLBI_VAAE1, CGT_HCR_TTLB),
559 SR_TRAP(OP_TLBI_VALE1, CGT_HCR_TTLB),
560 SR_TRAP(OP_TLBI_VAALE1, CGT_HCR_TTLB),
561 SR_TRAP(OP_TLBI_RVAE1NXS, CGT_HCR_TTLB),
562 SR_TRAP(OP_TLBI_RVAAE1NXS, CGT_HCR_TTLB),
563 SR_TRAP(OP_TLBI_RVALE1NXS, CGT_HCR_TTLB),
564 SR_TRAP(OP_TLBI_RVAALE1NXS, CGT_HCR_TTLB),
565 SR_TRAP(OP_TLBI_VMALLE1NXS, CGT_HCR_TTLB),
566 SR_TRAP(OP_TLBI_VAE1NXS, CGT_HCR_TTLB),
567 SR_TRAP(OP_TLBI_ASIDE1NXS, CGT_HCR_TTLB),
568 SR_TRAP(OP_TLBI_VAAE1NXS, CGT_HCR_TTLB),
569 SR_TRAP(OP_TLBI_VALE1NXS, CGT_HCR_TTLB),
570 SR_TRAP(OP_TLBI_VAALE1NXS, CGT_HCR_TTLB),
571 SR_TRAP(OP_TLBI_RVAE1IS, CGT_HCR_TTLB_TTLBIS),
572 SR_TRAP(OP_TLBI_RVAAE1IS, CGT_HCR_TTLB_TTLBIS),
573 SR_TRAP(OP_TLBI_RVALE1IS, CGT_HCR_TTLB_TTLBIS),
574 SR_TRAP(OP_TLBI_RVAALE1IS, CGT_HCR_TTLB_TTLBIS),
575 SR_TRAP(OP_TLBI_VMALLE1IS, CGT_HCR_TTLB_TTLBIS),
576 SR_TRAP(OP_TLBI_VAE1IS, CGT_HCR_TTLB_TTLBIS),
577 SR_TRAP(OP_TLBI_ASIDE1IS, CGT_HCR_TTLB_TTLBIS),
578 SR_TRAP(OP_TLBI_VAAE1IS, CGT_HCR_TTLB_TTLBIS),
579 SR_TRAP(OP_TLBI_VALE1IS, CGT_HCR_TTLB_TTLBIS),
580 SR_TRAP(OP_TLBI_VAALE1IS, CGT_HCR_TTLB_TTLBIS),
581 SR_TRAP(OP_TLBI_RVAE1ISNXS, CGT_HCR_TTLB_TTLBIS),
582 SR_TRAP(OP_TLBI_RVAAE1ISNXS, CGT_HCR_TTLB_TTLBIS),
583 SR_TRAP(OP_TLBI_RVALE1ISNXS, CGT_HCR_TTLB_TTLBIS),
584 SR_TRAP(OP_TLBI_RVAALE1ISNXS, CGT_HCR_TTLB_TTLBIS),
585 SR_TRAP(OP_TLBI_VMALLE1ISNXS, CGT_HCR_TTLB_TTLBIS),
586 SR_TRAP(OP_TLBI_VAE1ISNXS, CGT_HCR_TTLB_TTLBIS),
587 SR_TRAP(OP_TLBI_ASIDE1ISNXS, CGT_HCR_TTLB_TTLBIS),
588 SR_TRAP(OP_TLBI_VAAE1ISNXS, CGT_HCR_TTLB_TTLBIS),
589 SR_TRAP(OP_TLBI_VALE1ISNXS, CGT_HCR_TTLB_TTLBIS),
590 SR_TRAP(OP_TLBI_VAALE1ISNXS, CGT_HCR_TTLB_TTLBIS),
591 SR_TRAP(OP_TLBI_VMALLE1OS, CGT_HCR_TTLB_TTLBOS),
592 SR_TRAP(OP_TLBI_VAE1OS, CGT_HCR_TTLB_TTLBOS),
593 SR_TRAP(OP_TLBI_ASIDE1OS, CGT_HCR_TTLB_TTLBOS),
594 SR_TRAP(OP_TLBI_VAAE1OS, CGT_HCR_TTLB_TTLBOS),
595 SR_TRAP(OP_TLBI_VALE1OS, CGT_HCR_TTLB_TTLBOS),
596 SR_TRAP(OP_TLBI_VAALE1OS, CGT_HCR_TTLB_TTLBOS),
597 SR_TRAP(OP_TLBI_RVAE1OS, CGT_HCR_TTLB_TTLBOS),
598 SR_TRAP(OP_TLBI_RVAAE1OS, CGT_HCR_TTLB_TTLBOS),
599 SR_TRAP(OP_TLBI_RVALE1OS, CGT_HCR_TTLB_TTLBOS),
600 SR_TRAP(OP_TLBI_RVAALE1OS, CGT_HCR_TTLB_TTLBOS),
601 SR_TRAP(OP_TLBI_VMALLE1OSNXS, CGT_HCR_TTLB_TTLBOS),
602 SR_TRAP(OP_TLBI_VAE1OSNXS, CGT_HCR_TTLB_TTLBOS),
603 SR_TRAP(OP_TLBI_ASIDE1OSNXS, CGT_HCR_TTLB_TTLBOS),
604 SR_TRAP(OP_TLBI_VAAE1OSNXS, CGT_HCR_TTLB_TTLBOS),
605 SR_TRAP(OP_TLBI_VALE1OSNXS, CGT_HCR_TTLB_TTLBOS),
606 SR_TRAP(OP_TLBI_VAALE1OSNXS, CGT_HCR_TTLB_TTLBOS),
607 SR_TRAP(OP_TLBI_RVAE1OSNXS, CGT_HCR_TTLB_TTLBOS),
608 SR_TRAP(OP_TLBI_RVAAE1OSNXS, CGT_HCR_TTLB_TTLBOS),
609 SR_TRAP(OP_TLBI_RVALE1OSNXS, CGT_HCR_TTLB_TTLBOS),
610 SR_TRAP(OP_TLBI_RVAALE1OSNXS, CGT_HCR_TTLB_TTLBOS),
611 SR_TRAP(SYS_SCTLR_EL1, CGT_HCR_TVM_TRVM),
612 SR_TRAP(SYS_TTBR0_EL1, CGT_HCR_TVM_TRVM),
613 SR_TRAP(SYS_TTBR1_EL1, CGT_HCR_TVM_TRVM),
614 SR_TRAP(SYS_TCR_EL1, CGT_HCR_TVM_TRVM),
615 SR_TRAP(SYS_ESR_EL1, CGT_HCR_TVM_TRVM),
616 SR_TRAP(SYS_FAR_EL1, CGT_HCR_TVM_TRVM),
617 SR_TRAP(SYS_AFSR0_EL1, CGT_HCR_TVM_TRVM),
618 SR_TRAP(SYS_AFSR1_EL1, CGT_HCR_TVM_TRVM),
619 SR_TRAP(SYS_MAIR_EL1, CGT_HCR_TVM_TRVM),
620 SR_TRAP(SYS_AMAIR_EL1, CGT_HCR_TVM_TRVM),
621 SR_TRAP(SYS_CONTEXTIDR_EL1, CGT_HCR_TVM_TRVM),
622 SR_TRAP(SYS_DC_ZVA, CGT_HCR_TDZ),
623 SR_TRAP(SYS_DC_GVA, CGT_HCR_TDZ),
624 SR_TRAP(SYS_DC_GZVA, CGT_HCR_TDZ),
625 SR_TRAP(SYS_LORSA_EL1, CGT_HCR_TLOR),
626 SR_TRAP(SYS_LOREA_EL1, CGT_HCR_TLOR),
627 SR_TRAP(SYS_LORN_EL1, CGT_HCR_TLOR),
628 SR_TRAP(SYS_LORC_EL1, CGT_HCR_TLOR),
629 SR_TRAP(SYS_LORID_EL1, CGT_HCR_TLOR),
630 SR_TRAP(SYS_ERRIDR_EL1, CGT_HCR_TERR),
631 SR_TRAP(SYS_ERRSELR_EL1, CGT_HCR_TERR),
632 SR_TRAP(SYS_ERXADDR_EL1, CGT_HCR_TERR),
633 SR_TRAP(SYS_ERXCTLR_EL1, CGT_HCR_TERR),
634 SR_TRAP(SYS_ERXFR_EL1, CGT_HCR_TERR),
635 SR_TRAP(SYS_ERXMISC0_EL1, CGT_HCR_TERR),
636 SR_TRAP(SYS_ERXMISC1_EL1, CGT_HCR_TERR),
637 SR_TRAP(SYS_ERXMISC2_EL1, CGT_HCR_TERR),
638 SR_TRAP(SYS_ERXMISC3_EL1, CGT_HCR_TERR),
639 SR_TRAP(SYS_ERXSTATUS_EL1, CGT_HCR_TERR),
640 SR_TRAP(SYS_APIAKEYLO_EL1, CGT_HCR_APK),
641 SR_TRAP(SYS_APIAKEYHI_EL1, CGT_HCR_APK),
642 SR_TRAP(SYS_APIBKEYLO_EL1, CGT_HCR_APK),
643 SR_TRAP(SYS_APIBKEYHI_EL1, CGT_HCR_APK),
644 SR_TRAP(SYS_APDAKEYLO_EL1, CGT_HCR_APK),
645 SR_TRAP(SYS_APDAKEYHI_EL1, CGT_HCR_APK),
646 SR_TRAP(SYS_APDBKEYLO_EL1, CGT_HCR_APK),
647 SR_TRAP(SYS_APDBKEYHI_EL1, CGT_HCR_APK),
648 SR_TRAP(SYS_APGAKEYLO_EL1, CGT_HCR_APK),
649 SR_TRAP(SYS_APGAKEYHI_EL1, CGT_HCR_APK),
650 /* All _EL2 registers */
651 SR_RANGE_TRAP(sys_reg(3, 4, 0, 0, 0),
652 sys_reg(3, 4, 3, 15, 7), CGT_HCR_NV),
653 /* Skip the SP_EL1 encoding... */
654 SR_TRAP(SYS_SPSR_EL2, CGT_HCR_NV),
655 SR_TRAP(SYS_ELR_EL2, CGT_HCR_NV),
656 SR_RANGE_TRAP(sys_reg(3, 4, 4, 1, 1),
657 sys_reg(3, 4, 10, 15, 7), CGT_HCR_NV),
658 SR_RANGE_TRAP(sys_reg(3, 4, 12, 0, 0),
659 sys_reg(3, 4, 14, 15, 7), CGT_HCR_NV),
660 /* All _EL02, _EL12 registers */
661 SR_RANGE_TRAP(sys_reg(3, 5, 0, 0, 0),
662 sys_reg(3, 5, 10, 15, 7), CGT_HCR_NV),
663 SR_RANGE_TRAP(sys_reg(3, 5, 12, 0, 0),
664 sys_reg(3, 5, 14, 15, 7), CGT_HCR_NV),
665 SR_TRAP(OP_AT_S1E2R, CGT_HCR_NV),
666 SR_TRAP(OP_AT_S1E2W, CGT_HCR_NV),
667 SR_TRAP(OP_AT_S12E1R, CGT_HCR_NV),
668 SR_TRAP(OP_AT_S12E1W, CGT_HCR_NV),
669 SR_TRAP(OP_AT_S12E0R, CGT_HCR_NV),
670 SR_TRAP(OP_AT_S12E0W, CGT_HCR_NV),
671 SR_TRAP(OP_TLBI_IPAS2E1, CGT_HCR_NV),
672 SR_TRAP(OP_TLBI_RIPAS2E1, CGT_HCR_NV),
673 SR_TRAP(OP_TLBI_IPAS2LE1, CGT_HCR_NV),
674 SR_TRAP(OP_TLBI_RIPAS2LE1, CGT_HCR_NV),
675 SR_TRAP(OP_TLBI_RVAE2, CGT_HCR_NV),
676 SR_TRAP(OP_TLBI_RVALE2, CGT_HCR_NV),
677 SR_TRAP(OP_TLBI_ALLE2, CGT_HCR_NV),
678 SR_TRAP(OP_TLBI_VAE2, CGT_HCR_NV),
679 SR_TRAP(OP_TLBI_ALLE1, CGT_HCR_NV),
680 SR_TRAP(OP_TLBI_VALE2, CGT_HCR_NV),
681 SR_TRAP(OP_TLBI_VMALLS12E1, CGT_HCR_NV),
682 SR_TRAP(OP_TLBI_IPAS2E1NXS, CGT_HCR_NV),
683 SR_TRAP(OP_TLBI_RIPAS2E1NXS, CGT_HCR_NV),
684 SR_TRAP(OP_TLBI_IPAS2LE1NXS, CGT_HCR_NV),
685 SR_TRAP(OP_TLBI_RIPAS2LE1NXS, CGT_HCR_NV),
686 SR_TRAP(OP_TLBI_RVAE2NXS, CGT_HCR_NV),
687 SR_TRAP(OP_TLBI_RVALE2NXS, CGT_HCR_NV),
688 SR_TRAP(OP_TLBI_ALLE2NXS, CGT_HCR_NV),
689 SR_TRAP(OP_TLBI_VAE2NXS, CGT_HCR_NV),
690 SR_TRAP(OP_TLBI_ALLE1NXS, CGT_HCR_NV),
691 SR_TRAP(OP_TLBI_VALE2NXS, CGT_HCR_NV),
692 SR_TRAP(OP_TLBI_VMALLS12E1NXS, CGT_HCR_NV),
693 SR_TRAP(OP_TLBI_IPAS2E1IS, CGT_HCR_NV),
694 SR_TRAP(OP_TLBI_RIPAS2E1IS, CGT_HCR_NV),
695 SR_TRAP(OP_TLBI_IPAS2LE1IS, CGT_HCR_NV),
696 SR_TRAP(OP_TLBI_RIPAS2LE1IS, CGT_HCR_NV),
697 SR_TRAP(OP_TLBI_RVAE2IS, CGT_HCR_NV),
698 SR_TRAP(OP_TLBI_RVALE2IS, CGT_HCR_NV),
699 SR_TRAP(OP_TLBI_ALLE2IS, CGT_HCR_NV),
700 SR_TRAP(OP_TLBI_VAE2IS, CGT_HCR_NV),
701 SR_TRAP(OP_TLBI_ALLE1IS, CGT_HCR_NV),
702 SR_TRAP(OP_TLBI_VALE2IS, CGT_HCR_NV),
703 SR_TRAP(OP_TLBI_VMALLS12E1IS, CGT_HCR_NV),
704 SR_TRAP(OP_TLBI_IPAS2E1ISNXS, CGT_HCR_NV),
705 SR_TRAP(OP_TLBI_RIPAS2E1ISNXS, CGT_HCR_NV),
706 SR_TRAP(OP_TLBI_IPAS2LE1ISNXS, CGT_HCR_NV),
707 SR_TRAP(OP_TLBI_RIPAS2LE1ISNXS, CGT_HCR_NV),
708 SR_TRAP(OP_TLBI_RVAE2ISNXS, CGT_HCR_NV),
709 SR_TRAP(OP_TLBI_RVALE2ISNXS, CGT_HCR_NV),
710 SR_TRAP(OP_TLBI_ALLE2ISNXS, CGT_HCR_NV),
711 SR_TRAP(OP_TLBI_VAE2ISNXS, CGT_HCR_NV),
712 SR_TRAP(OP_TLBI_ALLE1ISNXS, CGT_HCR_NV),
713 SR_TRAP(OP_TLBI_VALE2ISNXS, CGT_HCR_NV),
714 SR_TRAP(OP_TLBI_VMALLS12E1ISNXS,CGT_HCR_NV),
715 SR_TRAP(OP_TLBI_ALLE2OS, CGT_HCR_NV),
716 SR_TRAP(OP_TLBI_VAE2OS, CGT_HCR_NV),
717 SR_TRAP(OP_TLBI_ALLE1OS, CGT_HCR_NV),
718 SR_TRAP(OP_TLBI_VALE2OS, CGT_HCR_NV),
719 SR_TRAP(OP_TLBI_VMALLS12E1OS, CGT_HCR_NV),
720 SR_TRAP(OP_TLBI_IPAS2E1OS, CGT_HCR_NV),
721 SR_TRAP(OP_TLBI_RIPAS2E1OS, CGT_HCR_NV),
722 SR_TRAP(OP_TLBI_IPAS2LE1OS, CGT_HCR_NV),
723 SR_TRAP(OP_TLBI_RIPAS2LE1OS, CGT_HCR_NV),
724 SR_TRAP(OP_TLBI_RVAE2OS, CGT_HCR_NV),
725 SR_TRAP(OP_TLBI_RVALE2OS, CGT_HCR_NV),
726 SR_TRAP(OP_TLBI_ALLE2OSNXS, CGT_HCR_NV),
727 SR_TRAP(OP_TLBI_VAE2OSNXS, CGT_HCR_NV),
728 SR_TRAP(OP_TLBI_ALLE1OSNXS, CGT_HCR_NV),
729 SR_TRAP(OP_TLBI_VALE2OSNXS, CGT_HCR_NV),
730 SR_TRAP(OP_TLBI_VMALLS12E1OSNXS,CGT_HCR_NV),
731 SR_TRAP(OP_TLBI_IPAS2E1OSNXS, CGT_HCR_NV),
732 SR_TRAP(OP_TLBI_RIPAS2E1OSNXS, CGT_HCR_NV),
733 SR_TRAP(OP_TLBI_IPAS2LE1OSNXS, CGT_HCR_NV),
734 SR_TRAP(OP_TLBI_RIPAS2LE1OSNXS, CGT_HCR_NV),
735 SR_TRAP(OP_TLBI_RVAE2OSNXS, CGT_HCR_NV),
736 SR_TRAP(OP_TLBI_RVALE2OSNXS, CGT_HCR_NV),
737 SR_TRAP(OP_CPP_RCTX, CGT_HCR_NV),
738 SR_TRAP(OP_DVP_RCTX, CGT_HCR_NV),
739 SR_TRAP(OP_CFP_RCTX, CGT_HCR_NV),
740 SR_TRAP(SYS_SP_EL1, CGT_HCR_NV_nNV2),
741 SR_TRAP(SYS_VBAR_EL1, CGT_HCR_NV1_nNV2),
742 SR_TRAP(SYS_ELR_EL1, CGT_HCR_NV1_nNV2),
743 SR_TRAP(SYS_SPSR_EL1, CGT_HCR_NV1_nNV2),
744 SR_TRAP(SYS_SCXTNUM_EL1, CGT_HCR_NV1_nNV2_ENSCXT),
745 SR_TRAP(SYS_SCXTNUM_EL0, CGT_HCR_ENSCXT),
746 SR_TRAP(OP_AT_S1E1R, CGT_HCR_AT),
747 SR_TRAP(OP_AT_S1E1W, CGT_HCR_AT),
748 SR_TRAP(OP_AT_S1E0R, CGT_HCR_AT),
749 SR_TRAP(OP_AT_S1E0W, CGT_HCR_AT),
750 SR_TRAP(OP_AT_S1E1RP, CGT_HCR_AT),
751 SR_TRAP(OP_AT_S1E1WP, CGT_HCR_AT),
752 SR_TRAP(SYS_ERXPFGF_EL1, CGT_HCR_nFIEN),
753 SR_TRAP(SYS_ERXPFGCTL_EL1, CGT_HCR_nFIEN),
754 SR_TRAP(SYS_ERXPFGCDN_EL1, CGT_HCR_nFIEN),
755 SR_TRAP(SYS_PMCR_EL0, CGT_MDCR_TPM_TPMCR),
756 SR_TRAP(SYS_PMCNTENSET_EL0, CGT_MDCR_TPM),
757 SR_TRAP(SYS_PMCNTENCLR_EL0, CGT_MDCR_TPM),
758 SR_TRAP(SYS_PMOVSSET_EL0, CGT_MDCR_TPM),
759 SR_TRAP(SYS_PMOVSCLR_EL0, CGT_MDCR_TPM),
760 SR_TRAP(SYS_PMCEID0_EL0, CGT_MDCR_TPM),
761 SR_TRAP(SYS_PMCEID1_EL0, CGT_MDCR_TPM),
762 SR_TRAP(SYS_PMXEVTYPER_EL0, CGT_MDCR_TPM),
763 SR_TRAP(SYS_PMSWINC_EL0, CGT_MDCR_TPM),
764 SR_TRAP(SYS_PMSELR_EL0, CGT_MDCR_TPM),
765 SR_TRAP(SYS_PMXEVCNTR_EL0, CGT_MDCR_TPM),
766 SR_TRAP(SYS_PMCCNTR_EL0, CGT_MDCR_TPM),
767 SR_TRAP(SYS_PMUSERENR_EL0, CGT_MDCR_TPM),
768 SR_TRAP(SYS_PMINTENSET_EL1, CGT_MDCR_TPM),
769 SR_TRAP(SYS_PMINTENCLR_EL1, CGT_MDCR_TPM),
770 SR_TRAP(SYS_PMMIR_EL1, CGT_MDCR_TPM),
771 SR_TRAP(SYS_PMEVCNTRn_EL0(0), CGT_MDCR_TPM),
772 SR_TRAP(SYS_PMEVCNTRn_EL0(1), CGT_MDCR_TPM),
773 SR_TRAP(SYS_PMEVCNTRn_EL0(2), CGT_MDCR_TPM),
774 SR_TRAP(SYS_PMEVCNTRn_EL0(3), CGT_MDCR_TPM),
775 SR_TRAP(SYS_PMEVCNTRn_EL0(4), CGT_MDCR_TPM),
776 SR_TRAP(SYS_PMEVCNTRn_EL0(5), CGT_MDCR_TPM),
777 SR_TRAP(SYS_PMEVCNTRn_EL0(6), CGT_MDCR_TPM),
778 SR_TRAP(SYS_PMEVCNTRn_EL0(7), CGT_MDCR_TPM),
779 SR_TRAP(SYS_PMEVCNTRn_EL0(8), CGT_MDCR_TPM),
780 SR_TRAP(SYS_PMEVCNTRn_EL0(9), CGT_MDCR_TPM),
781 SR_TRAP(SYS_PMEVCNTRn_EL0(10), CGT_MDCR_TPM),
782 SR_TRAP(SYS_PMEVCNTRn_EL0(11), CGT_MDCR_TPM),
783 SR_TRAP(SYS_PMEVCNTRn_EL0(12), CGT_MDCR_TPM),
784 SR_TRAP(SYS_PMEVCNTRn_EL0(13), CGT_MDCR_TPM),
785 SR_TRAP(SYS_PMEVCNTRn_EL0(14), CGT_MDCR_TPM),
786 SR_TRAP(SYS_PMEVCNTRn_EL0(15), CGT_MDCR_TPM),
787 SR_TRAP(SYS_PMEVCNTRn_EL0(16), CGT_MDCR_TPM),
788 SR_TRAP(SYS_PMEVCNTRn_EL0(17), CGT_MDCR_TPM),
789 SR_TRAP(SYS_PMEVCNTRn_EL0(18), CGT_MDCR_TPM),
790 SR_TRAP(SYS_PMEVCNTRn_EL0(19), CGT_MDCR_TPM),
791 SR_TRAP(SYS_PMEVCNTRn_EL0(20), CGT_MDCR_TPM),
792 SR_TRAP(SYS_PMEVCNTRn_EL0(21), CGT_MDCR_TPM),
793 SR_TRAP(SYS_PMEVCNTRn_EL0(22), CGT_MDCR_TPM),
794 SR_TRAP(SYS_PMEVCNTRn_EL0(23), CGT_MDCR_TPM),
795 SR_TRAP(SYS_PMEVCNTRn_EL0(24), CGT_MDCR_TPM),
796 SR_TRAP(SYS_PMEVCNTRn_EL0(25), CGT_MDCR_TPM),
797 SR_TRAP(SYS_PMEVCNTRn_EL0(26), CGT_MDCR_TPM),
798 SR_TRAP(SYS_PMEVCNTRn_EL0(27), CGT_MDCR_TPM),
799 SR_TRAP(SYS_PMEVCNTRn_EL0(28), CGT_MDCR_TPM),
800 SR_TRAP(SYS_PMEVCNTRn_EL0(29), CGT_MDCR_TPM),
801 SR_TRAP(SYS_PMEVCNTRn_EL0(30), CGT_MDCR_TPM),
802 SR_TRAP(SYS_PMEVTYPERn_EL0(0), CGT_MDCR_TPM),
803 SR_TRAP(SYS_PMEVTYPERn_EL0(1), CGT_MDCR_TPM),
804 SR_TRAP(SYS_PMEVTYPERn_EL0(2), CGT_MDCR_TPM),
805 SR_TRAP(SYS_PMEVTYPERn_EL0(3), CGT_MDCR_TPM),
806 SR_TRAP(SYS_PMEVTYPERn_EL0(4), CGT_MDCR_TPM),
807 SR_TRAP(SYS_PMEVTYPERn_EL0(5), CGT_MDCR_TPM),
808 SR_TRAP(SYS_PMEVTYPERn_EL0(6), CGT_MDCR_TPM),
809 SR_TRAP(SYS_PMEVTYPERn_EL0(7), CGT_MDCR_TPM),
810 SR_TRAP(SYS_PMEVTYPERn_EL0(8), CGT_MDCR_TPM),
811 SR_TRAP(SYS_PMEVTYPERn_EL0(9), CGT_MDCR_TPM),
812 SR_TRAP(SYS_PMEVTYPERn_EL0(10), CGT_MDCR_TPM),
813 SR_TRAP(SYS_PMEVTYPERn_EL0(11), CGT_MDCR_TPM),
814 SR_TRAP(SYS_PMEVTYPERn_EL0(12), CGT_MDCR_TPM),
815 SR_TRAP(SYS_PMEVTYPERn_EL0(13), CGT_MDCR_TPM),
816 SR_TRAP(SYS_PMEVTYPERn_EL0(14), CGT_MDCR_TPM),
817 SR_TRAP(SYS_PMEVTYPERn_EL0(15), CGT_MDCR_TPM),
818 SR_TRAP(SYS_PMEVTYPERn_EL0(16), CGT_MDCR_TPM),
819 SR_TRAP(SYS_PMEVTYPERn_EL0(17), CGT_MDCR_TPM),
820 SR_TRAP(SYS_PMEVTYPERn_EL0(18), CGT_MDCR_TPM),
821 SR_TRAP(SYS_PMEVTYPERn_EL0(19), CGT_MDCR_TPM),
822 SR_TRAP(SYS_PMEVTYPERn_EL0(20), CGT_MDCR_TPM),
823 SR_TRAP(SYS_PMEVTYPERn_EL0(21), CGT_MDCR_TPM),
824 SR_TRAP(SYS_PMEVTYPERn_EL0(22), CGT_MDCR_TPM),
825 SR_TRAP(SYS_PMEVTYPERn_EL0(23), CGT_MDCR_TPM),
826 SR_TRAP(SYS_PMEVTYPERn_EL0(24), CGT_MDCR_TPM),
827 SR_TRAP(SYS_PMEVTYPERn_EL0(25), CGT_MDCR_TPM),
828 SR_TRAP(SYS_PMEVTYPERn_EL0(26), CGT_MDCR_TPM),
829 SR_TRAP(SYS_PMEVTYPERn_EL0(27), CGT_MDCR_TPM),
830 SR_TRAP(SYS_PMEVTYPERn_EL0(28), CGT_MDCR_TPM),
831 SR_TRAP(SYS_PMEVTYPERn_EL0(29), CGT_MDCR_TPM),
832 SR_TRAP(SYS_PMEVTYPERn_EL0(30), CGT_MDCR_TPM),
833 SR_TRAP(SYS_PMCCFILTR_EL0, CGT_MDCR_TPM),
834 SR_TRAP(SYS_MDCCSR_EL0, CGT_MDCR_TDCC_TDE_TDA),
835 SR_TRAP(SYS_MDCCINT_EL1, CGT_MDCR_TDCC_TDE_TDA),
836 SR_TRAP(SYS_OSDTRRX_EL1, CGT_MDCR_TDCC_TDE_TDA),
837 SR_TRAP(SYS_OSDTRTX_EL1, CGT_MDCR_TDCC_TDE_TDA),
838 SR_TRAP(SYS_DBGDTR_EL0, CGT_MDCR_TDCC_TDE_TDA),
839 /*
840 * Also covers DBGDTRRX_EL0, which has the same encoding as
841 * SYS_DBGDTRTX_EL0...
842 */
843 SR_TRAP(SYS_DBGDTRTX_EL0, CGT_MDCR_TDCC_TDE_TDA),
844 SR_TRAP(SYS_MDSCR_EL1, CGT_MDCR_TDE_TDA),
845 SR_TRAP(SYS_OSECCR_EL1, CGT_MDCR_TDE_TDA),
846 SR_TRAP(SYS_DBGBVRn_EL1(0), CGT_MDCR_TDE_TDA),
847 SR_TRAP(SYS_DBGBVRn_EL1(1), CGT_MDCR_TDE_TDA),
848 SR_TRAP(SYS_DBGBVRn_EL1(2), CGT_MDCR_TDE_TDA),
849 SR_TRAP(SYS_DBGBVRn_EL1(3), CGT_MDCR_TDE_TDA),
850 SR_TRAP(SYS_DBGBVRn_EL1(4), CGT_MDCR_TDE_TDA),
851 SR_TRAP(SYS_DBGBVRn_EL1(5), CGT_MDCR_TDE_TDA),
852 SR_TRAP(SYS_DBGBVRn_EL1(6), CGT_MDCR_TDE_TDA),
853 SR_TRAP(SYS_DBGBVRn_EL1(7), CGT_MDCR_TDE_TDA),
854 SR_TRAP(SYS_DBGBVRn_EL1(8), CGT_MDCR_TDE_TDA),
855 SR_TRAP(SYS_DBGBVRn_EL1(9), CGT_MDCR_TDE_TDA),
856 SR_TRAP(SYS_DBGBVRn_EL1(10), CGT_MDCR_TDE_TDA),
857 SR_TRAP(SYS_DBGBVRn_EL1(11), CGT_MDCR_TDE_TDA),
858 SR_TRAP(SYS_DBGBVRn_EL1(12), CGT_MDCR_TDE_TDA),
859 SR_TRAP(SYS_DBGBVRn_EL1(13), CGT_MDCR_TDE_TDA),
860 SR_TRAP(SYS_DBGBVRn_EL1(14), CGT_MDCR_TDE_TDA),
861 SR_TRAP(SYS_DBGBVRn_EL1(15), CGT_MDCR_TDE_TDA),
862 SR_TRAP(SYS_DBGBCRn_EL1(0), CGT_MDCR_TDE_TDA),
863 SR_TRAP(SYS_DBGBCRn_EL1(1), CGT_MDCR_TDE_TDA),
864 SR_TRAP(SYS_DBGBCRn_EL1(2), CGT_MDCR_TDE_TDA),
865 SR_TRAP(SYS_DBGBCRn_EL1(3), CGT_MDCR_TDE_TDA),
866 SR_TRAP(SYS_DBGBCRn_EL1(4), CGT_MDCR_TDE_TDA),
867 SR_TRAP(SYS_DBGBCRn_EL1(5), CGT_MDCR_TDE_TDA),
868 SR_TRAP(SYS_DBGBCRn_EL1(6), CGT_MDCR_TDE_TDA),
869 SR_TRAP(SYS_DBGBCRn_EL1(7), CGT_MDCR_TDE_TDA),
870 SR_TRAP(SYS_DBGBCRn_EL1(8), CGT_MDCR_TDE_TDA),
871 SR_TRAP(SYS_DBGBCRn_EL1(9), CGT_MDCR_TDE_TDA),
872 SR_TRAP(SYS_DBGBCRn_EL1(10), CGT_MDCR_TDE_TDA),
873 SR_TRAP(SYS_DBGBCRn_EL1(11), CGT_MDCR_TDE_TDA),
874 SR_TRAP(SYS_DBGBCRn_EL1(12), CGT_MDCR_TDE_TDA),
875 SR_TRAP(SYS_DBGBCRn_EL1(13), CGT_MDCR_TDE_TDA),
876 SR_TRAP(SYS_DBGBCRn_EL1(14), CGT_MDCR_TDE_TDA),
877 SR_TRAP(SYS_DBGBCRn_EL1(15), CGT_MDCR_TDE_TDA),
878 SR_TRAP(SYS_DBGWVRn_EL1(0), CGT_MDCR_TDE_TDA),
879 SR_TRAP(SYS_DBGWVRn_EL1(1), CGT_MDCR_TDE_TDA),
880 SR_TRAP(SYS_DBGWVRn_EL1(2), CGT_MDCR_TDE_TDA),
881 SR_TRAP(SYS_DBGWVRn_EL1(3), CGT_MDCR_TDE_TDA),
882 SR_TRAP(SYS_DBGWVRn_EL1(4), CGT_MDCR_TDE_TDA),
883 SR_TRAP(SYS_DBGWVRn_EL1(5), CGT_MDCR_TDE_TDA),
884 SR_TRAP(SYS_DBGWVRn_EL1(6), CGT_MDCR_TDE_TDA),
885 SR_TRAP(SYS_DBGWVRn_EL1(7), CGT_MDCR_TDE_TDA),
886 SR_TRAP(SYS_DBGWVRn_EL1(8), CGT_MDCR_TDE_TDA),
887 SR_TRAP(SYS_DBGWVRn_EL1(9), CGT_MDCR_TDE_TDA),
888 SR_TRAP(SYS_DBGWVRn_EL1(10), CGT_MDCR_TDE_TDA),
889 SR_TRAP(SYS_DBGWVRn_EL1(11), CGT_MDCR_TDE_TDA),
890 SR_TRAP(SYS_DBGWVRn_EL1(12), CGT_MDCR_TDE_TDA),
891 SR_TRAP(SYS_DBGWVRn_EL1(13), CGT_MDCR_TDE_TDA),
892 SR_TRAP(SYS_DBGWVRn_EL1(14), CGT_MDCR_TDE_TDA),
893 SR_TRAP(SYS_DBGWVRn_EL1(15), CGT_MDCR_TDE_TDA),
894 SR_TRAP(SYS_DBGWCRn_EL1(0), CGT_MDCR_TDE_TDA),
895 SR_TRAP(SYS_DBGWCRn_EL1(1), CGT_MDCR_TDE_TDA),
896 SR_TRAP(SYS_DBGWCRn_EL1(2), CGT_MDCR_TDE_TDA),
897 SR_TRAP(SYS_DBGWCRn_EL1(3), CGT_MDCR_TDE_TDA),
898 SR_TRAP(SYS_DBGWCRn_EL1(4), CGT_MDCR_TDE_TDA),
899 SR_TRAP(SYS_DBGWCRn_EL1(5), CGT_MDCR_TDE_TDA),
900 SR_TRAP(SYS_DBGWCRn_EL1(6), CGT_MDCR_TDE_TDA),
901 SR_TRAP(SYS_DBGWCRn_EL1(7), CGT_MDCR_TDE_TDA),
902 SR_TRAP(SYS_DBGWCRn_EL1(8), CGT_MDCR_TDE_TDA),
903 SR_TRAP(SYS_DBGWCRn_EL1(9), CGT_MDCR_TDE_TDA),
904 SR_TRAP(SYS_DBGWCRn_EL1(10), CGT_MDCR_TDE_TDA),
905 SR_TRAP(SYS_DBGWCRn_EL1(11), CGT_MDCR_TDE_TDA),
906 SR_TRAP(SYS_DBGWCRn_EL1(12), CGT_MDCR_TDE_TDA),
907 SR_TRAP(SYS_DBGWCRn_EL1(13), CGT_MDCR_TDE_TDA),
908 SR_TRAP(SYS_DBGWCRn_EL1(14), CGT_MDCR_TDE_TDA),
909 SR_TRAP(SYS_DBGCLAIMSET_EL1, CGT_MDCR_TDE_TDA),
910 SR_TRAP(SYS_DBGCLAIMCLR_EL1, CGT_MDCR_TDE_TDA),
911 SR_TRAP(SYS_DBGAUTHSTATUS_EL1, CGT_MDCR_TDE_TDA),
912 SR_TRAP(SYS_OSLAR_EL1, CGT_MDCR_TDE_TDOSA),
913 SR_TRAP(SYS_OSLSR_EL1, CGT_MDCR_TDE_TDOSA),
914 SR_TRAP(SYS_OSDLR_EL1, CGT_MDCR_TDE_TDOSA),
915 SR_TRAP(SYS_DBGPRCR_EL1, CGT_MDCR_TDE_TDOSA),
916 SR_TRAP(SYS_MDRAR_EL1, CGT_MDCR_TDE_TDRA),
917 SR_TRAP(SYS_PMBLIMITR_EL1, CGT_MDCR_E2PB),
918 SR_TRAP(SYS_PMBPTR_EL1, CGT_MDCR_E2PB),
919 SR_TRAP(SYS_PMBSR_EL1, CGT_MDCR_E2PB),
920 SR_TRAP(SYS_PMSCR_EL1, CGT_MDCR_TPMS),
921 SR_TRAP(SYS_PMSEVFR_EL1, CGT_MDCR_TPMS),
922 SR_TRAP(SYS_PMSFCR_EL1, CGT_MDCR_TPMS),
923 SR_TRAP(SYS_PMSICR_EL1, CGT_MDCR_TPMS),
924 SR_TRAP(SYS_PMSIDR_EL1, CGT_MDCR_TPMS),
925 SR_TRAP(SYS_PMSIRR_EL1, CGT_MDCR_TPMS),
926 SR_TRAP(SYS_PMSLATFR_EL1, CGT_MDCR_TPMS),
927 SR_TRAP(SYS_PMSNEVFR_EL1, CGT_MDCR_TPMS),
928 SR_TRAP(SYS_TRFCR_EL1, CGT_MDCR_TTRF),
929 SR_TRAP(SYS_TRBBASER_EL1, CGT_MDCR_E2TB),
930 SR_TRAP(SYS_TRBLIMITR_EL1, CGT_MDCR_E2TB),
931 SR_TRAP(SYS_TRBMAR_EL1, CGT_MDCR_E2TB),
932 SR_TRAP(SYS_TRBPTR_EL1, CGT_MDCR_E2TB),
933 SR_TRAP(SYS_TRBSR_EL1, CGT_MDCR_E2TB),
934 SR_TRAP(SYS_TRBTRG_EL1, CGT_MDCR_E2TB),
935 SR_TRAP(SYS_CNTP_TVAL_EL0, CGT_CNTHCTL_EL1PTEN),
936 SR_TRAP(SYS_CNTP_CVAL_EL0, CGT_CNTHCTL_EL1PTEN),
937 SR_TRAP(SYS_CNTP_CTL_EL0, CGT_CNTHCTL_EL1PTEN),
938 SR_TRAP(SYS_CNTPCT_EL0, CGT_CNTHCTL_EL1PCTEN),
939 SR_TRAP(SYS_CNTPCTSS_EL0, CGT_CNTHCTL_EL1PCTEN),
940 };
941
942 static DEFINE_XARRAY(sr_forward_xa);
943
944 enum fgt_group_id {
945 __NO_FGT_GROUP__,
946 HFGxTR_GROUP,
947 HDFGRTR_GROUP,
948 HDFGWTR_GROUP,
949 HFGITR_GROUP,
950
951 /* Must be last */
952 __NR_FGT_GROUP_IDS__
953 };
954
955 enum fg_filter_id {
956 __NO_FGF__,
957 HCRX_FGTnXS,
958
959 /* Must be last */
960 __NR_FG_FILTER_IDS__
961 };
962
963 #define SR_FGF(sr, g, b, p, f) \
964 { \
965 .encoding = sr, \
966 .end = sr, \
967 .tc = { \
968 .fgt = g ## _GROUP, \
969 .bit = g ## _EL2_ ## b ## _SHIFT, \
970 .pol = p, \
971 .fgf = f, \
972 }, \
973 .line = __LINE__, \
974 }
975
976 #define SR_FGT(sr, g, b, p) SR_FGF(sr, g, b, p, __NO_FGF__)
977
978 static const struct encoding_to_trap_config encoding_to_fgt[] __initconst = {
979 /* HFGRTR_EL2, HFGWTR_EL2 */
980 SR_FGT(SYS_PIR_EL1, HFGxTR, nPIR_EL1, 0),
981 SR_FGT(SYS_PIRE0_EL1, HFGxTR, nPIRE0_EL1, 0),
982 SR_FGT(SYS_TPIDR2_EL0, HFGxTR, nTPIDR2_EL0, 0),
983 SR_FGT(SYS_SMPRI_EL1, HFGxTR, nSMPRI_EL1, 0),
984 SR_FGT(SYS_ACCDATA_EL1, HFGxTR, nACCDATA_EL1, 0),
985 SR_FGT(SYS_ERXADDR_EL1, HFGxTR, ERXADDR_EL1, 1),
986 SR_FGT(SYS_ERXPFGCDN_EL1, HFGxTR, ERXPFGCDN_EL1, 1),
987 SR_FGT(SYS_ERXPFGCTL_EL1, HFGxTR, ERXPFGCTL_EL1, 1),
988 SR_FGT(SYS_ERXPFGF_EL1, HFGxTR, ERXPFGF_EL1, 1),
989 SR_FGT(SYS_ERXMISC0_EL1, HFGxTR, ERXMISCn_EL1, 1),
990 SR_FGT(SYS_ERXMISC1_EL1, HFGxTR, ERXMISCn_EL1, 1),
991 SR_FGT(SYS_ERXMISC2_EL1, HFGxTR, ERXMISCn_EL1, 1),
992 SR_FGT(SYS_ERXMISC3_EL1, HFGxTR, ERXMISCn_EL1, 1),
993 SR_FGT(SYS_ERXSTATUS_EL1, HFGxTR, ERXSTATUS_EL1, 1),
994 SR_FGT(SYS_ERXCTLR_EL1, HFGxTR, ERXCTLR_EL1, 1),
995 SR_FGT(SYS_ERXFR_EL1, HFGxTR, ERXFR_EL1, 1),
996 SR_FGT(SYS_ERRSELR_EL1, HFGxTR, ERRSELR_EL1, 1),
997 SR_FGT(SYS_ERRIDR_EL1, HFGxTR, ERRIDR_EL1, 1),
998 SR_FGT(SYS_ICC_IGRPEN0_EL1, HFGxTR, ICC_IGRPENn_EL1, 1),
999 SR_FGT(SYS_ICC_IGRPEN1_EL1, HFGxTR, ICC_IGRPENn_EL1, 1),
1000 SR_FGT(SYS_VBAR_EL1, HFGxTR, VBAR_EL1, 1),
1001 SR_FGT(SYS_TTBR1_EL1, HFGxTR, TTBR1_EL1, 1),
1002 SR_FGT(SYS_TTBR0_EL1, HFGxTR, TTBR0_EL1, 1),
1003 SR_FGT(SYS_TPIDR_EL0, HFGxTR, TPIDR_EL0, 1),
1004 SR_FGT(SYS_TPIDRRO_EL0, HFGxTR, TPIDRRO_EL0, 1),
1005 SR_FGT(SYS_TPIDR_EL1, HFGxTR, TPIDR_EL1, 1),
1006 SR_FGT(SYS_TCR_EL1, HFGxTR, TCR_EL1, 1),
1007 SR_FGT(SYS_SCXTNUM_EL0, HFGxTR, SCXTNUM_EL0, 1),
1008 SR_FGT(SYS_SCXTNUM_EL1, HFGxTR, SCXTNUM_EL1, 1),
1009 SR_FGT(SYS_SCTLR_EL1, HFGxTR, SCTLR_EL1, 1),
1010 SR_FGT(SYS_REVIDR_EL1, HFGxTR, REVIDR_EL1, 1),
1011 SR_FGT(SYS_PAR_EL1, HFGxTR, PAR_EL1, 1),
1012 SR_FGT(SYS_MPIDR_EL1, HFGxTR, MPIDR_EL1, 1),
1013 SR_FGT(SYS_MIDR_EL1, HFGxTR, MIDR_EL1, 1),
1014 SR_FGT(SYS_MAIR_EL1, HFGxTR, MAIR_EL1, 1),
1015 SR_FGT(SYS_LORSA_EL1, HFGxTR, LORSA_EL1, 1),
1016 SR_FGT(SYS_LORN_EL1, HFGxTR, LORN_EL1, 1),
1017 SR_FGT(SYS_LORID_EL1, HFGxTR, LORID_EL1, 1),
1018 SR_FGT(SYS_LOREA_EL1, HFGxTR, LOREA_EL1, 1),
1019 SR_FGT(SYS_LORC_EL1, HFGxTR, LORC_EL1, 1),
1020 SR_FGT(SYS_ISR_EL1, HFGxTR, ISR_EL1, 1),
1021 SR_FGT(SYS_FAR_EL1, HFGxTR, FAR_EL1, 1),
1022 SR_FGT(SYS_ESR_EL1, HFGxTR, ESR_EL1, 1),
1023 SR_FGT(SYS_DCZID_EL0, HFGxTR, DCZID_EL0, 1),
1024 SR_FGT(SYS_CTR_EL0, HFGxTR, CTR_EL0, 1),
1025 SR_FGT(SYS_CSSELR_EL1, HFGxTR, CSSELR_EL1, 1),
1026 SR_FGT(SYS_CPACR_EL1, HFGxTR, CPACR_EL1, 1),
1027 SR_FGT(SYS_CONTEXTIDR_EL1, HFGxTR, CONTEXTIDR_EL1, 1),
1028 SR_FGT(SYS_CLIDR_EL1, HFGxTR, CLIDR_EL1, 1),
1029 SR_FGT(SYS_CCSIDR_EL1, HFGxTR, CCSIDR_EL1, 1),
1030 SR_FGT(SYS_APIBKEYLO_EL1, HFGxTR, APIBKey, 1),
1031 SR_FGT(SYS_APIBKEYHI_EL1, HFGxTR, APIBKey, 1),
1032 SR_FGT(SYS_APIAKEYLO_EL1, HFGxTR, APIAKey, 1),
1033 SR_FGT(SYS_APIAKEYHI_EL1, HFGxTR, APIAKey, 1),
1034 SR_FGT(SYS_APGAKEYLO_EL1, HFGxTR, APGAKey, 1),
1035 SR_FGT(SYS_APGAKEYHI_EL1, HFGxTR, APGAKey, 1),
1036 SR_FGT(SYS_APDBKEYLO_EL1, HFGxTR, APDBKey, 1),
1037 SR_FGT(SYS_APDBKEYHI_EL1, HFGxTR, APDBKey, 1),
1038 SR_FGT(SYS_APDAKEYLO_EL1, HFGxTR, APDAKey, 1),
1039 SR_FGT(SYS_APDAKEYHI_EL1, HFGxTR, APDAKey, 1),
1040 SR_FGT(SYS_AMAIR_EL1, HFGxTR, AMAIR_EL1, 1),
1041 SR_FGT(SYS_AIDR_EL1, HFGxTR, AIDR_EL1, 1),
1042 SR_FGT(SYS_AFSR1_EL1, HFGxTR, AFSR1_EL1, 1),
1043 SR_FGT(SYS_AFSR0_EL1, HFGxTR, AFSR0_EL1, 1),
1044 /* HFGITR_EL2 */
1045 SR_FGT(OP_BRB_IALL, HFGITR, nBRBIALL, 0),
1046 SR_FGT(OP_BRB_INJ, HFGITR, nBRBINJ, 0),
1047 SR_FGT(SYS_DC_CVAC, HFGITR, DCCVAC, 1),
1048 SR_FGT(SYS_DC_CGVAC, HFGITR, DCCVAC, 1),
1049 SR_FGT(SYS_DC_CGDVAC, HFGITR, DCCVAC, 1),
1050 SR_FGT(OP_CPP_RCTX, HFGITR, CPPRCTX, 1),
1051 SR_FGT(OP_DVP_RCTX, HFGITR, DVPRCTX, 1),
1052 SR_FGT(OP_CFP_RCTX, HFGITR, CFPRCTX, 1),
1053 SR_FGT(OP_TLBI_VAALE1, HFGITR, TLBIVAALE1, 1),
1054 SR_FGT(OP_TLBI_VALE1, HFGITR, TLBIVALE1, 1),
1055 SR_FGT(OP_TLBI_VAAE1, HFGITR, TLBIVAAE1, 1),
1056 SR_FGT(OP_TLBI_ASIDE1, HFGITR, TLBIASIDE1, 1),
1057 SR_FGT(OP_TLBI_VAE1, HFGITR, TLBIVAE1, 1),
1058 SR_FGT(OP_TLBI_VMALLE1, HFGITR, TLBIVMALLE1, 1),
1059 SR_FGT(OP_TLBI_RVAALE1, HFGITR, TLBIRVAALE1, 1),
1060 SR_FGT(OP_TLBI_RVALE1, HFGITR, TLBIRVALE1, 1),
1061 SR_FGT(OP_TLBI_RVAAE1, HFGITR, TLBIRVAAE1, 1),
1062 SR_FGT(OP_TLBI_RVAE1, HFGITR, TLBIRVAE1, 1),
1063 SR_FGT(OP_TLBI_RVAALE1IS, HFGITR, TLBIRVAALE1IS, 1),
1064 SR_FGT(OP_TLBI_RVALE1IS, HFGITR, TLBIRVALE1IS, 1),
1065 SR_FGT(OP_TLBI_RVAAE1IS, HFGITR, TLBIRVAAE1IS, 1),
1066 SR_FGT(OP_TLBI_RVAE1IS, HFGITR, TLBIRVAE1IS, 1),
1067 SR_FGT(OP_TLBI_VAALE1IS, HFGITR, TLBIVAALE1IS, 1),
1068 SR_FGT(OP_TLBI_VALE1IS, HFGITR, TLBIVALE1IS, 1),
1069 SR_FGT(OP_TLBI_VAAE1IS, HFGITR, TLBIVAAE1IS, 1),
1070 SR_FGT(OP_TLBI_ASIDE1IS, HFGITR, TLBIASIDE1IS, 1),
1071 SR_FGT(OP_TLBI_VAE1IS, HFGITR, TLBIVAE1IS, 1),
1072 SR_FGT(OP_TLBI_VMALLE1IS, HFGITR, TLBIVMALLE1IS, 1),
1073 SR_FGT(OP_TLBI_RVAALE1OS, HFGITR, TLBIRVAALE1OS, 1),
1074 SR_FGT(OP_TLBI_RVALE1OS, HFGITR, TLBIRVALE1OS, 1),
1075 SR_FGT(OP_TLBI_RVAAE1OS, HFGITR, TLBIRVAAE1OS, 1),
1076 SR_FGT(OP_TLBI_RVAE1OS, HFGITR, TLBIRVAE1OS, 1),
1077 SR_FGT(OP_TLBI_VAALE1OS, HFGITR, TLBIVAALE1OS, 1),
1078 SR_FGT(OP_TLBI_VALE1OS, HFGITR, TLBIVALE1OS, 1),
1079 SR_FGT(OP_TLBI_VAAE1OS, HFGITR, TLBIVAAE1OS, 1),
1080 SR_FGT(OP_TLBI_ASIDE1OS, HFGITR, TLBIASIDE1OS, 1),
1081 SR_FGT(OP_TLBI_VAE1OS, HFGITR, TLBIVAE1OS, 1),
1082 SR_FGT(OP_TLBI_VMALLE1OS, HFGITR, TLBIVMALLE1OS, 1),
1083 /* nXS variants must be checked against HCRX_EL2.FGTnXS */
1084 SR_FGF(OP_TLBI_VAALE1NXS, HFGITR, TLBIVAALE1, 1, HCRX_FGTnXS),
1085 SR_FGF(OP_TLBI_VALE1NXS, HFGITR, TLBIVALE1, 1, HCRX_FGTnXS),
1086 SR_FGF(OP_TLBI_VAAE1NXS, HFGITR, TLBIVAAE1, 1, HCRX_FGTnXS),
1087 SR_FGF(OP_TLBI_ASIDE1NXS, HFGITR, TLBIASIDE1, 1, HCRX_FGTnXS),
1088 SR_FGF(OP_TLBI_VAE1NXS, HFGITR, TLBIVAE1, 1, HCRX_FGTnXS),
1089 SR_FGF(OP_TLBI_VMALLE1NXS, HFGITR, TLBIVMALLE1, 1, HCRX_FGTnXS),
1090 SR_FGF(OP_TLBI_RVAALE1NXS, HFGITR, TLBIRVAALE1, 1, HCRX_FGTnXS),
1091 SR_FGF(OP_TLBI_RVALE1NXS, HFGITR, TLBIRVALE1, 1, HCRX_FGTnXS),
1092 SR_FGF(OP_TLBI_RVAAE1NXS, HFGITR, TLBIRVAAE1, 1, HCRX_FGTnXS),
1093 SR_FGF(OP_TLBI_RVAE1NXS, HFGITR, TLBIRVAE1, 1, HCRX_FGTnXS),
1094 SR_FGF(OP_TLBI_RVAALE1ISNXS, HFGITR, TLBIRVAALE1IS, 1, HCRX_FGTnXS),
1095 SR_FGF(OP_TLBI_RVALE1ISNXS, HFGITR, TLBIRVALE1IS, 1, HCRX_FGTnXS),
1096 SR_FGF(OP_TLBI_RVAAE1ISNXS, HFGITR, TLBIRVAAE1IS, 1, HCRX_FGTnXS),
1097 SR_FGF(OP_TLBI_RVAE1ISNXS, HFGITR, TLBIRVAE1IS, 1, HCRX_FGTnXS),
1098 SR_FGF(OP_TLBI_VAALE1ISNXS, HFGITR, TLBIVAALE1IS, 1, HCRX_FGTnXS),
1099 SR_FGF(OP_TLBI_VALE1ISNXS, HFGITR, TLBIVALE1IS, 1, HCRX_FGTnXS),
1100 SR_FGF(OP_TLBI_VAAE1ISNXS, HFGITR, TLBIVAAE1IS, 1, HCRX_FGTnXS),
1101 SR_FGF(OP_TLBI_ASIDE1ISNXS, HFGITR, TLBIASIDE1IS, 1, HCRX_FGTnXS),
1102 SR_FGF(OP_TLBI_VAE1ISNXS, HFGITR, TLBIVAE1IS, 1, HCRX_FGTnXS),
1103 SR_FGF(OP_TLBI_VMALLE1ISNXS, HFGITR, TLBIVMALLE1IS, 1, HCRX_FGTnXS),
1104 SR_FGF(OP_TLBI_RVAALE1OSNXS, HFGITR, TLBIRVAALE1OS, 1, HCRX_FGTnXS),
1105 SR_FGF(OP_TLBI_RVALE1OSNXS, HFGITR, TLBIRVALE1OS, 1, HCRX_FGTnXS),
1106 SR_FGF(OP_TLBI_RVAAE1OSNXS, HFGITR, TLBIRVAAE1OS, 1, HCRX_FGTnXS),
1107 SR_FGF(OP_TLBI_RVAE1OSNXS, HFGITR, TLBIRVAE1OS, 1, HCRX_FGTnXS),
1108 SR_FGF(OP_TLBI_VAALE1OSNXS, HFGITR, TLBIVAALE1OS, 1, HCRX_FGTnXS),
1109 SR_FGF(OP_TLBI_VALE1OSNXS, HFGITR, TLBIVALE1OS, 1, HCRX_FGTnXS),
1110 SR_FGF(OP_TLBI_VAAE1OSNXS, HFGITR, TLBIVAAE1OS, 1, HCRX_FGTnXS),
1111 SR_FGF(OP_TLBI_ASIDE1OSNXS, HFGITR, TLBIASIDE1OS, 1, HCRX_FGTnXS),
1112 SR_FGF(OP_TLBI_VAE1OSNXS, HFGITR, TLBIVAE1OS, 1, HCRX_FGTnXS),
1113 SR_FGF(OP_TLBI_VMALLE1OSNXS, HFGITR, TLBIVMALLE1OS, 1, HCRX_FGTnXS),
1114 SR_FGT(OP_AT_S1E1WP, HFGITR, ATS1E1WP, 1),
1115 SR_FGT(OP_AT_S1E1RP, HFGITR, ATS1E1RP, 1),
1116 SR_FGT(OP_AT_S1E0W, HFGITR, ATS1E0W, 1),
1117 SR_FGT(OP_AT_S1E0R, HFGITR, ATS1E0R, 1),
1118 SR_FGT(OP_AT_S1E1W, HFGITR, ATS1E1W, 1),
1119 SR_FGT(OP_AT_S1E1R, HFGITR, ATS1E1R, 1),
1120 SR_FGT(SYS_DC_ZVA, HFGITR, DCZVA, 1),
1121 SR_FGT(SYS_DC_GVA, HFGITR, DCZVA, 1),
1122 SR_FGT(SYS_DC_GZVA, HFGITR, DCZVA, 1),
1123 SR_FGT(SYS_DC_CIVAC, HFGITR, DCCIVAC, 1),
1124 SR_FGT(SYS_DC_CIGVAC, HFGITR, DCCIVAC, 1),
1125 SR_FGT(SYS_DC_CIGDVAC, HFGITR, DCCIVAC, 1),
1126 SR_FGT(SYS_DC_CVADP, HFGITR, DCCVADP, 1),
1127 SR_FGT(SYS_DC_CGVADP, HFGITR, DCCVADP, 1),
1128 SR_FGT(SYS_DC_CGDVADP, HFGITR, DCCVADP, 1),
1129 SR_FGT(SYS_DC_CVAP, HFGITR, DCCVAP, 1),
1130 SR_FGT(SYS_DC_CGVAP, HFGITR, DCCVAP, 1),
1131 SR_FGT(SYS_DC_CGDVAP, HFGITR, DCCVAP, 1),
1132 SR_FGT(SYS_DC_CVAU, HFGITR, DCCVAU, 1),
1133 SR_FGT(SYS_DC_CISW, HFGITR, DCCISW, 1),
1134 SR_FGT(SYS_DC_CIGSW, HFGITR, DCCISW, 1),
1135 SR_FGT(SYS_DC_CIGDSW, HFGITR, DCCISW, 1),
1136 SR_FGT(SYS_DC_CSW, HFGITR, DCCSW, 1),
1137 SR_FGT(SYS_DC_CGSW, HFGITR, DCCSW, 1),
1138 SR_FGT(SYS_DC_CGDSW, HFGITR, DCCSW, 1),
1139 SR_FGT(SYS_DC_ISW, HFGITR, DCISW, 1),
1140 SR_FGT(SYS_DC_IGSW, HFGITR, DCISW, 1),
1141 SR_FGT(SYS_DC_IGDSW, HFGITR, DCISW, 1),
1142 SR_FGT(SYS_DC_IVAC, HFGITR, DCIVAC, 1),
1143 SR_FGT(SYS_DC_IGVAC, HFGITR, DCIVAC, 1),
1144 SR_FGT(SYS_DC_IGDVAC, HFGITR, DCIVAC, 1),
1145 SR_FGT(SYS_IC_IVAU, HFGITR, ICIVAU, 1),
1146 SR_FGT(SYS_IC_IALLU, HFGITR, ICIALLU, 1),
1147 SR_FGT(SYS_IC_IALLUIS, HFGITR, ICIALLUIS, 1),
1148 /* HDFGRTR_EL2 */
1149 SR_FGT(SYS_PMBIDR_EL1, HDFGRTR, PMBIDR_EL1, 1),
1150 SR_FGT(SYS_PMSNEVFR_EL1, HDFGRTR, nPMSNEVFR_EL1, 0),
1151 SR_FGT(SYS_BRBINF_EL1(0), HDFGRTR, nBRBDATA, 0),
1152 SR_FGT(SYS_BRBINF_EL1(1), HDFGRTR, nBRBDATA, 0),
1153 SR_FGT(SYS_BRBINF_EL1(2), HDFGRTR, nBRBDATA, 0),
1154 SR_FGT(SYS_BRBINF_EL1(3), HDFGRTR, nBRBDATA, 0),
1155 SR_FGT(SYS_BRBINF_EL1(4), HDFGRTR, nBRBDATA, 0),
1156 SR_FGT(SYS_BRBINF_EL1(5), HDFGRTR, nBRBDATA, 0),
1157 SR_FGT(SYS_BRBINF_EL1(6), HDFGRTR, nBRBDATA, 0),
1158 SR_FGT(SYS_BRBINF_EL1(7), HDFGRTR, nBRBDATA, 0),
1159 SR_FGT(SYS_BRBINF_EL1(8), HDFGRTR, nBRBDATA, 0),
1160 SR_FGT(SYS_BRBINF_EL1(9), HDFGRTR, nBRBDATA, 0),
1161 SR_FGT(SYS_BRBINF_EL1(10), HDFGRTR, nBRBDATA, 0),
1162 SR_FGT(SYS_BRBINF_EL1(11), HDFGRTR, nBRBDATA, 0),
1163 SR_FGT(SYS_BRBINF_EL1(12), HDFGRTR, nBRBDATA, 0),
1164 SR_FGT(SYS_BRBINF_EL1(13), HDFGRTR, nBRBDATA, 0),
1165 SR_FGT(SYS_BRBINF_EL1(14), HDFGRTR, nBRBDATA, 0),
1166 SR_FGT(SYS_BRBINF_EL1(15), HDFGRTR, nBRBDATA, 0),
1167 SR_FGT(SYS_BRBINF_EL1(16), HDFGRTR, nBRBDATA, 0),
1168 SR_FGT(SYS_BRBINF_EL1(17), HDFGRTR, nBRBDATA, 0),
1169 SR_FGT(SYS_BRBINF_EL1(18), HDFGRTR, nBRBDATA, 0),
1170 SR_FGT(SYS_BRBINF_EL1(19), HDFGRTR, nBRBDATA, 0),
1171 SR_FGT(SYS_BRBINF_EL1(20), HDFGRTR, nBRBDATA, 0),
1172 SR_FGT(SYS_BRBINF_EL1(21), HDFGRTR, nBRBDATA, 0),
1173 SR_FGT(SYS_BRBINF_EL1(22), HDFGRTR, nBRBDATA, 0),
1174 SR_FGT(SYS_BRBINF_EL1(23), HDFGRTR, nBRBDATA, 0),
1175 SR_FGT(SYS_BRBINF_EL1(24), HDFGRTR, nBRBDATA, 0),
1176 SR_FGT(SYS_BRBINF_EL1(25), HDFGRTR, nBRBDATA, 0),
1177 SR_FGT(SYS_BRBINF_EL1(26), HDFGRTR, nBRBDATA, 0),
1178 SR_FGT(SYS_BRBINF_EL1(27), HDFGRTR, nBRBDATA, 0),
1179 SR_FGT(SYS_BRBINF_EL1(28), HDFGRTR, nBRBDATA, 0),
1180 SR_FGT(SYS_BRBINF_EL1(29), HDFGRTR, nBRBDATA, 0),
1181 SR_FGT(SYS_BRBINF_EL1(30), HDFGRTR, nBRBDATA, 0),
1182 SR_FGT(SYS_BRBINF_EL1(31), HDFGRTR, nBRBDATA, 0),
1183 SR_FGT(SYS_BRBINFINJ_EL1, HDFGRTR, nBRBDATA, 0),
1184 SR_FGT(SYS_BRBSRC_EL1(0), HDFGRTR, nBRBDATA, 0),
1185 SR_FGT(SYS_BRBSRC_EL1(1), HDFGRTR, nBRBDATA, 0),
1186 SR_FGT(SYS_BRBSRC_EL1(2), HDFGRTR, nBRBDATA, 0),
1187 SR_FGT(SYS_BRBSRC_EL1(3), HDFGRTR, nBRBDATA, 0),
1188 SR_FGT(SYS_BRBSRC_EL1(4), HDFGRTR, nBRBDATA, 0),
1189 SR_FGT(SYS_BRBSRC_EL1(5), HDFGRTR, nBRBDATA, 0),
1190 SR_FGT(SYS_BRBSRC_EL1(6), HDFGRTR, nBRBDATA, 0),
1191 SR_FGT(SYS_BRBSRC_EL1(7), HDFGRTR, nBRBDATA, 0),
1192 SR_FGT(SYS_BRBSRC_EL1(8), HDFGRTR, nBRBDATA, 0),
1193 SR_FGT(SYS_BRBSRC_EL1(9), HDFGRTR, nBRBDATA, 0),
1194 SR_FGT(SYS_BRBSRC_EL1(10), HDFGRTR, nBRBDATA, 0),
1195 SR_FGT(SYS_BRBSRC_EL1(11), HDFGRTR, nBRBDATA, 0),
1196 SR_FGT(SYS_BRBSRC_EL1(12), HDFGRTR, nBRBDATA, 0),
1197 SR_FGT(SYS_BRBSRC_EL1(13), HDFGRTR, nBRBDATA, 0),
1198 SR_FGT(SYS_BRBSRC_EL1(14), HDFGRTR, nBRBDATA, 0),
1199 SR_FGT(SYS_BRBSRC_EL1(15), HDFGRTR, nBRBDATA, 0),
1200 SR_FGT(SYS_BRBSRC_EL1(16), HDFGRTR, nBRBDATA, 0),
1201 SR_FGT(SYS_BRBSRC_EL1(17), HDFGRTR, nBRBDATA, 0),
1202 SR_FGT(SYS_BRBSRC_EL1(18), HDFGRTR, nBRBDATA, 0),
1203 SR_FGT(SYS_BRBSRC_EL1(19), HDFGRTR, nBRBDATA, 0),
1204 SR_FGT(SYS_BRBSRC_EL1(20), HDFGRTR, nBRBDATA, 0),
1205 SR_FGT(SYS_BRBSRC_EL1(21), HDFGRTR, nBRBDATA, 0),
1206 SR_FGT(SYS_BRBSRC_EL1(22), HDFGRTR, nBRBDATA, 0),
1207 SR_FGT(SYS_BRBSRC_EL1(23), HDFGRTR, nBRBDATA, 0),
1208 SR_FGT(SYS_BRBSRC_EL1(24), HDFGRTR, nBRBDATA, 0),
1209 SR_FGT(SYS_BRBSRC_EL1(25), HDFGRTR, nBRBDATA, 0),
1210 SR_FGT(SYS_BRBSRC_EL1(26), HDFGRTR, nBRBDATA, 0),
1211 SR_FGT(SYS_BRBSRC_EL1(27), HDFGRTR, nBRBDATA, 0),
1212 SR_FGT(SYS_BRBSRC_EL1(28), HDFGRTR, nBRBDATA, 0),
1213 SR_FGT(SYS_BRBSRC_EL1(29), HDFGRTR, nBRBDATA, 0),
1214 SR_FGT(SYS_BRBSRC_EL1(30), HDFGRTR, nBRBDATA, 0),
1215 SR_FGT(SYS_BRBSRC_EL1(31), HDFGRTR, nBRBDATA, 0),
1216 SR_FGT(SYS_BRBSRCINJ_EL1, HDFGRTR, nBRBDATA, 0),
1217 SR_FGT(SYS_BRBTGT_EL1(0), HDFGRTR, nBRBDATA, 0),
1218 SR_FGT(SYS_BRBTGT_EL1(1), HDFGRTR, nBRBDATA, 0),
1219 SR_FGT(SYS_BRBTGT_EL1(2), HDFGRTR, nBRBDATA, 0),
1220 SR_FGT(SYS_BRBTGT_EL1(3), HDFGRTR, nBRBDATA, 0),
1221 SR_FGT(SYS_BRBTGT_EL1(4), HDFGRTR, nBRBDATA, 0),
1222 SR_FGT(SYS_BRBTGT_EL1(5), HDFGRTR, nBRBDATA, 0),
1223 SR_FGT(SYS_BRBTGT_EL1(6), HDFGRTR, nBRBDATA, 0),
1224 SR_FGT(SYS_BRBTGT_EL1(7), HDFGRTR, nBRBDATA, 0),
1225 SR_FGT(SYS_BRBTGT_EL1(8), HDFGRTR, nBRBDATA, 0),
1226 SR_FGT(SYS_BRBTGT_EL1(9), HDFGRTR, nBRBDATA, 0),
1227 SR_FGT(SYS_BRBTGT_EL1(10), HDFGRTR, nBRBDATA, 0),
1228 SR_FGT(SYS_BRBTGT_EL1(11), HDFGRTR, nBRBDATA, 0),
1229 SR_FGT(SYS_BRBTGT_EL1(12), HDFGRTR, nBRBDATA, 0),
1230 SR_FGT(SYS_BRBTGT_EL1(13), HDFGRTR, nBRBDATA, 0),
1231 SR_FGT(SYS_BRBTGT_EL1(14), HDFGRTR, nBRBDATA, 0),
1232 SR_FGT(SYS_BRBTGT_EL1(15), HDFGRTR, nBRBDATA, 0),
1233 SR_FGT(SYS_BRBTGT_EL1(16), HDFGRTR, nBRBDATA, 0),
1234 SR_FGT(SYS_BRBTGT_EL1(17), HDFGRTR, nBRBDATA, 0),
1235 SR_FGT(SYS_BRBTGT_EL1(18), HDFGRTR, nBRBDATA, 0),
1236 SR_FGT(SYS_BRBTGT_EL1(19), HDFGRTR, nBRBDATA, 0),
1237 SR_FGT(SYS_BRBTGT_EL1(20), HDFGRTR, nBRBDATA, 0),
1238 SR_FGT(SYS_BRBTGT_EL1(21), HDFGRTR, nBRBDATA, 0),
1239 SR_FGT(SYS_BRBTGT_EL1(22), HDFGRTR, nBRBDATA, 0),
1240 SR_FGT(SYS_BRBTGT_EL1(23), HDFGRTR, nBRBDATA, 0),
1241 SR_FGT(SYS_BRBTGT_EL1(24), HDFGRTR, nBRBDATA, 0),
1242 SR_FGT(SYS_BRBTGT_EL1(25), HDFGRTR, nBRBDATA, 0),
1243 SR_FGT(SYS_BRBTGT_EL1(26), HDFGRTR, nBRBDATA, 0),
1244 SR_FGT(SYS_BRBTGT_EL1(27), HDFGRTR, nBRBDATA, 0),
1245 SR_FGT(SYS_BRBTGT_EL1(28), HDFGRTR, nBRBDATA, 0),
1246 SR_FGT(SYS_BRBTGT_EL1(29), HDFGRTR, nBRBDATA, 0),
1247 SR_FGT(SYS_BRBTGT_EL1(30), HDFGRTR, nBRBDATA, 0),
1248 SR_FGT(SYS_BRBTGT_EL1(31), HDFGRTR, nBRBDATA, 0),
1249 SR_FGT(SYS_BRBTGTINJ_EL1, HDFGRTR, nBRBDATA, 0),
1250 SR_FGT(SYS_BRBTS_EL1, HDFGRTR, nBRBDATA, 0),
1251 SR_FGT(SYS_BRBCR_EL1, HDFGRTR, nBRBCTL, 0),
1252 SR_FGT(SYS_BRBFCR_EL1, HDFGRTR, nBRBCTL, 0),
1253 SR_FGT(SYS_BRBIDR0_EL1, HDFGRTR, nBRBIDR, 0),
1254 SR_FGT(SYS_PMCEID0_EL0, HDFGRTR, PMCEIDn_EL0, 1),
1255 SR_FGT(SYS_PMCEID1_EL0, HDFGRTR, PMCEIDn_EL0, 1),
1256 SR_FGT(SYS_PMUSERENR_EL0, HDFGRTR, PMUSERENR_EL0, 1),
1257 SR_FGT(SYS_TRBTRG_EL1, HDFGRTR, TRBTRG_EL1, 1),
1258 SR_FGT(SYS_TRBSR_EL1, HDFGRTR, TRBSR_EL1, 1),
1259 SR_FGT(SYS_TRBPTR_EL1, HDFGRTR, TRBPTR_EL1, 1),
1260 SR_FGT(SYS_TRBMAR_EL1, HDFGRTR, TRBMAR_EL1, 1),
1261 SR_FGT(SYS_TRBLIMITR_EL1, HDFGRTR, TRBLIMITR_EL1, 1),
1262 SR_FGT(SYS_TRBIDR_EL1, HDFGRTR, TRBIDR_EL1, 1),
1263 SR_FGT(SYS_TRBBASER_EL1, HDFGRTR, TRBBASER_EL1, 1),
1264 SR_FGT(SYS_TRCVICTLR, HDFGRTR, TRCVICTLR, 1),
1265 SR_FGT(SYS_TRCSTATR, HDFGRTR, TRCSTATR, 1),
1266 SR_FGT(SYS_TRCSSCSR(0), HDFGRTR, TRCSSCSRn, 1),
1267 SR_FGT(SYS_TRCSSCSR(1), HDFGRTR, TRCSSCSRn, 1),
1268 SR_FGT(SYS_TRCSSCSR(2), HDFGRTR, TRCSSCSRn, 1),
1269 SR_FGT(SYS_TRCSSCSR(3), HDFGRTR, TRCSSCSRn, 1),
1270 SR_FGT(SYS_TRCSSCSR(4), HDFGRTR, TRCSSCSRn, 1),
1271 SR_FGT(SYS_TRCSSCSR(5), HDFGRTR, TRCSSCSRn, 1),
1272 SR_FGT(SYS_TRCSSCSR(6), HDFGRTR, TRCSSCSRn, 1),
1273 SR_FGT(SYS_TRCSSCSR(7), HDFGRTR, TRCSSCSRn, 1),
1274 SR_FGT(SYS_TRCSEQSTR, HDFGRTR, TRCSEQSTR, 1),
1275 SR_FGT(SYS_TRCPRGCTLR, HDFGRTR, TRCPRGCTLR, 1),
1276 SR_FGT(SYS_TRCOSLSR, HDFGRTR, TRCOSLSR, 1),
1277 SR_FGT(SYS_TRCIMSPEC(0), HDFGRTR, TRCIMSPECn, 1),
1278 SR_FGT(SYS_TRCIMSPEC(1), HDFGRTR, TRCIMSPECn, 1),
1279 SR_FGT(SYS_TRCIMSPEC(2), HDFGRTR, TRCIMSPECn, 1),
1280 SR_FGT(SYS_TRCIMSPEC(3), HDFGRTR, TRCIMSPECn, 1),
1281 SR_FGT(SYS_TRCIMSPEC(4), HDFGRTR, TRCIMSPECn, 1),
1282 SR_FGT(SYS_TRCIMSPEC(5), HDFGRTR, TRCIMSPECn, 1),
1283 SR_FGT(SYS_TRCIMSPEC(6), HDFGRTR, TRCIMSPECn, 1),
1284 SR_FGT(SYS_TRCIMSPEC(7), HDFGRTR, TRCIMSPECn, 1),
1285 SR_FGT(SYS_TRCDEVARCH, HDFGRTR, TRCID, 1),
1286 SR_FGT(SYS_TRCDEVID, HDFGRTR, TRCID, 1),
1287 SR_FGT(SYS_TRCIDR0, HDFGRTR, TRCID, 1),
1288 SR_FGT(SYS_TRCIDR1, HDFGRTR, TRCID, 1),
1289 SR_FGT(SYS_TRCIDR2, HDFGRTR, TRCID, 1),
1290 SR_FGT(SYS_TRCIDR3, HDFGRTR, TRCID, 1),
1291 SR_FGT(SYS_TRCIDR4, HDFGRTR, TRCID, 1),
1292 SR_FGT(SYS_TRCIDR5, HDFGRTR, TRCID, 1),
1293 SR_FGT(SYS_TRCIDR6, HDFGRTR, TRCID, 1),
1294 SR_FGT(SYS_TRCIDR7, HDFGRTR, TRCID, 1),
1295 SR_FGT(SYS_TRCIDR8, HDFGRTR, TRCID, 1),
1296 SR_FGT(SYS_TRCIDR9, HDFGRTR, TRCID, 1),
1297 SR_FGT(SYS_TRCIDR10, HDFGRTR, TRCID, 1),
1298 SR_FGT(SYS_TRCIDR11, HDFGRTR, TRCID, 1),
1299 SR_FGT(SYS_TRCIDR12, HDFGRTR, TRCID, 1),
1300 SR_FGT(SYS_TRCIDR13, HDFGRTR, TRCID, 1),
1301 SR_FGT(SYS_TRCCNTVR(0), HDFGRTR, TRCCNTVRn, 1),
1302 SR_FGT(SYS_TRCCNTVR(1), HDFGRTR, TRCCNTVRn, 1),
1303 SR_FGT(SYS_TRCCNTVR(2), HDFGRTR, TRCCNTVRn, 1),
1304 SR_FGT(SYS_TRCCNTVR(3), HDFGRTR, TRCCNTVRn, 1),
1305 SR_FGT(SYS_TRCCLAIMCLR, HDFGRTR, TRCCLAIM, 1),
1306 SR_FGT(SYS_TRCCLAIMSET, HDFGRTR, TRCCLAIM, 1),
1307 SR_FGT(SYS_TRCAUXCTLR, HDFGRTR, TRCAUXCTLR, 1),
1308 SR_FGT(SYS_TRCAUTHSTATUS, HDFGRTR, TRCAUTHSTATUS, 1),
1309 SR_FGT(SYS_TRCACATR(0), HDFGRTR, TRC, 1),
1310 SR_FGT(SYS_TRCACATR(1), HDFGRTR, TRC, 1),
1311 SR_FGT(SYS_TRCACATR(2), HDFGRTR, TRC, 1),
1312 SR_FGT(SYS_TRCACATR(3), HDFGRTR, TRC, 1),
1313 SR_FGT(SYS_TRCACATR(4), HDFGRTR, TRC, 1),
1314 SR_FGT(SYS_TRCACATR(5), HDFGRTR, TRC, 1),
1315 SR_FGT(SYS_TRCACATR(6), HDFGRTR, TRC, 1),
1316 SR_FGT(SYS_TRCACATR(7), HDFGRTR, TRC, 1),
1317 SR_FGT(SYS_TRCACATR(8), HDFGRTR, TRC, 1),
1318 SR_FGT(SYS_TRCACATR(9), HDFGRTR, TRC, 1),
1319 SR_FGT(SYS_TRCACATR(10), HDFGRTR, TRC, 1),
1320 SR_FGT(SYS_TRCACATR(11), HDFGRTR, TRC, 1),
1321 SR_FGT(SYS_TRCACATR(12), HDFGRTR, TRC, 1),
1322 SR_FGT(SYS_TRCACATR(13), HDFGRTR, TRC, 1),
1323 SR_FGT(SYS_TRCACATR(14), HDFGRTR, TRC, 1),
1324 SR_FGT(SYS_TRCACATR(15), HDFGRTR, TRC, 1),
1325 SR_FGT(SYS_TRCACVR(0), HDFGRTR, TRC, 1),
1326 SR_FGT(SYS_TRCACVR(1), HDFGRTR, TRC, 1),
1327 SR_FGT(SYS_TRCACVR(2), HDFGRTR, TRC, 1),
1328 SR_FGT(SYS_TRCACVR(3), HDFGRTR, TRC, 1),
1329 SR_FGT(SYS_TRCACVR(4), HDFGRTR, TRC, 1),
1330 SR_FGT(SYS_TRCACVR(5), HDFGRTR, TRC, 1),
1331 SR_FGT(SYS_TRCACVR(6), HDFGRTR, TRC, 1),
1332 SR_FGT(SYS_TRCACVR(7), HDFGRTR, TRC, 1),
1333 SR_FGT(SYS_TRCACVR(8), HDFGRTR, TRC, 1),
1334 SR_FGT(SYS_TRCACVR(9), HDFGRTR, TRC, 1),
1335 SR_FGT(SYS_TRCACVR(10), HDFGRTR, TRC, 1),
1336 SR_FGT(SYS_TRCACVR(11), HDFGRTR, TRC, 1),
1337 SR_FGT(SYS_TRCACVR(12), HDFGRTR, TRC, 1),
1338 SR_FGT(SYS_TRCACVR(13), HDFGRTR, TRC, 1),
1339 SR_FGT(SYS_TRCACVR(14), HDFGRTR, TRC, 1),
1340 SR_FGT(SYS_TRCACVR(15), HDFGRTR, TRC, 1),
1341 SR_FGT(SYS_TRCBBCTLR, HDFGRTR, TRC, 1),
1342 SR_FGT(SYS_TRCCCCTLR, HDFGRTR, TRC, 1),
1343 SR_FGT(SYS_TRCCIDCCTLR0, HDFGRTR, TRC, 1),
1344 SR_FGT(SYS_TRCCIDCCTLR1, HDFGRTR, TRC, 1),
1345 SR_FGT(SYS_TRCCIDCVR(0), HDFGRTR, TRC, 1),
1346 SR_FGT(SYS_TRCCIDCVR(1), HDFGRTR, TRC, 1),
1347 SR_FGT(SYS_TRCCIDCVR(2), HDFGRTR, TRC, 1),
1348 SR_FGT(SYS_TRCCIDCVR(3), HDFGRTR, TRC, 1),
1349 SR_FGT(SYS_TRCCIDCVR(4), HDFGRTR, TRC, 1),
1350 SR_FGT(SYS_TRCCIDCVR(5), HDFGRTR, TRC, 1),
1351 SR_FGT(SYS_TRCCIDCVR(6), HDFGRTR, TRC, 1),
1352 SR_FGT(SYS_TRCCIDCVR(7), HDFGRTR, TRC, 1),
1353 SR_FGT(SYS_TRCCNTCTLR(0), HDFGRTR, TRC, 1),
1354 SR_FGT(SYS_TRCCNTCTLR(1), HDFGRTR, TRC, 1),
1355 SR_FGT(SYS_TRCCNTCTLR(2), HDFGRTR, TRC, 1),
1356 SR_FGT(SYS_TRCCNTCTLR(3), HDFGRTR, TRC, 1),
1357 SR_FGT(SYS_TRCCNTRLDVR(0), HDFGRTR, TRC, 1),
1358 SR_FGT(SYS_TRCCNTRLDVR(1), HDFGRTR, TRC, 1),
1359 SR_FGT(SYS_TRCCNTRLDVR(2), HDFGRTR, TRC, 1),
1360 SR_FGT(SYS_TRCCNTRLDVR(3), HDFGRTR, TRC, 1),
1361 SR_FGT(SYS_TRCCONFIGR, HDFGRTR, TRC, 1),
1362 SR_FGT(SYS_TRCEVENTCTL0R, HDFGRTR, TRC, 1),
1363 SR_FGT(SYS_TRCEVENTCTL1R, HDFGRTR, TRC, 1),
1364 SR_FGT(SYS_TRCEXTINSELR(0), HDFGRTR, TRC, 1),
1365 SR_FGT(SYS_TRCEXTINSELR(1), HDFGRTR, TRC, 1),
1366 SR_FGT(SYS_TRCEXTINSELR(2), HDFGRTR, TRC, 1),
1367 SR_FGT(SYS_TRCEXTINSELR(3), HDFGRTR, TRC, 1),
1368 SR_FGT(SYS_TRCQCTLR, HDFGRTR, TRC, 1),
1369 SR_FGT(SYS_TRCRSCTLR(2), HDFGRTR, TRC, 1),
1370 SR_FGT(SYS_TRCRSCTLR(3), HDFGRTR, TRC, 1),
1371 SR_FGT(SYS_TRCRSCTLR(4), HDFGRTR, TRC, 1),
1372 SR_FGT(SYS_TRCRSCTLR(5), HDFGRTR, TRC, 1),
1373 SR_FGT(SYS_TRCRSCTLR(6), HDFGRTR, TRC, 1),
1374 SR_FGT(SYS_TRCRSCTLR(7), HDFGRTR, TRC, 1),
1375 SR_FGT(SYS_TRCRSCTLR(8), HDFGRTR, TRC, 1),
1376 SR_FGT(SYS_TRCRSCTLR(9), HDFGRTR, TRC, 1),
1377 SR_FGT(SYS_TRCRSCTLR(10), HDFGRTR, TRC, 1),
1378 SR_FGT(SYS_TRCRSCTLR(11), HDFGRTR, TRC, 1),
1379 SR_FGT(SYS_TRCRSCTLR(12), HDFGRTR, TRC, 1),
1380 SR_FGT(SYS_TRCRSCTLR(13), HDFGRTR, TRC, 1),
1381 SR_FGT(SYS_TRCRSCTLR(14), HDFGRTR, TRC, 1),
1382 SR_FGT(SYS_TRCRSCTLR(15), HDFGRTR, TRC, 1),
1383 SR_FGT(SYS_TRCRSCTLR(16), HDFGRTR, TRC, 1),
1384 SR_FGT(SYS_TRCRSCTLR(17), HDFGRTR, TRC, 1),
1385 SR_FGT(SYS_TRCRSCTLR(18), HDFGRTR, TRC, 1),
1386 SR_FGT(SYS_TRCRSCTLR(19), HDFGRTR, TRC, 1),
1387 SR_FGT(SYS_TRCRSCTLR(20), HDFGRTR, TRC, 1),
1388 SR_FGT(SYS_TRCRSCTLR(21), HDFGRTR, TRC, 1),
1389 SR_FGT(SYS_TRCRSCTLR(22), HDFGRTR, TRC, 1),
1390 SR_FGT(SYS_TRCRSCTLR(23), HDFGRTR, TRC, 1),
1391 SR_FGT(SYS_TRCRSCTLR(24), HDFGRTR, TRC, 1),
1392 SR_FGT(SYS_TRCRSCTLR(25), HDFGRTR, TRC, 1),
1393 SR_FGT(SYS_TRCRSCTLR(26), HDFGRTR, TRC, 1),
1394 SR_FGT(SYS_TRCRSCTLR(27), HDFGRTR, TRC, 1),
1395 SR_FGT(SYS_TRCRSCTLR(28), HDFGRTR, TRC, 1),
1396 SR_FGT(SYS_TRCRSCTLR(29), HDFGRTR, TRC, 1),
1397 SR_FGT(SYS_TRCRSCTLR(30), HDFGRTR, TRC, 1),
1398 SR_FGT(SYS_TRCRSCTLR(31), HDFGRTR, TRC, 1),
1399 SR_FGT(SYS_TRCRSR, HDFGRTR, TRC, 1),
1400 SR_FGT(SYS_TRCSEQEVR(0), HDFGRTR, TRC, 1),
1401 SR_FGT(SYS_TRCSEQEVR(1), HDFGRTR, TRC, 1),
1402 SR_FGT(SYS_TRCSEQEVR(2), HDFGRTR, TRC, 1),
1403 SR_FGT(SYS_TRCSEQRSTEVR, HDFGRTR, TRC, 1),
1404 SR_FGT(SYS_TRCSSCCR(0), HDFGRTR, TRC, 1),
1405 SR_FGT(SYS_TRCSSCCR(1), HDFGRTR, TRC, 1),
1406 SR_FGT(SYS_TRCSSCCR(2), HDFGRTR, TRC, 1),
1407 SR_FGT(SYS_TRCSSCCR(3), HDFGRTR, TRC, 1),
1408 SR_FGT(SYS_TRCSSCCR(4), HDFGRTR, TRC, 1),
1409 SR_FGT(SYS_TRCSSCCR(5), HDFGRTR, TRC, 1),
1410 SR_FGT(SYS_TRCSSCCR(6), HDFGRTR, TRC, 1),
1411 SR_FGT(SYS_TRCSSCCR(7), HDFGRTR, TRC, 1),
1412 SR_FGT(SYS_TRCSSPCICR(0), HDFGRTR, TRC, 1),
1413 SR_FGT(SYS_TRCSSPCICR(1), HDFGRTR, TRC, 1),
1414 SR_FGT(SYS_TRCSSPCICR(2), HDFGRTR, TRC, 1),
1415 SR_FGT(SYS_TRCSSPCICR(3), HDFGRTR, TRC, 1),
1416 SR_FGT(SYS_TRCSSPCICR(4), HDFGRTR, TRC, 1),
1417 SR_FGT(SYS_TRCSSPCICR(5), HDFGRTR, TRC, 1),
1418 SR_FGT(SYS_TRCSSPCICR(6), HDFGRTR, TRC, 1),
1419 SR_FGT(SYS_TRCSSPCICR(7), HDFGRTR, TRC, 1),
1420 SR_FGT(SYS_TRCSTALLCTLR, HDFGRTR, TRC, 1),
1421 SR_FGT(SYS_TRCSYNCPR, HDFGRTR, TRC, 1),
1422 SR_FGT(SYS_TRCTRACEIDR, HDFGRTR, TRC, 1),
1423 SR_FGT(SYS_TRCTSCTLR, HDFGRTR, TRC, 1),
1424 SR_FGT(SYS_TRCVIIECTLR, HDFGRTR, TRC, 1),
1425 SR_FGT(SYS_TRCVIPCSSCTLR, HDFGRTR, TRC, 1),
1426 SR_FGT(SYS_TRCVISSCTLR, HDFGRTR, TRC, 1),
1427 SR_FGT(SYS_TRCVMIDCCTLR0, HDFGRTR, TRC, 1),
1428 SR_FGT(SYS_TRCVMIDCCTLR1, HDFGRTR, TRC, 1),
1429 SR_FGT(SYS_TRCVMIDCVR(0), HDFGRTR, TRC, 1),
1430 SR_FGT(SYS_TRCVMIDCVR(1), HDFGRTR, TRC, 1),
1431 SR_FGT(SYS_TRCVMIDCVR(2), HDFGRTR, TRC, 1),
1432 SR_FGT(SYS_TRCVMIDCVR(3), HDFGRTR, TRC, 1),
1433 SR_FGT(SYS_TRCVMIDCVR(4), HDFGRTR, TRC, 1),
1434 SR_FGT(SYS_TRCVMIDCVR(5), HDFGRTR, TRC, 1),
1435 SR_FGT(SYS_TRCVMIDCVR(6), HDFGRTR, TRC, 1),
1436 SR_FGT(SYS_TRCVMIDCVR(7), HDFGRTR, TRC, 1),
1437 SR_FGT(SYS_PMSLATFR_EL1, HDFGRTR, PMSLATFR_EL1, 1),
1438 SR_FGT(SYS_PMSIRR_EL1, HDFGRTR, PMSIRR_EL1, 1),
1439 SR_FGT(SYS_PMSIDR_EL1, HDFGRTR, PMSIDR_EL1, 1),
1440 SR_FGT(SYS_PMSICR_EL1, HDFGRTR, PMSICR_EL1, 1),
1441 SR_FGT(SYS_PMSFCR_EL1, HDFGRTR, PMSFCR_EL1, 1),
1442 SR_FGT(SYS_PMSEVFR_EL1, HDFGRTR, PMSEVFR_EL1, 1),
1443 SR_FGT(SYS_PMSCR_EL1, HDFGRTR, PMSCR_EL1, 1),
1444 SR_FGT(SYS_PMBSR_EL1, HDFGRTR, PMBSR_EL1, 1),
1445 SR_FGT(SYS_PMBPTR_EL1, HDFGRTR, PMBPTR_EL1, 1),
1446 SR_FGT(SYS_PMBLIMITR_EL1, HDFGRTR, PMBLIMITR_EL1, 1),
1447 SR_FGT(SYS_PMMIR_EL1, HDFGRTR, PMMIR_EL1, 1),
1448 SR_FGT(SYS_PMSELR_EL0, HDFGRTR, PMSELR_EL0, 1),
1449 SR_FGT(SYS_PMOVSCLR_EL0, HDFGRTR, PMOVS, 1),
1450 SR_FGT(SYS_PMOVSSET_EL0, HDFGRTR, PMOVS, 1),
1451 SR_FGT(SYS_PMINTENCLR_EL1, HDFGRTR, PMINTEN, 1),
1452 SR_FGT(SYS_PMINTENSET_EL1, HDFGRTR, PMINTEN, 1),
1453 SR_FGT(SYS_PMCNTENCLR_EL0, HDFGRTR, PMCNTEN, 1),
1454 SR_FGT(SYS_PMCNTENSET_EL0, HDFGRTR, PMCNTEN, 1),
1455 SR_FGT(SYS_PMCCNTR_EL0, HDFGRTR, PMCCNTR_EL0, 1),
1456 SR_FGT(SYS_PMCCFILTR_EL0, HDFGRTR, PMCCFILTR_EL0, 1),
1457 SR_FGT(SYS_PMEVTYPERn_EL0(0), HDFGRTR, PMEVTYPERn_EL0, 1),
1458 SR_FGT(SYS_PMEVTYPERn_EL0(1), HDFGRTR, PMEVTYPERn_EL0, 1),
1459 SR_FGT(SYS_PMEVTYPERn_EL0(2), HDFGRTR, PMEVTYPERn_EL0, 1),
1460 SR_FGT(SYS_PMEVTYPERn_EL0(3), HDFGRTR, PMEVTYPERn_EL0, 1),
1461 SR_FGT(SYS_PMEVTYPERn_EL0(4), HDFGRTR, PMEVTYPERn_EL0, 1),
1462 SR_FGT(SYS_PMEVTYPERn_EL0(5), HDFGRTR, PMEVTYPERn_EL0, 1),
1463 SR_FGT(SYS_PMEVTYPERn_EL0(6), HDFGRTR, PMEVTYPERn_EL0, 1),
1464 SR_FGT(SYS_PMEVTYPERn_EL0(7), HDFGRTR, PMEVTYPERn_EL0, 1),
1465 SR_FGT(SYS_PMEVTYPERn_EL0(8), HDFGRTR, PMEVTYPERn_EL0, 1),
1466 SR_FGT(SYS_PMEVTYPERn_EL0(9), HDFGRTR, PMEVTYPERn_EL0, 1),
1467 SR_FGT(SYS_PMEVTYPERn_EL0(10), HDFGRTR, PMEVTYPERn_EL0, 1),
1468 SR_FGT(SYS_PMEVTYPERn_EL0(11), HDFGRTR, PMEVTYPERn_EL0, 1),
1469 SR_FGT(SYS_PMEVTYPERn_EL0(12), HDFGRTR, PMEVTYPERn_EL0, 1),
1470 SR_FGT(SYS_PMEVTYPERn_EL0(13), HDFGRTR, PMEVTYPERn_EL0, 1),
1471 SR_FGT(SYS_PMEVTYPERn_EL0(14), HDFGRTR, PMEVTYPERn_EL0, 1),
1472 SR_FGT(SYS_PMEVTYPERn_EL0(15), HDFGRTR, PMEVTYPERn_EL0, 1),
1473 SR_FGT(SYS_PMEVTYPERn_EL0(16), HDFGRTR, PMEVTYPERn_EL0, 1),
1474 SR_FGT(SYS_PMEVTYPERn_EL0(17), HDFGRTR, PMEVTYPERn_EL0, 1),
1475 SR_FGT(SYS_PMEVTYPERn_EL0(18), HDFGRTR, PMEVTYPERn_EL0, 1),
1476 SR_FGT(SYS_PMEVTYPERn_EL0(19), HDFGRTR, PMEVTYPERn_EL0, 1),
1477 SR_FGT(SYS_PMEVTYPERn_EL0(20), HDFGRTR, PMEVTYPERn_EL0, 1),
1478 SR_FGT(SYS_PMEVTYPERn_EL0(21), HDFGRTR, PMEVTYPERn_EL0, 1),
1479 SR_FGT(SYS_PMEVTYPERn_EL0(22), HDFGRTR, PMEVTYPERn_EL0, 1),
1480 SR_FGT(SYS_PMEVTYPERn_EL0(23), HDFGRTR, PMEVTYPERn_EL0, 1),
1481 SR_FGT(SYS_PMEVTYPERn_EL0(24), HDFGRTR, PMEVTYPERn_EL0, 1),
1482 SR_FGT(SYS_PMEVTYPERn_EL0(25), HDFGRTR, PMEVTYPERn_EL0, 1),
1483 SR_FGT(SYS_PMEVTYPERn_EL0(26), HDFGRTR, PMEVTYPERn_EL0, 1),
1484 SR_FGT(SYS_PMEVTYPERn_EL0(27), HDFGRTR, PMEVTYPERn_EL0, 1),
1485 SR_FGT(SYS_PMEVTYPERn_EL0(28), HDFGRTR, PMEVTYPERn_EL0, 1),
1486 SR_FGT(SYS_PMEVTYPERn_EL0(29), HDFGRTR, PMEVTYPERn_EL0, 1),
1487 SR_FGT(SYS_PMEVTYPERn_EL0(30), HDFGRTR, PMEVTYPERn_EL0, 1),
1488 SR_FGT(SYS_PMEVCNTRn_EL0(0), HDFGRTR, PMEVCNTRn_EL0, 1),
1489 SR_FGT(SYS_PMEVCNTRn_EL0(1), HDFGRTR, PMEVCNTRn_EL0, 1),
1490 SR_FGT(SYS_PMEVCNTRn_EL0(2), HDFGRTR, PMEVCNTRn_EL0, 1),
1491 SR_FGT(SYS_PMEVCNTRn_EL0(3), HDFGRTR, PMEVCNTRn_EL0, 1),
1492 SR_FGT(SYS_PMEVCNTRn_EL0(4), HDFGRTR, PMEVCNTRn_EL0, 1),
1493 SR_FGT(SYS_PMEVCNTRn_EL0(5), HDFGRTR, PMEVCNTRn_EL0, 1),
1494 SR_FGT(SYS_PMEVCNTRn_EL0(6), HDFGRTR, PMEVCNTRn_EL0, 1),
1495 SR_FGT(SYS_PMEVCNTRn_EL0(7), HDFGRTR, PMEVCNTRn_EL0, 1),
1496 SR_FGT(SYS_PMEVCNTRn_EL0(8), HDFGRTR, PMEVCNTRn_EL0, 1),
1497 SR_FGT(SYS_PMEVCNTRn_EL0(9), HDFGRTR, PMEVCNTRn_EL0, 1),
1498 SR_FGT(SYS_PMEVCNTRn_EL0(10), HDFGRTR, PMEVCNTRn_EL0, 1),
1499 SR_FGT(SYS_PMEVCNTRn_EL0(11), HDFGRTR, PMEVCNTRn_EL0, 1),
1500 SR_FGT(SYS_PMEVCNTRn_EL0(12), HDFGRTR, PMEVCNTRn_EL0, 1),
1501 SR_FGT(SYS_PMEVCNTRn_EL0(13), HDFGRTR, PMEVCNTRn_EL0, 1),
1502 SR_FGT(SYS_PMEVCNTRn_EL0(14), HDFGRTR, PMEVCNTRn_EL0, 1),
1503 SR_FGT(SYS_PMEVCNTRn_EL0(15), HDFGRTR, PMEVCNTRn_EL0, 1),
1504 SR_FGT(SYS_PMEVCNTRn_EL0(16), HDFGRTR, PMEVCNTRn_EL0, 1),
1505 SR_FGT(SYS_PMEVCNTRn_EL0(17), HDFGRTR, PMEVCNTRn_EL0, 1),
1506 SR_FGT(SYS_PMEVCNTRn_EL0(18), HDFGRTR, PMEVCNTRn_EL0, 1),
1507 SR_FGT(SYS_PMEVCNTRn_EL0(19), HDFGRTR, PMEVCNTRn_EL0, 1),
1508 SR_FGT(SYS_PMEVCNTRn_EL0(20), HDFGRTR, PMEVCNTRn_EL0, 1),
1509 SR_FGT(SYS_PMEVCNTRn_EL0(21), HDFGRTR, PMEVCNTRn_EL0, 1),
1510 SR_FGT(SYS_PMEVCNTRn_EL0(22), HDFGRTR, PMEVCNTRn_EL0, 1),
1511 SR_FGT(SYS_PMEVCNTRn_EL0(23), HDFGRTR, PMEVCNTRn_EL0, 1),
1512 SR_FGT(SYS_PMEVCNTRn_EL0(24), HDFGRTR, PMEVCNTRn_EL0, 1),
1513 SR_FGT(SYS_PMEVCNTRn_EL0(25), HDFGRTR, PMEVCNTRn_EL0, 1),
1514 SR_FGT(SYS_PMEVCNTRn_EL0(26), HDFGRTR, PMEVCNTRn_EL0, 1),
1515 SR_FGT(SYS_PMEVCNTRn_EL0(27), HDFGRTR, PMEVCNTRn_EL0, 1),
1516 SR_FGT(SYS_PMEVCNTRn_EL0(28), HDFGRTR, PMEVCNTRn_EL0, 1),
1517 SR_FGT(SYS_PMEVCNTRn_EL0(29), HDFGRTR, PMEVCNTRn_EL0, 1),
1518 SR_FGT(SYS_PMEVCNTRn_EL0(30), HDFGRTR, PMEVCNTRn_EL0, 1),
1519 SR_FGT(SYS_OSDLR_EL1, HDFGRTR, OSDLR_EL1, 1),
1520 SR_FGT(SYS_OSECCR_EL1, HDFGRTR, OSECCR_EL1, 1),
1521 SR_FGT(SYS_OSLSR_EL1, HDFGRTR, OSLSR_EL1, 1),
1522 SR_FGT(SYS_DBGPRCR_EL1, HDFGRTR, DBGPRCR_EL1, 1),
1523 SR_FGT(SYS_DBGAUTHSTATUS_EL1, HDFGRTR, DBGAUTHSTATUS_EL1, 1),
1524 SR_FGT(SYS_DBGCLAIMSET_EL1, HDFGRTR, DBGCLAIM, 1),
1525 SR_FGT(SYS_DBGCLAIMCLR_EL1, HDFGRTR, DBGCLAIM, 1),
1526 SR_FGT(SYS_MDSCR_EL1, HDFGRTR, MDSCR_EL1, 1),
1527 /*
1528 * The trap bits capture *64* debug registers per bit, but the
1529 * ARM ARM only describes the encoding for the first 16, and
1530 * we don't really support more than that anyway.
1531 */
1532 SR_FGT(SYS_DBGWVRn_EL1(0), HDFGRTR, DBGWVRn_EL1, 1),
1533 SR_FGT(SYS_DBGWVRn_EL1(1), HDFGRTR, DBGWVRn_EL1, 1),
1534 SR_FGT(SYS_DBGWVRn_EL1(2), HDFGRTR, DBGWVRn_EL1, 1),
1535 SR_FGT(SYS_DBGWVRn_EL1(3), HDFGRTR, DBGWVRn_EL1, 1),
1536 SR_FGT(SYS_DBGWVRn_EL1(4), HDFGRTR, DBGWVRn_EL1, 1),
1537 SR_FGT(SYS_DBGWVRn_EL1(5), HDFGRTR, DBGWVRn_EL1, 1),
1538 SR_FGT(SYS_DBGWVRn_EL1(6), HDFGRTR, DBGWVRn_EL1, 1),
1539 SR_FGT(SYS_DBGWVRn_EL1(7), HDFGRTR, DBGWVRn_EL1, 1),
1540 SR_FGT(SYS_DBGWVRn_EL1(8), HDFGRTR, DBGWVRn_EL1, 1),
1541 SR_FGT(SYS_DBGWVRn_EL1(9), HDFGRTR, DBGWVRn_EL1, 1),
1542 SR_FGT(SYS_DBGWVRn_EL1(10), HDFGRTR, DBGWVRn_EL1, 1),
1543 SR_FGT(SYS_DBGWVRn_EL1(11), HDFGRTR, DBGWVRn_EL1, 1),
1544 SR_FGT(SYS_DBGWVRn_EL1(12), HDFGRTR, DBGWVRn_EL1, 1),
1545 SR_FGT(SYS_DBGWVRn_EL1(13), HDFGRTR, DBGWVRn_EL1, 1),
1546 SR_FGT(SYS_DBGWVRn_EL1(14), HDFGRTR, DBGWVRn_EL1, 1),
1547 SR_FGT(SYS_DBGWVRn_EL1(15), HDFGRTR, DBGWVRn_EL1, 1),
1548 SR_FGT(SYS_DBGWCRn_EL1(0), HDFGRTR, DBGWCRn_EL1, 1),
1549 SR_FGT(SYS_DBGWCRn_EL1(1), HDFGRTR, DBGWCRn_EL1, 1),
1550 SR_FGT(SYS_DBGWCRn_EL1(2), HDFGRTR, DBGWCRn_EL1, 1),
1551 SR_FGT(SYS_DBGWCRn_EL1(3), HDFGRTR, DBGWCRn_EL1, 1),
1552 SR_FGT(SYS_DBGWCRn_EL1(4), HDFGRTR, DBGWCRn_EL1, 1),
1553 SR_FGT(SYS_DBGWCRn_EL1(5), HDFGRTR, DBGWCRn_EL1, 1),
1554 SR_FGT(SYS_DBGWCRn_EL1(6), HDFGRTR, DBGWCRn_EL1, 1),
1555 SR_FGT(SYS_DBGWCRn_EL1(7), HDFGRTR, DBGWCRn_EL1, 1),
1556 SR_FGT(SYS_DBGWCRn_EL1(8), HDFGRTR, DBGWCRn_EL1, 1),
1557 SR_FGT(SYS_DBGWCRn_EL1(9), HDFGRTR, DBGWCRn_EL1, 1),
1558 SR_FGT(SYS_DBGWCRn_EL1(10), HDFGRTR, DBGWCRn_EL1, 1),
1559 SR_FGT(SYS_DBGWCRn_EL1(11), HDFGRTR, DBGWCRn_EL1, 1),
1560 SR_FGT(SYS_DBGWCRn_EL1(12), HDFGRTR, DBGWCRn_EL1, 1),
1561 SR_FGT(SYS_DBGWCRn_EL1(13), HDFGRTR, DBGWCRn_EL1, 1),
1562 SR_FGT(SYS_DBGWCRn_EL1(14), HDFGRTR, DBGWCRn_EL1, 1),
1563 SR_FGT(SYS_DBGWCRn_EL1(15), HDFGRTR, DBGWCRn_EL1, 1),
1564 SR_FGT(SYS_DBGBVRn_EL1(0), HDFGRTR, DBGBVRn_EL1, 1),
1565 SR_FGT(SYS_DBGBVRn_EL1(1), HDFGRTR, DBGBVRn_EL1, 1),
1566 SR_FGT(SYS_DBGBVRn_EL1(2), HDFGRTR, DBGBVRn_EL1, 1),
1567 SR_FGT(SYS_DBGBVRn_EL1(3), HDFGRTR, DBGBVRn_EL1, 1),
1568 SR_FGT(SYS_DBGBVRn_EL1(4), HDFGRTR, DBGBVRn_EL1, 1),
1569 SR_FGT(SYS_DBGBVRn_EL1(5), HDFGRTR, DBGBVRn_EL1, 1),
1570 SR_FGT(SYS_DBGBVRn_EL1(6), HDFGRTR, DBGBVRn_EL1, 1),
1571 SR_FGT(SYS_DBGBVRn_EL1(7), HDFGRTR, DBGBVRn_EL1, 1),
1572 SR_FGT(SYS_DBGBVRn_EL1(8), HDFGRTR, DBGBVRn_EL1, 1),
1573 SR_FGT(SYS_DBGBVRn_EL1(9), HDFGRTR, DBGBVRn_EL1, 1),
1574 SR_FGT(SYS_DBGBVRn_EL1(10), HDFGRTR, DBGBVRn_EL1, 1),
1575 SR_FGT(SYS_DBGBVRn_EL1(11), HDFGRTR, DBGBVRn_EL1, 1),
1576 SR_FGT(SYS_DBGBVRn_EL1(12), HDFGRTR, DBGBVRn_EL1, 1),
1577 SR_FGT(SYS_DBGBVRn_EL1(13), HDFGRTR, DBGBVRn_EL1, 1),
1578 SR_FGT(SYS_DBGBVRn_EL1(14), HDFGRTR, DBGBVRn_EL1, 1),
1579 SR_FGT(SYS_DBGBVRn_EL1(15), HDFGRTR, DBGBVRn_EL1, 1),
1580 SR_FGT(SYS_DBGBCRn_EL1(0), HDFGRTR, DBGBCRn_EL1, 1),
1581 SR_FGT(SYS_DBGBCRn_EL1(1), HDFGRTR, DBGBCRn_EL1, 1),
1582 SR_FGT(SYS_DBGBCRn_EL1(2), HDFGRTR, DBGBCRn_EL1, 1),
1583 SR_FGT(SYS_DBGBCRn_EL1(3), HDFGRTR, DBGBCRn_EL1, 1),
1584 SR_FGT(SYS_DBGBCRn_EL1(4), HDFGRTR, DBGBCRn_EL1, 1),
1585 SR_FGT(SYS_DBGBCRn_EL1(5), HDFGRTR, DBGBCRn_EL1, 1),
1586 SR_FGT(SYS_DBGBCRn_EL1(6), HDFGRTR, DBGBCRn_EL1, 1),
1587 SR_FGT(SYS_DBGBCRn_EL1(7), HDFGRTR, DBGBCRn_EL1, 1),
1588 SR_FGT(SYS_DBGBCRn_EL1(8), HDFGRTR, DBGBCRn_EL1, 1),
1589 SR_FGT(SYS_DBGBCRn_EL1(9), HDFGRTR, DBGBCRn_EL1, 1),
1590 SR_FGT(SYS_DBGBCRn_EL1(10), HDFGRTR, DBGBCRn_EL1, 1),
1591 SR_FGT(SYS_DBGBCRn_EL1(11), HDFGRTR, DBGBCRn_EL1, 1),
1592 SR_FGT(SYS_DBGBCRn_EL1(12), HDFGRTR, DBGBCRn_EL1, 1),
1593 SR_FGT(SYS_DBGBCRn_EL1(13), HDFGRTR, DBGBCRn_EL1, 1),
1594 SR_FGT(SYS_DBGBCRn_EL1(14), HDFGRTR, DBGBCRn_EL1, 1),
1595 SR_FGT(SYS_DBGBCRn_EL1(15), HDFGRTR, DBGBCRn_EL1, 1),
1596 /*
1597 * HDFGWTR_EL2
1598 *
1599 * Although HDFGRTR_EL2 and HDFGWTR_EL2 registers largely
1600 * overlap in their bit assignment, there are a number of bits
1601 * that are RES0 on one side, and an actual trap bit on the
1602 * other. The policy chosen here is to describe all the
1603 * read-side mappings, and only the write-side mappings that
1604 * differ from the read side, and the trap handler will pick
1605 * the correct shadow register based on the access type.
1606 */
1607 SR_FGT(SYS_TRFCR_EL1, HDFGWTR, TRFCR_EL1, 1),
1608 SR_FGT(SYS_TRCOSLAR, HDFGWTR, TRCOSLAR, 1),
1609 SR_FGT(SYS_PMCR_EL0, HDFGWTR, PMCR_EL0, 1),
1610 SR_FGT(SYS_PMSWINC_EL0, HDFGWTR, PMSWINC_EL0, 1),
1611 SR_FGT(SYS_OSLAR_EL1, HDFGWTR, OSLAR_EL1, 1),
1612 };
1613
get_trap_config(u32 sysreg)1614 static union trap_config get_trap_config(u32 sysreg)
1615 {
1616 return (union trap_config) {
1617 .val = xa_to_value(xa_load(&sr_forward_xa, sysreg)),
1618 };
1619 }
1620
print_nv_trap_error(const struct encoding_to_trap_config * tc,const char * type,int err)1621 static __init void print_nv_trap_error(const struct encoding_to_trap_config *tc,
1622 const char *type, int err)
1623 {
1624 kvm_err("%s line %d encoding range "
1625 "(%d, %d, %d, %d, %d) - (%d, %d, %d, %d, %d) (err=%d)\n",
1626 type, tc->line,
1627 sys_reg_Op0(tc->encoding), sys_reg_Op1(tc->encoding),
1628 sys_reg_CRn(tc->encoding), sys_reg_CRm(tc->encoding),
1629 sys_reg_Op2(tc->encoding),
1630 sys_reg_Op0(tc->end), sys_reg_Op1(tc->end),
1631 sys_reg_CRn(tc->end), sys_reg_CRm(tc->end),
1632 sys_reg_Op2(tc->end),
1633 err);
1634 }
1635
populate_nv_trap_config(void)1636 int __init populate_nv_trap_config(void)
1637 {
1638 int ret = 0;
1639
1640 BUILD_BUG_ON(sizeof(union trap_config) != sizeof(void *));
1641 BUILD_BUG_ON(__NR_CGT_GROUP_IDS__ > BIT(TC_CGT_BITS));
1642 BUILD_BUG_ON(__NR_FGT_GROUP_IDS__ > BIT(TC_FGT_BITS));
1643 BUILD_BUG_ON(__NR_FG_FILTER_IDS__ > BIT(TC_FGF_BITS));
1644
1645 for (int i = 0; i < ARRAY_SIZE(encoding_to_cgt); i++) {
1646 const struct encoding_to_trap_config *cgt = &encoding_to_cgt[i];
1647 void *prev;
1648
1649 if (cgt->tc.val & BIT(63)) {
1650 kvm_err("CGT[%d] has MBZ bit set\n", i);
1651 ret = -EINVAL;
1652 }
1653
1654 if (cgt->encoding != cgt->end) {
1655 prev = xa_store_range(&sr_forward_xa,
1656 cgt->encoding, cgt->end,
1657 xa_mk_value(cgt->tc.val),
1658 GFP_KERNEL);
1659 } else {
1660 prev = xa_store(&sr_forward_xa, cgt->encoding,
1661 xa_mk_value(cgt->tc.val), GFP_KERNEL);
1662 if (prev && !xa_is_err(prev)) {
1663 ret = -EINVAL;
1664 print_nv_trap_error(cgt, "Duplicate CGT", ret);
1665 }
1666 }
1667
1668 if (xa_is_err(prev)) {
1669 ret = xa_err(prev);
1670 print_nv_trap_error(cgt, "Failed CGT insertion", ret);
1671 }
1672 }
1673
1674 kvm_info("nv: %ld coarse grained trap handlers\n",
1675 ARRAY_SIZE(encoding_to_cgt));
1676
1677 if (!cpus_have_final_cap(ARM64_HAS_FGT))
1678 goto check_mcb;
1679
1680 for (int i = 0; i < ARRAY_SIZE(encoding_to_fgt); i++) {
1681 const struct encoding_to_trap_config *fgt = &encoding_to_fgt[i];
1682 union trap_config tc;
1683
1684 if (fgt->tc.fgt >= __NR_FGT_GROUP_IDS__) {
1685 ret = -EINVAL;
1686 print_nv_trap_error(fgt, "Invalid FGT", ret);
1687 }
1688
1689 tc = get_trap_config(fgt->encoding);
1690
1691 if (tc.fgt) {
1692 ret = -EINVAL;
1693 print_nv_trap_error(fgt, "Duplicate FGT", ret);
1694 }
1695
1696 tc.val |= fgt->tc.val;
1697 xa_store(&sr_forward_xa, fgt->encoding,
1698 xa_mk_value(tc.val), GFP_KERNEL);
1699 }
1700
1701 kvm_info("nv: %ld fine grained trap handlers\n",
1702 ARRAY_SIZE(encoding_to_fgt));
1703
1704 check_mcb:
1705 for (int id = __MULTIPLE_CONTROL_BITS__; id < __COMPLEX_CONDITIONS__; id++) {
1706 const enum cgt_group_id *cgids;
1707
1708 cgids = coarse_control_combo[id - __MULTIPLE_CONTROL_BITS__];
1709
1710 for (int i = 0; cgids[i] != __RESERVED__; i++) {
1711 if (cgids[i] >= __MULTIPLE_CONTROL_BITS__) {
1712 kvm_err("Recursive MCB %d/%d\n", id, cgids[i]);
1713 ret = -EINVAL;
1714 }
1715 }
1716 }
1717
1718 if (ret)
1719 xa_destroy(&sr_forward_xa);
1720
1721 return ret;
1722 }
1723
get_behaviour(struct kvm_vcpu * vcpu,const struct trap_bits * tb)1724 static enum trap_behaviour get_behaviour(struct kvm_vcpu *vcpu,
1725 const struct trap_bits *tb)
1726 {
1727 enum trap_behaviour b = BEHAVE_HANDLE_LOCALLY;
1728 u64 val;
1729
1730 val = __vcpu_sys_reg(vcpu, tb->index);
1731 if ((val & tb->mask) == tb->value)
1732 b |= tb->behaviour;
1733
1734 return b;
1735 }
1736
__compute_trap_behaviour(struct kvm_vcpu * vcpu,const enum cgt_group_id id,enum trap_behaviour b)1737 static enum trap_behaviour __compute_trap_behaviour(struct kvm_vcpu *vcpu,
1738 const enum cgt_group_id id,
1739 enum trap_behaviour b)
1740 {
1741 switch (id) {
1742 const enum cgt_group_id *cgids;
1743
1744 case __RESERVED__ ... __MULTIPLE_CONTROL_BITS__ - 1:
1745 if (likely(id != __RESERVED__))
1746 b |= get_behaviour(vcpu, &coarse_trap_bits[id]);
1747 break;
1748 case __MULTIPLE_CONTROL_BITS__ ... __COMPLEX_CONDITIONS__ - 1:
1749 /* Yes, this is recursive. Don't do anything stupid. */
1750 cgids = coarse_control_combo[id - __MULTIPLE_CONTROL_BITS__];
1751 for (int i = 0; cgids[i] != __RESERVED__; i++)
1752 b |= __compute_trap_behaviour(vcpu, cgids[i], b);
1753 break;
1754 default:
1755 if (ARRAY_SIZE(ccc))
1756 b |= ccc[id - __COMPLEX_CONDITIONS__](vcpu);
1757 break;
1758 }
1759
1760 return b;
1761 }
1762
compute_trap_behaviour(struct kvm_vcpu * vcpu,const union trap_config tc)1763 static enum trap_behaviour compute_trap_behaviour(struct kvm_vcpu *vcpu,
1764 const union trap_config tc)
1765 {
1766 enum trap_behaviour b = BEHAVE_HANDLE_LOCALLY;
1767
1768 return __compute_trap_behaviour(vcpu, tc.cgt, b);
1769 }
1770
check_fgt_bit(u64 val,const union trap_config tc)1771 static bool check_fgt_bit(u64 val, const union trap_config tc)
1772 {
1773 return ((val >> tc.bit) & 1) == tc.pol;
1774 }
1775
1776 #define sanitised_sys_reg(vcpu, reg) \
1777 ({ \
1778 u64 __val; \
1779 __val = __vcpu_sys_reg(vcpu, reg); \
1780 __val &= ~__ ## reg ## _RES0; \
1781 (__val); \
1782 })
1783
__check_nv_sr_forward(struct kvm_vcpu * vcpu)1784 bool __check_nv_sr_forward(struct kvm_vcpu *vcpu)
1785 {
1786 union trap_config tc;
1787 enum trap_behaviour b;
1788 bool is_read;
1789 u32 sysreg;
1790 u64 esr, val;
1791
1792 if (!vcpu_has_nv(vcpu) || is_hyp_ctxt(vcpu))
1793 return false;
1794
1795 esr = kvm_vcpu_get_esr(vcpu);
1796 sysreg = esr_sys64_to_sysreg(esr);
1797 is_read = (esr & ESR_ELx_SYS64_ISS_DIR_MASK) == ESR_ELx_SYS64_ISS_DIR_READ;
1798
1799 tc = get_trap_config(sysreg);
1800
1801 /*
1802 * A value of 0 for the whole entry means that we know nothing
1803 * for this sysreg, and that it cannot be re-injected into the
1804 * nested hypervisor. In this situation, let's cut it short.
1805 *
1806 * Note that ultimately, we could also make use of the xarray
1807 * to store the index of the sysreg in the local descriptor
1808 * array, avoiding another search... Hint, hint...
1809 */
1810 if (!tc.val)
1811 return false;
1812
1813 switch ((enum fgt_group_id)tc.fgt) {
1814 case __NO_FGT_GROUP__:
1815 break;
1816
1817 case HFGxTR_GROUP:
1818 if (is_read)
1819 val = sanitised_sys_reg(vcpu, HFGRTR_EL2);
1820 else
1821 val = sanitised_sys_reg(vcpu, HFGWTR_EL2);
1822 break;
1823
1824 case HDFGRTR_GROUP:
1825 case HDFGWTR_GROUP:
1826 if (is_read)
1827 val = sanitised_sys_reg(vcpu, HDFGRTR_EL2);
1828 else
1829 val = sanitised_sys_reg(vcpu, HDFGWTR_EL2);
1830 break;
1831
1832 case HFGITR_GROUP:
1833 val = sanitised_sys_reg(vcpu, HFGITR_EL2);
1834 switch (tc.fgf) {
1835 u64 tmp;
1836
1837 case __NO_FGF__:
1838 break;
1839
1840 case HCRX_FGTnXS:
1841 tmp = sanitised_sys_reg(vcpu, HCRX_EL2);
1842 if (tmp & HCRX_EL2_FGTnXS)
1843 tc.fgt = __NO_FGT_GROUP__;
1844 }
1845 break;
1846
1847 case __NR_FGT_GROUP_IDS__:
1848 /* Something is really wrong, bail out */
1849 WARN_ONCE(1, "__NR_FGT_GROUP_IDS__");
1850 return false;
1851 }
1852
1853 if (tc.fgt != __NO_FGT_GROUP__ && check_fgt_bit(val, tc))
1854 goto inject;
1855
1856 b = compute_trap_behaviour(vcpu, tc);
1857
1858 if (((b & BEHAVE_FORWARD_READ) && is_read) ||
1859 ((b & BEHAVE_FORWARD_WRITE) && !is_read))
1860 goto inject;
1861
1862 return false;
1863
1864 inject:
1865 trace_kvm_forward_sysreg_trap(vcpu, sysreg, is_read);
1866
1867 kvm_inject_nested_sync(vcpu, kvm_vcpu_get_esr(vcpu));
1868 return true;
1869 }
1870
kvm_check_illegal_exception_return(struct kvm_vcpu * vcpu,u64 spsr)1871 static u64 kvm_check_illegal_exception_return(struct kvm_vcpu *vcpu, u64 spsr)
1872 {
1873 u64 mode = spsr & PSR_MODE_MASK;
1874
1875 /*
1876 * Possible causes for an Illegal Exception Return from EL2:
1877 * - trying to return to EL3
1878 * - trying to return to an illegal M value
1879 * - trying to return to a 32bit EL
1880 * - trying to return to EL1 with HCR_EL2.TGE set
1881 */
1882 if (mode == PSR_MODE_EL3t || mode == PSR_MODE_EL3h ||
1883 mode == 0b00001 || (mode & BIT(1)) ||
1884 (spsr & PSR_MODE32_BIT) ||
1885 (vcpu_el2_tge_is_set(vcpu) && (mode == PSR_MODE_EL1t ||
1886 mode == PSR_MODE_EL1h))) {
1887 /*
1888 * The guest is playing with our nerves. Preserve EL, SP,
1889 * masks, flags from the existing PSTATE, and set IL.
1890 * The HW will then generate an Illegal State Exception
1891 * immediately after ERET.
1892 */
1893 spsr = *vcpu_cpsr(vcpu);
1894
1895 spsr &= (PSR_D_BIT | PSR_A_BIT | PSR_I_BIT | PSR_F_BIT |
1896 PSR_N_BIT | PSR_Z_BIT | PSR_C_BIT | PSR_V_BIT |
1897 PSR_MODE_MASK | PSR_MODE32_BIT);
1898 spsr |= PSR_IL_BIT;
1899 }
1900
1901 return spsr;
1902 }
1903
kvm_emulate_nested_eret(struct kvm_vcpu * vcpu)1904 void kvm_emulate_nested_eret(struct kvm_vcpu *vcpu)
1905 {
1906 u64 spsr, elr, mode;
1907 bool direct_eret;
1908
1909 /*
1910 * Going through the whole put/load motions is a waste of time
1911 * if this is a VHE guest hypervisor returning to its own
1912 * userspace, or the hypervisor performing a local exception
1913 * return. No need to save/restore registers, no need to
1914 * switch S2 MMU. Just do the canonical ERET.
1915 */
1916 spsr = vcpu_read_sys_reg(vcpu, SPSR_EL2);
1917 spsr = kvm_check_illegal_exception_return(vcpu, spsr);
1918
1919 mode = spsr & (PSR_MODE_MASK | PSR_MODE32_BIT);
1920
1921 direct_eret = (mode == PSR_MODE_EL0t &&
1922 vcpu_el2_e2h_is_set(vcpu) &&
1923 vcpu_el2_tge_is_set(vcpu));
1924 direct_eret |= (mode == PSR_MODE_EL2h || mode == PSR_MODE_EL2t);
1925
1926 if (direct_eret) {
1927 *vcpu_pc(vcpu) = vcpu_read_sys_reg(vcpu, ELR_EL2);
1928 *vcpu_cpsr(vcpu) = spsr;
1929 trace_kvm_nested_eret(vcpu, *vcpu_pc(vcpu), spsr);
1930 return;
1931 }
1932
1933 preempt_disable();
1934 kvm_arch_vcpu_put(vcpu);
1935
1936 elr = __vcpu_sys_reg(vcpu, ELR_EL2);
1937
1938 trace_kvm_nested_eret(vcpu, elr, spsr);
1939
1940 /*
1941 * Note that the current exception level is always the virtual EL2,
1942 * since we set HCR_EL2.NV bit only when entering the virtual EL2.
1943 */
1944 *vcpu_pc(vcpu) = elr;
1945 *vcpu_cpsr(vcpu) = spsr;
1946
1947 kvm_arch_vcpu_load(vcpu, smp_processor_id());
1948 preempt_enable();
1949 }
1950
kvm_inject_el2_exception(struct kvm_vcpu * vcpu,u64 esr_el2,enum exception_type type)1951 static void kvm_inject_el2_exception(struct kvm_vcpu *vcpu, u64 esr_el2,
1952 enum exception_type type)
1953 {
1954 trace_kvm_inject_nested_exception(vcpu, esr_el2, type);
1955
1956 switch (type) {
1957 case except_type_sync:
1958 kvm_pend_exception(vcpu, EXCEPT_AA64_EL2_SYNC);
1959 vcpu_write_sys_reg(vcpu, esr_el2, ESR_EL2);
1960 break;
1961 case except_type_irq:
1962 kvm_pend_exception(vcpu, EXCEPT_AA64_EL2_IRQ);
1963 break;
1964 default:
1965 WARN_ONCE(1, "Unsupported EL2 exception injection %d\n", type);
1966 }
1967 }
1968
1969 /*
1970 * Emulate taking an exception to EL2.
1971 * See ARM ARM J8.1.2 AArch64.TakeException()
1972 */
kvm_inject_nested(struct kvm_vcpu * vcpu,u64 esr_el2,enum exception_type type)1973 static int kvm_inject_nested(struct kvm_vcpu *vcpu, u64 esr_el2,
1974 enum exception_type type)
1975 {
1976 u64 pstate, mode;
1977 bool direct_inject;
1978
1979 if (!vcpu_has_nv(vcpu)) {
1980 kvm_err("Unexpected call to %s for the non-nesting configuration\n",
1981 __func__);
1982 return -EINVAL;
1983 }
1984
1985 /*
1986 * As for ERET, we can avoid doing too much on the injection path by
1987 * checking that we either took the exception from a VHE host
1988 * userspace or from vEL2. In these cases, there is no change in
1989 * translation regime (or anything else), so let's do as little as
1990 * possible.
1991 */
1992 pstate = *vcpu_cpsr(vcpu);
1993 mode = pstate & (PSR_MODE_MASK | PSR_MODE32_BIT);
1994
1995 direct_inject = (mode == PSR_MODE_EL0t &&
1996 vcpu_el2_e2h_is_set(vcpu) &&
1997 vcpu_el2_tge_is_set(vcpu));
1998 direct_inject |= (mode == PSR_MODE_EL2h || mode == PSR_MODE_EL2t);
1999
2000 if (direct_inject) {
2001 kvm_inject_el2_exception(vcpu, esr_el2, type);
2002 return 1;
2003 }
2004
2005 preempt_disable();
2006
2007 /*
2008 * We may have an exception or PC update in the EL0/EL1 context.
2009 * Commit it before entering EL2.
2010 */
2011 __kvm_adjust_pc(vcpu);
2012
2013 kvm_arch_vcpu_put(vcpu);
2014
2015 kvm_inject_el2_exception(vcpu, esr_el2, type);
2016
2017 /*
2018 * A hard requirement is that a switch between EL1 and EL2
2019 * contexts has to happen between a put/load, so that we can
2020 * pick the correct timer and interrupt configuration, among
2021 * other things.
2022 *
2023 * Make sure the exception actually took place before we load
2024 * the new context.
2025 */
2026 __kvm_adjust_pc(vcpu);
2027
2028 kvm_arch_vcpu_load(vcpu, smp_processor_id());
2029 preempt_enable();
2030
2031 return 1;
2032 }
2033
kvm_inject_nested_sync(struct kvm_vcpu * vcpu,u64 esr_el2)2034 int kvm_inject_nested_sync(struct kvm_vcpu *vcpu, u64 esr_el2)
2035 {
2036 return kvm_inject_nested(vcpu, esr_el2, except_type_sync);
2037 }
2038
kvm_inject_nested_irq(struct kvm_vcpu * vcpu)2039 int kvm_inject_nested_irq(struct kvm_vcpu *vcpu)
2040 {
2041 /*
2042 * Do not inject an irq if the:
2043 * - Current exception level is EL2, and
2044 * - virtual HCR_EL2.TGE == 0
2045 * - virtual HCR_EL2.IMO == 0
2046 *
2047 * See Table D1-17 "Physical interrupt target and masking when EL3 is
2048 * not implemented and EL2 is implemented" in ARM DDI 0487C.a.
2049 */
2050
2051 if (vcpu_is_el2(vcpu) && !vcpu_el2_tge_is_set(vcpu) &&
2052 !(__vcpu_sys_reg(vcpu, HCR_EL2) & HCR_IMO))
2053 return 1;
2054
2055 /* esr_el2 value doesn't matter for exits due to irqs. */
2056 return kvm_inject_nested(vcpu, 0, except_type_irq);
2057 }
2058