—SmartMotor程式範例:原點復歸—
==================CLASS 5========================
GOSUB1 ‘呼叫副程式1
‘————原點復歸副程式1—————
C1
MT ‘扭力模式
T=-2500 ‘扭力後退(依照現況調整)
c=1000
WHILE c>30 ‘若時間內有退後,就持續迴圈。退到底之後,離開迴圈
w=PA
WAIT=100
e=PA
c=w-e
LOOP
MP ‘位置模式
VT=32212
ADT=1000
PRT=2000 ‘前進一小段距離後,設定為原點
G
TWAIT
WAIT=1000*3
O=0
RETURN
END
====================CLASS 4======================
GOSUB1 ‘呼叫副程式1
‘————原點復歸副程式1—————
C1
MT ‘扭力模式
T=-60 ‘扭力後退(依照現況調整)
c=1000
WHILE c>30 ‘若時間內有退後,就持續迴圈。退到底之後,離開迴圈
w=@P
WAIT=400
e=@P
c=w-e
LOOP
MP ‘位置模式
V=32212
A=1000
D=2000 ‘前進一小段距離後,設定為原點
G
TWAIT
WAIT=4069*3
O=0
RETURN
END