0  BEGIN PGM 40201-EN MM 
1  ;Program for path calculation and path contour
2  ;for machining a 3-D ruled surface in five axes.
3  FUNCTION TCPM F CONT AXIS SPAT PATHCTRL VECTOR
4  L  A+Q1016  B+Q1013  C+0 R0 FQ28 M3
5  L  Z+Q25 R0 FQ28
6  CALL LBL 1
7  CALL LBL 2
8  FN 9: IF +0 EQU +0 GOTO LBL 20
9  LBL 1 ;START VALUES
10 FN 0: Q30 =+0
11 FN 4: Q46 =+Q26 DIV +Q29
12 FN 0: Q31 =+Q1
13 FN 0: Q32 =+Q2
14 FN 1: Q33 =+Q3 + +Q23
15 FN 0: Q34 =+Q4
16 FN 0: Q35 =+Q5
17 FN 1: Q36 =+Q6 + +Q23
18 FN 1: Q37 =+Q33 + +Q24
19 FN 1: Q38 =+Q36 + +Q24
20 FN 0: Q39 =+Q1013
21 FN 1: Q61 =+Q3 + +Q23
22 FN 1: Q65 =+Q61 + +Q24
23 FN 1: Q62 =+Q6 + +Q23
24 FN 1: Q66 =+Q62 + +Q24
25 FN 1: Q63 =+Q9 + +Q23
26 FN 1: Q67 =+Q63 + +Q24
27 FN 1: Q64 =+Q12 + +Q23
28 FN 1: Q68 =+Q64 + +Q24
29 LBL 0
30 LBL 2 ;DELTAS
31 FN 2: Q51 =+Q10 - +Q1
32 FN 4: Q51 =+Q51 DIV +Q46
33 FN 2: Q52 =+Q11 - +Q2
34 FN 4: Q52 =+Q52 DIV +Q46
35 FN 2: Q53 =+Q12 - +Q3
36 FN 4: Q53 =+Q53 DIV +Q46
37 FN 2: Q54 =+Q7 - +Q4
38 FN 4: Q54 =+Q54 DIV +Q46
39 FN 2: Q55 =+Q8 - +Q5
40 FN 4: Q55 =+Q55 DIV +Q46
41 FN 2: Q56 =+Q9 - +Q6
42 FN 4: Q56 =+Q56 DIV +Q46
43 FN 0: Q43 =+Q1013
44 FN 12: IF +Q1013 LT +180 GOTO LBL 13
45 FN 2: Q43 =+Q1013 - +360
46 LBL 13
47 FN 0: Q45 =+Q1015
48 FN 12: IF +Q1015 LT +180 GOTO LBL 15
49 FN 2: Q45 =+Q1015 - +360
50 LBL 15
51 FN 2: Q50 =+Q45 - +Q43
52 FN 4: Q50 =+Q50 DIV +Q46
53 FN 0: Q40 =+Q21
54 FN 0: Q41 =+Q21
55 FN 8: Q47 =+Q54 LEN +Q55
56 FN 8: Q42 =+Q51 LEN +Q52
57 FN 1: Q42 =+Q42 + +Q47
58 FN 4: Q42 =+Q108 DIV +Q42
59 FN 3: Q42 =+Q42 * +4
60 FN 3: Q42 =+Q21 * +Q42
61 FN 4: Q42 =+Q42 DIV +2
62 FN 0: Q43 =+Q21
63 LBL 0
64 LBL 3 ;UPDATING
65 FN 1: Q30 =+Q30 + +Q29
66 FN 1: Q31 =+Q31 + +Q51
67 FN 1: Q32 =+Q32 + +Q52
68 FN 1: Q33 =+Q33 + +Q53
69 FN 1: Q34 =+Q34 + +Q54
70 FN 1: Q35 =+Q35 + +Q55
71 FN 1: Q36 =+Q36 + +Q56
72 FN 1: Q37 =+Q33 + +Q108
73 FN 1: Q37 =+Q37 + +Q24
74 FN 1: Q38 =+Q36 + +Q108
75 FN 1: Q38 =+Q38 + +Q24
76 FN 0: Q40 =+Q42
77 FN 1: Q39 =+Q39 + +Q50
78 LBL 0
79 LBL 20
80 L  X+Q1  Y+Q2  A+Q1016  B+Q1013 R0 FQ28
81 L  Z+Q25 R0 FQ42
82 L  X+Q31  Y+Q32  Z+Q33 R0 FQ20
83 L  X+Q34  Y+Q35  Z+Q36  A+Q1014  B+Q1013 R0 FQ21
84 L  X+Q34  Y+Q35  Z+Q38 R0 FQ20
85 L  X+Q31  Y+Q32  Z+Q37  A+Q1016  B+Q1013 R0 FQ21
86 LBL 10
87 CALL LBL 3
88 L  X+Q31  Y+Q32  Z+Q33  A+Q1016  B+Q39 R0 FQ22
89 L  X+Q34  Y+Q35  Z+Q36  A+Q1014  B+Q39 R0 FQ40
90 FN 9: IF +Q30 EQU +Q26 GOTO LBL 99
91 FN 11: IF +Q30 GT +Q26 GOTO LBL 99
92 L
93 L  X+Q34  Y+Q35  Z+Q38  A+Q1014  B+Q39 R0 FQ27
94 L  X+Q31  Y+Q32  Z+Q37  A+Q1016  B+Q39 R0 FQ28
95 L  X+Q31  Y+Q32  Z+Q33  A+Q1016  B+Q39 R0 FQ42
96 FN 9: IF +Q30 EQU +Q26 GOTO LBL 10
97 FN 12: IF +Q30 LT +Q26 GOTO LBL 10
98 LBL 99
99 L  Z+Q25  A+0  B+0  C+0 R0 FQ28
100 FUNCTION RESET TCPM
101 END PGM 40201-EN MM