control.s

HAL硬件抽象层源码

;***************************************************************************
;  Copyright (C) Hynix Semiconductor Limited 2002. All rights reserved. 
;***************************************************************************

        	EXPORT	uHALir_CpuControlWrite
        	EXPORT	uHALir_CpuControlRead
        	EXPORT  uHALir_CpuIdRead

	IMPORT	uHALir_EnterSvcMode	
	IMPORT	uHALir_ExitSvcMode	
	IMPORT	uHALir_ReadCPUIdFromBoard

	KEEP

	AREA	uHAL_Control, CODE, READONLY


; ------------------------------------------------------------------
; void uHALir_CpuControlWrite(unsigned int)
;
;	Routine to write the given value to Coprocessor15 Reg 1

uHALir_CpuControlWrite
	mov	pc,lr
        

; ------------------------------------------------------------------
; unsigned int uHALir_CpuControlRead(void)
;
;	Routine to read the value of Coprocessor15 Reg 1

uHALir_CpuControlRead
	mov	r0,#0
	mov	pc,lr
        

; ------------------------------------------------------------------
; unsigned int uHALir_CpuIdRead(void)
;
;	Routine to read the value of Coprocessor15 Reg 0

uHALir_CpuIdRead
	STMFD	sp!, {r4-r6, r14}	; save working registers

	; destroys r4, r5, returns current mode in r0
	BL	uHALir_EnterSvcMode
	MOV	r4, r0

	; Look for a platform specific routine
	BL	uHALir_ReadCPUIdFromBoard
	MOV	r0, r4

	BL	uHALir_ExitSvcMode	; needs old mode in r0
	MOV	r0, r6
	LDMFD	sp!, {r4-r6, pc}	; restore registers & return
	
        END