0  BEGIN PGM 418 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  Q305 = ABS Q305  
6  FN 10: IF +Q109 NE -1 GOTO LBL 100
7  FN 14: ERROR = 1001
8  LBL 100
9  FN 18: SYSREAD Q0 = ID210 NR3
10  FN 9: IF +Q0 EQU +0 GOTO LBL 101
11  FN 14: ERROR = 1008
12  LBL 101
13  FN 18: SYSREAD Q0 = ID210 NR4 IDX1
14  FN 18: SYSREAD Q1 = ID210 NR4 IDX2
15  FN 18: SYSREAD Q2 = ID210 NR4 IDX3
16  Q0 = Q0 + Q1 + Q2  
17  FN 9: IF +Q0 EQU +3 GOTO LBL 102
18  FN 14: ERROR = 1007
19  LBL 102
20  FN 18: SYSREAD Q0 = ID210 NR1
21  FN 18: SYSREAD Q1 = ID210 NR2
22  Q51 = Q0 + Q1  
23  FN 9: IF +Q51 EQU +0 GOTO LBL 103
24  FN 18: SYSREAD Q0 = ID210 NR6
25  FN 10: IF +Q0 NE -1 GOTO LBL 103
26  FN 14: ERROR = 1006
27  LBL 103
28  Q54 = 0 + Q51  
29  Q55 = 90 + Q51  
30  Q56 = 180 + Q51  
31  Q57 = 270 + Q51  
32  FN 17: SYSWRITE ID212 = +3
33  FN 17: SYSWRITE ID990 NR1 = +1
34  FN 17: SYSWRITE ID990 NR2 = +1
35  FN 18: SYSREAD Q3 = ID1000 NR6140
36  FN 18: SYSREAD Q1 = ID1010 NR6200
37  FN 9: IF +Q1 EQU +0 GOTO LBL 13
38  FN 18: SYSREAD Q1 = ID1000 NR6200
39  FN 9: IF +Q1 EQU +1 GOTO LBL 10
40  LBL 13
41  FN 18: SYSREAD Q58 = ID1000 NR6120
42  FN 18: SYSREAD Q59 = ID1000 NR6150
43  FN 18: SYSREAD Q2 = ID350 NR11
44  FN 9: IF +0 EQU +0 GOTO LBL 11
45  LBL 10
46  FN 18: SYSREAD Q58 = ID1000 NR6360
47  FN 18: SYSREAD Q59 = ID1000 NR6361
48  FN 18: SYSREAD Q2 = ID350 NR31
49  LBL 11
50  FN 18: SYSREAD Q0 = ID1000 NR7411
51  ; Q0 = 2 * FRAC (Q0 / 2)  
52  FN 9: IF +Q0 EQU +0 GOTO LBL 14
53  FN 18: SYSREAD Q2 = ID200 NR1
54  Q2 = ABS Q2  
55  LBL 14
56  FN 10: IF +Q0 NE +0 GOTO LBL 15
57  FN 17: SYSWRITE ID990 NR3 = +1
58  LBL 15
59  FN 12: IF +Q261 LT +Q260 GOTO LBL 130
60  FN 14: ERROR = 1016
61  LBL 130
62  FN 1: Q1 = +Q109 + +1
63  FN 18: SYSREAD Q0 = ID270 NR1 IDXQ1
64  FN 11: IF +Q0 GT +Q260 GOTO LBL 120
65  L Z+Q260 R0 FQ59
66  LBL 120
67  L X+Q268 Y+Q269 R0 FQ59
68  TCH PROBE 1.0 BEZUGSPUNKT POLAR
69  TCH PROBE 1.1 X WINKEL: +Q54
70  TCH PROBE 1.2 Z+Q261
71  CALL LBL 253
72  FN 0: Q1 = +Q141
73  FN 0: Q2 = +Q142
74  TCH PROBE 1.0 BEZUGSPUNKT POLAR
75  TCH PROBE 1.1 X WINKEL: +Q55
76  TCH PROBE 1.2 Z+Q261
77  CALL LBL 253
78  FN 0: Q3 = +Q141
79  FN 0: Q4 = +Q142
80  TCH PROBE 1.0 BEZUGSPUNKT POLAR
81  TCH PROBE 1.1 X WINKEL: +Q56
82  TCH PROBE 1.2 Z+Q261
83  CALL LBL 253
84  FN 0: Q5 = +Q141
85  FN 0: Q6 = +Q142
86  TCH PROBE 1.0 BEZUGSPUNKT POLAR
87  TCH PROBE 1.1 X WINKEL: +Q57
88  TCH PROBE 1.2 Z+Q261
89  CALL LBL 253
90  FN 0: Q7 = +Q141
91  FN 0: Q8 = +Q142
92  L Z+Q260 R0 FQ59
93  FN 24: Q1 = CDATA Q1
94  ; *** 2. BOHRUNG ************** 
95  L X+Q270 Y+Q271 R0 FQ59
96  TCH PROBE 1.0 BEZUGSPUNKT POLAR
97  TCH PROBE 1.1 X WINKEL: +Q54
98  TCH PROBE 1.2 Z+Q261
99  CALL LBL 253
100  FN 0: Q11 = +Q141
101  FN 0: Q12 = +Q142
102  TCH PROBE 1.0 BEZUGSPUNKT POLAR
103  TCH PROBE 1.1 X WINKEL: +Q55
104  TCH PROBE 1.2 Z+Q261
105  CALL LBL 253
106  FN 0: Q13 = +Q141
107  FN 0: Q14 = +Q142
108  TCH PROBE 1.0 BEZUGSPUNKT POLAR
109  TCH PROBE 1.1 X WINKEL: +Q56
110  TCH PROBE 1.2 Z+Q261
111  CALL LBL 253
112  FN 0: Q15 = +Q141
113  FN 0: Q16 = +Q142
114  TCH PROBE 1.0 BEZUGSPUNKT POLAR
115  TCH PROBE 1.1 X WINKEL: +Q57
116  TCH PROBE 1.2 Z+Q261
117  CALL LBL 253
118  FN 0: Q17 = +Q141
119  FN 0: Q18 = +Q142
120  L Z+Q260 R0 FQ59
121  FN 24: Q10 = CDATA Q11
122  ; *** 3. BOHRUNG ************** 
123  L X+Q316 Y+Q317 R0 FQ59
124  TCH PROBE 1.0 BEZUGSPUNKT POLAR
125  TCH PROBE 1.1 X WINKEL: +Q54
126  TCH PROBE 1.2 Z+Q261
127  CALL LBL 253
128  FN 0: Q21 = +Q141
129  FN 0: Q22 = +Q142
130  TCH PROBE 1.0 BEZUGSPUNKT POLAR
131  TCH PROBE 1.1 X WINKEL: +Q55
132  TCH PROBE 1.2 Z+Q261
133  CALL LBL 253
134  FN 0: Q23 = +Q141
135  FN 0: Q24 = +Q142
136  TCH PROBE 1.0 BEZUGSPUNKT POLAR
137  TCH PROBE 1.1 X WINKEL: +Q56
138  TCH PROBE 1.2 Z+Q261
139  CALL LBL 253
140  FN 0: Q25 = +Q141
141  FN 0: Q26 = +Q142
142  TCH PROBE 1.0 BEZUGSPUNKT POLAR
143  TCH PROBE 1.1 X WINKEL: +Q57
144  TCH PROBE 1.2 Z+Q261
145  CALL LBL 253
146  FN 0: Q27 = +Q141
147  FN 0: Q28 = +Q142
148  L Z+Q260 R0 FQ59
149  FN 24: Q20 = CDATA Q21
150  ; *** 4. BOHRUNG ************** 
151  L X+Q318 Y+Q319 R0 FQ59
152  TCH PROBE 1.0 BEZUGSPUNKT POLAR
153  TCH PROBE 1.1 X WINKEL: +Q54
154  TCH PROBE 1.2 Z+Q261
155  CALL LBL 253
156  FN 0: Q31 = +Q141
157  FN 0: Q32 = +Q142
158  TCH PROBE 1.0 BEZUGSPUNKT POLAR
159  TCH PROBE 1.1 X WINKEL: +Q55
160  TCH PROBE 1.2 Z+Q261
161  CALL LBL 253
162  FN 0: Q33 = +Q141
163  FN 0: Q34 = +Q142
164  TCH PROBE 1.0 BEZUGSPUNKT POLAR
165  TCH PROBE 1.1 X WINKEL: +Q56
166  TCH PROBE 1.2 Z+Q261
167  CALL LBL 253
168  FN 0: Q35 = +Q141
169  FN 0: Q36 = +Q142
170  TCH PROBE 1.0 BEZUGSPUNKT POLAR
171  TCH PROBE 1.1 X WINKEL: +Q57
172  TCH PROBE 1.2 Z+Q261
173  CALL LBL 253
174  FN 0: Q37 = +Q141
175  FN 0: Q38 = +Q142
176  L Z+Q260 R0 FQ59
177  FN 24: Q30 = CDATA Q31
178  ; ** GERADENGLEICHUNGEN 
179  Q40 = Q20 - Q1   ; A 
180  Q41 = Q21 - Q2   ; B 
181  Q42 = Q30 - Q10   ; C 
182  Q43 = Q31 - Q11   ; D 
183  Q44 = Q40 / Q41   ; E 
184  Q45 = Q42 / Q43   ; F 
185  Q46 = (Q10 - Q1 + (Q2 * Q44) - (Q45 * Q11)) / (Q44 - Q45)  
186  Q47 = Q1 + ((Q20 - Q1) * ((Q46 - Q2) / (Q21 - Q2)))  
187  Q45 = Q46  
188  Q46 = Q47  
189  Q47 = Q45  
190  FN 11: IF +Q305 GT +0 GOTO LBL 35
191  CALL LBL 55
192  FN 9: IF +Q109 EQU +0 GOTO LBL 30
193  FN 9: IF +Q109 EQU +6 GOTO LBL 30
194  FN 9: IF +Q109 EQU +1 GOTO LBL 31
195  FN 9: IF +Q109 EQU +7 GOTO LBL 31
196  FN 9: IF +Q109 EQU +2 GOTO LBL 32
197  FN 9: IF +Q109 EQU +8 GOTO LBL 32
198  LBL 30
199  FN 25: PRESET = Y /+Q46 /+Q22
200  FN 25: PRESET = Z /+Q47 /+Q23
201  FN 9: IF +0 EQU +0 GOTO LBL 99
202  LBL 31
203  FN 25: PRESET = Z /+Q46 /+Q22
204  FN 25: PRESET = X /+Q47 /+Q23
205  FN 9: IF +0 EQU +0 GOTO LBL 99
206  LBL 32
207  FN 25: PRESET = X /+Q46 /+Q22
208  FN 25: PRESET = Y /+Q47 /+Q23
209  FN 9: IF +0 EQU +0 GOTO LBL 99
210  LBL 35
211  CALL LBL 50
212  FN 18: SYSREAD Q4 = ID1000 NR7475
213  FN 9: IF +Q4 EQU +0 GOTO LBL 38
214  Q46 = Q46 + Q19 - Q331  
215  Q47 = Q47 + Q29 - Q332  
216  FN 9: IF +0 EQU +0 GOTO LBL 39
217  LBL 38
218  Q46 = Q46 - Q331  
219  Q47 = Q47 - Q332  
220  LBL 39
221  FN 9: IF +Q109 EQU +0 GOTO LBL 40
222  FN 9: IF +Q109 EQU +6 GOTO LBL 40
223  FN 9: IF +Q109 EQU +1 GOTO LBL 41
224  FN 9: IF +Q109 EQU +7 GOTO LBL 41
225  FN 9: IF +Q109 EQU +2 GOTO LBL 42
226  FN 9: IF +Q109 EQU +8 GOTO LBL 42
227  LBL 40
228  ; FN 17: SYSWRITE ID500 NRQ305 IDX2 = +Q46 
229  ; FN 17: SYSWRITE ID500 NRQ305 IDX3 = +Q47 
230  ; FN 9: IF +0 EQU +0 GOTO LBL 99 
231  ; LBL 41 
232  ; FN 17: SYSWRITE ID500 NRQ305 IDX3 = +Q46 
233  ; FN 17: SYSWRITE ID500 NRQ305 IDX1 = +Q47 
234  ; FN 9: IF +0 EQU +0 GOTO LBL 99 
235  ; LBL 42 
236  ; FN 17: SYSWRITE ID500 NRQ305 IDX1 = +Q46 
237  ; FN 17: SYSWRITE ID500 NRQ305 IDX2 = +Q47 
238  FN 18: SYSREAD Q4 = ID1000 NR7475
239  FN 9: IF +Q4 EQU +0 GOTO LBL 196
240  Q60 = Q261  
241  Q61 = Q46  
242  Q62 = Q47  
243  CALL LBL 110
244  Q2 = 2  
245  CALL LBL 111
246  Q1 = Q4  
247  Q2 = Q3  
248  CALL LBL 112
249  FN 17: SYSWRITE ID501 NRQ305 IDXQ2 = +Q1
250  Q2 = 3  
251  CALL LBL 111
252  Q1 = Q4  
253  Q2 = Q3  
254  CALL LBL 112
255  FN 17: SYSWRITE ID501 NRQ305 IDXQ2 = +Q1
256  FN 9: IF +0 EQU +0 GOTO LBL 99
257  LBL 196
258  FN 17: SYSWRITE ID501 NRQ305 IDX2 = +Q46
259  FN 17: SYSWRITE ID501 NRQ305 IDX3 = +Q47
260  FN 9: IF +0 EQU +0 GOTO LBL 99
261  LBL 41
262  FN 18: SYSREAD Q4 = ID1000 NR7475
263  FN 9: IF +Q4 EQU +0 GOTO LBL 197
264  Q60 = Q47  
265  Q61 = Q261  
266  Q62 = Q46  
267  CALL LBL 110
268  Q2 = 3  
269  CALL LBL 111
270  Q1 = Q4  
271  Q2 = Q3  
272  CALL LBL 112
273  FN 17: SYSWRITE ID501 NRQ305 IDXQ2 = +Q1
274  Q2 = 1  
275  CALL LBL 111
276  Q1 = Q4  
277  Q2 = Q3  
278  CALL LBL 112
279  FN 17: SYSWRITE ID501 NRQ305 IDXQ2 = +Q1
280  FN 9: IF +0 EQU +0 GOTO LBL 99
281  LBL 197
282  FN 17: SYSWRITE ID501 NRQ305 IDX3 = +Q46
283  FN 17: SYSWRITE ID501 NRQ305 IDX1 = +Q47
284  FN 9: IF +0 EQU +0 GOTO LBL 99
285  LBL 42
286  FN 18: SYSREAD Q4 = ID1000 NR7475
287  FN 9: IF +Q4 EQU +0 GOTO LBL 198
288  Q60 = Q46  
289  Q61 = Q47  
290  Q62 = Q261  
291  CALL LBL 110
292  Q2 = 1  
293  CALL LBL 111
294  Q1 = Q4  
295  Q2 = Q3  
296  CALL LBL 112
297  FN 17: SYSWRITE ID501 NRQ305 IDXQ2 = +Q1
298  Q2 = 2  
299  CALL LBL 111
300  Q1 = Q4  
301  Q2 = Q3  
302  CALL LBL 112
303  FN 17: SYSWRITE ID501 NRQ305 IDXQ2 = +Q1
304  FN 9: IF +0 EQU +0 GOTO LBL 99
305  LBL 198
306  FN 17: SYSWRITE ID501 NRQ305 IDX1 = +Q46
307  FN 17: SYSWRITE ID501 NRQ305 IDX2 = +Q47
308  LBL 99
309  FN 17: SYSWRITE ID990 NR1 = +0
310  FN 17: SYSWRITE ID990 NR2 = +0
311  FN 9: IF +0 EQU +0 GOTO LBL 254
312  LBL 50
313  Q22 = (Q39 * COS Q51) + (Q49 * SIN Q51)  
314  Q23 = -(Q39 * SIN Q51) + (Q49 * COS Q51)  
315  Q46 = Q46 + Q22  
316  Q47 = Q47 + Q23  
317  LBL 0
318  LBL 55
319  Q22 = (Q331 * COS -Q51) + (Q332 * SIN -Q51)  
320  Q23 = -(Q331 * SIN -Q51) + (Q332 * COS -Q51)  
321  Q55 = (Q46 * COS -Q51) + (Q47 * SIN -Q51)  
322  Q56 = -(Q46 * SIN -Q51) + (Q47 * COS -Q51)  
323  Q46 = Q55  
324  Q47 = Q56  
325  LBL 0
326  LBL 110
327  FN 17: SYSWRITE ID990 NR5 IDX4 = +60
328  LBL 0
329  LBL 111
330  Q5 = Q2 - 1  
331  FN 17: SYSWRITE ID990 NR5 IDX5 = +5
332  FN 9: IF +Q6 EQU +0 GOTO LBL 113
333  FN 9: IF +Q6 EQU +1 GOTO LBL 114
334  FN 9: IF +Q6 EQU +2 GOTO LBL 115
335  FN 14: ERROR = 1013
336  LBL 113
337  Q3 = Q6 + 1  
338  Q4 = Q63  
339  FN 9: IF +0 EQU +0 GOTO LBL 116
340  LBL 114
341  Q3 = Q6 + 1  
342  Q4 = Q64  
343  FN 9: IF +0 EQU +0 GOTO LBL 116
344  LBL 115
345  Q3 = Q6 + 1  
346  Q4 = Q65  
347  LBL 116
348  LBL 0
349  LBL 112
350  FN 18: SYSREAD Q66 = ID220 NR3 IDXQ2
351  ;FN 18: SYSREAD Q67 = ID220 NR4 IDXQ2
352  Q1 = Q1 - Q66  
353  LBL 0
354  LBL 253
355  FN 9: IF +Q109 EQU +0 GOTO LBL 230
356  FN 9: IF +Q109 EQU +6 GOTO LBL 230
357  FN 9: IF +Q109 EQU +1 GOTO LBL 231
358  FN 9: IF +Q109 EQU +7 GOTO LBL 231
359  FN 9: IF +Q109 EQU +2 GOTO LBL 232
360  FN 9: IF +Q109 EQU +8 GOTO LBL 232
361  LBL 230
362  FN 0: Q141 = +Q115
363  FN 0: Q142 = +Q116
364  FN 0: Q143 = +Q117
365  FN 17: SYSWRITE ID990 NR5 IDX1 = +141
366  FN 0: Q141 = +Q145
367  FN 0: Q142 = +Q146
368  FN 17: SYSWRITE ID990 NR4 IDX1 = +141
369  FN 0: Q141 = +Q143
370  FN 0: Q142 = +Q144
371  FN 18: SYSREAD Q19 = ID220 NR4 IDX2
372  FN 18: SYSREAD Q29 = ID220 NR4 IDX3
373  FN 18: SYSREAD Q39 = ID220 NR2 IDX2
374  FN 18: SYSREAD Q49 = ID220 NR2 IDX3
375  FN 9: IF +0 EQU +0 GOTO LBL 233
376  LBL 231
377  FN 0: Q141 = +Q115
378  FN 0: Q142 = +Q116
379  FN 0: Q143 = +Q117
380  FN 17: SYSWRITE ID990 NR5 IDX1 = +141
381  FN 0: Q141 = +Q146
382  FN 0: Q142 = +Q144
383  FN 17: SYSWRITE ID990 NR4 IDX1 = +141
384  FN 0: Q141 = +Q143
385  FN 0: Q142 = +Q144
386  FN 18: SYSREAD Q19 = ID220 NR4 IDX3
387  FN 18: SYSREAD Q29 = ID220 NR4 IDX1
388  FN 18: SYSREAD Q39 = ID220 NR2 IDX3
389  FN 18: SYSREAD Q49 = ID220 NR2 IDX1
390  FN 9: IF +0 EQU +0 GOTO LBL 233
391  LBL 232
392  FN 0: Q141 = +Q115
393  FN 0: Q142 = +Q116
394  FN 0: Q143 = +Q117
395  FN 17: SYSWRITE ID990 NR5 IDX1 = +141
396  FN 0: Q141 = +Q144
397  FN 0: Q142 = +Q145
398  FN 17: SYSWRITE ID990 NR4 IDX1 = +141
399  FN 0: Q141 = +Q143
400  FN 0: Q142 = +Q144
401  FN 18: SYSREAD Q19 = ID220 NR4 IDX1
402  FN 18: SYSREAD Q29 = ID220 NR4 IDX2
403  FN 18: SYSREAD Q39 = ID220 NR2 IDX1
404  FN 18: SYSREAD Q49 = ID220 NR2 IDX2
405  LBL 233
406  LBL 0
407  LBL 254
408  END PGM 418 MM
