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);
   - J5 ?/ C6 ]  A
4. int  EQ_is_le (double s, double t);
   
5. int  EQ_is_lt (double s, double t);
   - c1 x  T+ \% |' {6 V/ d: C# |  `
6. int  EQ_is_zero (double s);
   - N4 p0 H' t4 T' _
7. //=============================================================
   7 x: e) x4 ~  r) P5 Z
8. double ARCTAN1 (double y, double x );
   2 x1 O( \2 r3 m8 I
9. //#=============================================================
   2 ?% R$ u9 |% m% h6 i# s
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    0 z2 s( S/ ~5 {
13. //#=============================================================
    
14. double Check360 ( double angle );
    " |- n5 y1 V; i6 l) B6 i
15. //#=============================================================
    
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
      r' ~  L6 D6 Y
17. //#=============================================================

复制代码

以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   
2. 
   ' \# k- B/ H* s" }/ P1 l% T/ j
3. {
   
4. 
   / o7 w; ^' h# l, d2 o% Y4 F8 p/ ?  y; R
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   * N. ?4 F5 i. L. O! C2 |
6. 
   . u" ^+ B! ^9 A! b/ P
7. }
   
8. 
   * Z8 Q# u/ D2 O% N& T4 u
9. /***********************************************************************/
   1 u7 s* f9 h( m  |" Y
10. 
    
11. int  EQ_is_ge (double s, double t)
    . y" O; x% v. G* f8 Q
12. 
    
13. {
    
14. 
    2 V$ N! O8 p: f1 M& |
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    
17. }
    
18. 
    8 g) U" s" S% ?$ ?# G0 l+ b9 R
19. /***********************************************************************/
    
20. 
    6 u3 i( l* j1 q+ w
21. int  EQ_is_gt (double s, double t)
    7 P% ?0 d  G* F! \2 t( d+ m+ `: R- U. t
22. 
    0 l- Y" b% s3 p7 n  M' s* _4 P
23. {
    & d2 G% ]7 T5 m; m7 m3 F4 a
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    8 d4 ?3 F, Q* \
26. 
    
27. }
    1 H0 J  G& N3 k8 x5 {
28. 
    
29. /***********************************************************************/
    
30. 
    9 u9 [1 }# }8 P! X
31. int  EQ_is_le (double s, double t)
    
32. 
    $ D+ I4 d4 H; F) m4 y. v0 r6 P5 s
33. {
    
34. 
    0 a4 S. [# q; f* R
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    ! J1 l, a9 d" ~3 ?: D
36. 
    9 r- b+ a. E7 C
37. }
    2 O7 o# X4 z* G0 Q
38. 
    % n7 J$ w3 u2 ^
39. /***********************************************************************/
    
40. 
    
41. int  EQ_is_lt (double s, double t)
    4 [1 D2 v" Q& `- r
42. 
    
43. {
    / Y/ P+ L7 ]- S8 f* u; z9 r
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    / d1 T* S5 P2 ^/ y5 q" b/ W
46. 
    4 v$ A# T3 Z; C
47. }
    
48. 
    
49. /***********************************************************************/
    
50. 
    
51. int  EQ_is_zero (double s)
    
52. 
    6 T6 ?3 T/ i1 ~& R
53. {
    / v! S$ K' Z. A
54. 
    8 S8 o; M$ _+ F0 R$ t' \
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    
57. }
    6 e5 V% D3 x" P4 m& [  F+ q9 z" r
58. 
    8 i% B7 y7 {% D
59. //=============================================================
    % }/ Z: H* R3 D4 Y7 u
60. 
    
61. double ARCTAN1 (double y, double x )
    
62. 
    % O1 f! I: n4 m
63. //#=============================================================
    ; H/ t6 I! t  s3 @& D5 ]
64. 
    ) f* I- N7 Z& H% s
65. {
    / p! c% b* X, l. A
66. 
    % c$ f9 h) j- W, l3 S* B7 K
67.    double ang;
    ( Q6 X: p/ H+ @" @: J
68. 
    & J2 H' F. c- y- U
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    , e% d& Y) Z  y2 L
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    
74. 
    
75.    ang=atan2(y,x);
    
76. 
    - O4 z0 X$ O# ~' E
77.    if (ang < 0 ) {
    
78. 
    0 Z3 Z; j! m. \, k- k9 Z5 k+ _
79.       return(ang + PI*2);
    
80. 
    
81.    }
    2 ~. k$ `: V0 |7 S4 A
82. 
    
83.    return(ang);
    3 O) \+ b& s( K6 m, a
84. 
    5 @& [. [8 D; Q7 u) ?# J( t
85. }
    
86. 
    
87. //#=============================================================
    " ~( `: ^* H8 S( O8 h
88. 
      U. c* m9 S; P2 p( Z: }9 C
89. double ARCTAN2 (double y, double x )
    7 `; X1 c! u6 T' U+ H& K9 g. Q
90. 
    , t& D% H7 A; I
91. //#=============================================================
    ) b4 F4 [1 O- g
92. 
    ! O8 Z, n/ S* L3 g
93. {
    * I6 y/ X% k2 U1 B$ u3 a2 P
94. 
    ' U4 x0 I4 ^+ _! V( ^
95.    double ang;
    
96. 
    2 O3 G5 ]3 S' y
97.    if (EQ_is_zero(y)) {
    2 |) u1 }. x0 d- g3 e
98. 
    
99.       if (x < 0.0) { return (PI); }
    ( \' M, w8 Z; z( g4 H
100. 
     3 d/ t) |1 h! z( ^7 c1 M
101.       return (0.0);
     
102. 
     
103.    }
     
104. 
     
105.    if (EQ_is_zero(x)) {
     
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     ; Q! M1 f- T& P1 o# Q
108. 
     
109.       return(PI*.5);
     7 W# v$ e- `) r+ y
110. 
     9 z. H0 V  c! y  i
111.    }
       W0 y- S' I6 z6 u% c6 Y
112. 
     
113.    ang=atan(y/x);
     
114. 
     8 }& Y/ s, x' D: V8 r7 C' y3 W9 F8 w
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     - k+ `% c8 V" Y
116. 
     ; z( N) p2 J4 j0 x1 g7 C, S$ ~3 ]
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     & G, I/ X0 o- u' Z
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     ! J: p  X% V  m2 R5 }
120. 
     
121.    return(ang);
     ) c7 Z5 n+ a# P
122. 
     
123. }
     ' N- G# [  l0 D; O0 ~9 [
124. 
     
125. //#=============================================================
     
126. 
     & h, a0 s2 G& @/ Z7 l, W/ y
127. double CheckConst ( double angle, double constvar  )
     
128. 
     1 W3 T) X& Y) y9 R
129. //#=============================================================
     2 r( P+ `' H% y$ r6 a" E
130. 
     ) \& \- ~' u- D3 c; V
131. {
     
132. 
     
133.    while (angle < -constvar) { angle+=constvar ; }
     - u" Y2 m, f% f2 [0 ]
134. 
       Z7 L# F" R" r( ^
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     ' O8 `# a; s* H( b0 H$ Q
138. 
     
139. }
     6 o9 Q. _! z3 j; x& Y9 v
140. 
     
141. //#=============================================================
     1 L& X6 b4 ~. |+ E% e0 G
142. 
     
143. double Check360 ( double angle )
     0 F& F/ M  w# m3 \) e
144. 
     
145. //#=============================================================
     
146. 
     
147. {
     
148. 
     + v) F& X  o' r2 Q$ b  z: u
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     : f( N# `: Y( H! e( G! S
151.    while (angle >= 360.) { angle-=360. ; }
     3 g8 W& f8 R' \' c/ ]0 _+ B
152. 
     
153.    return (angle) ;
     1 T+ [1 P: k( p1 q
154. 
     
155. }
     
156. 
     
157. //#=============================================================
     9 n( n* \; R# n( f5 J
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     ' N% a- |& S. [; N
161. //#=============================================================
     7 r. D7 H9 Y  M6 q3 L
162. 
     
163. {
     0 R1 Q6 D$ j5 S
164. 
     ' L* p$ u- }( X; W
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     / k& {- p1 c" |) [
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     * }6 P& r" }) [0 c
168. 
     9 A' m6 ^. e6 L7 z* J" X, H" C: E
169.    return (angle) ;
     - b4 y( d8 R) |& Q6 e# `/ L" |
170. 
     
171. }

复制代码

以下为摇篮5轴计算过程代码
' @' h2 v3 ?% q; n4 D( u+ `6 O

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   
2. 
   $ }( U$ m" C+ L! h5 f9 i9 R
3.          j=0.; B1=0.; B0=0.;
   
4. 
   
5.           if (EQ_is_ge(i,0.)) {
   6 k  q7 G2 h& c" D& k% |2 n
6. 
   
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   ( n2 ?1 ^0 h, W8 c% p, g, y( Q% Q
8. 
   
9.           }
   
10. 
    - N; Z& K+ D0 {0 a
11.           if (EQ_is_lt(i,0.)) {
    ; r2 w/ }* C3 d* c2 _% U
12. 
    $ k" L( f* A( F
13.              if (EQ_is_lt(k,0.)) {
    , C+ n$ _9 _, t8 ]( D- {
14. 
    & T; S7 z5 x9 d9 a* |7 T# S' W5 z
15.                 B0=atan(i/k); B1=B0+PI ;
    9 N1 R8 m+ b/ S; N. K
16. 
    ( I; C, w  K, s( A# [' p
17.              } else {
    
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    " t# T1 {; T( ^8 b7 c
21.               B1=2.*PI+B0 ;
    
22. 
    & i* U4 k  e1 _' P
23.              }
    : G! r* P) Q- k3 r$ }
24. 
    4 q, o- x3 E& @0 C$ w
25.           }
    , G) u4 x! _' w: [- z3 I7 S# w3 e
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    1 u  U+ O4 d) b5 v6 `/ |
28. 
    
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    
30. 
    
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    3 C& \: b7 [! j, B& j" g  T$ b
32. 
    
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

3 v, U9 _. A& X通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
4 ?. v8 ~7 y3 q: s9 Z8 G; F* g

4 J( S8 l0 \  `8 H- P* j测试结果：

* G+ v' C* b1 T& Q
  W2 _4 x( g- n反向测试结果
1 _, Q  ]+ Y% u* O0 C3 l! c

yucammayco

谢谢分享