0  BEGIN PGM 4020_DE MM 
1  ;Programm zur Bearbeitung einer
2  ;3D-Regelflaeche.
3  ;Das Werkzeug wird dabei in fuenf Achsen
4  ;bewegt. Diese Fuenfachsbewegung ist
5  ;kinematikunabhaengig, lediglich das Zurueck-
6  ;schwenken der Achsen muessen sie auf die
7  ;Maschine angepassen.
8  ;
9  ;Eingabe Parameter
10 FN 0: Q1 =+0 ;X-KOORDINATE 1.PUNKT
11 FN 0: Q2 =+0 ;Y-KOORDINATE 1.PUNKT
12 FN 0: Q3 =-10 ;Z-KOORDINATE 1.PUNKT
13 FN 0: Q4 =+60 ;X-KOORDINATE 2.PUNKT
14 FN 0: Q5 =+0 ;Y-KOORDINATE 2.PUNKT
15 FN 0: Q6 =-25 ;Z-KOORDINATE 2.PUNKT
16 FN 0: Q7 =+60 ;X-KOORDINATE 3.PUNKT
17 FN 0: Q8 =+60 ;Y-KOORDINATE 3.PUNKT
18 FN 0: Q9 =-10 ;Z-KOODINATE 3.PUNKT
19 FN 0: Q10 =+0 ;X-KOORDINATE 4.PUNKT
20 FN 0: Q11 =+60 ;Y-KOORDINATE 4.PUNKT
21 FN 0: Q12 =-5 ;Z-KOORDINATE 4.PUNKT
22 FN 0: Q20 =+500 ;VORSCHUB TIEFENZUSTELLUNG
23 FN 0: Q21 =+1500 ;VORSCHUB FRAESEN
24 FN 0: Q22 =+1000 ;VORSCHUB SEITLICHE ZUSTELLUNG
25 FN 0: Q27 =+1200 ;VORSCHUB RUECKZUG
26 FN 0: Q28 =+9999 ;VORSCHUB VORPOSITIONIEREN
27 FN 0: Q23 =+1 ;AUFMASS TIEFE
28 FN 0: Q24 =+30 ;INKREMENTALE HOEHE BEIM POSITIONIEREN
29 FN 0: Q25 =+50 ;SICHERHEITSABSTAND
30 FN 0: Q26 =+40 ;ANZAHL DER SCHNITTE
31 FN 0: Q29 =+2 ;SCHRUPPFAKTOR
32 ;Parametereingabe Ende
33 ;
34 BLK FORM 0.1 Z X+0 Y+0 Z-60
35 BLK FORM 0.2  X+60  Y+60  Z+0
36 ;
37 ;Werkzeugaufruf Schaftfraeser (schruppen)
38 TOOL CALL 11 Z S15000
39 ;
40 ;Programm 40201_de.h als Zyklus definieren
41 CYCL DEF 12.0 PGM CALL
42 CYCL DEF 12.1 PGM 40201_de.H
43 ;
44 L  A+0  C+0 R0 FQ28 ;Schwenkachsen auf null fahren
45 L  Z+100 R0 FQ28 M3 ;Auf sichere Hoehe fahren
46 CALL LBL 21 ;Berechnungen aufrufen
47 L  X+Q1  Y+Q2 FQ28 M99 ;Startposition anfahren und Zyklus aufrufen
48 ;
49 L  A+0  C+0 R0 FQ28 ;Schwenkachsen auf null fahren
50 M129 ;Function TCPM deaktivieren
51 ;
52 ;Werkzeugaufruf Schaftfraeser (schlichten)
53 TOOL CALL 24 Z S18000
54 ;
55 ;Parameter, die sich fuer das schlichten
56 ;veraendern, eingeben.
57 FN 0: Q20 =+500 ;VORSCHUB TIEFENZUSTELLUNG
58 FN 0: Q21 =+1200 ;VORSCHUB FRAESEN
59 FN 0: Q22 =+1000 ;VORSCHUB SEITLICHE ZUSTELLUNG
60 FN 0: Q27 =+1200 ;VORSCHUB RUECKZUG
61 FN 0: Q28 =+9999 ;VORSCHUB VORPOSITIONIEREN
62 FN 0: Q23 =+0 ;AUFMASS
63 FN 0: Q29 =+1 ;SCHRUPPFAKTOR
64 ;Parametereingabe Ende
65 ;
66 L  Z+100 R0 FQ28 M3 ;Auf sichere Hoehe fahren
67 CALL LBL 21 ;Berechnungen aufrufen
68 L  X+Q1  Y+Q2 R0 FQ28 M99 ;Startposition anfahren und Zyklus aufrufen
69 L  Z+100 R0 FMAX M5 ;Freifahren
70 L  A+0  C+0 R0 FQ28 ;Schwenkachsen auf null fahren
71 FUNCTION RESET TCPM ;Function TCPM zuruecksetzen
72 L  Z+100 R0 FQ28 M30 ;Programmende
73 ;
74 LBL 21 ;Berechnungen
75 Q1013 = ATAN ( ( Q3 - Q6 ) / ( Q4 - Q1 ) )
76 Q1014 = ATAN ( ( Q9 - Q6 ) / ( Q8 - Q5 ) )
77 Q1015 = ATAN ( ( Q12 - Q9 ) / ( Q7 - Q10 ) )
78 Q1016 = ATAN ( ( Q12 - Q3 ) / ( Q11 - Q2 ) )
79 CC  X+Q9  Y+Q1013
80 LBL 0
81 END PGM 4020_DE MM