SmartMotor伺服馬達

—SmartMotor程式-IO輸入範例：按A鈕不放，連續作用— ============= class 4 ===================== UAI MT ‘這邊我們用扭力模式做範例 T=0   WHILE 1 ‘不斷迴圈，重複下列判斷式 IF UAI==0 ‘判斷式：UAI若為0代表導通 T=40 WHILE UAI==0 LOOP ‘若按鈕不放就會持續停在這迴圈 T=0 ENDIF LOOP END  

—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