?? viccontrol.s
字號:
;/****************************************Copyright (c)***************************************************
;** Guangzhou ZHIYUAN electronics Co.,LTD.
;**
;** http://www.embedtools.com
;**
;**--------------File Info-------------------------------------------------------------------------------
;** File name: vicControl.s
;** Last modified Date: 2007-06-12
;** Last Version: 1.0
;** Descriptions: Provide VIC_Control in prerogative mode
;**------------------------------------------------------------------------------------------------------
;** Created by: LinEnqiang
;** Created date: 2007-06-12
;** Version: 1.0
;** Descriptions: The original version
;**
;**------------------------------------------------------------------------------------------------------
;** Modified by: LinEnqiang
;** Modified date: 2008-04-30
;** Version: 1.1
;** Descriptions: 統一于代碼規范V1.2
;**------------------------------------------------------------------------------------------------------
;** Modified by: LinEnqiang
;** Modified date: 2008-06-10
;** Version: 1.2
;** Descriptions: 增加VIC全局開關功能
;********************************************************************************************************/
INCLUDE LPC2400.INC ; Include the head file 引入頭文件
;/********************************************************************************************************
; 宏定義
;********************************************************************************************************/
NoInt EQU 0x80
NoFIQ EQU 0x40
SVC32Mode EQU 0x13
SYS32Mode EQU 0x1f
IMPORT StackUsr
EXPORT RunFirst
EXPORT vicControl
EXPORT SoftwareInterrupt
CODE32
AREA |RUNFIRST|, CODE, READONLY
;/********************************************************************************************************
;** Function name: RunFirst
;** Descriptions: VIC管理初始化
;** input parameters: none
;** output parameters: none
;** Returned value: none
;** Created by: LinEnqiang
;** Created Date: 2008/04/30
;**-------------------------------------------------------------------------------------------------------
;** Modified by:
;** Modified date:
;**-------------------------------------------------------------------------------------------------------
;********************************************************************************************************/
RunFirst
LDR R2, =VICIntEnClr
MVN R3, #0x00
STR R3, [R2]
LDR R2, =VICIntSelect
MOV R3, #0x00
STR R3, [R2]
LDR R0, =VICVectAddr0
MOV R1, #0
MOV R2, #0
MOV R3, #0
MOV R4, #0
MOV R5, #0
MOV R6, #0
MOV R7, #0
MOV R8, #0
STMIA R0!, {R1-R8}
STMIA R0!, {R1-R8}
STMIA R0!, {R1-R8}
STMIA R0!, {R1-R8}
LDR R0, =VICVectPri0
STMIA R0!, {R1-R8}
STMIA R0!, {R1-R8}
STMIA R0!, {R1-R8}
STMIA R0!, {R1-R8}
LDR R2, =VICVectAddr
STR R3, [R2]
LDR R2, =VICProtection
MOV R3, #0x01
STR R3, [R2]
BX LR
;/********************************************************************************************************
;** Function name: SoftwareInterrupt
;** Descriptions: 軟件中斷，用于提供VIC管理服務
;** input parameters: 依功能而定
;** output parameters: 依功能而定
;** Returned value: 依功能而定
;** Created by: LinEnqiang
;** Created Date: 2008/04/30
;**-------------------------------------------------------------------------------------------------------
;** Modified by:
;** Modified date:
;**-------------------------------------------------------------------------------------------------------
;********************************************************************************************************/
SoftwareInterrupt
CMP R0, #4
LDRLO PC, [PC, R0, LSL #2]
MOVS PC, LR
SwiFunction
DCD DisableIRQ ;0
DCD EnableIRQ ;1
DCD DisableFIQ ;2
DCD EnableFIQ ;3
;/*********************************************************************************************************
;** Function name: DisableIRQ
;** Descriptions: 關閉全局 IRQ 中斷
;** input parameters: none
;** output parameters: none
;** Returned value: none
;*********************************************************************************************************/
DisableIRQ
MRS R0, SPSR
ORR R0, R0, #NoInt
MSR SPSR_c, R0
MOVS PC, LR
;/*********************************************************************************************************
;** Function name: EnableIRQ
;** Descriptions: 打開全局 IRQ 中斷
;** input parameters: none
;** output parameters: none
;** Returned value: none
;*********************************************************************************************************/
EnableIRQ
MRS R0, SPSR
BIC R0, R0, #NoInt
MSR SPSR_c, R0
MOVS PC, LR
;/*********************************************************************************************************
;** Function name: DisableFIQ
;** Descriptions: 關閉全局 FIQ 中斷
;** input parameters: none
;** output parameters: none
;** Returned value: none
;*********************************************************************************************************/
DisableFIQ
MSR CPSR_c, #(SVC32Mode|NoFIQ)
MRS R0, SPSR
ORR R0, R0, #NoFIQ
MSR SPSR_c, R0
MOVS PC, LR
;/*********************************************************************************************************
;** Function name: EnableFIQ
;** Descriptions: 打開全局 FIQ 中斷
;** input parameters: none
;** output parameters: none
;*;* Returned value: none
;*********************************************************************************************************/
EnableFIQ
MSR CPSR_c, #(SVC32Mode|NoFIQ)
MRS R0, SPSR
BIC R0, R0, #NoFIQ
MSR SPSR_c, R0
MOVS PC, LR
;/********************************************************************************************************
;** Function name: vicControl
;** Descriptions: 軟件中斷，用于提供VIC管理服務
;** input parameters: 依功能而定
;** output parameters: 依功能而定
;** Returned value: 依功能而定
;** Created by: LinEnqiang
;** Created Date: 2008/04/30
;**-------------------------------------------------------------------------------------------------------
;** Modified by:
;** Modified date:
;**-------------------------------------------------------------------------------------------------------
;********************************************************************************************************/
vicControl
SUB R0, R0, #0x100
CMP R0, #7
LDRLO PC, [PC, R0, LSL #2]
MOVS PC, LR
vicControlFuncAdd
DCD SetvicIrqFunc ; 0
DCD ClrvicIrqFunc ; 1
DCD EnablevicIrq ; 2
DCD DisablevicIrq ; 3
DCD GetvicIrqStatus ; 4
DCD SetvicFiq ; 5
DCD ClrvicFiq ; 6
;/*********************************************************************************************************
;** Function name: SetvicIrqFunc
;** Descriptions: 設置所選外設的中斷優先級、中斷服務函數地址，并使能中斷
;** input parameters: R0: 外設對應的中斷通道號
;** R1: 中斷優先級
;** R2: 中斷服務函數地址
;** output parameters: none
;** Returned value: 1: 成功
;** 0: 失敗
;** Created by: LinEnqiang
;** Created Date: 2008/04/30
;**-------------------------------------------------------------------------------------------------------
;** Modified by:
;** Modified date:
;**-------------------------------------------------------------------------------------------------------
;*********************************************************************************************************/
SetvicIrqFunc
CMP R1, #32 ; if (通道號 >=32) return FALSE
MOVCS R0, #0
MOVCSS PC, LR
CMP R2, #16 ; if (優先級 >=16) return FALSE
MOVCS R0, #0
MOVCSS PC, LR
CMP R3, #0 ; if (處理函數 ==0) return FALSE
MOVEQ R0, #0
MOVEQS PC, LR
MSR CPSR_c, #(NoFIQ | NoInt | SYS32Mode)
STMFD SP!, {R2, R3}
MOV R2, #1 ; if (Enable) return FALSE
MOV R3, R2, lsl R1
LDR R0, =VICIntEnable
LDR R2, [R0]
ANDS R2, R2, R3
BNE SetvicIrqFunc_j
LDR R0, =VICVectAddr0 ; if (IRQ已經使能) return FALSE
LDR R3, [R0, R1, lsl #2]
CMP R3, #0
SetvicIrqFunc_j
LDMFD SP!, {R2, R3}
MSR CPSR_c, #(NoFIQ | NoInt | SVC32Mode)
MOVNE R0, #0
MOVNES PC, LR
?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -