BEGIN PGM 431 MM
CALL PGM CHECK_BAMODE.CYC
FN 9: IF +Q169 EQU +1.1 GOTO LBL 254
Q198 = 431
CALL PGM ORIENT.CYC
CALL PGM INIT.CYC
; ** 1. Messung **************
Q294 = Q294 + Q320 - Q2
Q295 = Q295 + Q320 - Q2
Q298 = Q298 + Q320 - Q2
FN 1: Q1 =+Q109 + +1
FN 18: SYSREAD Q0 = ID270 NR1 IDXQ1
FN 11: IF +Q0 GT +Q260 GOTO LBL 120
L  Z+Q260 R0 FQ59
LBL 120
L  X+Q263  Y+Q264 R0 FQ59
TCH PROBE 0.0 BEZUGSEBENE Q1 Z-
TCH PROBE 0.1  Z+Q294
L  Z+Q260 R0 FQ59
L  X+Q265  Y+Q266 R0 FQ59
TCH PROBE 0.0 BEZUGSEBENE Q2 Z-
TCH PROBE 0.1  Z+Q295
L  Z+Q260 R0 FQ59
L  X+Q296  Y+Q297 R0 FQ59
TCH PROBE 0.0 BEZUGSEBENE Q3 Z-
TCH PROBE 0.1  Z+Q298
L  Z+Q260 R0 FQ59
; *** KONSTANEN BERECHNEN *****
Q11 = Q266 * Q3 - Q264 * Q3 - Q266 * Q1
Q11 = Q11 - Q297 * Q2 + Q264 * Q2 + Q297 * Q1
Q12 = Q296 * Q2 - Q296 * Q1 - Q263 * Q2
Q12 = Q12 - Q265 * Q3 + Q265 * Q1 + Q263 * Q3
Q13 = Q265 * Q297 - Q263 * Q297 - Q265 * Q264
Q13 = Q13 - Q296 * Q266 + Q263 * Q266 + Q296 * Q264
; Projektionswinkel berechnen
Q159 = ATAN ( Q11 / Q13 )
Q158 = - ATAN ( Q12 / Q13 )
; Raumwinkel berechnen
QL0 = Q263 ; P1
QL1 = Q264
QL2 = Q1
QL3 = Q265 ; P2
QL4 = Q266
QL5 = Q2
QL6 = Q296 ; P3
QL7 = Q297
QL8 = Q3
FN 17: SYSWRITE ID 39 NR 2 IDX 10 = 0 ; Berechnungsfunktion
Q170 =+QL10
Q171 =+QL11
Q172 =+QL12
Q173 =+Q1
Q174 =+Q2
Q175 =+Q3
FN 10: IF +Q113 NE +1 GOTO LBL 170
Q173 = Q173 / 25.4
Q174 = Q174 / 25.4
Q175 = Q175 / 25.4
Q263 = Q263 / 25.4
Q264 = Q264 / 25.4
Q265 = Q265 / 25.4
Q266 = Q266 / 25.4
Q296 = Q296 / 25.4
Q297 = Q297 / 25.4
LBL 170
CALL PGM PROTOCOLL_431.CYC
FN 17: SYSWRITE ID 990 NR1 =+0
FN 17: SYSWRITE ID 990 NR2 =+0
FN 10: IF +Q113 NE +1 GOTO LBL 254
Q263 = Q263 * 25.4
Q264 = Q264 * 25.4
Q265 = Q265 * 25.4
Q266 = Q266 * 25.4
Q296 = Q296 * 25.4
Q297 = Q297 * 25.4
LBL 254
FN 17: SYSWRITE ID 990 NR16 =+0 ;# Spindelkontrolle aus
END PGM 431 MM
