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

若枫

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

1. int  EQ_is_equal (double s, double t);
     D% U( H+ i6 \# S, n2 z" e
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);
   
5. int  EQ_is_lt (double s, double t);
   
6. int  EQ_is_zero (double s);
   - K. M9 k  P2 i$ D2 C
7. //=============================================================
   ( l6 f' V( h+ l, n; Y3 t2 V/ C
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    + W2 Q9 L$ q9 K9 ?* A) R
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    ) d* g, v' M+ \+ z  ?
14. double Check360 ( double angle );
    ) ]# |. s' i1 U5 I
15. //#=============================================================
    & r& h. s7 x7 L& J) g
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    
17. //#=============================================================

复制代码

3 q! U7 d' Q' d, G以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   & j* N5 G; ]/ x1 i  P7 K& X
2. 
   ; a( y- T! w/ ~6 p, K
3. {
   9 U% m  y! {% h0 S! }! g6 q% N9 d
4. 
   
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   0 E) p1 y# i; [' J1 u* B$ |
6. 
   % h) a. T' P: T9 y
7. }
   
8. 
   
9. /***********************************************************************/
   . h! M5 |1 y- t  d. \& R- f
10. 
    
11. int  EQ_is_ge (double s, double t)
    
12. 
    : w  N) j8 D) a* o3 p6 d" n8 P
13. {
    " I% {" `7 D0 z3 R/ g5 c3 R9 h
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    2 }2 S2 Z7 p! ~  Y1 N2 a( Z/ O
17. }
    
18. 
    7 h! J/ }& M% N1 H+ e2 ~" d/ L- _
19. /***********************************************************************/
    
20. 
    
21. int  EQ_is_gt (double s, double t)
    
22. 
    
23. {
    
24. 
    ; O8 H' j' s1 Y% M# [
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
      H, R! d- }: _, e
26. 
    & {* J0 S3 K$ ]4 M0 N4 @3 T
27. }
    
28. 
    
29. /***********************************************************************/
    ( i, A5 b+ J% `6 w) A$ N
30. 
    
31. int  EQ_is_le (double s, double t)
    
32. 
    
33. {
    
34. 
    
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    , z5 U0 ]; L! E/ z* x2 B
37. }
    
38. 
    4 K' J+ ~) C# X9 u* j9 ^" B
39. /***********************************************************************/
    0 Z! |* D9 b$ a
40. 
    2 s) P9 {3 G) r5 H. q/ p% @
41. int  EQ_is_lt (double s, double t)
    
42. 
    : I9 S$ q. I$ U! t/ y
43. {
    
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    2 A- }4 n; d2 @; b9 z: W! w
46. 
    0 Z7 `, y( N! u, O8 T$ T
47. }
    
48. 
    
49. /***********************************************************************/
    9 {! i0 c7 T, [: W8 _# I- x
50. 
    
51. int  EQ_is_zero (double s)
    ; N2 K' @( F1 e+ O/ Z3 L0 ^
52. 
    : X9 l' j0 M1 [
53. {
    
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    
57. }
    
58. 
    * O  {6 z/ k9 K* ?' H2 p3 O
59. //=============================================================
    
60. 
    3 t! H7 _3 M8 ~
61. double ARCTAN1 (double y, double x )
    1 z( X6 E; T( Z5 ?+ K2 V
62. 
    
63. //#=============================================================
    7 p8 v. ?3 l; t* F0 v* ^+ u
64. 
    
65. {
    
66. 
    
67.    double ang;
    
68. 
    ) v+ R& t5 z* ]% [; A2 m0 q6 V
69.    if (EQ_is_zero(y)) { y=0; }
    $ O! J3 E/ u* a% ]; d5 ]6 m
70. 
    ( |  P  s9 z! t- j. T9 l
71.    if (EQ_is_zero(x)) { x=0; }
    
72. 
    : @5 [3 S$ G# i2 D
73.    if (y == 0 && x == 0) { return(0); }
    . H7 J0 z! ~! [. M) I- q% s$ i
74. 
    
75.    ang=atan2(y,x);
    % ?' ]' j) K: N
76. 
    
77.    if (ang < 0 ) {
    
78. 
    % I# _. Q, X+ U  Q/ S( `1 G
79.       return(ang + PI*2);
      v& x* g* g* |. {0 F+ |
80. 
    
81.    }
    " T7 o& G' y. z! Z
82. 
    
83.    return(ang);
    & U" n0 G# E. s: K$ {9 Z" G
84. 
    
85. }
    , C5 N$ |2 T* I
86. 
    
87. //#=============================================================
    3 H) Q1 H8 P# n
88. 
    : E  @  [0 t% l  l
89. double ARCTAN2 (double y, double x )
    $ n1 N2 u/ W1 a4 B! [# n1 T
90. 
    / W5 I* [7 T; p8 K) u7 e
91. //#=============================================================
    
92. 
    - w  C  ]! g2 z& R( Q* v
93. {
    6 \1 w, M, l5 G! X- Q  `$ S6 D# P; t. L$ B
94. 
    
95.    double ang;
    
96. 
    
97.    if (EQ_is_zero(y)) {
    ) M8 ?% U  \3 e* H5 B
98. 
    
99.       if (x < 0.0) { return (PI); }
    
100. 
     ! |* \3 G5 P$ m, D  s# X
101.       return (0.0);
     
102. 
     ' j& k1 k2 h0 n" t$ g% R
103.    }
     ' b: h2 \8 J* I6 M  N. B
104. 
     
105.    if (EQ_is_zero(x)) {
     
106. 
     : x; u  ^& i8 N; I0 u7 V
107.       if (y < 0.0) { return(PI*1.5); }
     5 w2 t+ l2 J1 p0 Y! s
108. 
     
109.       return(PI*.5);
     
110. 
     
111.    }
     3 J! o8 P' D( |! H
112. 
     # I! Y6 Y7 ?  g( P" O4 M
113.    ang=atan(y/x);
     
114. 
     7 r; t9 t# k! e5 d9 Y( m9 @! m
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     
116. 
     
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     8 |% x" L  P" q1 r" Q' \
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     " r" j3 N* X, k7 l
121.    return(ang);
     ; T- B6 k9 N2 C- J( ?: s+ }
122. 
     
123. }
     
124. 
     7 r/ b$ b5 f5 ]) G& N3 ?' {7 v
125. //#=============================================================
     4 k' ]% @8 H: ^% `3 b- g
126. 
     
127. double CheckConst ( double angle, double constvar  )
     
128. 
     
129. //#=============================================================
     . ~) r7 o. T  x' v
130. 
     
131. {
     4 G3 x) t1 d, x/ F3 ]* h. B
132. 
     + J) o, k8 U& e9 T% T  N
133.    while (angle < -constvar) { angle+=constvar ; }
     
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     + ?( n& C; M! i: O
136. 
     
137.    return (angle) ;
     " j/ e& O) ?6 A, C
138. 
     ) O" Z- Y, R/ D, ^, Y& N* k8 P
139. }
     
140. 
     
141. //#=============================================================
     
142. 
     6 L3 K: g! F$ u, _  w
143. double Check360 ( double angle )
     9 T- t- I+ N* i2 J$ t. R
144. 
     8 S8 F: ^" R( _' F, c/ X) Q
145. //#=============================================================
     # q5 q0 F0 a' G$ |& o! m; u: l. y+ M
146. 
     
147. {
     
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     1 w1 M4 ~0 V9 o0 Z
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     0 E: g8 W) g4 M3 i8 ~) E
153.    return (angle) ;
     
154. 
     
155. }
     1 k0 u4 P+ `- d& F
156. 
     2 y& t3 j( @5 \& q
157. //#=============================================================
     
158. 
     0 o( k; }  A/ K, y, m
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     
161. //#=============================================================
     
162. 
     9 {$ M- b: e$ o& I* Q( u# P% Z! q8 U
163. {
     6 Z: b  a# O& @" e$ s
164. 
     
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     
169.    return (angle) ;
     
170. 
     2 q  u* m' \) ^
171. }

复制代码

" C* J2 C8 [5 ~8 O' s8 ~& ^) W5 [以下为摇篮5轴计算过程代码
% E; P4 U5 V% r- y

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   
2. 
   
3.          j=0.; B1=0.; B0=0.;
   
4. 
   ( x0 K& o) d, J! V& H: @
5.           if (EQ_is_ge(i,0.)) {
   : J2 v7 H: p- b( h; p3 [& \
6. 
   " B) u  m1 u; J
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   
8. 
   
9.           }
   
10. 
    
11.           if (EQ_is_lt(i,0.)) {
    4 g. j  ?% t0 Z
12. 
    2 M5 }. D$ F' F! G/ b2 f2 a( c
13.              if (EQ_is_lt(k,0.)) {
    
14. 
    ( I  A0 z& N# n5 S" D) l7 I2 X
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    " O3 x6 b- p+ f" c' _- k& G; W0 F3 O( j
17.              } else {
    2 C; Z0 v9 L* z- W1 }# i" ^
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    
21.               B1=2.*PI+B0 ;
    8 t; Z: _) M- Z: R1 p4 f
22. 
    , h6 {4 }# z; T6 |. u; o
23.              }
    
24. 
    ; W. [6 g* y+ s" k
25.           }
    , [3 B! i6 d+ l  U8 ~
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    
28. 
    
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    6 `7 _% C/ [6 W( o+ g, [9 X
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程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
4 f4 b8 l: j; \% Y  d! T
, c! r% `- w( J' E! Z  A5 G
测试结果：
/ Z) |& }9 z8 q

5 {% r# H1 R3 D# O. [3 ^反向测试结果
% }3 B, k' R4 K- R# E+ n8 \! I

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享