proc-v7.S 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609
  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-A9 processor functions
  146. */
  147. globl_equ cpu_ca9mp_proc_init, cpu_v7_proc_init
  148. globl_equ cpu_ca9mp_proc_fin, cpu_v7_proc_fin
  149. globl_equ cpu_ca9mp_reset, cpu_v7_reset
  150. globl_equ cpu_ca9mp_do_idle, cpu_v7_do_idle
  151. globl_equ cpu_ca9mp_dcache_clean_area, cpu_v7_dcache_clean_area
  152. globl_equ cpu_ca9mp_switch_mm, cpu_v7_switch_mm
  153. globl_equ cpu_ca9mp_set_pte_ext, cpu_v7_set_pte_ext
  154. .globl cpu_ca9mp_suspend_size
  155. .equ cpu_ca9mp_suspend_size, cpu_v7_suspend_size + 4 * 2
  156. #ifdef CONFIG_ARM_CPU_SUSPEND
  157. ENTRY(cpu_ca9mp_do_suspend)
  158. stmfd sp!, {r4 - r5}
  159. mrc p15, 0, r4, c15, c0, 1 @ Diagnostic register
  160. mrc p15, 0, r5, c15, c0, 0 @ Power register
  161. stmia r0!, {r4 - r5}
  162. ldmfd sp!, {r4 - r5}
  163. b cpu_v7_do_suspend
  164. ENDPROC(cpu_ca9mp_do_suspend)
  165. ENTRY(cpu_ca9mp_do_resume)
  166. ldmia r0!, {r4 - r5}
  167. mrc p15, 0, r10, c15, c0, 1 @ Read Diagnostic register
  168. teq r4, r10 @ Already restored?
  169. mcrne p15, 0, r4, c15, c0, 1 @ No, so restore it
  170. mrc p15, 0, r10, c15, c0, 0 @ Read Power register
  171. teq r5, r10 @ Already restored?
  172. mcrne p15, 0, r5, c15, c0, 0 @ No, so restore it
  173. b cpu_v7_do_resume
  174. ENDPROC(cpu_ca9mp_do_resume)
  175. #endif
  176. #ifdef CONFIG_CPU_PJ4B
  177. globl_equ cpu_pj4b_switch_mm, cpu_v7_switch_mm
  178. globl_equ cpu_pj4b_set_pte_ext, cpu_v7_set_pte_ext
  179. globl_equ cpu_pj4b_proc_init, cpu_v7_proc_init
  180. globl_equ cpu_pj4b_proc_fin, cpu_v7_proc_fin
  181. globl_equ cpu_pj4b_reset, cpu_v7_reset
  182. #ifdef CONFIG_PJ4B_ERRATA_4742
  183. ENTRY(cpu_pj4b_do_idle)
  184. dsb @ WFI may enter a low-power mode
  185. wfi
  186. dsb @barrier
  187. ret lr
  188. ENDPROC(cpu_pj4b_do_idle)
  189. #else
  190. globl_equ cpu_pj4b_do_idle, cpu_v7_do_idle
  191. #endif
  192. globl_equ cpu_pj4b_dcache_clean_area, cpu_v7_dcache_clean_area
  193. #ifdef CONFIG_ARM_CPU_SUSPEND
  194. ENTRY(cpu_pj4b_do_suspend)
  195. stmfd sp!, {r6 - r10}
  196. mrc p15, 1, r6, c15, c1, 0 @ save CP15 - extra features
  197. mrc p15, 1, r7, c15, c2, 0 @ save CP15 - Aux Func Modes Ctrl 0
  198. mrc p15, 1, r8, c15, c1, 2 @ save CP15 - Aux Debug Modes Ctrl 2
  199. mrc p15, 1, r9, c15, c1, 1 @ save CP15 - Aux Debug Modes Ctrl 1
  200. mrc p15, 0, r10, c9, c14, 0 @ save CP15 - PMC
  201. stmia r0!, {r6 - r10}
  202. ldmfd sp!, {r6 - r10}
  203. b cpu_v7_do_suspend
  204. ENDPROC(cpu_pj4b_do_suspend)
  205. ENTRY(cpu_pj4b_do_resume)
  206. ldmia r0!, {r6 - r10}
  207. mcr p15, 1, r6, c15, c1, 0 @ restore CP15 - extra features
  208. mcr p15, 1, r7, c15, c2, 0 @ restore CP15 - Aux Func Modes Ctrl 0
  209. mcr p15, 1, r8, c15, c1, 2 @ restore CP15 - Aux Debug Modes Ctrl 2
  210. mcr p15, 1, r9, c15, c1, 1 @ restore CP15 - Aux Debug Modes Ctrl 1
  211. mcr p15, 0, r10, c9, c14, 0 @ restore CP15 - PMC
  212. b cpu_v7_do_resume
  213. ENDPROC(cpu_pj4b_do_resume)
  214. #endif
  215. .globl cpu_pj4b_suspend_size
  216. .equ cpu_pj4b_suspend_size, cpu_v7_suspend_size + 4 * 5
  217. #endif
  218. /*
  219. * __v7_setup
  220. *
  221. * Initialise TLB, Caches, and MMU state ready to switch the MMU
  222. * on. Return in r0 the new CP15 C1 control register setting.
  223. *
  224. * This should be able to cover all ARMv7 cores.
  225. *
  226. * It is assumed that:
  227. * - cache type register is implemented
  228. */
  229. __v7_ca5mp_setup:
  230. __v7_ca9mp_setup:
  231. __v7_cr7mp_setup:
  232. mov r10, #(1 << 0) @ Cache/TLB ops broadcasting
  233. b 1f
  234. __v7_ca7mp_setup:
  235. __v7_ca12mp_setup:
  236. __v7_ca15mp_setup:
  237. __v7_b15mp_setup:
  238. __v7_ca17mp_setup:
  239. mov r10, #0
  240. 1:
  241. #ifdef CONFIG_SMP
  242. ALT_SMP(mrc p15, 0, r0, c1, c0, 1)
  243. ALT_UP(mov r0, #(1 << 6)) @ fake it for UP
  244. tst r0, #(1 << 6) @ SMP/nAMP mode enabled?
  245. orreq r0, r0, #(1 << 6) @ Enable SMP/nAMP mode
  246. orreq r0, r0, r10 @ Enable CPU-specific SMP bits
  247. mcreq p15, 0, r0, c1, c0, 1
  248. #endif
  249. b __v7_setup
  250. __v7_pj4b_setup:
  251. #ifdef CONFIG_CPU_PJ4B
  252. /* Auxiliary Debug Modes Control 1 Register */
  253. #define PJ4B_STATIC_BP (1 << 2) /* Enable Static BP */
  254. #define PJ4B_INTER_PARITY (1 << 8) /* Disable Internal Parity Handling */
  255. #define PJ4B_BCK_OFF_STREX (1 << 5) /* Enable the back off of STREX instr */
  256. #define PJ4B_CLEAN_LINE (1 << 16) /* Disable data transfer for clean line */
  257. /* Auxiliary Debug Modes Control 2 Register */
  258. #define PJ4B_FAST_LDR (1 << 23) /* Disable fast LDR */
  259. #define PJ4B_SNOOP_DATA (1 << 25) /* Do not interleave write and snoop data */
  260. #define PJ4B_CWF (1 << 27) /* Disable Critical Word First feature */
  261. #define PJ4B_OUTSDNG_NC (1 << 29) /* Disable outstanding non cacheable rqst */
  262. #define PJ4B_L1_REP_RR (1 << 30) /* L1 replacement - Strict round robin */
  263. #define PJ4B_AUX_DBG_CTRL2 (PJ4B_SNOOP_DATA | PJ4B_CWF |\
  264. PJ4B_OUTSDNG_NC | PJ4B_L1_REP_RR)
  265. /* Auxiliary Functional Modes Control Register 0 */
  266. #define PJ4B_SMP_CFB (1 << 1) /* Set SMP mode. Join the coherency fabric */
  267. #define PJ4B_L1_PAR_CHK (1 << 2) /* Support L1 parity checking */
  268. #define PJ4B_BROADCAST_CACHE (1 << 8) /* Broadcast Cache and TLB maintenance */
  269. /* Auxiliary Debug Modes Control 0 Register */
  270. #define PJ4B_WFI_WFE (1 << 22) /* WFI/WFE - serve the DVM and back to idle */
  271. /* Auxiliary Debug Modes Control 1 Register */
  272. mrc p15, 1, r0, c15, c1, 1
  273. orr r0, r0, #PJ4B_CLEAN_LINE
  274. orr r0, r0, #PJ4B_BCK_OFF_STREX
  275. orr r0, r0, #PJ4B_INTER_PARITY
  276. bic r0, r0, #PJ4B_STATIC_BP
  277. mcr p15, 1, r0, c15, c1, 1
  278. /* Auxiliary Debug Modes Control 2 Register */
  279. mrc p15, 1, r0, c15, c1, 2
  280. bic r0, r0, #PJ4B_FAST_LDR
  281. orr r0, r0, #PJ4B_AUX_DBG_CTRL2
  282. mcr p15, 1, r0, c15, c1, 2
  283. /* Auxiliary Functional Modes Control Register 0 */
  284. mrc p15, 1, r0, c15, c2, 0
  285. #ifdef CONFIG_SMP
  286. orr r0, r0, #PJ4B_SMP_CFB
  287. #endif
  288. orr r0, r0, #PJ4B_L1_PAR_CHK
  289. orr r0, r0, #PJ4B_BROADCAST_CACHE
  290. mcr p15, 1, r0, c15, c2, 0
  291. /* Auxiliary Debug Modes Control 0 Register */
  292. mrc p15, 1, r0, c15, c1, 0
  293. orr r0, r0, #PJ4B_WFI_WFE
  294. mcr p15, 1, r0, c15, c1, 0
  295. #endif /* CONFIG_CPU_PJ4B */
  296. __v7_setup:
  297. adr r12, __v7_setup_stack @ the local stack
  298. stmia r12, {r0-r5, r7, r9, r11, lr}
  299. bl v7_flush_dcache_louis
  300. ldmia r12, {r0-r5, r7, r9, r11, lr}
  301. mrc p15, 0, r0, c0, c0, 0 @ read main ID register
  302. and r10, r0, #0xff000000 @ ARM?
  303. teq r10, #0x41000000
  304. bne 3f
  305. and r5, r0, #0x00f00000 @ variant
  306. and r6, r0, #0x0000000f @ revision
  307. orr r6, r6, r5, lsr #20-4 @ combine variant and revision
  308. ubfx r0, r0, #4, #12 @ primary part number
  309. /* Cortex-A8 Errata */
  310. ldr r10, =0x00000c08 @ Cortex-A8 primary part number
  311. teq r0, r10
  312. bne 2f
  313. #if defined(CONFIG_ARM_ERRATA_430973) && !defined(CONFIG_ARCH_MULTIPLATFORM)
  314. teq r5, #0x00100000 @ only present in r1p*
  315. mrceq p15, 0, r10, c1, c0, 1 @ read aux control register
  316. orreq r10, r10, #(1 << 6) @ set IBE to 1
  317. mcreq p15, 0, r10, c1, c0, 1 @ write aux control register
  318. #endif
  319. #ifdef CONFIG_ARM_ERRATA_458693
  320. teq r6, #0x20 @ only present in r2p0
  321. mrceq p15, 0, r10, c1, c0, 1 @ read aux control register
  322. orreq r10, r10, #(1 << 5) @ set L1NEON to 1
  323. orreq r10, r10, #(1 << 9) @ set PLDNOP to 1
  324. mcreq p15, 0, r10, c1, c0, 1 @ write aux control register
  325. #endif
  326. #ifdef CONFIG_ARM_ERRATA_460075
  327. teq r6, #0x20 @ only present in r2p0
  328. mrceq p15, 1, r10, c9, c0, 2 @ read L2 cache aux ctrl register
  329. tsteq r10, #1 << 22
  330. orreq r10, r10, #(1 << 22) @ set the Write Allocate disable bit
  331. mcreq p15, 1, r10, c9, c0, 2 @ write the L2 cache aux ctrl register
  332. #endif
  333. b 3f
  334. /* Cortex-A9 Errata */
  335. 2: ldr r10, =0x00000c09 @ Cortex-A9 primary part number
  336. teq r0, r10
  337. bne 3f
  338. #ifdef CONFIG_ARM_ERRATA_742230
  339. cmp r6, #0x22 @ only present up to r2p2
  340. mrcle p15, 0, r10, c15, c0, 1 @ read diagnostic register
  341. orrle r10, r10, #1 << 4 @ set bit #4
  342. mcrle p15, 0, r10, c15, c0, 1 @ write diagnostic register
  343. #endif
  344. #ifdef CONFIG_ARM_ERRATA_742231
  345. teq r6, #0x20 @ present in r2p0
  346. teqne r6, #0x21 @ present in r2p1
  347. teqne r6, #0x22 @ present in r2p2
  348. mrceq p15, 0, r10, c15, c0, 1 @ read diagnostic register
  349. orreq r10, r10, #1 << 12 @ set bit #12
  350. orreq r10, r10, #1 << 22 @ set bit #22
  351. mcreq p15, 0, r10, c15, c0, 1 @ write diagnostic register
  352. #endif
  353. #ifdef CONFIG_ARM_ERRATA_743622
  354. teq r5, #0x00200000 @ only present in r2p*
  355. mrceq p15, 0, r10, c15, c0, 1 @ read diagnostic register
  356. orreq r10, r10, #1 << 6 @ set bit #6
  357. mcreq p15, 0, r10, c15, c0, 1 @ write diagnostic register
  358. #endif
  359. #if defined(CONFIG_ARM_ERRATA_751472) && defined(CONFIG_SMP)
  360. ALT_SMP(cmp r6, #0x30) @ present prior to r3p0
  361. ALT_UP_B(1f)
  362. mrclt p15, 0, r10, c15, c0, 1 @ read diagnostic register
  363. orrlt r10, r10, #1 << 11 @ set bit #11
  364. mcrlt p15, 0, r10, c15, c0, 1 @ write diagnostic register
  365. 1:
  366. #endif
  367. /* Cortex-A15 Errata */
  368. 3: ldr r10, =0x00000c0f @ Cortex-A15 primary part number
  369. teq r0, r10
  370. bne 4f
  371. #ifdef CONFIG_ARM_ERRATA_773022
  372. cmp r6, #0x4 @ only present up to r0p4
  373. mrcle p15, 0, r10, c1, c0, 1 @ read aux control register
  374. orrle r10, r10, #1 << 1 @ disable loop buffer
  375. mcrle p15, 0, r10, c1, c0, 1 @ write aux control register
  376. #endif
  377. 4: mov r10, #0
  378. mcr p15, 0, r10, c7, c5, 0 @ I+BTB cache invalidate
  379. #ifdef CONFIG_MMU
  380. mcr p15, 0, r10, c8, c7, 0 @ invalidate I + D TLBs
  381. v7_ttb_setup r10, r4, r8, r5 @ TTBCR, TTBRx setup
  382. ldr r5, =PRRR @ PRRR
  383. ldr r6, =NMRR @ NMRR
  384. mcr p15, 0, r5, c10, c2, 0 @ write PRRR
  385. mcr p15, 0, r6, c10, c2, 1 @ write NMRR
  386. #endif
  387. dsb @ Complete invalidations
  388. #ifndef CONFIG_ARM_THUMBEE
  389. mrc p15, 0, r0, c0, c1, 0 @ read ID_PFR0 for ThumbEE
  390. and r0, r0, #(0xf << 12) @ ThumbEE enabled field
  391. teq r0, #(1 << 12) @ check if ThumbEE is present
  392. bne 1f
  393. mov r5, #0
  394. mcr p14, 6, r5, c1, c0, 0 @ Initialize TEEHBR to 0
  395. mrc p14, 6, r0, c0, c0, 0 @ load TEECR
  396. orr r0, r0, #1 @ set the 1st bit in order to
  397. mcr p14, 6, r0, c0, c0, 0 @ stop userspace TEEHBR access
  398. 1:
  399. #endif
  400. adr r5, v7_crval
  401. ldmia r5, {r5, r6}
  402. ARM_BE8(orr r6, r6, #1 << 25) @ big-endian page tables
  403. #ifdef CONFIG_SWP_EMULATE
  404. orr r5, r5, #(1 << 10) @ set SW bit in "clear"
  405. bic r6, r6, #(1 << 10) @ clear it in "mmuset"
  406. #endif
  407. mrc p15, 0, r0, c1, c0, 0 @ read control register
  408. bic r0, r0, r5 @ clear bits them
  409. orr r0, r0, r6 @ set them
  410. THUMB( orr r0, r0, #1 << 30 ) @ Thumb exceptions
  411. ret lr @ return to head.S:__ret
  412. ENDPROC(__v7_setup)
  413. .align 2
  414. __v7_setup_stack:
  415. .space 4 * 11 @ 11 registers
  416. __INITDATA
  417. @ define struct processor (see <asm/proc-fns.h> and proc-macros.S)
  418. define_processor_functions v7, dabort=v7_early_abort, pabort=v7_pabort, suspend=1
  419. define_processor_functions ca9mp, dabort=v7_early_abort, pabort=v7_pabort, suspend=1
  420. #ifdef CONFIG_CPU_PJ4B
  421. define_processor_functions pj4b, dabort=v7_early_abort, pabort=v7_pabort, suspend=1
  422. #endif
  423. .section ".rodata"
  424. string cpu_arch_name, "armv7"
  425. string cpu_elf_name, "v7"
  426. .align
  427. .section ".proc.info.init", #alloc, #execinstr
  428. /*
  429. * Standard v7 proc info content
  430. */
  431. .macro __v7_proc initfunc, mm_mmuflags = 0, io_mmuflags = 0, hwcaps = 0, proc_fns = v7_processor_functions
  432. ALT_SMP(.long PMD_TYPE_SECT | PMD_SECT_AP_WRITE | PMD_SECT_AP_READ | \
  433. PMD_SECT_AF | PMD_FLAGS_SMP | \mm_mmuflags)
  434. ALT_UP(.long PMD_TYPE_SECT | PMD_SECT_AP_WRITE | PMD_SECT_AP_READ | \
  435. PMD_SECT_AF | PMD_FLAGS_UP | \mm_mmuflags)
  436. .long PMD_TYPE_SECT | PMD_SECT_AP_WRITE | \
  437. PMD_SECT_AP_READ | PMD_SECT_AF | \io_mmuflags
  438. W(b) \initfunc
  439. .long cpu_arch_name
  440. .long cpu_elf_name
  441. .long HWCAP_SWP | HWCAP_HALF | HWCAP_THUMB | HWCAP_FAST_MULT | \
  442. HWCAP_EDSP | HWCAP_TLS | \hwcaps
  443. .long cpu_v7_name
  444. .long \proc_fns
  445. .long v7wbi_tlb_fns
  446. .long v6_user_fns
  447. .long v7_cache_fns
  448. .endm
  449. #ifndef CONFIG_ARM_LPAE
  450. /*
  451. * ARM Ltd. Cortex A5 processor.
  452. */
  453. .type __v7_ca5mp_proc_info, #object
  454. __v7_ca5mp_proc_info:
  455. .long 0x410fc050
  456. .long 0xff0ffff0
  457. __v7_proc __v7_ca5mp_setup
  458. .size __v7_ca5mp_proc_info, . - __v7_ca5mp_proc_info
  459. /*
  460. * ARM Ltd. Cortex A9 processor.
  461. */
  462. .type __v7_ca9mp_proc_info, #object
  463. __v7_ca9mp_proc_info:
  464. .long 0x410fc090
  465. .long 0xff0ffff0
  466. __v7_proc __v7_ca9mp_setup, proc_fns = ca9mp_processor_functions
  467. .size __v7_ca9mp_proc_info, . - __v7_ca9mp_proc_info
  468. #endif /* CONFIG_ARM_LPAE */
  469. /*
  470. * Marvell PJ4B processor.
  471. */
  472. #ifdef CONFIG_CPU_PJ4B
  473. .type __v7_pj4b_proc_info, #object
  474. __v7_pj4b_proc_info:
  475. .long 0x560f5800
  476. .long 0xff0fff00
  477. __v7_proc __v7_pj4b_setup, proc_fns = pj4b_processor_functions
  478. .size __v7_pj4b_proc_info, . - __v7_pj4b_proc_info
  479. #endif
  480. /*
  481. * ARM Ltd. Cortex R7 processor.
  482. */
  483. .type __v7_cr7mp_proc_info, #object
  484. __v7_cr7mp_proc_info:
  485. .long 0x410fc170
  486. .long 0xff0ffff0
  487. __v7_proc __v7_cr7mp_setup
  488. .size __v7_cr7mp_proc_info, . - __v7_cr7mp_proc_info
  489. /*
  490. * ARM Ltd. Cortex A7 processor.
  491. */
  492. .type __v7_ca7mp_proc_info, #object
  493. __v7_ca7mp_proc_info:
  494. .long 0x410fc070
  495. .long 0xff0ffff0
  496. __v7_proc __v7_ca7mp_setup
  497. .size __v7_ca7mp_proc_info, . - __v7_ca7mp_proc_info
  498. /*
  499. * ARM Ltd. Cortex A12 processor.
  500. */
  501. .type __v7_ca12mp_proc_info, #object
  502. __v7_ca12mp_proc_info:
  503. .long 0x410fc0d0
  504. .long 0xff0ffff0
  505. __v7_proc __v7_ca12mp_setup
  506. .size __v7_ca12mp_proc_info, . - __v7_ca12mp_proc_info
  507. /*
  508. * ARM Ltd. Cortex A15 processor.
  509. */
  510. .type __v7_ca15mp_proc_info, #object
  511. __v7_ca15mp_proc_info:
  512. .long 0x410fc0f0
  513. .long 0xff0ffff0
  514. __v7_proc __v7_ca15mp_setup
  515. .size __v7_ca15mp_proc_info, . - __v7_ca15mp_proc_info
  516. /*
  517. * Broadcom Corporation Brahma-B15 processor.
  518. */
  519. .type __v7_b15mp_proc_info, #object
  520. __v7_b15mp_proc_info:
  521. .long 0x420f00f0
  522. .long 0xff0ffff0
  523. __v7_proc __v7_b15mp_setup
  524. .size __v7_b15mp_proc_info, . - __v7_b15mp_proc_info
  525. /*
  526. * ARM Ltd. Cortex A17 processor.
  527. */
  528. .type __v7_ca17mp_proc_info, #object
  529. __v7_ca17mp_proc_info:
  530. .long 0x410fc0e0
  531. .long 0xff0ffff0
  532. __v7_proc __v7_ca17mp_setup
  533. .size __v7_ca17mp_proc_info, . - __v7_ca17mp_proc_info
  534. /*
  535. * Qualcomm Inc. Krait processors.
  536. */
  537. .type __krait_proc_info, #object
  538. __krait_proc_info:
  539. .long 0x510f0400 @ Required ID value
  540. .long 0xff0ffc00 @ Mask for ID
  541. /*
  542. * Some Krait processors don't indicate support for SDIV and UDIV
  543. * instructions in the ARM instruction set, even though they actually
  544. * do support them.
  545. */
  546. __v7_proc __v7_setup, hwcaps = HWCAP_IDIV
  547. .size __krait_proc_info, . - __krait_proc_info
  548. /*
  549. * Match any ARMv7 processor core.
  550. */
  551. .type __v7_proc_info, #object
  552. __v7_proc_info:
  553. .long 0x000f0000 @ Required ID value
  554. .long 0x000f0000 @ Mask for ID
  555. __v7_proc __v7_setup
  556. .size __v7_proc_info, . - __v7_proc_info