16F876控制的电动自行车驱动系统源程序(2)

;暂存STATUS寄存器

MOVWF ST_STACK

RETURN ;子程序返回

;**************中断恢复现场子程序**************

POP

MOVF ST_STACK，0 ;恢复STATUS寄存器值

MOVWF STATUS

MOVF W_STACK，0 ;恢复W寄存器值

RETURN ;子程序返回

;**************初始化子程序****************

SETUP

MOVLW .15 ;初始化TEMP

MOVWF TEMP

MOVF ACCbHI，0 ;ACCb送ACCd

MOVWF ACCdHI

MOVF ACCbLO，0

MOVWF ACCdLO

CLRF ACCbHI ;清ACCb

CLRF ACCbLO

RETLW 0

;**********乘除法运算确定结果符号子程序**********

S_SIGN

MOVF ACCaHI，0 ;ACCaHI异或ACCbHI，结果送SIGN单元

XORWF ACCbHI，0

MOVWF SIGN

BTFSS ACCbHI，7 ;ACCb为负?

GOTO CHEK_A ;否，检查ACCa

CALL NEG_BCHEK_A

BTFSS ACCaHI，7 ;ACCa为负?

RETLW 0 ;ACCa和ACCb均为负，返回

GOTO NEG_A ;ACCa为负，取补

GOTO MAIN

END

;程序结束

;程序结束

;程序结束

;程序结束

;程序结束

;程序结束

;程序结束

;程序结束

;程序结束