ABB机器人码垛程序(DOC48)3125.doc
( 4.5 )《ABB机器人码垛程序(DOC48)3125.doc》由会员分享，可在线阅读，更多相关《ABB机器人码垛程序(DOC48)3125.doc（78页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。
1、Evaluation Warning: The document was created with Spire.Doc for .NET.MODULE MainModulePROC Maain()TPErasee;TPReadNNum nCCount11, Qiing Shhu Ru Yi Maa Bao Shu! ;TPReadNNum nJJob, Qing Shu RRu Mo Shi:550KG:=1,25KKG:=2!;InitAlll;WHILE TTRUE DDOReadTyppe;clock2rre;PickIF;clock2rre;PlaceOFF;ENDWHILLEENDP
2、ROCCPROC cllock2rre()!tempinnt:=moovstatt; IIF DI110_1Prroductt0K = 0 orr DI110_2TuuoPanOOK = 00 ThennIF temppint00.25 tthenClkStarrt CLKK2;ELSEClkStopp CLK22;ENDIFElseClkStopp CLK22;EndIFEndproccPROC InnitAlll()MoveHomme;Reset DDO10_11JiaZhhua;Reset DDO10_22YaBann;Reset DDO10_33ZhuaOOK;Reset DDO10_
3、44MaDuooOK;Waittimme 0.55;bPickPaart:=FFALSE;ClkReseet CLKK1;ClkStarrt CLKK1;ClkReseet CLKK2;MoveL OOffs(ppPick,0,0,4400), vFastt, z100, tGrripperrWObjj:=wobbj0;ENDPROCCPROC PiickIF()IF bPiickParrt = FFALSE AND nnJob 0 AAND DII10_1PProducct0K = 1 THHEN!CalcullatePiick;MoveJ OOffs(ppPick,0,0,4400), v
4、Fastt, z2000, tGGrippeerWObbj:=woobj0;!MoveLDDO Offfs(pPiick,0,0,1000), vFFast, z20, tool00WObjj:=wobbj0, DDO10_11JiaZhhua, 11;MoveL ppPick, vFasst, fiine, ttGrippperWOObj:=wwobj0;Close1;GripLoaad LoaadFulll;Accset 50,500;HandshaakeIF;bPickPaart:=TTRUE;ConfLOOff;MoveJ ppAfterrPick, vFasst, z660, tGG
5、rippeerWObbj:=woobj0;ENDIFENDPROCCPROC PllaceOFF()IF DI100_2TuooPanOKK = 1 AND bbPickPPart = TRUEE THENNCalculaatePlaace;ConfLOOff;!MoveL Offs(pOverr,0,0,nOffssZ2), vFastt, z2000, tGGrippeer;IF bTaag=truue theenAccseet 70, 70;MoveJJ pAboovePlaace, vvFast, z10, tGriipperWObj:=wobjj0;elseAccset 90, 99
6、0; MoveeJ pAbbovePllace, vFastt, z100, tGrripperrWObjj:=wobbj0; EndiffAccset 100,1100;! placee firsst boxxConfLOOff;!MoveL Offs(pPlacce1,nOOffsX11,nOfffsY1,nnOffsZZ1),vTTurn,zz10,tGGrippeerWObbj:=woobj0;MoveL ppPlacee1, vMMiddlee, finne, tGGrippeerWObbj:=woobj0;Open1;ConfLOOff;MoveL OOffs(ppPlacee1,
7、0,00,nOfffsZ1),vMidddle,z55,tGriipperWObj:=wobjj0;GripLoaad LoaadEmptty;Accset 100,1100;bPickPaart:=FFALSE;Incr nCCount11;HandshaakeOF;MoveJ ppAboveePick, vFasst, z2200, ttGrippperWOObj:=wwobj0;MoveL OOffs(ppPick,0,0,4400), vFastt, z100, tGrripperrWObjj:=wobbj0;!MoveJ pHomee, vFaast, zz200, tGripppe
8、r;ENDIFENDPROCCPROC HaandshaakeIF()IF nJobb=1 THHEN!Set DOO10_3ZZhuaOKK;ENDIFIF nJobb=2 THHEN!Set DOO10_3ZZhuaOKK;ENDIFENDPROCCPROC HaandshaakeOF()IF (nCCount11=40 aand nJJob =11) or (nCouunt1=880 andd nJobb =2) THENSet DO110_4MaaDuoOKK;WaitDI DI10_2TuoPPanOK, 0;SetDOSSDelayy:=0.55,DO100_4MaDDuoOK,0
9、;nCount11:=0;ClkStopp CLK11;ClkStopp CLK22;TPErasee;nCycleCCount:=ClkRRead(CCLK1);Waitinggtime:=ClkRRead(CCLK2);TPWritee Cyccle tiime: Num:=nCyccleCouunt;TPWritee Waiiting time in thhis Cyycle: Numm:=Waiitingttime;ClkReseet CLKK2;ClkReseet CLKK1;ClkStarrt CLKK1;ENDIFENDPROCCPROC MooveHomme()TempPP1:
10、=CRRobT(Tool:=tooll0 WOObj:=wwobj0);TempPP1.traans.z:=500 ; MoveeJ TemmpP1, v10000, z200, tGrripperr;MoveJ ppHome, v10000, z220, tGGrippeer;ENDPROCCPROC ReeadTyppe()IF nPriiorityy = 1 AND DDI10_11Produuct0K = 1 THEN!nJob:=1;! Incr nPrioority;ELSEIF nPrioority = 2 AAND DII10_1PProducct0K = 1 TTHEN!nJ
11、ob:=2;!Incr nnPriorrity;ELSE!nJob:=0;!Incr nnPriorrity;!IF nPrrioritty2 nnPriorrity:=1;ENDIFENDPROCCPROC Oppen1()Reset DDO10_22YaBann;Waittimme 0.00;Reset DDO10_11JiaZhhua;waittimme 0.11;!Waittiime nTTimeGrripperr;ENDPROCCPROC Cllose1()Set DO110_1JiiaZhuaa;Waittimme 0.00;WaitDI DI10_4Zhuaa1End, 1;Se
12、t DO110_2YaaBan;Waittimme 0.00;!Waittiime nTTimeGrripperr;WaitDI DI10_4Zhuaa1End, 1;!WaitDII DI100_6Zhuua2Endd, 1;ENDPROCCPROC CaalculaatePicck()IF nJobb = 1 THENpPick:=pPickk1;ELSEIF nJob = 2 TTHENpPick:=pPickk1;ENDIF!pAboveePick:=pPicck;!pAfterrPick:=pPicck;!Patterrn80;!pAboveePick.transs.z:= pAft
13、eerPickk.tranns.z;!pAboveePick.transs.y:= pAfteerPickk.tranns.y-5500;!pAfterrPick.transs.y:= pAfteerPickk.tranns.y-5500;ENDPROCCPROC CaalculaatePlaace()IF nJobb = 1 THENnBagL:=nBag550L;nBagW:=nBag550W;nBagH:=nBag550H;Patternn80;ELSEIF nJob = 2 TTHENnBagL:=nBag225L;nBagW:=nBag225W;nBagH:=nBag225H;Pat
14、ternn100;ENDIF!pAboveePlacee:=pPllace1;pAfterPPlace:=pAboovePlaace;ENDPROCCPROC Paatternn80()bTag:=FFALSE;TEST nCCount11+1CASE 1:pPlace11:=pBaase1800;pPlace11.tranns.x:=pPlacce1.trrans.xx;pPlace11.tranns.y:=pPlacce1.trrans.yy;pPlace11.tranns.z:=pPlacce1.trrans.zz;nOffsX11:=0;nOffsY11:=0;nOffsZ11:=50
15、00;nOffsZ22:=-5000;nLevel:=1;bTwice:=FALSSE;pAfterPPick.ttrans.z:=pPPick.ttrans.z+4000;pAbovePPlace:=pPlaace1;pAbovePPlace.transs.z:=ppPick.transs.z+4000;bTag:=TTrue;CASE 2:pPlace11:=pBaase0;pPlace11.tranns.x:=pPlacce1.trrans.xx;pPlace11.tranns.y:=pPlacce1.trrans.yy;pPlace11.tranns.z:=pPlacce1.trran
16、s.zz;nOffsX11:=0;nOffsY11:=0;nOffsZ11:=nBaagH*1.2;nOffsZ22:=-5000;nLevel:=1;bTwice:=FALSSE;pAfterPPick.ttrans.z:=pPPick.ttrans.z+4000;pAbovePPlace:=pPlaace1;pAbovePPlace.transs.z:=ppPick.transs.z+4000;CASE 3:pPlace11:=pBaase90;pPlace11.tranns.x:=pPlacce1.trrans.xx;pPlace11.tranns.y:=pPlacce1.trrans.
17、yy+25;pPlace11.tranns.z:=pPlacce1.trrans.zz;nOffsX11:=0;nOffsY11:=0;nOffsZ11:=nBaagH*1.2;nOffsZ22:=-5000;nLevel:=1;bTwice:=FALSSE;pAfterPPick.ttrans.z:=pPPick.ttrans.z+4000;pAbovePPlace:=pPlaace1;pAbovePPlace.transs.z:=ppPick.transs.z+4000;CASE 4:pPlace11:=pBaase90;pPlace11.tranns.x:=pPlacce1.trrans
18、.xx+2*nBBagW;pPlace11.tranns.y:=pPlacce1.trrans.yy+25;pPlace11.tranns.z:=pPlacce1.trrans.zz;nOffsX11:=0;nOffsY11:=0;nOffsZ11:=nBaagH*1.2;nOffsZ22:=-5000;nLevel:=1;bTwice:=FALSSE;pAfterPPick.ttrans.z:=pPPick.ttrans.z+4000;pAbovePPlace:=pPlaace1;pAbovePPlace.transs.z:=ppPick.transs.z+4000;CASE 5:pPlac
19、e11:=pBaase90;pPlace11.tranns.x:=pPlacce1.trrans.xx+nBaggW;pPlace11.tranns.y:=pPlacce1.trrans.yy+25;pPlace11.tranns.z:=pPlacce1.trrans.zz+20;nOffsX11:=0;nOffsY11:=0;nOffsZ11:=nBaagH*1.2;nOffsZ22:=-5000;nLevel:=1;bTwice:=FALSSE;pAfterPPick.ttrans.z:=pPPick.ttrans.z+4000;pAbovePPlace:=pPlaace1;pAboveP
20、Place.transs.z:=ppPick.transs.z+4000;!Layer22 CASE 6:pPlace11:=pBaase1800;pPlace11.tranns.x:=pPlacce1.trrans.xx;pPlace11.tranns.y:=pPlacce1.trrans.yy+nBaggL-5;pPlace11.tranns.z:=pPlacce1.trrans.zz+nBaggH;nOffsX11:=0;nOffsY11:=0;nOffsZ11:=nBaagH*1.2;nOffsZ22:=-5000;nLevel:=1;bTwice:=FALSSE;pAfterPPic
21、k.ttrans.z:=pPPick.ttrans.z+4000;pAbovePPlace:=pPlaace1;pAbovePPlace.transs.z:=ppPick.transs.z+4000;CASE 7:pPlace11:=pBaase0;pPlace11.tranns.x:=pPlacce1.trrans.xx;pPlace11.tranns.y:=pPlacce1.trrans.yy+nBaggL-5;pPlace11.tranns.z:=pPlacce1.trrans.zz+nBaggH;nOffsX11:=0;nOffsY11:=0;nOffsZ11:=nBaagH*1.2;
22、nOffsZ22:=-5000;nLevel:=1;bTwice:=FALSSE;pAfterPPick.ttrans.z:=pPPick.ttrans.z+4000;pAbovePPlace:=pPlaace1;pAbovePPlace.transs.z:=ppPick.transs.z+4000;CASE 8:pPlace11:=pBaase2700;pPlace11.tranns.x:=pPlacce1.trrans.xx;pPlace11.tranns.y:=pPlacce1.trrans.yy;pPlace11.tranns.z:=pPlacce1.trrans.zz;nOffsX1
- 配套讲稿：
如PPT文件的首页显示word图标，表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制：
部分文档作品中含有的国旗、国徽等图片，仅作为作品整体效果示例展示，禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词：
- ABB 机器人 码垛 程序 DOC48 3125
淘文阁 - 分享文档赚钱的网站所有资源均是用户自行上传分享，仅供网友学习交流，未经上传用户书面授权，请勿作他用。
限制150内