&ACCESS RV$2 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 ; ptp velocity [%] INT DEF_ACC_PTP=50 ; ptp acceleration [%] ; CP - MOVEMENTS ;---------------------------------- DECL CIRC_TYPE DEF_CIRC_TYP=#BASE DECL JERK_STRUC DEF_JERK_STRUC={CP 500.000,ORI 50000.0,AX {A1 1000.00,A2 1000.00,A3 1000.00,A4 1000.00,A5 1000.00,A6 1000.00,E1 1000.00,E2 1000.00,E3 1000.00,E4 1000.00,E5 1000.00,E6 1000.00}} ; jerk value for the spline. CP: [m/Sec3], ORI: [[GRAD/Sec3], AX: [[GRAD/Sec3] (rotatory) resp. [m/Sec3] (linear) REAL DEF_GEAR_JERK=100.000 ; gear jerk of axes [%] REAL DEF_VEL_CP=2.00000 ; path velocity [M/SEC] REAL DEF_VEL_ORI1=200.000 ; swivel velocity [GRAD/Sec] REAL DEF_VEL_ORI2=200.000 ; rotation velocity [GRAD/Sec] REAL DEF_VEL_ORIS=200.000 ; spline swivel velocity [GRAD/Sec] REAL DEF_ACC_CP=2.30000 ; path acceleration [m/Sec2] REAL DEF_ACC_ORI1=100.000 ; swivel acceleration [GRAD/Sec2] REAL DEF_ACC_ORI2=100.000 ; rotation acceleration [GRAD/Sec2] REAL DEF_ACC_ORIS=200.000 ; spline swivel acceleration [GRAD/Sec2] REAL DEF_VEL_FACT=1.00000 REAL DEF_ACC_SPTP=100.000 ; ptp spline acceleration [%] ; APO - parameters ;-------------------------------- INT DEF_APO_CPTP=50 ; PTP-Approximation [%] INT DEF_APO_CVEL=100 ; Speed-Approximation [%] REAL DEF_APO_CDIS=3.00000 ; Distance-Approximation [mm] REAL DEF_APO_CORI=5.00000 ; Orientation-Approximation [Grad] REAL DEF_APO_CORIS=80.0000 ; spline Orientation-Approximation [Grad] ;================================== ; 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 ENUM APO_MODE_T CPTP,CDIS ENUM LDD_MODE_T NONE,CAD,T1,T2,AUT,EX,MANUAL ENUM LDD_RESULT_T NONE,APP,STATOVL,DYNOVL,CTCHCK,OVL,APPSLOOR,SLOOR 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,APO_MODE_T APO_MODE,REAL GEAR_JERK,INT EXAX_IGN STRUC LDAT REAL VEL,ACC,APO_DIST,APO_FAC,AXIS_VEL,AXIS_ACC,ORI_TYPE ORI_TYP,CIRC_TYPE CIRC_TYP,REAL JERK_FAC,GEAR_JERK,INT EXAX_IGN,CIRC_MODE CB STRUC FDAT INT TOOL_NO,BASE_NO,IPO_MODE IPO_FRAME,CHAR POINT2[24],BOOL TQ_STATE 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],SPL_NAME[24],A_PARAMS[24],PC_SYNCSTRING[24],GL_SYNCSTRING[24] STRUC HDAT REAL HT_START,HT_DEST,APO_START,APO_DEST,ACC_START,ACC_DEST,VEL_START,VEL_DEST STRUC OUT_SUGG_T CHAR PARAMS[24] STRUC MACHINE_DEF_T CHAR NAME[40],INT COOP_KRC_INDEX,CHAR PARENT[40],FRAME ROOT,ESYS MECH_TYPE,CHAR GEOMETRY[255] STRUC MACHINE_TOOL_T INT MACH_DEF_INDEX,CHAR PARENT[40],CHAR GEOMETRY[255] STRUC MACHINE_FRAME_T INT MACH_DEF_INDEX,CHAR PARENT[40],CHAR GEOMETRY[255] STRUC TRIGGER_PARA INT TriggerPath,BOOL TriggerOnStart,INT TriggerDelay,CHAR TriggerTask[40] STRUC CONSTVEL_PARA INT ConstVelTyp,INT ConstVelPath,BOOL ConstVelOnStart STRUC CONDSTOP_PARA INT CondStopPath,BOOL CondStopOnStart,CHAR StopCondition[40] STRUC ADAT TRIGGER_PARA TriggerPara,CONSTVEL_PARA ConstVelPara,CONDSTOP_PARA CondStopPara STRUC MODULEPARAM_T CHAR PARAMS[2000] STRUC TRACECACHE_T CHAR NAME[64],INT ACT_ITER,INT MAX_ITER ;FOLD OLD TORQUE MONITORING - Do not remove! Needed to prevent syntax errors in old user modules! STRUC TM_SUGG_T CHAR TM_ID[24] STRUC TQM_TQDAT_T INT T11,T12,T13,T14,T15,T16,T21,T22,T23,T24,T25,T26,K1,K2,K3,K4,K5,K6,O1,O2,ID,OVM,REAL TMF ;ENDFOLD ;================================== ; 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] ;================================== ; ID external user log-on: ;================================== SIGNAL ExtUserID $IN[1026] TO $IN[1026] SIGNAL ExtUserIDWatchDog $IN[1026] ;================================== ; Variables: ;================================== DECL PDAT PDEFAULT={VEL 100.000,ACC 100.000,APO_DIST 100.000,APO_MODE #CDIS,GEAR_JERK 100.000,EXAX_IGN 0} DECL LDAT LDEFAULT={VEL 2.00000,ACC 100.000,APO_DIST 100.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} DECL LDAT CDEFAULT={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 FDEFAULT={TOOL_NO 1,BASE_NO 0,IPO_FRAME #BASE,POINT2[] " ",TQ_STATE FALSE} DECL FDAT FHOME={TOOL_NO 1,BASE_NO 1,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 HDAT HDEFAULT={HT_START 250.000,HT_DEST 250.000,APO_START 200.000,APO_DEST 200.000,ACC_START 100.000,ACC_DEST 100.000,VEL_START 2.00000,VEL_DEST 2.00000} DECL ADAT TDEFAULT={TriggerPara {TriggerPath 0,TriggerOnStart FALSE,TriggerDelay 0,TriggerTask[] " "}} DECL ADAT CVDEFAULT={ConstVelPara {ConstVelTyp 0,ConstVelPath 0,ConstVelOnStart FALSE}} DECL ADAT CSDEFAULT={CondStopPara {CondStopPath 0,CondStopOnStart FALSE,StopCondition[] " "}} DECL PDAT PDAT_ACT DECL LDAT LDAT_ACT DECL FDAT FDAT_ACT DECL ODAT ODAT_ACT DECL INT ACT_FILTER DECL INT ACT_DELAY DECL INT ACT_DISTANCE DECL CHAR SPL_NAME[24] DECL MSGBUF_T TouchUpCheckMsgBuffer[100] ;GROUP-Definitions ;---------------------------------- INT COMPL_GROUP='B0001' 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='B0001' ; HOME POSITION ;---------------------------------- E6AXIS XHOME={A1 -40.3666763,A2 -84.9813843,A3 100.802277,A4 -0.0544359796,A5 73.7439957,A6 -25.0959282,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0} E6AXIS XHOME1={A1 -40.3666763,A2 -84.9813843,A3 100.802277,A4 -0.0544359796,A5 73.7439957,A6 -25.0959282,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0} E6AXIS XHOME2={A1 -40.3666763,A2 -84.9813843,A3 100.802277,A4 -0.0544359796,A5 73.7439957,A6 -25.0959282,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.0000,A3 90.0000,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.0000,A3 90.0000,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.0000,A3 90.0000,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 0.0,Y 0.0,Z 0.0,A 0.0,B 0.0,C 0.0} 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 0.0,Y 0.0,Z 0.0,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,]=" " 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,]=" " INT MAX_LOAD=16 DECL LOAD LOAD_DATA[16] LOAD_DATA[1]={M 20.0000,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[2]={M -1.00000,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.00000,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.00000,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.00000,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.00000,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.00000,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.00000,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.00000,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.00000,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.00000,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.00000,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.00000,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.00000,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.00000,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.00000,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 CHAR LOAD_NAME[16,24] LOAD_NAME[1,]=" " LOAD_NAME[2,]=" " LOAD_NAME[3,]=" " LOAD_NAME[4,]=" " LOAD_NAME[5,]=" " LOAD_NAME[6,]=" " LOAD_NAME[7,]=" " LOAD_NAME[8,]=" " LOAD_NAME[9,]=" " LOAD_NAME[10,]=" " LOAD_NAME[11,]=" " LOAD_NAME[12,]=" " LOAD_NAME[13,]=" " LOAD_NAME[14,]=" " LOAD_NAME[15,]=" " LOAD_NAME[16,]=" " DECL LDD_MODE_T LOAD_MODE[16] LOAD_MODE[1]=#MANUAL LOAD_MODE[2]=#NONE LOAD_MODE[3]=#NONE LOAD_MODE[4]=#NONE LOAD_MODE[5]=#NONE LOAD_MODE[6]=#NONE LOAD_MODE[7]=#NONE LOAD_MODE[8]=#NONE LOAD_MODE[9]=#NONE LOAD_MODE[10]=#NONE LOAD_MODE[11]=#NONE LOAD_MODE[12]=#NONE LOAD_MODE[13]=#NONE LOAD_MODE[14]=#NONE LOAD_MODE[15]=#NONE LOAD_MODE[16]=#NONE DECL LDD_RESULT_T LOAD_RESULT[16] LOAD_RESULT[1]=#NONE LOAD_RESULT[2]=#NONE LOAD_RESULT[3]=#NONE LOAD_RESULT[4]=#NONE LOAD_RESULT[5]=#NONE LOAD_RESULT[6]=#NONE LOAD_RESULT[7]=#NONE LOAD_RESULT[8]=#NONE LOAD_RESULT[9]=#NONE LOAD_RESULT[10]=#NONE LOAD_RESULT[11]=#NONE LOAD_RESULT[12]=#NONE LOAD_RESULT[13]=#NONE LOAD_RESULT[14]=#NONE LOAD_RESULT[15]=#NONE LOAD_RESULT[16]=#NONE 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.00000,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.00000,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.00000,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 823.726135,Y -1331.62146,Z 626.088379,A -0.308851,B 0.00167013647,C -0.0266715586} BASE_DATA[2]={X 0.0,Y 0.0,Z 0.0,A 0.0,B 0.0,C 0.0} BASE_DATA[3]={X 0.0,Y 0.0,Z 0.0,A 0.0,B 0.0,C 0.0} 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,]=" " BASE_NAME[2,]=" " BASE_NAME[3,]=" " 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,]=" " 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]=#NONE BASE_TYPE[3]=#NONE 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]=#NONE 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[] "KR 120 R3100-2",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[] "ObjectId = 1232261811"} MACHINE_DEF[2]={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[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[] "KR 120 R3100-2",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[] " ",GEOMETRY[] " "} MACHINE_FRAME_DAT[3]={MACH_DEF_INDEX 0,PARENT[] " ",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 0,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 ;****************************************** ; General purpose return value of functions ; like INVERSE, FORWARD ;****************************************** INT ERR_STATUS=-1 ;****************************************** ; Variables for TOUCHUP user limit ;****************************************** BOOL UM_TOUCHUP=FALSE REAL CARTESIAN_TOL=5.00000 REAL ROTATION_ANGLE=10.0000 REAL EXTAX_TOL[6] EXTAX_TOL[1]=10.0000 EXTAX_TOL[2]=10.0000 EXTAX_TOL[3]=10.0000 EXTAX_TOL[4]=10.0000 EXTAX_TOL[5]=10.0000 EXTAX_TOL[6]=10.0000 ;****************************************** ; 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 ;****************************************** ; Variables for Tracing ;****************************************** DECL TRACECACHE_T TRACE_CACHE[10] TRACE_CACHE[1]={NAME[] " ",ACT_ITER 0,MAX_ITER 1} TRACE_CACHE[2]={NAME[] " ",ACT_ITER 0,MAX_ITER 1} TRACE_CACHE[3]={NAME[] " ",ACT_ITER 0,MAX_ITER 1} TRACE_CACHE[4]={NAME[] " ",ACT_ITER 0,MAX_ITER 1} TRACE_CACHE[5]={NAME[] " ",ACT_ITER 0,MAX_ITER 1} TRACE_CACHE[6]={NAME[] " ",ACT_ITER 0,MAX_ITER 1} TRACE_CACHE[7]={NAME[] " ",ACT_ITER 0,MAX_ITER 1} TRACE_CACHE[8]={NAME[] " ",ACT_ITER 0,MAX_ITER 1} TRACE_CACHE[9]={NAME[] " ",ACT_ITER 0,MAX_ITER 1} TRACE_CACHE[10]={NAME[] " ",ACT_ITER 0,MAX_ITER 1} DECL INT TraceOverflowIndex=1 ;****************************************** ; 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 ;****************************************** ; Reduction factors ;****************************************** DECL REAL RedVelExAx[6] RedVelExAx[1]=100.000 RedVelExAx[2]=100.000 RedVelExAx[3]=100.000 RedVelExAx[4]=100.000 RedVelExAx[5]=100.000 RedVelExAx[6]=100.000 DECL REAL RedAccExAx[6] RedAccExAx[1]=100.000 RedAccExAx[2]=100.000 RedAccExAx[3]=100.000 RedAccExAx[4]=100.000 RedAccExAx[5]=100.000 RedAccExAx[6]=100.000 ;****************************************** ; Joint offset ;****************************************** STRUC JOINT_DEVICE_T CHAR NAME[39],REAL OFFSET,INT AXIS_INDEX DECL JOINT_DEVICE_T JOINT_DEVICE[32] JOINT_DEVICE[1]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[2]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[3]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[4]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[5]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[6]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[7]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[8]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[9]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[10]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[11]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[12]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[13]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[14]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[15]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[16]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[17]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[18]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[19]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[20]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[21]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[22]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[23]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[24]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[25]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[26]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[27]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[28]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[29]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[30]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[31]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} JOINT_DEVICE[32]={NAME[] " ",OFFSET 0.0,AXIS_INDEX -1} DECL INT JOINT_DEVICE_INDEX[32] JOINT_DEVICE_INDEX[1]=-1 JOINT_DEVICE_INDEX[2]=-1 JOINT_DEVICE_INDEX[3]=-1 JOINT_DEVICE_INDEX[4]=-1 JOINT_DEVICE_INDEX[5]=-1 JOINT_DEVICE_INDEX[6]=-1 JOINT_DEVICE_INDEX[7]=-1 JOINT_DEVICE_INDEX[8]=-1 JOINT_DEVICE_INDEX[9]=-1 JOINT_DEVICE_INDEX[10]=-1 JOINT_DEVICE_INDEX[11]=-1 JOINT_DEVICE_INDEX[12]=-1 JOINT_DEVICE_INDEX[13]=-1 JOINT_DEVICE_INDEX[14]=-1 JOINT_DEVICE_INDEX[15]=-1 JOINT_DEVICE_INDEX[16]=-1 JOINT_DEVICE_INDEX[17]=-1 JOINT_DEVICE_INDEX[18]=-1 JOINT_DEVICE_INDEX[19]=-1 JOINT_DEVICE_INDEX[20]=-1 JOINT_DEVICE_INDEX[21]=-1 JOINT_DEVICE_INDEX[22]=-1 JOINT_DEVICE_INDEX[23]=-1 JOINT_DEVICE_INDEX[24]=-1 JOINT_DEVICE_INDEX[25]=-1 JOINT_DEVICE_INDEX[26]=-1 JOINT_DEVICE_INDEX[27]=-1 JOINT_DEVICE_INDEX[28]=-1 JOINT_DEVICE_INDEX[29]=-1 JOINT_DEVICE_INDEX[30]=-1 JOINT_DEVICE_INDEX[31]=-1 JOINT_DEVICE_INDEX[32]=-1 BOOL bJointOffsetHasBeenSet=FALSE INT iLastAxisNo=0 ENUM TIMER_ACTIONTYPE TimerStart,TimerStop,TimeOut BOOL EasyTeachKeepOriWarning=FALSE INT EasyTeachKeepOriHandle=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 [] :OUT,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=9 ;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=1 ;parity bit of ext. pgno INT PGNO_REQ=6 ;request ext. pgno input INT PGNO_VALID=2 ;validate ext. pgno input INT APPL_RUN=7 ;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 BackupManagerConfig BOOL BM_ENABLED INT BM_OUTPUTVALUE SIGNAL BM_OutputSignal $OUT[4095] TO $OUT[4096] SIGNAL BM_InputSignal $IN[1026] TO $IN[1026] ;ENDFOLD BackupManagerConfig ;FOLD Conveyor DECL INT CONV_PART_NBR[16] CONV_PART_NBR[1]=0 CONV_PART_NBR[2]=0 CONV_PART_NBR[3]=0 CONV_PART_NBR[4]=0 CONV_PART_NBR[5]=0 CONV_PART_NBR[6]=0 CONV_PART_NBR[7]=0 CONV_PART_NBR[8]=0 CONV_PART_NBR[9]=0 CONV_PART_NBR[10]=0 CONV_PART_NBR[11]=0 CONV_PART_NBR[12]=0 CONV_PART_NBR[13]=0 CONV_PART_NBR[14]=0 CONV_PART_NBR[15]=0 CONV_PART_NBR[16]=0 ENUM CONV_MODE_TYPE Absolute,Relative DECL CONV_MODE_TYPE ActualConveyorMode=#Relative ;ENDFOLD Conveyor ;FOLD USER GLOBALS ;******************************************* ;Make your modifications -ONLY- here ;******************************************* ;================================== ; Userdefined Types ;================================== ;================================== ; Userdefined Externals ;================================== ;================================== ; Userdefined Variables ;================================== ;ENDFOLD (USER GLOBALS) ENDDAT