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 z- {  D4 M% z  R
3. int  EQ_is_gt (double s, double t);
     `  j$ u) @# M. u9 q5 y
4. int  EQ_is_le (double s, double t);
   ! F, _* C8 I) C7 i$ v9 ?. A) f
5. int  EQ_is_lt (double s, double t);
   
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    ; `2 f0 G; o8 e2 l0 l6 H
12. double CheckConst ( double angle, double constvar  );
    + y4 w* |- D- x' m
13. //#=============================================================
    
14. double Check360 ( double angle );
    + B) g1 A% M- B1 g! I
15. //#=============================================================
    5 G$ G3 `2 K% _; I% V1 s- B
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    
17. //#=============================================================

复制代码

8 K1 E: o; E; Q% E2 v" U: c6 k以下为部分源代码，用于判断，计算角度等
. V9 c4 e6 {, c% w% N9 U

1. int  EQ_is_equal (double s, double t)
   8 R# h% x% Y4 K; U, ~" p
2. 
   4 h2 t/ h$ x' }
3. {
   
4. 
   + i/ b) v) r  `0 _( G$ D& `
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   4 ?$ J- y  i" b
6. 
   & i  H3 O& K  L' P9 h
7. }
   % i1 A5 `8 k4 g, S. _% m
8. 
   
9. /***********************************************************************/
   
10. 
    
11. int  EQ_is_ge (double s, double t)
    
12. 
    
13. {
    
14. 
    4 u6 D$ E$ A1 `* E/ \$ {* _
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    
17. }
    
18. 
    # K  _/ X: t! ^" I8 c5 C# ]
19. /***********************************************************************/
    4 g$ [8 S, W+ n, N
20. 
    & M  a+ A) t) b$ n- H
21. int  EQ_is_gt (double s, double t)
    0 r0 {4 q: q3 P2 X- G; n/ @5 T
22. 
      f2 P" q* w  r
23. {
    + u& Q( E" C$ ^" U- y9 F
24. 
    6 @% D  E9 h# M+ j% A
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    
27. }
    
28. 
    
29. /***********************************************************************/
    $ g3 s8 ~! o5 C+ P# L9 T8 ~+ ^. K
30. 
    
31. int  EQ_is_le (double s, double t)
    - s* D$ s9 l. a- O: y0 x) Q
32. 
    
33. {
    , t! N9 g( `' a3 K0 m. y  K. w4 j
34. 
    3 C8 |0 Y& D4 C. t- }4 v" u) Y
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    ( j- X5 f/ y# G* m& ]8 G* \
36. 
    9 P; u' P# q6 {4 _2 s' S6 V5 X, H# N
37. }
    ! w$ Q6 z" p! v# H2 e: \
38. 
    & n: ~! y) ^1 V3 h* N
39. /***********************************************************************/
    " R6 {. D6 f" i0 }
40. 
    * ~% g' u* f. f7 H+ \, z
41. int  EQ_is_lt (double s, double t)
    : i6 c5 a2 f, e
42. 
    0 f$ f( s7 Y6 U  T! I( ]# P/ M+ Z+ W. k
43. {
    
44. 
    * e0 A! J4 ^* n' K  f  H
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    ) }9 x* j1 T1 e$ w
46. 
    
47. }
    
48. 
    
49. /***********************************************************************/
    , j8 k1 k7 i, \3 ~' W3 F$ H
50. 
    4 D- o: M' X4 n- h* M8 ^
51. int  EQ_is_zero (double s)
    
52. 
      q& D, R" o4 J& h& n
53. {
    
54. 
    : D1 G7 O8 k+ R6 H  D5 B% ?
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    
57. }
    3 G2 R5 d/ J5 [& ?6 e- h4 Z
58. 
    + p9 J* K6 {6 X/ S
59. //=============================================================
    
60. 
    
61. double ARCTAN1 (double y, double x )
    
62. 
    
63. //#=============================================================
    ! N! [  j5 D# ~4 z3 u& I
64. 
    
65. {
    
66. 
    
67.    double ang;
    5 v: x: e& e. O
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    # C8 {; u* _* v% ~2 _
70. 
    / e% [; e, y6 t7 b. y# @: V
71.    if (EQ_is_zero(x)) { x=0; }
    2 z7 O1 x4 A. N( X) q
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    ! C. ?+ S! f  M" ^  c# k+ J
74. 
    
75.    ang=atan2(y,x);
    ( [0 I$ T) M8 a
76. 
    
77.    if (ang < 0 ) {
    
78. 
    
79.       return(ang + PI*2);
    
80. 
    
81.    }
    
82. 
    5 l/ L0 _5 ^9 M
83.    return(ang);
    & m$ N2 R+ F8 S6 J# z, ~
84. 
    3 e/ v  H6 Z3 y6 E+ D
85. }
    
86. 
    
87. //#=============================================================
    
88. 
    $ Y- u* @$ n1 N; I. @1 L4 y
89. double ARCTAN2 (double y, double x )
    
90. 
    
91. //#=============================================================
    
92. 
    
93. {
    
94. 
    
95.    double ang;
    + F. `0 @$ O; |& Q
96. 
    
97.    if (EQ_is_zero(y)) {
    # G/ t3 L3 e' g7 _$ c8 {% i
98. 
    ) A3 v+ B0 B6 k2 @* E1 N1 Y: M
99.       if (x < 0.0) { return (PI); }
    
100. 
     , J% `6 `" n- b
101.       return (0.0);
     4 {2 w8 S, y9 Q) N1 j+ {/ @
102. 
     
103.    }
     . ]. `' D# {# F; @; v, u, Z
104. 
     
105.    if (EQ_is_zero(x)) {
     & u' W$ R5 X4 p9 G' b. c; Z6 s1 i
106. 
     . f1 o' X6 o- H* f+ j+ H
107.       if (y < 0.0) { return(PI*1.5); }
     2 Y* w' G4 U) T2 B0 m& b+ a+ T3 ]. c
108. 
     / `' Q- l. S1 }& i$ a2 R& S- R
109.       return(PI*.5);
     5 d) H2 f9 [2 R: w) R
110. 
     
111.    }
     
112. 
     . ^" q1 W! R2 ~# }& p
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. 
     : i3 u8 _# i; Y' X# h' a- ~# l/ H; B
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     3 y9 K" X& O) _4 n+ h
121.    return(ang);
     $ \# `! X9 M4 k$ M/ _% h% n& Q
122. 
     
123. }
     - Q9 x# c; }' ^$ [3 T( M
124. 
     
125. //#=============================================================
     # \2 i# y. H2 T6 _, t3 U
126. 
     & M2 m4 w# `( C& H
127. double CheckConst ( double angle, double constvar  )
     
128. 
     
129. //#=============================================================
     - a" f7 v) M9 ?: L* ~6 q1 W2 h, X
130. 
     7 y' K; P4 Z% R7 q" o( h3 {
131. {
     
132. 
     ; O5 a7 U3 E) V: F
133.    while (angle < -constvar) { angle+=constvar ; }
     
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     : f9 p. E$ u% y! Z9 K  t7 g
136. 
     $ f# `6 \% I# h& n+ U8 k4 j
137.    return (angle) ;
     
138. 
     # X/ z7 S& G& W2 x3 r( a0 a3 S
139. }
     
140. 
     
141. //#=============================================================
     - D6 M5 m3 n# z
142. 
     - f0 V* i# E& Q- [
143. double Check360 ( double angle )
     + H1 L) p! `2 ?# n- A2 Z
144. 
     / P# e! `, U. ~+ l! P
145. //#=============================================================
     
146. 
     
147. {
     
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     8 j5 V9 E% j, s/ S- e- Z7 _- W
151.    while (angle >= 360.) { angle-=360. ; }
     ! N8 F6 Q. Z* `+ t( j- H* T7 [
152. 
     
153.    return (angle) ;
     7 ~  s1 m; r! z
154. 
     
155. }
     
156. 
     $ L9 f& K% F9 l$ M; u0 @( C6 K
157. //#=============================================================
     ) M, h* ~, g* w# W9 p5 [, r$ s
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     8 N" g" e0 f1 ]) ^% M
160. 
     
161. //#=============================================================
     5 Y6 K2 {+ [! ^* y! T! y0 g
162. 
     5 @1 \3 D8 A  s* {8 F( E7 D! \
163. {
     
164. 
     " f# S* Q9 c" D0 q
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) ;
     
170. 
     
171. }

复制代码

以下为摇篮5轴计算过程代码
* y( U8 m$ G6 F5 d

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   " x6 n- d! W, v" w& H2 d
2. 
     e- x! V$ v  l2 r+ m5 h
3.          j=0.; B1=0.; B0=0.;
   % ]6 b  l" R, z
4. 
   + |. T! D1 a% n2 t
5.           if (EQ_is_ge(i,0.)) {
   3 l8 U: Y5 d/ S6 R
6. 
   
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   * {& _+ V- e5 _$ Q
8. 
   
9.           }
   + A: G: i  N7 y# {6 ?# |% l! O* e6 f
10. 
    
11.           if (EQ_is_lt(i,0.)) {
    
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    & W; j' c; H* `4 r
14. 
    + `9 b0 u4 B6 F
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    
17.              } else {
    
18. 
    * f( w: l9 m" T5 n
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    ) f7 ^# C4 z: N
20. 
    2 b) r' t% i3 t0 a! A0 ?: @
21.               B1=2.*PI+B0 ;
    0 e) v6 `: X+ \7 A* C. w2 T8 z
22. 
    
23.              }
    5 d3 K: Z) N4 K  h
24. 
    
25.           }
    ' E2 B( l# u/ D" r' z- V3 _
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    # U9 O! s% {& j1 A/ R
28. 
    8 R/ J5 t+ ~/ y9 M5 T
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    
30. 
    ) v& `; ?( ]; i+ q2 |
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    
32. 
    ( C, t6 \; b) M
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
; G* R3 ?! c. z
) v- m) y0 [. b7 ~
' C, n- v/ E& H2 z% A. L0 O# y测试结果：
/ t7 Z' M) i" W; `7 y
) v1 w( r) \) h
反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享