0  BEGIN PGM 420 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  Q272 = ABS Q272  
7  Q301 = ABS Q301  
8  Q281 = ABS Q281  
9  FN 10: IF +Q109 NE -1 GOTO LBL 7
10  FN 14: ERROR = 1001
11  LBL 7
12  FN 18: SYSREAD Q0 = ID210 NR3
13  FN 9: IF +Q0 EQU +0 GOTO LBL 103
14  FN 14: ERROR = 1008
15  LBL 103
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 104
21  FN 14: ERROR = 1007
22  LBL 104
23  FN 17: SYSWRITE ID212 = +3
24  FN 17: SYSWRITE ID990 NR1 = +1
25  FN 17: SYSWRITE ID990 NR2 = +1
26  FN 18: SYSREAD Q3 = ID1000 NR6140 IDX0
27  FN 18: SYSREAD Q1 = ID1010 NR6200
28  FN 9: IF +Q1 EQU +0 GOTO LBL 13
29  FN 18: SYSREAD Q1 = ID1000 NR6200
30  FN 9: IF +Q1 EQU +1 GOTO LBL 10
31  LBL 13
32  FN 18: SYSREAD Q58 = ID1000 NR6120
33  FN 18: SYSREAD Q59 = ID1000 NR6150
34  FN 18: SYSREAD Q2 = ID350 NR11
35  FN 9: IF +0 EQU +0 GOTO LBL 11
36  LBL 10
37  FN 18: SYSREAD Q58 = ID1000 NR6360
38  FN 18: SYSREAD Q59 = ID1000 NR6361
39  FN 18: SYSREAD Q2 = ID350 NR31
40  LBL 11
41  FN 18: SYSREAD Q0 = ID1000 NR7411
42  ; Q0 = 2 * FRAC (Q0 / 2)  
43  FN 9: IF +Q0 EQU +0 GOTO LBL 14
44  FN 18: SYSREAD Q2 = ID200 NR1
45  Q2 = ABS Q2  
46  LBL 14
47  FN 10: IF +Q0 NE +0 GOTO LBL 15
48  FN 17: SYSWRITE ID990 NR3 = +1
49  LBL 15
50  Q320 = Q320 + Q2 + Q3  
51  FN 10: IF +Q267 NE +0 GOTO LBL 12
52  FN 14: ERROR = 1042
53  LBL 12
54  ; ** Y-RICHTUNG ************** 
55  FN 12: IF +Q261 LT +Q260 GOTO LBL 130
56  FN 0: Q260 = +Q261
57  LBL 130
58  FN 1: Q1 = +Q109 + +1
59  FN 18: SYSREAD Q0 = ID270 NR1 IDXQ1
60  FN 11: IF +Q0 GT +Q260 GOTO LBL 120
61  L Z+Q260 R0 FQ59
62  LBL 120
63  FN 9: IF +Q272 EQU +1 GOTO LBL 21
64  FN 9: IF +Q272 EQU +3 GOTO LBL 23
65  FN 9: IF +Q267 EQU -1 GOTO LBL 20
66  FN 2: Q22 = +Q264 - +Q320
67  FN 2: Q32 = +Q266 - +Q320
68  L X+Q263 Y+Q22 R0 FQ59
69  TCH PROBE 0.0 BEZUGSEBENE Q4 Y+
70  TCH PROBE 0.1 Z+Q261
71  FN 9: IF +Q301 EQU +0 GOTO LBL 1
72  L Z+Q260 FQ59
73  LBL 1
74  L X+Q265 Y+Q32 FQ59
75  TCH PROBE 0.0 BEZUGSEBENE Q5 Y+
76  TCH PROBE 0.1 Z+Q261
77  FN 9: IF +0 EQU +0 GOTO LBL 92
78  LBL 20
79  FN 1: Q22 = +Q264 + +Q320
80  FN 1: Q32 = +Q266 + +Q320
81  L X+Q263 Y+Q22 R0 FQ59
82  TCH PROBE 0.0 BEZUGSEBENE Q4 Y-
83  TCH PROBE 0.1 Z+Q261
84  FN 9: IF +Q301 EQU +0 GOTO LBL 2
85  L Z+Q260 FQ59
86  LBL 2
87  L X+Q265 Y+Q32 FQ59
88  TCH PROBE 0.0 BEZUGSEBENE Q5 Y-
89  TCH PROBE 0.1 Z+Q261
90  FN 9: IF +0 EQU +0 GOTO LBL 92
91  LBL 21
92  ; ** X-RICHTUNG *************** 
93  FN 9: IF +Q267 EQU -1 GOTO LBL 22
94  FN 2: Q21 = +Q263 - +Q320
95  FN 2: Q31 = +Q265 - +Q320
96  L X+Q21 Y+Q264 R0 FQ59
97  TCH PROBE 0.0 BEZUGSEBENE Q4 X+
98  TCH PROBE 0.1 Z+Q261
99  FN 9: IF +Q301 EQU +0 GOTO LBL 3
100  L Z+Q260 FQ59
101  LBL 3
102  L X+Q31 Y+Q266 FQ59
103  TCH PROBE 0.0 BEZUGSEBENE Q5 X+
104  TCH PROBE 0.1 Z+Q261
105  FN 9: IF +0 EQU +0 GOTO LBL 91
106  LBL 22
107  FN 1: Q21 = +Q263 + +Q320
108  FN 1: Q31 = +Q265 + +Q320
109  L X+Q21 Y+Q264 R0 FQ59
110  TCH PROBE 0.0 BEZUGSEBENE Q4 X-
111  TCH PROBE 0.1 Z+Q261
112  FN 9: IF +Q301 EQU +0 GOTO LBL 4
113  L Z+Q260 FQ59
114  LBL 4
115  L X+Q31 Y+Q266 FQ59
116  TCH PROBE 0.0 BEZUGSEBENE Q5 X-
117  TCH PROBE 0.1 Z+Q261
118  FN 9: IF +0 EQU +0 GOTO LBL 91
119  ; *** Z-RICHTUNG ************* 
120  LBL 23
121  FN 9: IF +Q267 EQU -1 GOTO LBL 24
122  Q29 = Q261 - Q320  
123  L X+Q263 Y+Q264 R0 FQ59
124  L Z+Q29 R0 FQ59
125  TCH PROBE 0.0 BEZUGSEBENE Q4 Z+
126  TCH PROBE 0.1 Z+Q261
127  FN 9: IF +Q301 EQU +0 GOTO LBL 5
128  L Z+Q260 FQ59
129  L X+Q265 Y+Q266 FQ59
130  L Z+Q29 R0 FQ59
131  LBL 5
132  L X+Q265 Y+Q266 FQ59
133  TCH PROBE 0.0 BEZUGSEBENE Q5 Z+
134  TCH PROBE 0.1 Z+Q261
135  FN 9: IF +0 EQU +0 GOTO LBL 93
136  LBL 24
137  Q29 = Q261 + Q320  
138  L X+Q263 Y+Q264 R0 FQ59
139  L Z+Q29 R0 FQ59
140  TCH PROBE 0.0 BEZUGSEBENE Q4 Z-
141  TCH PROBE 0.1 Z+Q261
142  FN 9: IF +Q301 EQU +0 GOTO LBL 6
143  L Z+Q260 FQ59
144  L X+Q265 Y+Q266 FQ59
145  L Z+Q29 R0 FQ59
146  LBL 6
147  L X+Q265 Y+Q266 FQ59
148  TCH PROBE 0.0 BEZUGSEBENE Q5 Z-
149  TCH PROBE 0.1 Z+Q261
150  FN 9: IF +0 EQU +0 GOTO LBL 93
151  LBL 91
152  Q150 = ATAN ((Q264 - Q266) / (Q4 - Q5))  
153  FN 9: IF +0 EQU +0 GOTO LBL 99
154  LBL 92
155  Q150 = ATAN ((Q5 - Q4) / (Q265 - Q263))  
156  FN 9: IF +0 EQU +0 GOTO LBL 99
157  LBL 93
158  FN 10: IF +Q263 NE +Q265 GOTO LBL 95
159  FN 9: IF +Q109 EQU +1 GOTO LBL 96
160  Q150 = ATAN ((Q264 - Q266) / (Q4 - Q5))  
161  FN 11: IF +Q150 GT +0 GOTO LBL 94
162  Q150 = -(Q150 + 90)  
163  FN 9: IF +0 EQU +0 GOTO LBL 99
164  LBL 94
165  Q150 = (90 - Q150)  
166  FN 9: IF +0 EQU +0 GOTO LBL 99
167  LBL 95
168  Q150 = -ATAN ((Q5 - Q4) / (Q265 - Q263))  
169  FN 9: IF +0 EQU +0 GOTO LBL 99
170  LBL 96
171  Q150 = ATAN ((Q5 - Q4) / (Q266 - Q264))  
172  LBL 99
173  L Z+Q260 R0 FQ59
174  FN 10: IF +Q113 NE +1 GOTO LBL 170
175  Q4 = Q4 / 25.4  
176  Q5 = Q5 / 25.4  
177  Q263 = Q263 / 25.4  
178  Q264 = Q264 / 25.4  
179  Q265 = Q265 / 25.4  
180  Q266 = Q266 / 25.4  
181  Q261 = Q261 / 25.4  
182  LBL 170
183  FN 10: IF +Q281 NE +1 GOTO LBL 102
184  FN 10: IF +Q272 NE +1 GOTO LBL 100
185  FN 16: F-PRINT 420PROT1  / TCHPR420.TXT 
186  FN 9: IF +0 EQU +0 GOTO LBL 102
187  LBL 100
188  FN 10: IF +Q272 NE +2 GOTO LBL 101
189  FN 16: F-PRINT 420PROT2  / TCHPR420.TXT 
190  FN 9: IF +0 EQU +0 GOTO LBL 102
191  LBL 101
192  FN 16: F-PRINT 420PROT3  / TCHPR420.TXT 
193  LBL 102
194  FN 17: SYSWRITE ID990 NR1 = +0
195  FN 17: SYSWRITE ID990 NR2 = +0
196  FN 10: IF +Q113 NE +1 GOTO LBL 254
197  Q263 = Q263 * 25.4  
198  Q264 = Q264 * 25.4  
199  Q265 = Q265 * 25.4  
200  Q266 = Q266 * 25.4  
201  Q261 = Q261 * 25.4  
202  LBL 254
203  END PGM 420 MM
