0  BEGIN PGM 50801-DE MM 
1  ;Programm Fase Kreis
2  * - Parameter 1.Fase
3  Q1 = 3 ;FASENLAENGE
4  Q2 = 30 ;FASENWINKEL
5  Q3 = 70 ;DURCHMESSER KREIS
6  Q4 = 2 ;BEARBEITUNG 1=INNEN 2=AUSSEN
7  TOOL CALL  DL-0.5 ;Ueberlauf um saubere Fasenunterkante zu bekommen
8  ;Fase bearbeiten
9  CALL LBL "fase"
10 ;
11 ;Schwenkachsen ruecksetzen
12 PLANE RESET MOVE DIST20 FMAX
13 ;
14 ;Parameter 2.Fase
15 Q1 = 3 ;FASENLAENGE
16 Q2 = 30 ;FASENWINKEL
17 Q3 = 50 ;DURCHMESSER KREIS
18 Q4 = 1 ;BEARBEITUNG 1=INNEN  2=AUSSEN
19 ;
20 ;Fase bearbeiten
21 CALL LBL "fase"
22 ;
23 ;Schwenkachsen ruecksetzen
24 PLANE RESET MOVE DIST20 FMAX
25 ;
26 ;Sprung zum Programmende
27 FN 9: IF +0 EQU +0 GOTO LBL "end"
28 ;
29 ;
30 ;Bearbeitung
31 LBL "fase"
32 ;Abfrage aussen oder innen
33 FN 9: IF +Q4 EQU +1 GOTO LBL "innen"
34 FN 9: IF +Q4 EQU +2 GOTO LBL "aussen"
35 STOP
36 ;Bitte Q4 waehlen aussen oder innen
37 ;
38 LBL "innen"
39 FUNCTION TCPM F CONT AXIS SPAT PATHCTRL VECTOR ;Function TCPM aktivieren
40 Q10 = Q108 * ( COS Q2 ) ;Berechne WZR-Korrektur Radius
41 Q11 = ( Q3 / 2 ) - Q10 ;Durchmesser - WZR-Korrektur Radius
42 Q12 = ( Q1 / TAN Q2 ) - ( SIN Q2 * Q108 ) ;WZR-Korrektur Z
43 QL11 = Q11 - Q108 ;Anfahrposition Y
44 QL12 = Q12 - 2 ;Anfahrposition Z
45 L  X-Q108  Y-QL11  Z+50 R0 FMAX
46 L  A+Q2  B+0  C+0 R0 FMAX ;Wichtig alle drei Rundachsen wegen TCPM ... AXIS SPAT
47 L  Z-QL12 R0 F AUTO
48 CC  X+0  Y-QL11
49 CP  PA-90  Z-Q12 DR+
50 CC  X+0  Y+0
51 CP IPA+90 IC+90 DR+ F AUTO
52 CP IPA+90 IC+90 DR+
53 CP IPA+90 IC+90 DR+
54 CP IPA+90 IC+90 DR+
55 CC  X+0  Y-QL11
56 CP  PA+0  Z-QL12 DR+
57 L IZ+20
58 FN 9: IF +0 EQU +0 GOTO LBL "reset"
59 ;
60 LBL "aussen"
61 FUNCTION TCPM F CONT AXIS SPAT PATHCTRL VECTOR
62 Q10 = Q108 * ( COS Q2 ) ;Berechne WZR-Korrektur Radius
63 Q11 = ( Q3 / 2 ) + Q10 ;Durchmesser + WZR-Korrektur Radius
64 Q12 = ( Q1 / TAN Q2 ) - ( SIN Q2 * Q108 ) ;WZR-Korrektur Z
65 QL11 = Q11 + Q108 ;Anfahrposition Y
66 QL12 = Q12 - 2 ;Anfahrposition Z
67 L  X+Q108  Y-QL11  Z+50 R0 FMAX
68 L  A-Q2  B+0  C+0 R0 FMAX ;Wichtig alle drei Rundachsen wegen TCPM ... AXIS SPAT
69 L  Z-QL12 R0 F AUTO
70 CC  X+0  Y-QL11
71 CP IPA+90  Z-Q12 DR+
72 CC  X+0  Y+0
73 CP IPA-90 IC-90 DR- F AUTO
74 CP IPA-90 IC-90 DR-
75 CP IPA-90 IC-90 DR-
76 CP IPA-90 IC-90 DR-
77 CC  X+0  Y-QL11
78 CP  PA+180  Z-QL12 DR+
79 L IZ+20
80 ;
81 LBL "reset"
82 FUNCTION RESET TCPM
83 LBL 0
84 LBL "end"
85 END PGM 50801-DE MM