東莞自動化培訓(xùn)——ABB機(jī)器人中斷的立即停止與路徑恢復(fù)
最近有一個網(wǎng)上做項目的朋友問到,ABB機(jī)器人如何實現(xiàn)中斷的立即停止,中斷處理完后又接著中斷觸發(fā)時原來的路徑移動?答案是肯定有的,是如何實現(xiàn)的呢?不急,且聽智通工業(yè)機(jī)器人培訓(xùn)辛老師的下文分解。
MODULE
VAR?intnum?intno1:=0;
rInitAll;? ?!初始化程序
MoveL p10,v1000,fine,tool0\WObj:=wobj0;
MoveL p20,v1000,fine,tool0\WObj:=wobj0;
MoveL p30,v1000,fine,tool0\WObj:=wobj0;
MoveL p40,v1000,fine,tool0\WObj:=wobj0;
MoveL p10,v1000,fine,tool0\WObj:=wobj0;
ENDPROC
!下面為代碼的注譯
TRAP Trap1 ??!中斷程序Trap1
reg1 := reg1 + 1;? ??!reg1自加1
StopMove;? ? ??!中斷程序觸發(fā)時停止運(yùn)動
StorePath;? ? ? ?!存儲當(dāng)前路徑
pNowPos:=CRobT(\Tool:=tool0\WObj:=wobj0);? ? ?!獲取當(dāng)前位置賦值給pNowPos點
MoveJ pApporach, v1000, fine, tool0;? ?!中斷產(chǎn)生時遠(yuǎn)離點
WaitTime 1;? ? ?!延時1S
MoveJ pNowPos, v1000, fine, tool0;? ??!運(yùn)行中斷產(chǎn)生時存儲的位置pNowPos點
RestoPath;? ? !恢復(fù)中斷之前的路徑運(yùn)動
StartMove;? ? ?!開始運(yùn)動
ENDTRAP
PROC rInitAll()
IDelete intno1;? ??!取消當(dāng)前中斷符intno1的連接,預(yù)防誤觸發(fā)
CONNECT intno1 WITH Trap1;? ??!將中斷符與中斷程序tTrap連接
ISignalDI di1, 1, intno1;???!定義觸發(fā)條件,即當(dāng)數(shù)字輸入信號di1為1時,觸發(fā)該中斷程序
ENDPROC
ENDMODULE
東莞自動化培訓(xùn)辛老師特意給大家分了如下的知識干貨:
CONSTrobtargetp10:=[[310.64,-150.00,624.70],[0.320936,1.06963E-08,0.947101,-7.81584E-08],[-1,0,-1,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];CONSTrobtargetp20:=[[710.64,-150.00,624.70],[0.320935,4.22874E-08,0.947101,2.15468E-09],[-1,0,-1,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];CONSTrobtargetp30:=[[710.64,150.00,624.70],[0.320935,7.05697E-09,0.947101,5.00524E-08],[0,-1,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];CONSTrobtargetp40:=[[310.64,150.00,624.70],[0.320935,5.10625E-08,0.947101,8.5824E-08],[0,-1,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
更多資訊:智通教育(www.terrymoore-furniture.com)致力于工業(yè)機(jī)器人培訓(xùn)、PLC培訓(xùn)、電工培訓(xùn)等行業(yè)課程,詳情聯(lián)系:0769-8707-8535.