1 /* cpufunc.h,v 1.40.22.4 2007/11/08 10:59:33 matt Exp */ 2 3 /* 4 * Copyright (c) 1997 Mark Brinicombe. 5 * Copyright (c) 1997 Causality Limited 6 * All rights reserved. 7 * 8 * Redistribution and use in source and binary forms, with or without 9 * modification, are permitted provided that the following conditions 10 * are met: 11 * 1. Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in the 15 * documentation and/or other materials provided with the distribution. 16 * 3. All advertising materials mentioning features or use of this software 17 * must display the following acknowledgement: 18 * This product includes software developed by Causality Limited. 19 * 4. The name of Causality Limited may not be used to endorse or promote 20 * products derived from this software without specific prior written 21 * permission. 22 * 23 * THIS SOFTWARE IS PROVIDED BY CAUSALITY LIMITED ``AS IS'' AND ANY EXPRESS 24 * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 25 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE 26 * DISCLAIMED. IN NO EVENT SHALL CAUSALITY LIMITED BE LIABLE FOR ANY DIRECT, 27 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 28 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR 29 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 30 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 31 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 32 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 33 * SUCH DAMAGE. 34 * 35 * RiscBSD kernel project 36 * 37 * cpufunc.h 38 * 39 * Prototypes for cpu, mmu and tlb related functions. 40 */ 41 42 #ifndef _ARM32_CPUFUNC_H_ 43 #define _ARM32_CPUFUNC_H_ 44 45 #ifdef _KERNEL 46 47 #include <sys/types.h> 48 #include <arm/armreg.h> 49 #include <arm/cpuconf.h> 50 #include <arm/armreg.h> 51 52 struct cpu_functions { 53 54 /* CPU functions */ 55 56 u_int (*cf_id) (void); 57 void (*cf_cpwait) (void); 58 59 /* MMU functions */ 60 61 u_int (*cf_control) (u_int, u_int); 62 void (*cf_domains) (u_int); 63 void (*cf_setttb) (u_int); 64 u_int (*cf_faultstatus) (void); 65 u_int (*cf_faultaddress) (void); 66 67 /* TLB functions */ 68 69 void (*cf_tlb_flushID) (void); 70 void (*cf_tlb_flushID_SE) (u_int); 71 void (*cf_tlb_flushI) (void); 72 void (*cf_tlb_flushI_SE) (u_int); 73 void (*cf_tlb_flushD) (void); 74 void (*cf_tlb_flushD_SE) (u_int); 75 76 /* 77 * Cache operations: 78 * 79 * We define the following primitives: 80 * 81 * icache_sync_all Synchronize I-cache 82 * icache_sync_range Synchronize I-cache range 83 * 84 * dcache_wbinv_all Write-back and Invalidate D-cache 85 * dcache_wbinv_range Write-back and Invalidate D-cache range 86 * dcache_inv_range Invalidate D-cache range 87 * dcache_wb_range Write-back D-cache range 88 * 89 * idcache_wbinv_all Write-back and Invalidate D-cache, 90 * Invalidate I-cache 91 * idcache_wbinv_range Write-back and Invalidate D-cache, 92 * Invalidate I-cache range 93 * 94 * Note that the ARM term for "write-back" is "clean". We use 95 * the term "write-back" since it's a more common way to describe 96 * the operation. 97 * 98 * There are some rules that must be followed: 99 * 100 * I-cache Synch (all or range): 101 * The goal is to synchronize the instruction stream, 102 * so you may beed to write-back dirty D-cache blocks 103 * first. If a range is requested, and you can't 104 * synchronize just a range, you have to hit the whole 105 * thing. 106 * 107 * D-cache Write-Back and Invalidate range: 108 * If you can't WB-Inv a range, you must WB-Inv the 109 * entire D-cache. 110 * 111 * D-cache Invalidate: 112 * If you can't Inv the D-cache, you must Write-Back 113 * and Invalidate. Code that uses this operation 114 * MUST NOT assume that the D-cache will not be written 115 * back to memory. 116 * 117 * D-cache Write-Back: 118 * If you can't Write-back without doing an Inv, 119 * that's fine. Then treat this as a WB-Inv. 120 * Skipping the invalidate is merely an optimization. 121 * 122 * All operations: 123 * Valid virtual addresses must be passed to each 124 * cache operation. 125 */ 126 void (*cf_icache_sync_all) (void); 127 void (*cf_icache_sync_range) (vaddr_t, vsize_t); 128 129 void (*cf_dcache_wbinv_all) (void); 130 void (*cf_dcache_wbinv_range)(vaddr_t, vsize_t); 131 void (*cf_dcache_inv_range) (vaddr_t, vsize_t); 132 void (*cf_dcache_wb_range) (vaddr_t, vsize_t); 133 134 void (*cf_idcache_wbinv_all) (void); 135 void (*cf_idcache_wbinv_range)(vaddr_t, vsize_t); 136 137 /* Other functions */ 138 139 void (*cf_flush_prefetchbuf) (void); 140 void (*cf_drain_writebuf) (void); 141 void (*cf_flush_brnchtgt_C) (void); 142 void (*cf_flush_brnchtgt_E) (u_int); 143 144 void (*cf_sleep) (int mode); 145 146 /* Soft functions */ 147 148 int (*cf_dataabt_fixup) (void *); 149 int (*cf_prefetchabt_fixup) (void *); 150 151 void (*cf_context_switch) (u_int); 152 153 void (*cf_setup) (char *); 154 }; 155 156 extern struct cpu_functions cpufuncs; 157 extern u_int cputype; 158 159 #define cpu_id() cpufuncs.cf_id() 160 161 #define cpu_control(c, e) cpufuncs.cf_control(c, e) 162 #define cpu_domains(d) cpufuncs.cf_domains(d) 163 #define cpu_setttb(t) cpufuncs.cf_setttb(t) 164 #define cpu_faultstatus() cpufuncs.cf_faultstatus() 165 #define cpu_faultaddress() cpufuncs.cf_faultaddress() 166 167 #define cpu_tlb_flushID() cpufuncs.cf_tlb_flushID() 168 #define cpu_tlb_flushID_SE(e) cpufuncs.cf_tlb_flushID_SE(e) 169 #define cpu_tlb_flushI() cpufuncs.cf_tlb_flushI() 170 #define cpu_tlb_flushI_SE(e) cpufuncs.cf_tlb_flushI_SE(e) 171 #define cpu_tlb_flushD() cpufuncs.cf_tlb_flushD() 172 #define cpu_tlb_flushD_SE(e) cpufuncs.cf_tlb_flushD_SE(e) 173 174 #define cpu_icache_sync_all() cpufuncs.cf_icache_sync_all() 175 #define cpu_icache_sync_range(a, s) cpufuncs.cf_icache_sync_range((a), (s)) 176 177 #define cpu_dcache_wbinv_all() cpufuncs.cf_dcache_wbinv_all() 178 #define cpu_dcache_wbinv_range(a, s) cpufuncs.cf_dcache_wbinv_range((a), (s)) 179 #define cpu_dcache_inv_range(a, s) cpufuncs.cf_dcache_inv_range((a), (s)) 180 #define cpu_dcache_wb_range(a, s) cpufuncs.cf_dcache_wb_range((a), (s)) 181 182 #define cpu_idcache_wbinv_all() cpufuncs.cf_idcache_wbinv_all() 183 #define cpu_idcache_wbinv_range(a, s) cpufuncs.cf_idcache_wbinv_range((a), (s)) 184 185 #define cpu_flush_prefetchbuf() cpufuncs.cf_flush_prefetchbuf() 186 #define cpu_drain_writebuf() cpufuncs.cf_drain_writebuf() 187 #define cpu_flush_brnchtgt_C() cpufuncs.cf_flush_brnchtgt_C() 188 #define cpu_flush_brnchtgt_E(e) cpufuncs.cf_flush_brnchtgt_E(e) 189 190 #define cpu_sleep(m) cpufuncs.cf_sleep(m) 191 192 #define cpu_dataabt_fixup(a) cpufuncs.cf_dataabt_fixup(a) 193 #define cpu_prefetchabt_fixup(a) cpufuncs.cf_prefetchabt_fixup(a) 194 #define ABORT_FIXUP_OK 0 /* fixup succeeded */ 195 #define ABORT_FIXUP_FAILED 1 /* fixup failed */ 196 #define ABORT_FIXUP_RETURN 2 /* abort handler should return */ 197 198 #define cpu_context_switch(a) cpufuncs.cf_context_switch(a) 199 #define cpu_setup(a) cpufuncs.cf_setup(a) 200 201 int set_cpufuncs (void); 202 int set_cpufuncs_id (u_int); 203 #define ARCHITECTURE_NOT_PRESENT 1 /* known but not configured */ 204 #define ARCHITECTURE_NOT_SUPPORTED 2 /* not known */ 205 206 void cpufunc_nullop (void); 207 int cpufunc_null_fixup (void *); 208 int early_abort_fixup (void *); 209 int late_abort_fixup (void *); 210 u_int cpufunc_id (void); 211 u_int cpufunc_control (u_int, u_int); 212 void cpufunc_domains (u_int); 213 u_int cpufunc_faultstatus (void); 214 u_int cpufunc_faultaddress (void); 215 216 #ifdef CPU_ARM2 217 u_int arm2_id (void); 218 #endif /* CPU_ARM2 */ 219 220 #ifdef CPU_ARM250 221 u_int arm250_id (void); 222 #endif 223 224 #ifdef CPU_ARM3 225 u_int arm3_control (u_int, u_int); 226 void arm3_cache_flush (void); 227 #endif /* CPU_ARM3 */ 228 229 #if defined(CPU_ARM6) || defined(CPU_ARM7) 230 void arm67_setttb (u_int); 231 void arm67_tlb_flush (void); 232 void arm67_tlb_purge (u_int); 233 void arm67_cache_flush (void); 234 void arm67_context_switch (u_int); 235 #endif /* CPU_ARM6 || CPU_ARM7 */ 236 237 #ifdef CPU_ARM6 238 void arm6_setup (char *); 239 #endif /* CPU_ARM6 */ 240 241 #ifdef CPU_ARM7 242 void arm7_setup (char *); 243 #endif /* CPU_ARM7 */ 244 245 #ifdef CPU_ARM7TDMI 246 int arm7_dataabt_fixup (void *); 247 void arm7tdmi_setup (char *); 248 void arm7tdmi_setttb (u_int); 249 void arm7tdmi_tlb_flushID (void); 250 void arm7tdmi_tlb_flushID_SE (u_int); 251 void arm7tdmi_cache_flushID (void); 252 void arm7tdmi_context_switch (u_int); 253 #endif /* CPU_ARM7TDMI */ 254 255 #ifdef CPU_ARM8 256 void arm8_setttb (u_int); 257 void arm8_tlb_flushID (void); 258 void arm8_tlb_flushID_SE (u_int); 259 void arm8_cache_flushID (void); 260 void arm8_cache_flushID_E (u_int); 261 void arm8_cache_cleanID (void); 262 void arm8_cache_cleanID_E (u_int); 263 void arm8_cache_purgeID (void); 264 void arm8_cache_purgeID_E (u_int entry); 265 266 void arm8_cache_syncI (void); 267 void arm8_cache_cleanID_rng (vaddr_t, vsize_t); 268 void arm8_cache_cleanD_rng (vaddr_t, vsize_t); 269 void arm8_cache_purgeID_rng (vaddr_t, vsize_t); 270 void arm8_cache_purgeD_rng (vaddr_t, vsize_t); 271 void arm8_cache_syncI_rng (vaddr_t, vsize_t); 272 273 void arm8_context_switch (u_int); 274 275 void arm8_setup (char *); 276 277 u_int arm8_clock_config (u_int, u_int); 278 #endif 279 280 #ifdef CPU_FA526 281 void fa526_setup (char *); 282 void fa526_setttb (u_int); 283 void fa526_context_switch (u_int); 284 void fa526_cpu_sleep (int); 285 void fa526_tlb_flushI_SE (u_int); 286 void fa526_tlb_flushID_SE (u_int); 287 void fa526_flush_prefetchbuf (void); 288 void fa526_flush_brnchtgt_E (u_int); 289 290 void fa526_icache_sync_all (void); 291 void fa526_icache_sync_range(vaddr_t, vsize_t); 292 void fa526_dcache_wbinv_all (void); 293 void fa526_dcache_wbinv_range(vaddr_t, vsize_t); 294 void fa526_dcache_inv_range (vaddr_t, vsize_t); 295 void fa526_dcache_wb_range (vaddr_t, vsize_t); 296 void fa526_idcache_wbinv_all(void); 297 void fa526_idcache_wbinv_range(vaddr_t, vsize_t); 298 #endif 299 300 #ifdef CPU_SA110 301 void sa110_setup (char *); 302 void sa110_context_switch (u_int); 303 #endif /* CPU_SA110 */ 304 305 #if defined(CPU_SA1100) || defined(CPU_SA1110) 306 void sa11x0_drain_readbuf (void); 307 308 void sa11x0_context_switch (u_int); 309 void sa11x0_cpu_sleep (int); 310 311 void sa11x0_setup (char *); 312 #endif 313 314 #if defined(CPU_SA110) || defined(CPU_SA1100) || defined(CPU_SA1110) 315 void sa1_setttb (u_int); 316 317 void sa1_tlb_flushID_SE (u_int); 318 319 void sa1_cache_flushID (void); 320 void sa1_cache_flushI (void); 321 void sa1_cache_flushD (void); 322 void sa1_cache_flushD_SE (u_int); 323 324 void sa1_cache_cleanID (void); 325 void sa1_cache_cleanD (void); 326 void sa1_cache_cleanD_E (u_int); 327 328 void sa1_cache_purgeID (void); 329 void sa1_cache_purgeID_E (u_int); 330 void sa1_cache_purgeD (void); 331 void sa1_cache_purgeD_E (u_int); 332 333 void sa1_cache_syncI (void); 334 void sa1_cache_cleanID_rng (vaddr_t, vsize_t); 335 void sa1_cache_cleanD_rng (vaddr_t, vsize_t); 336 void sa1_cache_purgeID_rng (vaddr_t, vsize_t); 337 void sa1_cache_purgeD_rng (vaddr_t, vsize_t); 338 void sa1_cache_syncI_rng (vaddr_t, vsize_t); 339 340 #endif 341 342 #ifdef CPU_ARM9 343 void arm9_setttb (u_int); 344 345 void arm9_tlb_flushID_SE (u_int); 346 347 void arm9_icache_sync_all (void); 348 void arm9_icache_sync_range (vaddr_t, vsize_t); 349 350 void arm9_dcache_wbinv_all (void); 351 void arm9_dcache_wbinv_range (vaddr_t, vsize_t); 352 void arm9_dcache_inv_range (vaddr_t, vsize_t); 353 void arm9_dcache_wb_range (vaddr_t, vsize_t); 354 355 void arm9_idcache_wbinv_all (void); 356 void arm9_idcache_wbinv_range (vaddr_t, vsize_t); 357 358 void arm9_context_switch (u_int); 359 360 void arm9_setup (char *); 361 362 extern unsigned arm9_dcache_sets_max; 363 extern unsigned arm9_dcache_sets_inc; 364 extern unsigned arm9_dcache_index_max; 365 extern unsigned arm9_dcache_index_inc; 366 #endif 367 368 #if defined(CPU_ARM9E) || defined(CPU_ARM10) 369 void arm10_tlb_flushID_SE (u_int); 370 void arm10_tlb_flushI_SE (u_int); 371 372 void arm10_context_switch (u_int); 373 374 void arm10_setup (char *); 375 #endif 376 377 #if defined(CPU_ARM9E) || defined (CPU_ARM10) 378 void armv5_ec_setttb (u_int); 379 380 void armv5_ec_icache_sync_all (void); 381 void armv5_ec_icache_sync_range (vaddr_t, vsize_t); 382 383 void armv5_ec_dcache_wbinv_all (void); 384 void armv5_ec_dcache_wbinv_range (vaddr_t, vsize_t); 385 void armv5_ec_dcache_inv_range (vaddr_t, vsize_t); 386 void armv5_ec_dcache_wb_range (vaddr_t, vsize_t); 387 388 void armv5_ec_idcache_wbinv_all (void); 389 void armv5_ec_idcache_wbinv_range (vaddr_t, vsize_t); 390 #endif 391 392 #if defined (CPU_ARM10) 393 void armv5_setttb (u_int); 394 395 void armv5_icache_sync_all (void); 396 void armv5_icache_sync_range (vaddr_t, vsize_t); 397 398 void armv5_dcache_wbinv_all (void); 399 void armv5_dcache_wbinv_range (vaddr_t, vsize_t); 400 void armv5_dcache_inv_range (vaddr_t, vsize_t); 401 void armv5_dcache_wb_range (vaddr_t, vsize_t); 402 403 void armv5_idcache_wbinv_all (void); 404 void armv5_idcache_wbinv_range (vaddr_t, vsize_t); 405 406 extern unsigned armv5_dcache_sets_max; 407 extern unsigned armv5_dcache_sets_inc; 408 extern unsigned armv5_dcache_index_max; 409 extern unsigned armv5_dcache_index_inc; 410 #endif 411 412 #if defined(CPU_ARM11) || defined(CPU_CORTEX) 413 void arm11_setttb (u_int); 414 415 void arm11_tlb_flushID_SE (u_int); 416 void arm11_tlb_flushI_SE (u_int); 417 418 void arm11_context_switch (u_int); 419 420 void arm11_cpu_sleep (int); 421 void arm11_setup (char *string); 422 void arm11_tlb_flushID (void); 423 void arm11_tlb_flushI (void); 424 void arm11_tlb_flushD (void); 425 void arm11_tlb_flushD_SE (u_int va); 426 427 void armv11_dcache_wbinv_all (void); 428 void armv11_idcache_wbinv_all(void); 429 430 void arm11_drain_writebuf (void); 431 void arm11_sleep (int); 432 433 void armv6_setttb (u_int); 434 435 void armv6_icache_sync_all (void); 436 void armv6_icache_sync_range (vaddr_t, vsize_t); 437 438 void armv6_dcache_wbinv_all (void); 439 void armv6_dcache_wbinv_range (vaddr_t, vsize_t); 440 void armv6_dcache_inv_range (vaddr_t, vsize_t); 441 void armv6_dcache_wb_range (vaddr_t, vsize_t); 442 443 void armv6_idcache_wbinv_all (void); 444 void armv6_idcache_wbinv_range (vaddr_t, vsize_t); 445 #endif 446 447 #if defined(CPU_CORTEX) 448 void armv7_setttb(u_int); 449 450 void armv7_icache_sync_range(vaddr_t, vsize_t); 451 void armv7_dcache_wb_range(vaddr_t, vsize_t); 452 void armv7_dcache_wbinv_range(vaddr_t, vsize_t); 453 void armv7_dcache_inv_range(vaddr_t, vsize_t); 454 void armv7_idcache_wbinv_range(vaddr_t, vsize_t); 455 456 void armv7_dcache_wbinv_all (void); 457 void armv7_idcache_wbinv_all(void); 458 void armv7_icache_sync_all(void); 459 void armv7_cpu_sleep(int); 460 void armv7_context_switch(u_int); 461 void armv7_tlb_flushID_SE(u_int); 462 void armv7_setup (char *string); 463 #endif 464 465 466 #if defined(CPU_ARM1136) 467 void arm1136_setttb (u_int); 468 void arm1136_idcache_wbinv_all (void); 469 void arm1136_dcache_wbinv_all (void); 470 void arm1136_icache_sync_all (void); 471 void arm1136_flush_prefetchbuf (void); 472 void arm1136_icache_sync_range (vaddr_t, vsize_t); 473 void arm1136_idcache_wbinv_range (vaddr_t, vsize_t); 474 void arm1136_setup (char *string); 475 void arm1136_sleep_rev0 (int); /* for errata 336501 */ 476 #endif 477 478 479 #if defined(CPU_ARM9) || defined(CPU_ARM9E) || defined(CPU_ARM10) || \ 480 defined(CPU_SA110) || defined(CPU_SA1100) || defined(CPU_SA1110) || \ 481 defined(CPU_FA526) || \ 482 defined(CPU_XSCALE_80200) || defined(CPU_XSCALE_80321) || \ 483 defined(__CPU_XSCALE_PXA2XX) || defined(CPU_XSCALE_IXP425) || \ 484 defined(CPU_CORTEX) 485 486 void armv4_tlb_flushID (void); 487 void armv4_tlb_flushI (void); 488 void armv4_tlb_flushD (void); 489 void armv4_tlb_flushD_SE (u_int); 490 491 void armv4_drain_writebuf (void); 492 #endif 493 494 #if defined(CPU_IXP12X0) 495 void ixp12x0_drain_readbuf (void); 496 void ixp12x0_context_switch (u_int); 497 void ixp12x0_setup (char *); 498 #endif 499 500 #if defined(CPU_XSCALE_80200) || defined(CPU_XSCALE_80321) || \ 501 defined(__CPU_XSCALE_PXA2XX) || defined(CPU_XSCALE_IXP425) || \ 502 defined(CPU_CORTEX) 503 504 void xscale_cpwait (void); 505 #define cpu_cpwait() cpufuncs.cf_cpwait() 506 507 void xscale_cpu_sleep (int); 508 509 u_int xscale_control (u_int, u_int); 510 511 void xscale_setttb (u_int); 512 513 void xscale_tlb_flushID_SE (u_int); 514 515 void xscale_cache_flushID (void); 516 void xscale_cache_flushI (void); 517 void xscale_cache_flushD (void); 518 void xscale_cache_flushD_SE (u_int); 519 520 void xscale_cache_cleanID (void); 521 void xscale_cache_cleanD (void); 522 void xscale_cache_cleanD_E (u_int); 523 524 void xscale_cache_clean_minidata (void); 525 526 void xscale_cache_purgeID (void); 527 void xscale_cache_purgeID_E (u_int); 528 void xscale_cache_purgeD (void); 529 void xscale_cache_purgeD_E (u_int); 530 531 void xscale_cache_syncI (void); 532 void xscale_cache_cleanID_rng (vaddr_t, vsize_t); 533 void xscale_cache_cleanD_rng (vaddr_t, vsize_t); 534 void xscale_cache_purgeID_rng (vaddr_t, vsize_t); 535 void xscale_cache_purgeD_rng (vaddr_t, vsize_t); 536 void xscale_cache_syncI_rng (vaddr_t, vsize_t); 537 void xscale_cache_flushD_rng (vaddr_t, vsize_t); 538 539 void xscale_context_switch (u_int); 540 541 void xscale_setup (char *); 542 #endif /* CPU_XSCALE_80200 || CPU_XSCALE_80321 || __CPU_XSCALE_PXA2XX || CPU_XSCALE_IXP425 || CPU_CORTEX */ 543 544 #define tlb_flush cpu_tlb_flushID 545 #define setttb cpu_setttb 546 #define drain_writebuf cpu_drain_writebuf 547 548 #ifndef cpu_cpwait 549 #define cpu_cpwait() 550 #endif 551 552 /* 553 * Macros for manipulating CPU interrupts 554 */ 555 #ifdef __PROG32 556 static __inline u_int32_t __set_cpsr_c(uint32_t bic, uint32_t eor) __attribute__((__unused__)); 557 static __inline u_int32_t disable_interrupts(uint32_t mask) __attribute__((__unused__)); 558 static __inline u_int32_t enable_interrupts(uint32_t mask) __attribute__((__unused__)); 559 560 static __inline uint32_t 561 __set_cpsr_c(uint32_t bic, uint32_t eor) 562 { 563 uint32_t tmp, ret; 564 565 __asm volatile( 566 "mrs %0, cpsr\n" /* Get the CPSR */ 567 "bic %1, %0, %2\n" /* Clear bits */ 568 "eor %1, %1, %3\n" /* XOR bits */ 569 "msr cpsr_c, %1\n" /* Set the control field of CPSR */ 570 : "=&r" (ret), "=&r" (tmp) 571 : "r" (bic), "r" (eor) : "memory"); 572 573 return ret; 574 } 575 576 static __inline uint32_t 577 disable_interrupts(uint32_t mask) 578 { 579 uint32_t tmp, ret; 580 mask &= (I32_bit | F32_bit); 581 582 __asm volatile( 583 "mrs %0, cpsr\n" /* Get the CPSR */ 584 "orr %1, %0, %2\n" /* set bits */ 585 "msr cpsr_c, %1\n" /* Set the control field of CPSR */ 586 : "=&r" (ret), "=&r" (tmp) 587 : "r" (mask) 588 : "memory"); 589 590 return ret; 591 } 592 593 static __inline uint32_t 594 enable_interrupts(uint32_t mask) 595 { 596 uint32_t ret, tmp; 597 mask &= (I32_bit | F32_bit); 598 599 __asm volatile( 600 "mrs %0, cpsr\n" /* Get the CPSR */ 601 "bic %1, %0, %2\n" /* Clear bits */ 602 "msr cpsr_c, %1\n" /* Set the control field of CPSR */ 603 : "=&r" (ret), "=&r" (tmp) 604 : "r" (mask) 605 : "memory"); 606 607 return ret; 608 } 609 610 #define restore_interrupts(old_cpsr) \ 611 (__set_cpsr_c((I32_bit | F32_bit), (old_cpsr) & (I32_bit | F32_bit))) 612 613 static inline void cpsie(register_t psw) __attribute__((__unused__)); 614 static inline register_t cpsid(register_t psw) __attribute__((__unused__)); 615 616 static inline void 617 cpsie(register_t psw) 618 { 619 #ifdef _ARM_ARCH_6 620 if (!__builtin_constant_p(psw)) { 621 enable_interrupts(psw); 622 return; 623 } 624 switch (psw & (I32_bit|F32_bit)) { 625 case I32_bit: __asm("cpsie\ti"); break; 626 case F32_bit: __asm("cpsie\tf"); break; 627 case I32_bit|F32_bit: __asm("cpsie\tif"); break; 628 } 629 #else 630 enable_interrupts(psw); 631 #endif 632 } 633 634 static inline register_t 635 cpsid(register_t psw) 636 { 637 #ifdef _ARM_ARCH_6 638 register_t oldpsw; 639 if (!__builtin_constant_p(psw)) 640 return disable_interrupts(psw); 641 642 __asm("mrs %0, cpsr" : "=r"(oldpsw)); 643 switch (psw & (I32_bit|F32_bit)) { 644 case I32_bit: __asm("cpsid\ti"); break; 645 case F32_bit: __asm("cpsid\tf"); break; 646 case I32_bit|F32_bit: __asm("cpsid\tif"); break; 647 } 648 return oldpsw; 649 #else 650 return disable_interrupts(psw); 651 #endif 652 } 653 654 #else /* ! __PROG32 */ 655 #define disable_interrupts(mask) \ 656 (set_r15((mask) & (R15_IRQ_DISABLE | R15_FIQ_DISABLE), \ 657 (mask) & (R15_IRQ_DISABLE | R15_FIQ_DISABLE))) 658 659 #define enable_interrupts(mask) \ 660 (set_r15((mask) & (R15_IRQ_DISABLE | R15_FIQ_DISABLE), 0)) 661 662 #define restore_interrupts(old_r15) \ 663 (set_r15((R15_IRQ_DISABLE | R15_FIQ_DISABLE), \ 664 (old_r15) & (R15_IRQ_DISABLE | R15_FIQ_DISABLE))) 665 #endif /* __PROG32 */ 666 667 #ifdef __PROG32 668 /* Functions to manipulate the CPSR. */ 669 u_int SetCPSR(u_int, u_int); 670 u_int GetCPSR(void); 671 #else 672 /* Functions to manipulate the processor control bits in r15. */ 673 u_int set_r15(u_int, u_int); 674 u_int get_r15(void); 675 #endif /* __PROG32 */ 676 677 /* 678 * Functions to manipulate cpu r13 679 * (in arm/arm32/setstack.S) 680 */ 681 682 void set_stackptr (u_int, u_int); 683 u_int get_stackptr (u_int); 684 685 /* 686 * Miscellany 687 */ 688 689 int get_pc_str_offset (void); 690 691 /* 692 * CPU functions from locore.S 693 */ 694 695 void cpu_reset (void) __attribute__((__noreturn__)); 696 697 /* 698 * Cache info variables. 699 */ 700 701 /* PRIMARY CACHE VARIABLES */ 702 extern int arm_picache_size; 703 extern int arm_picache_line_size; 704 extern int arm_picache_ways; 705 706 extern int arm_pdcache_size; /* and unified */ 707 extern int arm_pdcache_line_size; 708 extern int arm_pdcache_ways; 709 extern int arm_cache_prefer_mask; 710 711 extern int arm_pcache_type; 712 extern int arm_pcache_unified; 713 714 extern int arm_dcache_align; 715 extern int arm_dcache_align_mask; 716 717 #endif /* _KERNEL */ 718 #endif /* _ARM32_CPUFUNC_H_ */ 719 720 /* End of cpufunc.h */ 721