;****************************************************************電機正轉低速度
;電機正轉低速度 ;是否到了原點電機電磁鐵停止
;****************************************************************電機正轉結束
ZMOR_TIN
BTFSS PORTB,6 ;原點檢測 光電
GOTO ZMOR_TIN1 ;H回到原點
GOTO ZMOR_TIN
ZMOR_TIN1
BCF PORTC,2 ;電機正轉停 A A B 0.0電機停
BCF PORTC,3 ;電機反轉停 B A B 0.0電機停
BCF PORTC,0 ;正轉磁鐵釋放
BCF PORTC,1 ;反轉磁鐵釋放
BSF PORTC,5 ;低速度 OUT A
BCF PORTC,6 ;高速度 OUT B A B 1.0速度停