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

若枫

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

1. int  EQ_is_equal (double s, double t);
   : I9 Z- F4 f2 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);
   : @8 g: M5 j9 F7 j
5. int  EQ_is_lt (double s, double t);
   
6. int  EQ_is_zero (double s);
   7 c8 z. W' Z. O; b8 n* i% w) f" ^
7. //=============================================================
   4 Y  k0 }/ w$ |
8. double ARCTAN1 (double y, double x );
   ! ]! v1 M" g' L6 y2 Q9 ^- w
9. //#=============================================================
   4 K& j% ]7 S- G1 S) d7 S7 Q
10. double ARCTAN2 (double y, double x );
    6 v- h2 n5 e" ~9 K
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    7 K( a; ~: _  l' O: {
13. //#=============================================================
    
14. double Check360 ( double angle );
    + N7 o) u- O# j: z( ^4 z/ h
15. //#=============================================================
    
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    
17. //#=============================================================

复制代码

, |9 B. g( W6 U以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   
2. 
   $ P+ A$ t6 U% s, Z, C& ~- B
3. {
   
4. 
   + h0 A: Z& i4 R$ `' m; V' T
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   
6. 
   1 x9 x8 V; h+ s5 s4 @+ s
7. }
   - }& N6 j2 L8 f* {; M
8. 
   
9. /***********************************************************************/
   ! R  P4 `5 f: X/ c  g
10. 
    
11. int  EQ_is_ge (double s, double t)
    
12. 
    $ d, I# b+ Z) L: u* B2 J
13. {
    6 C: i; n1 J/ I8 k/ @4 b  b
14. 
    + h2 A" h9 i2 p' N
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    ) |( `3 N; S2 o1 ~2 W
17. }
    
18. 
    
19. /***********************************************************************/
    ' k4 e" D# s& F( l, ^) G
20. 
    
21. int  EQ_is_gt (double s, double t)
    
22. 
    - e( d* o! X5 [: Y
23. {
    0 h, b5 f( T  t. K' C" W
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    
27. }
    
28. 
    
29. /***********************************************************************/
    
30. 
    ' l& r' ?) N4 a2 Y7 ?8 j
31. int  EQ_is_le (double s, double t)
    
32. 
    & I+ d4 l+ S8 ?0 N6 y: ]
33. {
    2 K$ G- c# z$ s  U/ x( J2 y+ v
34. 
    
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    0 F2 z2 M! ~8 A
37. }
    , m6 m) Z/ ]0 K9 x  T) q2 c1 r
38. 
    3 q% X. d& b) y+ k* L
39. /***********************************************************************/
    
40. 
    
41. int  EQ_is_lt (double s, double t)
    
42. 
    
43. {
    
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
    
47. }
    $ t7 G' e' O. g6 p
48. 
    
49. /***********************************************************************/
    
50. 
    
51. int  EQ_is_zero (double s)
    9 Z8 R' ]/ ?- @
52. 
    
53. {
    
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    
57. }
    
58. 
    ) M. L) ^0 C9 `7 C' D8 F7 e* l
59. //=============================================================
    1 }) X, t  Q: u3 m2 Q- T
60. 
    
61. double ARCTAN1 (double y, double x )
    
62. 
    
63. //#=============================================================
    
64. 
    0 L" f: U3 a9 g
65. {
    
66. 
    
67.    double ang;
    
68. 
    5 b* b8 F0 G7 Q: l* C; ?6 R. c$ P
69.    if (EQ_is_zero(y)) { y=0; }
    * \" @# ]: O3 g
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    
74. 
    
75.    ang=atan2(y,x);
    
76. 
    
77.    if (ang < 0 ) {
    5 z; w- |7 ]! G; G6 R
78. 
    4 r3 q& f8 M- f& n) Z; Q# z
79.       return(ang + PI*2);
    : u8 r5 Y! m9 C2 _9 g3 M
80. 
    
81.    }
    
82. 
    
83.    return(ang);
    - q6 m! Y$ E! T  G5 Q2 u
84. 
    
85. }
    3 t- {7 \% F9 S
86. 
    
87. //#=============================================================
    
88. 
    ( H& {! c/ L' E
89. double ARCTAN2 (double y, double x )
    
90. 
    
91. //#=============================================================
    ( [0 l4 i6 S9 l8 d2 M2 f5 h# U( b
92. 
    
93. {
    - M( _# V$ l5 L
94. 
    3 t0 @  z8 p6 r1 D. D- T6 t; }2 ]
95.    double ang;
    4 u4 j+ F% ^6 k% A, o+ P* v
96. 
    
97.    if (EQ_is_zero(y)) {
    1 {7 ~# y5 f, p  L5 g& O
98. 
    + E& j4 q2 j- s; @: b! k
99.       if (x < 0.0) { return (PI); }
    / w( d/ I& X. u; o: P. Z; ^
100. 
     
101.       return (0.0);
     - x' C7 l' \" m3 M
102. 
     
103.    }
     
104. 
     
105.    if (EQ_is_zero(x)) {
     & a9 q( N6 e" A7 |9 `/ _
106. 
     * W& E, H7 `* o+ s. [, H
107.       if (y < 0.0) { return(PI*1.5); }
     9 H. C" m) d8 j  U! n
108. 
     
109.       return(PI*.5);
     
110. 
     
111.    }
     
112. 
     
113.    ang=atan(y/x);
     
114. 
     * N( p' K7 F  Q: P3 Q( q
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     
116. 
     1 r2 p- z3 D' {  J+ Z! X0 D1 Z, ^
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     0 t2 r: I% Q  e* V
118. 
     " S& h' Q# E! ?& @' C4 T- G
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     - _! ~- V1 e/ h( K
121.    return(ang);
     
122. 
     : b0 E* W! {0 ~; V) o- d
123. }
     
124. 
     
125. //#=============================================================
     6 X; A/ U# m1 F7 t; ^1 D
126. 
     
127. double CheckConst ( double angle, double constvar  )
     
128. 
     
129. //#=============================================================
     
130. 
     
131. {
     1 ]8 U" Z9 `3 G0 k. p' i
132. 
     # C1 W$ t& ]% ?& v
133.    while (angle < -constvar) { angle+=constvar ; }
     
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     5 j0 Z% ?( s4 a& v: u& D$ i
138. 
     1 {* Y( K; x, I2 |
139. }
     
140. 
     
141. //#=============================================================
     : V# R3 ~* O8 R5 s0 l$ z& d
142. 
     
143. double Check360 ( double angle )
     
144. 
     & U% S3 e6 l4 c7 K3 s! [4 \
145. //#=============================================================
     % ?! m. u8 \+ T4 q5 ]
146. 
     9 ]% a+ B0 y3 n7 w" I
147. {
     5 A# Q( \  a0 d1 N! T
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     - v( i! U4 I9 o, G4 n# ~0 p
151.    while (angle >= 360.) { angle-=360. ; }
     * I$ j4 r" C$ O/ G# k8 E% v
152. 
     
153.    return (angle) ;
     , Q4 O1 b) q; o6 P* s; W, m
154. 
     
155. }
     
156. 
     
157. //#=============================================================
     $ Q5 U* R% T- y# X( P
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     9 ]. x3 X* |" i# R# L( z
160. 
     
161. //#=============================================================
     2 v5 v8 ]# `/ i: V8 t
162. 
     1 o% B( h: a4 i0 g$ J: f
163. {
     
164. 
     
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     
166. 
     . A$ s6 |/ Z: D
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     4 I) Y8 f7 C: ^2 Z- c* o
168. 
     
169.    return (angle) ;
     ! `6 O/ G+ ^  D
170. 
     : H' ~' k) a2 i( k# D
171. }

复制代码

5 U. a: h: ~) ~; e, u以下为摇篮5轴计算过程代码
" ~/ Y* q5 u3 p& o

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   8 a# [/ h  @$ I8 S" G
2. 
   
3.          j=0.; B1=0.; B0=0.;
   
4. 
   
5.           if (EQ_is_ge(i,0.)) {
   
6. 
   4 z2 R0 ]1 W0 j2 k& m
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   & s3 Q. |" Z# A" T/ u) X
8. 
   & T( L, I$ T0 Z
9.           }
   
10. 
    1 d7 a+ D" I# E/ U& E1 W$ Y/ N
11.           if (EQ_is_lt(i,0.)) {
    1 n* h3 R8 l) q1 {6 v8 g
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    
14. 
    
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    ( Y! E2 x4 d5 q! Y5 f: H& w
17.              } else {
    
18. 
    " s; o+ C4 z) @
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    . b3 w$ T; U6 [% }
20. 
    3 a2 F  W, a& B5 p0 P3 Z2 I4 d( _
21.               B1=2.*PI+B0 ;
    
22. 
    
23.              }
    ; u4 m  M; l2 T
24. 
    " _  n, R7 b4 o( b
25.           }
    
26. 
    ' q' b. D+ N4 U& d2 h2 ~2 j
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    4 h1 b- j9 H' }& [$ \
28. 
    
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    
30. 
    1 w7 U9 b9 s3 X3 M. Z
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程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
6 [. N  K' R0 e+ T. a

测试结果：
1 ~6 w, Q3 _$ S

$ Q; ~3 X: ^! T, G. X$ V反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享