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

若枫

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

1. int  EQ_is_equal (double s, double t);
   
2. int  EQ_is_ge (double s, double t);
   - s8 z  o, @* d
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);
   ; }, S! Q' j4 n) f6 t
6. int  EQ_is_zero (double s);
   
7. //=============================================================
     s6 A2 X3 s) T1 s  }
8. double ARCTAN1 (double y, double x );
   ( M# @. D$ q, k/ m
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    3 F4 E' C. B% |. F& m
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    
14. double Check360 ( double angle );
    
15. //#=============================================================
    
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    
17. //#=============================================================

复制代码

0 }9 ~7 F! ]; T  q7 g! Q; v3 p; I8 B以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   
2. 
   
3. {
   
4. 
   . X. h0 ?" N2 l2 n# q
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   & X% @) ^4 q1 Q/ A' I% i7 @
6. 
   3 I* D1 _" Z9 J6 P7 z0 C# g: I
7. }
   
8. 
   7 l. _" w% y9 K: D
9. /***********************************************************************/
   8 I, ^; r! V3 w, S
10. 
    ! `0 h! _% D: I  Q0 h/ [' J. ~
11. int  EQ_is_ge (double s, double t)
    
12. 
    9 s4 }! D0 B) _1 ^
13. {
      D9 o7 R( }3 T& d3 [
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    , r8 h/ _* a6 g+ |2 {2 Q5 _
16. 
    
17. }
    
18. 
    9 ^5 m4 `# g! M# I! D
19. /***********************************************************************/
    6 S9 G  m8 ^; B7 }1 o) i
20. 
    
21. int  EQ_is_gt (double s, double t)
    
22. 
    2 p! s2 G9 g7 v' r0 x
23. {
    * ]+ O7 [  N1 K2 d) c# H/ G: T) [
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    2 W. z* S1 J5 K6 ~7 i8 d
26. 
    2 t" Q7 t- Z4 `9 I
27. }
    6 C+ b. {' o6 T) L# e, Y9 d% Q
28. 
    
29. /***********************************************************************/
    ) _- I% u* f; E6 W
30. 
    $ \/ P% I# e. ~3 q7 H
31. int  EQ_is_le (double s, double t)
    
32. 
    
33. {
    9 T/ ^; s2 e. S2 W9 C$ K. p
34. 
    
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    4 ?  y( T; K, J4 P5 D' q
36. 
    3 g  k: p: F8 y% d# P& J" O1 b
37. }
    
38. 
    
39. /***********************************************************************/
    3 }$ Y3 W' ]3 y9 ^2 }8 Z
40. 
    9 D; c$ S" m. A% P
41. int  EQ_is_lt (double s, double t)
    
42. 
    
43. {
    
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    4 X. U4 ?, f% L
46. 
    ! Y8 C) p3 U& H( p
47. }
      q6 a1 r: Q" f1 R% X
48. 
    0 {  S+ S0 o+ S* z3 c: _+ ?& Y
49. /***********************************************************************/
    : B7 N3 r6 b( h! L
50. 
    
51. int  EQ_is_zero (double s)
    
52. 
    
53. {
    . w5 k7 C% G' B. a( J$ t0 Q
54. 
    3 m% q* y+ b4 w0 G) s
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    
57. }
    & r4 X1 s7 v0 A2 \! s3 j4 \+ {5 |
58. 
    
59. //=============================================================
    5 n: ?- _9 c1 c( g
60. 
    
61. double ARCTAN1 (double y, double x )
    , Y6 y( r' l* p9 I0 b, u7 q
62. 
    ) ]* E% B) r- a* D) Y; ?* z( j  H
63. //#=============================================================
    2 ]9 {: \0 N( y. t
64. 
    
65. {
    4 m$ g! L9 ^. [+ `( l; x3 @4 _
66. 
    1 R' H# C! U; [- n' X4 S7 k/ G
67.    double ang;
      r& q0 ~; @) L& @* F3 i- U
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
    ) N' a& J" ~2 U
71.    if (EQ_is_zero(x)) { x=0; }
    7 C9 ]& v* K. n2 Y4 H8 ^
72. 
    ( ?# j0 W+ \& \
73.    if (y == 0 && x == 0) { return(0); }
    - B& v. ?! l8 m
74. 
    
75.    ang=atan2(y,x);
    
76. 
    & A" q1 m: H3 t% h4 j5 |, ?# Z
77.    if (ang < 0 ) {
    0 |  v1 J4 t8 n  m7 D
78. 
    
79.       return(ang + PI*2);
    
80. 
    1 ]; J1 @/ ^/ O
81.    }
    
82. 
    8 d! t: K1 I  W# K
83.    return(ang);
    
84. 
    
85. }
    2 E$ }/ |) w6 E6 Y4 a! }, R
86. 
    9 ]5 E- _2 m& \7 d: `
87. //#=============================================================
    ( U. \- q# `) S6 ~, L
88. 
    
89. double ARCTAN2 (double y, double x )
    
90. 
    
91. //#=============================================================
    8 Q* b% P+ d! ]! Q! r; Y
92. 
    ! E' P2 W# k* l7 D& G4 r- r7 c
93. {
    
94. 
    5 p: I5 x$ u" |2 i- O2 f6 g$ d
95.    double ang;
    
96. 
    
97.    if (EQ_is_zero(y)) {
    0 A! _* v0 S# C+ p
98. 
      Z' b8 L  b" E, J
99.       if (x < 0.0) { return (PI); }
    ; U- r+ L, K3 i+ `
100. 
     7 n9 K" A  B" z/ L& [. ]8 X! _# a
101.       return (0.0);
     5 ^& F; |3 w! E( m: G- w$ P3 }! v
102. 
     $ s' w1 k/ R7 W' V' l% w! e, T% N
103.    }
     
104. 
     . _7 Y5 `6 h: G" b# r4 K
105.    if (EQ_is_zero(x)) {
     7 L& j% J/ D" F! H. I
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     % B( L2 C# k# I* a9 [# w
109.       return(PI*.5);
     
110. 
     ! ~* F7 c1 W  U
111.    }
     ' r( }; K7 B  v8 s7 p- @
112. 
       U3 w# m) H* Y0 ~* H
113.    ang=atan(y/x);
     
114. 
     1 t5 T+ M# j$ L! Z8 J* ]
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     7 p" A8 _9 ~) K4 W5 A4 i! H
116. 
     
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     
118. 
     ' W# ?2 R  O' w0 N2 ^' w& h
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     ! a$ p) `, @) u8 I) ]2 `
121.    return(ang);
     
122. 
     
123. }
     : g8 C" O" \4 }; \) Y
124. 
     
125. //#=============================================================
     
126. 
     : j! @2 e+ d* m$ ]" d- J
127. double CheckConst ( double angle, double constvar  )
     6 K; O, `5 {5 y+ P, k# e) q/ m
128. 
     7 V9 @# X7 L: }7 ^$ H; I
129. //#=============================================================
     
130. 
     9 Q" D! w$ t0 \
131. {
     % D5 V; K5 j0 V1 {
132. 
     
133.    while (angle < -constvar) { angle+=constvar ; }
     0 m" o$ x" c4 [! n+ j6 t- O3 k
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     , }4 m2 L% _! Z# P3 f) y) D* ]7 E
137.    return (angle) ;
     - }- y& b, z+ K- _$ i+ z. s# K
138. 
     ; t( L, }3 |5 K1 V
139. }
     
140. 
     8 V- _% ~& X+ P
141. //#=============================================================
     9 B& j# G+ x0 \3 I
142. 
     ! v$ v- _& z1 I; n* b/ k
143. double Check360 ( double angle )
     
144. 
     % J! \' y4 P+ M/ M# r/ I
145. //#=============================================================
     * i4 i: ?' O( v/ K/ b) {4 m* @
146. 
     ! c0 Z2 l) }9 e( C- z. Y
147. {
     0 H0 a+ Z- G1 X
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
     % }: p: S, L: [, C( g( ]7 \! {
152. 
     3 {. V5 X9 X: a  X
153.    return (angle) ;
     . h. A& {$ F- [$ Q; f8 O( {: t! ]
154. 
     
155. }
     $ l  p3 Y1 {# {' Z* x
156. 
     6 l' r/ e6 ~0 Q; q5 B# o
157. //#=============================================================
     
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     ) R3 L# S7 o! v
161. //#=============================================================
     
162. 
     
163. {
     , c8 |; H, M! i0 I8 ^
164. 
     + G3 ]& H# P; O- I  h
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     9 P3 ]+ P$ r* z0 X% h
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     
169.    return (angle) ;
     
170. 
     7 @. m9 v6 A0 `+ Z
171. }

复制代码

& P6 l* F, C- [' o/ w以下为摇篮5轴计算过程代码
& T% d+ e2 P0 j

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   1 F* o; L0 F! b6 e$ n2 y
2. 
   
3.          j=0.; B1=0.; B0=0.;
   : o$ \0 M# U( ~9 v' ^7 J) V4 n
4. 
   
5.           if (EQ_is_ge(i,0.)) {
   
6. 
   / z1 }, r' q" R" d
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   
8. 
   
9.           }
   
10. 
    , }; q& n: Z! O- N- u: s) }& M
11.           if (EQ_is_lt(i,0.)) {
    & W4 q6 i& g5 P5 U
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    
14. 
    / R5 A. D  A# u/ f
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    ; D3 W8 P4 @' s' F8 @
17.              } else {
    3 u  _$ M0 `2 {* N) c, j, a3 h; V
18. 
    : Y* ]: \9 ~5 s  ^
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    - S' `; |) A. h* b- A0 T
20. 
    
21.               B1=2.*PI+B0 ;
    
22. 
    ( K$ {9 f4 f4 T3 ]3 K- ?
23.              }
    
24. 
    1 O% l4 p3 m. c1 d7 z
25.           }
    
26. 
    % n& @  V  I% w( R9 `
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    
28. 
    , y0 Y  ?! I4 a9 }9 A
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    
30. 
    
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    
32. 
    3 V; U: }% P9 R5 R& t3 I$ g
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

0 O4 Z  R: t5 K- l' o通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。

1 e! ]5 Q- \3 u# M/ b0 D" v; [
0 n0 d. V, k0 t4 q测试结果：


反向测试结果
+ ^/ b+ o7 s2 L8 `1 K# E' K+ U

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享