Koordinatentransformationen (FRAMES)
5.6 Frame-Berechnung aus 3 Messpunkten im Raum (MEAFRAME)
Programmcode
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]
N500 X=IDEAL_POINT[1,0] Y=IDEAL_POINT[1,1]
Z=IDEAL_POINT[1,2]
N510 SHOW_MCS_POS2[0]=$AA_IM[X]
N520 SHOW_MCS_POS2[1]=$AA_IM[Y]
N530 SHOW_MCS_POS2[2]=$AA_IM[Z]
N600 X=IDEAL_POINT[2,0] Y=IDEAL_POINT[2,1]
Z=IDEAL_POINT[2,2]
N610 SHOW_MCS_POS3[0]=$AA_IM[X]
N620 SHOW_MCS_POS3[1]=$AA_IM[Y]
N630 SHOW_MCS_POS3[2]=$AA_IM[Z]
N700 G500
No_FRAME
M0
M30
312
Kommentar
; Begrenzung des 1. RPY- Winkels
; Begrenzung des 2. RPY-Winkels
; Begrenzung des 3. RPY- Winkels
; Abtast-Frame mit einem setzbaren
Frame aktivieren
; Frame prüfen durch Positionieren der
Geometrieachsen auf die idealen
Punkte
; Setzbaren Frame deaktivieren, da mit
Nullframe (kein Wert eingetragen
vorbesetzt).
; Setzbaren Frame deaktivieren, da mit
Nullframe (kein Wert eingetragen)
vorbesetzt
Programmierhandbuch, 02/2011, 6FC5398-2BP40-1AA0
Arbeitsvorbereitung