BEGIN PGM 405 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 = 405
CALL PGM INIT.CYC
FN 10: IF +Q247 NE +0 GOTO LBL 103
FN 14: ERROR= 1011
LBL 103
FN 11: IF +Q247 GT +4.9999 GOTO LBL 104
FN 12: IF +Q247 LT -4.9999 GOTO LBL 104
FN 14: ERROR= 1011
LBL 104
Q320 = Q320 + Q2 + Q3
FN 0: Q9 =+0
Q5 = ( Q262 / 2 ) - Q320
FN 11: IF +Q5 GT +0 GOTO LBL 12
FN 0: Q5 =+0
LBL 12
Q10 = Q325
FN 12: IF +Q261 LT +Q260 GOTO LBL 130
FN 0: Q260 =+Q261
FN 0: Q301 =+0
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+Q321  Y+Q322
LP  PR+Q5  PA+Q10 R0 FQ59
TCH PROBE 1.0 BEZUGSPUNKT POLAR
TCH PROBE 1.1 X WINKEL:+Q10
TCH PROBE 1.2  Z+Q261
CALL LBL 253
FN 0: Q27 =+Q141
FN 0: Q28 =+Q142
FN 1: Q10 =+Q10 + +Q247
FN 9: IF +Q5 EQU +0 GOTO LBL 23
FN 9: IF +Q301 EQU +0 GOTO LBL 21
L  Z+Q260 R0 FQ59
LBL 21
FN 12: IF +Q247 LT +0 GOTO LBL 22
CP IPA+Q247 DR+ R0 FQ59
FN 9: IF +0 EQU +0 GOTO LBL 23
LBL 22
CP IPA+Q247 DR- R0 FQ59
LBL 23
TCH PROBE 1.0 BEZUGSPUNKT POLAR
TCH PROBE 1.1 X WINKEL:+Q10
TCH PROBE 1.2  Z+Q261
CALL LBL 253
FN 0: Q25 =+Q141
FN 0: Q26 =+Q142
FN 1: Q10 =+Q10 + +Q247
FN 9: IF +Q5 EQU +0 GOTO LBL 26
FN 9: IF +Q301 EQU +0 GOTO LBL 24
L  Z+Q260 R0 FQ59
LBL 24
FN 12: IF +Q247 LT +0 GOTO LBL 25
CP IPA+Q247 DR+ R0 FQ59
FN 9: IF +0 EQU +0 GOTO LBL 26
LBL 25
CP IPA+Q247 DR- R0 FQ59
LBL 26
TCH PROBE 1.0 BEZUGSPUNKT POLAR
TCH PROBE 1.1 X WINKEL:+Q10
TCH PROBE 1.2  Z+Q261
CALL LBL 253
FN 0: Q23 =+Q141
FN 0: Q24 =+Q142
FN 1: Q10 =+Q10 + +Q247
FN 9: IF +Q5 EQU +0 GOTO LBL 29
FN 9: IF +Q301 EQU +0 GOTO LBL 27
L  Z+Q260 R0 FQ59
LBL 27
FN 12: IF +Q247 LT +0 GOTO LBL 28
CP IPA+Q247 DR+ R0 FQ59
FN 9: IF +0 EQU +0 GOTO LBL 29
LBL 28
CP IPA+Q247 DR- R0 FQ59
LBL 29
TCH PROBE 1.0 BEZUGSPUNKT POLAR
TCH PROBE 1.1 X WINKEL:+Q10
TCH PROBE 1.2  Z+Q261
CALL LBL 253
FN 0: Q21 =+Q141
FN 0: Q22 =+Q142
FN 24: Q31 = CDATA Q21
L  X+Q31  Y+Q32 R0 FQ59
FN 18: SYSREAD Q31 = ID270 NR1 IDX1
FN 18: SYSREAD Q32 = ID270 NR1 IDX2
L  Z+Q260 R0 FQ59
FN 9: IF +Q337 EQU +0 GOTO LBL "MAN_PRESET"
FN 9: IF +Q109 EQU +1 GOTO LBL 31
FN 9: IF +Q109 EQU +7 GOTO LBL 31
Q15 = 0
Q150 = ATAN ( ( Q31 - 0 ) / ( Q32 - 0 ) )
FN 9: IF +Q322 EQU +0 GOTO LBL 30
Q15 = ATAN ( ( Q321 - 0 ) / ( Q322 - 0 ) )
LBL 30
Q150 = Q150 - Q15
FN 9: IF +0 EQU +0 GOTO LBL 32
LBL 31
Q150 = ATAN ( ( Q31 - 0 ) / ( Q32 - 0 ) )
LBL 32
L IC-Q150 R0 FQ59
FN 18: SYSREAD Q0 = ID500 NRQ337 IDX6
Q0 = Q0 - Q150
FN 17: SYSWRITE ID 500 NRQ337 IDX6 =+Q0
FN 9: IF +0 EQU +0 GOTO LBL 65
LBL "MAN_PRESET"
Q150 = ATAN ( ( Q31 - 0 ) / ( Q32 - 0 ) )
L IC-Q150 R0 FQ59
FN 18: SYSREAD Q6 = ID 270 NR 1 IDX 6
FN 18: SYSREAD QL0 = ID 530 NR 1    ; aktueller Preset
FN 9: IF +QL0 EQU -1 GOTO LBL "MAN_PRESET_ACTIVE"
    FN 18: SYSREAD QL1 = ID 503 NR QL0 IDX 1
    FN 18: SYSREAD QL2 = ID 503 NR QL0 IDX 2
    FN 18: SYSREAD QL3 = ID 503 NR QL0 IDX 3
    FN 18: SYSREAD QL4 = ID 503 NR QL0 IDX 4
    FN 18: SYSREAD QL5 = ID 503 NR QL0 IDX 5
    FN 18: SYSREAD QL6 = ID 503 NR QL0 IDX 6
    FN 18: SYSREAD QL7 = ID 503 NR QL0 IDX 7
    FN 18: SYSREAD QL8 = ID 503 NR QL0 IDX 8
    FN 18: SYSREAD QL9 = ID 503 NR QL0 IDX 9
    FN 18: SYSREAD QL10 = ID 504 NR QL0
    FN 17: SYSWRITE ID 503 NR 0 IDX 1 =+QL1
    FN 17: SYSWRITE ID 503 NR 0 IDX 2 =+QL2
    FN 17: SYSWRITE ID 503 NR 0 IDX 3 =+QL3
    FN 17: SYSWRITE ID 503 NR 0 IDX 4 =+QL4
    FN 17: SYSWRITE ID 503 NR 0 IDX 5 =+QL5
    FN 17: SYSWRITE ID 503 NR 0 IDX 6 =+QL6
    FN 17: SYSWRITE ID 503 NR 0 IDX 7 =+QL7
    FN 17: SYSWRITE ID 503 NR 0 IDX 8 =+QL8
    FN 17: SYSWRITE ID 503 NR 0 IDX 9 =+QL9
    FN 17: SYSWRITE ID 504 NR 0 =+QL10
LBL "MAN_PRESET_ACTIVE"
FN 17: SYSWRITE ID 502 NR 0 IDX 6 =+Q6  ; Preset 0 beschreiben
FN 17: SYSWRITE ID 530 NR 1 =+0         ; Preset 0 aktivieren
LBL 65
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 =+Q115
FN 0: Q142 =+Q116
FN 0: Q143 =+Q117
FN 17: SYSWRITE ID 990 NR5 IDX1 =+141
FN 0: Q141 =+Q145
FN 0: Q142 =+Q146
FN 17: SYSWRITE ID 990 NR4 IDX1 =+141
FN 0: Q141 =+Q143
FN 0: Q142 =+Q144
FN 9: IF +0 EQU +0 GOTO LBL 233
LBL 231
FN 0: Q141 =+Q115
FN 0: Q142 =+Q116
FN 0: Q143 =+Q117
FN 17: SYSWRITE ID 990 NR5 IDX1 =+141
FN 0: Q141 =+Q146
FN 0: Q142 =+Q144
FN 17: SYSWRITE ID 990 NR4 IDX1 =+141
FN 0: Q141 =+Q143
FN 0: Q142 =+Q144
FN 9: IF +0 EQU +0 GOTO LBL 233
LBL 232
FN 0: Q141 =+Q115
FN 0: Q142 =+Q116
FN 0: Q143 =+Q117
FN 17: SYSWRITE ID 990 NR5 IDX1 =+141
FN 0: Q141 =+Q144
FN 0: Q142 =+Q145
FN 17: SYSWRITE ID 990 NR4 IDX1 =+141
FN 0: Q141 =+Q143
FN 0: Q142 =+Q144
LBL 233
LBL 0
LBL 254
END PGM 405 MM
