1/* SPDX-License-Identifier: GPL-2.0-only */ 2/* 3 * linux/arch/arm/mm/proc-v7m.S 4 * 5 * Copyright (C) 2008 ARM Ltd. 6 * Copyright (C) 2001 Deep Blue Solutions Ltd. 7 * 8 * This is the "shell" of the ARMv7-M processor support. 9 */ 10#include <linux/linkage.h> 11#include <asm/assembler.h> 12#include <asm/page.h> 13#include <asm/v7m.h> 14#include "proc-macros.S" 15 16ENTRY(cpu_v7m_proc_init) 17 ret lr 18ENDPROC(cpu_v7m_proc_init) 19 20ENTRY(cpu_v7m_proc_fin) 21 ret lr 22ENDPROC(cpu_v7m_proc_fin) 23 24/* 25 * cpu_v7m_reset(loc) 26 * 27 * Perform a soft reset of the system. Put the CPU into the 28 * same state as it would be if it had been reset, and branch 29 * to what would be the reset vector. 30 * 31 * - loc - location to jump to for soft reset 32 */ 33 .align 5 34ENTRY(cpu_v7m_reset) 35 ret r0 36ENDPROC(cpu_v7m_reset) 37 38/* 39 * cpu_v7m_do_idle() 40 * 41 * Idle the processor (eg, wait for interrupt). 42 * 43 * IRQs are already disabled. 44 */ 45ENTRY(cpu_v7m_do_idle) 46 wfi 47 ret lr 48ENDPROC(cpu_v7m_do_idle) 49 50ENTRY(cpu_v7m_dcache_clean_area) 51 ret lr 52ENDPROC(cpu_v7m_dcache_clean_area) 53 54/* 55 * There is no MMU, so here is nothing to do. 56 */ 57ENTRY(cpu_v7m_switch_mm) 58 ret lr 59ENDPROC(cpu_v7m_switch_mm) 60 61.globl cpu_v7m_suspend_size 62.equ cpu_v7m_suspend_size, 0 63 64#ifdef CONFIG_ARM_CPU_SUSPEND 65ENTRY(cpu_v7m_do_suspend) 66 ret lr 67ENDPROC(cpu_v7m_do_suspend) 68 69ENTRY(cpu_v7m_do_resume) 70 ret lr 71ENDPROC(cpu_v7m_do_resume) 72#endif 73 74ENTRY(cpu_cm7_dcache_clean_area) 75 dcache_line_size r2, r3 76 movw r3, #:lower16:BASEADDR_V7M_SCB + V7M_SCB_DCCMVAC 77 movt r3, #:upper16:BASEADDR_V7M_SCB + V7M_SCB_DCCMVAC 78 791: str r0, [r3] @ clean D entry 80 add r0, r0, r2 81 subs r1, r1, r2 82 bhi 1b 83 dsb 84 ret lr 85ENDPROC(cpu_cm7_dcache_clean_area) 86 87ENTRY(cpu_cm7_proc_fin) 88 movw r2, #:lower16:(BASEADDR_V7M_SCB + V7M_SCB_CCR) 89 movt r2, #:upper16:(BASEADDR_V7M_SCB + V7M_SCB_CCR) 90 ldr r0, [r2] 91 bic r0, r0, #(V7M_SCB_CCR_DC | V7M_SCB_CCR_IC) 92 str r0, [r2] 93 ret lr 94ENDPROC(cpu_cm7_proc_fin) 95 96 .section ".init.text", "ax" 97 98__v7m_cm7_setup: 99 mov r8, #(V7M_SCB_CCR_DC | V7M_SCB_CCR_IC| V7M_SCB_CCR_BP) 100 b __v7m_setup_cont 101/* 102 * __v7m_setup 103 * 104 * This should be able to cover all ARMv7-M cores. 105 */ 106__v7m_setup: 107 mov r8, 0 108 109__v7m_setup_cont: 110 @ Configure the vector table base address 111 ldr r0, =BASEADDR_V7M_SCB 112 ldr r12, =vector_table 113 str r12, [r0, V7M_SCB_VTOR] 114 115 @ enable UsageFault, BusFault and MemManage fault. 116 ldr r5, [r0, #V7M_SCB_SHCSR] 117 orr r5, #(V7M_SCB_SHCSR_USGFAULTENA | V7M_SCB_SHCSR_BUSFAULTENA | V7M_SCB_SHCSR_MEMFAULTENA) 118 str r5, [r0, #V7M_SCB_SHCSR] 119 120 @ Lower the priority of the SVC and PendSV exceptions 121 mov r5, #0x80000000 122 str r5, [r0, V7M_SCB_SHPR2] @ set SVC priority 123 mov r5, #0x00800000 124 str r5, [r0, V7M_SCB_SHPR3] @ set PendSV priority 125 126 @ SVC to switch to handler mode. Notice that this requires sp to 127 @ point to writeable memory because the processor saves 128 @ some registers to the stack. 129 badr r1, 1f 130 ldr r5, [r12, #11 * 4] @ read the SVC vector entry 131 str r1, [r12, #11 * 4] @ write the temporary SVC vector entry 132 dsb 133 mov r6, lr @ save LR 134 ldr sp, =init_thread_union + THREAD_START_SP 135 cpsie i 136 svc #0 1371: cpsid i 138 /* Calculate exc_ret */ 139 orr r10, lr, #EXC_RET_THREADMODE_PROCESSSTACK 140 ldmia sp, {r0-r3, r12} 141 str r5, [r12, #11 * 4] @ restore the original SVC vector entry 142 mov lr, r6 @ restore LR 143 144 @ Special-purpose control register 145 mov r1, #1 146 msr control, r1 @ Thread mode has unpriviledged access 147 148 @ Configure caches (if implemented) 149 teq r8, #0 150 stmiane sp, {r0-r6, lr} @ v7m_invalidate_l1 touches r0-r6 151 blne v7m_invalidate_l1 152 teq r8, #0 @ re-evalutae condition 153 ldmiane sp, {r0-r6, lr} 154 155 @ Configure the System Control Register to ensure 8-byte stack alignment 156 @ Note the STKALIGN bit is either RW or RAO. 157 ldr r0, [r0, V7M_SCB_CCR] @ system control register 158 orr r0, #V7M_SCB_CCR_STKALIGN 159 orr r0, r0, r8 160 161 ret lr 162ENDPROC(__v7m_setup) 163 164/* 165 * Cortex-M7 processor functions 166 */ 167 globl_equ cpu_cm7_proc_init, cpu_v7m_proc_init 168 globl_equ cpu_cm7_reset, cpu_v7m_reset 169 globl_equ cpu_cm7_do_idle, cpu_v7m_do_idle 170 globl_equ cpu_cm7_switch_mm, cpu_v7m_switch_mm 171 172 define_processor_functions v7m, dabort=nommu_early_abort, pabort=legacy_pabort, nommu=1 173 define_processor_functions cm7, dabort=nommu_early_abort, pabort=legacy_pabort, nommu=1 174 175 .section ".rodata" 176 string cpu_arch_name, "armv7m" 177 string cpu_elf_name "v7m" 178 string cpu_v7m_name "ARMv7-M" 179 180 .section ".proc.info.init", "a" 181 182.macro __v7m_proc name, initfunc, cache_fns = nop_cache_fns, hwcaps = 0, proc_fns = v7m_processor_functions 183 .long 0 /* proc_info_list.__cpu_mm_mmu_flags */ 184 .long 0 /* proc_info_list.__cpu_io_mmu_flags */ 185 initfn \initfunc, \name 186 .long cpu_arch_name 187 .long cpu_elf_name 188 .long HWCAP_HALF | HWCAP_THUMB | HWCAP_FAST_MULT | \hwcaps 189 .long cpu_v7m_name 190 .long \proc_fns 191 .long 0 /* proc_info_list.tlb */ 192 .long 0 /* proc_info_list.user */ 193 .long \cache_fns 194.endm 195 196 /* 197 * Match ARM Cortex-M55 processor. 198 */ 199 .type __v7m_cm55_proc_info, #object 200__v7m_cm55_proc_info: 201 .long 0x410fd220 /* ARM Cortex-M55 0xD22 */ 202 .long 0xff0ffff0 /* Mask off revision, patch release */ 203 __v7m_proc __v7m_cm55_proc_info, __v7m_cm7_setup, hwcaps = HWCAP_EDSP, cache_fns = v7m_cache_fns, proc_fns = cm7_processor_functions 204 .size __v7m_cm55_proc_info, . - __v7m_cm55_proc_info 205 206 /* 207 * Match ARM Cortex-M33 processor. 208 */ 209 .type __v7m_cm33_proc_info, #object 210__v7m_cm33_proc_info: 211 .long 0x410fd210 /* ARM Cortex-M33 0xD21 */ 212 .long 0xff0ffff0 /* Mask off revision, patch release */ 213 __v7m_proc __v7m_cm33_proc_info, __v7m_setup, hwcaps = HWCAP_EDSP 214 .size __v7m_cm33_proc_info, . - __v7m_cm33_proc_info 215 216 /* 217 * Match ARM Cortex-M7 processor. 218 */ 219 .type __v7m_cm7_proc_info, #object 220__v7m_cm7_proc_info: 221 .long 0x410fc270 /* ARM Cortex-M7 0xC27 */ 222 .long 0xff0ffff0 /* Mask off revision, patch release */ 223 __v7m_proc __v7m_cm7_proc_info, __v7m_cm7_setup, hwcaps = HWCAP_EDSP, cache_fns = v7m_cache_fns, proc_fns = cm7_processor_functions 224 .size __v7m_cm7_proc_info, . - __v7m_cm7_proc_info 225 226 /* 227 * Match ARM Cortex-M4 processor. 228 */ 229 .type __v7m_cm4_proc_info, #object 230__v7m_cm4_proc_info: 231 .long 0x410fc240 /* ARM Cortex-M4 0xC24 */ 232 .long 0xff0ffff0 /* Mask off revision, patch release */ 233 __v7m_proc __v7m_cm4_proc_info, __v7m_setup, hwcaps = HWCAP_EDSP 234 .size __v7m_cm4_proc_info, . - __v7m_cm4_proc_info 235 236 /* 237 * Match ARM Cortex-M3 processor. 238 */ 239 .type __v7m_cm3_proc_info, #object 240__v7m_cm3_proc_info: 241 .long 0x410fc230 /* ARM Cortex-M3 0xC23 */ 242 .long 0xff0ffff0 /* Mask off revision, patch release */ 243 __v7m_proc __v7m_cm3_proc_info, __v7m_setup 244 .size __v7m_cm3_proc_info, . - __v7m_cm3_proc_info 245 246 /* 247 * Match any ARMv7-M processor core. 248 */ 249 .type __v7m_proc_info, #object 250__v7m_proc_info: 251 .long 0x000f0000 @ Required ID value 252 .long 0x000f0000 @ Mask for ID 253 __v7m_proc __v7m_proc_info, __v7m_setup 254 .size __v7m_proc_info, . - __v7m_proc_info 255 256