0  BEGIN PGM 50802-en MM 
1  ;Program chamfer rectangular
2  * - Parameters first chamfer
3  Q1 = 3 ;CHAMFER LENGTH
4  Q2 = 30 ;CHAMFER ANGLE
5  Q13 = 50 ;LENGTH X
6  Q3 = 40 ;WIDTH Y
7  Q5 = 10 ;CORNER RADIUS
8  Q4 = 1 ;1=INSIDE 2=OUTSIDE PROCESSING
9  TOOL CALL  DL-0.5 ;Overflow to get smooth edges
10 ;
11 ;Milling chamfer
12 CALL LBL "chamfer"
13 ;
14 ;Reset tilt axis
15 PLANE RESET MOVE DIST20 FMAX
16 ;
17 * - Parameters secound chamfer
18 Q1 = 3 ;CHAMFER LENGTH
19 Q2 = 30 ;CHAMFER ANGLE
20 Q13 = 70 ;LENGTH X
21 Q3 = 60 ;WIDTH Y
22 Q5 = 15 ;CORNER RADIUS
23 Q4 = 2 ;1=INSIDE 2=OUTSIDE PROCESSING
24 TOOL CALL  DL-0.5 ;Overflow to get smooth edges
25 ;
26 ;Milling chamfer
27 CALL LBL "chamfer"
28 ;
29 ;Reset tilt axis
30 PLANE RESET MOVE DIST20 FMAX
31 ;
32 ;Jump to End of program
33 FN 9: IF +0 EQU +0 GOTO LBL "end"
34 ;
35 ;
36 ;Processing
37 LBL "chamfer"
38 ;Query whether inside or outside processing
39 FN 9: IF +Q4 EQU +1 GOTO LBL "inside"
40 FN 9: IF +Q4 EQU +2 GOTO LBL "outside"
41 STOP
42 ;Please choose Q4 -inside or outside processing
43 ;
44 LBL "inside"
45 FUNCTION TCPM F CONT AXIS SPAT PATHCTRL VECTOR ;activate Function TCPM
46 FN 11: IF +Q5 GT +0 GOTO LBL "radius"
47 Q5 = Q108
48 LBL "radius"
49 Q10 = Q108 * ( COS Q2 ) ;Calculate tool radius correction
50 Q11 = ( Q3 / 2 ) - Q10 ;Width Y - tool radius correction
51 Q21 = ( Q3 / 2 ) - Q5 ;Center CC Y
52 Q31 = ( Q13 / 2 ) - Q5 ;Center CC X
53 Q12 = ( Q1 / TAN Q2 ) - ( SIN Q2 * Q108 ) ;Tool correction Z-axis
54 QL11 = Q11 - Q108 ;Preposition Y
55 QL12 = Q12 - 2 ;Preposition Z
56 L  X-Q108  Y-QL11  Z+50 R0 FMAX
57 L  A+Q2  B+0  C+0 R0 FMAX ;Important to enter all three rotary axis,~
 because Function TCPM ... AXIS STAT is used
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 "outside"
81 FUNCTION TCPM F CONT AXIS SPAT PATHCTRL VECTOR
82 Q10 = Q108 * ( COS Q2 ) ;Calculate tool radius correction
83 Q11 = ( Q3 / 2 ) + Q10 ;Width Y + toll radius correction
84 Q12 = ( Q1 / TAN Q2 ) - ( SIN Q2 * Q108 ) ;Tool corrction Z/axis
85 Q21 = ( Q3 / 2 ) - Q5 ;Center CC Y
86 Q31 = ( Q13 / 2 ) - Q5 ;Center CC X
87 QL11 = Q11 + Q108 ;Preposition Y
88 QL12 = Q12 - 2 ;Preposition Z
89 L  X+Q108  Y-QL11  Z+50 R0 FMAX
90 L  A-Q2  B+0  C+0 R0 FMAX ;Important to enter all three rotarz axis,~
 because Function TCPM ... AXIS SPAT is used
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-en MM