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

若枫

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

1. int  EQ_is_equal (double s, double t);
   / A/ L& V2 b4 [# @0 x$ d
2. int  EQ_is_ge (double s, double t);
   " @/ m1 @7 Y' P3 \
3. int  EQ_is_gt (double s, double t);
   
4. int  EQ_is_le (double s, double t);
   ( |" D! B3 X5 D- k
5. int  EQ_is_lt (double s, double t);
   ( E  u9 ~; p& i- f9 b7 [- R5 |5 P
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   7 v* j, r  `1 p. V; O: E2 S
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   + I: P( Q! J. A+ J! [
10. double ARCTAN2 (double y, double x );
    & S4 E8 e6 j$ D' }/ D
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    8 B* z* C+ [* O% @0 P' p8 \
13. //#=============================================================
    , W5 Y* {6 v8 K( |- N; t* H/ K2 f
14. double Check360 ( double angle );
    . H8 \- L) {: G) i/ B5 `/ y
15. //#=============================================================
    
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    
17. //#=============================================================

复制代码

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

1. int  EQ_is_equal (double s, double t)
   
2. 
   ( G0 h) |+ ~2 |, X
3. {
   
4. 
   , Z5 S# \) F) p1 c
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   2 i5 C4 B% p% u1 U+ Y: k- b
6. 
   ' z8 h* \2 ]2 P/ x, X
7. }
   
8. 
   
9. /***********************************************************************/
   ( b, F% a3 E' ?8 m' k0 `( G0 j* L
10. 
    
11. int  EQ_is_ge (double s, double t)
    
12. 
    
13. {
    6 |! S; Y# ?% ~/ E; U
14. 
    ; h  u0 Y9 C, P8 B6 g9 @( P% h5 o- |% @
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    5 P' H/ V8 p6 G- A) L! }( L7 a
16. 
    5 m! G, p) T* z
17. }
    
18. 
    0 q8 x; c  O; c- |- r" v  o5 x) w4 {; Y
19. /***********************************************************************/
    6 _& S( Q" G4 O
20. 
    
21. int  EQ_is_gt (double s, double t)
    
22. 
    
23. {
    2 t3 A7 w, e; W! |; K
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    # p! `( D3 C* w5 _! t
26. 
    
27. }
    
28. 
    8 m& s& e/ K! y7 z8 k! f" p  K& S8 Q3 d
29. /***********************************************************************/
    
30. 
    
31. int  EQ_is_le (double s, double t)
    
32. 
    
33. {
    
34. 
    ; k7 r" n0 x! Y" N
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    
37. }
    
38. 
    " t" Q5 \9 @1 w3 z" g, w
39. /***********************************************************************/
    6 J3 M- I$ W# F
40. 
    . A3 i) p: b) C
41. int  EQ_is_lt (double s, double t)
    5 v  A% R0 }( u3 t7 A+ o
42. 
    
43. {
    . u' G# L( \/ z) [
44. 
    . q2 m! k" s. K1 M
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
    
47. }
    ' t) J0 g0 A  G- B
48. 
    " r! Z0 j( @) I# V1 C# X( S
49. /***********************************************************************/
    
50. 
    7 Q2 i8 D6 J7 U, {4 L& K% U/ `
51. int  EQ_is_zero (double s)
    $ D$ V* k% X: G% I4 k8 b( c/ u2 g
52. 
    $ \5 L+ b* Q0 P! V" k4 t
53. {
    
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    8 w3 K4 J$ o- h' s2 H
56. 
    
57. }
    
58. 
    6 H$ W7 F! }4 m7 G
59. //=============================================================
    . P. M. Q: u/ Q8 a" L
60. 
    
61. double ARCTAN1 (double y, double x )
    ( C6 p3 n1 e2 N& o
62. 
    0 _: B8 E  T7 U- i
63. //#=============================================================
    & g" \" Z2 C8 u+ M. x) r
64. 
    4 Z6 N) {' P% C5 j: T- `" m
65. {
    4 ]2 w, w( v' e0 z6 @
66. 
    2 L) q0 {6 W; N& m8 ?& }
67.    double ang;
    % J6 [4 X$ |% N( c
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); }
    % {, E( O/ W5 j0 b# f! o
74. 
    
75.    ang=atan2(y,x);
    
76. 
    / P1 S0 h, M1 @! K7 ?( C! L& y8 V
77.    if (ang < 0 ) {
    ) z2 F2 F$ c2 X$ V0 ^8 V
78. 
    
79.       return(ang + PI*2);
    2 e$ C8 M% w% P$ Q  W
80. 
    & J) A5 f3 Z5 G- g) A; j& @
81.    }
    
82. 
    4 {  T6 w7 D3 p# z
83.    return(ang);
    
84. 
    
85. }
    , @6 [2 X/ _% e" E4 a6 y
86. 
    0 t* G) P4 ~/ l2 d! k
87. //#=============================================================
    
88. 
    , o* D) f! q  P- H
89. double ARCTAN2 (double y, double x )
    & e" F9 F2 E6 E+ P
90. 
    # R1 K$ K( s; g5 ^! a1 J
91. //#=============================================================
    ; e0 g2 P; L" d+ G( i
92. 
    
93. {
    
94. 
    
95.    double ang;
    
96. 
    0 K$ w# f% i. r2 V. |! X7 w( l8 i0 Q
97.    if (EQ_is_zero(y)) {
    
98. 
    
99.       if (x < 0.0) { return (PI); }
    
100. 
     
101.       return (0.0);
     : L) {3 I( h8 u' x3 y/ D5 I* |$ g
102. 
     
103.    }
     6 U3 B1 m/ l! E# n" d
104. 
     5 m5 ]' E2 B# T3 s' E. E+ Y' _& g
105.    if (EQ_is_zero(x)) {
     ( ]1 |; i$ d- g) \! q
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     
109.       return(PI*.5);
     8 j2 p+ a$ c4 H  v4 f& Q7 ~( J; P
110. 
     
111.    }
     9 C/ q9 C2 K8 `& A1 Y" S
112. 
     
113.    ang=atan(y/x);
     
114. 
     " M2 I: V! a; d6 d$ v  }
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     5 h  {$ V0 O/ @& L1 m3 [
116. 
     $ X) ?0 d7 E, o, j5 ~
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     
118. 
     $ R4 N0 v0 I4 d: C) C/ m: k
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     ; L; b6 q7 X, _; V6 ]7 U
120. 
     . s* ]+ x8 E1 v$ k$ n: }8 \
121.    return(ang);
     
122. 
     
123. }
     . o0 I5 n, I3 b' F1 C: ^
124. 
     ( ^9 M/ G- U" h2 b
125. //#=============================================================
     5 h* d& }* X* C1 s3 d* f
126. 
     
127. double CheckConst ( double angle, double constvar  )
     # d; |0 q- j9 ?5 Z2 T/ w
128. 
     5 b+ R; I, G8 K4 K# a' ~$ n
129. //#=============================================================
     ; X  M5 M: W8 H2 S# H7 E9 l* {
130. 
     
131. {
     ' W5 N* V! n' O9 x9 z
132. 
     4 n3 v% D- Z3 j  g& C0 J1 p
133.    while (angle < -constvar) { angle+=constvar ; }
     
134. 
     # s2 g* Y) s& o2 y
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     ! i: q+ J6 ^$ f. r+ W: p% D3 ^9 t
137.    return (angle) ;
     
138. 
     2 r( B! x) Z$ O$ u
139. }
     " E4 d: v) ~+ z/ Q$ \' m- d: y
140. 
     
141. //#=============================================================
     $ r: w- `- b+ u- H
142. 
     3 X4 R& t( i5 s) B* P, A
143. double Check360 ( double angle )
     
144. 
     
145. //#=============================================================
     
146. 
     ) }* Q: Z* v! L$ U# r1 R
147. {
     / N& D  a: C: ~# w
148. 
     2 u/ D2 G$ {8 x7 F4 C
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     4 s6 X! R, S/ X; f
153.    return (angle) ;
     
154. 
     
155. }
     
156. 
     
157. //#=============================================================
     + I7 o; `% M; Z( t2 V+ w
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     
161. //#=============================================================
     
162. 
     
163. {
     
164. 
     
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     : N7 ~4 `$ _2 c5 E
166. 
     3 p" W" u) H. \1 P6 B9 W/ Y9 O! K
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     
169.    return (angle) ;
     $ i- [3 f' T' N+ N* N& w
170. 
     , t3 W! n0 E) q$ P4 s0 u5 c
171. }

复制代码

; Q) o0 Y& ], m% O" L! M以下为摇篮5轴计算过程代码
% K4 W: E; \4 C9 _! S4 f

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   
2. 
   3 a6 @6 @9 E, s7 p) L
3.          j=0.; B1=0.; B0=0.;
   
4. 
   
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; }
   + D3 k, p% R6 V
8. 
   
9.           }
   
10. 
    
11.           if (EQ_is_lt(i,0.)) {
    : F# f' W3 M7 v8 y, ]4 T, t9 _/ i: T
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    
14. 
    
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    3 e- F7 \1 I) v" [7 r& E; L
17.              } else {
    
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    
21.               B1=2.*PI+B0 ;
    
22. 
    
23.              }
    
24. 
    . k2 i7 R. V- Z% b$ |0 ?
25.           }
    - H' E- W' \0 c
26. 
    9 `/ h7 _2 B. Y" d+ u1 g% E
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    
28. 
    9 _8 ^- U  `3 e+ X* E6 q3 _, e
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    + G+ S5 P* }* f% c& S$ o6 o
30. 
    * S& ?3 z2 P# d8 W- z+ ^
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    + m; o- h" x" b7 |, E
32. 
    
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

4 Y6 |& Q4 R, l  Z+ q2 f+ d通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。

3 o6 E+ x* l" P% o6 A6 E: Y
! y" K' T1 V' l. A  z' B' o测试结果：

+ S+ X8 x/ s& a: {+ d' p
( y1 V/ ~& A. s& g反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享