SmartMotor 雙軸同步模式
應用: 雙軸平行滑台同步運動 https://youtu.be/n71ICL92rNs 目標: 雙軸同時動作、同時停止,移動過程中即使某一軸受到阻力,兩軸的編碼器位置仍保持相同。 https://montrol.com.tw/wp-content/uploads/2023/02/SmartMotor-雙軸同步模式_4x3.mp4 影片開始時,當馬達A有阻力時,馬達B跟隨馬達A作動; 反之,當馬達B有阻力時,馬達A跟隨馬達B作動。 ~~~~~~~~ 程式範例 ~~~~~~~~~ (1) 交叉跟隨範例 使用時請下指令GOSUB(40):1 馬達A EIGN(2) EIGN(3) ZSCADDR=1 ‘設定馬達A之CAN addressCBAUD=125000 ‘設定馬達A之CAN baud rateO=0 ‘設定位置為零ADT=100 VT=32768 PRT=0MP G ‘啟動位置模式xx=32768*2 ‘設定馬達速度值END C4 ‘馬達A啟動跟隨模式EIGN(W,0) ZSMFR ‘設定為跟隨模式MFMUL=1 ‘設定跟隨比例:分子 MFDIV=1 ‘設定跟隨比例:分母G TWAIT ‘執行運動RETURN C40a=EA:2 ‘將馬達B位置誤差值記錄在變數ab=ABS(a) ‘將變數a值的絕對值放入變數bSTACK ‘清除所有RETURN地址,避免連續呼叫副程式中斷GOSUB(5):2 ‘使馬達B啟動跟隨模式TWAITWAIT=2000MP ‘馬達A啟動位置模式ADT=100 VT=xx PT=4000*500 ‘前往絕對位置4000*500 G ‘開始運動WHILE b<50 ‘當馬達B位置誤差超過50設定值則跳出迴圈a=EA:2b=ABS(a)LOOPOFF ‘馬達A關閉伺服控制TWAIT WAIT=1000MP:0 PRT:0=0 G: …