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