diff options
Diffstat (limited to 'ArmPkg/Library/ArmLib/ArmV7/ArmLibSupport.asm')
-rw-r--r-- | ArmPkg/Library/ArmLib/ArmV7/ArmLibSupport.asm | 61 |
1 files changed, 43 insertions, 18 deletions
diff --git a/ArmPkg/Library/ArmLib/ArmV7/ArmLibSupport.asm b/ArmPkg/Library/ArmLib/ArmV7/ArmLibSupport.asm index 65b3683f26..b0350998d1 100644 --- a/ArmPkg/Library/ArmLib/ArmV7/ArmLibSupport.asm +++ b/ArmPkg/Library/ArmLib/ArmV7/ArmLibSupport.asm @@ -1,6 +1,6 @@ //------------------------------------------------------------------------------ // -// Copyright (c) 2008-2009 Apple Inc. All rights reserved. +// Copyright (c) 2008-2010 Apple Inc. All rights reserved. // // All rights reserved. This program and the accompanying materials // are licensed and made available under the terms and conditions of the BSD License @@ -25,6 +25,7 @@ EXPORT ArmSetTranslationTableBaseAddress EXPORT ArmGetTranslationTableBaseAddress EXPORT ArmSetDomainAccessControl + EXPORT ArmUpdateTranslationTableEntry EXPORT CPSRMaskInsert EXPORT CPSRRead EXPORT ReadCCSIDR @@ -32,6 +33,9 @@ AREA ArmLibSupport, CODE, READONLY + +//------------------------------------------------------------------------------ + Cp15IdCode mrc p15,0,R0,c0,c0,0 bx LR @@ -41,11 +45,11 @@ Cp15CacheInfo bx LR ArmEnableInterrupts - CPSIE i + cpsie i bx LR ArmDisableInterrupts - CPSID i + cpsid i bx LR ArmGetInterruptState @@ -54,18 +58,18 @@ ArmGetInterruptState moveq R0,#1 movne R0,#0 bx LR - + ArmEnableFiq - CPSIE f + cpsie f bx LR ArmDisableFiq - CPSID f + cpsid f bx LR ArmGetFiqState mrs R0,CPSR - tst R0,#0x40 ;Check if IRQ is enabled. + tst R0,#0x40 ;Check if FIQ is enabled. moveq R0,#1 movne R0,#0 bx LR @@ -73,22 +77,40 @@ ArmGetFiqState ArmInvalidateTlb mov r0,#0 mcr p15,0,r0,c8,c7,0 - ISB + mcr p15,0,R9,c7,c5,6 ; BPIALL Invalidate Branch predictor array. R9 == NoOp + dsb + isb bx lr ArmSetTranslationTableBaseAddress mcr p15,0,r0,c2,c0,0 - ISB + isb bx lr ArmGetTranslationTableBaseAddress mrc p15,0,r0,c2,c0,0 - ISB + isb bx lr + ArmSetDomainAccessControl mcr p15,0,r0,c3,c0,0 - ISB + isb + bx lr + +// +//VOID +//ArmUpdateTranslationTableEntry ( +// IN VOID *TranslationTableEntry // R0 +// IN VOID *MVA // R1 +// ); +ArmUpdateTranslationTableEntry + mcr p15,0,R0,c7,c14,1 ; DCCIMVAC Clean data cache by MVA + dsb + mcr p15,0,R1,c8,c7,1 ; TLBIMVA TLB Invalidate MVA + mcr p15,0,R9,c7,c5,6 ; BPIALL Invalidate Branch predictor array. R9 == NoOp + dsb + isb bx lr CPSRMaskInsert ; on entry, r0 is the mask and r1 is the field to insert @@ -99,7 +121,7 @@ CPSRMaskInsert ; on entry, r0 is the mask and r1 is the field to in and r1, r1, r0 ; clear bits outside the mask in the input orr r2, r2, r1 ; set field msr cpsr_cxsf, r2 ; write back cpsr (may have caused a mode switch) - ISB + isb mov sp, r3 ; restore stack pointer ldmfd sp!, {r4-r12, lr} ; restore registers bx lr ; return (hopefully thumb-safe!) @@ -114,10 +136,10 @@ CPSRRead // IN UINT32 CSSELR // ) ReadCCSIDR - MCR p15,2,r0,c0,c0,0 ; Write Cache Size Selection Register (CSSELR) - ISB - MRC p15,1,r0,c0,c0,0 ; Read current CP15 Cache Size ID Register (CCSIDR) - BX lr + mcr p15,2,r0,c0,c0,0 ; Write Cache Size Selection Register (CSSELR) + isb + mrc p15,1,r0,c0,c0,0 ; Read current CP15 Cache Size ID Register (CCSIDR) + bx lr // UINT32 @@ -125,7 +147,10 @@ ReadCCSIDR // IN UINT32 CSSELR // ) ReadCLIDR - MRC p15,1,r0,c0,c0,1 ; Read CP15 Cache Level ID Register - END + mrc p15,1,r0,c0,c0,1 ; Read CP15 Cache Level ID Register + bx lr + + +END |