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

若枫

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

1. int  EQ_is_equal (double s, double t);
   0 K% L  c: n3 f$ e2 x3 X/ a
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);
   - @* }2 z! z! w. r$ o
5. int  EQ_is_lt (double s, double t);
   $ b; q1 P) M& E( ~2 q8 Z. `
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
      \/ J. t5 i, l. J, `
11. //#=============================================================
    1 c- D0 H+ q! b& n
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    4 ]$ j0 V/ r8 y7 r' E" c/ }
14. double Check360 ( double angle );
    
15. //#=============================================================
    
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    ) {( [7 O) M* j8 U1 s
17. //#=============================================================

复制代码

以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   
2. 
   
3. {
   
4. 
   
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   - X( \4 Q( t! |/ G3 |: l
6. 
   8 f) I$ ?% Z! `. N% Q5 A' R0 v% B  n
7. }
   : Q- o/ @4 z: p8 X' r" X
8. 
   
9. /***********************************************************************/
   6 ?0 H9 i" `4 }' {! Y$ v
10. 
    
11. int  EQ_is_ge (double s, double t)
    
12. 
    ) N6 ?, r! y1 n% H9 i/ {! D2 r
13. {
    
14. 
    3 K, y9 O' T. x. j
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    # [/ Z# B/ M5 S! j; B3 d
16. 
    + X# R2 h) U; S- J& A
17. }
    
18. 
    ; Q  r9 J" z# x1 N6 b
19. /***********************************************************************/
    3 _, V( g: @% E! K1 f( k' x' ~
20. 
    + I7 }! l+ [" d( `/ {1 `
21. int  EQ_is_gt (double s, double t)
    + R; T2 y  n5 o9 \. j+ }
22. 
    # a: e6 R1 [& \  _1 V& p
23. {
    & M& S4 r0 W$ L# }0 @
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    2 u' F4 T- u6 H5 b& K- @
27. }
    
28. 
    
29. /***********************************************************************/
    2 c8 f& Z# R8 M! k9 I
30. 
    
31. int  EQ_is_le (double s, double t)
    7 U) u  b2 \  Q
32. 
    . A  {9 C$ {& u! v
33. {
    
34. 
    0 m- ]4 R$ P. L3 R! N0 ]
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    # i* ?1 p6 _6 W8 u2 Y8 }
37. }
    , N& J% ^: ?) T) x' I: B) ]
38. 
    ) ^) t/ z6 U+ e9 P* e1 W! U
39. /***********************************************************************/
    3 M! O2 w# g; P4 ^' \9 r# a
40. 
    
41. int  EQ_is_lt (double s, double t)
    . ]$ z) |. c8 J* \
42. 
    
43. {
    - p% e% U1 b* W4 {
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    % b& D2 o) ?) N: A. @8 |( O
46. 
    2 y% V) k  Z) ?$ j
47. }
    & t9 p9 n: M  R7 q7 f/ `: l
48. 
    0 a) F" H1 I2 J/ x8 Z( W
49. /***********************************************************************/
    
50. 
    / u: V+ v5 K' P% z, W: a+ t6 Q
51. int  EQ_is_zero (double s)
    # m, J1 M" g. l1 y& `  ]8 B# B
52. 
    7 m$ y+ R' I5 Q2 f4 x5 H/ O
53. {
    1 t0 k5 Y- j6 m" P  ]3 R
54. 
    , F- Q; ~# U/ Q
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    
57. }
    7 X: w' ~; _! ^3 ~  ~6 X
58. 
    ! y" ]5 w, O. E0 H
59. //=============================================================
    
60. 
    # h: F; w% T# L! e' s
61. double ARCTAN1 (double y, double x )
    
62. 
    0 ?9 b9 X5 K; Z0 ~/ c) F) _9 \
63. //#=============================================================
    
64. 
    
65. {
    
66. 
    ) D  T0 I7 {3 N& `7 ?
67.    double ang;
    
68. 
    4 l4 C, p$ T9 ]0 ^8 W; V; |' o
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
    3 b# h) z- a# g  q4 M1 d
71.    if (EQ_is_zero(x)) { x=0; }
    
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    $ M+ p1 K5 M; n7 h& k0 B
74. 
    % s: q8 {/ G3 a4 M$ g4 O( K
75.    ang=atan2(y,x);
    
76. 
    7 s( v' \% ?6 _) `0 M, Q0 L3 N. y; ^
77.    if (ang < 0 ) {
    6 K) F. `: S8 a$ p  `0 f. p; A
78. 
    
79.       return(ang + PI*2);
    
80. 
    & ^  i- ~& V- D/ K4 \7 T
81.    }
    
82. 
    9 H& B# D6 T+ ?  B, e5 b" F
83.    return(ang);
    
84. 
    ( K; z6 h) i( l2 J
85. }
    8 V( Q0 b7 f7 p0 Y1 E
86. 
    
87. //#=============================================================
    
88. 
      @$ Z) l, `7 `# y3 a5 \. d
89. double ARCTAN2 (double y, double x )
    
90. 
    
91. //#=============================================================
    . x5 }# X6 y" L: O, X& C$ ?3 p9 S; E
92. 
    ' E4 k5 O" x6 d( h& Q4 Z
93. {
    
94. 
    0 \8 O$ a0 w5 v# R) B
95.    double ang;
    
96. 
    4 N9 f) G0 J: s0 l! M- \: Q3 A
97.    if (EQ_is_zero(y)) {
    , z; G' ?0 m2 b# m7 ^1 J* u
98. 
    
99.       if (x < 0.0) { return (PI); }
    
100. 
     ( T5 ^* w0 N! o& g
101.       return (0.0);
       y/ `+ k% y. b
102. 
     5 u2 R1 x2 J- x6 D: c7 ?0 B, _
103.    }
     0 B9 w( R' a4 U2 P' V" @- `# ]
104. 
     
105.    if (EQ_is_zero(x)) {
     
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     # `' H  c( [" k8 H4 `
108. 
     
109.       return(PI*.5);
     3 a, h7 {  k$ z0 H1 v
110. 
     9 U+ ?( M& z) W- h& p8 V& D
111.    }
     / @/ Y1 G5 n" C4 q" n+ r0 x+ @- J6 O
112. 
     ) r# F. g. o2 V8 A- f
113.    ang=atan(y/x);
     1 U9 U1 q& M6 s: ]6 a( \  D7 {  ^2 I0 }
114. 
     * }# X& s  R+ y: t2 e
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     , ]+ Q) S  z9 ?) l) j
116. 
     ! P4 T% \$ h$ _9 u" d4 p
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     
118. 
     # ^. q" v9 x" ]+ o
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     ' b1 q8 ]" C1 K( y) o# x; T$ D
120. 
     9 i  B% S( n5 K
121.    return(ang);
     
122. 
     & j( _6 W* y7 I& ?
123. }
     ' w* T" |0 g& ^
124. 
     
125. //#=============================================================
     7 C2 c4 H: A+ D. P$ ]7 I
126. 
     3 S! k3 ?1 k  _$ J; ]
127. double CheckConst ( double angle, double constvar  )
     
128. 
       B6 k& Y5 `& y! z( K( K
129. //#=============================================================
     
130. 
     / H6 |7 l% P& i5 i- B
131. {
     
132. 
     / d% `7 Z5 P1 ]' i: D' Y+ k7 c
133.    while (angle < -constvar) { angle+=constvar ; }
     
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     
138. 
     6 d8 C/ E2 _2 r) `% [$ H3 A
139. }
     
140. 
     
141. //#=============================================================
     ! |9 T1 z- B# z. n+ P4 x1 {, s1 T
142. 
     
143. double Check360 ( double angle )
     4 i: Z2 I( S# k. Q, G) e
144. 
     
145. //#=============================================================
     ) l, M+ ?; G, `9 z, |/ B+ [
146. 
     
147. {
     . C8 ~4 w; J) E/ K& K9 v& r
148. 
     ' ^$ P! |$ U. l  e& h2 w) U
149.    while (angle < -360.) { angle+=360. ; }
     / W- A" I$ O. D6 {* @
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     : G  U  ?, G5 r) S% d
153.    return (angle) ;
     
154. 
     1 l) J3 S& a- L) }6 A7 N
155. }
     
156. 
     
157. //#=============================================================
     
158. 
     & P$ {- D# H: J1 s4 B2 V4 T
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     
161. //#=============================================================
     
162. 
     & a6 P6 s8 ~2 x' \5 Q7 A; v; E
163. {
     
164. 
     
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     5 `- V- J! Y4 d9 q) B/ a3 _  D
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     * G1 U" g/ R+ p0 r& C. X( B" f# k' c
168. 
     8 G9 d& S, A: J) _
169.    return (angle) ;
     6 Z' d4 w3 D2 m7 m
170. 
     ; U* t) v6 p, p9 h. f9 h
171. }

复制代码

4 l6 U& B2 v# e以下为摇篮5轴计算过程代码
/ @: \4 q9 o0 F0 J

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   
2. 
   
3.          j=0.; B1=0.; B0=0.;
   
4. 
   
5.           if (EQ_is_ge(i,0.)) {
   
6. 
   : b$ _! B. w5 P/ H$ w
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   5 i# x- ]1 O6 l" k, |3 s, q3 c
8. 
   & n5 v2 o' r* P
9.           }
   ' V) K0 G. `2 t
10. 
    % x' H' R- r2 |3 d0 G3 t; o5 d
11.           if (EQ_is_lt(i,0.)) {
      l5 r4 V  D3 e& T9 r" s9 [
12. 
    ) t6 n2 Z' h# g; U0 T
13.              if (EQ_is_lt(k,0.)) {
    6 _1 r* Z! N( A5 w
14. 
    9 t; O. x8 V+ Q/ ]( ^/ _' D6 E
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    : V. K' C& l; [" q; x
17.              } else {
    1 O7 J( G& {" V
18. 
    ( o: i# b. r- m  W  T; p- V+ t
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    8 U7 w+ h$ Y  _0 J7 ]6 _( r
21.               B1=2.*PI+B0 ;
    # [4 |7 S. s& u8 N
22. 
    / p9 P4 G+ }& H0 ]
23.              }
    
24. 
    
25.           }
    : S" y9 g* C# ?% p
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    
28. 
    ; R: R8 @6 G3 g4 }2 {
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    
30. 
    
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    ' g. _3 O9 A- n9 u
32. 
    6 S8 I; |7 g* C/ J7 i& ?% i' N% a/ `
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

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

  O) A/ t! v5 @
测试结果：
/ E1 j) k/ i( p8 z) i

反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享