0  BEGIN PGM 50802-DE MM 
1  ;Programm Fase Rechteck
2  * - Parameter 1.Fase
3  Q1 = 3 ;FASENLAENGE
4  Q2 = 30 ;FASENWINKEL
5  Q13 = 50 ;LAENGE X
6  Q3 = 40 ;BREITE Y
7  Q5 = 10 ;ECKRADIUS
8  Q4 = 1 ;BEARBEITUNG 1=INNEN 2=AUSSEN
9  TOOL CALL  DL-0.5 ;Ueberlauf um saubere Fasenunterkante zu bekommen
10 ;
11 ;Fase bearbeiten
12 CALL LBL "fase"
13 ;
14 ;Schwenkachsen ruecksetzen
15 PLANE RESET MOVE DIST20 FMAX
16 ;
17 * - Parameter 2. Fase
18 Q1 = 3 ;FASENLAENGE
19 Q2 = 30 ;FASENWINKEL
20 Q13 = 70 ;LAENGE X
21 Q3 = 60 ;BREITE Y
22 Q5 = 15 ;ECKRADIUS
23 Q4 = 2 ;BEARBEITUNG 1=INNEN 2=AUSSEN
24 TOOL CALL  DL-0.5 ;Uebelauf um saubere Fasenunterkante zu bekommen
25 ;
26 ;Fase bearbeiten
27 CALL LBL "fase"
28 ;
29 ;Schwenkachsen ruecksetzen
30 PLANE RESET MOVE DIST20 FMAX
31 ;
32 ;Sprung zum Programmende
33 FN 9: IF +0 EQU +0 GOTO LBL "end"
34 ;
35 ;
36 ;Bearbeitung
37 LBL "fase"
38 ;Abfrage aussen oder innen
39 FN 9: IF +Q4 EQU +1 GOTO LBL "innen"
40 FN 9: IF +Q4 EQU +2 GOTO LBL "aussen"
41 STOP
42 ;Bitte Q4 waehlen aussen oder innen
43 ;
44 LBL "innen"
45 FUNCTION TCPM F CONT AXIS SPAT PATHCTRL VECTOR ;Function TCPM aktivieren
46 FN 11: IF +Q5 GT +0 GOTO LBL "radius"
47 Q5 = Q108
48 LBL "radius"
49 Q10 = Q108 * ( COS Q2 ) ;Berechne WZR-Korrektur Radius
50 Q11 = ( Q3 / 2 ) - Q10 ;Breite Y - WZR-Korrektur Radius
51 Q21 = ( Q3 / 2 ) - Q5 ;Mitte CC Y
52 Q31 = ( Q13 / 2 ) - Q5 ;Mitte CC X
53 Q12 = ( Q1 / TAN Q2 ) - ( SIN Q2 * Q108 ) ;WZR-Korrektur Z
54 QL11 = Q11 - Q108 ;Anfahrposition Y
55 QL12 = Q12 - 2 ;Anfahrposition Z
56 L  X-Q108  Y-QL11  Z+50 R0 FMAX
57 L  A+Q2  B+0  C+0 R0 FMAX ;Wichtig alle drei Rundachsen wegen TCPM ... AXIS SPAT
58 L  Z-QL12 R0 F AUTO
59 CC  X+0  Y-QL11
60 CP  PA-90  Z-Q12 DR+
61 L  X+Q31
62 CC  X+Q31  Y-Q21
63 CP IPA+90 IC+90 DR+
64 L  Y+Q21
65 CC  X+Q31  Y+Q21
66 CP IPA+90 IC+90 DR+
67 L  X-Q31
68 CC  X-Q31  Y+Q21
69 CP IPA+90 IC+90 DR+
70 L  Y-Q21
71 CC  X-Q31  Y-Q21
72 CP IPA+90 IC+90 DR+
73 L  X+0
74 CC  X+0  Y-QL11
75 CP  PA+0  Z-QL12 DR+
76 L IZ+20
77 M140 MB+50
78 FN 9: IF +0 EQU +0 GOTO LBL "reset"
79 ;
80 LBL "aussen"
81 FUNCTION TCPM F CONT AXIS SPAT PATHCTRL VECTOR
82 Q10 = Q108 * ( COS Q2 ) ;Berechne WZR-Korrektur Radius
83 Q11 = ( Q3 / 2 ) + Q10 ;Breite Y + WZR-Korrektur Radius
84 Q12 = ( Q1 / TAN Q2 ) - ( SIN Q2 * Q108 ) ;WZR-Korrektur Z
85 Q21 = ( Q3 / 2 ) - Q5 ;Mitte CC Y
86 Q31 = ( Q13 / 2 ) - Q5 ;Mitte CC X
87 QL11 = Q11 + Q108 ;Anfahrposition Y
88 QL12 = Q12 - 2 ;Anfahrposition Z
89 L  X+Q108  Y-QL11  Z+50 R0 FMAX
90 L  A-Q2  B+0  C+0 R0 FMAX ;Wichtig alle drei Rundachsen wegen TCPM ... AXIS SPAT
91 L  Z-QL12 R0 F AUTO
92 CC  X+0  Y-QL11
93 CP IPA+90  Z-Q12 DR+
94 L  X-Q31
95 CC  X-Q31  Y-Q21
96 CP IPA-90 IC-90 DR-
97 L  Y+Q21
98 CC  X-Q31  Y+Q21
99 CP IPA-90 IC-90 DR-
100 L  X+Q31
101 CC  X+Q31  Y+Q21
102 CP IPA-90 IC-90 DR-
103 L  Y-Q21
104 CC  X+Q31  Y-Q21
105 CP IPA-90 IC-90 DR-
106 L  X+0
107 CC  X+0  Y-QL11
108 CP  PA+180  Z-QL12 DR+
109 L IZ+20
110 M140 MB+50
111 ;
112 LBL "reset"
113 FUNCTION RESET TCPM
114 LBL 0
115 LBL "end"
116 END PGM 50802-DE MM