0 BEGIN PGM 2115_ES MM 
1 ;Programa para el fresado de un polígono.
2 ;El tamaño viene definido por el ancho de llave.
3 ;Éste se convierte internamente en el radio del
4 ;vértice, al que luego se le hace la aproximación
5 ;como frase de datos polarlineal. La herramienta
6 ;se posiciona previamente en el primer vértice
7 ;desplazándose lo equivalente a su diámetro y, a
8 ;continuación, y desplaza en el contorno en un radio.
9 ;Todos los parámetros necesarios se definen en el
10 ;inicio del programa.
11 ;
12 ;Introducción de parámetros
13 FN 0: Q1 =+50 ;CENTRO CONTORNO EN EL EJE X
14 FN 0: Q2 =+50 ;CENTRO DEL CONTORNO EN EL EJE Y
15 FN 0: Q3 =-10 ;PROFUNDIDAD
16 FN 0: Q4 =-1 ;SENTIDO DE DESPLAZAMIENTO
17 ;            ;-1=EN EL SENTIDO HORARIO
18 ;            ;+1=EN EL SENTIDO ANTIHORARIO
19 FN 0: Q5 =+6 ;NUMERO DE VÉRTICES
20 FN 0: Q9 =+80 ;ANCHO DE LLAVE
21 FN 0: Q7 =+30 ;POSICIÓN ANGULAR DEL PRIMER VÉRTICE
22 FN 0: Q10 =+2 ;DISTANCIA DE SEGURIDAD
23 FN 0: Q11 =+500 ;AVANCE AL PROFUNDIZAR
24 FN 0: Q12 =+250 ;AVANCE DE FRESADO
25 FN 0: Q14 =+0 ;SOBREMEDIDA LATERAL
26 FN 0: Q15 =+1 ;CORRECCIÓN DE RADIO
27 ;             ;0=NINGUNA CORRECCIÓN DE RADIO
28 ;             ;1=CORRECCIÓN DE RADIO IZQUIERDA
29 ;             ;2=CORRECCIÓN DE RADIO DERECHA
30 ;Fin de la introducción de parámetros
31 ;
32 BLK FORM 0.1 Z X+0 Y+0 Z-22
33 BLK FORM 0.2  X+100  Y+100  Z+0
34 ;
35 ;Llamada de herramienta de fresado
36 TOOL CALL 16 Z S4000
37 ;
38 CALL LBL 1
39 ;
40 ;Retirar la herramienta y final del programa
41 L  Z+100 R0 FMAX M2
42 ;
43 ;Cálculo de contorno
44 LBL 1
45 FN 4: Q20 =+Q9 DIV +2
46 ;Reducir a la mitad el ancho de llave
47 FN 1: Q21 =+Q20 + +Q14 ;Añadir sobremedida
Q22 = 360 / Q5 / 2 ;Determinar medio paso angular
Q6 = Q21 / COS Q22 ;Calcular radio real
48 ;
49 CC  X+Q1  Y+Q2 ;Definir el centro
50 FN 0: Q27 =+Q7 ;Ángulo actual=Ángulo del primer vértice
51 FN 4: Q28 =+Q108 DIV +2 ;Radio de aproximación y salida
52 FN 3: Q29 =+Q108 * +2 ;Diámetro de herramienta
53 FN 1: Q29 =+Q6 + +Q29 ;Radio para el posicionamiento previo
54 FN 0: Q35 =+1 ;Contador
55 FN 4: Q37 =+360 DIV +Q5 ;Paso angular
56 FN 3: Q37 =+Q37 * +Q4 ;Paso angular en el sentido de giro
57 LP  PR+Q29  PA+Q7 R0 FMAX M3 ;Posicionamiento previo
58 L  Z+Q10 FMAX ;Posicionamiento previo Z
59 L  Z+Q3 FQ11 ;Profundización
60 ;Selección de la trayectoria corregida por radio
61 FN 9: IF +Q15 EQU +1 GOTO LBL 11
62 FN 9: IF +Q15 EQU +2 GOTO LBL 12
63 LP  PR+Q6  PA+Q7 R0 FQ12 ;Hacer la aproximación al primer vértice
64 RND RQ28 FQ12
65 FN 9: IF +0 EQU +0 GOTO LBL 2
66 ;
67 LBL 11
68 LP  PR+Q6  PA+Q7 RL FQ12 ;Hacer la aproximación al primer vértice
69 RND RQ28 FQ12
70 FN 9: IF +0 EQU +0 GOTO LBL 2
71 ;
72 LBL 12
73 LP  PR+Q6  PA+Q7 RR FQ12 ;Hacer la aproximación al primer vértice
74 RND RQ28 FQ12
75 LBL 2
76 FN 1: Q35 =+Q35 + +1 ;Continuación del recuento del contador
77 FN 1: Q27 =+Q27 + +Q37 ;Continuación de recuento del ángulo
78 LP  PR+Q6  PA+Q27 FQ12 ;Hacer la aproximación al siguiente vértice
79 FN 12: IF +Q35 LT +Q5 GOTO LBL 2
80 LP  PR+Q6  PA+Q7 FQ12 ;Hacer la aproximación al primer/último vértice
81 RND RQ28
82 LP  PR+Q29  PA+Q7 R0 FQ12 ;Salida del contorno
83 L  Z+Q10 R0 FMAX ;Z Desplazar a la distancia de seguridad
84 LBL 0
85 END PGM 2115_ES MM