0 BEGIN PGM 7125_nl MM 
1 ;Programma voor bewerking aan buitenzijde
2 ;van een halve bol met een torusfrees.
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 beïnvloeden daardoor de
9 ;nauwkeurigheid.
10 ;
11 BLK FORM 0.1 Z X-30 Y-30 Z-40
12 BLK FORM 0.2  X+30  Y+30  Z+0
13 ;
14 ;Invoer parameters
15 FN 0: Q1 =+0 ;MIDDELPUNT VAN DE KOGEL OP DE X-AS
16 FN 0: Q2 =+0 ;MIDDELPUNT VAN DE KOGEL OP DE Y-AS
17 FN 0: Q3 =-30 ;MIDDELPUNT VAN DE KOGEL OP DE Z-AS
18 FN 0: Q4 =+45 ;VERDELING VERTICAAL
19 ;             ;DEFINIEERT IN HOEVEEL SPIRAALBANEN 
20 ;             ;VAN 360 GRADEN VAN BOVEN NAAR 
21 ;             ;BENEDEN WORDEN VERPLAATST
22 FN 0: Q5 =+180 ;VERDELING HORIZONTAAL
23 ;              ;;DEFINIEERT IN HOEVEEL LINEAIRE
24 ;              ;BANEN EEN CIRKELBAAN VAN 360 GRADEN 
25 ;              ;WORDT OPGEDEELD.
26 FN 0: Q6 =+30 ;KOGELRADIUS
27 FN 0: Q7 =+90 ;STARTHOEK IN DE VERTICAAL
28 FN 0: Q8 =+0 ;STARTHOEK IN HET X/Y-VLAK
29 FN 0: Q10 =+150 ;AANZET DIEPTEVERPLAATSING
30 FN 0: Q11 =+1000 ;AANZET SPIRAALBAAN
31 FN 0: Q13 =+3 ;SNIJRADIUS VAN GEREEDSCHAP
32 FN 0: Q15 =+2 ;VEILIGHEIDSAFSTAND
33 FN 0: Q17 =+0 ;EINDHOEK IN DE VERTICAAL
34 ;Einde parameterinvoer
35 ;
36 ;Gereedschapsoproep torusfrees
37 TOOL CALL 112 Z S3000 DL-Q13
38 ;
39 ;Voorpositioneren
40 L  X+Q1  Y+Q2 R0 FMAX M3
41 FN 1: Q16 =+Q15 + +Q13
42 L  Z+Q16 FMAX
43 CALL LBL 1 ;Oproep spiraalbeweging
44 ;
45 ;Einde programma
46 L  Z+100 R0 FMAX M30
47 ;
48 ;Spiraalbeweging
49 LBL 1
Q14 = Q108 - Q13 ;Verrekening gereedschapsradius
Q26 = Q6 + Q13 ;Effectieve radius tot midden van snijkant
50 FN 0: Q27 =+Q7 ;Actuele hoek verticaal=starthoek verticaal
51 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
52 CALL LBL 10
53 L  X+Q21  Y+Q22  Z+Q23 R0 FQ10 ;Verplaats naar 1e positie
54 ;
55 ;Oproep berekeningen, hoekvergelijking en aan het
56 ;einde een volledige cirkelbaan
57 LBL 2
58 CALL LBL 10
59 L  X+Q21  Y+Q22  Z+Q23 FQ11
60 FN 11: IF +Q27 GT +Q17 GOTO LBL 2
61 CC  X+Q1  Y+Q2
62 CP IPA-360 DR- FQ11
63 LBL 0
64 ;
65 ;Berekening X-,Y-,Z-positie en nieuwe hoeken
66 LBL 10
Q20 = COS Q27 * Q26 + Q14
Q21 = COS Q28 * Q20 + Q1
Q22 = SIN Q28 * Q20 + Q2
Q23 = SIN Q27 * Q26 + Q3
Q27 = Q27 + Q37
Q28 = Q28 + Q38
67 LBL 0
68 END PGM 7125_nl MM