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

若枫

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

1. int  EQ_is_equal (double s, double t);
   . k- r( a; S: c5 M" x
2. int  EQ_is_ge (double s, double t);
   " P; M+ y, W+ b" w3 i
3. int  EQ_is_gt (double s, double t);
   2 i" m( s8 R2 @4 e: L
4. int  EQ_is_le (double s, double t);
   
5. int  EQ_is_lt (double s, double t);
   / e  U- W/ @( M
6. int  EQ_is_zero (double s);
   1 a! ?9 M+ I+ v4 V0 H7 B$ h8 a+ K/ Y
7. //=============================================================
   , H* g5 f2 x, }4 q8 o) N8 ~
8. double ARCTAN1 (double y, double x );
   5 p8 c: u# H. d- ]% n% ^4 c, I
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    ; D! j% L& M- G) ~
14. double Check360 ( double angle );
    . O* D5 V$ c" V% d
15. //#=============================================================
      ~! x6 v& ^, B! t& h. _* m
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    ( V& X( y8 A# U1 ]% {
17. //#=============================================================

复制代码

( V' x1 k1 J3 h, S) {! d2 J  `- G) \以下为部分源代码，用于判断，计算角度等
# g; ^$ G% L! i; r: T

1. int  EQ_is_equal (double s, double t)
   
2. 
   6 F2 D/ T5 A! c6 s
3. {
   
4. 
   4 B% L, v' N  b  Q8 A3 R
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   ) ^- \, o, }9 }$ F: E1 _) g+ z, ^
6. 
   
7. }
   " M% h  v# f3 W* a3 W$ U& t
8. 
   
9. /***********************************************************************/
   6 V$ j3 K/ j3 ?' z0 B' _# K
10. 
    ' J/ E# ?0 p/ f+ v+ b
11. int  EQ_is_ge (double s, double t)
    0 C9 D9 `+ y+ o: h( @- ?. r& N. U
12. 
    
13. {
    
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    / s$ \8 e' ]6 P6 h
16. 
    5 R( E* m9 K; J  f1 M8 ^5 b; w" m
17. }
    ' H# y! W; g, D* e" O0 n+ _# k
18. 
    9 I; R* u' c0 p4 p
19. /***********************************************************************/
    4 M# P* i1 j( |8 x7 `
20. 
    4 f. p! O  ?0 C# j/ C( t; E
21. int  EQ_is_gt (double s, double t)
    6 h) |  H4 Z0 t' x! h) z
22. 
    
23. {
    3 t# [: ^0 S) V. i2 g' i( Y
24. 
    8 d" i/ ^1 B$ h7 `( V2 i, U/ N
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    . [: U: ~1 u& e% y6 m/ A
26. 
    . s6 K0 z4 T+ U0 v  G
27. }
    
28. 
    + w7 r5 R, j1 V! j, l
29. /***********************************************************************/
    
30. 
    6 H/ i1 y! G+ L% g
31. int  EQ_is_le (double s, double t)
    & @6 N1 Y8 X) q% V: L( N
32. 
    
33. {
    
34. 
    5 {# N* T; L6 ]+ g, m" C' v. l: K
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    : c. m& D7 L* L+ q/ l& N
37. }
    7 i$ k# z. X) X) ~; u
38. 
    
39. /***********************************************************************/
    
40. 
    
41. int  EQ_is_lt (double s, double t)
    : W4 a! ?5 C+ ^7 T6 h5 }
42. 
    
43. {
    
44. 
    0 ]9 ?; z1 ]/ e$ s
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    , @+ Y; A! s  W0 }+ {
46. 
    ( K' G, V7 ?" C
47. }
    
48. 
    % R& G- X- H; P7 Z& M' w
49. /***********************************************************************/
    
50. 
    0 \( S% V% b! g2 L& _
51. int  EQ_is_zero (double s)
    9 o6 q4 V' E# z  s/ W8 K$ F( s
52. 
    
53. {
    
54. 
    2 u- C7 b  j+ z5 n8 \
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    # H# ^, J* ?" _! e9 e8 l/ {
57. }
    
58. 
    
59. //=============================================================
    
60. 
    
61. double ARCTAN1 (double y, double x )
    ) s! n& ~5 ]3 A/ ~% F/ _8 @1 P
62. 
    : ?) c1 t7 `2 D2 U" x
63. //#=============================================================
    * \. Z, u" }) q4 V
64. 
    
65. {
    . u; h9 r- {9 V  z7 `/ T% D4 ~( W" {
66. 
    
67.    double ang;
    
68. 
    * t2 V+ \; Q- `2 Q/ L! M+ [
69.    if (EQ_is_zero(y)) { y=0; }
    * U5 s5 z6 P3 u1 T6 \6 R
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    1 X) n8 @" i& W& `8 d+ x
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    
74. 
    
75.    ang=atan2(y,x);
    - a* S. x& t% M- b4 g* O/ ?
76. 
    
77.    if (ang < 0 ) {
    - W/ t' X& t3 [) r! t
78. 
    
79.       return(ang + PI*2);
    2 m/ `5 S: A- s4 V
80. 
    ! h* K7 R, y2 c, y% `  s
81.    }
    3 l* _6 {. l7 t! X3 K
82. 
    
83.    return(ang);
    
84. 
    1 `8 k: E' a) {9 L1 N/ p. n: D5 W) T
85. }
    ' X/ w% B6 ^" Q9 D& o! I0 c
86. 
    
87. //#=============================================================
    
88. 
    , t/ `& e& b  r; _# x; L6 A) P
89. double ARCTAN2 (double y, double x )
    
90. 
    / L! h2 X! B$ y/ ~; a9 o
91. //#=============================================================
    5 _0 [% {+ V+ t/ |/ o
92. 
    9 Y6 b! r; ^% \$ q7 k
93. {
    ! B5 ]0 Z: q. r( Q0 A; b6 }, f. g
94. 
    # B# e0 I' p; q
95.    double ang;
    
96. 
    
97.    if (EQ_is_zero(y)) {
    
98. 
    
99.       if (x < 0.0) { return (PI); }
    
100. 
     ; a& _; r5 v* A8 K+ [  v
101.       return (0.0);
     + @; S3 {' _! L( F
102. 
     " \/ Q% w8 ?" o- M) L$ {
103.    }
     ; T7 Z( W( [0 x/ F9 o  d: {
104. 
     
105.    if (EQ_is_zero(x)) {
     
106. 
       P" C1 z, Y$ @# z7 K0 L6 o
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     % X1 N' G! m2 _( E, z
109.       return(PI*.5);
     
110. 
     & |4 u' Z% t- E/ C) `8 `
111.    }
     
112. 
     
113.    ang=atan(y/x);
     + W) {4 N5 E0 i2 Z2 n/ w
114. 
     1 I$ o& C# ~  s% V; @
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); }
     & |6 i1 ]! ^6 L, V
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     
121.    return(ang);
     % K- h9 c9 F# t0 C2 x. i7 X4 e' r( |
122. 
     7 H& O6 u3 q; h) V3 o6 ?! @# D/ x
123. }
     
124. 
     
125. //#=============================================================
     
126. 
     & ?; b# b. x9 E' ], n
127. double CheckConst ( double angle, double constvar  )
     $ F; o" S! Z) l/ g
128. 
     
129. //#=============================================================
     
130. 
     , L3 }3 p# ~! |# T% [
131. {
     
132. 
     
133.    while (angle < -constvar) { angle+=constvar ; }
     & J+ i. C( ~% o* {: s9 V# o
134. 
     , \+ C8 Y$ p6 `3 O- \* ^/ \& q5 H! t
135.    while (angle >= constvar) { angle-=constvar ; }
     0 G) S2 Y! I# t8 X0 W  M
136. 
     
137.    return (angle) ;
     5 _2 R! n! P, z, {8 O2 }! n5 C: @
138. 
     $ ^1 [- |  l1 Z1 F
139. }
     
140. 
     
141. //#=============================================================
     2 s9 Y8 t; c0 y, D# c4 k4 \) I
142. 
     ; v, c0 {' V+ N, k& e. j* m
143. double Check360 ( double angle )
     
144. 
     
145. //#=============================================================
     8 i3 i$ J( _$ d! p, X- c" b! e+ d
146. 
     
147. {
     
148. 
     ( `, T8 l! V* `
149.    while (angle < -360.) { angle+=360. ; }
     3 h: g( r% N  J3 e  H! }% ^/ {
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     
153.    return (angle) ;
     
154. 
     / i# v/ Y6 K! y& R' |. w0 j
155. }
     & h: O( L( s+ v3 B% L* t
156. 
     
157. //#=============================================================
     5 v% U% B& \+ j) {2 g. K. Q
158. 
       ^( z. Z' C! O3 X; u
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     
161. //#=============================================================
     0 l0 i  _9 d9 M
162. 
     
163. {
     4 o& A- E- h2 n+ P- V! B
164. 
     ; l( y5 X1 J  m
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     7 }5 v# n* P3 p; D4 f7 [: t- z9 h
166. 
     * j+ W4 h% Z( V. m2 E! s
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     
169.    return (angle) ;
     
170. 
     6 z9 R- y# V0 q. j3 K* B" f
171. }

复制代码

* N* y# e6 k/ H" q5 [  K以下为摇篮5轴计算过程代码
; V, T* S8 a- [" k

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   
2. 
   
3.          j=0.; B1=0.; B0=0.;
   
4. 
   6 O1 T! }4 @5 P! f! ~+ i. F
5.           if (EQ_is_ge(i,0.)) {
   % `) y5 L% e, Z9 W5 C- Z
6. 
   ' [+ K' R5 [' |+ l, N1 y  |
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   
8. 
     |  q" ]$ K- ?, v$ a1 N( f
9.           }
   
10. 
    
11.           if (EQ_is_lt(i,0.)) {
    
12. 
    % K& x* `  M3 h
13.              if (EQ_is_lt(k,0.)) {
    " J$ n8 h  w$ D' d; n1 y
14. 
    
15.                 B0=atan(i/k); B1=B0+PI ;
    7 ]! C# `1 X( d+ n8 J& `% e
16. 
    
17.              } else {
    
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    
21.               B1=2.*PI+B0 ;
    1 t: T: }3 \3 _
22. 
    
23.              }
    ) j+ C6 k, G; C6 D
24. 
    ! M1 V" }" x8 Z! F; c
25.           }
    " y5 K. C8 F2 P4 K
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    . \! b; N2 U: P- p  ^0 A3 w) o
28. 
    
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    
30. 
    6 `. x! T# p) ]
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    4 ^3 t6 |# b3 p( E* L, ^
32. 
    . ?3 k$ h9 ~% Q  v
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

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

2 m. p( ?% c9 k: o
测试结果：
2 k& g, s0 \" W$ ]& g

  m. y  ]7 q0 b' u: ?* @* e1 ]! k* Z反向测试结果
# s+ m  D1 R. T/ F) Y: U/ |" U

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享