0 BEGIN PGM 2115_NL MM 
1 ;Programma voor het frezen van een veelhoek.
2 ;De grootte bepaalt u met de sleutelwijdte.
3 ;Deze wordt intern naar de hoekradius
4 ;omgerekend, die vervolgens als lineairpolaire
5 ;regel wordt genaderd. Het gereedschap wordt
6 ;met zijn diameter verzet naar de eerste hoek
7 ;voorgepositioneerd en vervolgens in een radius
8 ;naar de contour verplaatst. Alle benodigde
9 ;parameters definieert u aan het begin van het
10 ;programma.
11 ;
12 ;Invoer parameters
13 FN 0: Q1 =+50 ;MIDDELPUNT CONTOUR OP DE X-AS
14 FN 0: Q2 =+50 ;MIDDELPUNT CONTOUR OP DE Y-AS
15 FN 0: Q3 =-10 ;DIEPTE
16 FN 0: Q4 =-1 ;ROTATIERICHTING
17 ;            ;-1= RECHTSOM
18 ;            ;+1= LINKSOM
19 FN 0: Q5 =+6 ;AANTAL HOEKEN
20 FN 0: Q9 =+80 ;SLEUTELWIJDTE
21 FN 0: Q7 =+30 ;HOEKPOSITIE VAN DE EERSTE HOEK
22 FN 0: Q10 =+2 ;VEILIGHEIDSAFSTAND
23 FN 0: Q11 =+500 ;AANZET DIEPTEVERPLAATSING
24 FN 0: Q12 =+250 ;AANZET FREZEN
25 FN 0: Q14 =+0 ;ZIJDELINGSE OVERMAAT
26 FN 0: Q15 =+1 ;RADIUSCORRECTIE
27 ;             ;0= GEEN RADIUSCORRECTIE
28 ;             ;1= RADIUSCORRECTIE LINKS
29 ;             ;2= RADIUSCORRECTIE RECHTS
30 ;Einde parameterinvoer
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 ;Gereedschapsoproep frees
36 TOOL CALL 16 Z S4000
37 ;
38 CALL LBL 1
39 ;
40 ;Vrijzetten en programma-einde
41 L  Z+100 R0 FMAX M2
42 ;
43 ;Contourberekening
44 LBL 1
45 FN 4: Q20 =+Q9 DIV +2
46 ;Sleutelwijdte halveren
47 FN 1: Q21 =+Q20 + +Q14 ;Overmaat optellen
Q22 = 360 / Q5 / 2 ;Halve hoekstap bepalen
Q6 = Q21 / COS Q22 ;Hoekradius berekenen
48 ;
49 CC  X+Q1  Y+Q2 ;Middelpunt definiëren
50 FN 0: Q27 =+Q7 ;Actuele hoek = hoek van eerste hoek
51 FN 4: Q28 =+Q108 DIV +2 ;Radius voor naderen en wegtrekken
52 FN 3: Q29 =+Q108 * +2 ;Gereedschapsdiameter
53 FN 1: Q29 =+Q6 + +Q29 ;Radius voor voorpositionering
54 FN 0: Q35 =+1 ;Teller
55 FN 4: Q37 =+360 DIV +Q5 ;Hoekstap
56 FN 3: Q37 =+Q37 * +Q4 ;Hoekstap in de rotatierichting
57 LP  PR+Q29  PA+Q7 R0 FMAX M3 ;Voorpositioneren
58 L  Z+Q10 FMAX ;Z voorpositioneren
59 L  Z+Q3 FQ11 ;Diepteverplaatsing
60 ;Selectie van de baan met radiuscorrectie
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 ;Eerste hoek naderen
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 ;Eerste hoek naderen
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 ;Eerste hoek naderen
74 RND RQ28 FQ12
75 LBL 2
76 FN 1: Q35 =+Q35 + +1 ;Teller verder rekenen
77 FN 1: Q27 =+Q27 + +Q37 ;Hoek verder rekenen
78 LP  PR+Q6  PA+Q27 FQ12 ;Volgende hoek naderen
79 FN 12: IF +Q35 LT +Q5 GOTO LBL 2
80 LP  PR+Q6  PA+Q7 FQ12 ;Eerste/laatste hoek naderen
81 RND RQ28
82 LP  PR+Q29  PA+Q7 R0 FQ12 ;Contour verlaten
83 L  Z+Q10 R0 FMAX ;Z naar veiligheidsafstand verplaatsen
84 LBL 0
85 END PGM 2115_NL MM