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

若枫

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

1. int  EQ_is_equal (double s, double t);
   " ~1 L  n; I6 c( o4 H0 {
2. int  EQ_is_ge (double s, double t);
   , A. O0 F8 p1 z/ Y9 \0 M
3. int  EQ_is_gt (double s, double t);
   
4. int  EQ_is_le (double s, double t);
   5 r% e) Y+ R4 b
5. int  EQ_is_lt (double s, double t);
   ! A" Z' a! \# B
6. int  EQ_is_zero (double s);
   5 B) ^2 }, d1 A% {7 Z
7. //=============================================================
   $ ~1 Z. F- r- l$ E5 d
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   9 W# ~' Y5 D+ y$ ~
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    6 v4 }2 i! y8 A( H0 L8 I6 U* e
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    
14. double Check360 ( double angle );
    
15. //#=============================================================
    
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    9 b9 E! L6 S) L, t3 e) H. s( e
17. //#=============================================================

复制代码

以下为部分源代码，用于判断，计算角度等
- C' {+ @* ~( @% z; O3 F0 o" B

1. int  EQ_is_equal (double s, double t)
   
2. 
   / |; Z2 R+ h$ ?( B! a6 O
3. {
   
4. 
   
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   
6. 
   3 c- c- z* M- {8 N2 i% m
7. }
   
8. 
   + u* y' N: _% k
9. /***********************************************************************/
   8 ~) F$ \# Y# F4 \7 w, }4 }% @
10. 
    
11. int  EQ_is_ge (double s, double t)
    
12. 
    
13. {
    1 R% {' f1 l1 Y2 G
14. 
    5 e5 q( p0 |& o; \& l. R' [
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    - [4 |  r. q/ U9 E7 B
17. }
    
18. 
    $ |8 }, p; u3 A5 U5 z+ t$ `. a
19. /***********************************************************************/
    ' A6 j( c/ \$ U' I$ i
20. 
    9 N, u4 b' Q+ ~2 N/ l8 S! x
21. int  EQ_is_gt (double s, double t)
    5 V$ H3 A8 h+ R& Q9 s5 u' _5 S" }
22. 
    ; m& R. E/ i2 F8 F/ _
23. {
    
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    
27. }
    
28. 
    
29. /***********************************************************************/
    ( g9 [4 H# h) P- A2 o- d1 m; ~
30. 
    : @; {0 F, f7 P9 a
31. int  EQ_is_le (double s, double t)
    - Z  X9 g( E2 \. [2 T- k, A" L
32. 
    
33. {
    
34. 
    6 A' e* V. ?# ^) a. V& h" G
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    " }& H1 c" Y: u* j$ g* }- ~
36. 
    
37. }
    " S# ?4 v) o1 r7 f% A  v7 d
38. 
    
39. /***********************************************************************/
    
40. 
    
41. int  EQ_is_lt (double s, double t)
    : a! h9 f7 S; g- b/ x
42. 
    
43. {
    ! A8 A% [; g$ g7 t
44. 
    0 A( I- C2 V+ c) v& S4 K5 O+ `: n" g
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    1 l! H& b# |3 i( U- s$ r8 ]) v7 T: Z
46. 
    ' _5 V2 `5 _9 W% g, X" C9 F& ]# P  E
47. }
    . C6 [% e/ e# o; ^' J% b
48. 
    
49. /***********************************************************************/
    : q; j2 y7 ~, S$ }; ]
50. 
    
51. int  EQ_is_zero (double s)
    
52. 
    
53. {
    7 \) P# @- l: N9 Q
54. 
    4 ?- U7 g% }. m0 r& W9 O
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    6 Q6 a0 n# R* |* [% ]' f
56. 
    
57. }
    
58. 
    1 x" p/ x& s, H/ m
59. //=============================================================
    ! \( l4 F0 O0 I4 ~( e  _$ O
60. 
    5 B/ x, b6 {; T* M/ p/ R
61. double ARCTAN1 (double y, double x )
    3 s1 [2 [* v. r  \% Z+ d* K8 o
62. 
    
63. //#=============================================================
    , n2 g$ l; ^( `: q; P
64. 
      I! _7 [8 E" P9 m* O
65. {
    & b: u& X# M! T. q  g) {
66. 
    7 w$ F  |7 Y5 ^# ?* ]0 T! V9 G
67.    double ang;
    5 O' S7 {6 ~0 D3 n' B
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    9 b7 o' r7 c$ C" Y: |3 z
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    / U# ~! G9 T' }7 }; c; R
72. 
    % z' S- @3 c( j  q( ~
73.    if (y == 0 && x == 0) { return(0); }
    . [1 H: X+ Q; O0 b. W* `
74. 
    - w! e2 D4 `& [
75.    ang=atan2(y,x);
    . ]% ?: t+ c6 C1 W
76. 
    3 [1 d' ~0 d+ }7 m6 @+ M! i2 z
77.    if (ang < 0 ) {
    6 V/ F* M4 z! b3 z& q; G# W
78. 
    
79.       return(ang + PI*2);
    0 d. a0 W+ ~3 F  Z7 F
80. 
    : G3 c7 |7 v/ v: T. e- J" f$ }
81.    }
    " x3 T' S& Q, u3 f& R& x
82. 
      m: ?. O, D) m; A0 @: w$ s: P3 Q
83.    return(ang);
    2 }2 e/ G' t! o
84. 
    
85. }
    7 {9 ]0 {3 G; d' H4 x
86. 
    , L0 X2 A2 f' R$ o8 ^4 c( P
87. //#=============================================================
    
88. 
    
89. double ARCTAN2 (double y, double x )
    
90. 
    
91. //#=============================================================
    
92. 
    ! v. @5 m2 Q* k
93. {
    
94. 
    
95.    double ang;
    , k2 h5 T5 V7 C  R. {
96. 
    
97.    if (EQ_is_zero(y)) {
    8 {$ j- U' M! p! @7 f- _
98. 
    " H. ?" ?8 ~. s8 H/ ?
99.       if (x < 0.0) { return (PI); }
    & @! @9 z% D0 X. D% C$ W, C( Q
100. 
     
101.       return (0.0);
     
102. 
     5 a8 z/ t4 e; ]$ U
103.    }
     9 v1 {) o8 p  T* R  o: b! ?
104. 
     
105.    if (EQ_is_zero(x)) {
     
106. 
     ' g. k- i* U8 O+ ?/ ?
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     & S( c6 L% L) }+ y; W8 P
109.       return(PI*.5);
     % D5 l9 M  z! D, ~
110. 
     3 A5 T- N" }9 T& K* Q. r. J2 n
111.    }
     % d6 R, ?9 i; z/ I. F" o
112. 
     8 k' s3 w+ q0 c/ @2 o, ]
113.    ang=atan(y/x);
     
114. 
     
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     3 w  R6 c  d0 U, e, E
116. 
     
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     
118. 
     1 u5 B+ T- C/ x5 m8 s8 D, X* s# }, l
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     
121.    return(ang);
     1 p" t, `0 X, i# t& D. q
122. 
     - ~" ]+ j" j1 H1 M
123. }
     
124. 
     
125. //#=============================================================
     
126. 
     * G; D# U7 A* d' Q
127. double CheckConst ( double angle, double constvar  )
     
128. 
     % w9 l) U8 v# |8 s9 S% G
129. //#=============================================================
     
130. 
     
131. {
     
132. 
     
133.    while (angle < -constvar) { angle+=constvar ; }
     
134. 
     ; H% f4 ?6 u0 o& [7 z$ ~4 m" d( d
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     1 t' w9 V8 G  V% K6 M- K
138. 
     
139. }
     
140. 
     
141. //#=============================================================
     
142. 
     : }  Z8 {2 M, _; k; @! Q9 N5 k1 Q
143. double Check360 ( double angle )
     
144. 
     & O7 f8 Y+ E- C  K8 `
145. //#=============================================================
     
146. 
     
147. {
     
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     $ p8 o9 ~. Q" J* q2 k
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     
153.    return (angle) ;
     
154. 
     
155. }
     
156. 
     ' f2 c( c& Q. o/ r
157. //#=============================================================
     
158. 
     ! j! p  N" T* N) `( |' q
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     
161. //#=============================================================
     
162. 
     
163. {
     : _0 ^/ _3 _) m! n& \& e8 u
164. 
     ( f( ~* p& k/ ]. J9 }4 [1 W' T! a
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     " q& Q' j( k' V7 R
166. 
     # N! G& n/ j1 |/ V4 I0 }9 U: o0 m
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     * W1 B. a9 A9 z' C( Z) b% z$ o& L
169.    return (angle) ;
     % F8 ]& g" [, q& D# a; |
170. 
     
171. }

复制代码

2 k0 {, D& R8 d, [: T% j( V/ G以下为摇篮5轴计算过程代码
" s  R& K; W, C* y! a8 y6 v

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   
2. 
   # M8 l* e; ^. i: s+ b# C, d
3.          j=0.; B1=0.; B0=0.;
   " [1 K* c) i: e5 R1 j  H3 X% J
4. 
   7 e  v& L' \4 `3 P) P  J
5.           if (EQ_is_ge(i,0.)) {
   4 j7 B; x+ k. I* h2 m+ Q
6. 
   8 d/ v* [  w' z) i% O8 @% @: o' _% T
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   9 E9 t$ O6 ?& U9 H
8. 
   
9.           }
   
10. 
    + r) `+ ^# a5 N& Z# H) k  y
11.           if (EQ_is_lt(i,0.)) {
    
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    
14. 
    
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    ! l3 H5 o$ U: L% O
17.              } else {
    
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    
21.               B1=2.*PI+B0 ;
    % v  Q* ~0 `; W6 B* ^7 E# h
22. 
    ' r5 _, u: Z1 F. B1 y2 N
23.              }
    1 e; e2 s/ V: _8 e
24. 
    0 H; t# H1 T' C# y. M+ J3 X
25.           }
    
26. 
    % s- H7 b" z6 |! h* ^
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    
28. 
    5 t2 e8 i( g# P7 i% V  f
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    & R8 i, j* Y. v$ C2 a$ f- n
30. 
    * V) r+ k3 g' n  \! I7 F2 h
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    1 P. b/ t0 B' L/ g7 s% _' A9 B* Z
32. 
    
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

# U; K' m% A. n2 g7 p( ]通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
# |& F* F  h* Y- C' T, o, h" W

& S. t5 `1 R0 h" b( y测试结果：
4 p) Z5 j) d1 X% w/ p( i3 y8 T
& r6 G* q! m2 x- s6 j3 ~8 V/ L
反向测试结果
. n6 D4 U0 X, T( E! Q" I

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享