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

若枫

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

1. int  EQ_is_equal (double s, double t);
   
2. int  EQ_is_ge (double s, double t);
   
3. int  EQ_is_gt (double s, double t);
   . J* K9 a5 g0 {7 l* ~* Y6 e6 `5 T
4. int  EQ_is_le (double s, double t);
   
5. int  EQ_is_lt (double s, double t);
   " q6 d7 x2 m/ E3 e" W5 x  ^
6. int  EQ_is_zero (double s);
   ) |  ^. n$ J2 K' `' ^3 g
7. //=============================================================
   
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   6 e$ B& A& m. V9 c$ J3 W8 P
10. double ARCTAN2 (double y, double x );
    5 a7 n/ ^- t) o  s9 M
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    0 _% D- H( [: `+ h! W5 P
13. //#=============================================================
    3 C& @. p8 w7 ]3 W; e& W2 l
14. double Check360 ( double angle );
    + C; Z. n+ ^5 U& ^$ S
15. //#=============================================================
    
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    
17. //#=============================================================

复制代码

; Q9 w9 F% p; n  @9 j以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   
2. 
   - k0 q8 L" ?, K$ u- a/ g& ~9 M
3. {
     V+ j( L% y# X* h5 R+ z8 O
4. 
   2 G# W5 m. E. T/ P5 A
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   3 \$ g: ^5 k* r) T5 W. X* c3 E8 [
6. 
   2 k5 h% J# J% Q+ ]( |
7. }
   
8. 
   
9. /***********************************************************************/
   
10. 
    
11. int  EQ_is_ge (double s, double t)
    
12. 
    ; Z( Y+ Y' Y# S: z
13. {
    ) B6 U/ ^1 I2 D
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    % ?( m% Z+ Z5 X7 g( j( ^
16. 
    4 `5 A  e# e+ H
17. }
    
18. 
    
19. /***********************************************************************/
    
20. 
    & Q# d$ c* L1 q1 c" x. B
21. int  EQ_is_gt (double s, double t)
    ) g% {" Z  a1 b5 v- j0 o$ G: {; Q
22. 
    
23. {
    
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    ; @* u1 p: A) ]) T+ w
27. }
    ' D; v. @& z4 W/ a& J) ]  G
28. 
    
29. /***********************************************************************/
    5 m3 y9 v4 B6 A- D( I
30. 
    
31. int  EQ_is_le (double s, double t)
    
32. 
    + B2 f$ L1 \1 T! H
33. {
    
34. 
    
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    4 w9 i! g' R, u! X0 [
36. 
    
37. }
    
38. 
    - E) z3 F5 g/ P9 F
39. /***********************************************************************/
    ( X" P$ B! X' J: h0 R5 w% F: ^
40. 
    
41. int  EQ_is_lt (double s, double t)
    . |( l& H; l" Q$ @
42. 
    " |. p/ v1 @: {
43. {
    1 F$ R2 M( |- K( f
44. 
    4 Q) W, Y" X( t- {9 I  S
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    % p; E: P9 ~/ X5 s
46. 
    2 o. b* g; N) m2 r3 a/ _& @- _
47. }
    . P7 h" K3 K: k5 F5 H
48. 
    
49. /***********************************************************************/
    8 _. M+ f9 c5 Y2 Q: o  q; v$ ~! _
50. 
    ! X& V* l$ V' B
51. int  EQ_is_zero (double s)
    / ?% |. X2 H, S7 ^
52. 
    
53. {
    , r$ G9 D  i2 U+ X8 _
54. 
    9 w1 K+ y& U6 V& V) @5 k* a: }# i
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    
57. }
    8 V* ], Z4 x; Q  V
58. 
    
59. //=============================================================
    % ^7 E% [3 h% t+ e/ O
60. 
    
61. double ARCTAN1 (double y, double x )
    ) E7 u( t, [& j8 {
62. 
    
63. //#=============================================================
    
64. 
    
65. {
    
66. 
    
67.    double ang;
    0 E: e# b  P% _! Z2 g. n) D9 M) T1 N
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    ( q/ h# e! i1 M& r' x4 N
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    
72. 
    0 c& X- e+ Q% ?
73.    if (y == 0 && x == 0) { return(0); }
    
74. 
    
75.    ang=atan2(y,x);
    8 q4 z& B/ b3 C9 j7 W" d$ t
76. 
    ( T' K, c. t, M0 T- B5 q+ E
77.    if (ang < 0 ) {
    ' _4 ~7 ~! G4 ~4 A
78. 
    
79.       return(ang + PI*2);
    # p# V. J( w9 L9 T. p% u( s
80. 
    
81.    }
    
82. 
    
83.    return(ang);
    
84. 
    1 Y3 D# [2 V4 V( [0 y
85. }
    + G0 H; n- |9 o. @  |
86. 
    
87. //#=============================================================
    
88. 
    : j9 j& L9 i2 t/ U9 C/ V, H
89. double ARCTAN2 (double y, double x )
    
90. 
    
91. //#=============================================================
    ) U, g  v" ]1 ~2 p
92. 
    ) d* l2 T/ C: B2 W. E- E
93. {
    + E: [8 ?. U$ I  {3 M/ z) x
94. 
    
95.    double ang;
    7 P9 Z0 X$ m* s
96. 
      d8 {" Q6 ]1 D6 _( v
97.    if (EQ_is_zero(y)) {
    
98. 
    : D, w2 u' C; O$ L8 @
99.       if (x < 0.0) { return (PI); }
    
100. 
     
101.       return (0.0);
     
102. 
     
103.    }
     4 q2 y( z, _) C8 K0 E2 ~
104. 
     ) R. d* r1 E" R: `
105.    if (EQ_is_zero(x)) {
     
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     4 u4 d6 e5 {5 Z+ P+ x+ f# ?  c
109.       return(PI*.5);
     8 @, b2 c! }2 R9 I  g% S- o& ~
110. 
     . J) J  ^) O/ t2 N$ j& Y5 G! {
111.    }
     
112. 
     * r7 p) K$ a6 }$ n9 T' I" v
113.    ang=atan(y/x);
     % f0 z8 ?9 z2 R, q6 j' z
114. 
     
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     ) F7 [& @6 E, r
116. 
     * R' L' [. D! @  X8 S& R8 |' I
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     
118. 
     % x* e# G7 g. q
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     / g  t/ z- _8 H& g* I7 C
121.    return(ang);
     & Z4 Z$ I! p! ^' x
122. 
     ) y' w$ x: F8 [, V
123. }
     6 o  L5 O" P0 |
124. 
     4 s! t' {9 M7 i  _
125. //#=============================================================
     8 V5 [# C0 T8 B# u. X/ c
126. 
     
127. double CheckConst ( double angle, double constvar  )
     , @! P$ f  Y( \$ o
128. 
     / I4 w8 P8 u/ K9 J/ k5 @
129. //#=============================================================
     $ |: ]. `& r" L" z, l- t5 P
130. 
     ; V8 S: h6 |9 d7 _
131. {
     
132. 
     / o7 i* m' q4 |5 ?+ y# d  L
133.    while (angle < -constvar) { angle+=constvar ; }
     
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     
138. 
     
139. }
     3 z2 B& S  `, p
140. 
     ) P! o1 h9 O3 Y, C+ Y, |
141. //#=============================================================
     
142. 
     
143. double Check360 ( double angle )
     : c/ v) C9 n/ ]6 Z% t. G
144. 
     
145. //#=============================================================
     & i1 k$ v$ k$ }3 N" S/ r, f; T7 R
146. 
     
147. {
     , e: _! H5 U3 m. W
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     4 b! r' l0 f+ A3 `  [6 G2 \
151.    while (angle >= 360.) { angle-=360. ; }
     8 P6 y4 n1 |% M+ e& C- f* k
152. 
     
153.    return (angle) ;
     
154. 
     
155. }
     
156. 
     
157. //#=============================================================
     # G* X9 c# {7 x6 C0 F
158. 
     8 W1 _9 M; [- t2 h6 f4 P! i
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     3 e. I( i- V/ M
161. //#=============================================================
     " j7 s& Y" T1 s5 R% }' p7 R3 T9 b: f
162. 
     + [# {9 h1 X+ G; @
163. {
     8 Q4 [0 x5 E1 E" ]3 a) d( t9 t
164. 
     
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     / Y0 L3 L  ?: B8 S" p- a4 @
166. 
     $ K' [# E) S- e& S# ^  p
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     
169.    return (angle) ;
     ) ]7 Z) N* d, |/ z. P1 q  j4 Z8 E
170. 
     
171. }

复制代码

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

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   
2. 
   ) Z, K- W0 g; i
3.          j=0.; B1=0.; B0=0.;
   3 w" w# R# M4 A; u
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; }
   1 J2 v2 Q& u" ~. d, [# {3 }& K5 u
8. 
   9 p" y$ r4 W2 ~# }
9.           }
   / W& s2 o9 n. P( n% Y2 L4 U0 r5 m
10. 
    / G3 ~/ t0 x6 k4 g/ O$ h6 y
11.           if (EQ_is_lt(i,0.)) {
    : p3 b/ }- i* e1 w
12. 
      ?) @' y& h: ^) ^" z7 c
13.              if (EQ_is_lt(k,0.)) {
    
14. 
    % h0 L; S8 H2 _
15.                 B0=atan(i/k); B1=B0+PI ;
    " Y, \0 O# o9 g) ~+ |
16. 
    
17.              } else {
    
18. 
    + ]4 X, |% _- @
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    % J( Y  C7 ?4 ^" B1 r
21.               B1=2.*PI+B0 ;
    
22. 
    
23.              }
    6 G5 B; z$ J( X1 ^3 o5 I3 Q% U
24. 
    0 v5 G2 J: ~6 S) z
25.           }
    
26. 
    % K) S% q' z" J- q. o
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    ; o4 N, C1 b9 E
28. 
    
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    5 X7 R* e9 J6 |+ g5 P
30. 
    . l( z" p, c1 x! t$ ?! C
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    
32. 
    # {$ w$ t' Y8 s9 P
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

% ?; O5 ]1 I5 F- F; H3 @通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。

9 d0 [1 `" ?! c9 i5 w! a- \
测试结果：
- V4 {& ^' U3 C: c8 f
4 H' K# J8 q- H. m; L
' z9 ^$ h  |9 _; k/ X反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享