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