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

若枫

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

1. int  EQ_is_equal (double s, double t);
   " G0 J( p, \! a
2. int  EQ_is_ge (double s, double t);
   
3. int  EQ_is_gt (double s, double t);
   
4. int  EQ_is_le (double s, double t);
   " I2 h& X7 @+ H( o9 M
5. int  EQ_is_lt (double s, double t);
   
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   + u$ C' F/ V7 F; [+ q3 J
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    1 u. l  v/ [( Z
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    
14. double Check360 ( double angle );
    . f7 X* [. I6 d6 l
15. //#=============================================================
    ) X+ F% V9 s' t$ t
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)
   ; B6 k3 {+ N  ]8 w# ~1 ?
2. 
   % h! ?+ b/ E( k, o0 t: [7 I
3. {
   4 K( \! G! `# C' F
4. 
   - S6 I6 x" e( v* G* t$ v1 B* M* a
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   . y$ F1 A7 |. K
6. 
   & @# K6 l5 U# o4 [' b3 Z
7. }
   
8. 
   
9. /***********************************************************************/
   
10. 
    6 f" y& J7 l1 o% `# |! K
11. int  EQ_is_ge (double s, double t)
    / `4 E. W2 D  `3 P- [1 M3 y' ]
12. 
    , v; ?3 W; X( C  r
13. {
    ) t' I& j# r2 g& B3 Y) e: S- {1 T
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    - b8 Y8 p. g4 O) ]# ^) I/ ]# c# T
16. 
    * J" R) q/ z" j( v' C4 x
17. }
    
18. 
    : L' v' h! {- D2 L4 W/ J$ Q5 ?. t! z
19. /***********************************************************************/
    5 p4 `" }; z5 E, W4 b( A3 U
20. 
    / F* H  {6 s/ B1 S( r5 Y
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. }
      O0 M/ D/ V0 p. H0 c
28. 
    0 [" _- \2 r/ L, t
29. /***********************************************************************/
    
30. 
    
31. int  EQ_is_le (double s, double t)
    : C$ A  M6 U) s, y0 |' @5 Q
32. 
    7 L) R9 E9 n$ r, N
33. {
    
34. 
    
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    
37. }
    
38. 
    - {$ s3 c8 I# y
39. /***********************************************************************/
    
40. 
    # }, @, ^- }: G  B1 C1 F
41. int  EQ_is_lt (double s, double t)
    9 t3 U. U( X! L8 k5 Z( d2 a
42. 
    
43. {
    
44. 
    ! x1 |4 U% O6 ~7 M
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
    " x" V. x3 d# R. D) F
47. }
    $ ~$ v9 X0 ]$ L- \' ?
48. 
      a5 A8 P9 {4 F; C
49. /***********************************************************************/
    . g& B1 ^4 k5 u- e1 g4 C$ p, Y& ?- s
50. 
    
51. int  EQ_is_zero (double s)
    ( `6 W$ Q! d8 |2 W. d& T
52. 
    
53. {
    " b2 K- v# L8 h1 b
54. 
    / k! v. y3 V* {: T: l$ ~. X
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    
57. }
    $ A7 B; L2 M9 i
58. 
    
59. //=============================================================
    
60. 
      S3 }' V" d4 G$ H& g" J
61. double ARCTAN1 (double y, double x )
    + r$ k. Y! t; a' I* x) ?4 L
62. 
    
63. //#=============================================================
    
64. 
    7 S- o( p) c8 I# i
65. {
    : W, L; [/ W) _
66. 
    2 D: f* l% ~5 K2 E& F% u3 I5 c# W% K
67.    double ang;
    " v- W, J9 H) |) `- T, Z9 H
68. 
    $ u. i' [& ^1 ^1 v; [" d
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
    5 ~0 P' j1 y& T) m! ]
71.    if (EQ_is_zero(x)) { x=0; }
    ' ~& _+ \0 H- y5 q* y5 M
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
      z& o0 b0 s9 h- h7 L! P6 W
74. 
      Z* j! N5 W' l  {! }+ ~. G
75.    ang=atan2(y,x);
    
76. 
    
77.    if (ang < 0 ) {
    % Y+ k) K! m- l; m. I  X
78. 
    2 N7 i$ V2 r# n! J- {; Y
79.       return(ang + PI*2);
    
80. 
    4 P' j* B0 h( K
81.    }
    8 p9 L1 G) a$ ^" p( `% F: C
82. 
    
83.    return(ang);
    5 g+ t6 k+ O5 e# P* {3 w5 [
84. 
    , s* e4 G/ K& U# v+ j% }1 {4 b
85. }
    6 a) w, ^+ b0 j9 A; A& }, \1 Q
86. 
    - @* ]) [% d3 Z& _  H
87. //#=============================================================
    
88. 
    - V, K2 G5 A( O# a
89. double ARCTAN2 (double y, double x )
    7 S; Z: E9 l6 T* m5 |# u% {+ e2 f
90. 
    " z1 ~7 T% ?& L, W& S3 V
91. //#=============================================================
    8 I' }* W& B% v: t5 D) s
92. 
    5 g, e3 H, U  E. G
93. {
    ; z& V! `' U, [! Y
94. 
    ' v2 z. X. [2 G1 ^0 X
95.    double ang;
    
96. 
      E; ^  I; t* B6 t% j+ S/ J
97.    if (EQ_is_zero(y)) {
    * D4 ^2 M0 G; L& Y/ A3 f/ ]8 I& w3 v
98. 
    
99.       if (x < 0.0) { return (PI); }
    
100. 
     
101.       return (0.0);
     8 c" `" s% h) |; v7 d' T. D
102. 
     0 V% T( l. x2 M8 t. g/ h' ?% U
103.    }
     
104. 
     
105.    if (EQ_is_zero(x)) {
     
106. 
     8 p* ]* Y. K, n2 R% g3 Z0 }2 }8 q
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     
109.       return(PI*.5);
     2 o/ j; x. u4 s+ M
110. 
     
111.    }
     ( K9 }2 U5 o" z% n( z/ d
112. 
     
113.    ang=atan(y/x);
     1 d% [  x5 t3 V& U: S% t3 h3 g
114. 
     ( f3 y' k8 Q: ]7 b, u. {* _
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     , P+ y# T) c8 Z2 o6 ^8 p
116. 
       k+ V# U$ \0 r) Q& u9 R8 Z
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     3 U0 @/ f, U* I8 B
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     0 G+ c  @: L% ]3 ?/ n0 G
120. 
     , o7 G0 j4 R# v1 m2 [
121.    return(ang);
     $ Q% z3 N+ B: M' j- V
122. 
     4 W+ I7 Z% X( ]2 b2 {! b
123. }
     2 a; D6 E& O, z; ~+ }7 L: V$ o8 d7 b
124. 
     9 p( \4 \8 L9 C! |3 R9 y& V. N
125. //#=============================================================
     4 K" ]( J' X7 J0 P: S; ]! c, n* T3 }
126. 
     5 X& F' Y. u8 l+ u; L
127. double CheckConst ( double angle, double constvar  )
     4 A; U+ i; C/ E
128. 
     
129. //#=============================================================
     $ f; c. z5 s  J, v
130. 
     6 m4 X" n! _5 m9 f$ Q
131. {
     
132. 
     
133.    while (angle < -constvar) { angle+=constvar ; }
     9 D! j0 w% C6 g& E3 x- O
134. 
     ! j# {  Q) r! |3 g6 p
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     " Q6 |. l0 N7 L& C  X
138. 
     
139. }
     3 E4 y8 o3 Z% Q6 S  a
140. 
     + k: B% a5 F5 M: `6 w) U! b
141. //#=============================================================
     & m3 ~# U! q: \5 E2 J& B' w
142. 
     + z& `. m9 h$ M& R- \  D5 l5 O
143. double Check360 ( double angle )
     
144. 
     
145. //#=============================================================
     ' n& \( Z# c6 o
146. 
     
147. {
     ! b( z  |" O+ k4 d0 s8 d7 \
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     , @, q2 d0 c" S
151.    while (angle >= 360.) { angle-=360. ; }
     & m# S; }' f7 E5 y% A1 ^; v8 J
152. 
     . h  C' ], Z1 o4 {; X& ^
153.    return (angle) ;
     4 [" d" V; o. m3 C. N: [* v) L5 [
154. 
     
155. }
     * U. y) w* Q  r0 i) A$ Y. @
156. 
     
157. //#=============================================================
     
158. 
     , E# @. K, N4 L1 W1 c* f/ N, f. _
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     / M" E7 s* ]( t
160. 
     
161. //#=============================================================
     ' J7 ~$ s: S$ O9 |' Z9 y4 `
162. 
     9 K7 [/ E, g" _2 B2 ^
163. {
     " s4 H6 h) {/ h6 O& a4 v
164. 
     . E  ?+ j$ E2 J' G, {
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     : P4 b5 Y$ ^, A2 s$ S1 d
169.    return (angle) ;
     
170. 
     
171. }

复制代码

* J1 j4 \: y% N7 k4 T+ P以下为摇篮5轴计算过程代码

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   ! I3 ?" X$ G4 D8 m
2. 
   , \1 u4 w% L( b' v/ d# n
3.          j=0.; B1=0.; B0=0.;
   ; B% e% f4 `# \% O
4. 
   ! v  P/ U; [$ _. [# D9 I7 G
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; }
   
8. 
   : Q$ F+ b2 Z) {( U8 @; ]" V3 z& q# l
9.           }
   
10. 
    # Z/ f" O9 ]  k& T$ N1 @6 f, t
11.           if (EQ_is_lt(i,0.)) {
    : \0 }/ U# K1 o3 m% v; n8 `
12. 
    ! [/ F3 v) n8 {( @; o
13.              if (EQ_is_lt(k,0.)) {
    
14. 
    
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    ( F  m! U4 {& h0 |
17.              } else {
    
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    # ~) J/ h' E( J$ t
21.               B1=2.*PI+B0 ;
    0 @+ W( r3 @& m, Q+ m! u
22. 
      t% r0 d' c2 ~! ~/ ]
23.              }
    
24. 
    9 q! _* q7 I" E, v
25.           }
    : C( Q- ]: O* q0 ^9 W7 S$ b( b
26. 
    ) |- b2 d/ j8 }2 J, F
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    
28. 
    ) U9 t, h0 E3 x7 O
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    # u/ j& X+ _% ^0 g9 F2 u# h& Q
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程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。


测试结果：


  a8 e( z- ?" I% c# g反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享