更新:更新kuka程序
This commit is contained in:
@@ -1,12 +1,8 @@
|
||||
&ACCESS RV2
|
||||
&ACCESS RV
|
||||
DEF ActionReturn (nRet:IN )
|
||||
DECL INT nRet
|
||||
CONTINUE
|
||||
Q_CmdCountRet=CmdCountLast
|
||||
CONTINUE
|
||||
Q_CmdResult=nRet
|
||||
CONTINUE
|
||||
Q_CmdRet=CmdSave
|
||||
CONTINUE
|
||||
Q_CmdRet=CmdSave
|
||||
Q_Cmd_Running=0
|
||||
END
|
||||
@@ -1,20 +1,20 @@
|
||||
&ACCESS RV5
|
||||
&ACCESS RV1
|
||||
DEFDAT CONFIG PUBLIC
|
||||
|
||||
GLOBAL INT PdtTypeLast=0
|
||||
GLOBAL INT CmdSave=11
|
||||
GLOBAL INT CmdCountLast=304
|
||||
GLOBAL INT CmdCountLast=108
|
||||
GLOBAL INT PlaceOffsetX_Save=-1258
|
||||
GLOBAL INT PlaceOffsetY_Save=-3000
|
||||
GLOBAL INT PlaceOffsetZ_Save=0
|
||||
GLOBAL INT PickOffsetX_Save=0
|
||||
GLOBAL INT PickOffsetY_Save=0
|
||||
GLOBAL INT PickOffsetZ_Save=0
|
||||
GLOBAL INT CountX_Save=0
|
||||
GLOBAL INT CountY_Save=3
|
||||
GLOBAL INT CountX_Save=10
|
||||
GLOBAL INT CountY_Save=2
|
||||
|
||||
GLOBAL BOOL ConfMessSave=FALSE
|
||||
|
||||
DECL GLOBAL E6POS END_POS={X -367.936188,Y 3333.63623,Z 553.180,A -166.138092,B 0.376110703,C 179.734543,S 'B0010',T 'B00100011',E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL GLOBAL E6POS END_POS={X 234.879028,Y 2044.02686,Z 377.353760,A -165.224686,B 0.377169758,C 179.736649,S 'B0010',T 'B00101011',E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
|
||||
ENDDAT
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RVP2
|
||||
&ACCESS RVO
|
||||
DEF GripClose ( )
|
||||
Q_GripPosIndex=102
|
||||
Q_GripPosCount=I_GripPosCountRet+1
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RVP1
|
||||
&ACCESS RVO
|
||||
DEF GripOpen ( )
|
||||
|
||||
Q_GripPosIndex=101
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RVP
|
||||
&ACCESS RVO
|
||||
&REL 3
|
||||
&PARAM DISKPATH = KRC:\R1\Program\Home
|
||||
DEFDAT HOMEMODULE
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RVP
|
||||
&ACCESS RVO
|
||||
&REL 3
|
||||
&PARAM DISKPATH = KRC:\R1\Program\Home
|
||||
DEF HomeModule ( )
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RVP
|
||||
&ACCESS RVO
|
||||
&REL 1
|
||||
DEFDAT MainModule
|
||||
;FOLD EXTERNAL DECLARATIONS;%{PE}%MKUKATPBASIS,%CEXT,%VCOMMON,%P
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RVP
|
||||
&ACCESS RVO
|
||||
&REL 1
|
||||
DEF MainModule()
|
||||
;FOLD INI
|
||||
@@ -15,10 +15,10 @@ DEF MainModule()
|
||||
INTERRUPT DECL 24 WHEN $CYCFLAG[1] DO StopSafty()
|
||||
INTERRUPT ON 24
|
||||
|
||||
;FOLD PTP $POS_ACT Tool[0] Base[0]
|
||||
;FOLD PTP $POS_ACT Tool[1] Base[1]
|
||||
BAS(#INITMOV, 0)
|
||||
BAS(#BASE, 0)
|
||||
BAS(#TOOL, 0)
|
||||
BAS(#BASE, 1)
|
||||
BAS(#TOOL, 1)
|
||||
PTP $POS_ACT
|
||||
;ENDFOLD
|
||||
$ov_pro=40
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RVO2
|
||||
&ACCESS RVO
|
||||
DEFFCT BOOL CheckInPos (R_offset:IN,EndPos:IN )
|
||||
DECL REAL R_offset
|
||||
DECL BOOL b_Pok
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RV1
|
||||
&ACCESS RV
|
||||
DEFFCT INT GetInt16 (iVal:IN )
|
||||
DECL INT iVal,iRet
|
||||
IF iVal>32767 THEN
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RVP1
|
||||
&ACCESS RVO
|
||||
&REL 7
|
||||
&PARAM DISKPATH = KRC:\R1\Program\PL
|
||||
DEFDAT FEEDBELT1PICK
|
||||
@@ -15,10 +15,10 @@ DECL INT SUCCESS
|
||||
|
||||
DECL MODULEPARAM_T LAST_TP_PARAMS={PARAMS[] "Kuka.VelocityFieldEnabled=True; Kuka.ColDetectFieldEnabled=True; Kuka.MovementParameterFieldEnabled=True; Kuka.IsAngleEnabled=False; Kuka.PointName=PickH; Kuka.FrameData.base_no=1; Kuka.FrameData.tool_no=1; Kuka.FrameData.ipo_frame=#BASE; Kuka.isglobalpoint=False; Kuka.MoveDataPtpName=PDAT2; Kuka.MovementDataPdat.apo_mode=#CDIS; Kuka.MovementDataPdat.apo_dist=500; Kuka.MovementData.vel=100; Kuka.MovementData.acc=100; Kuka.MovementData.exax_ign=0; Kuka.VelocityPtp=100; Kuka.BlendingEnabled=True; Kuka.APXEnabled=False; Kuka.CurrentCDSetIndex=0; Kuka.MoveDataName=CPDAT3; Kuka.MovementData.cb={AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}}; Kuka.MovementData.apo_fac=50; Kuka.MovementData.apo_dist=500; Kuka.MovementData.axis_acc=100; Kuka.MovementData.axis_vel=100; Kuka.MovementData.circ_typ=#BASE; Kuka.MovementData.jerk_fac=50; Kuka.MovementData.ori_typ=#VAR; Kuka.VelocityPath=2; Kuka.FrameData.point2="}
|
||||
DECL FDAT FPickH={TOOL_NO 1,BASE_NO 1,IPO_FRAME #BASE,POINT2[] " "}
|
||||
DECL E6POS XPickH={X -367.936188,Y 3333.63623,Z 553.180,A -166.138535,B 0.376175523,C 179.734436,S 2,T 35,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL E6POS XPickH={X -368.575958,Y 3343.96265,Z 553.180481,A -166.138535,B 0.376172692,C 179.734436,S 2,T 35,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL LDAT LCPDAT1={VEL 2.00000,ACC 100.000,APO_DIST 500.000,APO_FAC 50.0000,AXIS_VEL 100.000,AXIS_ACC 100.000,ORI_TYP #VAR,CIRC_TYP #BASE,JERK_FAC 50.0000,GEAR_JERK 100.000,EXAX_IGN 0,CB {AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}}}
|
||||
DECL FDAT FPick={TOOL_NO 1,BASE_NO 1,IPO_FRAME #BASE,POINT2[] " "}
|
||||
DECL E6POS XPick={X -367.936188,Y 3333.63623,Z 53.1799889,A -166.138535,B 0.376175523,C 179.734436,S 2,T 35,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL E6POS XPick={X -368.575958,Y 3343.96265,Z 53.1804581,A -166.138535,B 0.376172692,C 179.734436,S 2,T 35,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL LDAT LCPDAT2={VEL 2.00000,ACC 100.000,APO_DIST 500.000,APO_FAC 50.0000,AXIS_VEL 100.000,AXIS_ACC 100.000,ORI_TYP #VAR,CIRC_TYP #BASE,JERK_FAC 50.0000,GEAR_JERK 100.000,EXAX_IGN 0,CB {AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}}}
|
||||
|
||||
DECL PDAT PPDAT1={VEL 100.000,ACC 100.000,APO_DIST 500.000,APO_MODE #CDIS,GEAR_JERK 100.000,EXAX_IGN 0}
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RVP1
|
||||
&ACCESS RVO
|
||||
&REL 7
|
||||
&PARAM DISKPATH = KRC:\R1\Program\PL
|
||||
DEF FeedBelt1Pick ( )
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RVO1
|
||||
&ACCESS RVO
|
||||
&REL 9
|
||||
&PARAM DISKPATH = KRC:\R1\Program\PL
|
||||
DEFDAT FEEDBELT2PICK
|
||||
@@ -18,8 +18,8 @@ DECL LDAT LCPDAT1={VEL 2.00000,ACC 100.000,APO_DIST 500.000,APO_FAC 50.0000,AXIS
|
||||
DECL PDAT PPDAT1={VEL 100.000,ACC 100.000,APO_DIST 500.000,APO_MODE #CDIS,GEAR_JERK 100.000,EXAX_IGN 0}
|
||||
DECL FDAT FPickH={TOOL_NO 1,BASE_NO 1,IPO_FRAME #BASE,POINT2[] " "}
|
||||
DECL MODULEPARAM_T LAST_TP_PARAMS={PARAMS[] "Kuka.VelocityFieldEnabled=True; Kuka.ColDetectFieldEnabled=True; Kuka.MovementParameterFieldEnabled=True; Kuka.IsAngleEnabled=False; Kuka.PointName=PickH; Kuka.FrameData.base_no=1; Kuka.FrameData.tool_no=1; Kuka.FrameData.ipo_frame=#BASE; Kuka.isglobalpoint=False; Kuka.MoveDataPtpName=PDAT2; Kuka.MovementDataPdat.apo_mode=#CDIS; Kuka.MovementDataPdat.apo_dist=500; Kuka.MovementData.vel=100; Kuka.MovementData.acc=100; Kuka.MovementData.exax_ign=0; Kuka.VelocityPtp=100; Kuka.BlendingEnabled=True; Kuka.APXEnabled=False; Kuka.CurrentCDSetIndex=0; Kuka.MoveDataName=CPDAT3; Kuka.MovementData.cb={AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}}; Kuka.MovementData.apo_fac=50; Kuka.MovementData.apo_dist=500; Kuka.MovementData.axis_acc=100; Kuka.MovementData.axis_vel=100; Kuka.MovementData.circ_typ=#BASE; Kuka.MovementData.jerk_fac=50; Kuka.MovementData.ori_typ=#VAR; Kuka.VelocityPath=2; Kuka.FrameData.point2="}
|
||||
DECL E6POS XPickH={X -510.559875,Y 3333.63623,Z 553.180,A -166.138535,B 0.376175523,C 179.734436,S 2,T 35,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL E6POS XPick={X -510.559875,Y 3333.63623,Z 53.1799850,A -166.138535,B 0.376175523,C 179.734436,S 2,T 35,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL E6POS XPickH={X -507.873199,Y 3343.96265,Z 553.180481,A -166.138535,B 0.376172692,C 179.734436,S 2,T 35,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL E6POS XPick={X -507.873199,Y 3343.96265,Z 53.1804581,A -166.138535,B 0.376172692,C 179.734436,S 2,T 35,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL FDAT FPick={TOOL_NO 1,BASE_NO 1,IPO_FRAME #BASE,POINT2[] " "}
|
||||
DECL LDAT LCPDAT3={VEL 2.00000,ACC 100.000,APO_DIST 500.000,APO_FAC 50.0000,AXIS_VEL 100.000,AXIS_ACC 100.000,ORI_TYP #VAR,CIRC_TYP #BASE,JERK_FAC 50.0000,GEAR_JERK 100.000,EXAX_IGN 0,CB {AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}}}
|
||||
DECL PDAT PPDAT2={VEL 100.000,ACC 100.000,APO_DIST 500.000,APO_MODE #CDIS,GEAR_JERK 100.000,EXAX_IGN 0}
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RVO1
|
||||
&ACCESS RVO
|
||||
&REL 9
|
||||
&PARAM DISKPATH = KRC:\R1\Program\PL
|
||||
DEF FeedBelt2Pick ( )
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RVO1
|
||||
&ACCESS RVO
|
||||
&REL 3
|
||||
&PARAM DISKPATH = KRC:\R1\Program\PL
|
||||
DEFDAT NGBELTPLACE
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RVO1
|
||||
&ACCESS RVO
|
||||
&REL 3
|
||||
&PARAM DISKPATH = KRC:\R1\Program\PL
|
||||
DEF NgBeltPlace ( )
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RV1
|
||||
&ACCESS RV
|
||||
&REL 15
|
||||
&PARAM DISKPATH = KRC:\R1\Program\PL
|
||||
DEFDAT PALLET1PLACE
|
||||
@@ -15,13 +15,13 @@ DECL INT SUCCESS
|
||||
|
||||
|
||||
|
||||
DECL MODULEPARAM_T LAST_TP_PARAMS={PARAMS[] "Kuka.VelocityFieldEnabled=True; Kuka.ColDetectFieldEnabled=True; Kuka.MovementParameterFieldEnabled=True; Kuka.IsAngleEnabled=False; Kuka.PointName=PlaceSig; Kuka.FrameData.base_no=0; Kuka.FrameData.tool_no=1; Kuka.FrameData.ipo_frame=#BASE; Kuka.isglobalpoint=False; Kuka.MoveDataPtpName=PDAT6; Kuka.MovementDataPdat.apo_mode=#CDIS; Kuka.MovementDataPdat.apo_dist=500; Kuka.MovementData.vel=2; Kuka.MovementData.acc=100; Kuka.MovementData.exax_ign=0; Kuka.VelocityPtp=100; Kuka.BlendingEnabled=False; Kuka.APXEnabled=False; Kuka.CurrentCDSetIndex=0; Kuka.MoveDataName=CPDAT8; Kuka.MovementData.cb={AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}}; Kuka.MovementData.apo_fac=50; Kuka.MovementData.apo_dist=500; Kuka.MovementData.axis_acc=100; Kuka.MovementData.axis_vel=100; Kuka.MovementData.circ_typ=#BASE; Kuka.MovementData.jerk_fac=50; Kuka.MovementData.ori_typ=#VAR; Kuka.VelocityPath=2; Kuka.FrameData.point2= "}
|
||||
DECL FDAT FPlaceH={TOOL_NO 1,BASE_NO 1,IPO_FRAME #BASE,POINT2[] " "}
|
||||
DECL MODULEPARAM_T LAST_TP_PARAMS = {PARAMS[] "Kuka.VelocityFieldEnabled=True; Kuka.ColDetectFieldEnabled=True; Kuka.MovementParameterFieldEnabled=True; Kuka.IsAngleEnabled=False; Kuka.PointName=PlaceH; Kuka.FrameData.base_no=1; Kuka.FrameData.tool_no=1; Kuka.FrameData.ipo_frame=#BASE; Kuka.isglobalpoint=False; Kuka.MoveDataPtpName=PDAT6; Kuka.MovementDataPdat.apo_mode=#CDIS; Kuka.MovementDataPdat.apo_dist=500; Kuka.MovementData.vel=2; Kuka.MovementData.acc=100; Kuka.MovementData.exax_ign=0; Kuka.VelocityPtp=100; Kuka.BlendingEnabled=False; Kuka.APXEnabled=False; Kuka.CurrentCDSetIndex=0; Kuka.MoveDataName=CPDAT2; Kuka.MovementData.cb={AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}}; Kuka.MovementData.apo_fac=50; Kuka.MovementData.apo_dist=500; Kuka.MovementData.axis_acc=100; Kuka.MovementData.axis_vel=100; Kuka.MovementData.circ_typ=#BASE; Kuka.MovementData.jerk_fac=50; Kuka.MovementData.ori_typ=#VAR; Kuka.VelocityPath=2; Kuka.FrameData.point2= "}
|
||||
DECL FDAT FPlaceH={BASE_NO 1,TOOL_NO 1,IPO_FRAME #BASE,POINT2[] " "}
|
||||
DECL E6POS XPlaceH={X 1501.64038,Y 1742.32153,Z 765.978271,A -164.789139,B 0.414351225,C 179.724762,S 2,T 43,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL LDAT LCPDAT1={VEL 2.00000,ACC 100.000,APO_DIST 500.000,APO_FAC 50.0000,AXIS_VEL 100.000,AXIS_ACC 100.000,ORI_TYP #VAR,CIRC_TYP #BASE,JERK_FAC 50.0000,GEAR_JERK 100.000,EXAX_IGN 0,CB {AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}}}
|
||||
DECL FDAT FPlace={TOOL_NO 1,BASE_NO 1,IPO_FRAME #BASE,POINT2[] " "}
|
||||
DECL E6POS XPlace={X 1501.64038,Y 1742.32153,Z 265.978241,A -164.789139,B 0.414351225,C 179.724762,S 2,T 43,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL LDAT LCPDAT2={VEL 2.00000,ACC 100.000,APO_DIST 500.000,APO_FAC 50.0000,AXIS_VEL 100.000,AXIS_ACC 100.000,ORI_TYP #VAR,CIRC_TYP #BASE,JERK_FAC 50.0000,GEAR_JERK 100.000,EXAX_IGN 0,CB {AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}}}
|
||||
DECL LDAT LCPDAT2={CB {AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}},APO_FAC 50.0,APO_DIST 500,AXIS_ACC 100.0,AXIS_VEL 100.0,CIRC_TYP #BASE,JERK_FAC 50.0,ORI_TYP #VAR,VEL 2,ACC 100,GEAR_JERK 100.0,EXAX_IGN 0}
|
||||
DECL PDAT PPDAT1={VEL 100.000,ACC 100.000,APO_DIST 500.000,APO_MODE #CDIS,GEAR_JERK 100.000,EXAX_IGN 0}
|
||||
DECL FDAT FHOME1={TOOL_NO 1,BASE_NO 1,IPO_FRAME #BASE,POINT2[] " "}
|
||||
DECL PDAT PPDAT2={VEL 100.000,ACC 100.000,APO_DIST 500.000,APO_MODE #CDIS,GEAR_JERK 100.000,EXAX_IGN 0}
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RV1
|
||||
&ACCESS RV
|
||||
&REL 15
|
||||
&PARAM DISKPATH = KRC:\R1\Program\PL
|
||||
DEF Pallet1Place ( )
|
||||
@@ -81,18 +81,18 @@ SET_CD_PARAMS (0)
|
||||
LIN XPlace
|
||||
;ENDFOLD
|
||||
GripOpen()
|
||||
;FOLD LIN PlaceH CONT Vel=2 m/s CPDAT2 Tool[1] Base[1] ;%{PE}
|
||||
;FOLD Parameters ;%{h}
|
||||
;Params IlfProvider=kukaroboter.basistech.inlineforms.movement.old; Kuka.IsGlobalPoint=False; Kuka.PointName=PlaceH; Kuka.BlendingEnabled=True; Kuka.MoveDataName=CPDAT2; Kuka.VelocityPath=2; Kuka.CurrentCDSetIndex=0; Kuka.MovementParameterFieldEnabled=True; IlfCommand=LIN
|
||||
;FOLD LIN PlaceH Vel=2 m/s CPDAT2 Tool[1] Base[1] ;%{PE}
|
||||
;FOLD Parameters ;%{h}
|
||||
;Params IlfProvider=kukaroboter.basistech.inlineforms.movement.old; Kuka.IsGlobalPoint=False; Kuka.PointName=PlaceH; Kuka.BlendingEnabled=False; Kuka.MoveDataName=CPDAT2; Kuka.VelocityPath=2; Kuka.CurrentCDSetIndex=0; Kuka.MovementParameterFieldEnabled=True; IlfCommand=LIN
|
||||
;ENDFOLD
|
||||
$BWDSTART = FALSE
|
||||
LDAT_ACT = LCPDAT2
|
||||
FDAT_ACT = FPlaceH
|
||||
BAS(#CP_PARAMS, 2.0)
|
||||
SET_CD_PARAMS (0)
|
||||
LIN XPlaceH
|
||||
;ENDFOLD
|
||||
$BWDSTART = FALSE
|
||||
LDAT_ACT = LCPDAT2
|
||||
FDAT_ACT = FPlaceH
|
||||
BAS(#CP_PARAMS, 2.0)
|
||||
SET_CD_PARAMS (0)
|
||||
LIN XPlaceH C_Dis C_Dis
|
||||
;ENDFOLD
|
||||
CONTINUE
|
||||
|
||||
Q_AreaEnter2=FALSE
|
||||
ActionReturn(1)
|
||||
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RVO1
|
||||
&ACCESS RVO
|
||||
&REL 26
|
||||
&PARAM DISKPATH = KRC:\R1\Program\PL
|
||||
DEFDAT PALLET2PLACE
|
||||
@@ -14,10 +14,10 @@ DECL INT SUCCESS
|
||||
;ENDFOLD (EXTERNAL DECLARATIONS)
|
||||
DECL MODULEPARAM_T LAST_TP_PARAMS={PARAMS[] "Kuka.VelocityFieldEnabled=True; Kuka.ColDetectFieldEnabled=True; Kuka.MovementParameterFieldEnabled=True; Kuka.IsAngleEnabled=False; Kuka.PointName=PlaceSigH; Kuka.FrameData.base_no=1; Kuka.FrameData.tool_no=1; Kuka.FrameData.ipo_frame=#BASE; Kuka.isglobalpoint=False; Kuka.MoveDataPtpName=PDAT19; Kuka.MovementDataPdat.apo_mode=#CDIS; Kuka.MovementDataPdat.apo_dist=500; Kuka.MovementData.vel=2; Kuka.MovementData.acc=100; Kuka.MovementData.exax_ign=0; Kuka.VelocityPtp=100; Kuka.BlendingEnabled=True; Kuka.APXEnabled=False; Kuka.CurrentCDSetIndex=0; Kuka.MoveDataName=CPDAT7; Kuka.MovementData.cb={AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}}; Kuka.MovementData.apo_fac=50; Kuka.MovementData.apo_dist=500; Kuka.MovementData.axis_acc=100; Kuka.MovementData.axis_vel=100; Kuka.MovementData.circ_typ=#BASE; Kuka.MovementData.jerk_fac=50; Kuka.MovementData.ori_typ=#VAR; Kuka.VelocityPath=2; Kuka.FrameData.point2= "}
|
||||
DECL FDAT FPlaceH={TOOL_NO 1,BASE_NO 1,IPO_FRAME #BASE,POINT2[] " "}
|
||||
DECL E6POS XPlaceH={X 1492.87903,Y 1744.02686,Z 467.353760,A -165.224686,B 0.377169758,C 179.736649,S 2,T 43,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL E6POS XPlaceH={X 234.879028,Y 2044.02686,Z 377.353760,A -165.224686,B 0.377169758,C 179.736649,S 2,T 43,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL LDAT LCPDAT1={VEL 2.00000,ACC 100.000,APO_DIST 500.000,APO_FAC 50.0000,AXIS_VEL 100.000,AXIS_ACC 100.000,ORI_TYP #VAR,CIRC_TYP #BASE,JERK_FAC 50.0000,GEAR_JERK 100.000,EXAX_IGN 0,CB {AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}}}
|
||||
DECL FDAT FPlace={TOOL_NO 1,BASE_NO 1,IPO_FRAME #BASE,POINT2[] " "}
|
||||
DECL E6POS XPlace={X 1492.87903,Y 1744.02686,Z 67.3537521,A -165.224686,B 0.377169758,C 179.736649,S 2,T 43,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL E6POS XPlace={X 234.879028,Y 2044.02686,Z 67.3537521,A -165.224686,B 0.377169758,C 179.736649,S 2,T 43,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL LDAT LCPDAT2={VEL 2.00000,ACC 100.000,APO_DIST 500.000,APO_FAC 50.0000,AXIS_VEL 100.000,AXIS_ACC 100.000,ORI_TYP #VAR,CIRC_TYP #BASE,JERK_FAC 50.0000,GEAR_JERK 100.000,EXAX_IGN 0,CB {AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}}}
|
||||
DECL PDAT PPDAT1={VEL 100.000,ACC 100.000,APO_DIST 500.000,APO_MODE #CDIS,GEAR_JERK 100.000,EXAX_IGN 0}
|
||||
DECL FDAT FHOME1={TOOL_NO 1,BASE_NO 1,IPO_FRAME #BASE,POINT2[] " "}
|
||||
@@ -33,12 +33,12 @@ DECL E6POS XPass={X 569.963684,Y 3051.40015,Z 726.036499,A 165.563766,B 0.200981
|
||||
DECL FDAT FPass={TOOL_NO 1,BASE_NO 1,IPO_FRAME #BASE,POINT2[] " "}
|
||||
DECL PDAT PPDAT18={VEL 100.000,ACC 100.000,APO_DIST 500.000,APO_MODE #CDIS,GEAR_JERK 100.000,EXAX_IGN 0}
|
||||
DECL LDAT LCPDAT5={VEL 2.00000,ACC 100.000,APO_DIST 500.000,APO_FAC 50.0000,AXIS_VEL 100.000,AXIS_ACC 100.000,ORI_TYP #VAR,CIRC_TYP #BASE,JERK_FAC 50.0000,GEAR_JERK 100.000,EXAX_IGN 0,CB {AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}}}
|
||||
DECL E6POS XPlaceSigH={X 1442.87903,Y 1744.02686,Z 567.353760,A -165.224686,B 0.377169758,C 179.736649,S 2,T 43,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL E6POS XPlaceSigH={X 184.879028,Y 2044.02686,Z 567.353760,A -165.224686,B 0.377169758,C 179.736649,S 2,T 43,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL FDAT FPlaceSigH={TOOL_NO 1,BASE_NO 1,IPO_FRAME #BASE,POINT2[] " "}
|
||||
DECL LDAT LCPDAT6={VEL 2.00000,ACC 100.000,APO_DIST 500.000,APO_FAC 50.0000,AXIS_VEL 100.000,AXIS_ACC 100.000,ORI_TYP #VAR,CIRC_TYP #BASE,JERK_FAC 50.0000,GEAR_JERK 100.000,EXAX_IGN 0,CB {AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}}}
|
||||
DECL PDAT PPDAT19={VEL 100.000,ACC 100.000,APO_DIST 500.000,APO_MODE #CDIS,GEAR_JERK 100.000,EXAX_IGN 0}
|
||||
DECL LDAT LCPDAT7={VEL 2.00000,ACC 100.000,APO_DIST 500.000,APO_FAC 50.0000,AXIS_VEL 100.000,AXIS_ACC 100.000,ORI_TYP #VAR,CIRC_TYP #BASE,JERK_FAC 50.0000,GEAR_JERK 100.000,EXAX_IGN 0,CB {AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}}}
|
||||
DECL E6POS XPlaceSig={X 1442.87903,Y 1744.02686,Z 467.353760,A -165.224686,B 0.377169758,C 179.736649,S 2,T 43,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL E6POS XPlaceSig={X 184.879028,Y 2044.02686,Z 377.353760,A -165.224686,B 0.377169758,C 179.736649,S 2,T 43,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL FDAT FPlaceSig={TOOL_NO 1,BASE_NO 1,IPO_FRAME #BASE,POINT2[] " "}
|
||||
DECL LDAT LCPDAT8={VEL 2.00000,ACC 100.000,APO_DIST 493.000,APO_FAC 50.0000,AXIS_VEL 100.000,AXIS_ACC 100.000,ORI_TYP #VAR,CIRC_TYP #BASE,JERK_FAC 50.0000,GEAR_JERK 100.000,EXAX_IGN 0,CB {AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}}}
|
||||
ENDDAT
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RVO1
|
||||
&ACCESS RVO
|
||||
&REL 26
|
||||
&PARAM DISKPATH = KRC:\R1\Program\PL
|
||||
DEF Pallet2Place ( )
|
||||
@@ -69,7 +69,7 @@ LIN XPlaceH C_Dis C_Dis
|
||||
CONTINUE
|
||||
WAIT FOR I_AreaReady2 AND I_GripSafty1 AND I_GripSafty2
|
||||
CONTINUE
|
||||
Q_AreaEnter2=TRUE
|
||||
Q_AreaEnter3=TRUE
|
||||
;FOLD LIN Place Vel=2 m/s CPDAT1 Tool[1] Base[1] ;%{PE}
|
||||
;FOLD Parameters ;%{h}
|
||||
;Params IlfProvider=kukaroboter.basistech.inlineforms.movement.old; Kuka.IsGlobalPoint=False; Kuka.PointName=Place; Kuka.BlendingEnabled=False; Kuka.MoveDataName=CPDAT1; Kuka.VelocityPath=2; Kuka.CurrentCDSetIndex=0; Kuka.MovementParameterFieldEnabled=True; IlfCommand=LIN
|
||||
@@ -93,8 +93,8 @@ BAS(#CP_PARAMS, 2.0)
|
||||
SET_CD_PARAMS (0)
|
||||
LIN XPlaceH
|
||||
;ENDFOLD
|
||||
CONTINUE
|
||||
Q_AreaEnter2=FALSE
|
||||
|
||||
Q_AreaEnter3=FALSE
|
||||
ActionReturn(1)
|
||||
|
||||
END_POS=$POS_ACT
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RVO1
|
||||
&ACCESS RVO
|
||||
&REL 7
|
||||
&PARAM DISKPATH = KRC:\R1\Program\PL
|
||||
DEFDAT REFEEDBELTPICK
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RVO1
|
||||
&ACCESS RVO
|
||||
&REL 7
|
||||
&PARAM DISKPATH = KRC:\R1\Program\PL
|
||||
DEF ReFeedBeltPick ( )
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RVO1
|
||||
&ACCESS RVO
|
||||
&REL 7
|
||||
&PARAM DISKPATH = KRC:\R1\Program\PL
|
||||
DEFDAT WATERBELTPICK
|
||||
@@ -14,10 +14,10 @@ DECL INT SUCCESS
|
||||
;ENDFOLD (EXTERNAL DECLARATIONS)
|
||||
DECL MODULEPARAM_T LAST_TP_PARAMS={PARAMS[] "Kuka.VelocityFieldEnabled=True; Kuka.ColDetectFieldEnabled=True; Kuka.MovementParameterFieldEnabled=True; Kuka.IsAngleEnabled=False; Kuka.PointName=PickH; Kuka.FrameData.base_no=1; Kuka.FrameData.tool_no=1; Kuka.FrameData.ipo_frame=#BASE; Kuka.isglobalpoint=False; Kuka.MoveDataPtpName=PDAT2; Kuka.MovementDataPdat.apo_mode=#CDIS; Kuka.MovementDataPdat.apo_dist=500; Kuka.MovementData.vel=2; Kuka.MovementData.acc=100; Kuka.MovementData.exax_ign=0; Kuka.VelocityPtp=100; Kuka.BlendingEnabled=False; Kuka.APXEnabled=False; Kuka.CurrentCDSetIndex=0; Kuka.MoveDataName=CPDAT2; Kuka.MovementData.cb={AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}}; Kuka.MovementData.apo_fac=50; Kuka.MovementData.apo_dist=500; Kuka.MovementData.axis_acc=100; Kuka.MovementData.axis_vel=100; Kuka.MovementData.circ_typ=#BASE; Kuka.MovementData.jerk_fac=50; Kuka.MovementData.ori_typ=#VAR; Kuka.VelocityPath=2; Kuka.FrameData.point2= "}
|
||||
DECL FDAT FPickH={TOOL_NO 1,BASE_NO 1,IPO_FRAME #BASE,POINT2[] " "}
|
||||
DECL E6POS XPickH={X -361.108734,Y -30.3251133,Z 595.508240,A 105.463463,B 0.376274616,C 179.736298,S 2,T 42,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL E6POS XPickH={X -374.435608,Y -52.7464218,Z 548.319702,A 104.528885,B 0.376218826,C 179.734528,S 2,T 42,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL LDAT LCPDAT1={VEL 2.00000,ACC 100.000,APO_DIST 500.000,APO_FAC 50.0000,AXIS_VEL 100.000,AXIS_ACC 100.000,ORI_TYP #VAR,CIRC_TYP #BASE,JERK_FAC 50.0000,GEAR_JERK 100.000,EXAX_IGN 0,CB {AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}}}
|
||||
DECL FDAT FPick={TOOL_NO 1,BASE_NO 1,IPO_FRAME #BASE,POINT2[] " "}
|
||||
DECL E6POS XPick={X -361.108734,Y -30.3251133,Z 95.5082550,A 105.463463,B 0.376274616,C 179.736298,S 2,T 42,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL E6POS XPick={X -374.435608,Y -52.7464218,Z 48.3197289,A 104.528885,B 0.376218826,C 179.734528,S 2,T 42,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL LDAT LCPDAT2={VEL 2.00000,ACC 100.000,APO_DIST 500.000,APO_FAC 50.0000,AXIS_VEL 100.000,AXIS_ACC 100.000,ORI_TYP #VAR,CIRC_TYP #BASE,JERK_FAC 50.0000,GEAR_JERK 100.000,EXAX_IGN 0,CB {AUX_PT {ORI #CONSIDER,E1 #CONSIDER,E2 #CONSIDER,E3 #CONSIDER,E4 #CONSIDER,E5 #CONSIDER,E6 #CONSIDER},TARGET_PT {ORI #INTERPOLATE,E1 #INTERPOLATE,E2 #INTERPOLATE,E3 #INTERPOLATE,E4 #INTERPOLATE,E5 #INTERPOLATE,E6 #INTERPOLATE}}}
|
||||
|
||||
DECL PDAT PPDAT1={VEL 100.000,ACC 100.000,APO_DIST 500.000,APO_MODE #CDIS,GEAR_JERK 100.000,EXAX_IGN 0}
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RVO1
|
||||
&ACCESS RVO
|
||||
&REL 7
|
||||
&PARAM DISKPATH = KRC:\R1\Program\PL
|
||||
DEF WaterBeltPick ( )
|
||||
|
||||
@@ -1,9 +1,29 @@
|
||||
&ACCESS RVO
|
||||
&ACCESS RVP
|
||||
&COMMENT USER specified PLC program
|
||||
DEF PLC ( )
|
||||
DECL STATE_T STAT
|
||||
DECL MODUS_T MODE
|
||||
DECL E6POS ACT_Point
|
||||
|
||||
LOOP
|
||||
ON_ERROR_PROCEED
|
||||
IF $ERR.NUMBER > 0 THEN
|
||||
Q_ActPosErr = TRUE
|
||||
ERR_CLEAR($ERR)
|
||||
ELSE
|
||||
Q_ActPosErr=FALSE
|
||||
IF ($ACT_TOOL==1) AND ($ACT_BASE==1) THEN
|
||||
ON_ERROR_PROCEED
|
||||
ACT_Point = $POS_ACT
|
||||
IF ACT_Point.Z>350.0 THEN
|
||||
Q_PlaceSafe=TRUE
|
||||
ELSE
|
||||
Q_PlaceSafe=FALSE
|
||||
ENDIF
|
||||
ELSE
|
||||
Q_PlaceSafe=FALSE
|
||||
ENDIF
|
||||
ENDIF
|
||||
|
||||
IF $FLAG[10] THEN
|
||||
CWRITE($CMD,STAT,MODE,"RESET/R1/cell()")
|
||||
@@ -37,6 +57,6 @@ DEF PLC ( )
|
||||
Q_Error16=FALSE
|
||||
ENDIF
|
||||
ConfMessSave=$CONF_MESS
|
||||
ON_ERROR_PROCEED
|
||||
|
||||
ENDLOOP
|
||||
END
|
||||
@@ -1,4 +1,4 @@
|
||||
&ACCESS RV5
|
||||
&ACCESS RV
|
||||
&REL 7
|
||||
&PARAM DISKPATH = KRC:\R1\Program\TP
|
||||
DEFDAT POSBASE PUBLIC
|
||||
@@ -8,8 +8,8 @@ DEFDAT POSBASE PUBLIC
|
||||
;***************************************************
|
||||
DECL GLOBAL E6POS XPallet1PlaceB={X 1492.87903,Y 2644.02686,Z 67.3537521,A -165.224686,B 0.377169758,C 179.736649,S 2,T 43,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL GLOBAL E6POS XPallet2PlaceB={X 1492.87903,Y 2644.02686,Z 67.3537521,A -165.224686,B 0.377169758,C 179.736649,S 2,T 43,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL GLOBAL E6POS XFeedBelt1Pick={X -367.936188,Y 3333.63623,Z 53.1799889,A -166.138535,B 0.376175523,C 179.734436,S 2,T 35,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL GLOBAL E6POS XFeedBelt2Pick={X -510.559875,Y 3333.63623,Z 53.1799850,A -166.138535,B 0.376175523,C 179.734436,S 2,T 35,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL GLOBAL E6POS XFeedBelt1Pick={X -368.575958,Y 3343.96265,Z 53.1804581,A -166.138535,B 0.376172692,C 179.734436,S 2,T 35,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL GLOBAL E6POS XFeedBelt2Pick={X -507.873199,Y 3343.96265,Z 53.1804581,A -166.138535,B 0.376172692,C 179.734436,S 2,T 35,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL GLOBAL E6POS XNgBeltPlace={X -377.579193,Y -392.592957,Z 48.2309685,A 104.528885,B 0.376219094,C 179.734528,S 2,T 10,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL GLOBAL E6POS XWaterBeltPick={X -374.435608,Y -52.7464218,Z 48.3197289,A 104.528885,B 0.376218826,C 179.734528,S 2,T 42,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
DECL GLOBAL E6POS XReFeedBeltPick={X -364.351349,Y 284.098267,Z 50.3441315,A 104.528885,B 0.376218945,C 179.734528,S 2,T 42,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}
|
||||
|
||||
@@ -67,7 +67,8 @@ GLOBAL SIGNAL I_PlaceOffsetZ $IN[273] TO $IN[288]
|
||||
|
||||
GLOBAL SIGNAL Q_PickDone $OUT[33]
|
||||
GLOBAL SIGNAL Q_PlaceDone $OUT[34]
|
||||
|
||||
GLOBAL SIGNAL Q_PlaceSafe $OUT[35]
|
||||
GLOBAL SIGNAL Q_ActPosErr $OUT[36]
|
||||
|
||||
GLOBAL SIGNAL Q_InHome1 $OUT[49]
|
||||
GLOBAL SIGNAL Q_InHome2 $OUT[50]
|
||||
|
||||
Reference in New Issue
Block a user