0  BEGIN PGM 431 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  Q281 = ABS Q281  
7  FN 10: IF +Q109 NE -1 GOTO LBL 100
8  FN 14: ERROR = 1001
9  LBL 100
10  FN 18: SYSREAD Q0 = ID210 NR3
11  FN 9: IF +Q0 EQU +0 GOTO LBL 101
12  FN 14: ERROR = 1008
13  LBL 101
14  FN 18: SYSREAD Q0 = ID210 NR4 IDX1
15  FN 18: SYSREAD Q1 = ID210 NR4 IDX2
16  FN 18: SYSREAD Q2 = ID210 NR4 IDX3
17  Q0 = Q0 + Q1 + Q2  
18  FN 9: IF +Q0 EQU +3 GOTO LBL 102
19  FN 14: ERROR = 1007
20  LBL 102
21  FN 17: SYSWRITE ID212 = +3
22  FN 17: SYSWRITE ID990 NR1 = +1
23  FN 17: SYSWRITE ID990 NR2 = +1
24  FN 18: SYSREAD Q3 = ID1000 NR6140
25  FN 18: SYSREAD Q1 = ID1010 NR6200
26  FN 9: IF +Q1 EQU +0 GOTO LBL 13
27  FN 18: SYSREAD Q1 = ID1000 NR6200
28  FN 9: IF +Q1 EQU +1 GOTO LBL 10
29  LBL 13
30  FN 18: SYSREAD Q58 = ID1000 NR6120
31  FN 18: SYSREAD Q59 = ID1000 NR6150
32  FN 18: SYSREAD Q2 = ID350 NR11
33  FN 9: IF +0 EQU +0 GOTO LBL 11
34  LBL 10
35  FN 18: SYSREAD Q58 = ID1000 NR6360
36  FN 18: SYSREAD Q59 = ID1000 NR6361
37  FN 18: SYSREAD Q2 = ID350 NR31
38  LBL 11
39  FN 18: SYSREAD Q0 = ID1000 NR7411
40  ; Q0 = 2 * FRAC (Q0 / 2)  
41  FN 9: IF +Q0 EQU +0 GOTO LBL 14
42  FN 18: SYSREAD Q2 = ID200 NR1
43  Q2 = ABS Q2  
44  LBL 14
45  FN 10: IF +Q0 NE +0 GOTO LBL 15
46  FN 17: SYSWRITE ID990 NR3 = +1
47  LBL 15
48  ; ** 1. Messung ************** 
49  Q294 = Q294 + Q320  
50  Q295 = Q295 + Q320  
51  Q298 = Q298 + Q320  
52  FN 1: Q1 = +Q109 + +1
53  FN 18: SYSREAD Q0 = ID270 NR1 IDXQ1
54  FN 11: IF +Q0 GT +Q260 GOTO LBL 120
55  L Z+Q260 R0 FQ59
56  LBL 120
57  L X+Q263 Y+Q264 R0 FQ59
58  TCH PROBE 0.0 BEZUGSEBENE Q1 Z-
59  TCH PROBE 0.1 Z+Q294
60  L Z+Q260 R0 FQ59
61  L X+Q265 Y+Q266 R0 FQ59
62  TCH PROBE 0.0 BEZUGSEBENE Q2 Z-
63  TCH PROBE 0.1 Z+Q295
64  L Z+Q260 R0 FQ59
65  L X+Q296 Y+Q297 R0 FQ59
66  TCH PROBE 0.0 BEZUGSEBENE Q3 Z-
67  TCH PROBE 0.1 Z+Q298
68  L Z+Q260 R0 FQ59
69  ; *** KONSTANEN BERECHNEN ***** 
70  Q11 = Q266 * Q3 - Q264 * Q3 - Q266 * Q1  
71  Q11 = Q11 - Q297 * Q2 + Q264 * Q2 + Q297 * Q1  
72  Q12 = Q296 * Q2 - Q296 * Q1 - Q263 * Q2  
73  Q12 = Q12 - Q265 * Q3 + Q265 * Q1 + Q263 * Q3  
74  Q13 = Q265 * Q297 - Q263 * Q297 - Q265 * Q264  
75  Q13 = Q13 - Q296 * Q266 + Q263 * Q266 + Q296 * Q264  
76  ; WINKEL BERECHNEN 
77  Q159 = ATAN (Q11 / Q13)  
78  Q158 = -ATAN (Q12 / Q13)  
79  ; RAUMWINKELBERECHNUNG  
80  Q20 = (SQ (Q265 - Q263) + SQ (Q266 - Q264) + SQ (Q2 - Q1))  
81  Q20 = (Q265 - Q263) / SQRT Q20  
82  Q21 = (SQ (Q265 - Q263) + SQ (Q266 - Q264) + SQ (Q2 - Q1))  
83  Q21 = (Q266 - Q264) / SQRT Q21  
84  Q22 = (SQ (Q265 - Q263) + SQ (Q266 - Q264) + SQ (Q2 - Q1))  
85  Q22 = (Q2 - Q1) / SQRT Q22  
86  Q27 = ASIN (-Q22)  
87  Q28 = ACOS (Q20 / (COS Q27))  
88  FN 12: IF +Q21 LT +0 GOTO LBL 1
89  FN 9: IF +0 EQU +0 GOTO LBL 2
90  LBL 1
91  FN 3: Q28 = +Q28 * -1
92  LBL 2
93  Q23 = (Q266 - Q264) * (Q3 - Q1) - (Q2 - Q1) * (Q297 - Q264)  
94  Q24 = (Q2 - Q1) * (Q296 - Q263) - (Q265 - Q263) * (Q3 - Q1)  
95  Q25 = (Q265 - Q263) * (Q297 - Q264) - (Q266 - Q264) * (Q296 - Q263)  
96  Q30 = SQRT (SQ Q23 + SQ Q24 + SQ Q25)  
97  Q31 = Q25 / Q30  
98  Q26 = ACOS (Q31 / (COS Q27))  
99  Q32 = Q23 * SIN (-Q28) + Q24 * COS (-Q28)  
100  FN 9: IF +Q32 EQU +0 GOTO LBL 4
101  FN 12: IF +Q32 LT +0 GOTO LBL 4
102  FN 3: Q26 = +Q26 * -1
103  LBL 4
104  FN 0: Q170 = +Q26
105  FN 0: Q171 = +Q27
106  FN 0: Q172 = +Q28
107  ; ENDE RAUMWINKEL   
108  FN 10: IF +Q113 NE +1 GOTO LBL 170
109  Q1 = Q1 / 25.4  
110  Q2 = Q2 / 25.4  
111  Q3 = Q3 / 25.4  
112  Q263 = Q263 / 25.4  
113  Q264 = Q264 / 25.4  
114  Q265 = Q265 / 25.4  
115  Q266 = Q266 / 25.4  
116  Q296 = Q296 / 25.4  
117  Q297 = Q297 / 25.4  
118  LBL 170
119  FN 10: IF +Q281 NE +1 GOTO LBL 198
120  FN 16: F-PRINT 431PROT  / TCHPR431.TXT 
121  LBL 198
122  FN 17: SYSWRITE ID990 NR1 = +0
123  FN 17: SYSWRITE ID990 NR2 = +0
124  FN 10: IF +Q113 NE +1 GOTO LBL 171
125  Q263 = Q263 * 25.4  
126  Q264 = Q264 * 25.4  
127  Q265 = Q265 * 25.4  
128  Q266 = Q266 * 25.4  
129  Q296 = Q296 * 25.4  
130  Q297 = Q297 * 25.4  
131  LBL 171
132  LBL 254
133  END PGM 431 MM
