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

若枫

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

1. int  EQ_is_equal (double s, double t);
   
2. int  EQ_is_ge (double s, double t);
   8 p" I9 w0 s  ~6 D$ [% s8 {0 v
3. int  EQ_is_gt (double s, double t);
   1 W% l2 |  B  L4 @3 N8 c
4. int  EQ_is_le (double s, double t);
   
5. int  EQ_is_lt (double s, double t);
   
6. int  EQ_is_zero (double s);
   . h. ~1 y; K& v
7. //=============================================================
   ; K1 _/ E9 e% g1 F. B" s
8. double ARCTAN1 (double y, double x );
   3 ?/ ?. Q, n2 c
9. //#=============================================================
   5 n4 e5 y6 J: o7 H4 |5 S
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    % G2 h& M% D: W, O3 C  r
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    4 P2 k) K: |4 L0 Q, K2 T3 }+ l
14. double Check360 ( double angle );
    
15. //#=============================================================
    
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    
17. //#=============================================================

复制代码

以下为部分源代码，用于判断，计算角度等
+ R" i$ O# [7 L( J

1. int  EQ_is_equal (double s, double t)
   ! l8 n- a: t- f8 H+ I. S5 X2 B$ F4 {  Z
2. 
   3 j* o* c' C6 K& ?* z% s2 Y3 g! W
3. {
   ! V+ G/ ^' \; P; d. P% |: A6 q$ s' h
4. 
   
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   
6. 
   & w# u' x1 A% G- `" w1 ]
7. }
   
8. 
   ; E3 B2 {. ~* y+ t" m4 {! s
9. /***********************************************************************/
   1 x1 z/ t- ^' P- x0 |
10. 
    9 [8 O! B+ G/ l! [8 W, W( J3 H, f
11. int  EQ_is_ge (double s, double t)
    3 [" k7 `  q; R2 v* ~
12. 
    
13. {
    ' @! |+ P* T% R( j, L6 Q- i
14. 
    , m; K3 W6 e2 F
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    ( D6 j- Q( Y- @3 V
17. }
    ( }+ O3 M2 B& v/ }
18. 
    
19. /***********************************************************************/
    
20. 
    
21. int  EQ_is_gt (double s, double t)
    0 ~8 ?) \- K2 n! h
22. 
    
23. {
    , B- ?* P# N' v$ b* t& q
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    ; K. ^2 g) c/ P' b# _
26. 
    
27. }
    . T, `0 d: H0 P  D
28. 
    * u. {' i0 U$ E0 _
29. /***********************************************************************/
    
30. 
    5 `* [# }) z, d: k
31. int  EQ_is_le (double s, double t)
    
32. 
    . b/ w, v; U+ O0 S4 o: ]/ n7 }
33. {
    
34. 
    / `8 H+ v: B, A; R* F) p
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    ) A! [$ M9 s6 Z1 x4 z4 }( I& w
36. 
    
37. }
    
38. 
    
39. /***********************************************************************/
    ; L6 Z( O9 y) U( d/ h0 E
40. 
    
41. int  EQ_is_lt (double s, double t)
    
42. 
    . u% ?' p2 C$ s4 E: ~
43. {
    
44. 
    3 j5 ~$ P  f; H5 p0 F; p
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    2 V& X& w+ j% d5 j/ w6 v
46. 
    # x! c9 H+ p: G
47. }
    
48. 
    
49. /***********************************************************************/
    7 p* {2 s3 ?8 t/ v
50. 
    4 o; _$ ?6 I5 K! V5 @1 L3 y
51. int  EQ_is_zero (double s)
    
52. 
    ! ?' y6 z& Z8 E
53. {
    3 w. s5 y* j) b- c; t/ H
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    1 ~- L( ~' s8 O
57. }
    
58. 
    
59. //=============================================================
    
60. 
    : q0 B1 c2 I- @1 d, E' B
61. double ARCTAN1 (double y, double x )
    : n3 k% ?5 ~' J" @6 r8 t2 h0 A
62. 
    
63. //#=============================================================
    9 S& @/ s4 ]/ r- E4 D7 }2 c5 V' b; t
64. 
    . H8 B# b3 P/ y( I
65. {
    
66. 
    
67.    double ang;
    
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    # y4 T& x& f. \6 j* P' v/ b
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    $ x! c$ I6 u& ]# B7 y6 E3 F. c" P3 {
74. 
    
75.    ang=atan2(y,x);
    
76. 
    * \2 G, q/ c" r" ]! @' {5 \
77.    if (ang < 0 ) {
    4 p6 j: O# p- s" c; G) N8 i# j
78. 
    
79.       return(ang + PI*2);
    . i- b7 c+ a; N7 z8 n# [
80. 
    7 ^+ G( \! U( a  F7 L9 K
81.    }
    
82. 
    
83.    return(ang);
    ( E5 F: r) ^/ f& Y
84. 
    
85. }
    7 c* i7 G# F$ o# @4 B
86. 
    
87. //#=============================================================
    " h: v/ n) S$ Y, ?, v  b9 j3 t
88. 
    
89. double ARCTAN2 (double y, double x )
    
90. 
    8 D, g  d$ w3 b, E
91. //#=============================================================
    3 H5 @( j1 ~) s5 B, l$ z: j
92. 
    % [, a- {  A( N0 _1 m- S
93. {
    
94. 
    : U5 j/ M* H3 j( p
95.    double ang;
    * B5 E+ m5 ^8 n) s7 k& U- W
96. 
    ( ]4 g  c4 q3 Y( p
97.    if (EQ_is_zero(y)) {
    ' Y+ p/ O, ~. }! Q4 c
98. 
    
99.       if (x < 0.0) { return (PI); }
    
100. 
     
101.       return (0.0);
     
102. 
     - s+ T9 Z2 i6 _, _5 J+ V+ ]6 v
103.    }
     
104. 
     
105.    if (EQ_is_zero(x)) {
     
106. 
     $ a2 @( i, H: o5 ?1 x! ?3 a& q
107.       if (y < 0.0) { return(PI*1.5); }
     : W* I7 A- {5 U+ I+ v8 m
108. 
     # [7 R$ P/ ?4 o& m$ t
109.       return(PI*.5);
     " _* C4 r- b9 C% e% }
110. 
     
111.    }
     - [5 S1 O/ |8 N& `' y
112. 
     9 n2 x2 ~4 T5 p9 s" \5 Y  J
113.    ang=atan(y/x);
     8 B3 n$ K; I9 q4 [: [" ~. w& X
114. 
     # g5 V* |" Z. S% @4 x
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     
116. 
     ; w* u$ C  [7 e* ^. m3 a7 n
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     . j& c3 r5 t4 n& p3 A1 C" E
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     
121.    return(ang);
     
122. 
     
123. }
     
124. 
     
125. //#=============================================================
     7 T/ k, U2 b1 C7 J) L8 N
126. 
     
127. double CheckConst ( double angle, double constvar  )
     5 p5 Y$ w# S4 w& O+ |7 _( K
128. 
     
129. //#=============================================================
     
130. 
     
131. {
     
132. 
     7 x; p2 [# ?8 @0 |. G
133.    while (angle < -constvar) { angle+=constvar ; }
     % Y# _+ M. [% x7 i6 N2 G2 s
134. 
     / s# l1 k8 h/ T) \7 ?4 r
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     0 `  t3 n$ y+ i4 ?8 w  \& J% g
138. 
     
139. }
     ; Y$ c$ t1 i! ]
140. 
     / d8 R  V( G1 [0 m, @5 \
141. //#=============================================================
     5 t2 z9 d) P& i
142. 
     % Y0 G" w: T/ m3 \7 T1 d3 b
143. double Check360 ( double angle )
     
144. 
     
145. //#=============================================================
     0 J! w5 V! x2 x& I3 |
146. 
       f( a7 N$ J/ ^$ y2 V, S
147. {
     
148. 
     / A$ ^( j% I! E+ U. i- _$ C, p
149.    while (angle < -360.) { angle+=360. ; }
     ( E2 @, h+ K- X0 Z0 f5 d
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     
153.    return (angle) ;
     
154. 
     
155. }
     - ]6 G: Y; a  ~8 n; I# C( l8 P
156. 
     : C" n* D% ?( x* |# e' q( f( x0 z/ {
157. //#=============================================================
     ; s' c$ N# y! v( ^: O2 w
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     
161. //#=============================================================
     , `& Q' o! b& X" ^7 `: V' {( X
162. 
     3 C3 J+ s% d$ ?0 g+ X5 E
163. {
     ; N) t& q4 N: q
164. 
     
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     
166. 
     ' H& ^1 |% H* Q; i
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     1 e( B3 v% K7 R
168. 
     ) `8 ~, t7 W5 ]; [7 |, L# C" ^; R
169.    return (angle) ;
     ) e0 N& u6 X0 ~$ F
170. 
     
171. }

复制代码

以下为摇篮5轴计算过程代码
( U* A1 h$ x  @6 u* Q

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   2 W0 T; B, O+ g- F6 U
2. 
   
3.          j=0.; B1=0.; B0=0.;
   
4. 
   " t8 `1 B7 E- f) V( N! w4 S) W
5.           if (EQ_is_ge(i,0.)) {
   % o5 G. [  |7 A3 [$ f7 D0 ]
6. 
   1 k; M( W6 V; R- Y) }
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   , G; e2 w, v! x7 {% Z
8. 
   & t) J, ^5 M. `5 e. p, W: s
9.           }
   3 R: B) d$ N* H
10. 
    2 Y) @! Z- q% M7 k
11.           if (EQ_is_lt(i,0.)) {
    & D: h; {: d& r: P' W
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    $ A5 ^3 b% m3 i$ D. b( w
14. 
    ! U5 {1 u/ W* N8 L3 X9 F& B3 j
15.                 B0=atan(i/k); B1=B0+PI ;
    ; S, Y2 x5 l- w  I/ x6 [
16. 
    2 _0 I/ X+ \. x; ]- N: E  X
17.              } else {
    
18. 
      W% @( @! d* e) T& b8 C
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    : m1 O; t6 J4 A/ W
21.               B1=2.*PI+B0 ;
    
22. 
    ! v- W# N! ?. z+ c2 h1 S1 Z1 _
23.              }
    
24. 
    
25.           }
    / Q" \2 I0 n# L3 e
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    . Q$ t2 E  Z- t
28. 
    
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    
30. 
    
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    : j" V% K; Y7 ^7 X( g+ F/ q
32. 
    
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

9 q* j9 b. Z  x0 a通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。

6 G/ J1 k" ]; s4 A. r$ _* l
& U& ]8 f+ _8 |9 f: t8 u6 a$ [测试结果：


反向测试结果
2 a/ D- {9 f- p' {! x' B% t$ h

yucammayco

谢谢分享