1/* 2 * linux/arch/arm/mm/proc-v6.S 3 * 4 * Copyright (C) 2001 Deep Blue Solutions Ltd. 5 * Modified by Catalin Marinas for noMMU support 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 is the "shell" of the ARMv6 processor support. 12 */ 13#include <linux/init.h> 14#include <linux/linkage.h> 15#include <asm/assembler.h> 16#include <asm/asm-offsets.h> 17#include <asm/hwcap.h> 18#include <asm/pgtable-hwdef.h> 19#include <asm/pgtable.h> 20 21#include "proc-macros.S" 22 23#define D_CACHE_LINE_SIZE 32 24 25#define TTB_C (1 << 0) 26#define TTB_S (1 << 1) 27#define TTB_IMP (1 << 2) 28#define TTB_RGN_NC (0 << 3) 29#define TTB_RGN_WBWA (1 << 3) 30#define TTB_RGN_WT (2 << 3) 31#define TTB_RGN_WB (3 << 3) 32 33#ifndef CONFIG_SMP 34#define TTB_FLAGS TTB_RGN_WBWA 35#define PMD_FLAGS PMD_SECT_WB 36#else 37#define TTB_FLAGS TTB_RGN_WBWA|TTB_S 38#define PMD_FLAGS PMD_SECT_WBWA|PMD_SECT_S 39#endif 40 41ENTRY(cpu_v6_proc_init) 42 mov pc, lr 43 44ENTRY(cpu_v6_proc_fin) 45 mrc p15, 0, r0, c1, c0, 0 @ ctrl register 46 bic r0, r0, #0x1000 @ ...i............ 47 bic r0, r0, #0x0006 @ .............ca. 48 mcr p15, 0, r0, c1, c0, 0 @ disable caches 49 mov pc, lr 50 51/* 52 * cpu_v6_reset(loc) 53 * 54 * Perform a soft reset of the system. Put the CPU into the 55 * same state as it would be if it had been reset, and branch 56 * to what would be the reset vector. 57 * 58 * - loc - location to jump to for soft reset 59 */ 60 .align 5 61ENTRY(cpu_v6_reset) 62 mov pc, r0 63 64/* 65 * cpu_v6_do_idle() 66 * 67 * Idle the processor (eg, wait for interrupt). 68 * 69 * IRQs are already disabled. 70 */ 71ENTRY(cpu_v6_do_idle) 72 mov r1, #0 73 mcr p15, 0, r1, c7, c10, 4 @ DWB - WFI may enter a low-power mode 74 mcr p15, 0, r1, c7, c0, 4 @ wait for interrupt 75 mov pc, lr 76 77ENTRY(cpu_v6_dcache_clean_area) 78#ifndef TLB_CAN_READ_FROM_L1_CACHE 791: mcr p15, 0, r0, c7, c10, 1 @ clean D entry 80 add r0, r0, #D_CACHE_LINE_SIZE 81 subs r1, r1, #D_CACHE_LINE_SIZE 82 bhi 1b 83#endif 84 mov pc, lr 85 86/* 87 * cpu_arm926_switch_mm(pgd_phys, tsk) 88 * 89 * Set the translation table base pointer to be pgd_phys 90 * 91 * - pgd_phys - physical address of new TTB 92 * 93 * It is assumed that: 94 * - we are not using split page tables 95 */ 96ENTRY(cpu_v6_switch_mm) 97#ifdef CONFIG_MMU 98 mov r2, #0 99 ldr r1, [r1, #MM_CONTEXT_ID] @ get mm->context.id 100 orr r0, r0, #TTB_FLAGS 101 mcr p15, 0, r2, c7, c5, 6 @ flush BTAC/BTB 102 mcr p15, 0, r2, c7, c10, 4 @ drain write buffer 103 mcr p15, 0, r0, c2, c0, 0 @ set TTB 0 104 mcr p15, 0, r1, c13, c0, 1 @ set context ID 105#endif 106 mov pc, lr 107 108/* 109 * cpu_v6_set_pte_ext(ptep, pte, ext) 110 * 111 * Set a level 2 translation table entry. 112 * 113 * - ptep - pointer to level 2 translation table entry 114 * (hardware version is stored at -1024 bytes) 115 * - pte - PTE value to store 116 * - ext - value for extended PTE bits 117 */ 118 armv6_mt_table cpu_v6 119 120ENTRY(cpu_v6_set_pte_ext) 121#ifdef CONFIG_MMU 122 armv6_set_pte_ext cpu_v6 123#endif 124 mov pc, lr 125 126 127 128 .type cpu_v6_name, #object 129cpu_v6_name: 130 .asciz "ARMv6-compatible processor" 131 .size cpu_v6_name, . - cpu_v6_name 132 133 .type cpu_pj4_name, #object 134cpu_pj4_name: 135 .asciz "Marvell PJ4 processor" 136 .size cpu_pj4_name, . - cpu_pj4_name 137 138 .align 139 140 __CPUINIT 141 142/* 143 * __v6_setup 144 * 145 * Initialise TLB, Caches, and MMU state ready to switch the MMU 146 * on. Return in r0 the new CP15 C1 control register setting. 147 * 148 * We automatically detect if we have a Harvard cache, and use the 149 * Harvard cache control instructions insead of the unified cache 150 * control instructions. 151 * 152 * This should be able to cover all ARMv6 cores. 153 * 154 * It is assumed that: 155 * - cache type register is implemented 156 */ 157__v6_setup: 158#ifdef CONFIG_SMP 159 mrc p15, 0, r0, c1, c0, 1 @ Enable SMP/nAMP mode 160 orr r0, r0, #0x20 161 mcr p15, 0, r0, c1, c0, 1 162#endif 163 164 mov r0, #0 165 mcr p15, 0, r0, c7, c14, 0 @ clean+invalidate D cache 166 mcr p15, 0, r0, c7, c5, 0 @ invalidate I cache 167 mcr p15, 0, r0, c7, c15, 0 @ clean+invalidate cache 168 mcr p15, 0, r0, c7, c10, 4 @ drain write buffer 169#ifdef CONFIG_MMU 170 mcr p15, 0, r0, c8, c7, 0 @ invalidate I + D TLBs 171 mcr p15, 0, r0, c2, c0, 2 @ TTB control register 172 orr r4, r4, #TTB_FLAGS 173 mcr p15, 0, r4, c2, c0, 1 @ load TTB1 174#endif /* CONFIG_MMU */ 175 adr r5, v6_crval 176 ldmia r5, {r5, r6} 177#ifdef CONFIG_CPU_ENDIAN_BE8 178 orr r6, r6, #1 << 25 @ big-endian page tables 179#endif 180 mrc p15, 0, r0, c1, c0, 0 @ read control register 181 bic r0, r0, r5 @ clear bits them 182 orr r0, r0, r6 @ set them 183 mov pc, lr @ return to head.S:__ret 184 185 /* 186 * V X F I D LR 187 * .... ...E PUI. .T.T 4RVI ZFRS BLDP WCAM 188 * rrrr rrrx xxx0 0101 xxxx xxxx x111 xxxx < forced 189 * 0 110 0011 1.00 .111 1101 < we want 190 */ 191 .type v6_crval, #object 192v6_crval: 193 crval clear=0x01e0fb7f, mmuset=0x00c0387d, ucset=0x00c0187c 194 195 __INITDATA 196 197 .type v6_processor_functions, #object 198ENTRY(v6_processor_functions) 199 .word v6_early_abort 200 .word v6_pabort 201 .word cpu_v6_proc_init 202 .word cpu_v6_proc_fin 203 .word cpu_v6_reset 204 .word cpu_v6_do_idle 205 .word cpu_v6_dcache_clean_area 206 .word cpu_v6_switch_mm 207 .word cpu_v6_set_pte_ext 208 .size v6_processor_functions, . - v6_processor_functions 209 210 .section ".rodata" 211 212 .type cpu_arch_name, #object 213cpu_arch_name: 214 .asciz "armv6" 215 .size cpu_arch_name, . - cpu_arch_name 216 217 .type cpu_elf_name, #object 218cpu_elf_name: 219 .asciz "v6" 220 .size cpu_elf_name, . - cpu_elf_name 221 .align 222 223 .section ".proc.info.init", #alloc, #execinstr 224 225 /* 226 * Match any ARMv6 processor core. 227 */ 228 .type __v6_proc_info, #object 229__v6_proc_info: 230 .long 0x0007b000 231 .long 0x0007f000 232 .long PMD_TYPE_SECT | \ 233 PMD_SECT_AP_WRITE | \ 234 PMD_SECT_AP_READ | \ 235 PMD_FLAGS 236 .long PMD_TYPE_SECT | \ 237 PMD_SECT_XN | \ 238 PMD_SECT_AP_WRITE | \ 239 PMD_SECT_AP_READ 240 b __v6_setup 241 .long cpu_arch_name 242 .long cpu_elf_name 243 /* See also feat_v6_fixup() for HWCAP_TLS */ 244 .long HWCAP_SWP|HWCAP_HALF|HWCAP_THUMB|HWCAP_FAST_MULT|HWCAP_EDSP|HWCAP_JAVA|HWCAP_TLS 245 .long cpu_v6_name 246 .long v6_processor_functions 247 .long v6wbi_tlb_fns 248 .long v6_user_fns 249 .long v6_cache_fns 250 .size __v6_proc_info, . - __v6_proc_info 251 252 .type __pj4_v6_proc_info, #object 253__pj4_v6_proc_info: 254 .long 0x560f5810 255 .long 0xff0ffff0 256 .long PMD_TYPE_SECT | \ 257 PMD_SECT_AP_WRITE | \ 258 PMD_SECT_AP_READ | \ 259 PMD_FLAGS 260 .long PMD_TYPE_SECT | \ 261 PMD_SECT_XN | \ 262 PMD_SECT_AP_WRITE | \ 263 PMD_SECT_AP_READ 264 b __v6_setup 265 .long cpu_arch_name 266 .long cpu_elf_name 267 .long HWCAP_SWP|HWCAP_HALF|HWCAP_THUMB|HWCAP_FAST_MULT|HWCAP_EDSP|HWCAP_TLS 268 .long cpu_pj4_name 269 .long v6_processor_functions 270 .long v6wbi_tlb_fns 271 .long v6_user_fns 272 .long v6_cache_fns 273 .size __pj4_v6_proc_info, . - __pj4_v6_proc_info 274