APT刀轨数据生成NC程序C++源代码

若枫

APT刀轨数据生成NC程序C++源代码，本功能仅作为技术交流研究之用，代码，功能可能存在缺失。需自行编写刀轨数据的读取与处理。以下仅为部分代码以下为头文件部分源代码

1. int  EQ_is_equal (double s, double t);
   
2. int  EQ_is_ge (double s, double t);
   
3. int  EQ_is_gt (double s, double t);
   
4. int  EQ_is_le (double s, double t);
   0 }+ l0 h$ N8 n& j
5. int  EQ_is_lt (double s, double t);
   
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    : t- D" Y! B0 Z! u6 S3 |/ a0 P1 F
12. double CheckConst ( double angle, double constvar  );
    4 I$ ~8 Q& w0 D$ M
13. //#=============================================================
    % ^) @- p2 x! I9 J5 t$ r. @
14. double Check360 ( double angle );
    
15. //#=============================================================
    
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    
17. //#=============================================================

复制代码

以下为部分源代码，用于判断，计算角度等
- X. W0 w) b8 |2 C! S- g

1. int  EQ_is_equal (double s, double t)
   , I, B# [) l9 k
2. 
   / r6 K$ \5 @+ Z/ Z) T( G
3. {
   ) {3 F, [4 I& R+ Q: p# p; w
4. 
   
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   
6. 
   4 o; a$ m7 w$ n8 @! E; d/ m8 A# K
7. }
   * y! f/ L+ I& c/ r+ _5 ?
8. 
   ; F8 p' H2 v  G) ]+ k
9. /***********************************************************************/
   
10. 
    
11. int  EQ_is_ge (double s, double t)
    - M" a9 }; Y+ p3 N
12. 
    
13. {
    
14. 
    6 q, e+ W' u$ y5 p; X! y0 p: x
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    ; b+ z# X1 S- v2 ^5 J& I1 W
17. }
    % q. w% w! u! A% q, n# C
18. 
    
19. /***********************************************************************/
    ( R. b1 Q# B$ t/ _
20. 
    ; N; j* d" p3 D9 J: ?! Q3 b
21. int  EQ_is_gt (double s, double t)
    1 b3 l$ d; W+ r# V* S
22. 
    
23. {
    2 U/ r) n4 M+ `* s5 c+ s' {& L
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    7 ^* W: w- g/ c0 [8 `8 u/ @9 i
26. 
    
27. }
    
28. 
    ; L" w" @8 K, c+ O  @$ |2 T' W
29. /***********************************************************************/
    
30. 
    6 W/ F0 M- f; b% r& m# o
31. int  EQ_is_le (double s, double t)
    1 p1 a; Z' p: P$ R4 _
32. 
    ) Q$ ^( ^6 k3 A7 R) A5 ^' T
33. {
    6 S. c) w" U( {" V9 |6 E' a9 {
34. 
    
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    5 |# u# P/ w: t1 u* j8 [
36. 
    - k. _5 i6 L0 g9 ^, l7 O, W
37. }
    
38. 
    
39. /***********************************************************************/
    
40. 
    
41. int  EQ_is_lt (double s, double t)
    
42. 
    % F! K* T/ q' G2 x& B
43. {
    
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
    
47. }
    
48. 
    . K  V+ A3 [4 I6 w, w
49. /***********************************************************************/
    
50. 
    
51. int  EQ_is_zero (double s)
      G( w, k, D! V/ K( M0 a
52. 
    
53. {
      y& h) f6 \7 H) o% Q3 n
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    
57. }
    5 W, W: T' `3 I% o' r- A# Q. w
58. 
    
59. //=============================================================
    
60. 
    
61. double ARCTAN1 (double y, double x )
    7 A$ Y* k% Z) h" A; N' s
62. 
    - r- _. I1 L. j5 ~3 J' f3 k+ J
63. //#=============================================================
    
64. 
    
65. {
    8 ]) o2 _1 `( Q! E5 c7 J
66. 
    . m. p6 _/ F9 d. S/ v& N
67.    double ang;
    
68. 
    5 v8 D- o" [2 i! u6 O1 C* k8 e
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    8 _3 m. ^$ r/ Z# M' Y4 ~+ ?
72. 
    * v% x% y) C0 Y+ M1 n. h  |; \
73.    if (y == 0 && x == 0) { return(0); }
    
74. 
    ) m" ^6 x: Y/ R3 U* _' ]; D+ [$ o
75.    ang=atan2(y,x);
    
76. 
    5 Y0 d$ o! l4 C; e2 s
77.    if (ang < 0 ) {
    # q* G  K$ ^6 T2 a5 P
78. 
    & x1 }" d. Z. ^3 S0 T
79.       return(ang + PI*2);
    ( J, w' `: B& ^& |
80. 
    " X) |$ G$ {% f* z: H
81.    }
    
82. 
    # j% N( n0 x# f) ?0 H5 N
83.    return(ang);
    
84. 
    $ y7 t% I# h* t
85. }
    
86. 
    * U+ I/ d5 ^4 {  \0 D" B) m/ }# \
87. //#=============================================================
    
88. 
    
89. double ARCTAN2 (double y, double x )
    
90. 
    
91. //#=============================================================
    3 s8 F- ~2 d: g, T
92. 
    % n' C: p. w; z
93. {
    / \2 ?. C! s' o& ]9 T. S, l) U
94. 
    
95.    double ang;
    
96. 
    / D4 c% z" c2 I" Y: A0 O% p: f
97.    if (EQ_is_zero(y)) {
    ; x  z! R0 n1 ]! l) t
98. 
    
99.       if (x < 0.0) { return (PI); }
    # s' B; p. w7 ^: a6 O9 Z
100. 
     * }8 I4 v& [5 w$ T
101.       return (0.0);
     
102. 
     1 k& h9 n( L) ^* o
103.    }
     
104. 
     
105.    if (EQ_is_zero(x)) {
     & T! q% L3 T: v4 j
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     6 {  G9 r  o0 D
108. 
     
109.       return(PI*.5);
     
110. 
     & V1 U" T7 i, T5 {
111.    }
     7 d# L* }$ f" l: v& \/ ~
112. 
     4 |0 t7 {  J& Z7 n+ m4 _
113.    ang=atan(y/x);
     & A1 G. y* _7 A' W" Q* A
114. 
     
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     & b4 j8 @. U% y' N9 o  @
116. 
     
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     ( t0 A9 C% A2 O! l7 O! U) ^) I/ s
118. 
     $ R  o$ i- m# c% _( i
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     
121.    return(ang);
       n7 M# q1 l2 R2 m: K+ U. T
122. 
     $ F) m  k0 Z' G$ ]
123. }
     
124. 
     7 a! V" L9 c# Z& X! ?1 s
125. //#=============================================================
     
126. 
     
127. double CheckConst ( double angle, double constvar  )
     
128. 
     9 V% e$ f! `$ X8 Q/ w
129. //#=============================================================
     
130. 
     
131. {
     & n5 m- d6 S4 g+ f8 A
132. 
     
133.    while (angle < -constvar) { angle+=constvar ; }
     
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     / U# a) I& `+ @6 t, X/ K5 U  @
136. 
     
137.    return (angle) ;
     % U/ ~  h2 V1 j+ c1 y& j: L
138. 
     
139. }
     & H" D& E, z+ Z6 ?
140. 
     7 b' q. c2 Q8 D/ u
141. //#=============================================================
     
142. 
     
143. double Check360 ( double angle )
     / Y! ]) n+ l) L: E
144. 
     / r2 z8 u; j6 \/ ?8 b3 T8 |4 i0 f
145. //#=============================================================
     1 I+ t. B1 y/ H& V# j0 H: [
146. 
     
147. {
     
148. 
     ' m* A+ t7 y9 D0 S
149.    while (angle < -360.) { angle+=360. ; }
     4 K/ @0 X6 H% e- T: w# d( u
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     ( _' l( g: R' _& N, |' W( v" Y
153.    return (angle) ;
     
154. 
       F. ^. z; U+ @* B6 _7 |( {
155. }
     8 _' Z2 _# @$ c5 L8 {, z$ J
156. 
     
157. //#=============================================================
     2 n( t. ]- ~  U
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     # n; Y6 ]% q7 s% l
160. 
     4 E6 i0 F2 e1 [
161. //#=============================================================
     6 t" Z" ^4 s" B, A. r" C
162. 
     & j+ h8 y. ]  X4 c. z
163. {
     
164. 
     
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     
166. 
     ; {/ V( n8 z, U* h9 ?; P% V
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     
169.    return (angle) ;
     0 W1 \" i) @' Q- g8 F
170. 
     
171. }

复制代码

! B! o/ v( P2 {; X# X) K& i2 P以下为摇篮5轴计算过程代码
5 |, L6 L# ?& c3 P* N+ G/ R& b. M

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   
2. 
   
3.          j=0.; B1=0.; B0=0.;
   . _  g: @# ]3 j( h
4. 
   - L7 C# q8 \; ]  l4 F: R
5.           if (EQ_is_ge(i,0.)) {
   
6. 
   
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   4 Z6 m, r" h1 n+ A0 ^4 h
8. 
   
9.           }
   
10. 
    
11.           if (EQ_is_lt(i,0.)) {
    7 |! f9 s( P+ X/ i/ O  C
12. 
    . U% ]( n# A; U" n) X* J) s$ E
13.              if (EQ_is_lt(k,0.)) {
    4 x( v5 A* E% N8 J9 l2 h; `- E
14. 
    + c) R3 ^# i$ M4 D7 ~
15.                 B0=atan(i/k); B1=B0+PI ;
    4 L# c! V# ]: P+ F
16. 
    
17.              } else {
    % [/ A$ @: [; d+ ~% o: ]8 t
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    " `, Y- y0 y, w' N: [8 @
20. 
    
21.               B1=2.*PI+B0 ;
    
22. 
    
23.              }
    
24. 
    
25.           }
      b: i$ ]/ I: c$ t& y# x! h  k
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    / H% J. I; y' ]& V8 a7 o
28. 
    . \7 \5 B& g& Z( B. g
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    7 {3 s+ B, `' H, |  p
30. 
    ! O8 ]5 J4 p% k- V# r- X/ I& w  l
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    
32. 
    
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

  `/ {$ ~; u4 ~! a通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
/ y; a5 p4 J& k* D- B  H
8 @  l6 x4 b6 ?. [0 l2 X
测试结果：
' c- r7 d2 Y" S4 a9 c

2 R- V5 K8 p5 W: f反向测试结果
6 K0 `0 P" @4 i

yucammayco

谢谢分享