最近要考试了,刚好分享下笔记 具体程序如下,适用于简单的码垛机器人编程 共有三个点需要经过,原点、p1、p2、p3三个点, 其中p1点为吸盘或抓手在空中运行的位置, p2为正在抓取实物的位置, p3为抓手释放物体的位置 大致的运行轨迹为: 原点开始运动——到达p1的位置——向下贴近传送带到达p2吸附住(或抓取)物体——抬升机器臂,回到位于半空的p1——然后机器臂将物体移动到p3点开始释放物体——重复该运动四次——最终回归原点 注:每次停留的时间为一秒
实际编程如下(部分代码有编程软件自带的部分代码,实际代码自行底部看图) DEF Modul ( ) DECL E6POS zhua,fang DECL INT a ;FOLD INI ;FOLD BASISTECH INI
GLOBAL 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:DEFAULTBWDSTART = 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:1 WAIT SEC 1 ;ENDFOLD zhua.z=zhua.z+100 LIN zhua fang.z=famg.z+100+17*a LIN fang fang.z=fang.z-100 LIN 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:DEFAULTBWDSTART = 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:PDAT1BWDSTART=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:PDAT2BWDSTART=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:PDAT3BWDSTART=FALSEPDAT_ACT=PPDAT3FDAT_ACT=FP3BAS(#PTP_PARAMS,50)PTP XP3 ;ENDFOLD