0 BEGIN PGM 3170_ES MM 
1 ;Programa para fresar una rosca interior cónica. La
2 ;trayectoria de la herramienta se divide en pasos
3 ;lineales. Con la División se define en cuantos
4 ;elementos lineales se divide una trayectoria de
5 ;360 grados. El control numérico calcula para cada
6 ;uno de dichos pasos lineales una coordenada X, Y y Z
7 ;a la que debe hacerse la aproximación. El mecanizado
8 ;se realiza de abajo hacia arriba. Con el sentido de
9 ;desplazamiento se establece si se origina una rosca a
10 ;derecha o una rosca a izquierda.
11 ;
12 BLK FORM 0.1 Z X+0 Y+0 Z-32
13 BLK FORM 0.2  X+100  Y+100  Z+0
14 ;
15 ;Llamada del programa para el fresado previo del cono
16 ;interior
17 ;En el programa llamado deben adaptarse datos,
18 ;por ejemplo número de herramienta, datos de corte y
19 ;parámetros!
20 CALL PGM 31701_es.h
21 ;
22 ;Llamada de herramienta fresado de rosca
23 TOOL CALL 10 Z S5000
24 ;
25 ;Introducción de parámetros
26 FN 0: Q1 =+50 ;CENTRO X
27 FN 0: Q2 =+50 ;CENTRO Y
28 FN 0: Q4 =+1 ;SENTIDO DE DESPLAZAMIENTO +/-1
29 ;            ;-1=EN EL SENTIDO HORARIO
30 ;            ;+1=EN EL SENTIDO ANTIHORARIO
31 FN 0: Q5 =+30 ;DIVISIÓN
32 FN 0: Q6 =+40 ;RADIO EXTERIOR ABAJO
33 FN 0: Q7 =+0 ;ANGULO INICIAL
34 FN 0: Q8 =+15 ;ANGULO CONO
35 FN 0: Q9 =+3 ;PASO
36 FN 0: Q10 =+2 ;ALTURA DE SEGURIDAD
37 FN 0: Q11 =+300 ;AVANCE POSICIONAMIENTO PREVIO
38 FN 0: Q12 =+1000 ;AVANCE DE FRESADO
39 FN 0: Q3 =-30 ;COORDENADA Z INICIO (ABAJO)
40 FN 0: Q13 =+0 ;COORDENADA Z FINAL (ARRIBA)
41 FN 0: Q14 =+1 ;SOBREMEDIDA EN EL PLANO X/Y
42 FN 0: Q16 =+2 ;DISTANCIA DE SEGURIDAD LATERALMENTE
43 ;Fin de la introducción de parámetros
44 ;
45 ;Llamada del mecanizado
46 CALL LBL 1
47 STOP
48 ;
49 ;Introducción de parámetros Acabado
50 FN 0: Q5 =+360 ;DIVISIÓN
51 FN 0: Q12 =+500 ;AVANCE DE FRESADO
52 FN 0: Q14 =+0 ;SOBREMEDIDA EN EL PLANO X/Y
53 ;
54 ;Llamada del mecanizado
55 CALL LBL 1
56 ;
57 ;Retirar la herramienta y final del programa
58 L  Z+100 R0 FMAX M30
59 ;
60 ;Mecanizado
61 LBL 1
62 ;Cálculos
63 FN 3: Q31 =+Q16 * -1 ;Compensación de la distancia de seguridad lateral
64 FN 3: Q38 =+Q108 * -1 ;Compensación de radio de herramienta
65 FN 3: Q39 =+Q14 * -1 ;Compensación de la sobremedida
66 FN 0: Q23 =+Q3 ;Coordenada Z actual
67 FN 0: Q25 =+0 ;Contador
68 FN 1: Q26 =+Q6 + +Q38 ;Compensación radio de la herramienta
69 FN 1: Q26 =+Q26 + +Q39 ;Compensación de la sobremedida
70 FN 1: Q28 =+Q26 + +Q31 ;Radio del posicionamiento previo
71 FN 0: Q27 =+Q7 ;Ángulo actual
Q36 = TAN Q8 * Q9 ;Variación del radio cada 360 grados
72 FN 4: Q36 =+Q36 DIV +Q5 ;Tamaño del paso radio
73 FN 4: Q37 =+360 DIV +Q5 ;Tamaño del paso ángulo
74 FN 3: Q37 =+Q37 * +Q4 ;Paso angular en el sentido de giro
75 FN 2: Q35 =+Q13 - +Q3 ;Zona Z
Q33 = Q9 / Q5 * SGN Q35 ;Tamaño del paso Z
Q35 = ( Q13 - Q3 ) / Q33 ;Número de pasos Z
Q35 = ABS Q35 ;Valor de contaje positivo
76 ;Fin de los cálculos
77 ;
78 CC  X+Q1  Y+Q2 ;Definir el centro
79 LP  PR+Q28  PA+Q7 R0 FMAX M3 ;Posicionamiento previo
80 L  Z+Q10 R0 FMAX ;Desplazarse a la distancia de seguridad
81 L  Z+Q3 R0 FQ11 ;Desplazarse a la coordenada de inicio Z
82 LP  PR+Q26  PA+Q7 R0 FQ12 ;Ir al radio inicial
83 LBL 2 ;Repetición
84 FN 1: Q26 =+Q26 + +Q36 ;Actualizar el radio
85 FN 1: Q27 =+Q27 + +Q37 ;Actualización del ángulo
86 FN 7: Q21 = COS +Q27 ;Cálculo coordenada X
87 FN 3: Q21 =+Q21 * +Q26 ;Cálculo coordenada X
88 FN 1: Q21 =+Q21 + +Q1 ;Nueva coordenada X
89 FN 6: Q22 = SIN +Q27 ;Cálculo coordenada Y
90 FN 3: Q22 =+Q26 * +Q22 ;Cálculo coordenada Y
91 FN 1: Q22 =+Q22 + +Q2 ;Nueva coordenada Y
92 FN 1: Q23 =+Q23 + +Q33 ;Nueva coordenada Z
93 FN 1: Q25 =+Q25 + +1 ;Actualización del contador
94 L  X+Q21  Y+Q22  Z+Q23 FQ12 ;Desplazarse a las nuevas coordenadas
95 FN 12: IF +Q25 LT +Q35 GOTO LBL 2 ;Comparación de si se ha alcanzado el número de pasos
96 LP IPR+Q31 ;Retirar la herramienta lateralmente
97 L  Z+Q10 R0 FMAX ;Desplazarse a la distancia de seguridad
98 LBL 0
99 END PGM 3170_ES MM