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

若枫

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

1. int  EQ_is_equal (double s, double t);
   ' R* w; b" z- m$ F4 b; n: K
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);
   8 [/ e7 n6 L2 r8 m' f* e5 D
5. int  EQ_is_lt (double s, double t);
   
6. int  EQ_is_zero (double s);
   1 n& `- `! e1 k' t# \7 ^4 u1 ^
7. //=============================================================
   % [0 q! n: E* Z9 R/ N; n3 h
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    4 y1 s$ y' W# ^
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    2 v+ s4 W, C- A) R( [* m
14. double Check360 ( double angle );
    
15. //#=============================================================
    9 F( e% N: e/ \2 K  F  s# u
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    - h! ]2 M' _+ o  U5 V
17. //#=============================================================

复制代码

: y* n! Q, F0 u( P. {7 L以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   
2. 
   2 r) M! x6 F  A) ]
3. {
   0 }4 A0 o$ L$ j+ s" d  j  ~
4. 
   
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   8 |) T2 _! }- o( |
6. 
   ' s/ P& r2 z/ q& {. ]
7. }
   8 m7 o" r8 C3 y" Q
8. 
   : ]' Q8 C. `: I; C, V1 O4 o6 C
9. /***********************************************************************/
   # L3 x8 N  X4 [& x7 ?
10. 
    % u% w$ f) h5 {
11. int  EQ_is_ge (double s, double t)
    
12. 
    $ U+ u2 g3 l0 z3 Q' t; H
13. {
    
14. 
    9 o, M, `0 u/ `
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    
17. }
    4 ]) u0 R* n( ?, U, O: J
18. 
    2 C# B/ D7 p  r; y7 T) V- l) y( R
19. /***********************************************************************/
    & T, [3 m2 z' P% x) {2 W" ?8 y
20. 
    . f' v4 m. J" u5 t
21. int  EQ_is_gt (double s, double t)
    $ v, U" n- q% E& P1 m
22. 
      E) c) E) L8 k: F& b
23. {
    $ r. y6 M1 Y  `/ _8 T/ s7 B. P
24. 
    * `' T- V9 H0 m2 M3 Z% e
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    + p. ?! X6 k8 |, Q: P# L, v: ?# e
26. 
    
27. }
    
28. 
    
29. /***********************************************************************/
    
30. 
    / o6 z, u4 L, D0 X8 ?) {" V& a: _& m
31. int  EQ_is_le (double s, double t)
    5 `' r3 u" F. n6 }3 V5 E6 u& G7 I( k
32. 
    
33. {
    0 d7 L  P- {) H9 c7 H
34. 
    2 t7 }5 @2 x9 z2 E; j
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    ! S. [) @# g- C0 ?( j1 ^! U
36. 
      V4 H/ l) \8 S* d8 R& \# X; W
37. }
    ( g9 y) Q3 C. H( y# k1 |# i
38. 
    0 {* Y% O' L8 G: `8 C
39. /***********************************************************************/
    ; L1 V) T0 }9 ]: t
40. 
    7 M3 |/ h6 ^9 I* S$ R4 f0 B( X
41. int  EQ_is_lt (double s, double t)
    
42. 
    : i$ I% K$ }/ ~3 G" |( B
43. {
    0 z! V7 o- y: J9 z+ f
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
    0 t; ^0 a3 y0 [* u
47. }
    
48. 
    
49. /***********************************************************************/
    
50. 
    
51. int  EQ_is_zero (double s)
    
52. 
    5 i: V3 S0 y3 `, H) t
53. {
    2 y5 J- c# i+ R5 d2 c8 g2 x+ m
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    , i1 p( w- C' h! n5 i. a( N: D' G
56. 
    
57. }
    . m) m0 ]) d$ Q' v# ~: B: g* ]
58. 
    / p8 o- M3 h$ {
59. //=============================================================
    2 J3 b$ i+ `& b5 N  b6 v' ~
60. 
    
61. double ARCTAN1 (double y, double x )
    
62. 
    
63. //#=============================================================
    ' H( @7 _) T) x) r  d
64. 
    & e( _5 R" g" m/ j6 U
65. {
    + g! X3 b8 `; T) t, n
66. 
    
67.    double ang;
    
68. 
    : q2 c% J8 J+ C
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
      O  j+ X' U9 H
71.    if (EQ_is_zero(x)) { x=0; }
    " d+ D' N6 O# ?( I$ N
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    
74. 
    
75.    ang=atan2(y,x);
    
76. 
    - g) u& p3 b) B
77.    if (ang < 0 ) {
    
78. 
    9 m6 T3 I6 A( h; ]9 M0 e
79.       return(ang + PI*2);
    + U" M6 b" O/ e. L" c7 C9 ~
80. 
    ; X( M4 c* o+ x. N! J3 ~
81.    }
    5 o" s1 r5 U% r6 I7 Z
82. 
    6 N8 E. O$ W5 R( T3 c' W. _
83.    return(ang);
    
84. 
    
85. }
    
86. 
    * _0 `( [; B4 `- N. ^9 V5 ]0 \4 U) V
87. //#=============================================================
    
88. 
    ( Z& [1 b/ o) C2 R7 v
89. double ARCTAN2 (double y, double x )
    
90. 
    5 b1 w% v+ f( ]6 ~9 {- j6 i
91. //#=============================================================
    
92. 
    2 o8 u9 y7 t. j& w
93. {
    
94. 
    
95.    double ang;
    + e- V) W& E' {5 D3 S, `
96. 
    
97.    if (EQ_is_zero(y)) {
    , v4 D4 D( E$ `( A' @
98. 
    
99.       if (x < 0.0) { return (PI); }
    & W1 ~" v+ |/ J. `. F. ?
100. 
     
101.       return (0.0);
     
102. 
     
103.    }
     8 P; C1 Y. v5 r( r: D
104. 
     + H& r- W; @; F$ n$ [
105.    if (EQ_is_zero(x)) {
     ' }( Q8 K# G0 |3 L7 E; e+ `: @3 l4 a
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     0 p/ M* s" P; ?3 C! F/ s9 A6 _
109.       return(PI*.5);
     
110. 
     
111.    }
     
112. 
     
113.    ang=atan(y/x);
     
114. 
     
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     * B( ^5 n: X8 R' P+ e( a8 m7 O
116. 
     * D* n% Z) C* b) U; }, ?4 L7 L
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     2 E6 s/ v6 q2 b
120. 
     
121.    return(ang);
     
122. 
     & `7 I# p$ K5 J
123. }
     ' ?1 O8 x' B: g! ?
124. 
     
125. //#=============================================================
     
126. 
     2 J- N8 M, P- o- U: R: r, ~
127. double CheckConst ( double angle, double constvar  )
     
128. 
     
129. //#=============================================================
     
130. 
     ) W' B/ R' v0 j/ F3 x
131. {
     
132. 
     8 y2 i$ G% i. k& ^9 K. B
133.    while (angle < -constvar) { angle+=constvar ; }
     7 @6 {  b$ D+ E* @3 p4 e' I+ Z
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     4 x1 ?8 ]/ i5 n
138. 
     
139. }
     
140. 
     
141. //#=============================================================
     + e  H7 @0 d0 ^* H/ W
142. 
     8 I% M' }, f# x" h- Z: r
143. double Check360 ( double angle )
     ' z" p  S  P" Q4 g# a
144. 
     " q; _$ ^3 [% o7 \, B3 c6 e- N
145. //#=============================================================
     0 [7 Y$ F$ w  N. d8 z
146. 
     
147. {
     2 Q  S7 g/ d, H! s' {+ [
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     
153.    return (angle) ;
     
154. 
     & x$ Y8 u/ S: X8 l& j7 A
155. }
     4 t! B9 @0 Y' V) U7 D7 r
156. 
     ! q" @& O# U3 P0 E! C: n. T
157. //#=============================================================
     
158. 
     3 K' b  E, L$ i$ C* o
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     8 A2 S% ~1 f/ R* A8 [# P, _
161. //#=============================================================
     ' s0 g, {! M; }
162. 
     & \, L2 @9 X8 K' O3 v, o
163. {
     * o* N% t  ]& Y( M7 I# x6 D
164. 
     
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     8 d" ?6 y9 f1 F. z
166. 
     2 ~& k; C8 r7 ?1 Q( f) v
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     9 l+ O5 ]) {4 {! ]* @1 c
168. 
     
169.    return (angle) ;
     $ R) U5 M* \" A& `6 w
170. 
     
171. }

复制代码

以下为摇篮5轴计算过程代码
, {) `9 D4 e/ E5 T1 d

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
     Z1 K% X$ T( ]* Y
2. 
   
3.          j=0.; B1=0.; B0=0.;
   
4. 
   / s( ^* F' B& Z, H4 f- k& [
5.           if (EQ_is_ge(i,0.)) {
   & b) m  D8 o( P+ A! a' Y& Z
6. 
   
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   
8. 
   & v# d8 @8 ?6 j# I6 ]
9.           }
   ( }( o4 G5 P( q" T, L. c
10. 
    
11.           if (EQ_is_lt(i,0.)) {
    , v% s* @  ]6 _3 Y0 h
12. 
    + t. I- y# q9 k
13.              if (EQ_is_lt(k,0.)) {
    * _0 [  R8 ]- I8 C) R9 p7 s* M9 [; r
14. 
    : R& [' N6 |2 I& B5 `6 W7 y5 G
15.                 B0=atan(i/k); B1=B0+PI ;
    % y" r/ H) R  {! c# t
16. 
    
17.              } else {
      n: P5 f. F% A! J
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    - T, @2 O7 q* d' R3 I8 {
20. 
    ; N" o( b4 H2 y6 o
21.               B1=2.*PI+B0 ;
    
22. 
    
23.              }
    
24. 
    
25.           }
    
26. 
    2 d; I: N8 `8 S# ?
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    
28. 
    ' M* V- |' S6 V, A7 I+ M* ~
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    9 F! m  |, s% I5 |( ^
30. 
    * n$ |# o* C3 f0 I- a4 x2 ^8 A3 y
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    1 s+ H, F  b6 q2 s! m
32. 
    
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

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


, K3 k. @; U0 v6 b测试结果：
% N& N- a5 B3 i, K4 \; y1 D( q' ]
7 h. u) S  a  t* _: @) ^+ ^
反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享