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