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

若枫

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

1. int  EQ_is_equal (double s, double t);
   
2. int  EQ_is_ge (double s, double t);
   - j' W% Q' p% ~( I8 g: j9 z
3. int  EQ_is_gt (double s, double t);
   
4. int  EQ_is_le (double s, double t);
   
5. int  EQ_is_lt (double s, double t);
   
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   
8. double ARCTAN1 (double y, double x );
   5 ^  S8 I3 s# Q. F" j
9. //#=============================================================
   0 @3 u% u9 W7 Y) ]' g
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    ( l& A' H4 N+ X2 Y- {
13. //#=============================================================
    % F0 q$ u' q5 `/ L( H* c
14. double Check360 ( double angle );
    
15. //#=============================================================
    
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    
17. //#=============================================================

复制代码

  }7 i. s! \2 ~- S! a  N以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   
2. 
   1 H: ~: w2 E! H% a
3. {
   
4. 
   " ^0 g3 T4 E. }
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   ' e# X  e! W7 t6 A0 L
6. 
   6 M' X6 L, }& k" g" f/ i+ b
7. }
   5 m. j7 ?1 \- [! J$ D: b
8. 
   ; N% X7 |* ?; v8 T1 Q
9. /***********************************************************************/
   
10. 
    , F4 l8 T, ]& @3 K5 J. C
11. int  EQ_is_ge (double s, double t)
    
12. 
    8 ?& a. c1 ?8 Y. s
13. {
    
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    
17. }
    
18. 
    
19. /***********************************************************************/
    3 M6 o6 Q! A, c1 H* O: P
20. 
    ' R5 M: M' }1 y
21. int  EQ_is_gt (double s, double t)
    4 a9 C! s+ Z9 _
22. 
    $ V* R) x$ n# A! m/ g2 ]
23. {
    
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    & K! r/ [, f0 v+ K8 o7 F
27. }
    8 c' N  C, m2 S- E/ }/ E
28. 
    # p$ u4 n: x, J0 z0 r; o; ?) P4 I! x/ P
29. /***********************************************************************/
    $ i1 h1 y+ q7 R# U+ C  j
30. 
    
31. int  EQ_is_le (double s, double t)
    
32. 
    
33. {
    
34. 
    - }$ \' Q' \2 }1 f
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    + T/ r% M7 U* ]% |; G4 u
36. 
    9 d6 d5 T$ b2 v/ S' |
37. }
    
38. 
    
39. /***********************************************************************/
    ! N+ T' c6 i4 q: r
40. 
    
41. int  EQ_is_lt (double s, double t)
    
42. 
    . `# D+ @6 q7 \( j
43. {
    
44. 
    1 U7 g/ F6 L$ S$ Y
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
    
47. }
    , v4 K; D* H% }1 ^5 Z7 F
48. 
    ) M; M+ w- k" }. X: o
49. /***********************************************************************/
    : h% Y5 ^; J2 y( p3 T! x
50. 
    
51. int  EQ_is_zero (double s)
    : w6 e; a' D: T1 N$ [
52. 
    
53. {
    
54. 
    1 q+ p& t5 T' R- H
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    + K) t. e, x6 Q8 @# j( d& H# e
56. 
    6 A0 {2 O% h% @7 a* H  I' @4 G/ Z
57. }
    
58. 
    ; ^1 h$ z  M; O4 L% }3 k; M9 x) V
59. //=============================================================
    1 m+ \0 Y/ S3 M0 a  J1 U
60. 
    
61. double ARCTAN1 (double y, double x )
    
62. 
    
63. //#=============================================================
    1 x9 ^. T3 X# u. ^1 K4 s! C" j! B
64. 
    2 A# A6 J) R8 K+ ^/ K) D. K) ^
65. {
    9 i& J0 ^  H1 T. }6 y6 C
66. 
    # L1 k6 a& O0 N9 x& ^8 \2 c
67.    double ang;
    
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    # ?! s' t# K+ v7 n2 O
70. 
    - b9 |8 Y. E2 V9 n. n5 H" A, d
71.    if (EQ_is_zero(x)) { x=0; }
    . [3 M( U4 N$ [* y' `( e
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    
74. 
    # z- n$ _1 a- _2 {
75.    ang=atan2(y,x);
    - U6 L+ F3 x( S6 _, p2 M
76. 
    1 \$ I4 ?) `! ~2 n1 r$ X3 C0 X
77.    if (ang < 0 ) {
    
78. 
    
79.       return(ang + PI*2);
    ) j$ D3 l; r0 T" [5 C0 f
80. 
    - @4 |5 w3 v" ~% G
81.    }
    8 D- j' t& ^* ]; C. L# ^/ H& ^3 Y9 D
82. 
      N1 ]% g* b' w! k2 \7 P2 @9 R
83.    return(ang);
    4 ~$ B* R3 ?; w1 u9 y" O4 U
84. 
    
85. }
    / D1 y, ]0 C  `. f
86. 
    8 r0 H0 Q, Z) |+ T0 w4 M, E# t
87. //#=============================================================
    
88. 
    6 m+ r5 b( L. I4 {
89. double ARCTAN2 (double y, double x )
    " i. b7 ?! A: _
90. 
    
91. //#=============================================================
    
92. 
    / n% ?# j9 U4 ^
93. {
    
94. 
    ; s8 @' z8 O5 Q" T
95.    double ang;
    
96. 
    ( h' `2 ]6 q5 ~
97.    if (EQ_is_zero(y)) {
    : r5 r& ~5 F' Z/ k$ U4 ~  q) T1 z
98. 
    
99.       if (x < 0.0) { return (PI); }
    0 o0 z" k( _& y3 T2 `
100. 
     ) C4 }2 \4 q$ J  w0 T
101.       return (0.0);
     
102. 
     8 S; w9 r; }! p8 |$ b# K" t& z, U
103.    }
     $ r8 s3 M% O( o5 G! d
104. 
     % A) u# `, g2 ]5 z: A: T
105.    if (EQ_is_zero(x)) {
     
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     & q9 t. A% `, h7 X# Z  l  F+ n
108. 
     2 C, g" T; p/ ]% n( l/ V9 d
109.       return(PI*.5);
     ! F1 k8 ?5 S  }' a% g0 O7 d
110. 
     
111.    }
     
112. 
     , \6 j5 v4 ]  Y" |
113.    ang=atan(y/x);
     ! e5 o2 t. b, A! 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. 
     " n; B1 j: ^! W3 ?* W4 L* Z2 Q
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     
121.    return(ang);
       v. T# J6 ]$ L% ?0 Y
122. 
     
123. }
     
124. 
     2 e" C6 V; g" Z. p
125. //#=============================================================
     
126. 
     
127. double CheckConst ( double angle, double constvar  )
     ( y4 F9 T. _* Y2 ^1 \: i- b
128. 
     
129. //#=============================================================
     
130. 
     
131. {
     
132. 
     3 p# d$ c# c2 d( M
133.    while (angle < -constvar) { angle+=constvar ; }
     
134. 
     , W. q8 m% n* T2 w. I/ g
135.    while (angle >= constvar) { angle-=constvar ; }
     1 Q2 ]; V! i/ u
136. 
     
137.    return (angle) ;
     / ?, H- G- w4 W: G, E; z6 c  ?
138. 
     ' S3 {- n6 B) \4 M, W
139. }
     
140. 
     
141. //#=============================================================
     , I" c$ I" B1 x8 g2 R6 j0 y( P
142. 
     ; ?" c# B& r- W7 |" u- Z: U- n
143. double Check360 ( double angle )
     1 G' f( V4 r6 ?( _: o7 p1 D) T/ E1 X
144. 
     
145. //#=============================================================
     - `  z/ D+ u  m% Y4 n, a
146. 
     
147. {
     # L8 b! i& Y* D# t3 G) Q
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     ' U; j# u0 g0 S
150. 
     : A4 a0 j3 f4 Y/ u0 y
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     5 }  R8 T' s/ w- K+ ^; T' ]
153.    return (angle) ;
     ( o& z. k. X" |- d' a* R
154. 
     
155. }
     0 Z: l6 B: [3 y: m+ p- ?
156. 
     
157. //#=============================================================
     
158. 
     5 C: J) b5 j! B
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     # o1 i5 ~" W& g1 v% o
161. //#=============================================================
     . _* q4 |6 l; O" f- |
162. 
     ! I1 q5 ~3 u. T% e0 H" K' U
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) ;
     6 m, W# V) I7 V& S3 A1 O
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.;
   
4. 
   + k$ I! _  ^# d/ W
5.           if (EQ_is_ge(i,0.)) {
   & J5 y+ d/ ~1 G& o7 X6 s
6. 
   
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   
8. 
   : Z' q8 l/ O& D
9.           }
   
10. 
      U: `8 Y* F) i4 x3 G9 ]
11.           if (EQ_is_lt(i,0.)) {
    $ V" p9 H& a$ {; V+ ]; S( D
12. 
    # @' m% P! S0 Q0 r
13.              if (EQ_is_lt(k,0.)) {
    
14. 
    
15.                 B0=atan(i/k); B1=B0+PI ;
    - S) p! `5 V2 |( V
16. 
    8 {! n1 S+ }* z6 S7 p
17.              } else {
    4 G  v3 G+ P; O' Z8 ^- T
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    2 S5 u; y3 l6 D, Z
20. 
    & p5 i: }2 b: h2 M+ ]. Z
21.               B1=2.*PI+B0 ;
    " m; w, g  \3 b  z" z' m6 O2 y; l
22. 
    3 h1 B. O% W0 R! E2 f, Z3 y5 A9 k
23.              }
    
24. 
    + ]( k" f  r% ~, f  W) h
25.           }
    
26. 
    & c! z3 h. l- e, B* s- N
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    9 j5 r6 M: e# s' b! [) X! @
28. 
    
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    . M, k! ^' W8 B# d& |! ]( _$ j; }% k
30. 
    
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    & ^6 m" F: c6 \2 j9 q) ?
32. 
    , w3 o3 n! }% |# a$ T) B
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

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

+ ~( k: V, O5 Q5 I4 S7 b
测试结果：

, n$ i. q& v# L9 L9 S; R
反向测试结果

yucammayco

谢谢分享