0  BEGIN PGM 405 MM
1  FN 18: SYSREAD Q0 = ID2000 NR10 IDX4158
2  FN 9: IF +Q0 EQU +1 GOTO LBL 254
3  FN 18: SYSREAD Q0 = ID990 NR2 IDX16
4  FN 9: IF +Q0 EQU +0 GOTO LBL 254
5  Q337 = ABS Q337  
6  Q262 = ABS Q262  
7  Q301 = ABS Q301  
8  FN 10: IF +Q109 NE -1 GOTO LBL 100
9  FN 14: ERROR = 1001
10  LBL 100
11  FN 18: SYSREAD Q0 = ID210 NR3
12  FN 9: IF +Q0 EQU +0 GOTO LBL 101
13  FN 14: ERROR = 1008
14  LBL 101
15  FN 18: SYSREAD Q0 = ID210 NR4 IDX1
16  FN 18: SYSREAD Q1 = ID210 NR4 IDX2
17  FN 18: SYSREAD Q2 = ID210 NR4 IDX3
18  Q0 = Q0 + Q1 + Q2  
19  FN 9: IF +Q0 EQU +3 GOTO LBL 102
20  FN 14: ERROR = 1007
21  LBL 102
22  FN 10: IF +Q247 NE +0 GOTO LBL 103
23  FN 14: ERROR = 1011
24  LBL 103
25  FN 11: IF +Q247 GT +4.9999 GOTO LBL 104
26  FN 12: IF +Q247 LT -4.9999 GOTO LBL 104
27  FN 14: ERROR = 1011
28  LBL 104
29  FN 17: SYSWRITE ID212 = +3
30  FN 17: SYSWRITE ID990 NR1 = +1
31  FN 17: SYSWRITE ID990 NR2 = +1
32  FN 18: SYSREAD Q3 = ID1000 NR6140
33  FN 18: SYSREAD Q1 = ID1010 NR6200
34  FN 9: IF +Q1 EQU +0 GOTO LBL 13
35  FN 18: SYSREAD Q1 = ID1000 NR6200
36  FN 9: IF +Q1 EQU +1 GOTO LBL 15
37  LBL 13
38  FN 18: SYSREAD Q58 = ID1000 NR6120
39  FN 18: SYSREAD Q59 = ID1000 NR6150
40  FN 18: SYSREAD Q2 = ID350 NR11
41  FN 9: IF +0 EQU +0 GOTO LBL 16
42  LBL 15
43  FN 18: SYSREAD Q58 = ID1000 NR6360
44  FN 18: SYSREAD Q59 = ID1000 NR6361
45  FN 18: SYSREAD Q2 = ID350 NR31
46  LBL 16
47  FN 18: SYSREAD Q0 = ID1000 NR7411
48  ; Q0 = 2 * FRAC (Q0 / 2)  
49  FN 9: IF +Q0 EQU +0 GOTO LBL 14
50  FN 18: SYSREAD Q2 = ID200 NR1
51  Q2 = ABS Q2  
52  LBL 14
53  FN 10: IF +Q0 NE +0 GOTO LBL 17
54  FN 17: SYSWRITE ID990 NR3 = +1
55  LBL 17
56  Q320 = Q320 + Q2 + Q3  
57  FN 0: Q9 = +0
58  Q5 = (Q262 / 2) - Q320  
59  FN 11: IF +Q5 GT +0 GOTO LBL 12
60  FN 0: Q5 = +0
61  LBL 12
62  Q10 = Q325  
63  FN 12: IF +Q261 LT +Q260 GOTO LBL 130
64  FN 0: Q260 = +Q261
65  FN 0: Q301 = +0
66  LBL 130
67  FN 1: Q1 = +Q109 + +1
68  FN 18: SYSREAD Q0 = ID270 NR1 IDXQ1
69  FN 11: IF +Q0 GT +Q260 GOTO LBL 120
70  L Z+Q260 R0 FQ59
71  LBL 120
72  CC X+Q321 Y+Q322
73  LP PR+Q5 PA+Q10 R0 FQ59
74  TCH PROBE 1.0 BEZUGSPUNKT POLAR
75  TCH PROBE 1.1 X WINKEL: +Q10
76  TCH PROBE 1.2 Z+Q261
77  CALL LBL 253
78  FN 0: Q27 = +Q141
79  FN 0: Q28 = +Q142
80  FN 1: Q10 = +Q10 + +Q247
81  FN 9: IF +Q5 EQU +0 GOTO LBL 23
82  FN 9: IF +Q301 EQU +0 GOTO LBL 21
83  L Z+Q260 R0 FQ59
84  LBL 21
85  FN 12: IF +Q247 LT +0 GOTO LBL 22
86  CP IPA+Q247 DR+ R0 FQ59
87  FN 9: IF +0 EQU +0 GOTO LBL 23
88  LBL 22
89  CP IPA+Q247 DR- R0 FQ59
90  LBL 23
91  TCH PROBE 1.0 BEZUGSPUNKT POLAR
92  TCH PROBE 1.1 X WINKEL: +Q10
93  TCH PROBE 1.2 Z+Q261
94  CALL LBL 253
95  FN 0: Q25 = +Q141
96  FN 0: Q26 = +Q142
97  FN 1: Q10 = +Q10 + +Q247
98  FN 9: IF +Q5 EQU +0 GOTO LBL 26
99  FN 9: IF +Q301 EQU +0 GOTO LBL 24
100  L Z+Q260 R0 FQ59
101  LBL 24
102  FN 12: IF +Q247 LT +0 GOTO LBL 25
103  CP IPA+Q247 DR+ R0 FQ59
104  FN 9: IF +0 EQU +0 GOTO LBL 26
105  LBL 25
106  CP IPA+Q247 DR- R0 FQ59
107  LBL 26
108  TCH PROBE 1.0 BEZUGSPUNKT POLAR
109  TCH PROBE 1.1 X WINKEL: +Q10
110  TCH PROBE 1.2 Z+Q261
111  CALL LBL 253
112  FN 0: Q23 = +Q141
113  FN 0: Q24 = +Q142
114  FN 1: Q10 = +Q10 + +Q247
115  FN 9: IF +Q5 EQU +0 GOTO LBL 29
116  FN 9: IF +Q301 EQU +0 GOTO LBL 27
117  L Z+Q260 R0 FQ59
118  LBL 27
119  FN 12: IF +Q247 LT +0 GOTO LBL 28
120  CP IPA+Q247 DR+ R0 FQ59
121  FN 9: IF +0 EQU +0 GOTO LBL 29
122  LBL 28
123  CP IPA+Q247 DR- R0 FQ59
124  LBL 29
125  TCH PROBE 1.0 BEZUGSPUNKT POLAR
126  TCH PROBE 1.1 X WINKEL: +Q10
127  TCH PROBE 1.2 Z+Q261
128  CALL LBL 253
129  FN 0: Q21 = +Q141
130  FN 0: Q22 = +Q142
131  FN 24: Q31 = CDATA Q21
132  L X+Q31 Y+Q32 R0 FQ59
133  FN 18: SYSREAD Q31 = ID270 NR1 IDX1
134  FN 18: SYSREAD Q32 = ID270 NR1 IDX2
135  L Z+Q260 R0 FQ59
136  FN 9: IF +Q337 EQU +0 GOTO LBL 64
137  FN 9: IF +Q109 EQU +1 GOTO LBL 31
138  FN 9: IF +Q109 EQU +7 GOTO LBL 31
139  Q15 = 0  
140  Q150 = ATAN ((Q31 - 0) / (Q32 - 0))  
141  FN 9: IF +Q322 EQU +0 GOTO LBL 30
142  Q15 = ATAN ((Q321 - 0) / (Q322 - 0))  
143  LBL 30
144  Q150 = Q150 - Q15  
145  FN 9: IF +0 EQU +0 GOTO LBL 32
146  LBL 31
147  Q150 = ATAN ((Q31 - 0) / (Q32 - 0))  
148  LBL 32
149  L IC-Q150 R0 FQ59
150  FN 18: SYSREAD Q0 = ID500 NRQ337 IDX6
151  Q0 = Q0 - Q150  
152  FN 17: SYSWRITE ID500 NRQ337 IDX6 = +Q0
153  FN 9: IF +0 EQU +0 GOTO LBL 65
154  LBL 64
155  Q150 = ATAN ((Q31 - 0) / (Q32 - 0))  
156  L IC-Q150 R0 FQ59
157  FN 18: SYSREAD Q6 = ID270 NR1 IDX6
158  FN 25: PRESET = C /+Q6 /+0
159  LBL 65
160  FN 17: SYSWRITE ID990 NR1 = +0
161  FN 17: SYSWRITE ID990 NR2 = +0
162  FN 9: IF +0 EQU +0 GOTO LBL 254
163  LBL 253
164  FN 9: IF +Q109 EQU +0 GOTO LBL 230
165  FN 9: IF +Q109 EQU +6 GOTO LBL 230
166  FN 9: IF +Q109 EQU +1 GOTO LBL 231
167  FN 9: IF +Q109 EQU +7 GOTO LBL 231
168  FN 9: IF +Q109 EQU +2 GOTO LBL 232
169  FN 9: IF +Q109 EQU +8 GOTO LBL 232
170  LBL 230
171  FN 0: Q141 = +Q115
172  FN 0: Q142 = +Q116
173  FN 0: Q143 = +Q117
174  FN 17: SYSWRITE ID990 NR5 IDX1 = +141
175  FN 0: Q141 = +Q145
176  FN 0: Q142 = +Q146
177  FN 17: SYSWRITE ID990 NR4 IDX1 = +141
178  FN 0: Q141 = +Q143
179  FN 0: Q142 = +Q144
180  FN 9: IF +0 EQU +0 GOTO LBL 233
181  LBL 231
182  FN 0: Q141 = +Q115
183  FN 0: Q142 = +Q116
184  FN 0: Q143 = +Q117
185  FN 17: SYSWRITE ID990 NR5 IDX1 = +141
186  FN 0: Q141 = +Q146
187  FN 0: Q142 = +Q144
188  FN 17: SYSWRITE ID990 NR4 IDX1 = +141
189  FN 0: Q141 = +Q143
190  FN 0: Q142 = +Q144
191  FN 9: IF +0 EQU +0 GOTO LBL 233
192  LBL 232
193  FN 0: Q141 = +Q115
194  FN 0: Q142 = +Q116
195  FN 0: Q143 = +Q117
196  FN 17: SYSWRITE ID990 NR5 IDX1 = +141
197  FN 0: Q141 = +Q144
198  FN 0: Q142 = +Q145
199  FN 17: SYSWRITE ID990 NR4 IDX1 = +141
200  FN 0: Q141 = +Q143
201  FN 0: Q142 = +Q144
202  LBL 233
203  LBL 0
204  LBL 254
205  END PGM 405 MM
