ABB机器人高级编程指令课件.ppt

1、NWE技術研發部自動化應用目錄目錄運動控制指令運動控制指令 外軸激活指令外軸激活指令 計數指令計數指令 輸入輸出指令輸入輸出指令 程序運行停止指令程序運行停止指令 例行程序調用指令例行程序調用指令 計時指令計時指令 中斷指令中斷指令 通信指令通信指令 中斷運動指令中斷運動指令程序流程指令程序流程指令 故障處理指令故障處理指令坐標轉換指令坐標轉換指令 運動觸發指令運動觸發指令2022/11/26運動控制指令AccSet VelSetConfJ ConfLSingArea PathReasolSoftAct SoftDeact2022/11/26運動控制指令運動控制指令-AccSet AccSet

2、 Acc,Ramp;Acc:機器人加速度百分率機器人加速度百分率 (num)Ramp:機器人加速度坡度機器人加速度坡度 (num)應用應用 當機器人運行速度改變時當機器人運行速度改變時對所產生的相對所產生的相應加速度進行限製應加速度進行限製使機器人高速運行時使機器人高速運行時更平緩更平緩但會延長循環時間但會延長循環時間系統默認值系統默認值為為AccSet 100,100;2022/11/26運動控制指令運動控制指令-AccSet實例實例限製限製l機器人加速度百分率最小值為機器人加速度百分率最小值為20小於小於20以以20 計計機器人加速度坡度最小值為機器人加速度坡度最小值為10小於小於10以以

3、10計計l機器人冷啟動機器人冷啟動新程序載入與程序重置後新程序載入與程序重置後系統系統 自動設置為默認值自動設置為默認值accelerationAccSet 100,100i.e.normalaccelerationAccSet 30,100accelerationAccSet 100,30Time2022/11/26運動控制指令運動控制指令-VelSet VelSet Override,Max;Override:機器人運行速度機器人運行速度%(num)Max:最大運行速度最大運行速度mm/s (num)應用應用 對機器人的運行速度進行限製對機器人的運行速度進行限製機器人運動機器人運動指令中均

4、帶有運行速度指令中均帶有運行速度在執行運動速度控在執行運動速度控制指令制指令VelSet後後實際運行速度為運動指令實際運行速度為運動指令規定的運行速度乘以機器人運行速率規定的運行速度乘以機器人運行速率并且并且不超過機器人最大運行速度不超過機器人最大運行速度系統默認值為系統默認值為VelSet 100,5000;2022/11/26運動控制指令運動控制指令-VelSet實例實例 VelSet 50,800;MoveL p1,v1000,z10,tool1;MoveL p2,v1000v:=2000,z10,tool1;MoveL p3,v1000T:=5,z10,tool1;VelSet 80,

5、1000;MoveL p1,v1000,z10,tool1;MoveL p2,v5000,z10,tool1;MoveL p3,v1000v:=2000,z10,tool1;MoveL p4,v1000T:=5,z10,tool1;500mm/s800mm/s10s800mm/s1000smm/s1000mm/s6.25s2022/11/26運動控制指令運動控制指令-VelSet限製限製l 機器人冷啟動機器人冷啟動新程序載入與程序重置後新程序載入與程序重置後系系統自動設置為默認值統自動設置為默認值l 機器人使用參變量機器人使用參變量T時時最大運行速度將不最大運行速度將不起作用起作用l Over

6、ride對數據對數據(speeddate)內所有項都起作內所有項都起作用用例如例如TCP方位及外軸方位及外軸但對焊接參數但對焊接參數welddate與與seamdate內機器人運動速度不起內機器人運動速度不起作用作用l Max只對速度數據只對速度數據(speeddate)內內TCP這項起這項起作用作用2022/11/26運動控制指令運動控制指令-ConfJ ConfJOn Off;On:啟動軸配置數據啟動軸配置數據 (switch)關節運動時關節運動時機器人移動至絕對機器人移動至絕對ModPos點點如果無法到達如果無法到達程序將停止運行程序將停止運行Off:默認默認H軸配置數據軸配置數據 (s

7、witch)關節運動時關節運動時機器人移動至機器人移動至ModPos點點軸軸配置數據默認為當前最接近值配置數據默認為當前最接近值2022/11/26運動控制指令運動控制指令-ConfJ應用應用 對機器人運行姿態進行限製與調整對機器人運行姿態進行限製與調整程序運行時程序運行時使機器人運行姿態得到控制使機器人運行姿態得到控制系統默認值為系統默認值為ConfJOn;實例實例 ConfJOn;.ConfJOff;限製限製l 機器人冷啟動機器人冷啟動新程序載入與程序重置後新程序載入與程序重置後系統系統自動設置為默認值自動設置為默認值2022/11/26運動控制指令運動控制指令-ConfL ConfLOn

8、 Off;On:啟動軸配置數據啟動軸配置數據 (switch)直線運動時直線運動時機器人移動至絕對機器人移動至絕對ModPos點點如果無法到達如果無法到達程序將停止運行程序將停止運行Off:默認默認H軸配置數據軸配置數據 (switch)直線運動時直線運動時機器人移動至機器人移動至ModPos點點軸軸配置數據默認為當前最接近值配置數據默認為當前最接近值2022/11/26運動控制指令運動控制指令-ConfL應用應用 對機器人運行姿態進行限製與調整對機器人運行姿態進行限製與調整程序運行時程序運行時使機器人運行姿態得到控制使機器人運行姿態得到控制系統默認值為系統默認值為ConfLOn;實例實例 C

9、onfLOn;.ConfLOff;限製限製l 機器人冷啟動機器人冷啟動新程序載入與程序重置後新程序載入與程序重置後系統系統自動設置為默認值自動設置為默認值2022/11/26運動控制指令運動控制指令-SingArea SingAreaWrist Off;Wrist:啟動位置方位調整啟動位置方位調整 (switch)機器人運動時機器人運動時為了避免頻繁死機為了避免頻繁死機位置點位置點允許其方位值有些許改變允許其方位值有些許改變例如例如在五軸零在五軸零度時度時機器人四六軸平行機器人四六軸平行Off:關閉位置方位調整關閉位置方位調整 (switch)機器人運動時機器人運動時不允許位置點方位改變不允許

10、位置點方位改變是是機器人的默認狀態機器人的默認狀態2022/11/26運動控制指令運動控制指令-SingArea應用應用 當前指令通過對機器人位置點姿態進行些當前指令通過對機器人位置點姿態進行些 許改變許改變可以絕對避免機器人運行時死機可以絕對避免機器人運行時死機 但是但是機器人運行路徑會受影響機器人運行路徑會受影響姿態得不姿態得不 到控制到控制通常使用與通過複雜姿態點通常使用與通過複雜姿態點絕對絕對 不能作為工作點使用不能作為工作點使用實例實例 SingAreaWrist;.SingAreaOff;2022/11/26運動控制指令運動控制指令-SingArea限製限製l 以下情況機器人將自動

11、恢復默認值以下情況機器人將自動恢復默認值 SingAreaOff -機器人冷啟動機器人冷啟動 -系統重新載入新的程序系統重新載入新的程序 -系統重置系統重置(Start From Beginning)2022/11/26運動控制指令運動控制指令-PathResol PathResol PathSampleTime;PathSampleTime:路徑控制路徑控制%(num)應用應用 當前指令用於更改機器人主機系統參數當前指令用於更改機器人主機系統參數;調整機器人路徑采樣時間調整機器人路徑采樣時間從而達到控制從而達到控制機器人運行路徑的效果機器人運行路徑的效果通過此指令可以通過此指令可以提高機器人

12、運動精度或縮短循環時間提高機器人運動精度或縮短循環時間路路徑控制默認值為徑控制默認值為100%調整範圍為調整範圍為25%-400%路徑控制百分比越小路徑控制百分比越小運動精度越高運動精度越高占用占用CPU資源也越多資源也越多2022/11/26運動控制指令運動控制指令-PathResol實例實例 MoveJ p1,v1000,fine,tool1;PathResol 150;機器人在臨界運動狀態機器人在臨界運動狀態(重載重載高速高速路徑變化路徑變化複雜情況下接近最大工作區域複雜情況下接近最大工作區域)增加路徑控制增加路徑控制值值可避免頻繁死機可避免頻繁死機外軸以很低的速度與機器外軸以很低的速度

13、與機器人聯動人聯動增加路徑控制值增加路徑控制值可避免頻繁死機可避免頻繁死機 機器人進行高頻率擺動弧焊時機器人進行高頻率擺動弧焊時需要很高的路需要很高的路徑采樣時間徑采樣時間需要減小路徑控制值需要減小路徑控制值機器人進行機器人進行小範圍複雜運動時小範圍複雜運動時需要很高的精度需要很高的精度需要減小需要減小路徑控制值路徑控制值2022/11/26運動控制指令運動控制指令-PathResol限製限製l 機器人必須在完全停止後才能更改路徑控制值機器人必須在完全停止後才能更改路徑控制值否則否則機器人將默認一個停止點機器人將默認一個停止點并且顯示錯誤并且顯示錯誤信息信息50146l 機器人在更改路徑控制值

14、時機器人在更改路徑控制值時機器人被強製停止機器人被強製停止運行運行機器人將不能立刻恢復正常運行機器人將不能立刻恢復正常運行(Restart)l 以下情況機器人將自動恢復默認值以下情況機器人將自動恢復默認值100%-機器人冷啟動機器人冷啟動 -系統載入新的程序系統載入新的程序 -程序重置程序重置(Start From Beginning)2022/11/26運動控制指令運動控制指令-SoftAct SoftActMechUnit,Axis,SoftnessRampMechUnit 軟化外軸名稱軟化外軸名稱 (mechunit)Axis:軟化外軸號碼軟化外軸號碼 (num)Softness:軟化值

15、軟化值%(num)Ramp:軟化坡度軟化坡度%(num)應用應用 當前指令用於軟化機器人主機或外軸伺服系統當前指令用於軟化機器人主機或外軸伺服系統軟化值範圍軟化值範圍0%-100%,軟化坡度範圍軟化坡度範圍=100%,此指令必須與指令此指令必須與指令SoftDeact同時使用同時使用通常不通常不使用於工作位置。使用於工作位置。2022/11/26運動控制指令運動控制指令-SoftAct實例實例 SoftAct 3,20;SoftAct 1,90Ramp:=150;SoftAct MechUnit:=Orbit1,1,40Ramp:=120;限製限製l 機器人被強製停止運行後機器人被強製停止運行

16、後軟伺服設置將自動失效軟伺服設置將自動失效l 同一轉軸軟化伺服不允許被連續設置兩次同一轉軸軟化伺服不允許被連續設置兩次.SoftAct 3,20;SoftAct 3,20;SoftAct 3,20;MoveJ*,v100,fine,tool;.SoftAct 3,20;.2022/11/26運動控制指令運動控制指令-SoftDeact SoftDeact Ramp Ramp:軟化坡度軟化坡度=100%(num)應用應用 當前指令用於使軟化機器人主機或外軸伺服系當前指令用於使軟化機器人主機或外軸伺服系統指令統指令SoftAct失效。失效。實例實例 SoftAct 3,20;SoftDeact;S

17、oftAct 1,90;SoftDeactRamp:=150;2022/11/26外軸激活指令ActUnit DeactUnit2022/11/26外軸激活指令外軸激活指令-ActUnit ActUnit MecUnit MecUnit:外軸名外軸名 (mecunit)應用應用 將機器人一個外軸激活將機器人一個外軸激活例如例如當多個外當多個外軸公用一個驅動板時軸公用一個驅動板時通過外軸激活指令通過外軸激活指令ActUnit選擇當前所使用的外軸選擇當前所使用的外軸2022/11/26外軸激活指令外軸激活指令-ActUnit實例實例 MoveL p10,v100,fine,tool1;ActUni

18、t track_motion;MoveL p20,v100,z10,tool1;DeactUnit track_motion;ActUnit orbit_a;MoveL p30,v100,z10,tool1;限製限製l 不能在指令不能在指令StorePathRestorePath內使用內使用l 不能在預置程序不能在預置程序RESTART內使用內使用l 不能在機器人轉軸處於獨立狀態時使用不能在機器人轉軸處於獨立狀態時使用P10,外軸不動外軸不動P20,外軸聯動外軸聯動Track_motionP30,外軸聯動外軸聯動Orbit_a2022/11/26外軸激活指令外軸激活指令-DeactUnit D

19、eactUnit MecUnit MecUnit:外軸名外軸名 (mecunit)應用應用 將機器人一個外軸失效將機器人一個外軸失效例如例如當多個外當多個外軸公用一個驅動板時軸公用一個驅動板時通過外軸激活指令通過外軸激活指令DeactUnit使當前所使用的外軸失效使當前所使用的外軸失效2022/11/26實例實例 MoveL p10,v100,fine,tool1;ActUnit track_motion;MoveL p20,v100,z10,tool1;DeactUnit track_motion;ActUnit orbit_a;MoveL p30,v100,z10,tool1;限製限製l

20、不能在指令不能在指令StorePathRestorePath內使用內使用l 不能在預置程序不能在預置程序RESTART內使用內使用P10,外軸不動外軸不動P20,外軸聯動外軸聯動Track_motionP30,外軸聯動外軸聯動Orbit_a外軸激活指令外軸激活指令-DeactUnit2022/11/26計數指令計數指令 Add Clear Incr Decr2022/11/26計數指令計數指令-Add Add Name,AddValur Name:數據名稱數據名稱 (num)AddValue:增加的值增加的值 (num)應用應用 在一個數字數據值是增加相應的值在一個數字數據值是增加相應的值可以

21、可以用賦值指令替代用賦值指令替代實例實例 Add reg1,3;等同於等同於 reg1:=reg1+3;Add reg1,reg2;等同於等同於reg1:=reg1+reg2;2022/11/26計數指令計數指令-Clear Clear Name;Name:數據名稱數據名稱 (num)應用應用 將一個數字數據的值歸零將一個數字數據的值歸零可以用賦值指可以用賦值指令替代令替代實例實例 Clear reg1;等同於等同於 reg1:=02022/11/26計數指令計數指令-Incr Incr Name;Name:數據名稱數據名稱 (num)應用應用 在一個數字數據的值上加在一個數字數據的值上加1可

22、以用賦值可以用賦值指令替代指令替代一般用於產量計數一般用於產量計數實例實例 Incr reg1;等同於等同於 reg1:=reg1+1;2022/11/26計數指令計數指令-Decr Decr Name;Name:數據名稱數據名稱 (num)應用應用 在一個數字數據的值減在一個數字數據的值減1可以用賦值指可以用賦值指令替代令替代一般用於產量計數一般用於產量計數實例實例 Incr reg1;等同於等同於 reg1:=reg1-1;2022/11/26輸入輸出指令輸入輸出指令 AliasIO InvertDO IODisable IOEnable PluseDO Reset Set SetAO S

23、etDO SetGO WaitDI WaitDO2022/11/26輸入輸出指令輸入輸出指令-AliasIO AliasIO FromSignal,ToSignal;FromSignal:機器人系統參數內所定義的機器人系統參數內所定義的 信號名稱信號名稱(SignalXX or string)ToSignal:機器人程序內所使用的信號名稱機器人程序內所使用的信號名稱 (SignalXX)應用應用 對機器人系統參數內定義的信號名稱進行對機器人系統參數內定義的信號名稱進行化名化名給機器人程序使用給機器人程序使用一般使用與一般使用與LoadedModule或或Built-in Module內內例例如

24、如多台機器人使用相同系統參數多台機器人使用相同系統參數2022/11/26輸入輸出指令輸入輸出指令-AliasIO實例實例 VAR signaldo alias_do;CONST string config_string:=“config_do”;PROC prog_start()AliasIO config_do,alias_do;AliasIO config_string,alias_do;ENDPROCAlias_do,在機器在機器人程序內定義人程序內定義config_do,在系統在系統參數內定義參數內定義2022/11/26輸入輸出指令輸入輸出指令-AliasIO限製限製l指令指令Al

25、iasIO必須放置在預置程序必須放置在預置程序START內或程序內使用相應的信號之前內或程序內使用相應的信號之前l指令指令AliasIO在示教器上無法輸入在示教器上無法輸入只能只能通過離線編輯輸入通過離線編輯輸入l指令指令AliasIO需要軟件需要軟件Develops Functions的支持的支持 2022/11/26輸入輸出指令輸入輸出指令-InvertDO InvertDO Signal;Signal:輸出信號名稱輸出信號名稱 (SignalDO)應用應用 將機器人輸出信號值反轉將機器人輸出信號值反轉0為為11為為0在系統參數內也可定義在系統參數內也可定義實例實例:InvertDO do

26、15;2022/11/26輸入輸出指令輸入輸出指令-InvertDO機器人程序內指令機器人程序內指令InvertDO被執行被執行1100Signal LevelSignal Level2022/11/26輸入輸出指令輸入輸出指令-IODisable IODisable UnitName,MaxTime;UnitName:輸入輸出板名稱輸入輸出板名稱(num)MaxTime:最長等待時間最長等待時間 (num)應用應用 通過指令可以使機器人輸入板在程序運行時通過指令可以使機器人輸入板在程序運行時自動失效自動失效系統將一塊輸入輸出板失效需要系統將一塊輸入輸出板失效需要2-5秒秒如果失效時間超過最長

27、等待時間如果失效時間超過最長等待時間系系統將進入統將進入ErrorHandler處理處理錯誤代碼為錯誤代碼為ERR_IODISABLE如果例行程序沒有如果例行程序沒有ErrorHandler機器人將停機報錯。機器人將停機報錯。2022/11/26實例實例PROC go_home()recover_flag:=1;IODisable“cell”,0 MoveJ home,v1000,fine,tool1;recover_cover:=2;IODisable“cell”,5;ERROR IF ERRNO=ERR_IODISABLE THEN IF recover_flag=1 THEN TRYNE

28、XT;ELSEIF recover_flag=2 THEN RETRY;ENDIF ELSEIF ERRNO=ERR_EXCRPTYMAX THEN ErrorWrite“IODisable error”,”Restart the program”;Ttop;ENDIFENDPROC 輸入輸出指令輸入輸出指令-IODisable輸入輸出板輸入輸出板cell開始失效開始失效最長等待時間最長等待時間為為0肯定進入肯定進入Error Handler處理處理利用機器人移動到利用機器人移動到home的時的時間完成輸入輸出板失效間完成輸入輸出板失效確認輸入輸出板失效確認輸入輸出板失效連續連續5次次RETR

29、Y後後仍無法仍無法完成輸入輸出板的失效完成輸入輸出板的失效2022/11/26輸入輸出指令輸入輸出指令-IODisableError Handingl ERR_IODISABLE 超過最長等待時間超過最長等待時間系統仍未完成輸入輸出系統仍未完成輸入輸出板失效板失效l ERR_CALLIO_INTER 系統在執行輸入輸出板失效與激活時系統在執行輸入輸出板失效與激活時當前當前輸入輸出板與再次被失效或激活輸入輸出板與再次被失效或激活形成沖突形成沖突l ERR_NAME_INV ALID 輸入輸出板名稱錯誤或無法進行失效與激活輸入輸出板名稱錯誤或無法進行失效與激活操作操作2022/11/26輸入輸出指

30、令輸入輸出指令-IOEnable IOEnable UnitName,MaxTime;UnitName:輸入輸出板名稱輸入輸出板名稱(num)MaxTime:最長等待時間最長等待時間 (num)應用應用 通過指令可以使機器人輸入板在程序運行時通過指令可以使機器人輸入板在程序運行時自動激活自動激活系統將一塊輸入輸出板失效需要系統將一塊輸入輸出板失效需要2-5秒秒如果失效時間超過最長等待時間如果失效時間超過最長等待時間系系統將進入統將進入ErrorHandler處理處理錯誤代碼為錯誤代碼為ERR_IOENABLE如果例行程序沒有如果例行程序沒有ErrorHandler機器人將停機報錯。機器人將停機

31、報錯。2022/11/26輸入輸出指令輸入輸出指令-IOEnable實例實例 VAR num max_retry:=0;.IOEnable“cell:,0;SetDO cell_sig3,1;ERROR IF ERRNO=ERR_IOENABLE THEN IF max_retry3 THEN TPWrite“.”;ENDIF IF nCounter30 THEN Stop;ENDIF WaitDI di_Ready,1MaxTime=1Timeflag:=bTimeout;Incr nCounter;ENDWHOLE .ENDPROC機器等待到位信號機器等待到位信號如果如果1秒內仍沒有等到信

32、號秒內仍沒有等到信號di_Ready值為值為1機器人執機器人執行隨後指令行隨後指令但此時但此時TimeFlag值為值為TRUE機器機器人等到人等到di_Ready值為值為1此此時時TimeFlag值為值為FALSE輸入輸出指令輸入輸出指令-WaitDI2022/11/26輸入輸出指令輸入輸出指令-WaitDO WaitDO Signal,Value MaxTimeTimeFlag;Signal:輸出信號名稱輸出信號名稱(signaldo)Value:輸出信號值輸出信號值 (num)MaxTime:最長等待時間最長等待時間s (num)TimeFlag:超時邏輯量超時邏輯量 (bool)應用應用

33、 等待數字輸出信號滿足相應值等待數字輸出信號滿足相應值達到通信目達到通信目的的因為輸出信號一般情況下受程序控制因為輸出信號一般情況下受程序控制 此指令很少使用。此指令很少使用。2022/11/26實例實例 PROC Grip()Set do03_Grip;WaitDO do03_Grip,1;.ENDPROCPROC Grip()Set do03_Grip;WaitDO do03_Grip,1MaxTime:=5;.ERROR IF ERRNO=ERR_WAIT_MAXTIME THEN TRWrite“.”;RETRY;ELSE RAISE;ENDIFENDPROC 機器人等待輸出信號機器人

34、等待輸出信號直到信號直到信號do03_Grip為為1才執行隨後指令才執行隨後指令機器人等待相應機器人等待相應輸出信號輸出信號如果如果5秒內仍沒有等到秒內仍沒有等到信號信號do03_Grip值值為為1自動進行自動進行Error Handler處處理理如果沒有如果沒有Error Handler,機機器人停機報錯器人停機報錯輸入輸出指令輸入輸出指令-WaitDO2022/11/26實例實例PROC Grip()Set do03_Grip;bTimeout:=TRUE;nCounter:=0;WHILE bTimeout DO IF nCounter3 THEN TPWrite“.”;ENDIF IF

35、 nCounter30 THEN Stop;ENDIF WaitDI di_Ready,1MaxTime=1Timeflag:=bTimeout;Incr nCounter;ENDWHOLE .ENDPROC機器等待到位信號機器等待到位信號如果如果1秒內仍沒有等到信號秒內仍沒有等到信號do03_Grip值為值為1機器人機器人執行隨後指令執行隨後指令但此時但此時TimeFlag值為值為TRUE機器機器人等到人等到di_Ready值為值為1此此時時TimeFlag值為值為FALSE輸入輸出指令輸入輸出指令-WaitDO2022/11/26程序運行停止指令程序運行停止指令 Break Exit St

36、op ExitCycle2022/11/26程序運行停止指令程序運行停止指令-Break Break;應用應用 機器人在當前指令行立刻停止運行機器人在當前指令行立刻停止運行程序運程序運行指針停留在下一行指令行指針停留在下一行指令可以用可以用Start鍵繼鍵繼續運行機器人。續運行機器人。實例實例 .Break;.2022/11/26程序運行停止指令程序運行停止指令-Break區別區別 MoveL p2,v100,z30,tool0;Break;(Stop)MoveL p3,v100,z30,tool0;p1BreakStopp3p22022/11/26程序運行停止指令程序運行停止指令-EXIT

37、EXIT;應用應用 機器人在當前指令行停止運行機器人在當前指令行停止運行并且程序重并且程序重置置程序運行指針停留在主程序第一行。程序運行指針停留在主程序第一行。實例實例 .EXIT;.2022/11/26 Stop NoRegain;NoRegain:路徑恢復參數路徑恢復參數 (num)應用應用 機器人在當前指令停止運行機器人在當前指令停止運行程序運行指針程序運行指針停留在下一行指令停留在下一行指令可以用可以用Start鍵繼續運行鍵繼續運行機器人機器人屬於臨時性停止屬於臨時性停止如果機器人停止如果機器人停止 期間被手動移動後期間被手動移動後然後直接啟動機器人然後直接啟動機器人機器人將警告確認路

38、徑機器人將警告確認路徑如果此時采用參變如果此時采用參變量量NoRegain機器人將直接運行。機器人將直接運行。程序運行停止指令程序運行停止指令-STOP2022/11/26區別區別 MoveL p2,v100,z30,tool0;Stop;(Break;)MoveL p3,v100,z30,tool0;p1BreakStopp3p2程序運行停止指令程序運行停止指令-STOP2022/11/26程序運行停止指令程序運行停止指令-ExitCycle ExitCycle;應用應用 機器人在當前指令行立刻停止運行機器人在當前指令行立刻停止運行并且設并且設定當前循環結束定當前循環結束機器人自動從主程序第

39、一機器人自動從主程序第一行繼續運行下一個循環。行繼續運行下一個循環。2022/11/26程序運行停止指令程序運行停止指令-ExitCycle實例實例 PROC main()IF cyclecount=0 THEN CONNECT error_intno WITH error_trap ISignalDI di_error,1,error_intno;ENDIF cyclecount:=cyclecount+1;!start to do something intelligent .ENDPROC TRAP error_trap TPWrite“I will statr on the next

40、item”;ExitCycle;ENDTRAP2022/11/26例行程序調用指令例行程序調用指令 ProcCall CallByVar 2022/11/26 ProcCall ProcedureArgumentProcedure:例行程序名稱例行程序名稱 (Identifier)Argument:例行程序參數例行程序參數 (All)應用應用 機器人調用相應例行程序機器人調用相應例行程序同時給帶有參數同時給帶有參數的例行程序中相應的參數賦值。的例行程序中相應的參數賦值。實例實例 Weldpipe1;Weldpipe2 10,lowspeed;Weldpipe3 10speed:=20;例行程序

41、調用指令例行程序調用指令-ProcCall2022/11/26例行程序調用指令例行程序調用指令-ProcCall限製限製l 機器人調用帶參數的例行程序時機器人調用帶參數的例行程序時必須包括必須包括所有強製性參數所有強製性參數l 例行程序所有參數位置次序必須與例行程序例行程序所有參數位置次序必須與例行程序設置一致設置一致l 例行程序所有參數數據類型必須與例行程序例行程序所有參數數據類型必須與例行程序設置一致設置一致l 例行程序所有參數數據性質必須為例行程序所有參數數據性質必須為Input,Variable或或Persistent;2022/11/26 CallByVar Name,Number;

42、Name:例行程序名稱第一部分例行程序名稱第一部分(string)Number:例行程序名稱第二部分例行程序名稱第二部分 (num)應用應用 通過指令中相應數據通過指令中相應數據機器人調用相應例行機器人調用相應例行程序程序但無法調用帶有參數的例行程序。但無法調用帶有參數的例行程序。實例實例 reg1:=Ginput(gi_Type);CallByVar“proc”,reg1;例行程序調用指令例行程序調用指令-CallByVar2022/11/26例行程序調用指令例行程序調用指令-CallByVar限製限製l 不能調用帶參數的例行程序不能調用帶參數的例行程序l 所有被調用的例行程序名稱第一部分必

43、須相所有被調用的例行程序名稱第一部分必須相同同例如例如proc1,proc2,proc3;l 使用使用CallByVar指令調用例行程序比直接采指令調用例行程序比直接采用用ProcCall調用例行程序需要更長時間調用例行程序需要更長時間Error Handling:l ERR_REFUNKPRC 系統無法找到例行程序名稱第一部分系統無法找到例行程序名稱第一部分l ERR_CALLPROC 系統無法找到例行程序名稱第二部分系統無法找到例行程序名稱第二部分2022/11/26實例比較實例比較 TEST reg1 CASE 1:If _door door_loc;CASE 2:rf _door do

44、or_loc;CASE 3:Ir _door door_loc;CASE 4:rr _door door_loc;DEFAULT EXIT;ENDTEST CallByVar“proc”,reg1;%”proc”+NumTostr(reg1,0)%door_loc;例行程序調用指令例行程序調用指令-CallByVar指令指令CallByVar不能調用帶有參不能調用帶有參數的例行程序數的例行程序通過通過RAPID結構結構仍可以調用帶有仍可以調用帶有參數的例行程序參數的例行程序2022/11/26計時指令計時指令ClkReset ClkStartClkStop2022/11/26 ClkReset

45、 Clock;Clock:時鐘名稱時鐘名稱 (clock)應用應用 將機器人相應時鐘復位將機器人相應時鐘復位常用於記錄循環時常用於記錄循環時間或機器人跟蹤運輸鏈。間或機器人跟蹤運輸鏈。實例實例 ClkReset clock1;ClkStart clock1;RunCycle;ClkStop clock;nCycleTime:=ClkRead(clock1);TPWrite“Last cycletime:Num:=nCycleTime計時指令計時指令-ClkReset2022/11/26 ClkStart Clock;Clock:時鐘名稱時鐘名稱 (clock)應用應用 啟動機器人相應時鐘啟動機

46、器人相應時鐘常用於記錄循環時間常用於記錄循環時間或機器人跟蹤運輸鏈或機器人跟蹤運輸鏈機器人時鐘啟動後機器人時鐘啟動後 時鐘不會因為機器人停止運行或關機而停止時鐘不會因為機器人停止運行或關機而停止計時計時在機器人時鐘運行時在機器人時鐘運行時指令指令ClkStop 與與ClkReset仍起作用。仍起作用。計時指令計時指令-ClkStart2022/11/26計時指令計時指令-ClkStart實例實例 ClkReset clock1;ClkStart clock1;RunCycle;ClkStop clock;nCycleTime:=ClkRead(clock1);TPWrite“Last cycl

47、etime:Num:=nCycleTime限製限製l 機器人時鐘計時超過機器人時鐘計時超過4,294,967秒秒即即49天天17小時小時2分分47秒秒機器人將出錯機器人將出錯Error Handler代碼為代碼為ERR_OVERFLOW2022/11/26 ClkStop Clock;Clock:時鐘名稱時鐘名稱 (clock)應用應用 停止機器人相應時鐘停止機器人相應時鐘常用於記錄循環時間常用於記錄循環時間或機器人跟蹤運輸鏈。或機器人跟蹤運輸鏈。實例實例 ClkReset clock1;ClkStart clock1;RunCycle;ClkStop clock;nCycleTime:=Cl

48、kRead(clock1);TPWrite“Last cycletime:Num:=nCycleTime計時指令計時指令-ClkStop2022/11/26中斷指令中斷指令CONNECT IDeleteISignalDI ISignalDOISignalAI ISignalAOISleep IWatchIDisable IEnableITimer2022/11/26中斷指令中斷指令-CONNECTCONNECT Interrupt WITH Trap routineInterrupt:中斷數據名稱中斷數據名稱 (intnum)Trap routine:中斷處理程序中斷處理程序 (Identif

49、ier)應用應用 將機器人相應中斷數據連接到相應的中將機器人相應中斷數據連接到相應的中斷處理程序是機器人中斷功能必不可少的斷處理程序是機器人中斷功能必不可少的組成部分組成部分必須同指令必須同指令ISignalDIISignalDOISignalAIISignalAO或或ITmer聯合使用聯合使用2022/11/26中斷指令中斷指令-CONNECT實例實例VAR intnum intInspectProc main().CONNECT intInpect WITH rAlarm;ISignalDI di01_Vacuum,0,intInspect;.ENDPROCTRAP rAlarm TPWr

50、ite“Grip Error”;Stop;WaitDI di01_Vacuum,1;ENDTRAP2022/11/26中斷中斷指令指令-CONNECT限製限製l中斷數據的數據類型必須為變量中斷數據的數據類型必須為變量(VAR)l一個中斷數據不允許同時連接到多個中斷處一個中斷數據不允許同時連接到多個中斷處理程序理程序但多個中斷數據可以共享一個中斷但多個中斷數據可以共享一個中斷處理程序處理程序l當一個中斷數據完成連接後當一個中斷數據完成連接後 這個中斷數這個中斷數據不允許再次連接到任何中斷處理程序據不允許再次連接到任何中斷處理程序(包包括已經連接的中斷處理程序括已經連接的中斷處理程序)如果需要再次