4.3. 2D기준 데이터 등록
4.3. 2D기준 데이터 등록
이후 이번 예시에서 사용할 2D 방향 기준 데이터 등록을 수행합니다. 응용에 따라 3D, 5D 기준 데이터도 등록할 수 있습니다.
'-- Reference run extern 2D without signal reflection --
'----------------------------------------------------
'----------------------------------------------------
'-- Initial parameter setting
CALL 1020_INIT_SET
'-- Calculate Circle Pose
CALL 1021_CALC_C1
'-- Activate configuration mode -
gyConfigMode=1
WAIT gxConfModeAct
'-- Activate reference run extern --
gyRefRunExt=1
WAIT gxRefRunExAct=1
'-- Set Program Number 1 --
gyPrgNrBit1=1
gyPrgNrBit2=0
gyPrgNrBit3=0
gyPrgNrBit4=0
gyPrgNrBit5=0
'-- Set referencing for tool --
gyConfigTool=1
'-- Set referencing for diameter --
gyRefDiameter=1
'-- Set to Program No. set --
gyPgNrSRIdxSe=1
'-- Wait for confirmation of program number --
WAIT gxPgNrSRIdxRd OR gxError
'-- Reference run only when input gxPgNrSRIdxRd is set --
IF (gxPgNrSRIdxRd=1) THEN
'-- Reset Program Number 1 --
gyPrgNrBit1=0
gyPrgNrBit2=0
gyPrgNrBit3=0
gyPrgNrBit4=0
gyPrgNrBit5=0
'-- Reset referencing for tool --
gyConfigTool=0
'-- Reset referencing for diameter --
gyRefDiameter=0
'-- Reset to program number set --
gyPgNrSRIdxSe=0
'-- Wait until ready --
WAIT gxReadyForMes
'-- Reset tool data --
Tool[giToolNrCorr]=Tool[giToolNrOrig]
'-- Double-circle with tool_corrected
S1 MOVE L,gpCirPose1,S=50%,A=0,T=giToolNrCorr '-- Move to starting point
S2 MOVE C,gpCirPose2,S=50mm/s,A=3,T=giToolNrCorr '-- 1st quarter circle movement --
S3 MOVE C,gpCirPose3,S=50mm/s,A=3,T=giToolNrCorr '-- 2nd quarter circle movement --
S4 MOVE C,gpCirPose4,S=50mm/s,A=3,T=giToolNrCorr '-- 3rd quarter circle movement --
S5 MOVE C,gpCirPose1,S=50mm/s,A=3,T=giToolNrCorr '-- 4th quarter circle movement --
S6 MOVE C,gpCirPose2,S=50mm/s,A=3,T=giToolNrCorr '-- 1st quarter circle movement --
S7 MOVE C,gpCirPose3,S=50mm/s,A=3,T=giToolNrCorr '-- 2nd quarter circle movement --
S8 MOVE C,gpCirPose4,S=50mm/s,A=3,T=giToolNrCorr '-- 3rd quarter circle movement --
S9 MOVE C,gpCirPose1,S=50mm/s,A=0,T=giToolNrCorr '-- 4th quarter circle movement --
'-- Execute "Get measured values and Correction"
CALL 1000_GetMesVal
'-- Acknowledge error during measurement --
'-- Identify and rectify error cause --
IF gxError=1 THEN
'-- Reset tool data --
Tool[giToolNrCorr]=Tool[giToolNrOrig]
gyReset=1
WAIT gxError=0
gyReset=0
ENDIF
ELSE '-- Error when setting program number --
'-- Reset Program Number 1 --
gyPrgNrBit1=0
gyPrgNrBit2=0
gyPrgNrBit3=0
gyPrgNrBit4=0
gyPrgNrBit5=0
'-- Reset referencing for tool --
gyConfigTool=0
'-- Reset referencing for diameter -
gyRefDiameter=0
'-- Reset to program no. set --
gyPgNrSRIdxSe=0
ENDIF
'-- Turn off reference run extern --
gyRefRunExt=0
WAIT gxRefRunExAct=0
'-- Turn off configuration mode --
gyConfigMode=0
WAIT gxConfModeAct=0
END