proc-v7.S 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660
  1. /*
  2. * linux/arch/arm/mm/proc-v7.S
  3. *
  4. * Copyright (C) 2001 Deep Blue Solutions Ltd.
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License version 2 as
  8. * published by the Free Software Foundation.
  9. *
  10. * This is the "shell" of the ARMv7 processor support.
  11. */
  12. #include <linux/init.h>
  13. #include <linux/linkage.h>
  14. #include <asm/assembler.h>
  15. #include <asm/asm-offsets.h>
  16. #include <asm/hwcap.h>
  17. #include <asm/pgtable-hwdef.h>
  18. #include <asm/pgtable.h>
  19. #include "proc-macros.S"
  20. #ifdef CONFIG_ARM_LPAE
  21. #include "proc-v7-3level.S"
  22. #else
  23. #include "proc-v7-2level.S"
  24. #endif
  25. ENTRY(cpu_v7_proc_init)
  26. ret lr
  27. ENDPROC(cpu_v7_proc_init)
  28. ENTRY(cpu_v7_proc_fin)
  29. mrc p15, 0, r0, c1, c0, 0 @ ctrl register
  30. bic r0, r0, #0x1000 @ ...i............
  31. bic r0, r0, #0x0006 @ .............ca.
  32. mcr p15, 0, r0, c1, c0, 0 @ disable caches
  33. ret lr
  34. ENDPROC(cpu_v7_proc_fin)
  35. /*
  36. * cpu_v7_reset(loc)
  37. *
  38. * Perform a soft reset of the system. Put the CPU into the
  39. * same state as it would be if it had been reset, and branch
  40. * to what would be the reset vector.
  41. *
  42. * - loc - location to jump to for soft reset
  43. *
  44. * This code must be executed using a flat identity mapping with
  45. * caches disabled.
  46. */
  47. .align 5
  48. .pushsection .idmap.text, "ax"
  49. ENTRY(cpu_v7_reset)
  50. mrc p15, 0, r1, c1, c0, 0 @ ctrl register
  51. bic r1, r1, #0x1 @ ...............m
  52. THUMB( bic r1, r1, #1 << 30 ) @ SCTLR.TE (Thumb exceptions)
  53. mcr p15, 0, r1, c1, c0, 0 @ disable MMU
  54. isb
  55. bx r0
  56. ENDPROC(cpu_v7_reset)
  57. .popsection
  58. /*
  59. * cpu_v7_do_idle()
  60. *
  61. * Idle the processor (eg, wait for interrupt).
  62. *
  63. * IRQs are already disabled.
  64. */
  65. ENTRY(cpu_v7_do_idle)
  66. dsb @ WFI may enter a low-power mode
  67. wfi
  68. ret lr
  69. ENDPROC(cpu_v7_do_idle)
  70. ENTRY(cpu_v7_dcache_clean_area)
  71. ALT_SMP(W(nop)) @ MP extensions imply L1 PTW
  72. ALT_UP_B(1f)
  73. ret lr
  74. 1: dcache_line_size r2, r3
  75. 2: mcr p15, 0, r0, c7, c10, 1 @ clean D entry
  76. add r0, r0, r2
  77. subs r1, r1, r2
  78. bhi 2b
  79. dsb ishst
  80. ret lr
  81. ENDPROC(cpu_v7_dcache_clean_area)
  82. string cpu_v7_name, "ARMv7 Processor"
  83. .align
  84. /* Suspend/resume support: derived from arch/arm/mach-s5pv210/sleep.S */
  85. .globl cpu_v7_suspend_size
  86. .equ cpu_v7_suspend_size, 4 * 9
  87. #ifdef CONFIG_ARM_CPU_SUSPEND
  88. ENTRY(cpu_v7_do_suspend)
  89. stmfd sp!, {r4 - r10, lr}
  90. mrc p15, 0, r4, c13, c0, 0 @ FCSE/PID
  91. mrc p15, 0, r5, c13, c0, 3 @ User r/o thread ID
  92. stmia r0!, {r4 - r5}
  93. #ifdef CONFIG_MMU
  94. mrc p15, 0, r6, c3, c0, 0 @ Domain ID
  95. #ifdef CONFIG_ARM_LPAE
  96. mrrc p15, 1, r5, r7, c2 @ TTB 1
  97. #else
  98. mrc p15, 0, r7, c2, c0, 1 @ TTB 1
  99. #endif
  100. mrc p15, 0, r11, c2, c0, 2 @ TTB control register
  101. #endif
  102. mrc p15, 0, r8, c1, c0, 0 @ Control register
  103. mrc p15, 0, r9, c1, c0, 1 @ Auxiliary control register
  104. mrc p15, 0, r10, c1, c0, 2 @ Co-processor access control
  105. stmia r0, {r5 - r11}
  106. ldmfd sp!, {r4 - r10, pc}
  107. ENDPROC(cpu_v7_do_suspend)
  108. ENTRY(cpu_v7_do_resume)
  109. mov ip, #0
  110. mcr p15, 0, ip, c7, c5, 0 @ invalidate I cache
  111. mcr p15, 0, ip, c13, c0, 1 @ set reserved context ID
  112. ldmia r0!, {r4 - r5}
  113. mcr p15, 0, r4, c13, c0, 0 @ FCSE/PID
  114. mcr p15, 0, r5, c13, c0, 3 @ User r/o thread ID
  115. ldmia r0, {r5 - r11}
  116. #ifdef CONFIG_MMU
  117. mcr p15, 0, ip, c8, c7, 0 @ invalidate TLBs
  118. mcr p15, 0, r6, c3, c0, 0 @ Domain ID
  119. #ifdef CONFIG_ARM_LPAE
  120. mcrr p15, 0, r1, ip, c2 @ TTB 0
  121. mcrr p15, 1, r5, r7, c2 @ TTB 1
  122. #else
  123. ALT_SMP(orr r1, r1, #TTB_FLAGS_SMP)
  124. ALT_UP(orr r1, r1, #TTB_FLAGS_UP)
  125. mcr p15, 0, r1, c2, c0, 0 @ TTB 0
  126. mcr p15, 0, r7, c2, c0, 1 @ TTB 1
  127. #endif
  128. mcr p15, 0, r11, c2, c0, 2 @ TTB control register
  129. ldr r4, =PRRR @ PRRR
  130. ldr r5, =NMRR @ NMRR
  131. mcr p15, 0, r4, c10, c2, 0 @ write PRRR
  132. mcr p15, 0, r5, c10, c2, 1 @ write NMRR
  133. #endif /* CONFIG_MMU */
  134. mrc p15, 0, r4, c1, c0, 1 @ Read Auxiliary control register
  135. teq r4, r9 @ Is it already set?
  136. mcrne p15, 0, r9, c1, c0, 1 @ No, so write it
  137. mcr p15, 0, r10, c1, c0, 2 @ Co-processor access control
  138. isb
  139. dsb
  140. mov r0, r8 @ control register
  141. b cpu_resume_mmu
  142. ENDPROC(cpu_v7_do_resume)
  143. #endif
  144. /*
  145. * Cortex-A8
  146. */
  147. globl_equ cpu_ca8_proc_init, cpu_v7_proc_init
  148. globl_equ cpu_ca8_proc_fin, cpu_v7_proc_fin
  149. globl_equ cpu_ca8_reset, cpu_v7_reset
  150. globl_equ cpu_ca8_do_idle, cpu_v7_do_idle
  151. globl_equ cpu_ca8_dcache_clean_area, cpu_v7_dcache_clean_area
  152. globl_equ cpu_ca8_set_pte_ext, cpu_v7_set_pte_ext
  153. globl_equ cpu_ca8_suspend_size, cpu_v7_suspend_size
  154. #ifdef CONFIG_ARM_CPU_SUSPEND
  155. globl_equ cpu_ca8_do_suspend, cpu_v7_do_suspend
  156. globl_equ cpu_ca8_do_resume, cpu_v7_do_resume
  157. #endif
  158. /*
  159. * Cortex-A9 processor functions
  160. */
  161. globl_equ cpu_ca9mp_proc_init, cpu_v7_proc_init
  162. globl_equ cpu_ca9mp_proc_fin, cpu_v7_proc_fin
  163. globl_equ cpu_ca9mp_reset, cpu_v7_reset
  164. globl_equ cpu_ca9mp_do_idle, cpu_v7_do_idle
  165. globl_equ cpu_ca9mp_dcache_clean_area, cpu_v7_dcache_clean_area
  166. globl_equ cpu_ca9mp_switch_mm, cpu_v7_switch_mm
  167. globl_equ cpu_ca9mp_set_pte_ext, cpu_v7_set_pte_ext
  168. .globl cpu_ca9mp_suspend_size
  169. .equ cpu_ca9mp_suspend_size, cpu_v7_suspend_size + 4 * 2
  170. #ifdef CONFIG_ARM_CPU_SUSPEND
  171. ENTRY(cpu_ca9mp_do_suspend)
  172. stmfd sp!, {r4 - r5}
  173. mrc p15, 0, r4, c15, c0, 1 @ Diagnostic register
  174. mrc p15, 0, r5, c15, c0, 0 @ Power register
  175. stmia r0!, {r4 - r5}
  176. ldmfd sp!, {r4 - r5}
  177. b cpu_v7_do_suspend
  178. ENDPROC(cpu_ca9mp_do_suspend)
  179. ENTRY(cpu_ca9mp_do_resume)
  180. ldmia r0!, {r4 - r5}
  181. mrc p15, 0, r10, c15, c0, 1 @ Read Diagnostic register
  182. teq r4, r10 @ Already restored?
  183. mcrne p15, 0, r4, c15, c0, 1 @ No, so restore it
  184. mrc p15, 0, r10, c15, c0, 0 @ Read Power register
  185. teq r5, r10 @ Already restored?
  186. mcrne p15, 0, r5, c15, c0, 0 @ No, so restore it
  187. b cpu_v7_do_resume
  188. ENDPROC(cpu_ca9mp_do_resume)
  189. #endif
  190. #ifdef CONFIG_CPU_PJ4B
  191. globl_equ cpu_pj4b_switch_mm, cpu_v7_switch_mm
  192. globl_equ cpu_pj4b_set_pte_ext, cpu_v7_set_pte_ext
  193. globl_equ cpu_pj4b_proc_init, cpu_v7_proc_init
  194. globl_equ cpu_pj4b_proc_fin, cpu_v7_proc_fin
  195. globl_equ cpu_pj4b_reset, cpu_v7_reset
  196. #ifdef CONFIG_PJ4B_ERRATA_4742
  197. ENTRY(cpu_pj4b_do_idle)
  198. dsb @ WFI may enter a low-power mode
  199. wfi
  200. dsb @barrier
  201. ret lr
  202. ENDPROC(cpu_pj4b_do_idle)
  203. #else
  204. globl_equ cpu_pj4b_do_idle, cpu_v7_do_idle
  205. #endif
  206. globl_equ cpu_pj4b_dcache_clean_area, cpu_v7_dcache_clean_area
  207. #ifdef CONFIG_ARM_CPU_SUSPEND
  208. ENTRY(cpu_pj4b_do_suspend)
  209. stmfd sp!, {r6 - r10}
  210. mrc p15, 1, r6, c15, c1, 0 @ save CP15 - extra features
  211. mrc p15, 1, r7, c15, c2, 0 @ save CP15 - Aux Func Modes Ctrl 0
  212. mrc p15, 1, r8, c15, c1, 2 @ save CP15 - Aux Debug Modes Ctrl 2
  213. mrc p15, 1, r9, c15, c1, 1 @ save CP15 - Aux Debug Modes Ctrl 1
  214. mrc p15, 0, r10, c9, c14, 0 @ save CP15 - PMC
  215. stmia r0!, {r6 - r10}
  216. ldmfd sp!, {r6 - r10}
  217. b cpu_v7_do_suspend
  218. ENDPROC(cpu_pj4b_do_suspend)
  219. ENTRY(cpu_pj4b_do_resume)
  220. ldmia r0!, {r6 - r10}
  221. mcr p15, 1, r6, c15, c1, 0 @ restore CP15 - extra features
  222. mcr p15, 1, r7, c15, c2, 0 @ restore CP15 - Aux Func Modes Ctrl 0
  223. mcr p15, 1, r8, c15, c1, 2 @ restore CP15 - Aux Debug Modes Ctrl 2
  224. mcr p15, 1, r9, c15, c1, 1 @ restore CP15 - Aux Debug Modes Ctrl 1
  225. mcr p15, 0, r10, c9, c14, 0 @ restore CP15 - PMC
  226. b cpu_v7_do_resume
  227. ENDPROC(cpu_pj4b_do_resume)
  228. #endif
  229. .globl cpu_pj4b_suspend_size
  230. .equ cpu_pj4b_suspend_size, cpu_v7_suspend_size + 4 * 5
  231. #endif
  232. /*
  233. * __v7_setup
  234. *
  235. * Initialise TLB, Caches, and MMU state ready to switch the MMU
  236. * on. Return in r0 the new CP15 C1 control register setting.
  237. *
  238. * r1, r2, r4, r5, r9, r13 must be preserved - r13 is not a stack
  239. * r4: TTBR0 (low word)
  240. * r5: TTBR0 (high word if LPAE)
  241. * r8: TTBR1
  242. * r9: Main ID register
  243. *
  244. * This should be able to cover all ARMv7 cores.
  245. *
  246. * It is assumed that:
  247. * - cache type register is implemented
  248. */
  249. __v7_ca5mp_setup:
  250. __v7_ca9mp_setup:
  251. __v7_cr7mp_setup:
  252. mov r10, #(1 << 0) @ Cache/TLB ops broadcasting
  253. b 1f
  254. __v7_ca7mp_setup:
  255. __v7_ca12mp_setup:
  256. __v7_ca15mp_setup:
  257. __v7_b15mp_setup:
  258. __v7_ca17mp_setup:
  259. mov r10, #0
  260. 1: adr r12, __v7_setup_stack @ the local stack
  261. stmia r12, {r0-r5, lr} @ v7_invalidate_l1 touches r0-r6
  262. bl v7_invalidate_l1
  263. ldmia r12, {r0-r5, lr}
  264. #ifdef CONFIG_SMP
  265. ALT_SMP(mrc p15, 0, r0, c1, c0, 1)
  266. ALT_UP(mov r0, #(1 << 6)) @ fake it for UP
  267. tst r0, #(1 << 6) @ SMP/nAMP mode enabled?
  268. orreq r0, r0, #(1 << 6) @ Enable SMP/nAMP mode
  269. orreq r0, r0, r10 @ Enable CPU-specific SMP bits
  270. mcreq p15, 0, r0, c1, c0, 1
  271. #endif
  272. b __v7_setup_cont
  273. /*
  274. * Errata:
  275. * r0, r10 available for use
  276. * r1, r2, r4, r5, r9, r13: must be preserved
  277. * r3: contains MIDR rX number in bits 23-20
  278. * r6: contains MIDR rXpY as 8-bit XY number
  279. * r9: MIDR
  280. */
  281. __ca8_errata:
  282. #if defined(CONFIG_ARM_ERRATA_430973) && !defined(CONFIG_ARCH_MULTIPLATFORM)
  283. teq r3, #0x00100000 @ only present in r1p*
  284. mrceq p15, 0, r0, c1, c0, 1 @ read aux control register
  285. orreq r0, r0, #(1 << 6) @ set IBE to 1
  286. mcreq p15, 0, r0, c1, c0, 1 @ write aux control register
  287. #endif
  288. #ifdef CONFIG_ARM_ERRATA_458693
  289. teq r6, #0x20 @ only present in r2p0
  290. mrceq p15, 0, r0, c1, c0, 1 @ read aux control register
  291. orreq r0, r0, #(1 << 5) @ set L1NEON to 1
  292. orreq r0, r0, #(1 << 9) @ set PLDNOP to 1
  293. mcreq p15, 0, r0, c1, c0, 1 @ write aux control register
  294. #endif
  295. #ifdef CONFIG_ARM_ERRATA_460075
  296. teq r6, #0x20 @ only present in r2p0
  297. mrceq p15, 1, r0, c9, c0, 2 @ read L2 cache aux ctrl register
  298. tsteq r0, #1 << 22
  299. orreq r0, r0, #(1 << 22) @ set the Write Allocate disable bit
  300. mcreq p15, 1, r0, c9, c0, 2 @ write the L2 cache aux ctrl register
  301. #endif
  302. b __errata_finish
  303. __ca9_errata:
  304. #ifdef CONFIG_ARM_ERRATA_742230
  305. cmp r6, #0x22 @ only present up to r2p2
  306. mrcle p15, 0, r0, c15, c0, 1 @ read diagnostic register
  307. orrle r0, r0, #1 << 4 @ set bit #4
  308. mcrle p15, 0, r0, c15, c0, 1 @ write diagnostic register
  309. #endif
  310. #ifdef CONFIG_ARM_ERRATA_742231
  311. teq r6, #0x20 @ present in r2p0
  312. teqne r6, #0x21 @ present in r2p1
  313. teqne r6, #0x22 @ present in r2p2
  314. mrceq p15, 0, r0, c15, c0, 1 @ read diagnostic register
  315. orreq r0, r0, #1 << 12 @ set bit #12
  316. orreq r0, r0, #1 << 22 @ set bit #22
  317. mcreq p15, 0, r0, c15, c0, 1 @ write diagnostic register
  318. #endif
  319. #ifdef CONFIG_ARM_ERRATA_743622
  320. teq r3, #0x00200000 @ only present in r2p*
  321. mrceq p15, 0, r0, c15, c0, 1 @ read diagnostic register
  322. orreq r0, r0, #1 << 6 @ set bit #6
  323. mcreq p15, 0, r0, c15, c0, 1 @ write diagnostic register
  324. #endif
  325. #if defined(CONFIG_ARM_ERRATA_751472) && defined(CONFIG_SMP)
  326. ALT_SMP(cmp r6, #0x30) @ present prior to r3p0
  327. ALT_UP_B(1f)
  328. mrclt p15, 0, r0, c15, c0, 1 @ read diagnostic register
  329. orrlt r0, r0, #1 << 11 @ set bit #11
  330. mcrlt p15, 0, r0, c15, c0, 1 @ write diagnostic register
  331. 1:
  332. #endif
  333. b __errata_finish
  334. __ca15_errata:
  335. #ifdef CONFIG_ARM_ERRATA_773022
  336. cmp r6, #0x4 @ only present up to r0p4
  337. mrcle p15, 0, r0, c1, c0, 1 @ read aux control register
  338. orrle r0, r0, #1 << 1 @ disable loop buffer
  339. mcrle p15, 0, r0, c1, c0, 1 @ write aux control register
  340. #endif
  341. b __errata_finish
  342. __v7_pj4b_setup:
  343. #ifdef CONFIG_CPU_PJ4B
  344. /* Auxiliary Debug Modes Control 1 Register */
  345. #define PJ4B_STATIC_BP (1 << 2) /* Enable Static BP */
  346. #define PJ4B_INTER_PARITY (1 << 8) /* Disable Internal Parity Handling */
  347. #define PJ4B_CLEAN_LINE (1 << 16) /* Disable data transfer for clean line */
  348. /* Auxiliary Debug Modes Control 2 Register */
  349. #define PJ4B_FAST_LDR (1 << 23) /* Disable fast LDR */
  350. #define PJ4B_SNOOP_DATA (1 << 25) /* Do not interleave write and snoop data */
  351. #define PJ4B_CWF (1 << 27) /* Disable Critical Word First feature */
  352. #define PJ4B_OUTSDNG_NC (1 << 29) /* Disable outstanding non cacheable rqst */
  353. #define PJ4B_L1_REP_RR (1 << 30) /* L1 replacement - Strict round robin */
  354. #define PJ4B_AUX_DBG_CTRL2 (PJ4B_SNOOP_DATA | PJ4B_CWF |\
  355. PJ4B_OUTSDNG_NC | PJ4B_L1_REP_RR)
  356. /* Auxiliary Functional Modes Control Register 0 */
  357. #define PJ4B_SMP_CFB (1 << 1) /* Set SMP mode. Join the coherency fabric */
  358. #define PJ4B_L1_PAR_CHK (1 << 2) /* Support L1 parity checking */
  359. #define PJ4B_BROADCAST_CACHE (1 << 8) /* Broadcast Cache and TLB maintenance */
  360. /* Auxiliary Debug Modes Control 0 Register */
  361. #define PJ4B_WFI_WFE (1 << 22) /* WFI/WFE - serve the DVM and back to idle */
  362. /* Auxiliary Debug Modes Control 1 Register */
  363. mrc p15, 1, r0, c15, c1, 1
  364. orr r0, r0, #PJ4B_CLEAN_LINE
  365. orr r0, r0, #PJ4B_INTER_PARITY
  366. bic r0, r0, #PJ4B_STATIC_BP
  367. mcr p15, 1, r0, c15, c1, 1
  368. /* Auxiliary Debug Modes Control 2 Register */
  369. mrc p15, 1, r0, c15, c1, 2
  370. bic r0, r0, #PJ4B_FAST_LDR
  371. orr r0, r0, #PJ4B_AUX_DBG_CTRL2
  372. mcr p15, 1, r0, c15, c1, 2
  373. /* Auxiliary Functional Modes Control Register 0 */
  374. mrc p15, 1, r0, c15, c2, 0
  375. #ifdef CONFIG_SMP
  376. orr r0, r0, #PJ4B_SMP_CFB
  377. #endif
  378. orr r0, r0, #PJ4B_L1_PAR_CHK
  379. orr r0, r0, #PJ4B_BROADCAST_CACHE
  380. mcr p15, 1, r0, c15, c2, 0
  381. /* Auxiliary Debug Modes Control 0 Register */
  382. mrc p15, 1, r0, c15, c1, 0
  383. orr r0, r0, #PJ4B_WFI_WFE
  384. mcr p15, 1, r0, c15, c1, 0
  385. #endif /* CONFIG_CPU_PJ4B */
  386. __v7_setup:
  387. adr r12, __v7_setup_stack @ the local stack
  388. stmia r12, {r0-r5, lr} @ v7_invalidate_l1 touches r0-r6
  389. bl v7_invalidate_l1
  390. ldmia r12, {r0-r5, lr}
  391. __v7_setup_cont:
  392. and r0, r9, #0xff000000 @ ARM?
  393. teq r0, #0x41000000
  394. bne __errata_finish
  395. and r3, r9, #0x00f00000 @ variant
  396. and r6, r9, #0x0000000f @ revision
  397. orr r6, r6, r3, lsr #20-4 @ combine variant and revision
  398. ubfx r0, r9, #4, #12 @ primary part number
  399. /* Cortex-A8 Errata */
  400. ldr r10, =0x00000c08 @ Cortex-A8 primary part number
  401. teq r0, r10
  402. beq __ca8_errata
  403. /* Cortex-A9 Errata */
  404. ldr r10, =0x00000c09 @ Cortex-A9 primary part number
  405. teq r0, r10
  406. beq __ca9_errata
  407. /* Cortex-A15 Errata */
  408. ldr r10, =0x00000c0f @ Cortex-A15 primary part number
  409. teq r0, r10
  410. beq __ca15_errata
  411. __errata_finish:
  412. mov r10, #0
  413. mcr p15, 0, r10, c7, c5, 0 @ I+BTB cache invalidate
  414. #ifdef CONFIG_MMU
  415. mcr p15, 0, r10, c8, c7, 0 @ invalidate I + D TLBs
  416. v7_ttb_setup r10, r4, r5, r8, r3 @ TTBCR, TTBRx setup
  417. ldr r3, =PRRR @ PRRR
  418. ldr r6, =NMRR @ NMRR
  419. mcr p15, 0, r3, c10, c2, 0 @ write PRRR
  420. mcr p15, 0, r6, c10, c2, 1 @ write NMRR
  421. #endif
  422. dsb @ Complete invalidations
  423. #ifndef CONFIG_ARM_THUMBEE
  424. mrc p15, 0, r0, c0, c1, 0 @ read ID_PFR0 for ThumbEE
  425. and r0, r0, #(0xf << 12) @ ThumbEE enabled field
  426. teq r0, #(1 << 12) @ check if ThumbEE is present
  427. bne 1f
  428. mov r3, #0
  429. mcr p14, 6, r3, c1, c0, 0 @ Initialize TEEHBR to 0
  430. mrc p14, 6, r0, c0, c0, 0 @ load TEECR
  431. orr r0, r0, #1 @ set the 1st bit in order to
  432. mcr p14, 6, r0, c0, c0, 0 @ stop userspace TEEHBR access
  433. 1:
  434. #endif
  435. adr r3, v7_crval
  436. ldmia r3, {r3, r6}
  437. ARM_BE8(orr r6, r6, #1 << 25) @ big-endian page tables
  438. #ifdef CONFIG_SWP_EMULATE
  439. orr r3, r3, #(1 << 10) @ set SW bit in "clear"
  440. bic r6, r6, #(1 << 10) @ clear it in "mmuset"
  441. #endif
  442. mrc p15, 0, r0, c1, c0, 0 @ read control register
  443. bic r0, r0, r3 @ clear bits them
  444. orr r0, r0, r6 @ set them
  445. THUMB( orr r0, r0, #1 << 30 ) @ Thumb exceptions
  446. ret lr @ return to head.S:__ret
  447. ENDPROC(__v7_setup)
  448. .align 2
  449. __v7_setup_stack:
  450. .space 4 * 7 @ 12 registers
  451. __INITDATA
  452. @ define struct processor (see <asm/proc-fns.h> and proc-macros.S)
  453. define_processor_functions v7, dabort=v7_early_abort, pabort=v7_pabort, suspend=1
  454. #ifndef CONFIG_ARM_LPAE
  455. define_processor_functions ca8, dabort=v7_early_abort, pabort=v7_pabort, suspend=1
  456. define_processor_functions ca9mp, dabort=v7_early_abort, pabort=v7_pabort, suspend=1
  457. #endif
  458. #ifdef CONFIG_CPU_PJ4B
  459. define_processor_functions pj4b, dabort=v7_early_abort, pabort=v7_pabort, suspend=1
  460. #endif
  461. .section ".rodata"
  462. string cpu_arch_name, "armv7"
  463. string cpu_elf_name, "v7"
  464. .align
  465. .section ".proc.info.init", #alloc
  466. /*
  467. * Standard v7 proc info content
  468. */
  469. .macro __v7_proc name, initfunc, mm_mmuflags = 0, io_mmuflags = 0, hwcaps = 0, proc_fns = v7_processor_functions
  470. ALT_SMP(.long PMD_TYPE_SECT | PMD_SECT_AP_WRITE | PMD_SECT_AP_READ | \
  471. PMD_SECT_AF | PMD_FLAGS_SMP | \mm_mmuflags)
  472. ALT_UP(.long PMD_TYPE_SECT | PMD_SECT_AP_WRITE | PMD_SECT_AP_READ | \
  473. PMD_SECT_AF | PMD_FLAGS_UP | \mm_mmuflags)
  474. .long PMD_TYPE_SECT | PMD_SECT_AP_WRITE | \
  475. PMD_SECT_AP_READ | PMD_SECT_AF | \io_mmuflags
  476. initfn \initfunc, \name
  477. .long cpu_arch_name
  478. .long cpu_elf_name
  479. .long HWCAP_SWP | HWCAP_HALF | HWCAP_THUMB | HWCAP_FAST_MULT | \
  480. HWCAP_EDSP | HWCAP_TLS | \hwcaps
  481. .long cpu_v7_name
  482. .long \proc_fns
  483. .long v7wbi_tlb_fns
  484. .long v6_user_fns
  485. .long v7_cache_fns
  486. .endm
  487. #ifndef CONFIG_ARM_LPAE
  488. /*
  489. * ARM Ltd. Cortex A5 processor.
  490. */
  491. .type __v7_ca5mp_proc_info, #object
  492. __v7_ca5mp_proc_info:
  493. .long 0x410fc050
  494. .long 0xff0ffff0
  495. __v7_proc __v7_ca5mp_proc_info, __v7_ca5mp_setup
  496. .size __v7_ca5mp_proc_info, . - __v7_ca5mp_proc_info
  497. /*
  498. * ARM Ltd. Cortex A9 processor.
  499. */
  500. .type __v7_ca9mp_proc_info, #object
  501. __v7_ca9mp_proc_info:
  502. .long 0x410fc090
  503. .long 0xff0ffff0
  504. __v7_proc __v7_ca9mp_proc_info, __v7_ca9mp_setup, proc_fns = ca9mp_processor_functions
  505. .size __v7_ca9mp_proc_info, . - __v7_ca9mp_proc_info
  506. /*
  507. * ARM Ltd. Cortex A8 processor.
  508. */
  509. .type __v7_ca8_proc_info, #object
  510. __v7_ca8_proc_info:
  511. .long 0x410fc080
  512. .long 0xff0ffff0
  513. __v7_proc __v7_ca8_proc_info, __v7_setup, proc_fns = ca8_processor_functions
  514. .size __v7_ca8_proc_info, . - __v7_ca8_proc_info
  515. #endif /* CONFIG_ARM_LPAE */
  516. /*
  517. * Marvell PJ4B processor.
  518. */
  519. #ifdef CONFIG_CPU_PJ4B
  520. .type __v7_pj4b_proc_info, #object
  521. __v7_pj4b_proc_info:
  522. .long 0x560f5800
  523. .long 0xff0fff00
  524. __v7_proc __v7_pj4b_proc_info, __v7_pj4b_setup, proc_fns = pj4b_processor_functions
  525. .size __v7_pj4b_proc_info, . - __v7_pj4b_proc_info
  526. #endif
  527. /*
  528. * ARM Ltd. Cortex R7 processor.
  529. */
  530. .type __v7_cr7mp_proc_info, #object
  531. __v7_cr7mp_proc_info:
  532. .long 0x410fc170
  533. .long 0xff0ffff0
  534. __v7_proc __v7_cr7mp_proc_info, __v7_cr7mp_setup
  535. .size __v7_cr7mp_proc_info, . - __v7_cr7mp_proc_info
  536. /*
  537. * ARM Ltd. Cortex A7 processor.
  538. */
  539. .type __v7_ca7mp_proc_info, #object
  540. __v7_ca7mp_proc_info:
  541. .long 0x410fc070
  542. .long 0xff0ffff0
  543. __v7_proc __v7_ca7mp_proc_info, __v7_ca7mp_setup
  544. .size __v7_ca7mp_proc_info, . - __v7_ca7mp_proc_info
  545. /*
  546. * ARM Ltd. Cortex A12 processor.
  547. */
  548. .type __v7_ca12mp_proc_info, #object
  549. __v7_ca12mp_proc_info:
  550. .long 0x410fc0d0
  551. .long 0xff0ffff0
  552. __v7_proc __v7_ca12mp_proc_info, __v7_ca12mp_setup
  553. .size __v7_ca12mp_proc_info, . - __v7_ca12mp_proc_info
  554. /*
  555. * ARM Ltd. Cortex A15 processor.
  556. */
  557. .type __v7_ca15mp_proc_info, #object
  558. __v7_ca15mp_proc_info:
  559. .long 0x410fc0f0
  560. .long 0xff0ffff0
  561. __v7_proc __v7_ca15mp_proc_info, __v7_ca15mp_setup
  562. .size __v7_ca15mp_proc_info, . - __v7_ca15mp_proc_info
  563. /*
  564. * Broadcom Corporation Brahma-B15 processor.
  565. */
  566. .type __v7_b15mp_proc_info, #object
  567. __v7_b15mp_proc_info:
  568. .long 0x420f00f0
  569. .long 0xff0ffff0
  570. __v7_proc __v7_b15mp_proc_info, __v7_b15mp_setup
  571. .size __v7_b15mp_proc_info, . - __v7_b15mp_proc_info
  572. /*
  573. * ARM Ltd. Cortex A17 processor.
  574. */
  575. .type __v7_ca17mp_proc_info, #object
  576. __v7_ca17mp_proc_info:
  577. .long 0x410fc0e0
  578. .long 0xff0ffff0
  579. __v7_proc __v7_ca17mp_proc_info, __v7_ca17mp_setup
  580. .size __v7_ca17mp_proc_info, . - __v7_ca17mp_proc_info
  581. /*
  582. * Qualcomm Inc. Krait processors.
  583. */
  584. .type __krait_proc_info, #object
  585. __krait_proc_info:
  586. .long 0x510f0400 @ Required ID value
  587. .long 0xff0ffc00 @ Mask for ID
  588. /*
  589. * Some Krait processors don't indicate support for SDIV and UDIV
  590. * instructions in the ARM instruction set, even though they actually
  591. * do support them. They also don't indicate support for fused multiply
  592. * instructions even though they actually do support them.
  593. */
  594. __v7_proc __krait_proc_info, __v7_setup, hwcaps = HWCAP_IDIV | HWCAP_VFPv4
  595. .size __krait_proc_info, . - __krait_proc_info
  596. /*
  597. * Match any ARMv7 processor core.
  598. */
  599. .type __v7_proc_info, #object
  600. __v7_proc_info:
  601. .long 0x000f0000 @ Required ID value
  602. .long 0x000f0000 @ Mask for ID
  603. __v7_proc __v7_proc_info, __v7_setup
  604. .size __v7_proc_info, . - __v7_proc_info