0 BEGIN PGM 8170-it MM 
1 ;Determinazione del centro di un foro
2 ;con tre punti di misura e impostazione
3 ;dell'origine X/Y nel centro.
4 ;Per iTNC 530 e TNC 426 possibile da
5 ;versione software 280 472 XX
6 ;
7 BLK FORM 0.1 Z  X+0  Y+0  Z-50
8 BLK FORM 0.2  X+50  Y+50  Z+0
9 ;
10 ;Chiamata utensile tastatore
11 TOOL CALL 501 Z
12 ;
13 ;Immissione parametri
14 FN 0: Q30 =+25 ;CENTRO FORO IN ASSE X
15 FN 0: Q31 =+25 ;CENTRO FORO IN ASSE Y
16 FN 0: Q32 =-5 ;ALTEZZA DI MISURA ! CENTRO STILO A SFERA !
17 FN 0: Q33 =+40 ;DIAMETRO FORO
18 FN 0: Q34 =+0 ;ANGOLO 1. PUNTO DI TASTATURA ! POSITIVO !
19 FN 0: Q35 =+120 ;ANGOLO 2. PUNTO DI TASTATURA ! POSITIVO !
20 FN 0: Q36 =+240 ;ANGOLO 3. PUNTO DI TASTATURA ! POSITIVO !
21 FN 0: Q37 =+5 ;DISTANZA DI SICUREZZA SUPPLEMENTARE IN DIREZIONE DI TASTATURA MP6140!
22 FN 0: Q38 =+20 ;ALTEZZA DI SICUREZZA ! ASSOLUTO !
23 FN 0: Q60 =+0 ;NUOVA ORIGINE ASSE X
24 FN 0: Q61 =+0 ;NUOVA ORIGINE ASSE Y
25 ;Fine immissione!
26 ;
27 ;Decisione se 1. angolo deve essere convertito
28 FN 12: IF +Q34 LT +180 GOTO LBL 1
29 FN 9: IF +Q34 EQU +180 GOTO LBL 1
30 FN 11: IF +Q34 GT +0 GOTO LBL 1
31 FN 9: IF +Q34 EQU +0 GOTO LBL 1
32 FN 1: Q34 =-360 + +Q34
33 ;
34 ;Calcoli
35 LBL 1
36 FN 18: SYSREAD Q39 = ID1000 NR6140
37 FN 3: Q37 =+Q37 * +Q37
38 FN 5: Q37 = SQRT +Q37
39 FN 2: Q40 =+Q32 - +Q108
40 FN 4: Q41 =+Q33 DIV +2
41 FN 2: Q42 =+Q41 - +Q37
42 FN 2: Q43 =+Q42 - +Q39
43 FN 2: Q44 =+Q43 - +Q108
44 ;
45 ;Calcolo posizione 1. punto di tastatura
46 FN 7: Q50 = COS +Q34
47 FN 3: Q51 =+Q50 * +Q42
48 FN 1: Q52 =+Q51 + +Q30
49 FN 6: Q53 = SIN +Q34
50 FN 3: Q54 =+Q53 * +Q42
51 FN 1: Q55 =+Q54 + +Q31
52 FN 3: Q56 =+Q50 * +Q44
53 FN 1: Q57 =+Q56 + +Q30
54 FN 3: Q58 =+Q53 * +Q44
55 FN 1: Q59 =+Q54 + +Q31
56 L  Z+Q38 R0 FMAX
57 L  X+Q57  Y+Q59 FMAX
58 L  Z+2 FMAX
59 L  Z+Q40 F2000
60 ;1. ciclo di tastatura
61 TCH PROBE 1.0 BEZUGSPUNKT POLAR
62 TCH PROBE 1.1 X WINKEL:+Q34
63 TCH PROBE 1.2  X+Q52  Y+Q55  Z+Q32
64 FN 0: Q90 =+Q115
65 FN 0: Q91 =+Q116
66 L  Z+Q38 FMAX
67 ;
68 ;Decisione se 2. angolo deve essere convertito
69 FN 12: IF +Q35 LT +180 GOTO LBL 2
70 FN 9: IF +Q35 EQU +180 GOTO LBL 2
71 FN 11: IF +Q35 GT +0 GOTO LBL 2
72 FN 9: IF +Q35 EQU +0 GOTO LBL 2
73 FN 1: Q35 =-360 + +Q35
74 ;
75 ;Calcolo posizione 2. punto di tastatura
76 LBL 2
77 FN 7: Q50 = COS +Q35
78 FN 3: Q51 =+Q50 * +Q42
79 FN 1: Q52 =+Q51 + +Q30
80 FN 6: Q53 = SIN +Q35
81 FN 3: Q54 =+Q53 * +Q42
82 FN 1: Q55 =+Q54 + +Q31
83 FN 3: Q56 =+Q50 * +Q44
84 FN 1: Q57 =+Q56 + +Q30
85 FN 3: Q58 =+Q53 * +Q44
86 FN 1: Q59 =+Q58 + +Q31
87 L  Z+Q38 R0 FMAX
88 L  X+Q57  Y+Q59 FMAX
89 L  Z+2 FMAX
90 L  Z+Q40 F2000
91 ;2. ciclo di tastatura
92 TCH PROBE 1.0 BEZUGSPUNKT POLAR
93 TCH PROBE 1.1 X WINKEL:+Q35
94 TCH PROBE 1.2  X+Q52  Y+Q55  Z+Q32
95 FN 0: Q92 =+Q115
96 FN 0: Q93 =+Q116
97 L  Z+Q38 FMAX
98 ;
99 ;Decisione se 3. angolo deve essere convertito
100 FN 12: IF +Q36 LT +180 GOTO LBL 3
101 FN 9: IF +Q36 EQU +180 GOTO LBL 3
102 FN 11: IF +Q36 GT +0 GOTO LBL 3
103 FN 9: IF +Q36 EQU +0 GOTO LBL 3
104 FN 1: Q36 =-360 + +Q36
105 ;
106 ;Calcolo posizione 3. punto di tastatura
107 LBL 3
108 FN 7: Q50 = COS +Q36
109 FN 3: Q51 =+Q50 * +Q42
110 FN 1: Q52 =+Q51 + +Q30
111 FN 6: Q53 = SIN +Q36
112 FN 3: Q54 =+Q53 * +Q42
113 FN 1: Q55 =+Q54 + +Q31
114 FN 3: Q56 =+Q50 * +Q44
115 FN 1: Q57 =+Q56 + +Q30
116 FN 3: Q58 =+Q53 * +Q44
117 FN 1: Q59 =+Q58 + +Q31
118 L  Z+Q38 R0 FMAX
119 L  X+Q57  Y+Q59 FMAX
120 L  Z+2 FMAX
121 L  Z+Q40 F2000
122 ;3. ciclo di tastatura
123 TCH PROBE 1.0 BEZUGSPUNKT POLAR
124 TCH PROBE 1.1 X WINKEL:+Q36
125 TCH PROBE 1.2  X+Q52  Y+Q55  Z+Q32
126 FN 0: Q94 =+Q115
127 FN 0: Q95 =+Q116
128 L  Z+Q38 FMAX
129 ;
130 ;
131 ;Determinazione centro cerchio
132 FN 23: Q97 = CDATA Q90
133 ;Impostazione origine X e Y
134 FN 25: PRESET =  X /+Q97 /+Q60
135 FN 25: PRESET =  Y /+Q98 /+Q61
136 ;
137 ;Fine programma
138 M30
139 END PGM 8170-it MM