DEFDAT $CONFIG ;FOLD BASISTECH GLOBALS ;================================== ; Default parameters for movement ; These values shouldn't be changed ;================================== ;---------------------------------- ; general MOVEMENT - parameters: ;---------------------------------- INT DEF_OV_PRO=100 INT DEF_ADVANCE=3 ; PTP - MOVEMENTS ;---------------------------------- INT DEF_VEL_PTP=100 INT DEF_ACC_PTP=50 ; CP - MOVEMENTS ;---------------------------------- DECL CIRC_TYPE DEF_CIRC_TYP=#BASE REAL DEF_VEL_CP=2.0 REAL DEF_VEL_ORI1=200.0 REAL DEF_VEL_ORI2=200.0 REAL DEF_ACC_CP=2.29999995 REAL DEF_ACC_ORI1=100.0 REAL DEF_ACC_ORI2=100.0 REAL DEF_VEL_FACT=1.0 ; APO - parameters ;-------------------------------- INT DEF_APO_CPTP=50 INT DEF_APO_CVEL=100 REAL DEF_APO_CDIS=3.0 REAL DEF_APO_CORI=5.0 ;================================== ; Structures: ;================================== ENUM BAS_COMMAND INITMOV,ACC_CP,ACC_PTP,VEL_CP,VEL_PTP,ACC_GLUE,TOOL,BASE,EX_BASE,PTP_DAT,CP_DAT,OUT_SYNC,OUT_ASYNC,GROUP,FRAMES,PTP_PARAMS,CP_PARAMS ENUM OUT_MODETYPE TRIGGER_,CONT_,STOP_ ENUM IPO_M_T NONE,TCP,BASE STRUC DIG_OUT_TYPE INT FIRST_BIT,LENGTH,PARITY,CODING STRUC CTRL_IN_T INT IN_NR,CHAR NAME_NAT[20] STRUC CTRL_OUT_T INT OUT_NR,BOOL INI,CHAR NAME_NAT[20] STRUC FCT_OUT_T INT NO,REAL PULS_TIME,BOOL STATE STRUC FCT_IN_T INT NO,BOOL STATE STRUC PDAT REAL VEL,ACC,APO_DIST STRUC LDAT REAL VEL,ACC,APO_DIST,APO_FAC,ORI_TYPE ORI_TYP STRUC FDAT INT TOOL_NO,BASE_NO,IPO_MODE IPO_FRAME,CHAR POINT2[24] STRUC ODAT INT OUT_NO,BOOL STATE,REAL PULSE_TIME,OUT_MODETYPE OUT_MODE,REAL TIME_DELAY,OFFSET STRUC BASIS_SUGG_T CHAR POINT1[24],POINT2[24],CP_PARAMS[24],PTP_PARAMS[24],CONT[24],CP_VEL[24],PTP_VEL[24],SYNC_PARAMS[24] STRUC OUT_SUGG_T CHAR PARAMS[24] STRUC MACHINE_DEF_T CHAR NAME[24],INT COOP_KRC_INDEX,CHAR PARENT[24],FRAME ROOT,ESYS MECH_TYPE,CHAR GEOMETRY[255] STRUC MACHINE_TOOL_T INT MACH_DEF_INDEX,CHAR PARENT[24],CHAR GEOMETRY[255] STRUC MACHINE_FRAME_T INT MACH_DEF_INDEX,CHAR PARENT[24],CHAR GEOMETRY[255] ;================================== ; External declarations: ;================================== EXT BAS (BAS_COMMAND :IN,REAL :IN ) EXT IR_STOPM ( ) ;==================== ; Signal declarations ; Do not change !!!!! ;==================== SIGNAL CHANNEL_1 $ANOUT[1] SIGNAL CHANNEL_2 $ANOUT[2] SIGNAL CHANNEL_3 $ANOUT[3] SIGNAL CHANNEL_4 $ANOUT[4] SIGNAL CHANNEL_5 $ANOUT[5] SIGNAL CHANNEL_6 $ANOUT[6] SIGNAL CHANNEL_7 $ANOUT[7] SIGNAL CHANNEL_8 $ANOUT[8] SIGNAL CHANNEL_9 $ANOUT[9] SIGNAL CHANNEL_10 $ANOUT[10] SIGNAL CHANNEL_11 $ANOUT[11] SIGNAL CHANNEL_12 $ANOUT[12] SIGNAL CHANNEL_13 $ANOUT[13] SIGNAL CHANNEL_14 $ANOUT[14] SIGNAL CHANNEL_15 $ANOUT[15] SIGNAL CHANNEL_16 $ANOUT[16] SIGNAL CHANNEL_17 $ANOUT[17] SIGNAL CHANNEL_18 $ANOUT[18] SIGNAL CHANNEL_19 $ANOUT[19] SIGNAL CHANNEL_20 $ANOUT[20] SIGNAL CHANNEL_21 $ANOUT[21] SIGNAL CHANNEL_22 $ANOUT[22] SIGNAL CHANNEL_23 $ANOUT[23] SIGNAL CHANNEL_24 $ANOUT[24] SIGNAL CHANNEL_25 $ANOUT[25] SIGNAL CHANNEL_26 $ANOUT[26] SIGNAL CHANNEL_27 $ANOUT[27] SIGNAL CHANNEL_28 $ANOUT[28] SIGNAL CHANNEL_29 $ANOUT[29] SIGNAL CHANNEL_30 $ANOUT[30] SIGNAL CHANNEL_31 $ANOUT[31] SIGNAL CHANNEL_32 $ANOUT[32] ;================================== ; Variables: ;================================== DECL PDAT PDEFAULT={VEL 100.0,ACC 100.0,APO_DIST 100.0} DECL LDAT LDEFAULT={VEL 2.0,ACC 100.0,APO_DIST 100.0,APO_FAC 50.0,ORI_TYP #VAR} DECL FDAT FDEFAULT={TOOL_NO 1,BASE_NO 0,IPO_FRAME #BASE,POINT2[] " "} DECL FDAT FHOME={TOOL_NO 1,BASE_NO 0,IPO_FRAME #BASE,POINT2[] " "} DECL ODAT ODEFAULT={OUT_NO 1,STATE TRUE,PULSE_TIME 0.0,OUT_MODE #STOP_,TIME_DELAY 0.0,OFFSET 0.0} DECL PDAT PDAT_ACT DECL LDAT LDAT_ACT DECL FDAT FDAT_ACT DECL ODAT ODAT_ACT DECL INT ACT_DELAY DECL INT ACT_DISTANCE ;GROUP-Definitions ;---------------------------------- INT COMPL_GROUP='B0011' INT DEF_GROUP[10] DEF_GROUP[1]='B1111' ; complete DEF_GROUP[2]='B0001' ; robot only DEF_GROUP[3]='B0011' ; robot and track DEF_GROUP[4]='B0111' ; robot, track and ext. axis2 DEF_GROUP[5]='B1011' ; robot, track and ext. axis3 DEF_GROUP[6]='B1111' ; robot, track and ext. axis2+3 DEF_GROUP[7]='B1111' ; complete DEF_GROUP[8]='B1111' ; complete DEF_GROUP[9]='B1111' ; complete DEF_GROUP[10]='B1111' ; complete INT $ACT_GROUP='B0011' ; HOME POSITION ;---------------------------------- E6AXIS XHOME={a1 0.0,a2 -90.0,a3 90.0,a4 0.0,a5 0.0,a6 0.0,e1 0.0,e2 0.0,e3 0.0,e4 0.0,e5 0.0,e6 0.0} E6AXIS XHOME1={a1 0.0,a2 -90.0,a3 90.0,a4 0.0,a5 0.0,a6 0.0,e1 0.0,e2 0.0,e3 0.0,e4 0.0,e5 0.0,e6 0.0} E6AXIS XHOME2={a1 0.0,a2 -90.0,a3 90.0,a4 0.0,a5 0.0,a6 0.0,e1 0.0,e2 0.0,e3 0.0,e4 0.0,e5 0.0,e6 0.0} E6AXIS XHOME3={a1 0.0,a2 -90.0,a3 90.0,a4 0.0,a5 0.0,a6 0.0,e1 0.0,e2 0.0,e3 0.0,e4 0.0,e5 0.0,e6 0.0} E6AXIS XHOME4={a1 0.0,a2 -90.0,a3 90.0,a4 0.0,a5 0.0,a6 0.0,e1 0.0,e2 0.0,e3 0.0,e4 0.0,e5 0.0,e6 0.0} E6AXIS XHOME5={a1 0.0,a2 -90.0,a3 90.0,a4 0.0,a5 0.0,a6 0.0,e1 0.0,e2 0.0,e3 0.0,e4 0.0,e5 0.0,e6 0.0} E6AXIS XHOME6={a1 0.0,a2 -90.0,a3 90.0,a4 0.0,a5 0.0,a6 0.0,e1 0.0,e2 0.0,e3 0.0,e4 0.0,e5 0.0,e6 0.0} ; REFERENCE POINTS ;---------------------------------- DECL FRAME REF_PT[16] REF_PT[1]={x 1935.47766,y 114.933945,z 25.5331917,a 59.3351936,b 48.3624268,c 140.048111} REF_PT[2]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} REF_PT[3]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} REF_PT[4]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} REF_PT[5]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} REF_PT[6]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} REF_PT[7]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} REF_PT[8]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} REF_PT[9]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} REF_PT[10]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} REF_PT[11]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} REF_PT[12]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} REF_PT[13]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} REF_PT[14]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} REF_PT[15]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} REF_PT[16]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} FRAME REF_TOOL={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} ; TOOL and BASE data ;---------------------------------- BOOL AUTO_IPO_M=FALSE BOOL STOPM_FLAG=FALSE BOOL TOOL_CORR_ON=FALSE BOOL TOOL_CORR_W_ON=FALSE BOOL BASE_CORR_ON=FALSE BOOL M_BAS_COR_ON=FALSE FRAME TOOL_CORR={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} FRAME TOOL_CORR_W={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} FRAME BASE_CORR={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} FRAME M_BASE_CORR={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} INT COR_TOOL_NO=0 INT MAX_TOOL=16 DECL FRAME TOOL_DATA[16] TOOL_DATA[1]={x 593.123901,y 0.617697001,z 121.234528,a 0.0,b 0.0,c 0.0} TOOL_DATA[2]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} TOOL_DATA[3]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} TOOL_DATA[4]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} TOOL_DATA[5]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} TOOL_DATA[6]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} TOOL_DATA[7]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} TOOL_DATA[8]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} TOOL_DATA[9]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} TOOL_DATA[10]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} TOOL_DATA[11]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} TOOL_DATA[12]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} TOOL_DATA[13]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} TOOL_DATA[14]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} TOOL_DATA[15]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} TOOL_DATA[16]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} DECL CHAR TOOL_NAME[16,24] TOOL_NAME[1,]="CAL" TOOL_NAME[2,]=" " TOOL_NAME[3,]=" " TOOL_NAME[4,]=" " TOOL_NAME[5,]=" " TOOL_NAME[6,]=" " TOOL_NAME[7,]=" " TOOL_NAME[8,]=" " TOOL_NAME[9,]=" " TOOL_NAME[10,]=" " TOOL_NAME[11,]=" " TOOL_NAME[12,]=" " TOOL_NAME[13,]=" " TOOL_NAME[14,]=" " TOOL_NAME[15,]=" " TOOL_NAME[16,]=" " DECL LOAD LOAD_DATA[16] LOAD_DATA[1]={M 170.0,CM {x 270.0,y 0.0,z 240.0,a 0.0,b 0.0,c 0.0},J {X 75.0,Y 75.0,Z 75.0}} LOAD_DATA[2]={M -1.0,CM {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},J {X 0.0,Y 0.0,Z 0.0}} LOAD_DATA[3]={M -1.0,CM {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},J {X 0.0,Y 0.0,Z 0.0}} LOAD_DATA[4]={M -1.0,CM {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},J {X 0.0,Y 0.0,Z 0.0}} LOAD_DATA[5]={M -1.0,CM {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},J {X 0.0,Y 0.0,Z 0.0}} LOAD_DATA[6]={M -1.0,CM {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},J {X 0.0,Y 0.0,Z 0.0}} LOAD_DATA[7]={M -1.0,CM {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},J {X 0.0,Y 0.0,Z 0.0}} LOAD_DATA[8]={M -1.0,CM {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},J {X 0.0,Y 0.0,Z 0.0}} LOAD_DATA[9]={M -1.0,CM {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},J {X 0.0,Y 0.0,Z 0.0}} LOAD_DATA[10]={M -1.0,CM {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},J {X 0.0,Y 0.0,Z 0.0}} LOAD_DATA[11]={M -1.0,CM {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},J {X 0.0,Y 0.0,Z 0.0}} LOAD_DATA[12]={M -1.0,CM {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},J {X 0.0,Y 0.0,Z 0.0}} LOAD_DATA[13]={M -1.0,CM {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},J {X 0.0,Y 0.0,Z 0.0}} LOAD_DATA[14]={M -1.0,CM {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},J {X 0.0,Y 0.0,Z 0.0}} LOAD_DATA[15]={M -1.0,CM {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},J {X 0.0,Y 0.0,Z 0.0}} LOAD_DATA[16]={M -1.0,CM {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},J {X 0.0,Y 0.0,Z 0.0}} DECL IPO_M_T TOOL_TYPE[16] TOOL_TYPE[1]=#BASE TOOL_TYPE[2]=#NONE TOOL_TYPE[3]=#NONE TOOL_TYPE[4]=#NONE TOOL_TYPE[5]=#NONE TOOL_TYPE[6]=#NONE TOOL_TYPE[7]=#NONE TOOL_TYPE[8]=#NONE TOOL_TYPE[9]=#NONE TOOL_TYPE[10]=#NONE TOOL_TYPE[11]=#NONE TOOL_TYPE[12]=#NONE TOOL_TYPE[13]=#NONE TOOL_TYPE[14]=#NONE TOOL_TYPE[15]=#NONE TOOL_TYPE[16]=#NONE DECL LOAD LOAD_A1_DATA={M -1.0,CM {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},J {X 0.0,Y 0.0,Z 0.0}} DECL LOAD LOAD_A2_DATA={M -1.0,CM {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},J {X 0.0,Y 0.0,Z 0.0}} DECL LOAD LOAD_A3_DATA={M -1.0,CM {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},J {X 0.0,Y 0.0,Z 0.0}} INT MAX_BASE=32 DECL FRAME BASE_DATA[32] BASE_DATA[1]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[2]={x 1324.70801,y -1753.68201,z 0.952060997,a -0.0875770003,b -0.0189839993,c -0.0178609993} BASE_DATA[3]={x 2543.09204,y -1440.276,z 167.934998,a 0.136000007,b -0.0850000009,c 170.621002} BASE_DATA[4]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[5]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[6]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[7]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[8]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[9]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[10]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[11]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[12]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[13]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[14]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[15]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[16]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[17]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[18]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[19]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[20]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[21]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[22]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[23]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[24]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[25]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[26]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[27]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[28]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[29]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[30]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[31]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} BASE_DATA[32]={x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0} DECL CHAR BASE_NAME[32,24] BASE_NAME[1,]="testBase" BASE_NAME[2,]="TABLE" BASE_NAME[3,]="ROTARY" BASE_NAME[4,]=" " BASE_NAME[5,]=" " BASE_NAME[6,]=" " BASE_NAME[7,]=" " BASE_NAME[8,]=" " BASE_NAME[9,]=" " BASE_NAME[10,]=" " BASE_NAME[11,]=" " BASE_NAME[12,]=" " BASE_NAME[13,]=" " BASE_NAME[14,]=" " BASE_NAME[15,]=" " BASE_NAME[16,]=" " BASE_NAME[17,]="E1 " BASE_NAME[18,]=" " BASE_NAME[19,]=" " BASE_NAME[20,]=" " BASE_NAME[21,]=" " BASE_NAME[22,]=" " BASE_NAME[23,]=" " BASE_NAME[24,]=" " BASE_NAME[25,]=" " BASE_NAME[26,]=" " BASE_NAME[27,]=" " BASE_NAME[28,]=" " BASE_NAME[29,]=" " BASE_NAME[30,]=" " BASE_NAME[31,]=" " BASE_NAME[32,]=" " DECL IPO_M_T BASE_TYPE[32] BASE_TYPE[1]=#NONE BASE_TYPE[2]=#BASE BASE_TYPE[3]=#BASE BASE_TYPE[4]=#NONE BASE_TYPE[5]=#NONE BASE_TYPE[6]=#NONE BASE_TYPE[7]=#NONE BASE_TYPE[8]=#NONE BASE_TYPE[9]=#NONE BASE_TYPE[10]=#NONE BASE_TYPE[11]=#NONE BASE_TYPE[12]=#NONE BASE_TYPE[13]=#NONE BASE_TYPE[14]=#NONE BASE_TYPE[15]=#NONE BASE_TYPE[16]=#NONE BASE_TYPE[17]=#BASE BASE_TYPE[18]=#NONE BASE_TYPE[19]=#NONE BASE_TYPE[20]=#NONE BASE_TYPE[21]=#NONE BASE_TYPE[22]=#NONE BASE_TYPE[23]=#NONE BASE_TYPE[24]=#NONE BASE_TYPE[25]=#NONE BASE_TYPE[26]=#NONE BASE_TYPE[27]=#NONE BASE_TYPE[28]=#NONE BASE_TYPE[29]=#NONE BASE_TYPE[30]=#NONE BASE_TYPE[31]=#NONE BASE_TYPE[32]=#NONE ;****************************************** ; Variables for CELL DEFINITION ;****************************************** INT MAX_MACHINES=16 DECL MACHINE_DEF_T MACHINE_DEF[16] MACHINE_DEF[1]={NAME[] "Robot",COOP_KRC_INDEX 1,PARENT[] "WORLD",ROOT {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},MECH_TYPE #ROBOT,GEOMETRY[] " "} MACHINE_DEF[2]={NAME[] "E1 ",COOP_KRC_INDEX 1,PARENT[] " ",ROOT {x 2533.54102,y -1448.17505,z 59.7919998,a 0.0,b 0.0,c 0.0},MECH_TYPE #EASYS,GEOMETRY[] " "} MACHINE_DEF[3]={NAME[] " ",COOP_KRC_INDEX 0,PARENT[] " ",ROOT {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},MECH_TYPE #NONE,GEOMETRY[] " "} MACHINE_DEF[4]={NAME[] " ",COOP_KRC_INDEX 0,PARENT[] " ",ROOT {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},MECH_TYPE #NONE,GEOMETRY[] " "} MACHINE_DEF[5]={NAME[] " ",COOP_KRC_INDEX 0,PARENT[] " ",ROOT {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},MECH_TYPE #NONE,GEOMETRY[] " "} MACHINE_DEF[6]={NAME[] " ",COOP_KRC_INDEX 0,PARENT[] " ",ROOT {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},MECH_TYPE #NONE,GEOMETRY[] " "} MACHINE_DEF[7]={NAME[] " ",COOP_KRC_INDEX 0,PARENT[] " ",ROOT {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},MECH_TYPE #NONE,GEOMETRY[] " "} MACHINE_DEF[8]={NAME[] " ",COOP_KRC_INDEX 0,PARENT[] " ",ROOT {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},MECH_TYPE #NONE,GEOMETRY[] " "} MACHINE_DEF[9]={NAME[] " ",COOP_KRC_INDEX 0,PARENT[] " ",ROOT {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},MECH_TYPE #NONE,GEOMETRY[] " "} MACHINE_DEF[10]={NAME[] " ",COOP_KRC_INDEX 0,PARENT[] " ",ROOT {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},MECH_TYPE #NONE,GEOMETRY[] " "} MACHINE_DEF[11]={NAME[] " ",COOP_KRC_INDEX 0,PARENT[] " ",ROOT {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},MECH_TYPE #NONE,GEOMETRY[] " "} MACHINE_DEF[12]={NAME[] " ",COOP_KRC_INDEX 0,PARENT[] " ",ROOT {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},MECH_TYPE #NONE,GEOMETRY[] " "} MACHINE_DEF[13]={NAME[] " ",COOP_KRC_INDEX 0,PARENT[] " ",ROOT {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},MECH_TYPE #NONE,GEOMETRY[] " "} MACHINE_DEF[14]={NAME[] " ",COOP_KRC_INDEX 0,PARENT[] " ",ROOT {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},MECH_TYPE #NONE,GEOMETRY[] " "} MACHINE_DEF[15]={NAME[] " ",COOP_KRC_INDEX 0,PARENT[] " ",ROOT {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},MECH_TYPE #NONE,GEOMETRY[] " "} MACHINE_DEF[16]={NAME[] " ",COOP_KRC_INDEX 0,PARENT[] " ",ROOT {x 0.0,y 0.0,z 0.0,a 0.0,b 0.0,c 0.0},MECH_TYPE #NONE,GEOMETRY[] " "} DECL MACHINE_TOOL_T MACHINE_TOOL_DAT[16] MACHINE_TOOL_DAT[1]={MACH_DEF_INDEX 1,PARENT[] "Robot",GEOMETRY[] " "} MACHINE_TOOL_DAT[2]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_TOOL_DAT[3]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_TOOL_DAT[4]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_TOOL_DAT[5]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_TOOL_DAT[6]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_TOOL_DAT[7]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_TOOL_DAT[8]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_TOOL_DAT[9]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_TOOL_DAT[10]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_TOOL_DAT[11]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_TOOL_DAT[12]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_TOOL_DAT[13]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_TOOL_DAT[14]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_TOOL_DAT[15]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_TOOL_DAT[16]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} DECL MACHINE_FRAME_T MACHINE_FRAME_DAT[32] MACHINE_FRAME_DAT[1]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[2]={MACH_DEF_INDEX 0,PARENT[] "WORLD",GEOMETRY[] " "} MACHINE_FRAME_DAT[3]={MACH_DEF_INDEX 0,PARENT[] "WORLD",GEOMETRY[] " "} MACHINE_FRAME_DAT[4]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[5]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[6]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[7]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[8]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[9]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[10]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[11]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[12]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[13]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[14]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[15]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[16]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[17]={MACH_DEF_INDEX 2,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[18]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[19]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[20]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[21]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[22]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[23]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[24]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[25]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[26]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[27]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[28]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[29]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[30]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[31]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[32]={MACH_DEF_INDEX 0,PARENT[] " ",GEOMETRY[] " "} ;****************************************** ; Variables for axis CALIBRATING ;****************************************** DECL INT CAL_AXIS BOOL CONST_SPEED ;****************************************** ; Variables for added TechPackages ;****************************************** INT POWER ;****************************************** ; Variables for Displaying and Konfiguring ;****************************************** DECL INT I[20] I[1]=0 I[2]=0 I[3]=0 I[4]=0 I[5]=0 I[6]=0 I[7]=0 I[8]=0 I[9]=0 I[10]=0 I[11]=0 I[12]=0 I[13]=0 I[14]=0 I[15]=0 I[16]=0 I[17]=0 I[18]=0 I[19]=0 I[20]=0 ;****************************************** ; all for InterBus Mapping on optional segments ;****************************************** DECL INT IBUS_SEGMENT[16] IBUS_SEGMENT[1]=0 IBUS_SEGMENT[2]=0 IBUS_SEGMENT[3]=0 IBUS_SEGMENT[4]=0 IBUS_SEGMENT[5]=0 IBUS_SEGMENT[6]=0 IBUS_SEGMENT[7]=0 IBUS_SEGMENT[8]=0 IBUS_SEGMENT[9]=0 IBUS_SEGMENT[10]=0 IBUS_SEGMENT[11]=0 IBUS_SEGMENT[12]=0 IBUS_SEGMENT[13]=0 IBUS_SEGMENT[14]=0 IBUS_SEGMENT[15]=0 IBUS_SEGMENT[16]=0 ;ENDFOLD (BASISTECH GLOBALS) ;FOLD AUTOEXT GLOBALS ;================================== ; Structures: ;================================== ENUM FUNCT_TYPE PGNO_GET,PGNO_ACKN,PGNO_FAULT ENUM P00_COMMAND INIT_EXT,EXT_PGNO,CHK_HOME,EXT_ERR STRUC SPS_PROG_TYPE INT PROG_NR,CHAR PROG_NAME[12] ;================================== ; External declarations: ;================================== EXT P00 (P00_COMMAND :IN,FUNCT_TYPE :IN,CHAR [],INT :IN ) ;External declaration for Submit controlled AutoExt EXT P00_SUBM (P00_COMMAND :IN,FUNCT_TYPE :IN ) ;================================== ; Variables: ;================================== ; Variables for internal ; Communication: ;---------------------------------- BOOL ERROR_FLAG BOOL CHECK_HOME=TRUE BOOL PROG_CONTROL=FALSE DECL CHAR PRO_NAME1_L[8] PRO_NAME1_L[]=" " DECL CHAR PRO_NAME1_A[8] PRO_NAME1_A[]=" " INT PGNO=0 ;copy of ext. pgno INT PGNO_ERROR=0 ;transmission error INT PGNO_TYPE=1 ;coding type of ext. pgno INT REFLECT_PROG_NR=0 ; enable mirroring of program number inputs (1=enabled, 0=disabled) ; Variables for External ; Communication: I/O-Interface ;---------------------------------- INT PGNO_FBIT=33 ;first bit of ext. pgno input $IN[] INT PGNO_FBIT_REFL=999 ;first bit of ext. pgno reflection output $OUT[] INT PGNO_LENGTH=8 ;length of ext. pgno (max. 16) INT PGNO_PARITY=41 ;parity bit of ext. pgno INT PGNO_REQ=33 ;request ext. pgno input INT PGNO_VALID=42 ;validate ext. pgno input INT APPL_RUN=34 ;application program is running output INT ERR_TO_PLC=35 ;error output to PLC INT P01_STEP INT CHK_STEP INT PGNO_FLAG ; Table for assign SPS program number to program name INT MAX_SPS_PROG=12 DECL SPS_PROG_TYPE SPS_PROG[12] SPS_PROG[1]={PROG_NR 1,PROG_NAME[] "HP01() "} SPS_PROG[2]={PROG_NR 2,PROG_NAME[] "HP02() "} SPS_PROG[3]={PROG_NR 3,PROG_NAME[] "HP03() "} SPS_PROG[4]={PROG_NR 4,PROG_NAME[] "HP04() "} SPS_PROG[5]={PROG_NR 5,PROG_NAME[] "HP05() "} SPS_PROG[6]={PROG_NR 6,PROG_NAME[] "HP06() "} SPS_PROG[7]={PROG_NR 7,PROG_NAME[] "HP07() "} SPS_PROG[8]={PROG_NR 8,PROG_NAME[] "HP08() "} SPS_PROG[9]={PROG_NR 9,PROG_NAME[] "HP09() "} SPS_PROG[10]={PROG_NR 10,PROG_NAME[] "HP10() "} SPS_PROG[11]={PROG_NR 62,PROG_NAME[] "HP62() "} SPS_PROG[12]={PROG_NR 63,PROG_NAME[] "HP63() "} DECL CHAR TMPNAME[128] TMPNAME[]=" " ;ENDFOLD (AUTOEXT GLOBALS) ;FOLD USER GLOBALS ;******************************************* ;Make your modifications -ONLY- here ;******************************************* ;================================== ; Userdefined Types ;================================== ;================================== ; Userdefined Externals ;================================== ;================================== ; Userdefined Variables ;================================== ;ENDFOLD (USER GLOBALS) ENDDAT