0 BEGIN PGM 2070_ES MM 
1 ;Programa para fresar una trayectoria de elipse.
2 ;Para ello, la trayectoria propiamente dicha se
3 ;divide en elementos lineales individuales. El
4 ;número de dichos movimientos lineales determina
5 ;con que exactitud se igualan la trayectoria
6 ;linealizada y la trayectoria de la elipse. La
7 ;trayectoria es en el sentido antihorario. Todos
8 ;los valores necesarios se definen en parámetros.
9 ;
10 ;Introducción de parámetros
11 FN 0: Q1 =+0 ;CENTRO DE LA ELIPSE EN EL EJE X
12 FN 0: Q2 =+0 ;CENTRO DE LA ELIPSE EN EL EJE Y
13 FN 0: Q3 =-10 ;PROFUNDIDAD
14 FN 0: Q5 =+50 ;DIVISIÓN
15 ;             ;DEFINE EN CUANTOS ELEMENTOS
16 ;             ;LINEALES SE DIVIDE LA TRAYECTORIA
17 FN 0: Q6 =+45 ;SEMIEJE DE LA ELIPSE EN X
18 FN 0: Q16 =+25 ;SEMIEJE DE LA ELIPSE EN Y
19 FN 0: Q7 =+0 ;ÁNGULO INICIAL EN EL PLANO X/Y
20 FN 0: Q17 =+360 ;ÁNGULO FINAL EN EL PLANO X/Y
21 FN 0: Q8 =+0 ;ROTACIÓN DE LA ELIPSE
22 FN 0: Q10 =+2 ;DISTANCIA DE SEGURIDAD
23 FN 0: Q11 =+300 ;AVANCE AL PROFUNDIZAR
24 FN 0: Q12 =+555 ;AVANCE DE FRESADO
25 FN 0: Q14 =+0 ;SOBREMEDIDA
26 ;             ;VALOR CON EL QUE SE MODIFICAN LOS
27 ;             ;SEMIEJES
28 ;             ;!!TENER EN CUENTA EL SIGNO!!
29 FN 0: Q15 =+2 ;COMPENSACIÓN DEL RADIO
30 ;           ;0=NINGUNA COMPENSACIÓN
31 ;           ;1=COMPENSACIÓN DEL RADIO HACIA LA IZQUIERDA
32 ;           ;2=COMPENSACIÓN DEL RADIO HACIA LA DERECHA
33 ;Introducción de parámetros Final
34 ;
35 BLK FORM 0.1 Z X-60 Y-50 Z-40
36 BLK FORM 0.2  X+60  Y+50  Z+0
37 ;
38 ;Llamada de herramienta de fresado
39 TOOL CALL 10 Z S3000
40 ;
41 ;Llamada movimiento de la trayectoria
42 CALL LBL 1
43 ;
44 ;Retirar la herramienta y final del programa
45 L  Z+100 R0 FMAX M30
46 ;
47 ;Movimiento de trayectoria
48 LBL 1
49 ;Conversiones de coordenadas
50 CYCL DEF 7.0 PUNTO CERO
51 CYCL DEF 7.1  X+Q1
52 CYCL DEF 7.2  Y+Q2
53 CYCL DEF 10.0 GIRO
54 CYCL DEF 10.1  ROT+Q8
55 ;
56 FN 0: Q23 =+Q3 ;Copiar el valor Z
57 FN 0: Q27 =+Q7 ;Ángulo actual=Ángulo inicial
58 FN 1: Q31 =+Q6 + +Q14 ;Semieje X efectivo
59 FN 1: Q32 =+Q16 + +Q14 ;Semieje Y efectivo
60 FN 0: Q35 =+0 ;Contador
61 FN 2: Q37 =+Q17 - +Q7 ;Paso angular
62 FN 4: Q37 =+Q37 DIV +Q5 ;Paso angular
63 CALL LBL 4 ;Llamada cálculo de posición
64 ;
65 ;Tener en cuenta el Corrección de radio y
66 ;Hacer aproximación a la primera posición
67 FN 9: IF +Q15 EQU +1 GOTO LBL 11
68 FN 9: IF +Q15 EQU +2 GOTO LBL 12
69 LBL 10
70 L  X+Q21  Y+Q22 R0 FMAX M3
71 FN 9: IF +0 EQU +0 GOTO LBL 2
72 LBL 11
73 L  X+Q21  Y+Q22 RL FMAX M3
74 FN 9: IF +0 EQU +0 GOTO LBL 2
75 LBL 12
76 L  X+Q21  Y+Q22 RR FMAX M3
77 ;
78 LBL 2
79 L  Z+Q10 FMAX ;Posicionamiento previo eje Z
80 L  Z+Q3 FQ11 ;Profundización
81 ;
82 LBL 3 ;Repetición
83 FN 1: Q27 =+Q27 + +Q37 ;Continuación de recuento del ángulo
84 FN 1: Q35 =+Q35 + +1 ;Continuación del recuento del contador
85 FN 11: IF +Q35 GT +Q5 GOTO LBL 99 ;Comparación de si se ha alcanzado el número de pasos
86 CALL LBL 4 ;Llamada cálculo de posición
87 L  X+Q21  Y+Q22  Z+Q23 FQ11 ;Desplazarse a una nueva posición
88 FN 12: IF +Q35 LT +Q5 GOTO LBL 3 ;Comparar si es necesaria otra repetición
89 ;
90 LBL 99
91 L  Z+Q10 R0 FMAX ;Retirar la herramienta eje Z
92 ;Deshacer la transformación de coordenadas
93 CYCL DEF 10.0 GIRO
94 CYCL DEF 10.1  ROT+0
95 CYCL DEF 7.0 PUNTO CERO
96 CYCL DEF 7.1  X+0
97 CYCL DEF 7.2  Y+0
98 LBL 0
99 ;
100 LBL 4 ;Cálculo de la nueva posición X e Y
101 FN 7: Q21 = COS +Q27
102 FN 3: Q21 =+Q21 * +Q31
103 FN 6: Q22 = SIN +Q27
104 FN 3: Q22 =+Q32 * +Q22
105 LBL 0
106 END PGM 2070_ES MM