BEGIN PGM 402 MM 
FN 18: SYSREAD Q0 = ID2000 NR10 IDX4158
FN 9: IF +Q0 EQU +1 GOTO LBL 254
FN 18: SYSREAD Q0 = ID990 NR2 IDX16
FN 9: IF +Q0 EQU +0 GOTO LBL 254
Q198 = 402
FN 9: IF +Q402 EQU +0 GOTO LBL 10
FN 18: SYSREAD Q51 = ID210 NR6
FN 10: IF +Q51 NE -1 GOTO LBL 10
FN 14: ERROR= 1075
LBL 10
CALL PGM INIT.CYC
Q320 = Q320 + Q2 + Q3
Q19 = ( Q313 / 2 ) + Q320
Q20 = ( Q314 / 2 ) + Q320
; ** 1. Zapfen *************  
FN 12: IF +Q261 LT +Q260 GOTO LBL 130
FN 14: ERROR= 1016
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
CC  X+Q268  Y+Q269
LP  PR+Q19  PA+0 R0 FQ59
TCH PROBE 0.0 BEZUGSEBENE Q0 X-
TCH PROBE 0.1  Z+Q261
CALL LBL 253
FN 0: Q1 =+Q141
FN 0: Q2 =+Q142
FN 9: IF +Q301 EQU +0 GOTO LBL 20
L  Z+Q260 R0 FQ59
LBL 20
CP IPA+90 DR+ R0 FQ59
TCH PROBE 0.0 BEZUGSEBENE Q0 Y-
TCH PROBE 0.1  Z+Q261
CALL LBL 253
FN 0: Q3 =+Q141
FN 0: Q4 =+Q142
FN 9: IF +Q301 EQU +0 GOTO LBL 21
L  Z+Q260 R0 FQ59
LBL 21
CP IPA+90 DR+ R0 FQ59
TCH PROBE 0.0 BEZUGSEBENE Q0 X+
TCH PROBE 0.1  Z+Q261
CALL LBL 253
FN 0: Q5 =+Q141
FN 0: Q6 =+Q142
FN 9: IF +Q301 EQU +0 GOTO LBL 22
L  Z+Q260 R0 FQ59
LBL 22
CP IPA+90 DR+ R0 FQ59
TCH PROBE 0.0 BEZUGSEBENE Q0 Y+
TCH PROBE 0.1  Z+Q261
CALL LBL 253
FN 0: Q7 =+Q141
FN 0: Q8 =+Q142
L  Z+Q260 R0 FQ59
; ** 2. Zapfen *************** 
CC  X+Q270  Y+Q271
LP  PR+Q20  PA+0 R0 FQ59
TCH PROBE 0.0 BEZUGSEBENE Q0 X-
TCH PROBE 0.1  Z+Q315
CALL LBL 253
FN 0: Q11 =+Q141
FN 0: Q12 =+Q142
FN 9: IF +Q301 EQU +0 GOTO LBL 23
L  Z+Q260 R0 FQ59
LBL 23
CP IPA+90 DR+ R0 FQ59
TCH PROBE 0.0 BEZUGSEBENE Q0 Y-
TCH PROBE 0.1  Z+Q315
CALL LBL 253
FN 0: Q13 =+Q141
FN 0: Q14 =+Q142
FN 9: IF +Q301 EQU +0 GOTO LBL 24
L  Z+Q260 R0 FQ59
LBL 24
CP IPA+90 DR+ R0 FQ59
TCH PROBE 0.0 BEZUGSEBENE Q0 X+
TCH PROBE 0.1  Z+Q315
CALL LBL 253
FN 0: Q15 =+Q141
FN 0: Q16 =+Q142
FN 9: IF +Q301 EQU +0 GOTO LBL 25
L  Z+Q260 R0 FQ59
LBL 25
CP IPA+90 DR+ R0 FQ59
TCH PROBE 0.0 BEZUGSEBENE Q0 Y+
TCH PROBE 0.1  Z+Q315
CALL LBL 253
FN 0: Q17 =+Q141
FN 0: Q18 =+Q142
L  Z+Q260 R0 FQ59
FN 24: Q21 = CDATA Q1
FN 24: Q31 = CDATA Q11
FN 2: Q41 =+Q31 - +Q21
FN 2: Q42 =+Q32 - +Q22
FN 13: Q50 =+Q42 ANG +Q41
FN 12: IF +Q50 LT +90 GOTO LBL 31
FN 9: IF +Q50 EQU +90 GOTO LBL 31
FN 11: IF +Q50 GT +270 GOTO LBL 30
FN 9: IF +Q50 EQU +270 GOTO LBL 30
Q50 = Q50 - 180
FN 9: IF +0 EQU +0 GOTO LBL 31
LBL 30
Q50 = Q50 - 360
LBL 31
Q50 = Q50 - Q307
FN 11: IF +Q50 GT +0 GOTO LBL 41
FN 11: IF +Q50 GT -360.0001 GOTO LBL 42
Q50 = Q50 + 360
FN 9: IF +0 EQU +0 GOTO LBL 42
LBL 41
FN 12: IF +Q50 LT +360.0001 GOTO LBL 42
Q50 = Q50 - 360
LBL 42
FN 11: IF +Q50 GT +0 GOTO LBL 50
FN 11: IF +Q50 GT -90.0001 GOTO LBL 98
FN 11: IF +Q50 GT -270.0001 GOTO LBL 43
Q50 = Q50 + 360
FN 9: IF +0 EQU +0 GOTO LBL 98
LBL 43
Q50 = Q50 + 180
FN 9: IF +0 EQU +0 GOTO LBL 98
LBL 50
FN 12: IF +Q50 LT +90.0001 GOTO LBL 98
FN 12: IF +Q50 LT +270.0001 GOTO LBL 44
Q50 = Q50 - 360
FN 9: IF +0 EQU +0 GOTO LBL 98
LBL 44
Q50 = Q50 - 180
LBL 98
FN 10: IF +Q402 NE +1 GOTO LBL 100
CALL PGM AXISCOMP.CYC
FN 9: IF +0 EQU +0 GOTO LBL 252
LBL 100
FN 11: IF +Q305 GT +0 GOTO LBL 251
; Aktiven Preset lesen
FN 18: SYSREAD Q0 = ID530 NR1
FN 9: IF +Q0 EQU +0 GOTO LBL 101
; Wenn Zeile 0 aktiv, dann copy ueberspringen
FN 10: IF +Q0 NE -1 GOTO LBL 102
Q0 = 0
LBL 102
; Aktive Zeile Kopieren
FN 18: SYSREAD QL1 = ID503 NRQ0 IDX1
FN 18: SYSREAD QL2 = ID503 NRQ0 IDX2
FN 18: SYSREAD QL3 = ID503 NRQ0 IDX3
FN 18: SYSREAD QL4 = ID503 NRQ0 IDX4
FN 18: SYSREAD QL5 = ID503 NRQ0 IDX5
FN 18: SYSREAD QL6 = ID503 NRQ0 IDX6
FN 18: SYSREAD QL7 = ID503 NRQ0 IDX7
FN 18: SYSREAD QL8 = ID503 NRQ0 IDX8
FN 18: SYSREAD QL9 = ID503 NRQ0 IDX9
FN 17: SYSWRITE ID 503 NRQ305 IDX1 =+QL1
FN 17: SYSWRITE ID 503 NRQ305 IDX2 =+QL2
FN 17: SYSWRITE ID 503 NRQ305 IDX3 =+QL3
FN 17: SYSWRITE ID 503 NRQ305 IDX4 =+QL4
FN 17: SYSWRITE ID 503 NRQ305 IDX5 =+QL5
FN 17: SYSWRITE ID 503 NRQ305 IDX6 =+QL6
FN 17: SYSWRITE ID 503 NRQ305 IDX7 =+QL7
FN 17: SYSWRITE ID 503 NRQ305 IDX8 =+QL8
FN 17: SYSWRITE ID 503 NRQ305 IDX9 =+QL9
LBL 101
FN 17: SYSWRITE ID 504 NRQ305 =+Q50
; Preset 0 aktivieren
FN 17: SYSWRITE ID 530 NR1 =+Q305
FN 9: IF +0 EQU +0 GOTO LBL 252
LBL 251
FN 17: SYSWRITE ID 504 NRQ305 =+Q50
LBL 252
FN 17: SYSWRITE ID 990 NR1 =+0
FN 17: SYSWRITE ID 990 NR2 =+0
FN 9: IF +0 EQU +0 GOTO LBL 254
LBL 253
FN 9: IF +Q109 EQU +0 GOTO LBL 230
FN 9: IF +Q109 EQU +6 GOTO LBL 230
FN 9: IF +Q109 EQU +1 GOTO LBL 231
FN 9: IF +Q109 EQU +7 GOTO LBL 231
FN 9: IF +Q109 EQU +2 GOTO LBL 232
FN 9: IF +Q109 EQU +8 GOTO LBL 232
LBL 230
FN 0: Q141 =+Q116
FN 0: Q142 =+Q117
FN 9: IF +0 EQU +0 GOTO LBL 233
LBL 231
FN 0: Q141 =+Q117
FN 0: Q142 =+Q115
FN 9: IF +0 EQU +0 GOTO LBL 233
LBL 232
FN 0: Q141 =+Q115
FN 0: Q142 =+Q116
LBL 233
LBL 0
LBL 254
END PGM 402 MM 
