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

若枫

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

1. int  EQ_is_equal (double s, double t);
   
2. int  EQ_is_ge (double s, double t);
   , u4 N( O% a0 ~* N2 W# m1 o
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);
   ; a& X$ [' Z, Q% r4 m
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    8 B+ x7 a: d6 ^1 T: t
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    
14. double Check360 ( double angle );
    0 A- u2 Z. t% x$ n
15. //#=============================================================
    & o$ [: K! d* U6 g' |
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    
17. //#=============================================================

复制代码

- ]$ i* {: k2 e, z" N' Q以下为部分源代码，用于判断，计算角度等
0 H  ^. [; C+ l. @+ ]+ U

1. int  EQ_is_equal (double s, double t)
   2 ?- _" m2 I5 h! O1 A8 O
2. 
   , F. ]0 b" c! F/ t1 J2 U
3. {
   ) b; w7 ~& {" F+ @' S0 c8 e
4. 
   - B: [: l# ^" l7 _2 H& G
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   
6. 
   ' }/ @; I0 Y) k$ `+ ~
7. }
   
8. 
   
9. /***********************************************************************/
   2 }( b7 _; y/ @1 V' @
10. 
    " |$ I! u% Z/ e4 B# X! N  t
11. int  EQ_is_ge (double s, double t)
    8 k1 _' P' V3 b. S# T9 P3 _
12. 
    
13. {
    
14. 
    / \* D# j, o/ y( H! K! `  B  F: C
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    5 D. S% ^: `! `9 p8 c* X
17. }
    # a4 D$ J5 d5 j$ i1 E0 _# @5 a
18. 
    4 Z+ r) h: _7 x+ _( e  [* L) e# h
19. /***********************************************************************/
    
20. 
    
21. int  EQ_is_gt (double s, double t)
    , c" v' ?/ y, ~; B$ i, E+ V
22. 
    : t- m% k9 X. v! C9 Z; B: G- ]
23. {
    + j2 p5 j/ t; N1 x. V+ B; L/ E
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    . ]% E+ U+ D) X3 m1 y
26. 
    
27. }
    7 Z- D4 |, M7 j
28. 
    
29. /***********************************************************************/
      D$ j7 K) T- ]6 y5 A. c8 B& }3 u
30. 
    7 l7 l; I8 b5 p! ~2 o# O, Y
31. int  EQ_is_le (double s, double t)
    
32. 
    * D+ W0 M$ X! B/ t0 S
33. {
    
34. 
    4 X+ S0 x5 b; c8 j& N  X5 }
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    " Q# Z$ s4 Z1 @/ r2 _8 J9 R3 J$ @1 D
36. 
    
37. }
    
38. 
    
39. /***********************************************************************/
    2 b5 Z) Q( E# A$ ?6 A2 x8 \- i+ z
40. 
    
41. int  EQ_is_lt (double s, double t)
    0 j- k. i) C# H" u  L
42. 
    
43. {
    
44. 
    % ?- X) Q+ Z5 w
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
      S+ g/ E. h1 n/ g( |7 ?( s
47. }
    + \; p6 ]9 U! M0 b; |8 j
48. 
    # W+ X$ c( R4 Q5 `
49. /***********************************************************************/
    5 j' H3 ^+ \6 g7 t
50. 
    1 J; @# _3 A- k' S. X& D* M
51. int  EQ_is_zero (double s)
    
52. 
    7 F) v  ]  L* B' z2 D
53. {
    
54. 
    ( ]" D8 _- [, j" p
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    ! r& D2 h5 Y2 s6 `" a
56. 
    ' b2 ^1 K) t3 p  r" f" r
57. }
    " F0 k6 |# m6 |0 P6 U8 l) {
58. 
    ; q  p# S& @8 s2 g6 z
59. //=============================================================
    ( r1 W3 b# M1 s# |: Z; `
60. 
    
61. double ARCTAN1 (double y, double x )
    * I) f$ M) w, X" M; F$ z! l9 _
62. 
    ) A7 A* l4 x  v% N, o
63. //#=============================================================
    
64. 
    
65. {
    
66. 
    $ B& m+ W# {4 |
67.    double ang;
    
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    # B4 k/ x0 `. F( v; F  O8 j
72. 
    9 {3 F+ P4 ~& L6 R" m0 s, w) b
73.    if (y == 0 && x == 0) { return(0); }
    
74. 
    
75.    ang=atan2(y,x);
    
76. 
    ' I+ f" K+ s9 c# t6 T7 v
77.    if (ang < 0 ) {
    
78. 
    & C) L0 r: t" s8 S$ `
79.       return(ang + PI*2);
    8 a' W/ C6 A5 T' Q) x3 F' I: Y1 t  i0 M
80. 
    
81.    }
    ; E* g6 C2 I# F  R) b( B5 O2 r
82. 
    $ g$ q% p# n! ]3 K
83.    return(ang);
    % C1 e! T7 Y. X
84. 
    
85. }
    
86. 
    9 M/ Y4 k2 O; F: F% m
87. //#=============================================================
    , T4 B2 V( ~+ B6 h
88. 
    . c& p5 f" Y3 G! l: \% X
89. double ARCTAN2 (double y, double x )
    * q. w0 Z: K! T& `7 ~4 D
90. 
    3 G# q) b! m$ W% t) G' m* E  R
91. //#=============================================================
    
92. 
    
93. {
    
94. 
    
95.    double ang;
    
96. 
    / L& p, i( n% d" V0 T  E3 j
97.    if (EQ_is_zero(y)) {
    : F, q9 n! T% z$ }
98. 
    
99.       if (x < 0.0) { return (PI); }
    1 Q: ^5 D; w0 `$ }. i, \
100. 
     
101.       return (0.0);
     
102. 
     
103.    }
     : U5 ?8 e7 w+ L9 O, d# z  ^5 t
104. 
     8 y+ e. |) D2 |6 u6 z$ s8 p9 a6 M. e
105.    if (EQ_is_zero(x)) {
     5 p- ?5 @* D7 S7 k) ?6 ^7 }
106. 
     : J4 J. u, q3 r' f8 v& {
107.       if (y < 0.0) { return(PI*1.5); }
     ' R0 c8 }$ V: r) x- U4 W0 K3 `
108. 
     6 B' W, R5 i' \( o' h+ v
109.       return(PI*.5);
     % U; o( }3 v$ }5 L( X6 m. D
110. 
     ( M% v" D/ z0 C5 @
111.    }
       T5 s# P, O7 @. k# A
112. 
     ' _2 q( t8 C0 V* H0 u
113.    ang=atan(y/x);
     
114. 
     7 y% l- i# p  ]
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     $ T( R, T4 ~7 v; w, e
116. 
     
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     # _9 M5 J* P% a( e
118. 
       V* F( T$ ~. C% f
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     
121.    return(ang);
     
122. 
     
123. }
     4 U' d, m& m# E$ H! Y
124. 
     
125. //#=============================================================
     
126. 
     
127. double CheckConst ( double angle, double constvar  )
     % y. Q* A' J- Y7 F) Z
128. 
     4 ?7 a! y  f8 G
129. //#=============================================================
     
130. 
     3 }' e9 r; e; K% u* O
131. {
     1 }0 S5 @7 [6 U; v$ @
132. 
     - q2 I8 G  L3 n" n' O$ ]/ O$ a& s! v
133.    while (angle < -constvar) { angle+=constvar ; }
     ! b4 T/ I4 @* J. o; y
134. 
     5 t2 P. }- Z, q0 U6 E" y
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     : L6 ]2 ]9 ]. }' E" l+ Z' A3 ^
138. 
     
139. }
     
140. 
     / ]5 M9 F  V: l* J
141. //#=============================================================
     
142. 
     $ Q% a& O- c; s/ u7 r
143. double Check360 ( double angle )
     
144. 
     
145. //#=============================================================
     % k1 f8 ^: X! `8 h, {7 ~* [
146. 
     . B- R5 Q7 L! n4 q1 \, e+ E, _
147. {
     
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     6 f! k3 _& ]( m, c$ m$ x- }
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     
153.    return (angle) ;
     
154. 
     " L- t: ~% ^% ?9 ~  c
155. }
     
156. 
     
157. //#=============================================================
     0 _% @6 V6 R. E- L3 L" R9 x
158. 
     - M& t  [: s3 m3 ]; L5 C/ _
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     - V* }/ x# |; M  W3 E  x0 l
161. //#=============================================================
     5 M- d6 O' Z8 @& h9 K& X( \3 G
162. 
     
163. {
     ! B+ h# Q; E  |, J  r
164. 
     9 K5 t( S! ?' u5 g/ b% E8 V9 c
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     
166. 
     - ]" |/ r. V$ h3 ^6 Z
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     5 L7 C1 g9 L7 t
168. 
     
169.    return (angle) ;
     
170. 
     
171. }

复制代码

% M& ~/ a7 t7 B以下为摇篮5轴计算过程代码
0 D7 ^6 ]6 H  G8 t

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   
2. 
   
3.          j=0.; B1=0.; B0=0.;
   & ?% o* v5 \/ O) h4 |3 p6 I9 I7 K
4. 
   ; h7 N. X5 t' a1 c( z
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. 
   
9.           }
   5 j9 |2 c) X4 d1 @/ h8 q8 G5 R+ L
10. 
    
11.           if (EQ_is_lt(i,0.)) {
    
12. 
    . @* p& h$ \4 ?. j& j8 S
13.              if (EQ_is_lt(k,0.)) {
    ) e& K4 Y( q4 z# X3 R
14. 
    
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    
17.              } else {
    , t! d& d. k2 e2 l2 ?7 Z3 }' P
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    
21.               B1=2.*PI+B0 ;
    ( K2 S/ T1 S4 J7 x
22. 
    / i& l" U7 s1 P1 A
23.              }
    ' j6 k/ ?1 s& [, F1 \, s
24. 
    
25.           }
    7 J) V( o2 q' @' u1 B
26. 
    9 y1 b( d0 o7 p0 f2 j. y
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    + Y8 N1 b9 c. b; C  c
28. 
    ! j  _, j- Z# L: a$ m! `1 }# S
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    
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程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
1 M, f( c7 c- e1 V4 q6 K
7 D- V8 p- q: a
测试结果：
+ }  P  [, }) z+ f: i% G

反向测试结果

yucammayco

谢谢分享