#------------------------------------------------------------------------------ # # Copyright (c) 2008 - 2009, Apple Inc. All rights reserved.
# # This program and the accompanying materials # are licensed and made available under the terms and conditions of the BSD License # which accompanies this distribution. The full text of the license may be found at # http://opensource.org/licenses/bsd-license.php # # THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS, # WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED. # #------------------------------------------------------------------------------ .text .align 2 .globl ASM_PFX(Cp15IdCode) INTERWORK_FUNC(Cp15IdCode) .globl ASM_PFX(Cp15CacheInfo) INTERWORK_FUNC(Cp15CacheInfo) .globl ASM_PFX(ArmEnableInterrupts) INTERWORK_FUNC(ArmEnableInterrupts) .globl ASM_PFX(ArmDisableInterrupts) INTERWORK_FUNC(ArmDisableInterrupts) .globl ASM_PFX(ArmGetInterruptState) INTERWORK_FUNC(ArmGetInterruptState) .globl ASM_PFX(ArmEnableFiq) INTERWORK_FUNC(ArmEnableFiq) .globl ASM_PFX(ArmDisableFiq) INTERWORK_FUNC(ArmDisableFiq) .globl ASM_PFX(ArmGetFiqState) INTERWORK_FUNC(ArmGetFiqState) .globl ASM_PFX(ArmInvalidateTlb) INTERWORK_FUNC(ArmInvalidateTlb) .globl ASM_PFX(ArmSetTranslationTableBaseAddress) INTERWORK_FUNC(ArmSetTranslationTableBaseAddress) .globl ASM_PFX(ArmGetTranslationTableBaseAddress) INTERWORK_FUNC(ArmGetTranslationTableBaseAddress) .globl ASM_PFX(ArmSetDomainAccessControl) INTERWORK_FUNC(ArmSetDomainAccessControl) .globl ASM_PFX(CPSRMaskInsert) INTERWORK_FUNC(CPSRMaskInsert) .globl ASM_PFX(CPSRRead) INTERWORK_FUNC(CPSRRead) #------------------------------------------------------------------------------ ASM_PFX(Cp15IdCode): mrc p15,0,R0,c0,c0,0 bx LR ASM_PFX(Cp15CacheInfo): mrc p15,0,R0,c0,c0,1 bx LR ASM_PFX(ArmEnableInterrupts): mrs R0,CPSR bic R0,R0,#0x80 @Enable IRQ interrupts msr CPSR_c,R0 bx LR ASM_PFX(ArmDisableInterrupts): mrs R0,CPSR orr R1,R0,#0x80 @Disable IRQ interrupts msr CPSR_c,R1 tst R0,#0x80 moveq R0,#1 movne R0,#0 bx LR ASM_PFX(ArmGetInterruptState): mrs R0,CPSR tst R0,#0x80 @Check if IRQ is enabled. moveq R0,#1 movne R0,#0 bx LR ASM_PFX(ArmEnableFiq): mrs R0,CPSR bic R0,R0,#0x40 @Enable FIQ interrupts msr CPSR_c,R0 bx LR ASM_PFX(ArmDisableFiq): mrs R0,CPSR orr R1,R0,#0x40 @Disable FIQ interrupts msr CPSR_c,R1 tst R0,#0x80 moveq R0,#1 movne R0,#0 bx LR ASM_PFX(ArmGetFiqState): mrs R0,CPSR tst R0,#0x80 @Check if FIQ is enabled. moveq R0,#1 movne R0,#0 bx LR ASM_PFX(ArmInvalidateTlb): mov r0,#0 mcr p15,0,r0,c8,c7,0 bx lr ASM_PFX(ArmSetTranslationTableBaseAddress): mcr p15,0,r0,c2,c0,0 bx lr ASM_PFX(ArmGetTranslationTableBaseAddress): mrc p15,0,r0,c2,c0,0 bx lr ASM_PFX(ArmSetDomainAccessControl): mcr p15,0,r0,c3,c0,0 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 mrs r2, cpsr @ read the cpsr bic r2, r2, r0 @ clear mask in the cpsr 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) mov sp, r3 @ restore stack pointer ldmfd sp!, {r4-r12, lr} @ restore registers bx lr @ return (hopefully thumb-safe!) ASM_PFX(CPSRRead): mrs r0, cpsr bx lr ASM_FUNCTION_REMOVE_IF_UNREFERENCED