ENDPROC
PROC rIntiAll( ) !初始化程序 MoveAbsJPhome\NoEOffs,v50,fine,tool0;!回原点。
ENDPROC
主程序main()中调用的子程Path_20~Path_70 分别对应图5-5中(a)~(f )轨迹图案,以下给出初始化 子程序以及图案(a)~(f )的程序。
ENDPROC
二、工业机器人基础轨迹程序设计
PROC Path_40 ( )!平行四边形图案轨迹程序 MoveL offs(p140,0,0,50),v100,fine,tool1\WObj:=wobj0; !运行至第一个目标点正上方 MoveL p140,v200,fine,tool1\WObj:=wobj0; MoveL p150,v200,fine,tool1\WObj:=wobj0; MoveL p160,v200,fine,tool1\WObj:=wobj0; MoveL p170,v200,fine,tool1\WObj:=wobj0; MoveL p140,v200,fine,tool1\WObj:=wobj0; MoveL offs(p140,0,0,50),v100,fine,tool1\WObj:=wobj0;
ENDPROC
三、工业机器人搬运码垛程序设计
PROC Lcount()!列计算子程序 TEST L1 CASE 1: Place10 := Place20; Pick10 := Pick20;!Place20、Pick20分别为示教的放料目标点和取料目标点 CASE 2: Place10 := Offs(Place20,0,-53,0); Pick10 := Offs(Pick20,0,-53,0);!对示教的Place20、Pick20点进行列偏移,以下说明同上 CASE 3: Place10 := Offs(Place20,0,-53 * 2,0); Pick10 := Offs(Pick20,0,-53 * 2,0); CASE 4: Place10 := Offs(Place20,0,-53 * 3,0); Pick10 := Offs(Pick20,0,-53 * 3,0); ENDTEST