xref: /openbmc/linux/arch/arm64/kvm/emulate-nested.c (revision 86d6a628a281a17b8341ece99997c1251bb41a41)
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