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

若枫

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

1. int  EQ_is_equal (double s, double t);
   ' U! ^9 \  b% y/ R- x; |
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);
   7 f' }8 ]7 F' W: C$ G$ q, u! W( H9 t
5. int  EQ_is_lt (double s, double t);
   8 d; q: h' ^- l9 S. F$ T/ g
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   
8. double ARCTAN1 (double y, double x );
   4 G  @7 d5 V, c) s
9. //#=============================================================
   " P4 D4 |- \- x) w4 `/ z
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    - H# r2 N' R* k' r5 b; k- X
14. double Check360 ( double angle );
    9 U' F3 v: Q  \5 f! O9 Z
15. //#=============================================================
    
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    2 q' A% G' u/ l0 [' G: d* l* m
17. //#=============================================================

复制代码

+ W9 U, V8 s4 Q" `/ {/ c( C以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   3 p% Q# ~. Y" U, g6 F* p& ~; o# ?" t- Q
2. 
   
3. {
   " _2 k* `4 M* J: ^
4. 
   5 s/ s( _! M! y# ?6 F& M0 Y
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   0 B* _' U! ?+ N; {9 X
6. 
   % M- T8 c5 t& I4 O* I! _/ B
7. }
     H% X/ J9 N* g8 I. G1 W: r9 z, ]* _
8. 
   
9. /***********************************************************************/
   
10. 
    / W: H! d8 L# F6 y* `- l
11. int  EQ_is_ge (double s, double t)
    
12. 
    
13. {
    1 @" _- t3 ]& v3 }/ M6 Y
14. 
    ( b4 W% F6 q: B' Z$ {
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    / Y9 Y8 {) N6 X4 \* ~7 }
16. 
    
17. }
    
18. 
    
19. /***********************************************************************/
    
20. 
    3 D) z' F) b% \3 Y
21. int  EQ_is_gt (double s, double t)
    
22. 
    , O( M  d" K# q* G
23. {
    8 q( P$ \) J. {6 J  T) M' v
24. 
    ) h. s" ?: B' Z( Y
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    * [: o2 {* s  X4 g5 W2 X* u
26. 
    
27. }
    
28. 
    
29. /***********************************************************************/
    
30. 
    1 `$ G: ^3 p5 ]+ Z4 x3 y
31. int  EQ_is_le (double s, double t)
    
32. 
    & \* T0 C; E8 q. A4 D- J) k- }
33. {
    
34. 
    
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    ! Y/ {, C1 j) N/ d4 ^; ]3 q& D
36. 
    ( p( U8 U  b8 q! E: h, k7 T
37. }
    " H8 J; |4 q4 I% @% E
38. 
    
39. /***********************************************************************/
    
40. 
    
41. int  EQ_is_lt (double s, double t)
    
42. 
    
43. {
    9 `0 p# K/ n; y6 S; E/ C
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    ! t9 C9 d9 k$ \+ z( i* _/ M
46. 
    5 F( m' A7 J! Q) y) u2 e
47. }
    
48. 
    
49. /***********************************************************************/
    
50. 
    , P# n. [* |" c) n0 d
51. int  EQ_is_zero (double s)
    0 v9 s- [# E& x4 S/ |- _
52. 
    
53. {
    
54. 
      X4 g5 }+ w9 R0 b1 }& @4 H4 Q
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    ; L( D8 o/ h; S
56. 
    
57. }
    - }" b$ \+ H" s" h" a2 n
58. 
    
59. //=============================================================
    
60. 
    * W' Q' n$ f, E( {: B
61. double ARCTAN1 (double y, double x )
    
62. 
    1 f' A) j7 P, H1 b
63. //#=============================================================
    # G: Q" ^9 T# O, z. x7 U
64. 
    
65. {
    + B" _6 g! _" _! v- i
66. 
    8 Z1 T& [- J; ^
67.    double ang;
    
68. 
    2 J# Z0 ~' W& ?+ s$ _
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
    + t4 U+ f  \* Y7 I) |( D6 E; k: D
71.    if (EQ_is_zero(x)) { x=0; }
    " |6 _- v, V3 s; K1 }
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    ; V0 N: U' S0 N+ f5 ^5 V' ?
74. 
    
75.    ang=atan2(y,x);
    + l; T0 I! S$ C
76. 
    " k7 {! ^8 o3 a. ^3 Y' D3 x9 r
77.    if (ang < 0 ) {
    8 L! f( G+ [+ k. |& u
78. 
    
79.       return(ang + PI*2);
    8 O: I2 u- |2 m5 U$ N- z$ k
80. 
    
81.    }
    
82. 
    4 O7 b( @& H/ m1 g! p
83.    return(ang);
    
84. 
    
85. }
    
86. 
    
87. //#=============================================================
    
88. 
    2 _2 f/ A/ Y( R% D
89. double ARCTAN2 (double y, double x )
    
90. 
    
91. //#=============================================================
    1 |* `% b; }  o. f
92. 
    
93. {
    - x, H$ I' B/ Y! c  g/ p! B+ A
94. 
    ) ]3 ?. y: P/ U/ C  h6 h' a
95.    double ang;
    
96. 
    - e# F& ^8 j! r! [+ e# S
97.    if (EQ_is_zero(y)) {
    
98. 
    - J' }! h  z# n, D
99.       if (x < 0.0) { return (PI); }
    8 a  i' \% O3 V% _
100. 
     
101.       return (0.0);
     
102. 
     
103.    }
     * d5 F! h+ J- D  A1 U
104. 
     , l+ K' I* }& A2 I' ~
105.    if (EQ_is_zero(x)) {
     
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     5 o; P% o$ t+ M8 }" C) k# N
109.       return(PI*.5);
     ' V' w5 n7 t" ^& r: I+ G
110. 
     ) O, b/ r4 ?! [1 v
111.    }
     - b, ~+ F" s, k  g6 B, z- Q
112. 
     
113.    ang=atan(y/x);
     ! n+ o. V- H$ A$ c
114. 
     
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     " _4 Z' _( }$ ]" {% T
116. 
     ( R$ M: M! F' @
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     
121.    return(ang);
     
122. 
     
123. }
     8 w. G' {* f+ D
124. 
     
125. //#=============================================================
     
126. 
     5 T; m# q) r( o3 k- P6 }  s  s( \: ]0 B
127. double CheckConst ( double angle, double constvar  )
     & o" j  z# K$ _7 V' R" M: F& G7 }
128. 
     
129. //#=============================================================
     9 t& y' ~" a$ o8 X0 h
130. 
     
131. {
     4 A9 Q" R9 Y) r/ a7 W
132. 
     7 L# k, j- r# h& f3 V! s
133.    while (angle < -constvar) { angle+=constvar ; }
     + u- `1 j$ _! \0 ^5 W# i( c
134. 
     + `6 U1 J1 P) s1 e, {2 ^! i. M6 a: D
135.    while (angle >= constvar) { angle-=constvar ; }
     ' l7 I. Y& s# Y$ z
136. 
     
137.    return (angle) ;
     * W* y8 O) P% c) [" T4 o
138. 
     7 x- k  b- o0 M6 a4 `
139. }
     ( B  c  n/ w' y1 e/ O" T* E
140. 
     # ~/ s; V# Y$ ?  j9 H3 G
141. //#=============================================================
     - U8 Q6 O8 |3 F3 e
142. 
     # T, I5 f0 C9 L/ ?1 B3 E
143. double Check360 ( double angle )
     & C$ W& h; T# E& |- s, P
144. 
     
145. //#=============================================================
     / I7 k8 c7 e5 n4 l
146. 
     % V" c1 G, u/ r0 o. c' s$ V, F$ t
147. {
     * Z) ^7 x7 q' Z# O
148. 
     : R$ E6 m+ ?9 z2 R) A
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     % Y  X1 ~3 _0 d
151.    while (angle >= 360.) { angle-=360. ; }
     $ F& R; d+ N9 {1 D' Y
152. 
       k( l, C  G3 j1 y
153.    return (angle) ;
     ( o8 w! n( m) W: C2 ~# M: ~; s) V# ~
154. 
     
155. }
     
156. 
     $ j9 m( `. |3 @  g# D; U) K0 D
157. //#=============================================================
     0 z5 V+ ?8 d6 C/ W- x
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     
161. //#=============================================================
     . ~% ^' M# P7 {% H" `( Z
162. 
     % ^6 |( c5 I+ H- D' O
163. {
     ) r9 D7 s- M- `! H* R, s
164. 
     - ?5 ]; R& H7 P3 F6 F
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     , \& a( q: I+ S7 T5 F
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     ; k4 G. x' _7 O% J
169.    return (angle) ;
     ) i6 t* R9 K  g+ j- I2 f  d
170. 
     % h8 d$ D) y8 V- y
171. }

复制代码

以下为摇篮5轴计算过程代码
. |" ?+ p+ i' j

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   2 v+ P4 W) b% i/ k, o% O% _
2. 
   
3.          j=0.; B1=0.; B0=0.;
   
4. 
   
5.           if (EQ_is_ge(i,0.)) {
   
6. 
   
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   
8. 
   
9.           }
   ! h6 `7 E7 f% C+ {
10. 
    
11.           if (EQ_is_lt(i,0.)) {
    
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    ; D: o  C+ i2 O8 t. R4 R0 G
14. 
      I' ^2 ^7 w  w3 {2 z9 j5 @
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    4 J' Z- V2 r+ p; f/ C7 y
17.              } else {
    
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    
21.               B1=2.*PI+B0 ;
    
22. 
    
23.              }
    3 J: B6 F' b+ a) F) L0 C8 _
24. 
    
25.           }
    
26. 
    3 i- U$ U: K, X3 u8 x
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    ( y* b+ j* t8 ~' s, {7 |6 C
28. 
    0 q: |( W- h  c0 o" m
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    ! W: P- I: ?7 f$ J: K/ |- L
30. 
    $ }6 [/ M* c6 a) s
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    ( d  M! P' w* m& p2 j$ r/ b
32. 
    
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

/ \. B. l* M" i) A5 b6 X, b. f通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
* `3 v' m1 m% c, D2 m; u: Q5 A5 ~
5 P8 N  g+ c# k8 o$ P# u( l
测试结果：

9 ^, O) y! K+ ~! w; F4 _# y" E
5 V6 m, F& ^. {0 y5 H# v& B反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享