0  BEGIN PGM 401 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  FN 10: IF +Q109 NE -1 GOTO LBL 100
6  FN 14: ERROR = 1001
7  LBL 100
8  FN 18: SYSREAD Q0 = ID210 NR3
9  FN 9: IF +Q0 EQU +0 GOTO LBL 101
10  FN 14: ERROR = 1008
11  LBL 101
12  FN 18: SYSREAD Q0 = ID210 NR4 IDX1
13  FN 18: SYSREAD Q1 = ID210 NR4 IDX2
14  FN 18: SYSREAD Q2 = ID210 NR4 IDX3
15  Q0 = Q0 + Q1 + Q2  
16  FN 9: IF +Q0 EQU +3 GOTO LBL 102
17  FN 14: ERROR = 1007
18  LBL 102
19  FN 18: SYSREAD Q0 = ID210 NR6
20  FN 10: IF +Q0 NE -1 GOTO LBL 103
21  FN 14: ERROR = 1006
22  LBL 103
23  FN 17: SYSWRITE ID212 = +3
24  FN 17: SYSWRITE ID990 NR1 = +1
25  FN 17: SYSWRITE ID990 NR2 = +1
26  FN 17: SYSWRITE ID210 NR1 = +0
27  FN 18: SYSREAD Q3 = ID1000 NR6140
28  FN 18: SYSREAD Q1 = ID1010 NR6200
29  FN 9: IF +Q1 EQU +0 GOTO LBL 13
30  FN 18: SYSREAD Q1 = ID1000 NR6200
31  FN 9: IF +Q1 EQU +1 GOTO LBL 10
32  LBL 13
33  FN 18: SYSREAD Q2 = ID350 NR11
34  FN 18: SYSREAD Q58 = ID1000 NR6120
35  FN 18: SYSREAD Q59 = ID1000 NR6150
36  FN 9: IF +0 EQU +0 GOTO LBL 11
37  LBL 10
38  FN 18: SYSREAD Q2 = ID350 NR31
39  FN 18: SYSREAD Q58 = ID1000 NR6360
40  FN 18: SYSREAD Q59 = ID1000 NR6361
41  LBL 11
42  FN 18: SYSREAD Q0 = ID1000 NR7411
43  ; Q0 = 2 * FRAC (Q0 / 2)  
44  FN 9: IF +Q0 EQU +0 GOTO LBL 14
45  FN 18: SYSREAD Q2 = ID200 NR1
46  Q2 = ABS Q2  
47  LBL 14
48  FN 10: IF +Q0 NE +0 GOTO LBL 15
49  FN 17: SYSWRITE ID990 NR3 = +1
50  LBL 15
51  ; ** 1. BOHRUNG ************* 
52  FN 12: IF +Q261 LT +Q260 GOTO LBL 130
53  FN 14: ERROR = 1016
54  LBL 130
55  FN 1: Q1 = +Q109 + +1
56  FN 18: SYSREAD Q0 = ID270 NR1 IDXQ1
57  FN 11: IF +Q0 GT +Q260 GOTO LBL 120
58  L Z+Q260 R0 FQ59
59  LBL 120
60  L X+Q268 Y+Q269 R0 FQ59
61  TCH PROBE 0.0 BEZUGSEBENE Q0 Y+
62  TCH PROBE 0.1 Z+Q261
63  CALL LBL 253
64  FN 0: Q1 = +Q141
65  FN 0: Q2 = +Q142
66  TCH PROBE 0.0 BEZUGSEBENE Q0 X+
67  TCH PROBE 0.1 Z+Q261
68  CALL LBL 253
69  FN 0: Q3 = +Q141
70  FN 0: Q4 = +Q142
71  TCH PROBE 0.0 BEZUGSEBENE Q0 Y-
72  TCH PROBE 0.1 Z+Q261
73  CALL LBL 253
74  FN 0: Q5 = +Q141
75  FN 0: Q6 = +Q142
76  TCH PROBE 0.0 BEZUGSEBENE Q0 X-
77  TCH PROBE 0.1 Z+Q261
78  CALL LBL 253
79  FN 0: Q7 = +Q141
80  FN 0: Q8 = +Q142
81  L Z+Q260 R0 FQ59
82  ; ** 2. BOHRUNG *************** 
83  L X+Q270 Y+Q271 R0 FQ59
84  TCH PROBE 0.0 BEZUGSEBENE Q0 Y+
85  TCH PROBE 0.1 Z+Q261
86  CALL LBL 253
87  FN 0: Q11 = +Q141
88  FN 0: Q12 = +Q142
89  TCH PROBE 0.0 BEZUGSEBENE Q0 X+
90  TCH PROBE 0.1 Z+Q261
91  CALL LBL 253
92  FN 0: Q13 = +Q141
93  FN 0: Q14 = +Q142
94  TCH PROBE 0.0 BEZUGSEBENE Q0 Y-
95  TCH PROBE 0.1 Z+Q261
96  CALL LBL 253
97  FN 0: Q15 = +Q141
98  FN 0: Q16 = +Q142
99  TCH PROBE 0.0 BEZUGSEBENE Q0 X-
100  TCH PROBE 0.1 Z+Q261
101  CALL LBL 253
102  FN 0: Q17 = +Q141
103  FN 0: Q18 = +Q142
104  L Z+Q260 R0 FQ59
105  FN 24: Q21 = CDATA Q1
106  FN 24: Q31 = CDATA Q11
107  Q41 = Q31 - Q21  
108  Q42 = Q32 - Q22  
109  FN 13: Q50 = +Q42 ANG+Q41
110  FN 12: IF +Q50 LT +90 GOTO LBL 31
111  FN 9: IF +Q50 EQU +90 GOTO LBL 31
112  FN 11: IF +Q50 GT +270 GOTO LBL 30
113  FN 9: IF +Q50 EQU +270 GOTO LBL 30
114  Q50 = Q50 - 180  
115  FN 9: IF +0 EQU +0 GOTO LBL 31
116  LBL 30
117  Q50 = Q50 - 360  
118  LBL 31
119  Q50 = Q50 - Q307  
120  FN 11: IF +Q50 GT +0 GOTO LBL 41
121  FN 11: IF +Q50 GT -360.0001 GOTO LBL 42
122  Q50 = Q50 + 360  
123  FN 9: IF +0 EQU +0 GOTO LBL 42
124  LBL 41
125  FN 12: IF +Q50 LT +360.0001 GOTO LBL 42
126  Q50 = Q50 - 360  
127  LBL 42
128  FN 11: IF +Q50 GT +0 GOTO LBL 50
129  FN 11: IF +Q50 GT -90.0001 GOTO LBL 98
130  FN 11: IF +Q50 GT -270.0001 GOTO LBL 43
131  Q50 = Q50 + 360  
132  FN 9: IF +0 EQU +0 GOTO LBL 98
133  LBL 43
134  Q50 = Q50 + 180  
135  FN 9: IF +0 EQU +0 GOTO LBL 98
136  LBL 50
137  FN 12: IF +Q50 LT +90.0001 GOTO LBL 98
138  FN 12: IF +Q50 LT +270.0001 GOTO LBL 44
139  Q50 = Q50 - 360  
140  FN 9: IF +0 EQU +0 GOTO LBL 98
141  LBL 44
142  Q50 = Q50 - 180  
143  LBL 98
144  FN 17: SYSWRITE ID210 NR1 = +Q50
145  FN 17: SYSWRITE ID990 NR1 = +0
146  FN 17: SYSWRITE ID990 NR2 = +0
147  FN 9: IF +0 EQU +0 GOTO LBL 254
148  LBL 253
149  FN 9: IF +Q109 EQU +0 GOTO LBL 230
150  FN 9: IF +Q109 EQU +6 GOTO LBL 230
151  FN 9: IF +Q109 EQU +1 GOTO LBL 231
152  FN 9: IF +Q109 EQU +7 GOTO LBL 231
153  FN 9: IF +Q109 EQU +2 GOTO LBL 232
154  FN 9: IF +Q109 EQU +8 GOTO LBL 232
155  LBL 230
156  FN 0: Q141 = +Q116
157  FN 0: Q142 = +Q117
158  FN 9: IF +0 EQU +0 GOTO LBL 233
159  LBL 231
160  FN 0: Q141 = +Q117
161  FN 0: Q142 = +Q115
162  FN 9: IF +0 EQU +0 GOTO LBL 233
163  LBL 232
164  FN 0: Q141 = +Q115
165  FN 0: Q142 = +Q116
166  LBL 233
167  LBL 0
168  LBL 254
169  END PGM 401 MM
