简介：最近要考试了，刚好分享下笔记具体程序如下，适用于简单的码垛机器人编程共有三个点需要经过，原点、p1、p2、p3三个点，其中p1点为吸盘或抓手在空中运行的位置，p2为正在抓取实物的位置，p3为抓手释放物体的位置大致的运行轨迹为：原点开始运动——到达p1的位置——向下贴近传送带到达p2吸附住（或抓取）物体——抬升机器臂，回到位于半空的p1——然后机器臂将物体移动到p3点开始释放物体——重复该运动四次——最终回归原点注：每次停留的时间为一秒实际编程如下（部分代码有编程软件自带的部分代码，实际代码自行底部看图）DEF Modul ( )DECL E6POS zhua,fangDECL INT a;FOLD INI;FOLD BASISTECH INIGLOBAL INTERRUPT DECL 3 WHEN $STOPMESS==TRUE DO IR_STOPM ( ) INTERRUPT ON 3 BAS (#INITMOV,0 );ENDFOLD (BASISTECH INI);FOLD USER INI;Make your modifications here ;ENDFOLD (USER INI);ENDFOLD (INI);FOLD PTP HOME Vel= 100 % DEFAULT;%{PE}%MKUKATPBASIS,%CMOVE,%VPTP,%P 1:PTP, 2:HOME, 3:, 5:100, 7:DEFAULT$BWDSTART = FALSEPDAT_ACT=PDEFAULTFDAT_ACT=FHOMEBAS (#PTP_PARAMS,100 )$H_POS=XHOMEPTP XHOME;ENDFOLDFOR a=o TO 3zhua=XP2fang=XP3zhua.z=zhua.z+100LIN zhuazhua.z=zhua.z 100LIN zhua;FOLD OUT 4 '' State= TRUE;%{PE}%R 5.4.33,%MKUKATPBASIS,%COUT,%VOUTX,%P 2:4, 3:, 5:TRUE, 6:$OUT[4]=TRUE;ENDFOLD;FOLD WAIT Time= 1 sec;%{PE}%R 5.4.33,%MKUKATPBASIS,%CWAIT,%VWAIT,%P 2:1WAIT SEC 1;ENDFOLDzhua.z=zhua.z+100LIN zhuafang.z=famg.z+100+17*aLIN fangfang.z=fang.z 100LIN fang;FOLD OUT 4 '' State= FALSE;%{PE}%R 5.4.33,%MKUKATPBASIS,%COUT,%VOUTX,%P 2:4, 3:, 5:FALSE, 6:$OUT[4]=FALSE;ENDFOLD;FOLD WAIT Time= 1 sec;%{PE}%R 5.4.33,%MKUKATPBASIS,%CWAIT,%VWAIT,%P 2:1WAIT SEC 1;ENDFOLDfang.z=fang.z+100LIN fangENDFOR;FOLD PTP HOME Vel= 100 % DEFAULT;%{PE}%MKUKATPBASIS,%CMOVE,%VPTP,%P 1:PTP, 2:HOME, 3:, 5:100, 7:DEFAULT$BWDSTART = FALSEPDAT_ACT=PDEFAULTFDAT_ACT=FHOMEBAS (#PTP_PARAMS,100 )$H_POS=XHOMEPTP XHOME;ENDFOLDENDDEF ();FOLD PTP P1 Vel=50 % PDAT1 Tool[0] Base[0];%{PE}%R 5.5.29,%MKUKATPBASIS,%CMOVE,%VPTP,%P 1:PTP, 2:P1, 3:, 5:50, 7:PDAT1$BWDSTART=FALSEPDAT_ACT=PPDAT1FDAT_ACT=FP1BAS(#PTP_PARAMS,50)PTP XP1;ENDFOLD;FOLD PTP P2 Vel=50 % PDAT2 Tool[0] Base[0];%{PE}%R 5.5.29,%MKUKATPBASIS,%CMOVE,%VPTP,%P 1:PTP, 2:P2, 3:, 5:50, 7:PDAT2$BWDSTART=FALSEPDAT_ACT=PPDAT2FDAT_ACT=FP2BAS(#PTP_PARAMS,50)PTP XP2;ENDFOLD;FOLD PTP P3 Vel=50 % PDAT3 Tool[0] Base[0];%{PE}%R 5.5.29,%MKUKATPBASIS,%CMOVE,%VPTP,%P 1:PTP, 2:P3, 3:, 5:50, 7:PDAT3$BWDSTART=FALSEPDAT_ACT=PPDAT3FDAT_ACT=FP3BAS(#PTP_PARAMS,50)PTP XP3;ENDFOLD