fiq.asm

智能语音识别避障机器人 // 语音识别+机器人+超声波测距综合应用方案 // 采用特定人识别技术

.include hardware.inc
.include s480.inc
.include bsrSD.inc

.external _BSR_FIQ_Routine
.external F_FIQ_Service_SACM_S480

.public _FIQ

.text
_FIQ:
	push r1,r5 to [sp]
	r1 = C_FIQ_TMA
	test r1,[P_INT_Ctrl]
	jnz L_FIQ_TimerA
	r1 = C_FIQ_TMB
	test r1,[P_INT_Ctrl]
	jnz L_FIQ_TimerB
L_FIQ_PWM:
	r1 = C_FIQ_PWM
	[P_INT_Clear] = r1
	pop r1,r5 from [sp]
	reti
L_FIQ_TimerA:
	[P_INT_Clear] = r1
	call _BSR_FIQ_Routine
	call F_FIQ_Service_SACM_S480
	pop r1,r5 from [sp]
	reti
L_FIQ_TimerB:
	[P_INT_Clear] = r1
	pop r1,r5 from [sp]
	reti