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

若枫

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

1. int  EQ_is_equal (double s, double t);
   " K4 K6 i) Q  T. q9 L4 H& T5 \
2. int  EQ_is_ge (double s, double t);
   " D4 _9 U) c- G# U5 }6 v7 J
3. int  EQ_is_gt (double s, double t);
   
4. int  EQ_is_le (double s, double t);
   ' Q; I' N) Z- f' D* y# W- P
5. int  EQ_is_lt (double s, double t);
   
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   , n( e6 K9 E  @. O2 L
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   ) z. {  P% `9 s& ~" k
10. double ARCTAN2 (double y, double x );
    3 r, Z' K1 U. X: l9 Q
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    - \6 `$ b4 F% S0 g
13. //#=============================================================
    
14. double Check360 ( double angle );
    # i* s0 W( n# R
15. //#=============================================================
    ) h' B% b  l9 b- E- K! l2 m
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    : i" Q- q4 \8 M4 O2 `6 q. H
17. //#=============================================================

复制代码

以下为部分源代码，用于判断，计算角度等
# P) f8 i( z* z  m3 @

1. int  EQ_is_equal (double s, double t)
   . x& G4 q  ?0 K. ]: F9 O3 S
2. 
   
3. {
   
4. 
   * i& [6 b1 o4 ]1 K1 z7 i; p4 F
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   
6. 
   
7. }
   7 G  N- P. Q' `' P* z
8. 
   
9. /***********************************************************************/
   
10. 
    0 ~7 C% L( R( r6 R
11. int  EQ_is_ge (double s, double t)
    : o! i8 i- a; X
12. 
    6 w7 H7 _0 D: n7 l) [. |
13. {
    1 C1 ^" c$ Y$ _' r+ S' t
14. 
    5 K2 U6 W) T9 z0 Q( u: B, w
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    3 ^3 B% e1 o/ ?1 F8 j# v+ P
17. }
    
18. 
    
19. /***********************************************************************/
    2 p0 f  l5 f: ^
20. 
    - O" q/ T& K" f4 k8 s6 D' x
21. int  EQ_is_gt (double s, double t)
    
22. 
    
23. {
    
24. 
    8 b  _. q, c1 `* I
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    % G: i8 g3 }1 z2 V+ o, ?
26. 
    ! X' d+ W7 R9 M1 l0 y) {
27. }
    : W( A. Z7 K5 T7 t
28. 
    
29. /***********************************************************************/
    
30. 
    9 {" s* r' J# j' V4 k- ]
31. int  EQ_is_le (double s, double t)
    2 Z$ l* B/ N" f, W, |2 L" I
32. 
    
33. {
    # }0 Q8 a9 B3 n: N7 g
34. 
    
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    # b& Z8 n2 n' C& V$ c* u2 B- M
36. 
    
37. }
    
38. 
    & ^$ V- x1 n0 k" Z. Q
39. /***********************************************************************/
    
40. 
    " |9 d. y+ g( |5 z) g% V7 y% ~: q/ o# `
41. int  EQ_is_lt (double s, double t)
    8 a& S+ U6 ~3 p
42. 
    9 C5 n- v0 N7 T' B
43. {
    # [( C8 A( ~7 I2 [, N* g; V6 R
44. 
    ) |5 P0 @$ R6 o: n2 p3 {; `* ?
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
    
47. }
    
48. 
    $ e2 }' o' E' ]6 J) |; H1 o8 {
49. /***********************************************************************/
    
50. 
    
51. int  EQ_is_zero (double s)
    
52. 
    
53. {
    
54. 
    0 m) _9 e6 p! Q
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    2 N; w$ j; s, k* Q( |4 _( {9 h( O$ b
56. 
    
57. }
    
58. 
    
59. //=============================================================
    
60. 
      b& a% ~0 v/ o' b$ Z& I2 q
61. double ARCTAN1 (double y, double x )
    
62. 
    ; A8 q5 ]) p$ S+ i/ r5 B- N
63. //#=============================================================
    
64. 
    , d& j+ L4 Z" L+ ^, }7 Y0 _) V
65. {
    9 N1 k8 P2 W1 N+ k3 f
66. 
    ( R) Y& o1 T( k2 M: o7 B
67.    double ang;
    
68. 
    , \: Z8 f4 F6 M1 E/ @# u1 \- R
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    1 P! ]& [3 x/ l1 J6 l
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    
74. 
    % c9 F' d/ p4 o; A) k/ x8 G
75.    ang=atan2(y,x);
    % s% A8 Y2 ^/ O
76. 
    
77.    if (ang < 0 ) {
    2 s- t! b! E" j$ e
78. 
    
79.       return(ang + PI*2);
    / l+ b- Y9 q5 C. p) N
80. 
    
81.    }
    . s7 v6 `6 e! B8 D# p# z
82. 
    
83.    return(ang);
    
84. 
    
85. }
    # w8 X2 O9 i* z
86. 
    
87. //#=============================================================
    9 O" w  w0 N* ^9 C3 y' K$ O
88. 
    # t* T; I* S: P7 j1 K. `& u
89. double ARCTAN2 (double y, double x )
    
90. 
    
91. //#=============================================================
    
92. 
    
93. {
    ' d: {+ A, r0 i3 g4 |! r
94. 
    
95.    double ang;
    
96. 
    $ Y' x9 x# {6 u+ q9 j
97.    if (EQ_is_zero(y)) {
    
98. 
    ) Y$ z% w1 [9 @9 E
99.       if (x < 0.0) { return (PI); }
    
100. 
     
101.       return (0.0);
     3 E1 F3 t) U: _+ X& L$ y. @
102. 
     9 |: ~& o* K0 \. R4 S# J8 E/ [
103.    }
     
104. 
     
105.    if (EQ_is_zero(x)) {
     9 ~' D4 S6 L1 n! {& V! k7 x- E4 [
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     8 e0 t$ Q' V$ S8 n
109.       return(PI*.5);
     
110. 
     
111.    }
     
112. 
     
113.    ang=atan(y/x);
     ( D( Z* Q4 S$ M/ F9 N" h& D. K! b
114. 
     
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     ( _8 l& R( @1 L
116. 
     
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     
118. 
     + f1 L( \3 \3 b, d( `4 q- `. b
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     4 y/ d; n8 F& t' Z; V8 e+ f
121.    return(ang);
     
122. 
     
123. }
     $ I' M$ S  Z7 y% ~0 w. g- V1 x
124. 
     
125. //#=============================================================
     
126. 
     9 \: A6 L! ^9 M5 D# a2 |* R
127. double CheckConst ( double angle, double constvar  )
     
128. 
     ( |# i9 `$ J& g* t4 H
129. //#=============================================================
     0 j! S( D! z6 r4 _- ?. g
130. 
     ( A( D* N: I+ Z$ T0 u7 H) S; r
131. {
     
132. 
     
133.    while (angle < -constvar) { angle+=constvar ; }
     
134. 
     ' O. i5 a" r$ X: ]- Y
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     
138. 
     
139. }
     & \7 U9 h" F3 k, r1 g5 G" w( K
140. 
     
141. //#=============================================================
     7 z1 d6 b- r0 @2 S/ d
142. 
     2 z- l+ q. `9 O' \0 \- f" w
143. double Check360 ( double angle )
     
144. 
     
145. //#=============================================================
     
146. 
     9 b) G9 r) w6 j. O4 a9 K: R
147. {
     $ c4 A& y. O# t- R; [+ d2 @
148. 
     1 {- L2 q% ]: k9 d5 }
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
     $ [% P2 R  z9 l
152. 
       c3 N7 {5 i& }5 p' E/ _5 x& L
153.    return (angle) ;
     1 A0 s, ^2 v% \9 I& v* {5 C8 z
154. 
     
155. }
     
156. 
     8 h  N, H2 l0 j" X$ X
157. //#=============================================================
     2 U* `; d% Z' n5 F: D) M  L
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     / x% j6 n6 g) m" t
160. 
     
161. //#=============================================================
     
162. 
     ! O6 z) W. L; M: I" s
163. {
     ; W" p5 k4 Z8 k% V+ A% B
164. 
     
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     
166. 
     8 ]# e% K, S7 d4 o( J
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     
169.    return (angle) ;
     
170. 
     9 k/ D1 c5 G7 e5 N/ k( w6 F- `
171. }

复制代码

- f# w5 Y9 h! v' B7 w: Z, d! b以下为摇篮5轴计算过程代码

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   / G5 W+ p* i, ^" g- N+ j9 {
2. 
   3 N. z' U; _2 D. ]1 J* q  u2 D3 B( K- X
3.          j=0.; B1=0.; B0=0.;
   
4. 
   
5.           if (EQ_is_ge(i,0.)) {
   : \8 z# H$ p1 Z& ^! I
6. 
   ! ]) K) r9 K, k5 d* {! r" |
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   , p. w4 M1 M3 [( h, Z1 |
8. 
   % v& m; l4 E( N" G; C! n
9.           }
   ' N$ D/ p' Y% z! b' G
10. 
    ' g0 p8 j+ x; |+ V  f( k* I
11.           if (EQ_is_lt(i,0.)) {
    . @+ v3 F$ i1 {2 F+ U2 i
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    
14. 
    $ X: k1 f: e; ~: r" S
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    6 N) j* C: S: j3 Y5 n! F" d
17.              } else {
    0 B; [- f1 I" W% ^/ N
18. 
    % y7 F2 A4 j# z# h; U/ E$ U$ p! w
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    " ]8 p0 {7 P' a" P6 h2 p+ h
20. 
    / z4 X- Z6 \, v  N: _, c
21.               B1=2.*PI+B0 ;
    2 J) i& G( T: v  p1 U7 a& p
22. 
    % v2 d$ P. w4 V% x, J
23.              }
    7 H! j! F& C; v, z$ A. D9 v
24. 
    
25.           }
    
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    ! \! m0 I: `( x1 z& {: J3 K
28. 
    
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    
30. 
    + S, {$ b8 R: Z# I! v+ w
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    ) |; V- F) t5 e: ~: B$ i% [+ ]
32. 
    
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

6 p# _4 r9 ?+ f6 D) v通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
) m/ Z1 }- V/ Z
2 o! J3 @8 Q2 ~1 B" S4 G
测试结果：
7 c8 q1 b* g7 b; p% q7 A7 y

反向测试结果

yucammayco

谢谢分享