0 BEGIN PGM 8170-es MM 
1 ;Determinar el centro de un taladro con tres
2 ;puntos de medición y poner punto de
3 ;referencia X/Y en el centro.
4 ;Para iTNC530 y TNC426 a partir del
5 ;software n.º 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 ;Llamada de herramienta palpador
11 TOOL CALL 501 Z
12 ;
13 ;Introducción de parámetros
14 FN 0: Q30 =+25 ;CENTRO DEL TALADRO EN EJE X
15 FN 0: Q31 =+25 ;CENTRO DEL TALADRO EN EJE Y
16 FN 0: Q32 =-5 ;¡ALTURA DE MEDICIÓN! ¡CENTRO DE LA BOLA DE PALPACIÓN!
17 FN 0: Q33 =+40 ;DIÁMETRO DEL TALADRO
18 FN 0: Q34 =+0 ;ÁNGULO 1r PUNTO DE PALPACIÓN POSITIVO
19 FN 0: Q35 =+120 ;ÁNGULO 2.º PUNTO DE PALPACIÓN POSITIVO
20 FN 0: Q36 =+240 ;ÁNGULO 3r PUNTO DE PALPACIÓN POSITIVO
21 FN 0: Q37 =+5 ;DISTANCIA DE SEGURIDAD ADICIONAL EN LA DIRECCIÓN DE PALPACIÓN adic. A MP6140!
22 FN 0: Q38 =+20 ;ALTURA DE SEGURIDAD ABSOLUTO
23 FN 0: Q60 =+0 ;NUEVO PUNTO DE REFERENCIA EJE X
24 FN 0: Q61 =+0 ;NUEVO PUNTO DE REFERENCIA EJE Y
25 ;Introducción del final
26 ;
27 ;Decisión de si el 1r ángulo debe convertirse
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 ;Cálculos
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 ;Cálculo posición 1r punto de palpación
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 ;1r ciclo de palpación
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 ;Decisión de si el 2.º ángulo debe convertirse
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 ;Cálculo posición 2.º punto de palpación
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 de palpación
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 ;Decisión de si el 3r ángulo debe convertirse
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 ;Cálculo posición del 3r punto de palpación
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 ;3r ciclo de palpación
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 ;Determinación del centro del círculo
132 FN 23: Q97 = CDATA Q90
133 ;Establecer punto de referencia X y Y
134 FN 25: PRESET =  X /+Q97 /+Q60
135 FN 25: PRESET =  Y /+Q98 /+Q61
136 ;
137 ;Final del programa
138 M30
139 END PGM 8170-es MM