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

若枫

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

1. int  EQ_is_equal (double s, double t);
   % ]1 a' |/ C: a3 d9 b- i& Y1 l
2. int  EQ_is_ge (double s, double t);
   - A+ F% E- j, [& j7 e% O9 R5 b
3. int  EQ_is_gt (double s, double t);
   0 B3 u" w- o8 Z, L0 U: W0 M' I
4. int  EQ_is_le (double s, double t);
   : T8 z- |4 _& L9 d8 A
5. int  EQ_is_lt (double s, double t);
   4 D: t% t9 }( F
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   
8. double ARCTAN1 (double y, double x );
   ) P) J+ m9 P5 g: g7 l0 h
9. //#=============================================================
   3 K7 }4 r4 b8 |& ~4 Z  }2 E" T6 R" ^
10. double ARCTAN2 (double y, double x );
    7 H2 i; C) J2 e" c
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    - U, u) b) H8 o* {: @9 v* s2 O& o
13. //#=============================================================
    
14. double Check360 ( double angle );
    # @: n5 n" `$ t" h
15. //#=============================================================
    ( k5 u" I8 i; V) U$ v) k$ m( D
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    
17. //#=============================================================

复制代码

5 P, |( x! a6 }9 r5 a6 u以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   5 M  ^# `# `6 c  u" t
2. 
   6 t5 X; Z+ N9 W8 X
3. {
   2 G* x1 y  N; j6 n; u/ ^
4. 
   
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   . M5 u' D$ w) c/ I9 T1 ]
6. 
   . T6 \% u* j  |) k# i
7. }
   ; ^5 k" I# @* w
8. 
   
9. /***********************************************************************/
   $ i: w5 F, z) [8 u- V  \
10. 
    
11. int  EQ_is_ge (double s, double t)
    4 }+ ], x" {* ]4 b1 K# O2 p5 ^7 {/ S
12. 
    
13. {
    / l" [( t6 g# A& x9 f& y  T& _- O) [
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    7 A; B9 C5 d# s; _$ t
17. }
    " _2 B) X' J2 W5 z: J; C- u) B8 O5 V2 `
18. 
    % N/ g' t( `# x4 D1 z6 |. i% U1 g
19. /***********************************************************************/
    9 e, n( _+ N) n6 q6 a
20. 
    
21. int  EQ_is_gt (double s, double t)
    ) ^) Y4 Z& @. f% i+ `8 I6 I5 U
22. 
    $ Z' R& {  V4 ?+ M4 R% s
23. {
    ) ]: t7 q& q9 U1 k7 H" `  I9 d
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    
27. }
    
28. 
    
29. /***********************************************************************/
      X/ P* D/ a3 k) q' Q
30. 
    - J% s( u: s$ t$ O9 ?* F! d$ q
31. int  EQ_is_le (double s, double t)
    2 z, I8 X8 d' w* |' F0 {7 M
32. 
    
33. {
    
34. 
      S3 M9 S: t- o8 v
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    / i% F& V/ w$ j$ E5 Z) X1 [, L
36. 
    
37. }
    & A5 s9 n' P. d, o/ A$ Y  d
38. 
    
39. /***********************************************************************/
    
40. 
    9 i6 S2 e% }! d* v) ^* `* z7 {% Z
41. int  EQ_is_lt (double s, double t)
    % i4 N, c7 v( S! q" z& P. }! Z
42. 
    
43. {
    0 e5 }0 ^; b5 w
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    2 u' I7 Z! R, W- k. {* L. m# k
46. 
    $ z9 X- V: {4 \  @0 D: R
47. }
    
48. 
    
49. /***********************************************************************/
    3 x& q9 E& c* V" `. N) q
50. 
      Y: V& D: O. u" s
51. int  EQ_is_zero (double s)
    
52. 
    ( F* \9 i" b6 C1 e& I7 T4 f
53. {
    2 }* w9 _. V- y
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    
57. }
    9 p7 {. j: Q- _3 W9 h  X* v
58. 
    ; B' u  R; H5 N- v
59. //=============================================================
    5 m0 ?, ~5 U! X- a; {  Z
60. 
    8 \) b' C( D  M, H
61. double ARCTAN1 (double y, double x )
    , ~2 z2 f" c, Z6 `/ f% Q3 g% x3 b  U
62. 
    
63. //#=============================================================
    
64. 
    
65. {
    
66. 
    ; s* t  a2 w. {* d
67.    double ang;
    
68. 
    8 W$ I+ r( e$ }( y
69.    if (EQ_is_zero(y)) { y=0; }
    4 B  c* o( R& d8 Z& M$ |
70. 
    6 z- ?2 U) _, z6 `
71.    if (EQ_is_zero(x)) { x=0; }
    # k- k9 u( {( z7 I
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    6 Q/ y' B# O+ ~( |+ R# n
74. 
    - k: R6 P) L8 O0 x$ p+ M4 j% T
75.    ang=atan2(y,x);
    8 p0 l5 l7 G- {% z) n
76. 
    ! M" F# y  D% w) L( a0 z% U' s8 q
77.    if (ang < 0 ) {
    7 E0 _* s7 w" [5 N- [4 X1 M5 }
78. 
    . w. C. N8 ]8 N/ i8 z
79.       return(ang + PI*2);
    
80. 
    
81.    }
    ; B8 K: c6 h9 ]+ k% g! t( t/ `) L
82. 
    
83.    return(ang);
    
84. 
    
85. }
    
86. 
    ; S5 H% u2 ~% ~  l2 m
87. //#=============================================================
    
88. 
    
89. double ARCTAN2 (double y, double x )
    
90. 
    
91. //#=============================================================
    0 u5 K) n( W% p5 r9 a$ [; W! c2 ]
92. 
    3 c( z& t$ q, ^
93. {
    
94. 
    ! j& j0 D' d. _$ S: [
95.    double ang;
    
96. 
    0 p- R9 O- x* R2 E% \/ B/ J4 Z
97.    if (EQ_is_zero(y)) {
    , O5 F. M. q1 \7 |9 q
98. 
    
99.       if (x < 0.0) { return (PI); }
    
100. 
     
101.       return (0.0);
     ; {5 I6 z" [1 X6 b
102. 
     
103.    }
     
104. 
     
105.    if (EQ_is_zero(x)) {
     
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     0 W( ?' S" v. W% v6 s6 E" O/ j
109.       return(PI*.5);
     
110. 
     
111.    }
     1 j* r' r+ G4 S* L# W7 ~0 R, T
112. 
     
113.    ang=atan(y/x);
     
114. 
     
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     
116. 
     
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     
118. 
     . F0 H: m4 O* |* w5 G- N' t8 _8 x' u
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     . @+ z7 G3 i7 J$ H5 B
121.    return(ang);
     * [) t1 G: _5 w4 g" h  `
122. 
     ! L# n$ g: @, z4 U* Z4 |
123. }
     * w, y( ~$ O2 B0 q/ a' Y7 t
124. 
     
125. //#=============================================================
     
126. 
     5 g7 `, |' Y% Z( C# x2 ]/ F2 \
127. double CheckConst ( double angle, double constvar  )
     
128. 
     * s2 q, A" x" L+ i9 ]6 f
129. //#=============================================================
     
130. 
     $ y" J$ X8 W1 ]; C# x* j! a5 u
131. {
     4 h" A4 E( G, G3 M/ v
132. 
     : z9 P- [- Z) h# o$ G4 E
133.    while (angle < -constvar) { angle+=constvar ; }
     
134. 
     1 M6 ?" r8 y- J5 Y8 z
135.    while (angle >= constvar) { angle-=constvar ; }
     2 {  M, a9 P+ d& L8 ^; q- s3 a6 M1 f
136. 
     4 k: t" g+ D6 ?) t: G* k( Q
137.    return (angle) ;
     
138. 
     
139. }
     , n6 ]8 G. H0 T7 c
140. 
     
141. //#=============================================================
     ' g, H# d: I, E! t
142. 
     1 e, x1 W; n$ R! O3 B. W! k+ ]
143. double Check360 ( double angle )
     
144. 
     
145. //#=============================================================
     
146. 
     * g4 ?" Z0 N6 ^# R- Q
147. {
     
148. 
     , C8 ]1 I& L1 N9 T* M$ K, {" |7 v2 R
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     
153.    return (angle) ;
     6 o5 t4 [. ]" q6 H# \
154. 
     , T5 N9 i6 M4 W" `. h: {$ [
155. }
     
156. 
     . B* D0 b0 U' I6 H
157. //#=============================================================
     
158. 
     5 z% W3 e3 p. Q; _% |. ^
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     3 r+ ?2 V  B: u- P: b. F5 J
161. //#=============================================================
     2 ?4 n  G# A+ t' T4 ]( i
162. 
     
163. {
     
164. 
     
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     
169.    return (angle) ;
     - c! v; D6 ]1 ^' D4 c& ?
170. 
     ! j+ e% V4 ^# p8 U2 S$ _# e
171. }

复制代码

以下为摇篮5轴计算过程代码
. ~# q$ [. T. w; P) W

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   
2. 
   
3.          j=0.; B1=0.; B0=0.;
   * L8 K  Y$ _5 @0 j' K) c2 e* E* w
4. 
   
5.           if (EQ_is_ge(i,0.)) {
   
6. 
   0 t3 h3 X  x+ k. E! Z
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   - e0 k4 {) p! G
8. 
   9 M2 R- q& e- M! t$ l
9.           }
   7 w0 g# P- O& E; a
10. 
    
11.           if (EQ_is_lt(i,0.)) {
    * N; E: t8 P  q8 b( ?
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    " c! ]" D4 G6 A$ d/ `
14. 
    ( F+ G0 x! s) C: j
15.                 B0=atan(i/k); B1=B0+PI ;
    * y( M0 }$ F$ ]
16. 
    5 x& D- d! W- [8 J
17.              } else {
    
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    
21.               B1=2.*PI+B0 ;
    , Q# t( y6 p% F8 G
22. 
    # `+ z4 r# @/ x$ \; q0 z
23.              }
    ( c6 _  T+ h: k/ S
24. 
    
25.           }
    
26. 
      C0 Z( [! i! _' N5 B* X; P- F
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    
28. 
    ( ]2 s9 b, n$ x0 R
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    ' J  b+ V& `2 B6 H, `
30. 
    / i6 B$ Z/ i0 n8 m. u# C! V
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    * _' b# ^2 L/ q7 z. p% |8 z
32. 
    $ Z6 J# T. c4 {, Q; r
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

7 l5 g0 D  O  ]) f0 j( ]$ K8 I通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。

1 Z3 a4 D/ d+ d! J
测试结果：

: q8 E4 {/ e3 V7 F" f" W
  M2 C  b' h5 J" L反向测试结果
5 Z8 y4 H7 G/ d1 k3 q6 \

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享