Skip to main content

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