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

若枫

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

1. int  EQ_is_equal (double s, double t);
   / X2 @# |; }; c4 u2 s8 F* d" v9 g7 R
2. int  EQ_is_ge (double s, double t);
   
3. int  EQ_is_gt (double s, double t);
   : }8 Y' j; d2 s, e% r$ s
4. int  EQ_is_le (double s, double t);
   
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. //#=============================================================
   : B% \! l8 y& G
10. double ARCTAN2 (double y, double x );
    ! M8 t) v; I4 z! A* A  }9 U; b
11. //#=============================================================
    / Z6 N5 O0 h9 R3 P  `% e! K
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    & Z+ Q0 ?+ D5 C7 n) A, T3 {! a
14. double Check360 ( double angle );
    : K2 r* l* `  f; f
15. //#=============================================================
    ) ?& n" B* B. W0 K
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    
17. //#=============================================================

复制代码

" T) n3 k9 M4 E4 o以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   - E7 R5 Z- H' T/ e- ~9 p) V5 v
2. 
   ! b" j+ X1 A3 H' q2 F
3. {
   
4. 
   
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   % u; x! ]) B# A/ A* S
6. 
   
7. }
   
8. 
   
9. /***********************************************************************/
   ( t9 }/ b" {' {& `# t5 F/ w! k6 f6 K
10. 
    
11. int  EQ_is_ge (double s, double t)
    * j. L8 ?' ]% i7 p
12. 
    3 Z$ A1 M0 R* H5 {1 m! W* G% r
13. {
    . i" T" u: n/ L- l
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    
17. }
    2 @3 e$ k! E6 F3 {" @( v, ~: a: g
18. 
    $ ]) L$ c) R+ w* A
19. /***********************************************************************/
    
20. 
    
21. int  EQ_is_gt (double s, double t)
    
22. 
    2 g4 I. `  @& _/ b
23. {
    
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    ! O+ N2 b$ |+ `) k1 H( I
26. 
    ' H9 m4 |9 J  R6 y. d$ M. x
27. }
    
28. 
    
29. /***********************************************************************/
    
30. 
    
31. int  EQ_is_le (double s, double t)
    
32. 
    
33. {
    5 L, t. I' d+ h, D$ t/ ~3 x
34. 
    ! K" q& R; A" {; Z' p9 t
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    3 v% \; f, t& [2 g: x& y" K
36. 
    
37. }
    / M* P* O) _6 U" h1 l
38. 
    ; b7 q1 P* T5 _. B9 ?3 s  l0 E
39. /***********************************************************************/
    1 J: p' Q9 f/ `1 x3 @
40. 
    
41. int  EQ_is_lt (double s, double t)
    6 N" x" z) O' h4 W# p
42. 
    6 M. {3 z; A& Z  ?1 a( q
43. {
    # p7 @7 p' ~- t/ q) i
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
    6 B  t8 @& u0 F  V
47. }
    
48. 
    5 |9 g8 `$ g3 d
49. /***********************************************************************/
    $ M3 c) z2 o; u  ?+ `
50. 
    
51. int  EQ_is_zero (double s)
    
52. 
    
53. {
    6 g4 a& E' k( A2 B+ B
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    
57. }
    6 b! ]6 q' ~) l& A7 D
58. 
    
59. //=============================================================
    
60. 
    ; n5 h: o( s7 q5 d* O/ G+ N7 \
61. double ARCTAN1 (double y, double x )
    
62. 
    
63. //#=============================================================
    
64. 
    
65. {
    3 [' T% Z9 m7 U- V  i  S
66. 
    
67.    double ang;
    
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    . d+ v# ~! x) J0 ]/ z
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    1 c: B# o4 ]2 S3 q7 @
74. 
    
75.    ang=atan2(y,x);
    - R- L8 `4 s, ?8 i
76. 
    
77.    if (ang < 0 ) {
    9 l+ R: ]: s/ n
78. 
    
79.       return(ang + PI*2);
    3 j3 W2 P4 q( B$ N1 X' q
80. 
    * _, o$ g) z) v& D% h( U5 K
81.    }
    
82. 
    
83.    return(ang);
    
84. 
    4 c! K5 S6 m: J
85. }
    
86. 
    
87. //#=============================================================
    8 F' G, |' h1 {! s. F% w
88. 
    
89. double ARCTAN2 (double y, double x )
    
90. 
    
91. //#=============================================================
    . T0 S( d7 U1 N2 d1 K0 H- T  s
92. 
    " z) }+ {3 A8 a- g  [; v
93. {
    ) c5 C5 g/ E3 F: R
94. 
    
95.    double ang;
    
96. 
    * {' C( A" {: s9 u! L% I
97.    if (EQ_is_zero(y)) {
    9 o, z/ h! B4 y$ W; Z  V
98. 
    
99.       if (x < 0.0) { return (PI); }
    
100. 
     
101.       return (0.0);
     ' w) A, [2 R( x3 K( E& ^5 v
102. 
     6 I2 ?6 R, y% i/ _- z5 R4 U0 z
103.    }
     
104. 
     
105.    if (EQ_is_zero(x)) {
     3 h4 c1 t9 y* S3 P& Y+ Y! W5 R
106. 
     0 ^; }$ k! P: W
107.       if (y < 0.0) { return(PI*1.5); }
     ' Y& F) k  c8 k9 _. W
108. 
     5 }( ?& a* v9 s) C: \
109.       return(PI*.5);
     ) @$ r  o- b$ I, P# O/ l8 k
110. 
     ' b7 a9 g  P/ N
111.    }
     7 L3 J, N0 c# ^; e; p, w
112. 
     . o9 q  o# W% u+ ^
113.    ang=atan(y/x);
     
114. 
     5 ]8 {: [% R) _0 H+ i& i5 t
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     3 N6 l1 b9 a3 f) c% O! Q
116. 
     
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     : t4 v4 K- N$ W
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     0 r  Q, @, D/ T- T; f, z7 {
120. 
     8 {/ z$ J; T4 Z- M8 x
121.    return(ang);
     
122. 
     , l% ]# v0 d7 L4 w4 }
123. }
     
124. 
     
125. //#=============================================================
     
126. 
     
127. double CheckConst ( double angle, double constvar  )
     
128. 
     
129. //#=============================================================
     
130. 
     1 |7 h' m5 @$ y9 C* e! U
131. {
     
132. 
     
133.    while (angle < -constvar) { angle+=constvar ; }
     4 H0 u, |  o0 a" o3 H0 q( N: _
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     # L1 c& q! f, f
138. 
     - c4 q5 w# t$ @: l
139. }
     # V" o5 s9 O9 h+ l
140. 
     
141. //#=============================================================
     
142. 
     - c  w1 e4 M2 Z1 j( i' X
143. double Check360 ( double angle )
     
144. 
     
145. //#=============================================================
     
146. 
     
147. {
     
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     4 q0 u: G) K* u
150. 
     ! G2 e0 o+ F: r. _0 j( g
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     + f' Q. _; J( {
153.    return (angle) ;
     8 B1 \; A, t1 h4 S
154. 
     / Z, `" T! o4 x, e9 t
155. }
     $ \% I8 Y5 P8 `* z! `( o
156. 
     ) q, g/ ?( m$ u, G( R& |
157. //#=============================================================
     ( c9 p* q* |* g
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     1 O7 P& K$ a$ V9 l  D$ D( N! d
160. 
     . z  ^7 c, p9 L2 y* B" T
161. //#=============================================================
     
162. 
     
163. {
     0 x' g9 _7 K& _4 I. M
164. 
     
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     ! @3 D" J, a, G* b2 i
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     8 q& k% R) ?9 e! a
168. 
     
169.    return (angle) ;
     
170. 
     
171. }

复制代码

, K  o6 n. N; W! f9 X以下为摇篮5轴计算过程代码

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   
2. 
   8 v6 u1 H# b- u1 R! G% w
3.          j=0.; B1=0.; B0=0.;
   4 q8 [  {1 o. Z" n
4. 
   
5.           if (EQ_is_ge(i,0.)) {
   ' G' a2 F1 i% g  ?% _( X; U
6. 
   
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   & ]9 N: w  Z$ z3 g1 Q; \8 i$ H
8. 
   % S/ r* q& U4 _* L, S+ G
9.           }
   
10. 
    7 x" A$ ?9 F0 a& I5 F
11.           if (EQ_is_lt(i,0.)) {
    ; ^' B5 r" W- f+ ?- w
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    7 S0 ~8 O3 b0 Z: l# [% |5 }3 `
14. 
    
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    ) g7 L9 Q) w' K% @
17.              } else {
    
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    6 P  Z! b% `/ D# u) m6 {6 v
20. 
    
21.               B1=2.*PI+B0 ;
    ) o5 Q; |! k6 L5 E  r3 V
22. 
    
23.              }
    / G7 ~9 I2 Y3 w2 n3 E
24. 
    
25.           }
    
26. 
    6 P& k1 |2 K% ]! r  Y8 [9 g4 b
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    
28. 
    
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    
30. 
    0 U( ]; D: U# s$ ]. {3 a
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    # u2 F/ e5 Q$ ^9 d( s
32. 
    
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

* K/ S! D' F% v: {; J1 N8 x# h7 d) r6 m通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
6 Q* M# H$ a& x. |
- ^  v! u0 X6 ~* ?7 Z7 q
5 j* {9 T3 }# \测试结果：
# y  W9 t6 y5 d. w
1 x# J, \# W- ?  v/ o
反向测试结果
- V' C" g, H$ Y9 X

yucammayco

谢谢分享