0 BEGIN PGM 2035_NL MM 
1 ;Programma voor het frezen van een spiraal
2 ;in X/Y vlak.
3 ;Uit de ingevoerde parameters berekent de
4 ;besturing de gereedschapsbaan die uit
5 ;afzonderlijke lineaire regels bestaat. Van
6 ;waaruit de besturing de eindpunten in X en
7 ;Y bepaalt. Met de in te voeren verdeling
8 ;definieert u in hoeveel lineaire regels een
9 ;baan van 360 graden baan wordt opgedeeld.
10 ;Op deze baan van 360 graden verrekent de
11 ;besturing eveneens de ingevoerde spoed. De 
12 ;gereedschapsbewegingen in de Z-as worden
13 ;loodrecht verplaatst.
14 ;
15 BLK FORM 0.1 Z X+0 Y+0 Z-20
16 BLK FORM 0.2  X+100  Y+100  Z+0
17 ;
18 ;Gereedschapsoproep
19 TOOL CALL 5 Z S4000
20 ;
21 ;Invoer parameters
22 FN 0: Q1 =+50 ;MIDDELPUNT OP DE X-AS
23 FN 0: Q2 =+50 ;MIDDELPUNT OP DE Y-AS
24 FN 0: Q3 =-15 ;DIEPTE
25 FN 0: Q4 =+1 ;ROTATIERICHTING
26 ;            ;+1= LINKSOM
27 ;            ;-1 = RECHTSOM
28 FN 0: Q5 =+180 ;VERDELING (AANTAL
29 ;              ;LINEAIRE REGELS OP 360 GRADEN)
30 FN 0: Q6 =+10 ;STARTRADIUS
31 FN 0: Q16 =+47 ;EINDRADIUS
32 FN 0: Q7 =+90 ;STARTHOEK
33 FN 0: Q8 =+10 ;SPOED IN MM OP 360 GRADEN
34 FN 0: Q10 =+2 ;VEILIGHEIDSAFSTAND
35 FN 0: Q11 =+100 ;AANZET DIEPTEVERPLAATSING
36 FN 0: Q12 =+300 ;AANZET FREZEN
37 FN 0: Q14 =+0 ;ZIJDELINGSE OVERMAAT
38 FN 0: Q15 =+0 ;RADIUSCORRECTIE
39 ;             ;0 = GEEN RADIUSCORRECTIE
40 ;             ;+1 = GEREEDSCHAP WORDT VERPLAATST
41 ;             ;BUITEN DE CONTOUR
42 ;             ;;-1 = GEREEDSCHAP WORDT VERPLAATST
43 ;             ;BINNEN DE CONTOUR
44 ;Einde parameterinvoer
45 ;
46 L  X+Q1  Y+Q2 R0 FMAX M3 ;Voorpositioneren
47 L  Z+Q10 R0 FMAX
48 CALL LBL 1
49 ;Einde van programma
50 L  Z+100 R0 FMAX M5 M2
51 ;
52 ;
53 LBL 1 ;Berekeningen
54 CC  X+Q1  Y+Q2 ;Middelpunt instellen
55 FN 3: Q38 =+Q108 * +Q15 ;Radiuscorrectie verrekenen
56 FN 3: Q39 =+Q14 * +Q15 ;Overmaat verrekenen
57 FN 1: Q26 =+Q6 + +Q38 ;Startradius met radiuscorrectie
58 FN 1: Q26 =+Q26 + +Q39 ;Effectieve startradius (incl. overmaat)
59 FN 0: Q27 =+Q7 ;Actuele hoek = starthoek
60 FN 4: Q36 =+Q8 DIV +Q5 ;Radiusstap vastleggen
61 FN 8: Q36 =+Q36 LEN +0 ;Vastleggen dat met positieve waarden wordt gerekend
62 FN 4: Q37 =+360 DIV +Q5 ;Hoekstap vastleggen
63 FN 3: Q37 =+Q37 * +Q4 ;Hoekstap met rotatierichting verrekenen
64 ;
65 ;
66 LP  PR+Q26  PA+Q7 R0 F9999 M3 ;Naar startpositie verplaatsen
67 L  Z+Q3 FQ11 ;insteken
68 ;
69 LBL 2 ;Herhaling
70 FN 1: Q26 =+Q26 + +Q36 ;Radius verder rekenen
71 FN 1: Q27 =+Q27 + +Q37 ;Hoek verder rekenen
72 ;Coördinaten X en Y berekenen
73 FN 7: Q21 = COS +Q27
74 FN 3: Q21 =+Q21 * +Q26
75 FN 1: Q21 =+Q21 + +Q1
76 FN 6: Q22 = SIN +Q27
77 FN 3: Q22 =+Q22 * +Q26
78 FN 1: Q22 =+Q22 + +Q2
79 ;Controle of eindradius bereikt
80 FN 11: IF +Q26 GT +Q16 GOTO LBL 99 ;
81 ;Nieuwe X- en Y-positie naderen
82 L  X+Q21  Y+Q22  Z+Q3 FQ12
83 ;Wanneer de eindradius niet bereikt is, dan
84 ;sprong naar herhaling
85 FN 12: IF +Q26 LT +Q16 GOTO LBL 2
86 ;
87 LBL 99 ;Spiraal gereed
88 L  Z+Q10 F9999 ;Verplaatsen naar veiligheidsafstand
89 LBL 0
90 END PGM 2035_NL MM