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

若枫

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

1. int  EQ_is_equal (double s, double t);
   / ]5 v& @+ v- K) p5 y5 a
2. int  EQ_is_ge (double s, double t);
   + u0 H( C# A$ s5 ]  o1 N+ U7 L0 E
3. int  EQ_is_gt (double s, double t);
   
4. int  EQ_is_le (double s, double t);
   
5. int  EQ_is_lt (double s, double t);
   7 T9 k& o5 M" K
6. int  EQ_is_zero (double s);
   * P/ g% }" K6 H% P2 ?; ^
7. //=============================================================
   
8. double ARCTAN1 (double y, double x );
   & [' |" G3 _0 J# {
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    $ g0 v, D, ]5 m
11. //#=============================================================
    ; `- b9 Q( ]- T# b* C
12. double CheckConst ( double angle, double constvar  );
    3 F+ [! h* \2 U! \' m* N! p* r
13. //#=============================================================
    , y5 A& W/ R8 R$ c8 m
14. double Check360 ( double angle );
    ( o7 Z* W4 t  U% ^
15. //#=============================================================
    " t4 s& @! @5 s2 Z6 G1 t9 x( Y
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    
17. //#=============================================================

复制代码

以下为部分源代码，用于判断，计算角度等
6 r! P& ^: @; v) I  b! ^" z

1. int  EQ_is_equal (double s, double t)
   
2. 
   1 W; O- H* g/ s6 P# B
3. {
   / }5 a: d9 J$ i1 j$ ^
4. 
   ( w& j: H. Y. o& s5 I/ o
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   
6. 
   
7. }
   8 v: c  ~+ s. R3 [7 L
8. 
   2 @% s6 p: x: |/ Q% P
9. /***********************************************************************/
   
10. 
    
11. int  EQ_is_ge (double s, double t)
    " k* o& e$ Y* U( c1 q# c+ x7 r- u
12. 
    
13. {
    
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    ; [1 {# b+ e( f- C1 e7 p& k
16. 
    
17. }
    / g$ R) B) |# b2 K6 y
18. 
    ( b2 |. q8 f; R4 M
19. /***********************************************************************/
    
20. 
    
21. int  EQ_is_gt (double s, double t)
    0 Q# [- j" ]  H3 T
22. 
    & E( P- D1 v  e6 f7 O" E
23. {
    
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    
27. }
    ( H/ u7 F3 f) @& f' V- T1 z
28. 
    
29. /***********************************************************************/
    
30. 
    4 a' j- W) B2 [! R$ B- T2 [
31. int  EQ_is_le (double s, double t)
    
32. 
    
33. {
    7 M2 |. b+ S# Q/ s. f
34. 
    5 [! N+ `7 c+ g% y5 W% H
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    8 s5 p1 U1 e4 C0 W& T+ G& l* S/ r2 Y
37. }
    
38. 
    
39. /***********************************************************************/
    
40. 
    
41. int  EQ_is_lt (double s, double t)
    8 q, b/ w, L1 M; y) Z& d
42. 
    & y3 M& X7 K, k0 [
43. {
    
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
    
47. }
    
48. 
    
49. /***********************************************************************/
    
50. 
    
51. int  EQ_is_zero (double s)
    ; g2 u9 Q( D6 E  D' Y% w2 V1 j
52. 
    6 j; _: G; n3 B( R# M
53. {
    / V* z: a; f* {2 Q4 o- L
54. 
    ; `/ B, g! R9 I. L/ @: Z
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    
57. }
    
58. 
    1 M! E% y7 s# d; A' u
59. //=============================================================
    9 ~% H9 g5 a# j5 ~5 r
60. 
    3 V; W; o" R4 R
61. double ARCTAN1 (double y, double x )
    
62. 
    
63. //#=============================================================
    . a3 U  U3 u- S: k8 i1 F( o
64. 
    0 F  B$ n5 B8 c' u5 w1 {* D
65. {
    
66. 
    + z3 V/ g5 w6 p& x* y  C
67.    double ang;
    
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    1 M. x+ b8 a/ [7 p, X. R# Q
74. 
    / K& w3 i  j& t. a' a* ]' k6 |6 n# t
75.    ang=atan2(y,x);
    
76. 
    
77.    if (ang < 0 ) {
    
78. 
    + {# P0 h3 s/ H) h4 F1 k0 Q
79.       return(ang + PI*2);
      m5 p$ i& f" U/ L2 x; ~3 n
80. 
    9 q) g! X5 ^- D# C: e& D
81.    }
    ( K5 [% V# }) }% o. u7 ]/ u# C1 L0 d
82. 
    8 X' f5 b7 [3 p. a- v" X4 @
83.    return(ang);
    4 |6 C. @' I7 ]0 s
84. 
    
85. }
    
86. 
    6 K/ E( N/ e! _
87. //#=============================================================
    
88. 
    % ]6 \! {8 s( h5 ?2 y) Y4 C
89. double ARCTAN2 (double y, double x )
    
90. 
    
91. //#=============================================================
    5 t& ~- }1 u4 I0 d
92. 
    / l0 E- j; l" w' o' k) u: }
93. {
      [6 a. E$ l. E# B
94. 
    ) |( Z$ r) p0 Y& |- _% \
95.    double ang;
      {0 j" Q+ t7 C# q4 b6 Q7 s2 O$ a: v
96. 
    0 N- Q& j: {  m& A+ t1 l
97.    if (EQ_is_zero(y)) {
    7 X- L3 ]  W4 @. Z. R
98. 
    . j& ]5 Y, N5 C
99.       if (x < 0.0) { return (PI); }
    2 J4 ^7 f8 ^7 w/ \0 s: a* l4 Z+ H
100. 
     4 \" `1 H' ^5 p( l% E) {
101.       return (0.0);
     " s0 v3 t( I7 V+ i0 C$ H
102. 
     & U& q+ {5 \1 F+ K
103.    }
     
104. 
     
105.    if (EQ_is_zero(x)) {
     
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     ( x/ G; ~2 U8 Z/ E  P; O
109.       return(PI*.5);
     
110. 
       ?- h* ^1 v8 Q# k8 R7 E
111.    }
     
112. 
     
113.    ang=atan(y/x);
     5 P% j0 {2 ?3 Z* l  ~
114. 
     
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     - A6 M. x- x) a8 K* m* O
116. 
     8 m! L+ ~1 Q* D' w, r
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     
121.    return(ang);
     
122. 
     8 J! O. G9 m% b# {+ W0 j
123. }
     
124. 
     
125. //#=============================================================
     " v! ]* |! q* Q: O: f8 @9 Q
126. 
     9 O) w6 B6 x/ s
127. double CheckConst ( double angle, double constvar  )
     
128. 
     
129. //#=============================================================
     
130. 
     
131. {
     
132. 
     8 f) f; `7 P2 ^8 [1 {" D/ \
133.    while (angle < -constvar) { angle+=constvar ; }
     ( u2 L7 E( C$ E) Y. ]5 ^
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     ) E1 h' S8 a$ j6 L# K, F4 c# _
137.    return (angle) ;
     
138. 
     
139. }
     # {  |8 l  p; j
140. 
     $ c0 [0 w/ s* A% r
141. //#=============================================================
     ; J! A" C( `5 k$ A2 R
142. 
     
143. double Check360 ( double angle )
     ' z% W  u2 K! t/ K9 v2 U, p( J: T
144. 
     
145. //#=============================================================
     
146. 
     
147. {
       G- S& U: _: J. R
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     ! U0 ^9 }" z" w* Q! _$ ~' }
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     
153.    return (angle) ;
       C; t. T6 P4 g% G7 U# c
154. 
     
155. }
     0 M" w/ B$ l8 A1 A5 p% M
156. 
     $ w: Z! f- y% c! D
157. //#=============================================================
     
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     0 b: B) Z' l, ^) k, E4 G
161. //#=============================================================
     
162. 
     
163. {
     $ t7 b. Y4 q- V5 w4 ~
164. 
     " U4 G, O, U* o) k$ G
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
       e4 D  |, j: K# z& i: b
166. 
     3 w- _. u5 d. H9 d5 V+ ]
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     
169.    return (angle) ;
     % y7 g5 a5 y* Y# t
170. 
     ) ^4 J+ T1 W* X8 D6 G- ~9 L
171. }

复制代码

. p3 V4 v  i. k: r以下为摇篮5轴计算过程代码

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   " g8 X1 ^' F7 {- ^5 z, ]( I
2. 
   # U3 {& w  G& W8 e) l  I
3.          j=0.; B1=0.; B0=0.;
   
4. 
   8 @9 w+ v/ X7 y- T5 v! @" L
5.           if (EQ_is_ge(i,0.)) {
   - |/ n( `" G9 X0 w5 H( Z
6. 
   
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   
8. 
   5 W( ~) U8 l( w7 Y1 |8 I  e8 ~: O
9.           }
   6 ^- S$ m; b" |$ k& ^4 I
10. 
    
11.           if (EQ_is_lt(i,0.)) {
    
12. 
    & d) T7 [. h( }7 a& q: m
13.              if (EQ_is_lt(k,0.)) {
    
14. 
    
15.                 B0=atan(i/k); B1=B0+PI ;
    : f- ?9 _! J+ G+ f9 [) A/ B& [
16. 
    
17.              } else {
    
18. 
    " I& t+ c8 M7 a& u
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    0 ^5 Z2 j, c/ C6 u8 @
20. 
    0 z# R2 U/ l; \5 X
21.               B1=2.*PI+B0 ;
    
22. 
    7 C3 R% d0 `# _& A* m9 u. |1 p
23.              }
    3 p# e% I, C$ a6 P1 a! r) K
24. 
    $ q, _# k$ t, u$ j' d$ d6 i
25.           }
    
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    
28. 
    ; B& Y, M0 F/ N4 z0 a
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    
30. 
    
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.;

复制代码

通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
8 L/ d! l, |% s( S( G4 S- N
8 l! k0 u, i1 z: g
7 p5 R$ n2 v& z& w4 W8 p; z测试结果：
/ L1 B8 H2 S* q6 J1 g

) ?* T2 }4 l/ ~7 M反向测试结果

yucammayco

谢谢分享