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

若枫

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

1. int  EQ_is_equal (double s, double t);
   ) G- Y$ _% a/ G1 G
2. int  EQ_is_ge (double s, double t);
   
3. int  EQ_is_gt (double s, double t);
   # n0 a+ {! S& |# u4 G8 q
4. int  EQ_is_le (double s, double t);
   
5. int  EQ_is_lt (double s, double t);
   2 M" |4 s  @' |. [% b0 c1 m1 y
6. int  EQ_is_zero (double s);
   : L+ s& U' J  M) }- C
7. //=============================================================
   
8. double ARCTAN1 (double y, double x );
   , a- L- ~) i$ ?7 z+ O) z4 ?
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    ) K4 Y- o! c2 Q. ~6 U% U
11. //#=============================================================
    3 t2 i9 ^1 e* q' ]. E3 B
12. double CheckConst ( double angle, double constvar  );
    3 _) [4 Z2 Y6 [
13. //#=============================================================
    8 I8 M! y4 Z& Q0 U
14. double Check360 ( double angle );
    2 c' Q4 M/ N/ V0 C. W  G; G5 p
15. //#=============================================================
    
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    
17. //#=============================================================

复制代码

) y- a6 N. b% H* p0 j0 Z) U) x/ L以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   ' M: O7 S) t/ e
2. 
   
3. {
   . j  A. Z0 m* E5 Y; @
4. 
   
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   / X$ Z% {5 |; z5 V- C2 ^: E: q) A1 o
6. 
   
7. }
   / [/ ~. R* h) `2 M: x
8. 
   & @& z& p- N1 e$ A& b9 I- J2 z
9. /***********************************************************************/
   
10. 
    ) N& \/ f+ I0 a* X4 h# `# V
11. int  EQ_is_ge (double s, double t)
    8 w3 W# q8 c' S0 b* I4 i. y1 w: w
12. 
    
13. {
    
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    
17. }
    8 t% Q( u0 a; u% T
18. 
    
19. /***********************************************************************/
    
20. 
    & e% U* r2 @. R: _
21. int  EQ_is_gt (double s, double t)
    
22. 
    
23. {
    
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    
27. }
    8 u0 s7 T% o  C: s; X3 u; A4 }
28. 
    5 B$ h, N4 o* L4 G  U2 b" E9 H
29. /***********************************************************************/
    
30. 
    , J1 O. O, @% u- P1 e7 ^  f
31. int  EQ_is_le (double s, double t)
    
32. 
    % z& `. u# v1 J
33. {
    9 k6 o  `/ j, P# i3 P2 u
34. 
    - Q+ y5 T# c& d) Q, ~
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    2 i' r. l- l# D
36. 
    - F2 `( F6 O# f) n3 B
37. }
    
38. 
    6 H) q7 j8 o' [$ Z
39. /***********************************************************************/
    
40. 
    2 @1 C8 q7 P) P/ T* k# Z/ Y$ ~  v6 |
41. int  EQ_is_lt (double s, double t)
    2 n( x* M+ x# l) Z0 O
42. 
    
43. {
    0 ?, S. f) x4 i  u5 r
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
    8 a( f* D7 j  r; S
47. }
    & t# f$ V( K- F7 G' z8 P
48. 
    + K' t2 f! L' g! g, s0 H" x
49. /***********************************************************************/
    + z/ ^8 P$ Z4 N1 S$ j! y0 i4 M) v
50. 
    8 b4 @8 ^3 t3 @. j( T$ {# [4 x! p
51. int  EQ_is_zero (double s)
    
52. 
    
53. {
    9 }. |5 R+ c( R, b
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    & N) m. `" j* Z
56. 
    , k5 ?- Q  I9 }) v5 F1 \) r
57. }
    
58. 
    6 O. V( u+ y; e) C7 n% l  A* j$ M* v
59. //=============================================================
    / S$ K5 _+ D  e/ E# D1 T3 L
60. 
    " I9 N1 P. k' [$ O
61. double ARCTAN1 (double y, double x )
    4 ^# W8 q! K" ~, s( M0 c, f6 b
62. 
    % `! H; ?& _6 T2 L$ M- v
63. //#=============================================================
    / Y% Q  Y; }  V/ e  ?  e
64. 
    9 M* V: i9 f% _9 `' H9 w
65. {
    % A  W1 J5 Z) l
66. 
    1 f- _0 ~$ T0 r. \. f" E
67.    double ang;
    ( }  s* b; J; n' s6 R' ^
68. 
    1 z/ }" K3 f7 U
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
    6 a. J$ H' \# M( r! Z
71.    if (EQ_is_zero(x)) { x=0; }
    
72. 
    $ T7 c( p) M/ g
73.    if (y == 0 && x == 0) { return(0); }
    + x* f+ q; D3 ]: ^/ a5 \1 H& j- A
74. 
    0 N7 ^0 D; m1 t( Y8 N* ]
75.    ang=atan2(y,x);
    
76. 
    9 t( A8 o8 C/ Y/ Q
77.    if (ang < 0 ) {
    
78. 
    3 {! P1 ]& A4 V7 e9 O( y4 C, B
79.       return(ang + PI*2);
    
80. 
    5 Z* q! M$ {# {3 M  O3 {/ ~6 [
81.    }
    
82. 
    
83.    return(ang);
    
84. 
    
85. }
    
86. 
    
87. //#=============================================================
    6 _8 J) ^8 x: `% b6 H1 t, p6 A% S
88. 
    3 C( x- j1 ^  U, ?6 D3 p) ~
89. double ARCTAN2 (double y, double x )
    ; A  {) |1 V- ~9 X' Q
90. 
    8 [2 V, R, f  o7 \% u1 V7 C9 F
91. //#=============================================================
    
92. 
    " Z. ~; X0 f1 z+ @, m
93. {
    ) u% h6 h$ N# s! q/ U, t% a6 W
94. 
    
95.    double ang;
    
96. 
    
97.    if (EQ_is_zero(y)) {
    
98. 
    
99.       if (x < 0.0) { return (PI); }
    ) Q5 X% Z. o6 Y% h5 z( w
100. 
     7 x& h) }( j; S  u& h
101.       return (0.0);
     ; K. k% g  K' F/ O- G/ s: }
102. 
     5 u: B, m9 ^3 o' q. |# V6 |
103.    }
     : Z# H' Y+ g% U/ t6 R2 T
104. 
     % L, \" w5 m1 `2 r5 O* O  N
105.    if (EQ_is_zero(x)) {
     9 r1 I+ d$ l) E5 z, [
106. 
     ) e6 x- g; i8 ?0 y
107.       if (y < 0.0) { return(PI*1.5); }
     ' }" R+ J' }* ?7 o. j$ [
108. 
     % v+ J, P( H. X; w
109.       return(PI*.5);
     ; |8 z* i/ ~# ^/ m6 l' ~
110. 
     
111.    }
     
112. 
     
113.    ang=atan(y/x);
     9 M; q2 D3 I+ {# a2 N7 Q
114. 
     % z3 _4 H' D$ K! m  y+ R
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     
116. 
     - R3 R7 s7 @: _; k, I. I
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     8 `9 ^3 D3 y, ?0 {% j
118. 
     & x5 v1 h1 r4 J* h5 x
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     ; O/ p; S/ }. z* H% R. ?: p  s6 H1 o
121.    return(ang);
     # D9 n8 R; ?  r* T
122. 
     
123. }
     + E6 c) N1 K4 X, }0 P
124. 
     
125. //#=============================================================
     % }* I/ \. c1 i$ U3 U
126. 
     - P" j# x* J% Q3 C7 {
127. double CheckConst ( double angle, double constvar  )
     + b& a  ]( o% G7 d
128. 
     
129. //#=============================================================
     : G0 H7 H* @: ~" ]' I
130. 
     ) w1 ]7 K6 f  n0 E/ {
131. {
     ! C7 M9 v9 e3 e: U/ U- V" R- T0 p
132. 
     
133.    while (angle < -constvar) { angle+=constvar ; }
     4 v2 f" F( X3 m
134. 
     2 F4 B8 o5 @' s* s4 @
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     
138. 
     
139. }
     
140. 
     , I+ B+ q1 G" G7 ]2 Q4 L
141. //#=============================================================
     , ]) X. z& D! J5 P2 [4 s( ?
142. 
     
143. double Check360 ( double angle )
     
144. 
     ) C/ u" U: b# k& `- m" e
145. //#=============================================================
     
146. 
     7 m9 d; v! \8 S: J( P- b
147. {
     
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     7 X7 r1 g7 G1 Q+ `1 K1 z
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
     9 h) n8 v; X$ }# t
152. 
     & P4 n, P% Y1 K. A
153.    return (angle) ;
     + c+ d. b/ B( h* g6 ~. ^$ N
154. 
     
155. }
     ! d7 O9 |5 [! b% Z- c
156. 
     ; Q9 I1 f& G+ f, P6 O! u: ]
157. //#=============================================================
     5 q  [% o* C9 ^, B
158. 
     9 k% U$ Z- M% e: L
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     
161. //#=============================================================
     
162. 
     
163. {
     
164. 
     ( ?- n. K" G4 g; X1 ?  J
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     : C4 H  n/ R" ^" l
168. 
     
169.    return (angle) ;
     
170. 
     ' Z# I" }1 G/ b- I
171. }

复制代码

以下为摇篮5轴计算过程代码

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   5 r2 v8 U+ i/ r" ]& P1 m) ^. B8 Z
2. 
   
3.          j=0.; B1=0.; B0=0.;
   
4. 
   3 P8 ~0 s% {% g; j
5.           if (EQ_is_ge(i,0.)) {
   9 I: |! N/ A) ?% b- E- H
6. 
   
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   . l3 @" H/ p6 U( v2 E" y+ I
8. 
   
9.           }
   
10. 
    
11.           if (EQ_is_lt(i,0.)) {
    
12. 
    2 ^- _* I( I! B$ j8 {
13.              if (EQ_is_lt(k,0.)) {
    
14. 
    & w  Z* ?2 ~: K+ q  q& I
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    0 |% @3 n' j$ `9 b+ P" M7 Q/ ~
17.              } else {
    # Q7 X# i1 [2 A  p* {, F! ?: A
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    : }! N: n) I9 U. Y. w5 W0 |
20. 
    + Q6 _  G1 d+ i2 f8 d/ d1 Q
21.               B1=2.*PI+B0 ;
    
22. 
    ; s! |! s3 Z% ?/ P
23.              }
    5 s3 E) c! K4 ~, @4 h0 m5 `
24. 
    
25.           }
    3 i8 E+ ^5 n6 m
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    ' m1 Y( u4 w# f" b, x: X
28. 
    
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    
30. 
    ! D8 V2 E' `2 J
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.;

复制代码

! p* g) W% U& O2 b( g9 r1 i7 m8 b* h通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
# ^1 ~8 X( M) N  ?* W
& ^/ y- V2 U: g# s4 x. f
! p# h+ T2 c* B8 {, g1 @% @4 J1 o测试结果：


反向测试结果
3 p: W3 }# [, j1 G

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享