---SmartMotor程式範例:原點復歸---


===============================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

===============================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