Siemens SINUMERIK 840D sl Programming Manual page 646

Work preparation
3.8 Coordinate transformations (frames)
Program code
DEF REAL FIT_QUALITY=0
DEF REAL ROT_FRAME_LIMIT=5
DEF REAL FIT_QUALITY_LIMIT=3
DEF REAL SHOW_MCS_POS1[3]
DEF REAL SHOW_MCS_POS2[3]
DEF REAL SHOW_MCS_POS3[3]
Program code
N100 G01 G90 F5000
N110 X0 Y0 Z0
N200 CORR_FRAME=MEAFRAME(IDEAL_POINT,MEAS_POINT,FIT_QUALITY)
N230 IF FIT_QUALITY < 0
SETAL(65000)
GOTOF NO_FRAME
ENDIF
N240 IF FIT_QUALITY > FIT_QUALITY_LIMIT
SETAL(65010)
GOTOF NO_FRAME
ENDIF
N250 IF CORR_FRAME[X,RT] > ROT_FRAME_LIMIT
SETAL(65020)
GOTOF NO_FRAME
ENDIF
N260 IF CORR_FRAME[Y,RT] > ROT_FRAME_LIMIT
SETAL(65021)
GOTOF NO_FRAME
ENDIF
N270 IF CORR_FRAME[Z,RT] > ROT_FRAME_LIMIT
SETAL(65022)
GOTOF NO_FRAME
ENDIF
N300 $P_IFRAME=CORR_FRAME
N400 X=IDEAL_POINT[0,0] Y=IDEAL_POINT[0,1]
Z=IDEAL_POINT[0,2]
N410 SHOW_MCS_POS1[0]=$AA_IM[X]
N420 SHOW_MCS_POS1[1]=$AA_IM[Y]
N430 SHOW_MCS_POS1[2]=$AA_IM[Z]
646
Comment
; Permits max. five degree rota-
tion of the part position.
; Permits max. 3 mm offset between
the
ideal and the measured triangle.
Comment
; Limiting the 1st RPY angle.
; Limiting the 2nd RPY angle.
; Limiting the 3rd RPY angle.
; Activate sample frame with setta-
ble frame.
; Check frame by positioning the
geometry axes to the ideal point.
Programming Manual, 12/2019, 6FC5398-2EP40-0BA0
NC programming