0 BEGIN PGM 1075_ES MM 
1 ;Programa para fresar un cono con una trayectoria
2 ;helicoidal. El mecanizado se realiza según como
3 ;se definan los parámetros:
4 ;- Interior o Exterior
5 ;- De arriba hacia abajo o a la inversa
6 ;- En sentido horario o en sentido antihorario
7 ;- De diámetro grande a diámetro pequeño o a la inversa
8 ;
9 ;El control numérico divide en pasos lineales la
10 ;trayectoria de la herramienta necesaria para ello. Con
11 ;la División se define en cuantos elementos lineales se
12 ;divide una trayectoria de 360 grados. El control
13 ;numérico calcula para cada uno de dichos pasos lineales
14 ;una coordenada X, Y y Z a la que debe hacerse la
15 ;aproximación.
16 ;
17 ;
18 BLK FORM 0.1 Z X+0 Y+0 Z-32
19 BLK FORM 0.2  X+100  Y+100  Z+0
20 ;
21 ;Llamada de herramienta fresa cilíndrica
22 TOOL CALL 15 Z S5000
23 ;
24 ;Introducción de parámetros
25 FN 0: Q1 =+50 ;CENTRO X
26 FN 0: Q2 =+50 ;CENTRO Y
27 FN 0: Q4 =-1 ;SENTIDO DE DESPLAZAMIENTO
28 ;            ;-1= EN EL SENTIDO HORARIO
29 ;            ;+1= EN EL SENTIDO ANTIHORARIO
30 FN 0: Q5 =+180 ;DIVISIÓN
31 FN 0: Q6 =+40 ;RADIO INICIO
32 FN 0: Q7 =+0 ;ANGULO INICIAL
33 FN 0: Q8 =+15 ;ANGULO CONO
34 FN 0: Q9 =+0.2 ;VARIACIÓN DE LA PROFUNDIDAD POR VUELTA
35 FN 0: Q10 =+2 ;ALTURA DE SEGURIDAD
36 FN 0: Q11 =+300 ;AVANCE AL PROFUNDIZAR
37 FN 0: Q12 =+1000 ;AVANCE DE FRESADO
38 FN 0: Q3 =+0 ;COORDENADA Z INICIO
39 FN 0: Q13 =-30 ;COORDENADA Z FINAL
40 FN 0: Q14 =+0 ;SOBREMEDIDA LATERAL
41 FN 0: Q15 =+1 ;COMPENSACIÓN DEL RADIO
42 ;             ;-1= INTERIOR
43 ;             ;+1= EXTERIOR
44 FN 0: Q16 =+2 ;DISTANCIA DE SEGURIDAD LATERAL
45 ;Fin de la introducción de parámetros
46 ;
47 ;Llamada del mecanizado
48 CALL LBL 1
49 ;
50 ;Retirar la herramienta y final del programa
51 L  Z+100 R0 FMAX M30
52 ;
53 ;Mecanizado
54 LBL 1
55 FN 3: Q31 =+Q16 * +Q15 ;Compensación de la distancia de seguridad lateral
56 FN 3: Q38 =+Q108 * +Q15 ;Compensación de radio de herramienta
57 FN 3: Q39 =+Q14 * +Q15 ;Compensación de la sobremedida lateral
58 FN 0: Q23 =+Q3 ;Coordenada Z actual
59 FN 0: Q25 =+0 ;Contador
60 FN 1: Q26 =+Q6 + +Q38 ;Compensación radio de la herramienta
61 FN 1: Q26 =+Q26 + +Q39 ;Compensación de la sobremedida
62 FN 1: Q28 =+Q26 + +Q31 ;Radio para el posicionamiento previo
63 FN 0: Q27 =+Q7 ;Ángulo actual
Q36 = TAN Q8 * Q9 ;Variación del radio cada 360 grados
64 FN 4: Q36 =+Q36 DIV +Q5 ;Tamaño del paso radio
65 FN 4: Q37 =+360 DIV +Q5 ;Tamaño del paso ángulo
66 FN 3: Q37 =+Q37 * +Q4 ;Paso angular en el sentido de giro
67 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
68 ;
69 CC  X+Q1  Y+Q2 ;Definir el centro
70 LP  PR+Q28  PA+Q7 R0 FMAX M3 ;Posicionamiento previo
71 L  Z+Q10 R0 FMAX ;Desplazarse a la distancia de seguridad
72 L  Z+Q3 R0 FQ11 ;Desplazarse a la coordenada de inicio Z
73 LP  PR+Q26  PA+Q7 R0 FQ12 ;Desplazarse a la posición inicial
74 ;
75 ;Repeticiones
76 LBL 2
77 FN 1: Q26 =+Q26 + +Q36 ;Actualizar el radio
78 FN 1: Q27 =+Q27 + +Q37 ;Actualización del ángulo
79 FN 7: Q21 = COS +Q27 ;Cálculo coordenada X
80 FN 3: Q21 =+Q21 * +Q26 ;Cálculo coordenada X
81 FN 1: Q21 =+Q21 + +Q1 ;Nueva coordenada X
82 FN 6: Q22 = SIN +Q27 ;Cálculo coordenada Y
83 FN 3: Q22 =+Q26 * +Q22 ;Cálculo coordenada Y
84 FN 1: Q22 =+Q22 + +Q2 ;Nueva coordenada Y
85 FN 1: Q23 =+Q23 + +Q33 ;Nueva coordenada Z
86 FN 1: Q25 =+Q25 + +1 ;Actualización del contador
87 L  X+Q21  Y+Q22  Z+Q23 FQ12 ;Desplazarse a las nuevas coordenadas
88 FN 12: IF +Q25 LT +Q35 GOTO LBL 2 ;Comparación de si se ha alcanzado el número de pasos
89 LP IPR+Q31 ;Retirar la herramienta lateralmente
90 L  Z+Q10 R0 FMAX ;Desplazarse a la distancia de seguridad
91 LBL 0
92 END PGM 1075_ES MM