sysreg.h 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763
  1. /*
  2. * Macros for accessing system registers with older binutils.
  3. *
  4. * Copyright (C) 2014 ARM Ltd.
  5. * Author: Catalin Marinas <catalin.marinas@arm.com>
  6. *
  7. * This program is free software: you can redistribute it and/or modify
  8. * it under the terms of the GNU General Public License version 2 as
  9. * published by the Free Software Foundation.
  10. *
  11. * This program is distributed in the hope that it will be useful,
  12. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  14. * GNU General Public License for more details.
  15. *
  16. * You should have received a copy of the GNU General Public License
  17. * along with this program. If not, see <http://www.gnu.org/licenses/>.
  18. */
  19. #ifndef __ASM_SYSREG_H
  20. #define __ASM_SYSREG_H
  21. #include <asm/compiler.h>
  22. #include <linux/stringify.h>
  23. /*
  24. * ARMv8 ARM reserves the following encoding for system registers:
  25. * (Ref: ARMv8 ARM, Section: "System instruction class encoding overview",
  26. * C5.2, version:ARM DDI 0487A.f)
  27. * [20-19] : Op0
  28. * [18-16] : Op1
  29. * [15-12] : CRn
  30. * [11-8] : CRm
  31. * [7-5] : Op2
  32. */
  33. #define Op0_shift 19
  34. #define Op0_mask 0x3
  35. #define Op1_shift 16
  36. #define Op1_mask 0x7
  37. #define CRn_shift 12
  38. #define CRn_mask 0xf
  39. #define CRm_shift 8
  40. #define CRm_mask 0xf
  41. #define Op2_shift 5
  42. #define Op2_mask 0x7
  43. #define sys_reg(op0, op1, crn, crm, op2) \
  44. (((op0) << Op0_shift) | ((op1) << Op1_shift) | \
  45. ((crn) << CRn_shift) | ((crm) << CRm_shift) | \
  46. ((op2) << Op2_shift))
  47. #define sys_insn sys_reg
  48. #define sys_reg_Op0(id) (((id) >> Op0_shift) & Op0_mask)
  49. #define sys_reg_Op1(id) (((id) >> Op1_shift) & Op1_mask)
  50. #define sys_reg_CRn(id) (((id) >> CRn_shift) & CRn_mask)
  51. #define sys_reg_CRm(id) (((id) >> CRm_shift) & CRm_mask)
  52. #define sys_reg_Op2(id) (((id) >> Op2_shift) & Op2_mask)
  53. #ifndef CONFIG_BROKEN_GAS_INST
  54. #ifdef __ASSEMBLY__
  55. // The space separator is omitted so that __emit_inst(x) can be parsed as
  56. // either an assembler directive or an assembler macro argument.
  57. #define __emit_inst(x) .inst(x)
  58. #else
  59. #define __emit_inst(x) ".inst " __stringify((x)) "\n\t"
  60. #endif
  61. #else /* CONFIG_BROKEN_GAS_INST */
  62. #ifndef CONFIG_CPU_BIG_ENDIAN
  63. #define __INSTR_BSWAP(x) (x)
  64. #else /* CONFIG_CPU_BIG_ENDIAN */
  65. #define __INSTR_BSWAP(x) ((((x) << 24) & 0xff000000) | \
  66. (((x) << 8) & 0x00ff0000) | \
  67. (((x) >> 8) & 0x0000ff00) | \
  68. (((x) >> 24) & 0x000000ff))
  69. #endif /* CONFIG_CPU_BIG_ENDIAN */
  70. #ifdef __ASSEMBLY__
  71. #define __emit_inst(x) .long __INSTR_BSWAP(x)
  72. #else /* __ASSEMBLY__ */
  73. #define __emit_inst(x) ".long " __stringify(__INSTR_BSWAP(x)) "\n\t"
  74. #endif /* __ASSEMBLY__ */
  75. #endif /* CONFIG_BROKEN_GAS_INST */
  76. #define REG_PSTATE_PAN_IMM sys_reg(0, 0, 4, 0, 4)
  77. #define REG_PSTATE_UAO_IMM sys_reg(0, 0, 4, 0, 3)
  78. #define REG_PSTATE_SSBS_IMM sys_reg(0, 3, 4, 0, 1)
  79. #define SET_PSTATE_PAN(x) __emit_inst(0xd5000000 | REG_PSTATE_PAN_IMM | \
  80. (!!x)<<8 | 0x1f)
  81. #define SET_PSTATE_UAO(x) __emit_inst(0xd5000000 | REG_PSTATE_UAO_IMM | \
  82. (!!x)<<8 | 0x1f)
  83. #define SET_PSTATE_SSBS(x) __emit_inst(0xd5000000 | REG_PSTATE_SSBS_IMM | \
  84. (!!x)<<8 | 0x1f)
  85. #define SYS_DC_ISW sys_insn(1, 0, 7, 6, 2)
  86. #define SYS_DC_CSW sys_insn(1, 0, 7, 10, 2)
  87. #define SYS_DC_CISW sys_insn(1, 0, 7, 14, 2)
  88. #define SYS_OSDTRRX_EL1 sys_reg(2, 0, 0, 0, 2)
  89. #define SYS_MDCCINT_EL1 sys_reg(2, 0, 0, 2, 0)
  90. #define SYS_MDSCR_EL1 sys_reg(2, 0, 0, 2, 2)
  91. #define SYS_OSDTRTX_EL1 sys_reg(2, 0, 0, 3, 2)
  92. #define SYS_OSECCR_EL1 sys_reg(2, 0, 0, 6, 2)
  93. #define SYS_DBGBVRn_EL1(n) sys_reg(2, 0, 0, n, 4)
  94. #define SYS_DBGBCRn_EL1(n) sys_reg(2, 0, 0, n, 5)
  95. #define SYS_DBGWVRn_EL1(n) sys_reg(2, 0, 0, n, 6)
  96. #define SYS_DBGWCRn_EL1(n) sys_reg(2, 0, 0, n, 7)
  97. #define SYS_MDRAR_EL1 sys_reg(2, 0, 1, 0, 0)
  98. #define SYS_OSLAR_EL1 sys_reg(2, 0, 1, 0, 4)
  99. #define SYS_OSLSR_EL1 sys_reg(2, 0, 1, 1, 4)
  100. #define SYS_OSDLR_EL1 sys_reg(2, 0, 1, 3, 4)
  101. #define SYS_DBGPRCR_EL1 sys_reg(2, 0, 1, 4, 4)
  102. #define SYS_DBGCLAIMSET_EL1 sys_reg(2, 0, 7, 8, 6)
  103. #define SYS_DBGCLAIMCLR_EL1 sys_reg(2, 0, 7, 9, 6)
  104. #define SYS_DBGAUTHSTATUS_EL1 sys_reg(2, 0, 7, 14, 6)
  105. #define SYS_MDCCSR_EL0 sys_reg(2, 3, 0, 1, 0)
  106. #define SYS_DBGDTR_EL0 sys_reg(2, 3, 0, 4, 0)
  107. #define SYS_DBGDTRRX_EL0 sys_reg(2, 3, 0, 5, 0)
  108. #define SYS_DBGDTRTX_EL0 sys_reg(2, 3, 0, 5, 0)
  109. #define SYS_DBGVCR32_EL2 sys_reg(2, 4, 0, 7, 0)
  110. #define SYS_MIDR_EL1 sys_reg(3, 0, 0, 0, 0)
  111. #define SYS_MPIDR_EL1 sys_reg(3, 0, 0, 0, 5)
  112. #define SYS_REVIDR_EL1 sys_reg(3, 0, 0, 0, 6)
  113. #define SYS_ID_PFR0_EL1 sys_reg(3, 0, 0, 1, 0)
  114. #define SYS_ID_PFR1_EL1 sys_reg(3, 0, 0, 1, 1)
  115. #define SYS_ID_DFR0_EL1 sys_reg(3, 0, 0, 1, 2)
  116. #define SYS_ID_AFR0_EL1 sys_reg(3, 0, 0, 1, 3)
  117. #define SYS_ID_MMFR0_EL1 sys_reg(3, 0, 0, 1, 4)
  118. #define SYS_ID_MMFR1_EL1 sys_reg(3, 0, 0, 1, 5)
  119. #define SYS_ID_MMFR2_EL1 sys_reg(3, 0, 0, 1, 6)
  120. #define SYS_ID_MMFR3_EL1 sys_reg(3, 0, 0, 1, 7)
  121. #define SYS_ID_ISAR0_EL1 sys_reg(3, 0, 0, 2, 0)
  122. #define SYS_ID_ISAR1_EL1 sys_reg(3, 0, 0, 2, 1)
  123. #define SYS_ID_ISAR2_EL1 sys_reg(3, 0, 0, 2, 2)
  124. #define SYS_ID_ISAR3_EL1 sys_reg(3, 0, 0, 2, 3)
  125. #define SYS_ID_ISAR4_EL1 sys_reg(3, 0, 0, 2, 4)
  126. #define SYS_ID_ISAR5_EL1 sys_reg(3, 0, 0, 2, 5)
  127. #define SYS_ID_MMFR4_EL1 sys_reg(3, 0, 0, 2, 6)
  128. #define SYS_MVFR0_EL1 sys_reg(3, 0, 0, 3, 0)
  129. #define SYS_MVFR1_EL1 sys_reg(3, 0, 0, 3, 1)
  130. #define SYS_MVFR2_EL1 sys_reg(3, 0, 0, 3, 2)
  131. #define SYS_ID_AA64PFR0_EL1 sys_reg(3, 0, 0, 4, 0)
  132. #define SYS_ID_AA64PFR1_EL1 sys_reg(3, 0, 0, 4, 1)
  133. #define SYS_ID_AA64ZFR0_EL1 sys_reg(3, 0, 0, 4, 4)
  134. #define SYS_ID_AA64DFR0_EL1 sys_reg(3, 0, 0, 5, 0)
  135. #define SYS_ID_AA64DFR1_EL1 sys_reg(3, 0, 0, 5, 1)
  136. #define SYS_ID_AA64AFR0_EL1 sys_reg(3, 0, 0, 5, 4)
  137. #define SYS_ID_AA64AFR1_EL1 sys_reg(3, 0, 0, 5, 5)
  138. #define SYS_ID_AA64ISAR0_EL1 sys_reg(3, 0, 0, 6, 0)
  139. #define SYS_ID_AA64ISAR1_EL1 sys_reg(3, 0, 0, 6, 1)
  140. #define SYS_ID_AA64MMFR0_EL1 sys_reg(3, 0, 0, 7, 0)
  141. #define SYS_ID_AA64MMFR1_EL1 sys_reg(3, 0, 0, 7, 1)
  142. #define SYS_ID_AA64MMFR2_EL1 sys_reg(3, 0, 0, 7, 2)
  143. #define SYS_SCTLR_EL1 sys_reg(3, 0, 1, 0, 0)
  144. #define SYS_ACTLR_EL1 sys_reg(3, 0, 1, 0, 1)
  145. #define SYS_CPACR_EL1 sys_reg(3, 0, 1, 0, 2)
  146. #define SYS_ZCR_EL1 sys_reg(3, 0, 1, 2, 0)
  147. #define SYS_TTBR0_EL1 sys_reg(3, 0, 2, 0, 0)
  148. #define SYS_TTBR1_EL1 sys_reg(3, 0, 2, 0, 1)
  149. #define SYS_TCR_EL1 sys_reg(3, 0, 2, 0, 2)
  150. #define SYS_ICC_PMR_EL1 sys_reg(3, 0, 4, 6, 0)
  151. #define SYS_AFSR0_EL1 sys_reg(3, 0, 5, 1, 0)
  152. #define SYS_AFSR1_EL1 sys_reg(3, 0, 5, 1, 1)
  153. #define SYS_ESR_EL1 sys_reg(3, 0, 5, 2, 0)
  154. #define SYS_ERRIDR_EL1 sys_reg(3, 0, 5, 3, 0)
  155. #define SYS_ERRSELR_EL1 sys_reg(3, 0, 5, 3, 1)
  156. #define SYS_ERXFR_EL1 sys_reg(3, 0, 5, 4, 0)
  157. #define SYS_ERXCTLR_EL1 sys_reg(3, 0, 5, 4, 1)
  158. #define SYS_ERXSTATUS_EL1 sys_reg(3, 0, 5, 4, 2)
  159. #define SYS_ERXADDR_EL1 sys_reg(3, 0, 5, 4, 3)
  160. #define SYS_ERXMISC0_EL1 sys_reg(3, 0, 5, 5, 0)
  161. #define SYS_ERXMISC1_EL1 sys_reg(3, 0, 5, 5, 1)
  162. #define SYS_FAR_EL1 sys_reg(3, 0, 6, 0, 0)
  163. #define SYS_PAR_EL1 sys_reg(3, 0, 7, 4, 0)
  164. /*** Statistical Profiling Extension ***/
  165. /* ID registers */
  166. #define SYS_PMSIDR_EL1 sys_reg(3, 0, 9, 9, 7)
  167. #define SYS_PMSIDR_EL1_FE_SHIFT 0
  168. #define SYS_PMSIDR_EL1_FT_SHIFT 1
  169. #define SYS_PMSIDR_EL1_FL_SHIFT 2
  170. #define SYS_PMSIDR_EL1_ARCHINST_SHIFT 3
  171. #define SYS_PMSIDR_EL1_LDS_SHIFT 4
  172. #define SYS_PMSIDR_EL1_ERND_SHIFT 5
  173. #define SYS_PMSIDR_EL1_INTERVAL_SHIFT 8
  174. #define SYS_PMSIDR_EL1_INTERVAL_MASK 0xfUL
  175. #define SYS_PMSIDR_EL1_MAXSIZE_SHIFT 12
  176. #define SYS_PMSIDR_EL1_MAXSIZE_MASK 0xfUL
  177. #define SYS_PMSIDR_EL1_COUNTSIZE_SHIFT 16
  178. #define SYS_PMSIDR_EL1_COUNTSIZE_MASK 0xfUL
  179. #define SYS_PMBIDR_EL1 sys_reg(3, 0, 9, 10, 7)
  180. #define SYS_PMBIDR_EL1_ALIGN_SHIFT 0
  181. #define SYS_PMBIDR_EL1_ALIGN_MASK 0xfU
  182. #define SYS_PMBIDR_EL1_P_SHIFT 4
  183. #define SYS_PMBIDR_EL1_F_SHIFT 5
  184. /* Sampling controls */
  185. #define SYS_PMSCR_EL1 sys_reg(3, 0, 9, 9, 0)
  186. #define SYS_PMSCR_EL1_E0SPE_SHIFT 0
  187. #define SYS_PMSCR_EL1_E1SPE_SHIFT 1
  188. #define SYS_PMSCR_EL1_CX_SHIFT 3
  189. #define SYS_PMSCR_EL1_PA_SHIFT 4
  190. #define SYS_PMSCR_EL1_TS_SHIFT 5
  191. #define SYS_PMSCR_EL1_PCT_SHIFT 6
  192. #define SYS_PMSCR_EL2 sys_reg(3, 4, 9, 9, 0)
  193. #define SYS_PMSCR_EL2_E0HSPE_SHIFT 0
  194. #define SYS_PMSCR_EL2_E2SPE_SHIFT 1
  195. #define SYS_PMSCR_EL2_CX_SHIFT 3
  196. #define SYS_PMSCR_EL2_PA_SHIFT 4
  197. #define SYS_PMSCR_EL2_TS_SHIFT 5
  198. #define SYS_PMSCR_EL2_PCT_SHIFT 6
  199. #define SYS_PMSICR_EL1 sys_reg(3, 0, 9, 9, 2)
  200. #define SYS_PMSIRR_EL1 sys_reg(3, 0, 9, 9, 3)
  201. #define SYS_PMSIRR_EL1_RND_SHIFT 0
  202. #define SYS_PMSIRR_EL1_INTERVAL_SHIFT 8
  203. #define SYS_PMSIRR_EL1_INTERVAL_MASK 0xffffffUL
  204. /* Filtering controls */
  205. #define SYS_PMSFCR_EL1 sys_reg(3, 0, 9, 9, 4)
  206. #define SYS_PMSFCR_EL1_FE_SHIFT 0
  207. #define SYS_PMSFCR_EL1_FT_SHIFT 1
  208. #define SYS_PMSFCR_EL1_FL_SHIFT 2
  209. #define SYS_PMSFCR_EL1_B_SHIFT 16
  210. #define SYS_PMSFCR_EL1_LD_SHIFT 17
  211. #define SYS_PMSFCR_EL1_ST_SHIFT 18
  212. #define SYS_PMSEVFR_EL1 sys_reg(3, 0, 9, 9, 5)
  213. #define SYS_PMSEVFR_EL1_RES0 0x0000ffff00ff0f55UL
  214. #define SYS_PMSLATFR_EL1 sys_reg(3, 0, 9, 9, 6)
  215. #define SYS_PMSLATFR_EL1_MINLAT_SHIFT 0
  216. /* Buffer controls */
  217. #define SYS_PMBLIMITR_EL1 sys_reg(3, 0, 9, 10, 0)
  218. #define SYS_PMBLIMITR_EL1_E_SHIFT 0
  219. #define SYS_PMBLIMITR_EL1_FM_SHIFT 1
  220. #define SYS_PMBLIMITR_EL1_FM_MASK 0x3UL
  221. #define SYS_PMBLIMITR_EL1_FM_STOP_IRQ (0 << SYS_PMBLIMITR_EL1_FM_SHIFT)
  222. #define SYS_PMBPTR_EL1 sys_reg(3, 0, 9, 10, 1)
  223. /* Buffer error reporting */
  224. #define SYS_PMBSR_EL1 sys_reg(3, 0, 9, 10, 3)
  225. #define SYS_PMBSR_EL1_COLL_SHIFT 16
  226. #define SYS_PMBSR_EL1_S_SHIFT 17
  227. #define SYS_PMBSR_EL1_EA_SHIFT 18
  228. #define SYS_PMBSR_EL1_DL_SHIFT 19
  229. #define SYS_PMBSR_EL1_EC_SHIFT 26
  230. #define SYS_PMBSR_EL1_EC_MASK 0x3fUL
  231. #define SYS_PMBSR_EL1_EC_BUF (0x0UL << SYS_PMBSR_EL1_EC_SHIFT)
  232. #define SYS_PMBSR_EL1_EC_FAULT_S1 (0x24UL << SYS_PMBSR_EL1_EC_SHIFT)
  233. #define SYS_PMBSR_EL1_EC_FAULT_S2 (0x25UL << SYS_PMBSR_EL1_EC_SHIFT)
  234. #define SYS_PMBSR_EL1_FAULT_FSC_SHIFT 0
  235. #define SYS_PMBSR_EL1_FAULT_FSC_MASK 0x3fUL
  236. #define SYS_PMBSR_EL1_BUF_BSC_SHIFT 0
  237. #define SYS_PMBSR_EL1_BUF_BSC_MASK 0x3fUL
  238. #define SYS_PMBSR_EL1_BUF_BSC_FULL (0x1UL << SYS_PMBSR_EL1_BUF_BSC_SHIFT)
  239. /*** End of Statistical Profiling Extension ***/
  240. #define SYS_PMINTENSET_EL1 sys_reg(3, 0, 9, 14, 1)
  241. #define SYS_PMINTENCLR_EL1 sys_reg(3, 0, 9, 14, 2)
  242. #define SYS_MAIR_EL1 sys_reg(3, 0, 10, 2, 0)
  243. #define SYS_AMAIR_EL1 sys_reg(3, 0, 10, 3, 0)
  244. #define SYS_LORSA_EL1 sys_reg(3, 0, 10, 4, 0)
  245. #define SYS_LOREA_EL1 sys_reg(3, 0, 10, 4, 1)
  246. #define SYS_LORN_EL1 sys_reg(3, 0, 10, 4, 2)
  247. #define SYS_LORC_EL1 sys_reg(3, 0, 10, 4, 3)
  248. #define SYS_LORID_EL1 sys_reg(3, 0, 10, 4, 7)
  249. #define SYS_VBAR_EL1 sys_reg(3, 0, 12, 0, 0)
  250. #define SYS_DISR_EL1 sys_reg(3, 0, 12, 1, 1)
  251. #define SYS_ICC_IAR0_EL1 sys_reg(3, 0, 12, 8, 0)
  252. #define SYS_ICC_EOIR0_EL1 sys_reg(3, 0, 12, 8, 1)
  253. #define SYS_ICC_HPPIR0_EL1 sys_reg(3, 0, 12, 8, 2)
  254. #define SYS_ICC_BPR0_EL1 sys_reg(3, 0, 12, 8, 3)
  255. #define SYS_ICC_AP0Rn_EL1(n) sys_reg(3, 0, 12, 8, 4 | n)
  256. #define SYS_ICC_AP0R0_EL1 SYS_ICC_AP0Rn_EL1(0)
  257. #define SYS_ICC_AP0R1_EL1 SYS_ICC_AP0Rn_EL1(1)
  258. #define SYS_ICC_AP0R2_EL1 SYS_ICC_AP0Rn_EL1(2)
  259. #define SYS_ICC_AP0R3_EL1 SYS_ICC_AP0Rn_EL1(3)
  260. #define SYS_ICC_AP1Rn_EL1(n) sys_reg(3, 0, 12, 9, n)
  261. #define SYS_ICC_AP1R0_EL1 SYS_ICC_AP1Rn_EL1(0)
  262. #define SYS_ICC_AP1R1_EL1 SYS_ICC_AP1Rn_EL1(1)
  263. #define SYS_ICC_AP1R2_EL1 SYS_ICC_AP1Rn_EL1(2)
  264. #define SYS_ICC_AP1R3_EL1 SYS_ICC_AP1Rn_EL1(3)
  265. #define SYS_ICC_DIR_EL1 sys_reg(3, 0, 12, 11, 1)
  266. #define SYS_ICC_RPR_EL1 sys_reg(3, 0, 12, 11, 3)
  267. #define SYS_ICC_SGI1R_EL1 sys_reg(3, 0, 12, 11, 5)
  268. #define SYS_ICC_ASGI1R_EL1 sys_reg(3, 0, 12, 11, 6)
  269. #define SYS_ICC_SGI0R_EL1 sys_reg(3, 0, 12, 11, 7)
  270. #define SYS_ICC_IAR1_EL1 sys_reg(3, 0, 12, 12, 0)
  271. #define SYS_ICC_EOIR1_EL1 sys_reg(3, 0, 12, 12, 1)
  272. #define SYS_ICC_HPPIR1_EL1 sys_reg(3, 0, 12, 12, 2)
  273. #define SYS_ICC_BPR1_EL1 sys_reg(3, 0, 12, 12, 3)
  274. #define SYS_ICC_CTLR_EL1 sys_reg(3, 0, 12, 12, 4)
  275. #define SYS_ICC_SRE_EL1 sys_reg(3, 0, 12, 12, 5)
  276. #define SYS_ICC_IGRPEN0_EL1 sys_reg(3, 0, 12, 12, 6)
  277. #define SYS_ICC_IGRPEN1_EL1 sys_reg(3, 0, 12, 12, 7)
  278. #define SYS_CONTEXTIDR_EL1 sys_reg(3, 0, 13, 0, 1)
  279. #define SYS_TPIDR_EL1 sys_reg(3, 0, 13, 0, 4)
  280. #define SYS_CNTKCTL_EL1 sys_reg(3, 0, 14, 1, 0)
  281. #define SYS_CLIDR_EL1 sys_reg(3, 1, 0, 0, 1)
  282. #define SYS_AIDR_EL1 sys_reg(3, 1, 0, 0, 7)
  283. #define SYS_CSSELR_EL1 sys_reg(3, 2, 0, 0, 0)
  284. #define SYS_CTR_EL0 sys_reg(3, 3, 0, 0, 1)
  285. #define SYS_DCZID_EL0 sys_reg(3, 3, 0, 0, 7)
  286. #define SYS_PMCR_EL0 sys_reg(3, 3, 9, 12, 0)
  287. #define SYS_PMCNTENSET_EL0 sys_reg(3, 3, 9, 12, 1)
  288. #define SYS_PMCNTENCLR_EL0 sys_reg(3, 3, 9, 12, 2)
  289. #define SYS_PMOVSCLR_EL0 sys_reg(3, 3, 9, 12, 3)
  290. #define SYS_PMSWINC_EL0 sys_reg(3, 3, 9, 12, 4)
  291. #define SYS_PMSELR_EL0 sys_reg(3, 3, 9, 12, 5)
  292. #define SYS_PMCEID0_EL0 sys_reg(3, 3, 9, 12, 6)
  293. #define SYS_PMCEID1_EL0 sys_reg(3, 3, 9, 12, 7)
  294. #define SYS_PMCCNTR_EL0 sys_reg(3, 3, 9, 13, 0)
  295. #define SYS_PMXEVTYPER_EL0 sys_reg(3, 3, 9, 13, 1)
  296. #define SYS_PMXEVCNTR_EL0 sys_reg(3, 3, 9, 13, 2)
  297. #define SYS_PMUSERENR_EL0 sys_reg(3, 3, 9, 14, 0)
  298. #define SYS_PMOVSSET_EL0 sys_reg(3, 3, 9, 14, 3)
  299. #define SYS_TPIDR_EL0 sys_reg(3, 3, 13, 0, 2)
  300. #define SYS_TPIDRRO_EL0 sys_reg(3, 3, 13, 0, 3)
  301. #define SYS_CNTFRQ_EL0 sys_reg(3, 3, 14, 0, 0)
  302. #define SYS_CNTP_TVAL_EL0 sys_reg(3, 3, 14, 2, 0)
  303. #define SYS_CNTP_CTL_EL0 sys_reg(3, 3, 14, 2, 1)
  304. #define SYS_CNTP_CVAL_EL0 sys_reg(3, 3, 14, 2, 2)
  305. #define __PMEV_op2(n) ((n) & 0x7)
  306. #define __CNTR_CRm(n) (0x8 | (((n) >> 3) & 0x3))
  307. #define SYS_PMEVCNTRn_EL0(n) sys_reg(3, 3, 14, __CNTR_CRm(n), __PMEV_op2(n))
  308. #define __TYPER_CRm(n) (0xc | (((n) >> 3) & 0x3))
  309. #define SYS_PMEVTYPERn_EL0(n) sys_reg(3, 3, 14, __TYPER_CRm(n), __PMEV_op2(n))
  310. #define SYS_PMCCFILTR_EL0 sys_reg (3, 3, 14, 15, 7)
  311. #define SYS_ZCR_EL2 sys_reg(3, 4, 1, 2, 0)
  312. #define SYS_DACR32_EL2 sys_reg(3, 4, 3, 0, 0)
  313. #define SYS_IFSR32_EL2 sys_reg(3, 4, 5, 0, 1)
  314. #define SYS_VSESR_EL2 sys_reg(3, 4, 5, 2, 3)
  315. #define SYS_FPEXC32_EL2 sys_reg(3, 4, 5, 3, 0)
  316. #define SYS_VDISR_EL2 sys_reg(3, 4, 12, 1, 1)
  317. #define __SYS__AP0Rx_EL2(x) sys_reg(3, 4, 12, 8, x)
  318. #define SYS_ICH_AP0R0_EL2 __SYS__AP0Rx_EL2(0)
  319. #define SYS_ICH_AP0R1_EL2 __SYS__AP0Rx_EL2(1)
  320. #define SYS_ICH_AP0R2_EL2 __SYS__AP0Rx_EL2(2)
  321. #define SYS_ICH_AP0R3_EL2 __SYS__AP0Rx_EL2(3)
  322. #define __SYS__AP1Rx_EL2(x) sys_reg(3, 4, 12, 9, x)
  323. #define SYS_ICH_AP1R0_EL2 __SYS__AP1Rx_EL2(0)
  324. #define SYS_ICH_AP1R1_EL2 __SYS__AP1Rx_EL2(1)
  325. #define SYS_ICH_AP1R2_EL2 __SYS__AP1Rx_EL2(2)
  326. #define SYS_ICH_AP1R3_EL2 __SYS__AP1Rx_EL2(3)
  327. #define SYS_ICH_VSEIR_EL2 sys_reg(3, 4, 12, 9, 4)
  328. #define SYS_ICC_SRE_EL2 sys_reg(3, 4, 12, 9, 5)
  329. #define SYS_ICH_HCR_EL2 sys_reg(3, 4, 12, 11, 0)
  330. #define SYS_ICH_VTR_EL2 sys_reg(3, 4, 12, 11, 1)
  331. #define SYS_ICH_MISR_EL2 sys_reg(3, 4, 12, 11, 2)
  332. #define SYS_ICH_EISR_EL2 sys_reg(3, 4, 12, 11, 3)
  333. #define SYS_ICH_ELSR_EL2 sys_reg(3, 4, 12, 11, 5)
  334. #define SYS_ICH_VMCR_EL2 sys_reg(3, 4, 12, 11, 7)
  335. #define __SYS__LR0_EL2(x) sys_reg(3, 4, 12, 12, x)
  336. #define SYS_ICH_LR0_EL2 __SYS__LR0_EL2(0)
  337. #define SYS_ICH_LR1_EL2 __SYS__LR0_EL2(1)
  338. #define SYS_ICH_LR2_EL2 __SYS__LR0_EL2(2)
  339. #define SYS_ICH_LR3_EL2 __SYS__LR0_EL2(3)
  340. #define SYS_ICH_LR4_EL2 __SYS__LR0_EL2(4)
  341. #define SYS_ICH_LR5_EL2 __SYS__LR0_EL2(5)
  342. #define SYS_ICH_LR6_EL2 __SYS__LR0_EL2(6)
  343. #define SYS_ICH_LR7_EL2 __SYS__LR0_EL2(7)
  344. #define __SYS__LR8_EL2(x) sys_reg(3, 4, 12, 13, x)
  345. #define SYS_ICH_LR8_EL2 __SYS__LR8_EL2(0)
  346. #define SYS_ICH_LR9_EL2 __SYS__LR8_EL2(1)
  347. #define SYS_ICH_LR10_EL2 __SYS__LR8_EL2(2)
  348. #define SYS_ICH_LR11_EL2 __SYS__LR8_EL2(3)
  349. #define SYS_ICH_LR12_EL2 __SYS__LR8_EL2(4)
  350. #define SYS_ICH_LR13_EL2 __SYS__LR8_EL2(5)
  351. #define SYS_ICH_LR14_EL2 __SYS__LR8_EL2(6)
  352. #define SYS_ICH_LR15_EL2 __SYS__LR8_EL2(7)
  353. /* Common SCTLR_ELx flags. */
  354. #define SCTLR_ELx_DSSBS (1UL << 44)
  355. #define SCTLR_ELx_EE (1 << 25)
  356. #define SCTLR_ELx_IESB (1 << 21)
  357. #define SCTLR_ELx_WXN (1 << 19)
  358. #define SCTLR_ELx_I (1 << 12)
  359. #define SCTLR_ELx_SA (1 << 3)
  360. #define SCTLR_ELx_C (1 << 2)
  361. #define SCTLR_ELx_A (1 << 1)
  362. #define SCTLR_ELx_M 1
  363. #define SCTLR_ELx_FLAGS (SCTLR_ELx_M | SCTLR_ELx_A | SCTLR_ELx_C | \
  364. SCTLR_ELx_SA | SCTLR_ELx_I | SCTLR_ELx_IESB)
  365. /* SCTLR_EL2 specific flags. */
  366. #define SCTLR_EL2_RES1 ((1 << 4) | (1 << 5) | (1 << 11) | (1 << 16) | \
  367. (1 << 18) | (1 << 22) | (1 << 23) | (1 << 28) | \
  368. (1 << 29))
  369. #define SCTLR_EL2_RES0 ((1 << 6) | (1 << 7) | (1 << 8) | (1 << 9) | \
  370. (1 << 10) | (1 << 13) | (1 << 14) | (1 << 15) | \
  371. (1 << 17) | (1 << 20) | (1 << 24) | (1 << 26) | \
  372. (1 << 27) | (1 << 30) | (1 << 31) | \
  373. (0xffffefffUL << 32))
  374. #ifdef CONFIG_CPU_BIG_ENDIAN
  375. #define ENDIAN_SET_EL2 SCTLR_ELx_EE
  376. #define ENDIAN_CLEAR_EL2 0
  377. #else
  378. #define ENDIAN_SET_EL2 0
  379. #define ENDIAN_CLEAR_EL2 SCTLR_ELx_EE
  380. #endif
  381. /* SCTLR_EL2 value used for the hyp-stub */
  382. #define SCTLR_EL2_SET (SCTLR_ELx_IESB | ENDIAN_SET_EL2 | SCTLR_EL2_RES1)
  383. #define SCTLR_EL2_CLEAR (SCTLR_ELx_M | SCTLR_ELx_A | SCTLR_ELx_C | \
  384. SCTLR_ELx_SA | SCTLR_ELx_I | SCTLR_ELx_WXN | \
  385. SCTLR_ELx_DSSBS | ENDIAN_CLEAR_EL2 | SCTLR_EL2_RES0)
  386. #if (SCTLR_EL2_SET ^ SCTLR_EL2_CLEAR) != 0xffffffffffffffff
  387. #error "Inconsistent SCTLR_EL2 set/clear bits"
  388. #endif
  389. /* SCTLR_EL1 specific flags. */
  390. #define SCTLR_EL1_UCI (1 << 26)
  391. #define SCTLR_EL1_E0E (1 << 24)
  392. #define SCTLR_EL1_SPAN (1 << 23)
  393. #define SCTLR_EL1_NTWE (1 << 18)
  394. #define SCTLR_EL1_NTWI (1 << 16)
  395. #define SCTLR_EL1_UCT (1 << 15)
  396. #define SCTLR_EL1_DZE (1 << 14)
  397. #define SCTLR_EL1_UMA (1 << 9)
  398. #define SCTLR_EL1_SED (1 << 8)
  399. #define SCTLR_EL1_ITD (1 << 7)
  400. #define SCTLR_EL1_CP15BEN (1 << 5)
  401. #define SCTLR_EL1_SA0 (1 << 4)
  402. #define SCTLR_EL1_RES1 ((1 << 11) | (1 << 20) | (1 << 22) | (1 << 28) | \
  403. (1 << 29))
  404. #define SCTLR_EL1_RES0 ((1 << 6) | (1 << 10) | (1 << 13) | (1 << 17) | \
  405. (1 << 27) | (1 << 30) | (1 << 31) | \
  406. (0xffffefffUL << 32))
  407. #ifdef CONFIG_CPU_BIG_ENDIAN
  408. #define ENDIAN_SET_EL1 (SCTLR_EL1_E0E | SCTLR_ELx_EE)
  409. #define ENDIAN_CLEAR_EL1 0
  410. #else
  411. #define ENDIAN_SET_EL1 0
  412. #define ENDIAN_CLEAR_EL1 (SCTLR_EL1_E0E | SCTLR_ELx_EE)
  413. #endif
  414. #define SCTLR_EL1_SET (SCTLR_ELx_M | SCTLR_ELx_C | SCTLR_ELx_SA |\
  415. SCTLR_EL1_SA0 | SCTLR_EL1_SED | SCTLR_ELx_I |\
  416. SCTLR_EL1_DZE | SCTLR_EL1_UCT | SCTLR_EL1_NTWI |\
  417. SCTLR_EL1_NTWE | SCTLR_ELx_IESB | SCTLR_EL1_SPAN |\
  418. ENDIAN_SET_EL1 | SCTLR_EL1_UCI | SCTLR_EL1_RES1)
  419. #define SCTLR_EL1_CLEAR (SCTLR_ELx_A | SCTLR_EL1_CP15BEN | SCTLR_EL1_ITD |\
  420. SCTLR_EL1_UMA | SCTLR_ELx_WXN | ENDIAN_CLEAR_EL1 |\
  421. SCTLR_ELx_DSSBS | SCTLR_EL1_RES0)
  422. #if (SCTLR_EL1_SET ^ SCTLR_EL1_CLEAR) != 0xffffffffffffffff
  423. #error "Inconsistent SCTLR_EL1 set/clear bits"
  424. #endif
  425. /* id_aa64isar0 */
  426. #define ID_AA64ISAR0_TS_SHIFT 52
  427. #define ID_AA64ISAR0_FHM_SHIFT 48
  428. #define ID_AA64ISAR0_DP_SHIFT 44
  429. #define ID_AA64ISAR0_SM4_SHIFT 40
  430. #define ID_AA64ISAR0_SM3_SHIFT 36
  431. #define ID_AA64ISAR0_SHA3_SHIFT 32
  432. #define ID_AA64ISAR0_RDM_SHIFT 28
  433. #define ID_AA64ISAR0_ATOMICS_SHIFT 20
  434. #define ID_AA64ISAR0_CRC32_SHIFT 16
  435. #define ID_AA64ISAR0_SHA2_SHIFT 12
  436. #define ID_AA64ISAR0_SHA1_SHIFT 8
  437. #define ID_AA64ISAR0_AES_SHIFT 4
  438. /* id_aa64isar1 */
  439. #define ID_AA64ISAR1_LRCPC_SHIFT 20
  440. #define ID_AA64ISAR1_FCMA_SHIFT 16
  441. #define ID_AA64ISAR1_JSCVT_SHIFT 12
  442. #define ID_AA64ISAR1_DPB_SHIFT 0
  443. /* id_aa64pfr0 */
  444. #define ID_AA64PFR0_CSV3_SHIFT 60
  445. #define ID_AA64PFR0_CSV2_SHIFT 56
  446. #define ID_AA64PFR0_DIT_SHIFT 48
  447. #define ID_AA64PFR0_SVE_SHIFT 32
  448. #define ID_AA64PFR0_RAS_SHIFT 28
  449. #define ID_AA64PFR0_GIC_SHIFT 24
  450. #define ID_AA64PFR0_ASIMD_SHIFT 20
  451. #define ID_AA64PFR0_FP_SHIFT 16
  452. #define ID_AA64PFR0_EL3_SHIFT 12
  453. #define ID_AA64PFR0_EL2_SHIFT 8
  454. #define ID_AA64PFR0_EL1_SHIFT 4
  455. #define ID_AA64PFR0_EL0_SHIFT 0
  456. #define ID_AA64PFR0_SVE 0x1
  457. #define ID_AA64PFR0_RAS_V1 0x1
  458. #define ID_AA64PFR0_FP_NI 0xf
  459. #define ID_AA64PFR0_FP_SUPPORTED 0x0
  460. #define ID_AA64PFR0_ASIMD_NI 0xf
  461. #define ID_AA64PFR0_ASIMD_SUPPORTED 0x0
  462. #define ID_AA64PFR0_EL1_64BIT_ONLY 0x1
  463. #define ID_AA64PFR0_EL0_64BIT_ONLY 0x1
  464. #define ID_AA64PFR0_EL0_32BIT_64BIT 0x2
  465. /* id_aa64pfr1 */
  466. #define ID_AA64PFR1_SSBS_SHIFT 4
  467. #define ID_AA64PFR1_SSBS_PSTATE_NI 0
  468. #define ID_AA64PFR1_SSBS_PSTATE_ONLY 1
  469. #define ID_AA64PFR1_SSBS_PSTATE_INSNS 2
  470. /* id_aa64mmfr0 */
  471. #define ID_AA64MMFR0_TGRAN4_SHIFT 28
  472. #define ID_AA64MMFR0_TGRAN64_SHIFT 24
  473. #define ID_AA64MMFR0_TGRAN16_SHIFT 20
  474. #define ID_AA64MMFR0_BIGENDEL0_SHIFT 16
  475. #define ID_AA64MMFR0_SNSMEM_SHIFT 12
  476. #define ID_AA64MMFR0_BIGENDEL_SHIFT 8
  477. #define ID_AA64MMFR0_ASID_SHIFT 4
  478. #define ID_AA64MMFR0_PARANGE_SHIFT 0
  479. #define ID_AA64MMFR0_TGRAN4_NI 0xf
  480. #define ID_AA64MMFR0_TGRAN4_SUPPORTED 0x0
  481. #define ID_AA64MMFR0_TGRAN64_NI 0xf
  482. #define ID_AA64MMFR0_TGRAN64_SUPPORTED 0x0
  483. #define ID_AA64MMFR0_TGRAN16_NI 0x0
  484. #define ID_AA64MMFR0_TGRAN16_SUPPORTED 0x1
  485. #define ID_AA64MMFR0_PARANGE_48 0x5
  486. #define ID_AA64MMFR0_PARANGE_52 0x6
  487. #ifdef CONFIG_ARM64_PA_BITS_52
  488. #define ID_AA64MMFR0_PARANGE_MAX ID_AA64MMFR0_PARANGE_52
  489. #else
  490. #define ID_AA64MMFR0_PARANGE_MAX ID_AA64MMFR0_PARANGE_48
  491. #endif
  492. /* id_aa64mmfr1 */
  493. #define ID_AA64MMFR1_PAN_SHIFT 20
  494. #define ID_AA64MMFR1_LOR_SHIFT 16
  495. #define ID_AA64MMFR1_HPD_SHIFT 12
  496. #define ID_AA64MMFR1_VHE_SHIFT 8
  497. #define ID_AA64MMFR1_VMIDBITS_SHIFT 4
  498. #define ID_AA64MMFR1_HADBS_SHIFT 0
  499. #define ID_AA64MMFR1_VMIDBITS_8 0
  500. #define ID_AA64MMFR1_VMIDBITS_16 2
  501. /* id_aa64mmfr2 */
  502. #define ID_AA64MMFR2_FWB_SHIFT 40
  503. #define ID_AA64MMFR2_AT_SHIFT 32
  504. #define ID_AA64MMFR2_LVA_SHIFT 16
  505. #define ID_AA64MMFR2_IESB_SHIFT 12
  506. #define ID_AA64MMFR2_LSM_SHIFT 8
  507. #define ID_AA64MMFR2_UAO_SHIFT 4
  508. #define ID_AA64MMFR2_CNP_SHIFT 0
  509. /* id_aa64dfr0 */
  510. #define ID_AA64DFR0_PMSVER_SHIFT 32
  511. #define ID_AA64DFR0_CTX_CMPS_SHIFT 28
  512. #define ID_AA64DFR0_WRPS_SHIFT 20
  513. #define ID_AA64DFR0_BRPS_SHIFT 12
  514. #define ID_AA64DFR0_PMUVER_SHIFT 8
  515. #define ID_AA64DFR0_TRACEVER_SHIFT 4
  516. #define ID_AA64DFR0_DEBUGVER_SHIFT 0
  517. #define ID_ISAR5_RDM_SHIFT 24
  518. #define ID_ISAR5_CRC32_SHIFT 16
  519. #define ID_ISAR5_SHA2_SHIFT 12
  520. #define ID_ISAR5_SHA1_SHIFT 8
  521. #define ID_ISAR5_AES_SHIFT 4
  522. #define ID_ISAR5_SEVL_SHIFT 0
  523. #define MVFR0_FPROUND_SHIFT 28
  524. #define MVFR0_FPSHVEC_SHIFT 24
  525. #define MVFR0_FPSQRT_SHIFT 20
  526. #define MVFR0_FPDIVIDE_SHIFT 16
  527. #define MVFR0_FPTRAP_SHIFT 12
  528. #define MVFR0_FPDP_SHIFT 8
  529. #define MVFR0_FPSP_SHIFT 4
  530. #define MVFR0_SIMD_SHIFT 0
  531. #define MVFR1_SIMDFMAC_SHIFT 28
  532. #define MVFR1_FPHP_SHIFT 24
  533. #define MVFR1_SIMDHP_SHIFT 20
  534. #define MVFR1_SIMDSP_SHIFT 16
  535. #define MVFR1_SIMDINT_SHIFT 12
  536. #define MVFR1_SIMDLS_SHIFT 8
  537. #define MVFR1_FPDNAN_SHIFT 4
  538. #define MVFR1_FPFTZ_SHIFT 0
  539. #define ID_AA64MMFR0_TGRAN4_SHIFT 28
  540. #define ID_AA64MMFR0_TGRAN64_SHIFT 24
  541. #define ID_AA64MMFR0_TGRAN16_SHIFT 20
  542. #define ID_AA64MMFR0_TGRAN4_NI 0xf
  543. #define ID_AA64MMFR0_TGRAN4_SUPPORTED 0x0
  544. #define ID_AA64MMFR0_TGRAN64_NI 0xf
  545. #define ID_AA64MMFR0_TGRAN64_SUPPORTED 0x0
  546. #define ID_AA64MMFR0_TGRAN16_NI 0x0
  547. #define ID_AA64MMFR0_TGRAN16_SUPPORTED 0x1
  548. #if defined(CONFIG_ARM64_4K_PAGES)
  549. #define ID_AA64MMFR0_TGRAN_SHIFT ID_AA64MMFR0_TGRAN4_SHIFT
  550. #define ID_AA64MMFR0_TGRAN_SUPPORTED ID_AA64MMFR0_TGRAN4_SUPPORTED
  551. #elif defined(CONFIG_ARM64_16K_PAGES)
  552. #define ID_AA64MMFR0_TGRAN_SHIFT ID_AA64MMFR0_TGRAN16_SHIFT
  553. #define ID_AA64MMFR0_TGRAN_SUPPORTED ID_AA64MMFR0_TGRAN16_SUPPORTED
  554. #elif defined(CONFIG_ARM64_64K_PAGES)
  555. #define ID_AA64MMFR0_TGRAN_SHIFT ID_AA64MMFR0_TGRAN64_SHIFT
  556. #define ID_AA64MMFR0_TGRAN_SUPPORTED ID_AA64MMFR0_TGRAN64_SUPPORTED
  557. #endif
  558. /*
  559. * The ZCR_ELx_LEN_* definitions intentionally include bits [8:4] which
  560. * are reserved by the SVE architecture for future expansion of the LEN
  561. * field, with compatible semantics.
  562. */
  563. #define ZCR_ELx_LEN_SHIFT 0
  564. #define ZCR_ELx_LEN_SIZE 9
  565. #define ZCR_ELx_LEN_MASK 0x1ff
  566. #define CPACR_EL1_ZEN_EL1EN (1 << 16) /* enable EL1 access */
  567. #define CPACR_EL1_ZEN_EL0EN (1 << 17) /* enable EL0 access, if EL1EN set */
  568. #define CPACR_EL1_ZEN (CPACR_EL1_ZEN_EL1EN | CPACR_EL1_ZEN_EL0EN)
  569. /* Safe value for MPIDR_EL1: Bit31:RES1, Bit30:U:0, Bit24:MT:0 */
  570. #define SYS_MPIDR_SAFE_VAL (1UL << 31)
  571. #ifdef __ASSEMBLY__
  572. .irp num,0,1,2,3,4,5,6,7,8,9,10,11,12,13,14,15,16,17,18,19,20,21,22,23,24,25,26,27,28,29,30
  573. .equ .L__reg_num_x\num, \num
  574. .endr
  575. .equ .L__reg_num_xzr, 31
  576. .macro mrs_s, rt, sreg
  577. __emit_inst(0xd5200000|(\sreg)|(.L__reg_num_\rt))
  578. .endm
  579. .macro msr_s, sreg, rt
  580. __emit_inst(0xd5000000|(\sreg)|(.L__reg_num_\rt))
  581. .endm
  582. #else
  583. #include <linux/build_bug.h>
  584. #include <linux/types.h>
  585. asm(
  586. " .irp num,0,1,2,3,4,5,6,7,8,9,10,11,12,13,14,15,16,17,18,19,20,21,22,23,24,25,26,27,28,29,30\n"
  587. " .equ .L__reg_num_x\\num, \\num\n"
  588. " .endr\n"
  589. " .equ .L__reg_num_xzr, 31\n"
  590. "\n"
  591. " .macro mrs_s, rt, sreg\n"
  592. __emit_inst(0xd5200000|(\\sreg)|(.L__reg_num_\\rt))
  593. " .endm\n"
  594. "\n"
  595. " .macro msr_s, sreg, rt\n"
  596. __emit_inst(0xd5000000|(\\sreg)|(.L__reg_num_\\rt))
  597. " .endm\n"
  598. );
  599. /*
  600. * Unlike read_cpuid, calls to read_sysreg are never expected to be
  601. * optimized away or replaced with synthetic values.
  602. */
  603. #define read_sysreg(r) ({ \
  604. u64 __val; \
  605. asm volatile("mrs %0, " __stringify(r) : "=r" (__val)); \
  606. __val; \
  607. })
  608. /*
  609. * The "Z" constraint normally means a zero immediate, but when combined with
  610. * the "%x0" template means XZR.
  611. */
  612. #define write_sysreg(v, r) do { \
  613. u64 __val = (u64)(v); \
  614. asm volatile("msr " __stringify(r) ", %x0" \
  615. : : "rZ" (__val)); \
  616. } while (0)
  617. /*
  618. * For registers without architectural names, or simply unsupported by
  619. * GAS.
  620. */
  621. #define read_sysreg_s(r) ({ \
  622. u64 __val; \
  623. asm volatile("mrs_s %0, " __stringify(r) : "=r" (__val)); \
  624. __val; \
  625. })
  626. #define write_sysreg_s(v, r) do { \
  627. u64 __val = (u64)(v); \
  628. asm volatile("msr_s " __stringify(r) ", %x0" : : "rZ" (__val)); \
  629. } while (0)
  630. /*
  631. * Modify bits in a sysreg. Bits in the clear mask are zeroed, then bits in the
  632. * set mask are set. Other bits are left as-is.
  633. */
  634. #define sysreg_clear_set(sysreg, clear, set) do { \
  635. u64 __scs_val = read_sysreg(sysreg); \
  636. u64 __scs_new = (__scs_val & ~(u64)(clear)) | (set); \
  637. if (__scs_new != __scs_val) \
  638. write_sysreg(__scs_new, sysreg); \
  639. } while (0)
  640. #endif
  641. #endif /* __ASM_SYSREG_H */