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);
   " N3 R6 D% l9 k. f& \
4. int  EQ_is_le (double s, double t);
   
5. int  EQ_is_lt (double s, double t);
   & s7 U$ S- V5 o& @$ _3 q) j8 l2 S
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   % y1 V( i% f! B; Z+ U5 O
8. double ARCTAN1 (double y, double x );
   ) I) e0 l* h+ O0 w+ r8 i
9. //#=============================================================
   * A5 o& m- r- |& ?" ^3 L% e
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    8 K) _4 H, c* [" W. y9 b  M
12. double CheckConst ( double angle, double constvar  );
    2 p& ~5 F, {  x+ j- t
13. //#=============================================================
    % H7 ]9 r3 H: y" T! v
14. double Check360 ( double angle );
    
15. //#=============================================================
    
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    ( V1 p5 F5 o0 U0 U4 }! g
17. //#=============================================================

复制代码

) x+ Z) a& f# F& L5 r6 |以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   
2. 
   
3. {
   
4. 
   
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   * s; ]5 h3 A6 @
6. 
   ( `8 y: c! x& I" U  Z1 D3 p8 C* t
7. }
   0 @0 p3 a- t6 ]4 d5 B% ^+ H
8. 
   : C+ `7 u- \/ W8 |  Z5 Q! E
9. /***********************************************************************/
   
10. 
    6 ~6 J, K$ |. f
11. int  EQ_is_ge (double s, double t)
    
12. 
    
13. {
    " b8 B* C2 j1 q& W2 Z2 I
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    $ V! O' ~, C/ E4 V
16. 
    - r5 A; ?6 P; ]. L9 H6 }
17. }
    * K1 Y9 _. p# P. w
18. 
    
19. /***********************************************************************/
    
20. 
    5 i) Q+ d7 E" ]. i  R
21. int  EQ_is_gt (double s, double t)
    
22. 
    
23. {
    9 ~- @3 y% }9 J  J
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    * K2 n1 C" ~7 O) _* X/ O
27. }
    
28. 
    " c  N0 y5 x& ]* ]  H5 R  O& l& f
29. /***********************************************************************/
    
30. 
    
31. int  EQ_is_le (double s, double t)
    
32. 
    
33. {
    
34. 
    * s6 {4 ^2 G$ o+ Y8 P
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    
37. }
    
38. 
    ' E# C( ~4 _0 c9 @( \8 s
39. /***********************************************************************/
    
40. 
    % T4 L  s( x( h' o2 ^0 m5 K% Z. ]
41. int  EQ_is_lt (double s, double t)
    / P1 ^/ f: H" `. s- h
42. 
    + B7 u# d% ]4 v3 \0 H; w2 w
43. {
    
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
    
47. }
    . N3 N# ]8 }  X* J0 B" Z
48. 
    3 T+ _% @4 E% M( O1 s! v: u
49. /***********************************************************************/
    
50. 
    ) m6 Y. i7 t# f( ?' n% A! g7 x
51. int  EQ_is_zero (double s)
    
52. 
    
53. {
    
54. 
    7 T" F) V) `6 R" I; A
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    ; a$ t7 t  j! p3 E9 _
57. }
    
58. 
    
59. //=============================================================
    % W2 ~( X7 m$ B; z, C
60. 
    6 B- ^. m- Q1 D# d3 C
61. double ARCTAN1 (double y, double x )
      k0 D$ |+ d+ E$ a* d) y) u( b
62. 
    
63. //#=============================================================
    
64. 
    # {8 `) M$ r! B; H# u2 b
65. {
    . v9 |; {8 J' z# |
66. 
    
67.    double ang;
    
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    ( M/ v( n/ f5 D7 P+ W+ o
72. 
    ' A$ N4 G0 Q  @/ b. I
73.    if (y == 0 && x == 0) { return(0); }
    ( G8 Z: h  y/ [) F2 Q! ]
74. 
    
75.    ang=atan2(y,x);
    
76. 
    ( {( K4 s% e1 }% \. f7 R. |
77.    if (ang < 0 ) {
    
78. 
    ) L5 k+ _& [# J$ c
79.       return(ang + PI*2);
    . p/ f- \5 o" J# V# i3 Y
80. 
    
81.    }
    + b3 D. F, T% H+ y$ N* X
82. 
    5 p& Q- ~5 Z9 f! d
83.    return(ang);
    
84. 
    
85. }
    
86. 
    / x$ L1 q! O# x! b: M
87. //#=============================================================
    3 h. x3 R+ x4 v$ l! f0 N
88. 
    & b- r' i% p/ ^, u* `. V% J( n
89. double ARCTAN2 (double y, double x )
    
90. 
    
91. //#=============================================================
    4 i) Q( I: {9 |1 V4 i( V% n7 y
92. 
    
93. {
    
94. 
    
95.    double ang;
    
96. 
    
97.    if (EQ_is_zero(y)) {
    0 ^% N7 h0 J9 ], ~
98. 
    
99.       if (x < 0.0) { return (PI); }
    # Y6 F5 V" V0 ~: M$ `- j0 X
100. 
     
101.       return (0.0);
     6 l% N* W; `; {4 V- h9 i/ e
102. 
     
103.    }
     
104. 
     
105.    if (EQ_is_zero(x)) {
     
106. 
     4 }! ^, R2 F( x' Z$ y' W$ F$ n$ q
107.       if (y < 0.0) { return(PI*1.5); }
     ; k- l: g; Z- Q7 D; D: ^6 ~/ \6 ?2 P% r
108. 
     
109.       return(PI*.5);
     
110. 
     
111.    }
     
112. 
     3 a$ B! P+ l, m1 }* o
113.    ang=atan(y/x);
     
114. 
     
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     * }' \9 C0 P# M  k* @
116. 
     5 M; @' D5 }+ _4 I$ X
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     * h$ J# T% r/ U$ n6 Q1 N
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     
121.    return(ang);
     5 I' Q% v9 D; A. T* z
122. 
     
123. }
     
124. 
     ; n! S8 U, [: b, m
125. //#=============================================================
     
126. 
     3 k0 H* H# W( Q( x& o
127. double CheckConst ( double angle, double constvar  )
     
128. 
     % l) u' ^! Y& U$ d
129. //#=============================================================
     , |: `" e! Z$ e/ p7 q
130. 
     
131. {
     
132. 
     
133.    while (angle < -constvar) { angle+=constvar ; }
     ' V; V6 k& L1 Y" O( Q0 u* w/ t- W
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     " s4 p+ a8 o8 X. u9 J/ [( r" W( v
138. 
     
139. }
     
140. 
     1 e. s4 K7 v5 g3 h2 K2 l) j
141. //#=============================================================
     
142. 
     
143. double Check360 ( double angle )
     
144. 
     ( B+ X- x; O7 K2 F/ @8 E1 K
145. //#=============================================================
     4 D* V8 n9 m6 B
146. 
     
147. {
     . P0 A4 ~# Z! t1 {9 a
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     ( j2 R" z. G! a8 h0 t
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
     9 q- |" W! s9 s* [) `
152. 
     . m6 g2 L+ W: l" a9 P4 a) F
153.    return (angle) ;
     2 E' K% S1 H' v$ Y- t" P& V; `9 P
154. 
     ( C3 X& X: r/ P, O) I
155. }
     : e5 Q0 y! {* [$ J6 F
156. 
     
157. //#=============================================================
     
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     $ _: K0 W& U! G; s; ^3 i
161. //#=============================================================
     % a+ K- c3 K3 S+ f2 C# @& q
162. 
     7 o9 r7 S; Y6 y, ]1 L( B, {5 j
163. {
     
164. 
     6 r( r! e1 ~3 v3 U" Q
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
       W0 p& B9 w) c( G
168. 
     
169.    return (angle) ;
     
170. 
     0 Q( L6 q* A# D3 I
171. }

复制代码

以下为摇篮5轴计算过程代码
/ ?+ A( w- c% U( G8 s5 y' N0 Y

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   6 a& C, X0 n  b9 U
2. 
   
3.          j=0.; B1=0.; B0=0.;
   ! p+ b+ ^; y7 @4 L. [- g* E7 G
4. 
   : B* L) s  r* s2 D" p. Q: ~
5.           if (EQ_is_ge(i,0.)) {
   
6. 
   " J$ g# h" Z4 A
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   + \/ ]/ `8 w; x0 L. H6 V2 J
8. 
   ' E1 j. _, \6 X3 \+ T
9.           }
   
10. 
    ! Z. c# V( T3 J* b7 F% ^. q5 x
11.           if (EQ_is_lt(i,0.)) {
    
12. 
    3 d3 R# L0 W# D
13.              if (EQ_is_lt(k,0.)) {
    9 N+ w% a, s- n4 l% `
14. 
    ' \2 M& r. h! G5 e8 M
15.                 B0=atan(i/k); B1=B0+PI ;
    1 H# _# h5 U, d- U
16. 
    
17.              } else {
    
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    ; K) @5 f) O: P; H9 W
20. 
    
21.               B1=2.*PI+B0 ;
    ! \7 j4 \3 H8 h/ L  s
22. 
    3 E4 D5 a8 H. d
23.              }
    $ ]( ?, K9 _4 v* I* r3 c: M
24. 
    + o( P9 e! X- M# i3 T
25.           }
    $ a3 K$ E5 k% E( Q* `+ ^  I* ~; r, p
26. 
    & p* N6 o3 x* A% ^
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    
28. 
    
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    
30. 
    
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    ! X9 v6 L8 z& Y- r7 J( X* R
32. 
    ' `/ x% Q9 c, [+ V+ Q
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

3 F: Y7 M  d7 n" ]& D& T% @7 @通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。

: n3 \6 U" c$ v$ j2 C
测试结果：

' Y. p. l, r. N- k# E7 j3 t% K2 Z6 N
; a1 ^5 e8 C, i1 h9 o4 O$ m反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享