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

若枫

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

1. int  EQ_is_equal (double s, double t);
   
2. int  EQ_is_ge (double s, double t);
   # S' S" h/ l5 H" O
3. int  EQ_is_gt (double s, double t);
   
4. int  EQ_is_le (double s, double t);
   . ~+ Q, O6 P7 s4 u& `
5. int  EQ_is_lt (double s, double t);
   ) P: _% k- w5 f" x2 y
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   
8. double ARCTAN1 (double y, double x );
   + V0 q8 k$ s7 P/ }6 }0 m
9. //#=============================================================
   3 K; j" o7 G8 y! O" J
10. double ARCTAN2 (double y, double x );
    # |, _) T$ z, c- n& [
11. //#=============================================================
    . z, x. Z9 M' g% V+ Z, b# b2 D
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    + y3 J  H' _% E/ m" x# y% |
14. double Check360 ( double angle );
    1 l+ T& m# @( T
15. //#=============================================================
    ( O* B3 D; r; L+ y; G: c
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    0 I% l0 {& @1 E5 T
17. //#=============================================================

复制代码

! Q/ @+ Q4 Q0 g9 O以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   % `1 j* E# ]8 d9 Y! J1 J* U
2. 
   ! m4 r+ L6 E$ i9 _7 i+ l& D
3. {
   
4. 
   
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   1 L* ]5 ~: u  e+ v4 O% i& Z
6. 
   % C) T8 l* `, j5 ~7 c9 R
7. }
     I! ]4 O- g* R9 C/ P
8. 
   
9. /***********************************************************************/
   
10. 
    
11. int  EQ_is_ge (double s, double t)
    
12. 
    . \5 l# r2 D4 C+ `
13. {
    ( f3 l/ `8 `! |# Y, H- W
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    - F: [. N7 \. e: a3 d+ B* F
16. 
    
17. }
    
18. 
    
19. /***********************************************************************/
    . ^1 c* A1 ~, i) y' `0 i" D
20. 
    
21. int  EQ_is_gt (double s, double t)
    ; s4 ^% t5 ]! ?
22. 
    
23. {
    8 F1 ?. R* H& G' I  Y
24. 
    3 l7 e& A4 f- D- h, K
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    
27. }
    ! {: d0 v8 k1 A& @. J/ b9 w% {
28. 
    * n7 Y, f) X0 |4 F/ j) V! O
29. /***********************************************************************/
    
30. 
    
31. int  EQ_is_le (double s, double t)
    ) N4 |0 T8 m* f  ?
32. 
    , B6 ?) R* O: M1 t' P
33. {
    
34. 
    , g' O7 l' B# S' a3 |2 p. X
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    ; p0 R5 A# T% J. ?( I: C+ y! N
36. 
    
37. }
    
38. 
    
39. /***********************************************************************/
    4 Q" O0 m9 A* d" A1 J
40. 
    1 P* Q; R  X$ V/ X! P8 v0 g+ X: Y' b
41. int  EQ_is_lt (double s, double t)
    5 S0 O$ Y9 j5 m0 m
42. 
    
43. {
    ! u" g) I  p- r  ~6 d8 v
44. 
    8 h( F% T/ {+ _$ B4 p: K. r: F
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
    
47. }
    
48. 
    
49. /***********************************************************************/
    
50. 
    
51. int  EQ_is_zero (double s)
    
52. 
      z2 d) z, ~& F0 s0 {
53. {
    
54. 
    . J8 E: d9 T, r$ G3 ~: n+ D, o0 t% ]
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    . i' `5 z3 _1 i( z8 h" r' M
56. 
    
57. }
    ! h5 J$ \) E0 Y6 D2 x& R, T
58. 
    
59. //=============================================================
    
60. 
    
61. double ARCTAN1 (double y, double x )
    
62. 
    , ^5 x# j; ^3 F4 @. `# h
63. //#=============================================================
    
64. 
    ; d$ F0 c2 O8 _2 m# N
65. {
    
66. 
    
67.    double ang;
    
68. 
    ' w; v& J1 }, n+ g8 G6 \4 g+ k
69.    if (EQ_is_zero(y)) { y=0; }
    * e; K/ z* s; @7 v! [& j
70. 
    0 g8 Y5 n1 o- x2 |" m5 F
71.    if (EQ_is_zero(x)) { x=0; }
    2 _8 S# r4 [3 \# [5 q1 B  m  h- w8 s
72. 
    : H+ [" G( v  I5 v) D+ A. |
73.    if (y == 0 && x == 0) { return(0); }
    
74. 
      [  h% b& m9 I( ^
75.    ang=atan2(y,x);
    
76. 
    9 a0 ~7 M- V) e7 g! q& _$ q1 h
77.    if (ang < 0 ) {
    
78. 
    9 W9 Q" o* s0 f8 Z
79.       return(ang + PI*2);
    
80. 
    $ h0 E: g4 M, l2 I7 Q6 F  C
81.    }
    # P; |' W  {5 k; G" M! O) s
82. 
    3 p  h% ~- m# Y4 Y
83.    return(ang);
    
84. 
    , Y5 C4 G* S3 J  z
85. }
    , ~3 I8 J6 |7 P/ V9 Y
86. 
    
87. //#=============================================================
    & `& V: O: ?1 F$ D6 w+ W
88. 
    
89. double ARCTAN2 (double y, double x )
      d% g! p, n% H+ I+ v$ z3 f
90. 
    - {' q4 X0 ]/ z
91. //#=============================================================
    , c. T0 K, H; m' v. }# y. Z; h
92. 
    
93. {
    & r4 t6 M( X/ C& P! \
94. 
    + \  V# [( e4 K1 n4 ?
95.    double ang;
    
96. 
    ; u% v1 g# L( Q# E8 C
97.    if (EQ_is_zero(y)) {
    $ M5 u9 A6 M* T$ f' c
98. 
    
99.       if (x < 0.0) { return (PI); }
    ! Z" Z9 A* D# d
100. 
     
101.       return (0.0);
     
102. 
     ' K5 w# F# X. O# P) k
103.    }
     ( k, t) m+ O9 Q) ^$ [
104. 
     : }& J  N& T4 R8 c
105.    if (EQ_is_zero(x)) {
     
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     3 k2 z+ X' F7 F' }8 R! G* Y
108. 
     
109.       return(PI*.5);
     8 b7 d9 i/ g+ I& N; [2 q% C, a
110. 
       I; r. d* b7 E3 T& l$ F4 T
111.    }
     7 g+ e( u+ r7 [, q
112. 
     
113.    ang=atan(y/x);
     
114. 
     9 [$ n6 Y1 Z8 x& g/ G1 ^/ j. \
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     $ |' `4 n) y0 d
116. 
     
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     " _0 B5 p( u* [" ]( U# P* u
118. 
     : n9 y" _5 w# f) n7 p
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     
121.    return(ang);
     * a7 n, I9 b9 ?; U- z. }
122. 
     # f& X* t- e" ^# {
123. }
     
124. 
     ( m3 B, G+ E% h( F% F
125. //#=============================================================
     
126. 
     " N$ D7 x+ X1 I  {+ B- o
127. double CheckConst ( double angle, double constvar  )
     1 W6 F7 n4 f" _* f+ F: t
128. 
     
129. //#=============================================================
     / F4 G$ O3 r& Z$ q( E
130. 
     
131. {
     
132. 
     % N5 R9 B8 z  z$ a. I
133.    while (angle < -constvar) { angle+=constvar ; }
     
134. 
     $ l" `& A: r1 }- K6 a5 U
135.    while (angle >= constvar) { angle-=constvar ; }
     8 b, R" b: R4 Q1 O# @  R/ [6 b
136. 
     # \: Y0 b6 ?: t! g1 z, x  T
137.    return (angle) ;
     
138. 
     
139. }
     
140. 
     0 Q# z1 Z' b3 j3 N; q
141. //#=============================================================
       r2 y! e! I6 J4 `& K
142. 
     
143. double Check360 ( double angle )
     / {0 `" Y. p& N( `
144. 
     
145. //#=============================================================
     
146. 
     5 V  I4 _5 k% F6 Z& S) A3 ^
147. {
     , ~$ m. [8 q8 }8 F1 _* Z
148. 
     3 n/ @/ v! `2 P, X% B$ o; A
149.    while (angle < -360.) { angle+=360. ; }
     / P( D. j9 d' c  e# _$ |
150. 
     9 W& o, Y9 E+ F* L) Z2 J1 J
151.    while (angle >= 360.) { angle-=360. ; }
     $ ]. Q4 i9 s! R* p$ P" o
152. 
     . E/ m$ z7 s- n# f
153.    return (angle) ;
     
154. 
     ) K, _( `8 s4 C7 Q5 W  N
155. }
     
156. 
     
157. //#=============================================================
     . n3 T6 S% y3 @7 y' s& W( V* }# p3 T
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     . K4 N: E' [) q% y& U4 D
161. //#=============================================================
     2 a/ U+ t; }& v8 e
162. 
     : V' F- Y; A7 u4 |6 e& V
163. {
     
164. 
     ! I6 O/ B: J* f8 P
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     3 x! l1 L& t. |& V8 ?6 E/ k/ @
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     ( E3 a5 [5 {6 e, }, `, f$ l1 v
168. 
     4 N- I+ f2 d6 A& G0 C$ X1 L: {
169.    return (angle) ;
     - p9 L& ]0 o( P2 M2 _  M) I
170. 
     ' ~  l9 l5 \; I
171. }

复制代码

* \+ a4 L% t9 o+ e# _9 f以下为摇篮5轴计算过程代码
8 S3 f: l) b# j: u; }

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   
2. 
   1 l0 Q# z9 c# J9 {) m
3.          j=0.; B1=0.; B0=0.;
   
4. 
   ! M9 d6 s5 t: q9 W
5.           if (EQ_is_ge(i,0.)) {
   
6. 
   3 q2 v1 D% V4 T! V( T
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   
8. 
   
9.           }
   5 Z, K& o2 z. i) [
10. 
    
11.           if (EQ_is_lt(i,0.)) {
    
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    
14. 
    
15.                 B0=atan(i/k); B1=B0+PI ;
    6 w! k/ w) L' O
16. 
      ]: C. n: s- L% n; t1 P1 f
17.              } else {
      @5 a9 D" |4 Z8 D# T
18. 
    & k3 ?, I0 c) N
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    5 a* i5 m( u$ G9 X2 }* f
20. 
    7 n4 r( V- S/ _+ \/ R' H/ x
21.               B1=2.*PI+B0 ;
    
22. 
    3 E" g+ }2 Q' u' H" _
23.              }
    
24. 
    
25.           }
    
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
      T" r' J$ V7 E% ~  S" d* b
28. 
    3 A6 z! N3 a$ c  S3 v- r7 J8 k
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    - G% N' C' q2 |. W, G) S3 M  O* d
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程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。


2 P$ H2 B! l1 V" O; I! J测试结果：

3 e* u4 c* ^1 y* V" ?6 p
反向测试结果
0 K& j1 b% f4 h! M- g

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享