0 BEGIN PGM 7130_nl MM 
1 ;Programma voor bewerking aan binnenzijde
2 ;van een halve bol met een kogelfrees.
3 ;De bewerking vindt plaats in een
4 ;spiraalvormige beweging. Deze beweging
5 ;wordt in afzonderlijke lineaire bewegingen
6 ;opgedeeld. De verdelingen definiëren in
7 ;hoeveel lineaire bewegingen de baan wordt
8 ;opgedeeld, en bepalen daarmee de
9 ;nauwkeurigheid en kwaliteit van het
10 ;oppervlak.
11 ;
12 BLK FORM 0.1 Z X-40 Y-40 Z-40
13 BLK FORM 0.2  X+40  Y+40  Z+0
14 ;
15 ;Invoer parameters
16 FN 0: Q1 =+0 ;MIDDELPUNT VAN DE KOGEL OP DE X-AS
17 FN 0: Q2 =+0 ;MIDDELPUNT VAN DE KOGEL OP DE Y-AS
18 FN 0: Q3 =+0 ;MIDDELPUNT VAN DE KOGEL OP DE Z-AS
19 FN 0: Q4 =+30 ;VERDELING VERTICAAL
20 ;             ;DEFINIEERT IN HOEVEEL SPIRAALBANEN 
21 ;             ;VAN 360 GRADEN VAN BOVEN NAAR BENEDEN
22 ;             ;WORDEN VERPLAATST
23 FN 0: Q5 =+120 ;VERDELING HORIZONTAAL
24 ;              ;DEFINIEERT IN HOEVEEL LINEAIRE 
25 ;              ;BANEN EEN CIRKELBAAN VAN 360 GRADEN 
26 ;              ;WORDT OPGEDEELD
27 FN 0: Q6 =+35 ;KOGELRADIUS
28 FN 0: Q7 =+0 ;STARTHOEK IN DE VERTICAAL
29 FN 0: Q8 =+0 ;STARTHOEK IN HET X/Y-VLAK
30 FN 0: Q10 =+150 ;AANZET DIEPTEVERPLAATSING
31 FN 0: Q11 =+1000 ;AANZET SPIRAALBAAN
32 FN 0: Q12 =+3 ;VEILIGHEIDSAFSTAND
33 FN 0: Q13 =+8 ;KOGELRADIUS GEREEDSCHAP
34 FN 0: Q17 =-89.999 ;EINDHOEK IN DE VERTICAAL
35 ;Einde parameterinvoer
36 ;
37 ;Gereedschapsoproep kogelfrees
38 TOOL CALL 159 Z S9000 DL-Q13
39 ;
40 ;Voorpositioneren
41 L  X+Q1  Y+Q2 R0 FMAX M3
42 FN 1: Q18 =+Q12 + +Q13
43 L  Z+Q18 FMAX
44 CALL LBL 1 ;Oproep spiraalbeweging
45 ;
46 ;Einde programma
47 L  Z+100 R0 F9999 M30
48 ;
49 ;Spiralbewegung
50 LBL 1
Q26 = Q6 - Q13 ;Effectieve radius tot het middelpunt van het gereedschap
51 FN 0: Q27 =+Q7 ;Actuele hoek verticaal=starthoek verticaal
52 FN 0: Q28 =+Q8 ;Actuele hoek vlak X/Y=starthoek vlak X/Y
Q37 = ( Q17 - Q7 ) / Q4 / Q5 ;Hoekstap verticaal
Q38 = - 360 / Q5 ;Hoekstap vlak X/Y
53 CALL LBL 10 ;Oproep berekeningen
54 L  X+Q21  Y+Q22  Z+Q23 R0 FQ10 ;Naar 1e positie verplaatsen
55 LBL 2
56 CALL LBL 10 ;Oproep berekeningen
57 L  X+Q21  Y+Q22  Z+Q23 FQ11 ;Nieuwe positie benaderen
58 FN 11: IF +Q27 GT +Q17 GOTO LBL 2
59 L  Z+Q18 FMAX ;Vrijzetten
60 LBL 0
61 ;Berekening X-,Y-,Z-positie en nieuwe hoeken
62 LBL 10
Q20 = COS Q27 * Q26
Q21 = COS Q28 * Q20 + Q1
Q22 = SIN Q28 * Q20 + Q2
Q23 = SIN Q27 * Q26 + Q3
Q27 = Q27 + Q37
Q28 = Q28 + Q38
63 LBL 0
64 END PGM 7130_nl MM