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

若枫

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

1. int  EQ_is_equal (double s, double t);
   
2. int  EQ_is_ge (double s, double t);
   : m' D  C% Q: {& b
3. int  EQ_is_gt (double s, double t);
   1 k9 }  I; R6 T, }! Y
4. int  EQ_is_le (double s, double t);
   - _; x; [+ G  f1 j8 m6 o
5. int  EQ_is_lt (double s, double t);
   * J: R. K% p% x- r9 F9 M- y! e- Y/ L
6. int  EQ_is_zero (double s);
   8 \. z3 \0 S2 l9 d
7. //=============================================================
   
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    6 i1 i: v; c9 {7 Z" }: H
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    
14. double Check360 ( double angle );
    + R9 _( ]$ R9 k  Q0 t7 r% v' H
15. //#=============================================================
    
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    
17. //#=============================================================

复制代码

. H7 E9 s* ?5 ^# @以下为部分源代码，用于判断，计算角度等
) Q, L; Z" M, ^0 Q8 |8 f

1. int  EQ_is_equal (double s, double t)
   - p+ m9 z2 ]* ?# x8 u+ }+ O
2. 
   8 C5 C" e3 g9 i" I
3. {
   
4. 
   & B, C! d2 e1 X# B
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   
6. 
   
7. }
   
8. 
   
9. /***********************************************************************/
   - A# z: b% s5 {
10. 
    
11. int  EQ_is_ge (double s, double t)
    
12. 
    
13. {
    
14. 
    4 q5 v8 G$ `& F" |7 w* R2 y1 I
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    . @6 i* z9 J$ H9 \; Y2 g; I
17. }
    ) F& _( A' N, _$ l# r5 m4 S- s
18. 
    
19. /***********************************************************************/
    
20. 
    
21. int  EQ_is_gt (double s, double t)
    ) E; K8 k$ ?" F: }2 I5 c  r  i
22. 
    $ s" N5 v! Z& `
23. {
    
24. 
    $ f/ _( h# }: b/ Q
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    + u3 z+ o# E5 o$ a+ ~2 D
26. 
    
27. }
    7 }" V' U4 \6 C. z6 K- }
28. 
    , \  N: T# \. G* W/ c# U  q+ S
29. /***********************************************************************/
    3 l# s; r- K# a3 X  p( }
30. 
    ) T7 ~% C: {& T) c* C9 M
31. int  EQ_is_le (double s, double t)
    8 M" o+ k# z' _1 c, D( ?- s. K- b
32. 
    
33. {
    
34. 
    3 c& M: W4 \0 M' S" I( a# ^
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    7 Y/ r8 U3 g  x" [/ K
36. 
    2 n0 p8 v3 r- k& _! W! c
37. }
    
38. 
    - b5 y5 T% J5 P1 _$ `- t
39. /***********************************************************************/
    ) m. b6 ^5 I" g& L$ X+ i
40. 
    ! P4 b! t2 m2 j$ S2 z# h" b' G( |
41. int  EQ_is_lt (double s, double t)
    + N* Y+ [( w+ x9 m
42. 
    
43. {
    
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
    # r6 r$ j$ G& U+ Z9 f( X
47. }
    
48. 
    
49. /***********************************************************************/
    + S4 r8 t4 |; _7 t3 I
50. 
    & t! V7 {! n6 U1 U. m/ {
51. int  EQ_is_zero (double s)
    
52. 
    ! Y) A# e" P* o+ S9 {
53. {
    " P9 B9 V# @; _2 v6 l8 D: w- P% t
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    
57. }
    
58. 
    
59. //=============================================================
    
60. 
    ) Z3 x8 G' \/ j3 L- _9 F& Z
61. double ARCTAN1 (double y, double x )
    ' L: t- q( P0 g. \" l* ~0 q
62. 
    
63. //#=============================================================
    
64. 
    
65. {
    
66. 
    
67.    double ang;
    1 }1 N  Z, W4 ]) z7 i/ F$ ?
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    * Z9 o8 w: r3 S* E. w& T6 k
70. 
    ( r  \9 ]* X! u6 R1 G: k; i
71.    if (EQ_is_zero(x)) { x=0; }
    
72. 
    4 _9 H9 ~3 ^  }* w' ~0 Z* b8 v- i
73.    if (y == 0 && x == 0) { return(0); }
    
74. 
    : z" {0 ~* A/ z1 U; w: V5 u9 D, z& z
75.    ang=atan2(y,x);
    
76. 
    
77.    if (ang < 0 ) {
    
78. 
    ' {% V9 I$ u, p3 A; Q( I
79.       return(ang + PI*2);
    
80. 
    
81.    }
    
82. 
    
83.    return(ang);
    
84. 
    / n* f/ h, c" l8 n
85. }
    . w7 ]+ Z* K5 x$ ~+ I; Q; F1 n1 A. j
86. 
    , W7 }: S& R- |! x; b
87. //#=============================================================
    # X) I( E2 S5 X4 c" N% V- X
88. 
    6 [# T; v3 T* c
89. double ARCTAN2 (double y, double x )
    & W; t  \1 O- L4 M- b5 R0 L
90. 
    * e5 B6 [4 L2 O, }7 N% P# T
91. //#=============================================================
    
92. 
    ! j5 U' V+ V2 X& C
93. {
    
94. 
      X; l6 y, X, l9 q1 X* T& O3 s
95.    double ang;
    ( X& u  O. U  `, \/ J3 G3 @. y) G& F
96. 
    
97.    if (EQ_is_zero(y)) {
    # C( C2 f$ g$ ]: h! [% [# C, G/ u
98. 
    
99.       if (x < 0.0) { return (PI); }
    . a4 r; X- r- Q3 q7 G$ R
100. 
     4 P4 S& \1 U, i0 t; Y: Y5 d
101.       return (0.0);
     ) ]  x" a- f3 @- G0 W9 \
102. 
     
103.    }
     
104. 
     
105.    if (EQ_is_zero(x)) {
     2 h* i8 b! N+ s- @# b; n
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     3 y& ]& `$ c- _( X
108. 
     
109.       return(PI*.5);
     
110. 
     
111.    }
     7 |( B# q* v* n; Z6 z& z
112. 
     
113.    ang=atan(y/x);
     * Y6 ~& M9 ~+ }  ~* |
114. 
     
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     7 c: A8 |9 w  u1 Z
116. 
     & Y( a5 z" ~* }& G$ x& S; X
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     
121.    return(ang);
     
122. 
     9 u' S5 N( `2 H5 n
123. }
     
124. 
     
125. //#=============================================================
     $ z9 U. }% p& {5 l- a, }# B
126. 
     
127. double CheckConst ( double angle, double constvar  )
     
128. 
     - J1 ?0 M& i5 y" d4 q, \+ I$ q
129. //#=============================================================
     7 `6 p: p% q7 \) [7 u1 q& u
130. 
     , d9 B6 k( ?2 n
131. {
     0 H$ s, u4 Z7 E9 x4 A2 j( [  {% z
132. 
     . r( \* ^  B3 z3 L$ N/ h
133.    while (angle < -constvar) { angle+=constvar ; }
     
134. 
     ; C4 ]4 W7 z: Q. o+ Z7 D( J5 _
135.    while (angle >= constvar) { angle-=constvar ; }
     0 W; I- J4 a6 Y( Y1 O8 s- h0 f
136. 
     " |: Y( K# [$ T3 U2 ^; ~% v
137.    return (angle) ;
     0 D% L$ r' @/ E
138. 
     2 {) @8 ~! a  D. l$ f) @
139. }
     , ^6 ~0 ?+ |  |6 ]
140. 
     : [* D" C! q4 j7 a$ ^/ X: }
141. //#=============================================================
     / ~0 N5 J* o( D- p
142. 
     
143. double Check360 ( double angle )
     & C$ Q* k9 [% j
144. 
     
145. //#=============================================================
     9 L1 l0 E6 |$ D: V7 P
146. 
     
147. {
     
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     % s" k7 ]/ K+ F, `( c
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     
153.    return (angle) ;
     7 V- N& ?( K9 n, b! m
154. 
     
155. }
     1 z+ n0 U0 @, v9 b  x
156. 
     & u2 b- |9 o7 F+ v3 W
157. //#=============================================================
     " h, k6 k/ q5 @0 X
158. 
     ) C, N/ j4 G; p$ Q5 g0 U
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     0 H; [; B2 X! E; h. N3 X* p8 |
160. 
     
161. //#=============================================================
     ) A3 K0 Q6 ?" w( j
162. 
     ' j, ?( e" |1 N6 L8 G
163. {
     
164. 
     
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     - D' `  J; j/ p. Z- U3 z
166. 
     0 v, x3 P$ x8 ^# ~
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     
169.    return (angle) ;
     
170. 
     5 |, k6 b& E% Z
171. }

复制代码

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

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   ( U  J$ x( j0 I" G! P/ X) Q
2. 
   
3.          j=0.; B1=0.; B0=0.;
   
4. 
   
5.           if (EQ_is_ge(i,0.)) {
   ( L' M" o- o& _4 R; U
6. 
   
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   
8. 
   
9.           }
   
10. 
    7 `: [5 x0 G1 W; M+ N
11.           if (EQ_is_lt(i,0.)) {
    
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    5 H2 \( G. W! h; f
14. 
    ! J5 G, n, W8 T; A
15.                 B0=atan(i/k); B1=B0+PI ;
    * ^" P2 M6 [8 Y5 q4 o2 v* J
16. 
    * ?& {  _: k" `: o
17.              } else {
    - R- K3 c) J7 |. _! k; n' W
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    1 Z* M1 O  C0 [8 z* p: x/ r8 S
20. 
    
21.               B1=2.*PI+B0 ;
    6 Q9 |2 g! {1 J  c
22. 
    
23.              }
    ) r5 y( j$ w+ u2 q! `7 H
24. 
    & J0 G3 p! [1 Y) M; i" ~# Q4 v
25.           }
    ' o5 U% l2 X$ r1 S# q* X; {# u
26. 
    ! h6 {* }& z8 f# Y: m1 @! b
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    ( _; t6 B$ N, C$ K7 N/ r
28. 
    ! y3 d- ?1 Y( e/ \: h
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    / D2 W* V5 w! g2 h1 C
30. 
    0 L3 Y2 f& U5 C* B
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    
32. 
    7 v, z+ x$ c2 R, h/ ?7 p3 X1 i
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
6 j0 ]: D3 Z' z3 U

) t  u& f( {7 r! d: C测试结果：
7 z* y' A- c, T' Y  e
! v* S- x  \: M0 ~. @4 r
反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享