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);
   1 `3 N" f8 n; i' C
4. int  EQ_is_le (double s, double t);
   
5. int  EQ_is_lt (double s, double t);
   5 Q* V; }& h1 F2 H' G) e
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   
8. double ARCTAN1 (double y, double x );
   $ ], G5 r. [  [# z7 m, u
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    2 f# `' D  e7 J4 a% Y0 \
12. double CheckConst ( double angle, double constvar  );
    : D  _6 {2 n1 \4 I% v
13. //#=============================================================
    * _; I! V8 G& `: w- A
14. double Check360 ( double angle );
    " j9 n9 P. ^# I
15. //#=============================================================
    ) x  f7 [# w7 m) Q
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    , ?( L8 _3 {9 U7 n
17. //#=============================================================

复制代码

7 u1 Q" U* `! J8 ^; h以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   
2. 
   
3. {
   
4. 
   ; j' m$ |7 s$ A9 V
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   
6. 
   
7. }
   " j  R7 v  m3 d; {5 S
8. 
   8 ~# p$ }; ?* r
9. /***********************************************************************/
   % ?/ F! S* a* Z, j! L
10. 
    + Z0 g! z* l; v( y5 G6 j! ~
11. int  EQ_is_ge (double s, double t)
    ! j6 T( Q4 A/ S" Z2 |( n  c
12. 
    
13. {
    
14. 
    ) T( |" @% x! A# ^
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    $ s6 V4 u9 N* A% q; e2 C. X- C
16. 
    
17. }
    + A6 c2 ^! j# s( Q) S) I9 a
18. 
    
19. /***********************************************************************/
    : `% o0 M. O: n8 l- ]& W6 l% H
20. 
    ' @2 |  c! g2 t$ n
21. int  EQ_is_gt (double s, double t)
    
22. 
    
23. {
    
24. 
    6 ~; `8 r# i" @
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    
27. }
    
28. 
    
29. /***********************************************************************/
    
30. 
    
31. int  EQ_is_le (double s, double t)
    7 D8 C) }& l/ W- G, [" m+ F
32. 
    
33. {
    / k- j* M% d% g) T3 y
34. 
    
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    
37. }
    
38. 
    , w9 ^, A) g4 Y! W4 U1 b
39. /***********************************************************************/
    
40. 
    $ w- G' }& i) I
41. int  EQ_is_lt (double s, double t)
    - I) k( _* @. s) n2 t: D' K
42. 
    ( u% _  J% f# Z% w
43. {
    8 e9 H0 e, a0 p1 X& a" l# _$ z, `
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    ) n' a6 Z/ N* ?% ?( J. L. ~0 P! R
46. 
    
47. }
      g+ X1 i; H6 }% l5 I
48. 
    
49. /***********************************************************************/
    : U. o5 S. j: D6 N0 Y2 G
50. 
    
51. int  EQ_is_zero (double s)
    
52. 
    
53. {
    & g- M0 W% [! B" b* q' K: M
54. 
    % U3 S0 C5 S2 i, o! F% j9 [& j
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    4 A1 b1 ^' j  v9 k% C! n6 i
56. 
    
57. }
    1 r( x' k1 F3 z% [2 R! `2 m- F) X
58. 
    1 b1 Z" q/ a1 k. h
59. //=============================================================
    3 }1 m' |; k: C, [) o6 m6 G
60. 
    8 y( g! G# w) _) T" N
61. double ARCTAN1 (double y, double x )
      A9 K; D1 F+ |' F. E
62. 
    
63. //#=============================================================
    
64. 
    
65. {
    0 f* i7 |0 g0 X8 Q
66. 
      P9 a  s8 ^/ B, L5 K* h
67.    double ang;
    " X0 N) T" B! M3 P
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    0 C# c, ^; \( Y/ j; T7 I' V
70. 
    - L! F: g$ D0 p3 d, V% n
71.    if (EQ_is_zero(x)) { x=0; }
    , H2 n- q. b8 ^+ K2 b
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    : \# X: Y* m! D5 {+ Z
74. 
    
75.    ang=atan2(y,x);
    
76. 
    9 X5 z0 `+ n: D! b4 r, N4 t
77.    if (ang < 0 ) {
    8 H+ s3 ^  S& b; M/ a6 a
78. 
    
79.       return(ang + PI*2);
    
80. 
    ; R5 U5 Q* y4 [/ C7 t& j
81.    }
    
82. 
    
83.    return(ang);
    - ~( O, F9 m: }7 d; A9 m
84. 
    
85. }
    
86. 
    
87. //#=============================================================
    - k4 r- H  z" Z1 O. b# Z
88. 
    
89. double ARCTAN2 (double y, double x )
    % G: k* v, i' W4 Q
90. 
    " b/ ]3 e$ {8 J7 o
91. //#=============================================================
    
92. 
    ' m- M' _0 \  K  W* r( D0 U
93. {
    2 P4 q$ {6 F/ [/ ]
94. 
    * H: L, q/ U% g
95.    double ang;
    4 |8 G9 z5 [; l3 u. V
96. 
    / t' k- F, q7 a! P  t3 p
97.    if (EQ_is_zero(y)) {
    
98. 
    8 d9 b4 u& V7 N1 }  \* d
99.       if (x < 0.0) { return (PI); }
    0 x; y' _) ]+ R0 U# F7 g
100. 
     : n6 I4 C' ]8 ?  g+ @; V/ X# f+ X
101.       return (0.0);
     - W7 n/ Z" a/ d0 h7 @. f
102. 
     
103.    }
     + x0 f( G% q$ z/ j0 W1 [; U) y
104. 
     
105.    if (EQ_is_zero(x)) {
     5 m/ i& t- g/ K3 E  l; v9 O6 v
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     
109.       return(PI*.5);
     
110. 
     
111.    }
     8 l" S+ B: @' \! d' l
112. 
     9 }: |! o7 }4 J. l3 L1 }
113.    ang=atan(y/x);
     9 u1 V0 g) r- T7 t( i! K* [
114. 
     . n0 u4 f- t0 Z2 S4 h: P, b
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     5 s* S! U9 ?+ v
116. 
     " s/ B" t0 F, g' A) \
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     * b2 l0 u$ ^% c% Q% i; x+ D
120. 
     
121.    return(ang);
     8 Y& b  _3 {% J3 a
122. 
     * N1 B3 F& p# L! K5 X. u' i
123. }
     % N2 \2 A7 Y/ |1 K5 V9 M& d- D
124. 
     
125. //#=============================================================
     
126. 
     ' ]- ]1 T8 [: Y: ~& `
127. double CheckConst ( double angle, double constvar  )
     6 ?+ s  ^& ~* I6 `$ n* r3 z) g
128. 
     2 O' C& g2 M, f2 H  ~; l
129. //#=============================================================
     
130. 
     ' b0 r4 C0 P7 d8 f/ W, K3 \5 y
131. {
     
132. 
     " K. k6 p8 o4 p6 H3 Y) s
133.    while (angle < -constvar) { angle+=constvar ; }
     * X& O( Q2 L% W  n7 J: D
134. 
     * ?/ G7 p9 z8 o+ x; k2 E
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     
138. 
     0 X" c) U' S1 Q: L( K' j
139. }
     : `9 x. O9 ~# b
140. 
     
141. //#=============================================================
     9 e* F+ J* C2 m8 z# i1 x
142. 
     9 j7 d* z0 J1 d' ^6 R
143. double Check360 ( double angle )
     
144. 
     
145. //#=============================================================
     9 X" h# {) j) L+ Y* q. n
146. 
       a- G. D  Z/ b% T6 O
147. {
     
148. 
       e. z+ k( K) Q) {
149.    while (angle < -360.) { angle+=360. ; }
     - ^5 w7 X% y. Z# m% {
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     
153.    return (angle) ;
     4 T" |9 Y6 Y+ [' Q7 {- k5 F
154. 
     2 m8 u  f& F7 _' E! ^! U- k
155. }
     6 e4 ^/ N8 b& A9 k: _2 J( z
156. 
     
157. //#=============================================================
     / `$ a6 @: q" F$ Z- t+ Y& p
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     : m1 t- s+ k( W. L) y
161. //#=============================================================
     3 z0 J; @( Z. s; {' [
162. 
     4 }& f( M0 E# O
163. {
     ; h! J; M( h; z6 h; L- M
164. 
     & ^* b4 u" [* L( B
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     
166. 
     4 H& o# V/ k* k8 J6 |# v1 O
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     
169.    return (angle) ;
     3 g( x3 V8 P5 a
170. 
     0 L4 P; h/ m4 f2 H* h# O2 ~+ J
171. }

复制代码

+ Z6 _2 y9 A+ V2 S以下为摇篮5轴计算过程代码

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   
2. 
   
3.          j=0.; B1=0.; B0=0.;
   
4. 
   
5.           if (EQ_is_ge(i,0.)) {
   
6. 
   1 Y0 F' D/ a  h- g4 M& ^3 g) j
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   
8. 
   - x4 L  P/ V0 _6 c" V& I$ c
9.           }
   " R8 A3 c1 }6 t1 y) N
10. 
    
11.           if (EQ_is_lt(i,0.)) {
    4 E+ A$ p3 {2 B! j& ?7 e
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    0 W9 D+ k3 s% X: d) t1 I. G8 g
14. 
    9 j& V# Y9 [5 F
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    
17.              } else {
    ) k! ~" |) w4 p  f9 [8 W
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    
21.               B1=2.*PI+B0 ;
    
22. 
    
23.              }
    
24. 
    
25.           }
    ) {  x1 |$ B' D; W$ H- E
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    
28. 
    
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    5 L* O/ W( [' A, e2 Q' u! `$ b: x
30. 
    ' ^3 O- ^0 g/ H9 a4 d7 n- x- e
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    * b; Z) C9 T4 K4 o& \( p
32. 
    
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
, C+ S- }' y' @0 p/ h( B
6 O( G: H" [7 V$ W
9 |0 Q( W  S( h测试结果：


6 F3 F6 j( O* \; v" F( H反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享