diff options
Diffstat (limited to 'ArmPkg/Library/ArmLib')
-rw-r--r-- | ArmPkg/Library/ArmLib/ArmV7/ArmLibSupport.S | 38 | ||||
-rw-r--r-- | ArmPkg/Library/ArmLib/ArmV7/ArmLibSupport.asm | 61 | ||||
-rw-r--r-- | ArmPkg/Library/ArmLib/ArmV7/ArmV7Support.asm | 1 |
3 files changed, 77 insertions, 23 deletions
diff --git a/ArmPkg/Library/ArmLib/ArmV7/ArmLibSupport.S b/ArmPkg/Library/ArmLib/ArmV7/ArmLibSupport.S index cdfd3dc9cf..9932e1462b 100644 --- a/ArmPkg/Library/ArmLib/ArmV7/ArmLibSupport.S +++ b/ArmPkg/Library/ArmLib/ArmV7/ArmLibSupport.S @@ -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 @@ -12,8 +12,6 @@ # #------------------------------------------------------------------------------ -.text -.align 2 .globl ASM_PFX(Cp15IdCode) .globl ASM_PFX(Cp15CacheInfo) .globl ASM_PFX(ArmEnableInterrupts) @@ -26,11 +24,14 @@ .globl ASM_PFX(ArmSetTranslationTableBaseAddress) .globl ASM_PFX(ArmGetTranslationTableBaseAddress) .globl ASM_PFX(ArmSetDomainAccessControl) +.globl ASM_PFX(ArmUpdateTranslationTableEntry) .globl ASM_PFX(CPSRMaskInsert) .globl ASM_PFX(CPSRRead) .globl ASM_PFX(ReadCCSIDR) .globl ASM_PFX(ReadCLIDR) +.text +.align 2 #------------------------------------------------------------------------------ @@ -67,7 +68,7 @@ ASM_PFX(ArmDisableFiq): ASM_PFX(ArmGetFiqState): mrs R0,CPSR - tst R0,#0x30 @Check if IRQ is enabled. + tst R0,#0x40 @Check if FIQ is enabled. moveq R0,#1 movne R0,#0 bx LR @@ -75,6 +76,8 @@ ASM_PFX(ArmGetFiqState): ASM_PFX(ArmInvalidateTlb): mov r0,#0 mcr p15,0,r0,c8,c7,0 + mcr p15,0,R9,c7,c5,6 @ BPIALL Invalidate Branch predictor array. R9 == NoOp + dsb isb bx lr @@ -85,6 +88,7 @@ ASM_PFX(ArmSetTranslationTableBaseAddress): ASM_PFX(ArmGetTranslationTableBaseAddress): mrc p15,0,r0,c2,c0,0 + isb bx lr @@ -93,6 +97,21 @@ ASM_PFX(ArmSetDomainAccessControl): isb bx lr +// +//VOID +//ArmUpdateTranslationTableEntry ( +// IN VOID *TranslationTableEntry // R0 +// IN VOID *MVA // R1 +// ); +ASM_PFX(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 + ASM_PFX(CPSRMaskInsert): @ on entry, r0 is the mask and r1 is the field to insert stmfd sp!, {r4-r12, lr} @ save all the banked registers mov r3, sp @ copy the stack pointer into a non-banked register @@ -101,6 +120,7 @@ ASM_PFX(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 mov sp, r3 @ restore stack pointer ldmfd sp!, {r4-r12, lr} @ restore registers bx lr @ return (hopefully thumb-safe!) @@ -109,14 +129,22 @@ ASM_PFX(CPSRRead): mrs r0, cpsr bx lr +// UINT32 +// ReadCCSIDR ( +// IN UINT32 CSSELR +// ) ASM_PFX(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 - +// UINT32 +// ReadCLIDR ( +// IN UINT32 CSSELR +// ) ASM_PFX(ReadCLIDR): mrc p15,1,r0,c0,c0,1 @ Read CP15 Cache Level ID Register + bx lr ASM_FUNCTION_REMOVE_IF_UNREFERENCED 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 diff --git a/ArmPkg/Library/ArmLib/ArmV7/ArmV7Support.asm b/ArmPkg/Library/ArmLib/ArmV7/ArmV7Support.asm index 6d65b7e727..64c8207251 100644 --- a/ArmPkg/Library/ArmLib/ArmV7/ArmV7Support.asm +++ b/ArmPkg/Library/ArmLib/ArmV7/ArmV7Support.asm @@ -114,6 +114,7 @@ ArmDisableMmu isb bx LR + ArmEnableDataCache ldr R1,=DC_ON mrc p15,0,R0,c1,c0,0 ;Read control register configuration data |