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

若枫

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

1. int  EQ_is_equal (double s, double t);
   
2. int  EQ_is_ge (double s, double t);
   5 \3 b- O- {2 D% r( `( ]5 e
3. int  EQ_is_gt (double s, double t);
   # G2 X$ h* h! _
4. int  EQ_is_le (double s, double t);
   ! I) C  J2 g* Q3 G( G
5. int  EQ_is_lt (double s, double t);
   & |% m* o8 g) W/ [* ]# l$ ?
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    & d. W; o  ?3 q, ^" l& Q
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    8 r$ \$ W4 Z) V5 s9 Q5 V
13. //#=============================================================
    0 |3 {) N2 d/ ~/ t0 q' X1 h" S
14. double Check360 ( double angle );
    ) P( I8 F: e6 F6 b4 g: `, n0 T1 a
15. //#=============================================================
    5 F1 F- t  w  ^2 p5 y# i( E
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    # p2 D0 Q7 C) L  R
17. //#=============================================================

复制代码

以下为部分源代码，用于判断，计算角度等
# m( }+ e% E  ?0 R# E+ X* A2 P# K9 B

1. int  EQ_is_equal (double s, double t)
   
2. 
   7 M2 }2 ^* w" ^# g6 r" _' s. C
3. {
   - l& h: L8 Y" y4 ?4 r
4. 
   
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   & i! j$ e7 R6 f* Y5 i
6. 
   
7. }
   
8. 
   % h: T0 Q7 T' L* p8 ^4 x3 |
9. /***********************************************************************/
   
10. 
    
11. int  EQ_is_ge (double s, double t)
    + P% U9 \) n( @1 h  l* r+ H7 e% `
12. 
    0 H6 A* x3 _# |; I: O9 l
13. {
    
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    
17. }
    
18. 
    
19. /***********************************************************************/
    8 S9 Q- p3 Q; A
20. 
    % g  w% z' X6 r3 V0 `& G- _
21. int  EQ_is_gt (double s, double t)
    5 D4 z. H2 S9 W- Q- Q
22. 
    
23. {
    
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    
27. }
    
28. 
    
29. /***********************************************************************/
    ; X% f, R6 F6 a- F% }( l
30. 
    ! b! Y. c$ L5 n6 I0 W5 j1 a
31. int  EQ_is_le (double s, double t)
    * c% `) y/ o4 a4 b1 p6 f! N
32. 
    ( y# R! L# g. Q# x; ^
33. {
    
34. 
    ! @0 z: \; f" u9 R3 ~
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    
37. }
    
38. 
      U2 ^) l+ e5 c5 G6 C: d
39. /***********************************************************************/
    
40. 
    % W) x# V! O! G" Z7 e9 r+ G5 E
41. int  EQ_is_lt (double s, double t)
    
42. 
    4 q; Z9 H, P6 w2 H7 x' ^; a. o
43. {
    
44. 
    % e( i/ c& U- E5 f
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
    
47. }
    & i! T: S' n0 J: o
48. 
    + b1 K3 ~" s7 M" f. v* f6 N
49. /***********************************************************************/
    
50. 
    
51. int  EQ_is_zero (double s)
    " ]& W, U* P9 E
52. 
    
53. {
    
54. 
    ! L3 m7 P/ j& ]3 q9 p6 y" {
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    ! N4 P- t/ T) U- @
56. 
      u; L  U4 K; T2 I6 w; v# W
57. }
    # J4 h; W: ~) d# i  b- q: p
58. 
    
59. //=============================================================
    
60. 
    2 ?$ ^) R& d/ }8 ~. ^, K+ b
61. double ARCTAN1 (double y, double x )
    # C& f9 k2 J, i1 R  L  {% M) g
62. 
    & Y5 ^5 t' X7 X: u
63. //#=============================================================
    
64. 
    6 T5 T7 u7 }0 u( Z
65. {
    
66. 
    
67.    double ang;
    , W1 J4 w- b  t% d* v2 ?* Z2 {  V. L
68. 
    9 c% M5 @  [& d/ n& X( Z. H$ P" s
69.    if (EQ_is_zero(y)) { y=0; }
    % o4 f. d2 h$ u
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 ) {
    / A9 l- r6 U& {7 i& M
78. 
    
79.       return(ang + PI*2);
    : r8 \! z/ Y$ _) B6 U
80. 
    2 q& C6 z, q+ O4 b
81.    }
    
82. 
    
83.    return(ang);
    
84. 
    ' m- z$ a$ Y: a' O# V4 U' x! O* M
85. }
    
86. 
    4 M8 p' E% B0 ~( W' A
87. //#=============================================================
    & f& D: b0 n, H( \
88. 
    
89. double ARCTAN2 (double y, double x )
    3 _3 x1 d; ^4 {
90. 
    
91. //#=============================================================
    
92. 
    
93. {
    # Y( `" i& T$ S& f. [; x1 @/ u3 U0 N* u
94. 
    1 P8 K/ \% D4 L: R* }3 m
95.    double ang;
    / Z9 S! E) ]) o- ?8 b: ]
96. 
    
97.    if (EQ_is_zero(y)) {
      p8 L( }6 _. S* q8 _# N% a- G/ `# w3 U
98. 
    : G$ Q5 b, ^% T. |- D
99.       if (x < 0.0) { return (PI); }
    
100. 
     5 s2 ?5 O! k4 G" |
101.       return (0.0);
     6 l, x) R  N$ R; f' K" `
102. 
     4 T. X- [* X! ~. g& o
103.    }
     2 T8 x5 M( _% {- q- P% k
104. 
     : N" V3 A: s: c3 J" R
105.    if (EQ_is_zero(x)) {
     
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     8 `6 B( X: v4 e' O  A
108. 
     
109.       return(PI*.5);
     
110. 
     0 c, k8 o) o& j# g
111.    }
     
112. 
     
113.    ang=atan(y/x);
     * T& r. t2 L. w* c  D( g0 B
114. 
     
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     
116. 
     ( _+ N; |( h' D
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     , P- C. V, e' D1 E1 N
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     $ k$ n/ _2 J7 A# n
120. 
     
121.    return(ang);
     
122. 
     
123. }
     # y( Z4 g. ^: {- A1 @
124. 
     : {: }. v  M; I( ]- ~
125. //#=============================================================
     
126. 
     
127. double CheckConst ( double angle, double constvar  )
     % ?+ `: E$ S7 x' D7 m
128. 
     4 [8 `) T6 C* a( g1 ?% \$ M) c/ s, T
129. //#=============================================================
     . _% [8 s5 q; c6 J3 }9 T) |
130. 
     
131. {
     
132. 
     
133.    while (angle < -constvar) { angle+=constvar ; }
     
134. 
     0 s1 L8 q" K  ^* l4 L1 K
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     8 j; i8 M) b  M0 I3 w: m
138. 
     
139. }
     
140. 
     
141. //#=============================================================
     * ^+ m7 E; }8 T) D
142. 
     7 e8 o' G( j5 `8 T. L
143. double Check360 ( double angle )
     ; L8 g  ]$ A8 ?! }
144. 
     
145. //#=============================================================
     ) A, T7 n8 d) E
146. 
     
147. {
     4 e, h8 a* N  m) P2 U
148. 
     5 x. \2 I; M9 T) Y& |& K
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     ! H0 I. |  l6 {- z5 Q# g" U$ _3 F
153.    return (angle) ;
     
154. 
     ) t* g* z7 r1 f( a1 ~
155. }
     
156. 
     6 w* p, A8 q* M
157. //#=============================================================
     ; @+ ]& j- L: g: T
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     0 E! _% ^8 K, d( t. f
160. 
     
161. //#=============================================================
     4 |: N4 f  E8 g  V
162. 
     - D$ s5 X1 M. m- B3 x+ ?
163. {
     
164. 
     9 k" n( L. N* c- [+ }0 h$ a9 @5 q
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     . G4 d0 c0 o5 n" H6 I- }: \( o; U
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
       \& h. ~+ ~7 N; Z
168. 
     
169.    return (angle) ;
     8 u; P4 b- R" d3 z
170. 
     5 K  e! M7 t! E; Z1 u. z
171. }

复制代码

以下为摇篮5轴计算过程代码
& G. s7 ]5 ^5 ?- v) ~# e0 j; [6 Y, L

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   5 V9 ]0 R0 h* {" W; g' O
2. 
   
3.          j=0.; B1=0.; B0=0.;
   9 n5 ^8 {6 ?1 }' {# e
4. 
   , ?/ Y5 X  a# _
5.           if (EQ_is_ge(i,0.)) {
   
6. 
   4 Y1 D9 C/ z3 b1 N; h4 J  I! n
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   : X, P; g1 K' G# k4 P
8. 
   
9.           }
   # R0 E5 }( @% s
10. 
    / Q6 v" H# J. U/ O0 j4 y3 Y
11.           if (EQ_is_lt(i,0.)) {
    
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    ! a" D/ i) N, O( v  r9 A6 T6 p
14. 
    
15.                 B0=atan(i/k); B1=B0+PI ;
    6 l/ C1 w" J6 N% O5 I, V7 o! W3 t
16. 
    
17.              } else {
    4 {; q0 m7 W& W6 L9 x/ [
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    0 }9 ?* M, H( m) Q2 p1 h6 @
21.               B1=2.*PI+B0 ;
    : P0 I3 q) {3 Z; x8 m* B6 }& y1 l
22. 
    ! I0 C/ m$ M$ x9 Y
23.              }
    9 P. m& j2 P+ w& c
24. 
    $ m/ \, Y) p3 T
25.           }
    
26. 
    ( E6 s9 d9 y4 l+ a
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    ; h' t0 V3 j" E5 \0 Q9 ?
28. 
    1 |( Y4 q4 |' U7 n, W% f
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    
30. 
    2 q0 X" d, F+ G; O9 Z. |+ l" m' I
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    
32. 
    6 `. G* f* {1 A. o: E2 N' m
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
9 M3 H3 _9 A1 O8 I

测试结果：
) h1 O6 v' T) D
; {2 B! D3 T' ?0 a& v# j+ m) U2 ]0 {7 [
3 j$ o( [& E2 B* D$ M反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享