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