;*********************************************************************電機(jī)正轉(zhuǎn)低速度
ZDI_SDU BCF PORTC,5 ; A A B 0.0電機(jī)速度低
BCF PORTC,6 ; B A B 0.0電機(jī)速度低
NOP
;****************************************************************電機(jī)正轉(zhuǎn)低速度
;電機(jī)正轉(zhuǎn)低速度 ;是否到了原點(diǎn)電機(jī)電磁鐵停止
;****************************************************************電機(jī)正轉(zhuǎn)結(jié)束
ZMOR_TIN
BTFSS PORTB,6 ;原點(diǎn)檢測 光電
GOTO ZMOR_TIN1 ;H回到原點(diǎn)
GOTO ZMOR_TIN
ZMOR_TIN1
BCF PORTC,2 ;電機(jī)正轉(zhuǎn)停 A A B 0.0電機(jī)停
BCF PORTC,3 ;電機(jī)反轉(zhuǎn)停 B A B 0.0電機(jī)停