BEGIN PGM 400 MM
CALL PGM CHECK_BAMODE.CYC
FN 9: IF +Q169 EQU +1.1 GOTO LBL 254
Q198 = 400
CALL PGM ORIENT.CYC
CALL PGM CHCK_INP.CYC
CALL PGM INIT.CYC
Q320 = Q320 + Q2 + Q3
FN 10: IF +Q267 NE +0 GOTO LBL 12
FN 14: ERROR= 1042
LBL 12
; ** Y-RICHTUNG **************
FN 12: IF +Q261 LT +Q260 GOTO LBL 130
FN 0: Q260 =+Q261
LBL 130
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
FN 9: IF +Q272 EQU +1 GOTO LBL 21
FN 9: IF +Q267 EQU -1 GOTO LBL 20
FN 2: Q22 =+Q264 - +Q320
FN 2: Q32 =+Q266 - +Q320
L  X+Q263  Y+Q22 R0 FQ59
TCH PROBE 0.0 BEZUGSEBENE Q4 Y+
TCH PROBE 0.1  Z+Q261
FN 9: IF +Q301 EQU +0 GOTO LBL 1
L  Z+Q260 FQ59
LBL 1
L  X+Q265  Y+Q32 FQ59
TCH PROBE 0.0 BEZUGSEBENE Q5 Y+
TCH PROBE 0.1  Z+Q261
FN 9: IF +0 EQU +0 GOTO LBL 92
LBL 20
FN 1: Q22 =+Q264 + +Q320
FN 1: Q32 =+Q266 + +Q320
L  X+Q263  Y+Q22 R0 FQ59
TCH PROBE 0.0 BEZUGSEBENE Q4 Y-
TCH PROBE 0.1  Z+Q261
FN 9: IF +Q301 EQU +0 GOTO LBL 2
L  Z+Q260 FQ59
LBL 2
L  X+Q265  Y+Q32 FQ59
TCH PROBE 0.0 BEZUGSEBENE Q5 Y-
TCH PROBE 0.1  Z+Q261
FN 9: IF +0 EQU +0 GOTO LBL 92
LBL 21
; ** X-RICHTUNG ***************
FN 9: IF +Q267 EQU -1 GOTO LBL 22
FN 2: Q21 =+Q263 - +Q320
FN 2: Q31 =+Q265 - +Q320
L  X+Q21  Y+Q264 R0 FQ59
TCH PROBE 0.0 BEZUGSEBENE Q4 X+
TCH PROBE 0.1  Z+Q261
FN 9: IF +Q301 EQU +0 GOTO LBL 3
L  Z+Q260 FQ59
LBL 3
L  X+Q31  Y+Q266 FQ59
TCH PROBE 0.0 BEZUGSEBENE Q5 X+
TCH PROBE 0.1  Z+Q261
FN 9: IF +0 EQU +0 GOTO LBL 91
LBL 22
FN 1: Q21 =+Q263 + +Q320
FN 1: Q31 =+Q265 + +Q320
L  X+Q21  Y+Q264 R0 FQ59
TCH PROBE 0.0 BEZUGSEBENE Q4 X-
TCH PROBE 0.1  Z+Q261
FN 9: IF +Q301 EQU +0 GOTO LBL 4
L  Z+Q260 FQ59
LBL 4
L  X+Q31  Y+Q266 FQ59
TCH PROBE 0.0 BEZUGSEBENE Q5 X-
TCH PROBE 0.1  Z+Q261
FN 9: IF +0 EQU +0 GOTO LBL 91
; Z-RICHTUNG
LBL 91
Q50 = 90 - ATAN ( ( Q4 - Q5 ) / ( Q264 - Q266 ) )
Q50 = Q50 - Q307
CALL PGM CALC_ANGLE.CYC
FN 9: IF +0 EQU +0 GOTO LBL 99
LBL 92
Q50 = ATAN ( ( Q5 - Q4 ) / ( Q265 - Q263 ) )
Q50 = Q50 - Q307
CALL PGM CALC_ANGLE.CYC
LBL 99
L  Z+Q260 R0 FQ59
CALL PGM WRITE_BROT.CYC
FN 17: SYSWRITE ID 990 NR1 =+0
FN 17: SYSWRITE ID 990 NR2 =+0
LBL 254
FN 17: SYSWRITE ID 990 NR16 =+0 ;# Spindelkontrolle aus
END PGM 400 MM
