技術支援

如何使用扭力回原點? (class 4 & 5)

—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