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

若枫

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

1. int  EQ_is_equal (double s, double t);
   # G( U2 a1 P& c/ ?
2. int  EQ_is_ge (double s, double t);
   , {. N3 e  p! B- {  s! |
3. int  EQ_is_gt (double s, double t);
   ! D% O6 l* W5 [+ u4 V& E
4. int  EQ_is_le (double s, double t);
   
5. int  EQ_is_lt (double s, double t);
   9 G! y7 o) O- }* b6 J0 b
6. int  EQ_is_zero (double s);
   4 u+ U/ t1 T# Q1 o# u* B/ k1 ~/ f2 X! k
7. //=============================================================
   - T7 {% w& l9 U, S
8. double ARCTAN1 (double y, double x );
   * y, O+ {" _9 c
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    / R" D8 l# Q( i0 m- y% f& G
13. //#=============================================================
    
14. double Check360 ( double angle );
    $ P) ~- I# j$ z" \* \* }5 Y: {$ I
15. //#=============================================================
    
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    
17. //#=============================================================

复制代码

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

1. int  EQ_is_equal (double s, double t)
   
2. 
   
3. {
   9 Q" m+ j. K* \, x" v' x
4. 
   
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   
6. 
   
7. }
   $ K5 v  W2 T" b, I9 a  ~
8. 
   
9. /***********************************************************************/
   & Z9 ~4 W8 D0 E, \
10. 
    : i/ n3 X) o8 q, Q/ r5 i
11. int  EQ_is_ge (double s, double t)
    
12. 
    
13. {
    1 y0 E& f, Y. O5 j) X0 y! b
14. 
    7 `2 k- f+ N0 A& `% d- I
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    
17. }
    - z7 b7 `9 b( ?4 B0 P
18. 
    ( U/ Z7 t1 a/ c9 @  ~- ]
19. /***********************************************************************/
    # w( i6 n4 p. }
20. 
    : S7 i1 E: K! q) Y% ~1 a/ Y
21. int  EQ_is_gt (double s, double t)
    
22. 
    
23. {
    
24. 
    ' u4 K1 L1 U. q1 I$ z& C
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    
27. }
    , P: ~  Y" |4 d$ Q$ [( w% E
28. 
    
29. /***********************************************************************/
    
30. 
    , [" C6 a( g: r, I. j- m* c* d
31. int  EQ_is_le (double s, double t)
    
32. 
    # T. K' J+ j: w6 ^  J
33. {
    $ U9 \, h! i9 Q: m0 X. k: V& A
34. 
    ; k" \/ ]2 x* ?( s2 q
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    ) v, d& S& p. i7 B2 K. p$ h
36. 
    
37. }
    
38. 
    2 j/ L# n1 I' w& ?; ^" v. E
39. /***********************************************************************/
    8 c$ A! N+ j* \/ y$ |+ I/ O" J
40. 
    
41. int  EQ_is_lt (double s, double t)
    
42. 
    & J* j  t0 }: }+ p* y* v: k- L, n& M
43. {
    
44. 
    - D, W& E- j7 t% P( Y2 \
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    2 h) j  |0 M3 m$ L8 L' ?8 I
46. 
    # v& ^7 m7 m0 n
47. }
    0 ^% z5 e& K2 T8 x0 H% R0 z/ l
48. 
    1 ^# c3 L  V0 v
49. /***********************************************************************/
    ' k0 r' r( S# N# h; L* V+ k& G
50. 
    
51. int  EQ_is_zero (double s)
    ' k( I9 w7 j* u; I: b3 A* n6 o) k% U
52. 
    2 ]* M& k, I. L  s7 k2 I
53. {
    / Z$ I0 x7 G- c' X
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    : o; s7 h2 {# M, R* h3 C+ o, J" g1 j
56. 
    
57. }
    0 Q+ j7 T- Z# `' h
58. 
    4 S3 e# |3 Z/ t, {2 P( F4 Y9 a" H+ E
59. //=============================================================
    
60. 
    6 K& u. _& g1 K! {
61. double ARCTAN1 (double y, double x )
    
62. 
    
63. //#=============================================================
    ! [  S2 S$ ?+ F5 E2 a3 @% W7 J" C
64. 
    0 b5 t6 O. P# G  j# b& l; m, H
65. {
    & B3 n( I0 a* w( d3 V
66. 
    3 {0 R$ |7 a( W0 v' r1 G/ `, y
67.    double ang;
    
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
    / [4 D& v% D! @! Q% A( r5 v
71.    if (EQ_is_zero(x)) { x=0; }
    
72. 
    + m. l9 X6 B  j1 M1 ^2 U& q) {1 Q
73.    if (y == 0 && x == 0) { return(0); }
    
74. 
    
75.    ang=atan2(y,x);
    
76. 
    6 c9 B' E7 f$ f- N% u5 j) F4 |8 `
77.    if (ang < 0 ) {
    
78. 
    , p/ b# j! l0 ~  I1 ^5 \, D% `3 r
79.       return(ang + PI*2);
    & {* W9 D% O  C! G$ Y
80. 
    * t% O, A* u* S% D/ A
81.    }
      E( M& g2 f. J1 j! l( G' r
82. 
    7 l# _2 a0 J3 P% v" m3 l9 |
83.    return(ang);
    
84. 
    / R8 T) `$ N$ D% l* i& X. u- v
85. }
    + U, u4 d/ `# H( i( ]
86. 
    ! Z; u# H/ ^% k4 c
87. //#=============================================================
    ) v! }" R' M0 ^  d
88. 
    7 C/ v$ x2 R" [$ M
89. double ARCTAN2 (double y, double x )
    
90. 
    
91. //#=============================================================
    1 ^8 l4 j+ h: a) z% |' z; T
92. 
    
93. {
    
94. 
    
95.    double ang;
    $ J) @6 Q5 M% [
96. 
    $ P/ O* ]" U0 K/ z$ ^
97.    if (EQ_is_zero(y)) {
    
98. 
    
99.       if (x < 0.0) { return (PI); }
    * }+ b1 Z, Z- |. U* U
100. 
     0 Y3 x2 u! b+ c' v7 K$ a
101.       return (0.0);
     
102. 
     
103.    }
     0 L/ S. {2 ~2 T. V# `" l
104. 
     
105.    if (EQ_is_zero(x)) {
     0 K5 M0 b2 h. d5 v2 M' `
106. 
     3 n' q7 K0 z9 H
107.       if (y < 0.0) { return(PI*1.5); }
       N0 g8 Q8 l. l+ F6 T  Y
108. 
     ( f1 y6 y( {; A8 U* M
109.       return(PI*.5);
     
110. 
     
111.    }
     
112. 
     
113.    ang=atan(y/x);
     
114. 
     ! S" h' ~( m% R* v) h1 Y$ o
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     4 E) m' Y* d, }/ `/ [& ]- `
116. 
     
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     0 O. P3 |* r5 D3 ?: y6 F( Y
120. 
     $ x, \, H# j! ]6 S8 [2 r
121.    return(ang);
     
122. 
     
123. }
     , @5 |+ U7 Z8 C+ s3 [' O
124. 
     
125. //#=============================================================
     
126. 
     ) _  {( p3 }9 G; S4 q
127. double CheckConst ( double angle, double constvar  )
     $ L- f0 n, b0 i* l; d
128. 
     
129. //#=============================================================
     4 Y* n( k# }* p/ a
130. 
     
131. {
     
132. 
     ) q9 r7 d$ ~, {" N  x! _% @
133.    while (angle < -constvar) { angle+=constvar ; }
     " h9 R2 W, |5 H* y9 f
134. 
     8 k( {) }4 n0 N9 f  A; N! B
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     
138. 
     " d. y# S& G0 h( x, I. B2 I1 H
139. }
     
140. 
     & x* V2 j$ f6 c% C
141. //#=============================================================
     
142. 
     " f: g$ a1 q; p- v
143. double Check360 ( double angle )
     
144. 
     - v4 z) k* u$ e" h0 A. h. K8 {
145. //#=============================================================
     
146. 
     ) G+ w! [: c$ v
147. {
     # h9 `4 W3 k7 |. ?
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     4 `& z$ X- S" F$ U% g' I
150. 
     6 a7 ^9 Z( X0 y5 x, Z
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     
153.    return (angle) ;
     6 b6 ]4 q& d1 G' ^0 n
154. 
     * |2 U" R3 L6 @+ B+ [$ G1 h- Q
155. }
     
156. 
     
157. //#=============================================================
     
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     
161. //#=============================================================
     
162. 
     # I7 Y6 r' S& l6 w  q
163. {
     
164. 
     7 f  f7 z3 A3 K  W; `! t' E' p% Z
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     , N/ [! e# h# S2 _3 m6 }9 M
168. 
     2 b. W; a% v6 ?$ E  A
169.    return (angle) ;
     
170. 
     
171. }

复制代码

以下为摇篮5轴计算过程代码

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   
2. 
   
3.          j=0.; B1=0.; B0=0.;
   0 i  T5 Y% R( ?# y! E" u' C
4. 
   ) ~+ e$ u. E" E% Q4 q. ]0 F
5.           if (EQ_is_ge(i,0.)) {
   1 ~3 F$ H9 d( g  y
6. 
   
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   8 y$ h4 p9 G( Z. u3 k
8. 
   $ r* v6 N; _( g- e) [
9.           }
   
10. 
    # R* {. |& H( m
11.           if (EQ_is_lt(i,0.)) {
    ' C" Z- f. J- S2 h3 {* p
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    & u# \; y' N* \! \1 }( b4 }
14. 
    
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    9 V8 w8 h; A1 L3 v* u
17.              } else {
    
18. 
    . d' W& [+ F4 u
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    3 Z& E% K. f# Z  T, p6 y
21.               B1=2.*PI+B0 ;
    
22. 
    
23.              }
    : W/ Y/ H* `3 {
24. 
    ' l2 A$ u8 I$ G  Y4 @8 b" y
25.           }
    " a" c0 E/ R' A- T' W
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    7 H# ~6 Z2 ~/ R+ ^% G
28. 
    " L, g" b7 R. S7 t* A* t
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    
30. 
    - l0 }! a1 Z5 T. k% s- A
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.;

复制代码

2 l& v6 }/ H  N" c+ x# e" ]通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。

& ~" J9 B6 G8 C- p1 V; n! a0 s
测试结果：
4 H$ v: z- u( u

反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享