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

若枫

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

1. int  EQ_is_equal (double s, double t);
   6 `2 O+ Z4 o4 q5 U; v: G4 c9 @; p
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);
   - {% q  |9 Q# h( l4 _
5. int  EQ_is_lt (double s, double t);
   $ ?0 g* H- y7 _
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   : C7 Q' g) b$ C- ]# R/ h+ L( V
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    . J4 y6 k. f8 I+ s/ G- h1 ]
13. //#=============================================================
    
14. double Check360 ( double angle );
    + C$ i) h0 i2 Q* w6 i/ \
15. //#=============================================================
    
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    9 e. z7 {) Q" d3 f3 g$ T
17. //#=============================================================

复制代码

# B7 X6 ]4 M( {$ n2 w( r( O! }7 |以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   
2. 
   4 z$ W4 q) F/ s! n. o
3. {
   
4. 
   $ `5 {7 V) z. F1 j
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   
6. 
   + ^& V! H* I, I7 E6 U( Q
7. }
   
8. 
   $ ]8 A2 K) j& p) S
9. /***********************************************************************/
   
10. 
    % G1 X# P, K+ @  q8 j$ Z
11. int  EQ_is_ge (double s, double t)
    9 ?; }+ T4 r, [, C$ c4 o
12. 
    
13. {
    
14. 
    + t3 u+ ?: c) K/ v4 x9 ]
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    " P8 A! h! u; F4 Z; H
17. }
    " {7 r- W8 w) G+ a
18. 
    
19. /***********************************************************************/
    0 e5 W+ ?+ h$ a, ]
20. 
    / q+ g& N  l9 N4 G6 }3 `+ _
21. int  EQ_is_gt (double s, double t)
    
22. 
    4 R- _: O4 w$ y. V2 V7 X+ O
23. {
    ' y+ k# h8 _1 l$ f* ^1 i$ w
24. 
    9 [) I/ w. ?7 \: H- }/ D) k
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    / L( ~; W. t$ q, s
26. 
    
27. }
    ( n3 T" [- D4 K  l! U+ b
28. 
    
29. /***********************************************************************/
    + r% J/ b9 u: E3 s, g
30. 
    
31. int  EQ_is_le (double s, double t)
    
32. 
    1 K1 E- r; B. H
33. {
    
34. 
    
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    , b3 i! y) t" S# n! }; F$ `
36. 
    
37. }
    4 q. o- |8 ^# \4 {
38. 
    
39. /***********************************************************************/
    
40. 
    + I+ N* |1 v0 `8 L
41. int  EQ_is_lt (double s, double t)
    : H# }# J' y* H4 M3 ~. x; N+ _7 i
42. 
    3 s/ f6 ]' Y( W* i/ a9 p
43. {
    6 r0 I: Y) c0 m. x( c- l8 X' ^) q' f
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
    ( Y# N! o( j- e( n
47. }
    
48. 
    : X/ b* E2 z7 ~
49. /***********************************************************************/
    5 b$ g0 p- P8 M) M4 t
50. 
    & A0 `) L+ o% W: x
51. int  EQ_is_zero (double s)
    * D, a% L( F% o" l& n& U8 p
52. 
    
53. {
    - I- r2 t* y+ m  i* H2 u/ u; C
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    7 m8 W5 e2 I1 x9 M0 t, k: W
57. }
    $ ?4 T. M* M1 i
58. 
    
59. //=============================================================
    
60. 
    
61. double ARCTAN1 (double y, double x )
    
62. 
    
63. //#=============================================================
    
64. 
    
65. {
    
66. 
    
67.    double ang;
    5 X; Z' Q4 u1 j6 J# ^, F
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    ! G. n1 f+ }* W! w" s% A3 X% C8 @
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    3 Z5 e/ M& n7 z! e) T$ ?
74. 
    % M" s! r5 n4 S; s- W$ m! g/ W
75.    ang=atan2(y,x);
    ! `7 B  q' Y% ~  t2 Q5 B9 N( Y  E8 `
76. 
    
77.    if (ang < 0 ) {
    
78. 
    & D, C* v' c* q, i! L
79.       return(ang + PI*2);
    
80. 
    1 [4 P2 F1 a+ @+ S( _, ?
81.    }
    0 v2 k4 k; ^; H# S5 j- E1 z# u
82. 
    
83.    return(ang);
    
84. 
    8 d2 {( n9 w" J; [; {/ G+ @6 l7 _% b! m
85. }
    7 |% P; _4 J8 j" c
86. 
    
87. //#=============================================================
      k8 h1 y/ B- ]' k4 I6 u+ z! d8 N$ L
88. 
    " m; `6 X6 T8 X/ L" j9 n+ a1 u
89. double ARCTAN2 (double y, double x )
    
90. 
    
91. //#=============================================================
    
92. 
    # V4 \: q! x* W2 A/ |+ A, p
93. {
    
94. 
    
95.    double ang;
    . n( L& m8 Y) E4 x
96. 
    
97.    if (EQ_is_zero(y)) {
    
98. 
    
99.       if (x < 0.0) { return (PI); }
    8 Y' Z* [: d4 R* D0 A/ z0 I3 q- c
100. 
     2 @# L: a& Y  Y" }
101.       return (0.0);
     
102. 
     
103.    }
     ) ]" s4 J& C1 ~2 R1 e) C8 R9 P
104. 
     % y4 J6 Q  I5 `8 }% \/ Y
105.    if (EQ_is_zero(x)) {
     6 ^8 |# |8 a* R7 F4 \
106. 
       j( m+ q% k% d5 e. ^  |
107.       if (y < 0.0) { return(PI*1.5); }
     # ?2 |! P4 k# b- K+ C1 V5 }8 ]
108. 
     
109.       return(PI*.5);
     2 n  n2 b+ L, T' ?
110. 
     
111.    }
     
112. 
     3 M7 `- v4 J! B; ^  B. Y2 ~
113.    ang=atan(y/x);
     
114. 
     " ^8 Y5 e' V  z8 u
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); }
     * k( S' X+ ^: j" M$ \" M
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     2 I8 a+ N9 R3 D( a
120. 
     
121.    return(ang);
     / y! p/ R) E$ w
122. 
     9 {" D: K6 D6 Z0 x7 ^6 }
123. }
     1 M7 H7 T  @) m; n1 L
124. 
     0 r7 E2 k3 }" K0 f
125. //#=============================================================
     
126. 
     ( X: O% |' G: P# `# N% {5 O
127. double CheckConst ( double angle, double constvar  )
     
128. 
     & K: y; ?% s! _$ R& w+ H1 o  ~
129. //#=============================================================
     
130. 
     / o2 W* D* U" H. K( e# H
131. {
     
132. 
     # |8 x6 U- ^: Z+ n/ c
133.    while (angle < -constvar) { angle+=constvar ; }
     
134. 
     : a7 }. C9 n- E* w9 U7 A
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     $ |% N9 ~' g; B1 `8 O8 l
137.    return (angle) ;
     1 ]6 t5 B) k4 X  R  _8 ?
138. 
     9 C2 E3 a% \( I7 q, d: O; d
139. }
     1 |: g: R* y; \' j. O
140. 
     
141. //#=============================================================
     4 t+ r: q  \6 e- K9 }+ y, l
142. 
     ' V/ Z" L+ S5 z+ K3 I
143. double Check360 ( double angle )
     
144. 
     5 E0 S4 v# f( e2 t- m1 p, s
145. //#=============================================================
     
146. 
     
147. {
     ) A5 W$ @, P3 G% U
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     2 k7 u0 X+ F1 ^* ^( Q
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     
153.    return (angle) ;
     
154. 
     1 m" `9 Y1 }2 e3 W4 {
155. }
     
156. 
     . a3 y+ w, T7 y! f* c) F) v
157. //#=============================================================
     
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     : e; y3 |* [" w/ I
160. 
     1 q1 q$ }/ h4 ]9 |
161. //#=============================================================
     & z. G/ s3 m0 l
162. 
     
163. {
     
164. 
     
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     - @& z1 {0 i* _! z% \: ~
166. 
     : V0 V/ F# G2 s+ V# I
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     0 }+ c; ^* E6 b  T, u) Y" b
168. 
     
169.    return (angle) ;
     1 P8 g: k& l# v- [0 M0 S- V0 M
170. 
     
171. }

复制代码

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

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   4 U. C0 D6 R( w+ C+ ]' e6 Z. j# W
2. 
   
3.          j=0.; B1=0.; B0=0.;
   9 d4 M1 E6 }; u
4. 
   
5.           if (EQ_is_ge(i,0.)) {
   . z0 ^0 S- c6 }2 k6 M
6. 
   ! v) n  z) C- {2 F8 c
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   + V2 C- F& U/ |5 s3 t
8. 
   
9.           }
   ; y7 U7 Q% Y% B' a+ O" |
10. 
    ( e; l3 q" [: q2 g4 O. J. @8 M4 I
11.           if (EQ_is_lt(i,0.)) {
    5 {( x2 x4 a. a# p+ E: I
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    , M; `$ U0 T; P, s
14. 
      N. u- f$ s. a8 p
15.                 B0=atan(i/k); B1=B0+PI ;
    , |; n) S7 S) Y/ B8 }' S' k
16. 
    
17.              } else {
    * {/ c4 C$ R0 j  K+ ^! a
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    / W' O& A$ q' j- I
20. 
    + U* e$ M7 }& ~4 x4 j
21.               B1=2.*PI+B0 ;
    0 q) L$ R% U1 b5 D, o. T
22. 
    
23.              }
    ) Z/ B9 B9 n( F) P% _
24. 
    7 j1 h0 O, M) U, T6 i. H
25.           }
    6 h1 Q0 Y4 F& z4 w+ K5 G% x
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    8 n5 q& ?+ A: A  p4 {
28. 
    5 P; F) R8 P, W% ^
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    0 X/ n4 d# y& g" i: Y5 N: [: T
30. 
    ' L1 s% r9 p6 R7 U" N
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    
32. 
    
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

! i) H5 [" u, J' e) G通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。

0 ^/ j0 ?5 P9 `# ?( v" y- W, n! _
2 I0 n# U6 ^# a6 i" f7 \- i测试结果：
; X6 H1 D  L, Y# e' f2 N

反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享