0 BEGIN PGM 2035_ES MM 
1 ;Programa para fresar una espiral en el
2 ;plano X/Y.
3 ;A partir de los parámetros introducidos,
4 ;el control numérico calcula la trayectoria
5 ;de la herramienta, que se compone de frases
6 ;lineales individuales. A partir de las
7 ;mismas determina respectivamente los puntos
8 ;finales en X e Y Con la División a introducir
9 ;se define en cuantas frases lineales se divide
10 ;una trayectoria de 360 grados. Sobre dicha
11 ;trayectoria de 360º el control numérico compensa
12 ;asimismo la inclinación introducida. Los
13 ;movimientos de la herramienta en el eje Z
14 ;se recorren verticalmente.
15 ;
16 BLK FORM 0.1 Z X+0 Y+0 Z-20
17 BLK FORM 0.2  X+100  Y+100  Z+0
18 ;
19 ;Llamada a la herramienta
20 TOOL CALL 5 Z S4000
21 ;
22 ;Introducción de parámetros
23 FN 0: Q1 =+50 ;CENTRO EN EL EJE X
24 FN 0: Q2 =+50 ;CENTRO EN EL EJE Y
25 FN 0: Q3 =-15 ;PROFUNDIDAD
26 FN 0: Q4 =+1 ;SENTIDO DE DESPLAZAMIENTO
27 ;            ;+1=EN EL SENTIDO ANTIHORARIO
28 ;            ;-1=EN EL SENTIDO HORARIO
29 FN 0: Q5 =+180 ;DIVISIÓN (NÚMERO DE FRASES LINEALES
30 ;              ;SOBRE 360 GRADOS)
31 FN 0: Q6 =+10 ;RADIO INICIAL
32 FN 0: Q16 =+47 ;RADIO FINAL
33 FN 0: Q7 =+90 ;ANGULO INICIAL
34 FN 0: Q8 =+10 ;INCLINACIÓN EN MM A 360 GRADOS
35 FN 0: Q10 =+2 ;DISTANCIA DE SEGURIDAD
36 FN 0: Q11 =+100 ;AVANCE AL PROFUNDIZAR
37 FN 0: Q12 =+300 ;AVANCE DE FRESADO
38 FN 0: Q14 =+0 ;SOBREMEDIDA LATERAL
39 FN 0: Q15 =+0 ;CORRECCIÓN DE RADIO
40 ;             ;0=NINGUNA CORRECCIÓN DE RADIO
41 ;             ;+1=LA HERRAMIENTA SE DESPLAZA FUERA
42 ;             ;DEL CONTORNO
43 ;             ;-1=LA HERRAMIENT SE DESPLAZA DENTRO
44 ;             ;DEL CONTORNO
45 ;Final introducción de parámetros
46 ;
47 L  X+Q1  Y+Q2 R0 FMAX M3 ;Posicionamiento previo
48 L  Z+Q10 R0 FMAX
49 CALL LBL 1
50 ;Final del programa
51 L  Z+100 R0 FMAX M5 M2
52 ;
53 ;
54 LBL 1 ;Cálculos
55 CC  X+Q1  Y+Q2 ;Fijar el centro del círculo
56 FN 3: Q38 =+Q108 * +Q15 ;Compensar la corrección de radio
57 FN 3: Q39 =+Q14 * +Q15 ;Compensar la sobremedida
58 FN 1: Q26 =+Q6 + +Q38 ;Radio inicial corregido en radio
59 FN 1: Q26 =+Q26 + +Q39 ;Radio inicial efectivo (incluida sobremedida)
60 FN 0: Q27 =+Q7 ;Ángulo actual=Ángulo inicial
61 FN 4: Q36 =+Q8 DIV +Q5 ;Establecer el paso del radio
62 FN 8: Q36 =+Q36 LEN +0 ;Establecer que se calcule con valores positivos
63 FN 4: Q37 =+360 DIV +Q5 ;Establecer el paso angular
64 FN 3: Q37 =+Q37 * +Q4 ;Compensar el paso angular con el sentido del desplazamiento
65 ;
66 ;
67 LP  PR+Q26  PA+Q7 R0 F9999 M3 ;Desplazarse a la posición inicial
68 L  Z+Q3 FQ11 ;Profundización
69 ;
70 LBL 2 ;Repetición
71 FN 1: Q26 =+Q26 + +Q36 ;Continuación de cálculo del radio
72 FN 1: Q27 =+Q27 + +Q37 ;Continuación de recuento del ángulo
73 ;Calcular coordenadas X e Y
74 FN 7: Q21 = COS +Q27
75 FN 3: Q21 =+Q21 * +Q26
76 FN 1: Q21 =+Q21 + +Q1
77 FN 6: Q22 = SIN +Q27
78 FN 3: Q22 =+Q22 * +Q26
79 FN 1: Q22 =+Q22 + +Q2
80 ;Control de si se ha alcanzado el radio final
81 FN 11: IF +Q26 GT +Q16 GOTO LBL 99 ;
82 ;Hacer la aproximación a la nueva posición X e Y
83 L  X+Q21  Y+Q22  Z+Q3 FQ12
84 ;Si el radio final no se ha alcanzado, entonces retorno
85 ;para repetición
86 FN 12: IF +Q26 LT +Q16 GOTO LBL 2
87 ;
88 LBL 99 ;Espiral terminada
89 L  Z+Q10 F9999 ;Ir a la distancia de seguridad
90 LBL 0
91 END PGM 2035_ES MM