0 BEGIN PGM 2030_ES MM 
1 ;Polígono regular.
2 ;Determinación de las coordenada con seno y coseno
3 BLK FORM 0.1 Z X+0 Y+0 Z-20
4 BLK FORM 0.2  X+100  Y+100  Z+0
5 ;
6 ;Llamada de herramienta de fresado
7 TOOL CALL 51 Z S3000
8 ;
9 ;Introducción de parámetros
10 FN 0: Q1 =+50 ;CENTRO EJE X
11 FN 0: Q2 =+50 ;CENTRO EJE Y
12 FN 0: Q3 =-10 ;PROFUNDIDAD
13 FN 0: Q4 =-1 ;SENTIDO DE DESPLAZAMIENTO
14 ;            ;-1=EN EL SENTIDO HORARIO
15 ;            ;+1=EN EL SENTIDO ANTIHORARIO
16 FN 0: Q5 =+6 ;NUMERO DE VÉRTICES
17 FN 0: Q6 =+45 ;RADIO DEL PERÍMETRO
18 FN 0: Q7 =+0 ;POSICIÓN ANGULAR DEL PRIMER VÉRTICE
19 FN 0: Q10 =+2 ;DISTANCIA DE SEGURIDAD
20 FN 0: Q11 =+150 ;AVANCE AL PROFUNDIZAR
21 FN 0: Q12 =+300 ;AVANCE DE FRESADO
22 FN 0: Q14 =+0 ;SOBREMEDIDA LATERAL
23 FN 0: Q15 =+1 ;CORRECCIÓN DEL RADIO (O=RO,1=RL,2=RR)
24 ;Introducción del final!
25 ;
26 L  Z+100 R0 FMAX M3
27 ;
28 LBL 1
29 CC  X+Q1  Y+Q2 ;CC en el centro X e Y
30 ;
31 ;Cálculos
32 FN 0: Q27 =+0 ;Poner a cero el ángulo actua
33 FN 1: Q26 =+Q6 + +Q14 ;Radio a realizar (radio del perímetro + sobremedida)
34 FN 4: Q28 =+Q108 DIV +2 ;Radio de entrada (1/2*radio de la herramienta)
35 FN 3: Q29 =+Q108 * +2 ;Diámetro de la herramienta (2*radio de la herramienta)
36 FN 1: Q29 =+Q26 + +Q29 ;Distancia para el posicionamiento previo (radio+diámetro de la herramienta)
37 FN 4: Q37 =+360 DIV +Q5 ;Paso angular
38 FN 3: Q37 =+Q37 * +Q4 ;Sentido de desplazamiento
39 FN 0: Q27 =+Q7 ;Ángulo actual=Ángulo del primer vértice
40 LP  PR+Q29  PA+Q7 R0 FMAX ;Posicionamiento previo
41 L  Z+Q10 FMAX
42 L  Z+Q3 FQ11 ;Profundización
43 ;
44 FN 9: IF +Q15 EQU +1 GOTO LBL 11 ;si la corrección del radio es RL Salto a LBL11
45 FN 9: IF +Q15 EQU +2 GOTO LBL 12 ;si la corrección del radio es RR Salto a LBL12
46 ;
47 ;Aproximación al primer vértice con R0
48 LP  PR+Q26  PA+Q7 R0 FQ12
49 RND RQ28
50 FN 9: IF +0 EQU +0 GOTO LBL 2 ;Salto a LBL2
51 ;
52 ;Aproximación al primer vértice con RL
53 LBL 11
54 LP  PR+Q26  PA+Q7 RL FQ12
55 RND RQ28
56 FN 9: IF +0 EQU +0 GOTO LBL 2 ;Salto a LBL2
57 ;
58 ;Aproximación al primer vértice con RR
59 LBL 12
60 LP  PR+Q26  PA+Q7 RR FQ12
61 RND RQ28
62 FN 9: IF +0 EQU +0 GOTO LBL 2 ;Salto a LBL2
63 ;
64 ;
65 LBL 2
66 FN 1: Q35 =+Q35 + +1 ;Contador de vértices
67 FN 1: Q27 =+Q27 + +Q37 ;nuevo ángulo (ángulo actual + paso angular)
68 ;
69 ;Calcular nueva posición X e Y
70 FN 6: Q22 = SIN +Q27 ;Seno del ángulo actual
71 FN 3: Q22 =+Q22 * +Q26 ;Seno * Radio
72 FN 1: Q22 =+Q22 + +Q2 ;Posición Y=resultado+centro eje Y
73 FN 7: Q21 = COS +Q27 ;Coseno del ángulo actual
74 FN 3: Q21 =+Q21 * +Q26 ;Coseno * Radio
75 FN 1: Q21 =+Q21 + +Q1 ;Posición X=resultado+centro eje X
76 ;
77 ;ir a nueva posición
78 L  X+Q21  Y+Q22 FQ12
79 ;
80 FN 12: IF +Q35 LT +Q5 GOTO LBL 2 ;Si valor contador de vértices menor que número de vértices retorno a LBL2
81 ;
82 LP  PR+Q26  PA+Q7 ;volver al primer vértice
83 RND RQ28
84 LP  PR+Q29  PA+Q7 R0 ;Retirar la hta.
85 L  Z+Q10 R0 FMAX ;Desplazarse a altura de seguridad
86 LBL 0
87 L  Z+100 R0 FMAX M2
88 ;Final del programa
89 END PGM 2030_ES MM