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

若枫

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

1. int  EQ_is_equal (double s, double t);
   
2. int  EQ_is_ge (double s, double t);
   " Q& n! s% f* K  x3 y8 d
3. int  EQ_is_gt (double s, double t);
   - ?4 w. @) n6 F9 S
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);
   
7. //=============================================================
   2 z- g1 K" `" B  R, M
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    4 v8 ~3 g5 t: H4 [/ t
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    
14. double Check360 ( double angle );
    
15. //#=============================================================
    
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    0 q% K/ L3 Z! h- D( R% V
17. //#=============================================================

复制代码

/ m, _* h: Z; ~9 |( L1 n以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   
2. 
   * @+ X% d  w) Y- |0 N
3. {
   
4. 
   6 H6 |1 F2 ~/ M$ S5 M" W2 S4 q/ r
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   8 X  ^. Y& d( R* g; n( }
6. 
   6 @& r3 s( q) g  A. L1 |- I! G
7. }
   + j1 {; r' }, L+ @1 l& G, c  ^
8. 
   1 B# I+ c( ^0 c0 E; Y. v
9. /***********************************************************************/
     V, @$ u- r, S0 S( \
10. 
    + Y! C, s( r; v+ s/ @
11. int  EQ_is_ge (double s, double t)
    
12. 
    - k1 t1 o$ ?0 p: K, f% e- p
13. {
    ( c) ~! N$ Q/ |5 K
14. 
    % X4 ^, `6 C3 e! m
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    . R; D. x( {  |" ]$ ]0 G+ j4 U
17. }
    
18. 
    # K/ n# E4 b* I: L: @' |* B+ K) V* Q
19. /***********************************************************************/
    5 ~" J* g+ y7 O3 Y8 c- `1 Y3 M
20. 
    5 u- H4 ]( O" d+ F7 z- v
21. int  EQ_is_gt (double s, double t)
    
22. 
    
23. {
    5 N# K2 E# L, l  k  t7 R: i& |
24. 
    1 i6 q, O: f7 f* _' u/ v+ z
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    ( g7 u5 U4 n& q9 K
26. 
      \/ ]" e% m) m* W/ C
27. }
    
28. 
    8 {. q! g7 k# W8 [# U) x
29. /***********************************************************************/
    - @$ O; |' D- ]4 n+ I" I* b
30. 
    
31. int  EQ_is_le (double s, double t)
    
32. 
    
33. {
    
34. 
    
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    4 W# |$ B( }8 r! A! L% g
37. }
    
38. 
    " U: ?5 f( w* F* f7 q6 |
39. /***********************************************************************/
    . n5 Y9 V) _, O6 Y! }. K  N$ X
40. 
    
41. int  EQ_is_lt (double s, double t)
    
42. 
    
43. {
    3 x6 R- w* l" I2 f- T6 @
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    % I. L7 }0 ^) x; b5 w
46. 
    
47. }
    0 P0 b  d& J' S
48. 
    3 q' T9 ?0 O' y. y5 E) H
49. /***********************************************************************/
    : W( Q# i+ T9 h' m+ w# A7 x9 a7 N
50. 
    
51. int  EQ_is_zero (double s)
    
52. 
    
53. {
    8 z  l. D2 A0 G6 ]( H  Q
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    ( E0 ~( t8 e* I6 v; S) }
57. }
    
58. 
    ) v% e) \; B# L! v9 B7 z
59. //=============================================================
    
60. 
    3 z' R; D$ g2 F7 Y# e0 Q" H" h# b
61. double ARCTAN1 (double y, double x )
    
62. 
    
63. //#=============================================================
    
64. 
    
65. {
    
66. 
    
67.    double ang;
    9 H7 ^- s7 j1 G! a5 I
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    5 {& |7 C4 X0 K" [, @
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    4 ]# l6 j$ g/ n+ i
74. 
    
75.    ang=atan2(y,x);
    
76. 
    & P" W$ G8 ?  [+ g* |# n+ G" B7 \/ g
77.    if (ang < 0 ) {
    0 X' Y) w: k) j) F/ K) Z; r
78. 
    
79.       return(ang + PI*2);
    
80. 
    3 p- A2 u  Z! B
81.    }
    6 a1 I3 f' O0 T$ R  l: l
82. 
    # S/ p) n' D$ A2 {; X& ~5 w$ N# w  g
83.    return(ang);
    
84. 
    
85. }
    1 b* O# P! ?$ {* X; I
86. 
    ( O" x" v( `8 l: t9 g7 x
87. //#=============================================================
    9 y+ q+ a( F3 C! u3 P7 e9 |# b
88. 
    
89. double ARCTAN2 (double y, double x )
    
90. 
    . m  \& ?. O& L  E% Q2 B9 b! Q
91. //#=============================================================
      `* M4 u' q+ H3 i
92. 
    
93. {
    3 a6 |# x. U  {8 F( A
94. 
    
95.    double ang;
    1 a/ B: ?2 `% y: Y$ m
96. 
    
97.    if (EQ_is_zero(y)) {
    # R' l* i8 R! ?$ Y& T
98. 
    
99.       if (x < 0.0) { return (PI); }
    
100. 
     - ?$ A9 u; q5 _9 q* R6 Z+ _; n+ Q
101.       return (0.0);
     
102. 
     
103.    }
     " B. c& M4 \* \( M
104. 
     
105.    if (EQ_is_zero(x)) {
     
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     * A- j. k+ S" |4 U! g
108. 
     
109.       return(PI*.5);
     7 k; Y: Q2 T: i( T. a0 O3 [
110. 
     
111.    }
     
112. 
     : {4 r$ e& u" Z1 T5 A* M
113.    ang=atan(y/x);
       }9 [6 W" p# q$ K7 i
114. 
     
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); }
     
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     ; v4 Z; ^: {* a- F
120. 
     
121.    return(ang);
     2 M, F% g+ m3 k0 E6 I& n
122. 
     % r0 s1 N) w+ s% ^* p" a3 q
123. }
     5 q5 k" n2 Z: n, z: N
124. 
     1 T+ E; b! h! n2 C" M# q- D
125. //#=============================================================
     , |4 \! D( d6 [# w
126. 
     2 X! i+ d1 c' Z$ g
127. double CheckConst ( double angle, double constvar  )
     8 k/ T1 G& C. |! r5 t
128. 
     
129. //#=============================================================
     
130. 
     ( J% M3 H3 ~5 d9 X
131. {
     
132. 
     
133.    while (angle < -constvar) { angle+=constvar ; }
     2 O) }9 y/ l' l& k8 F# P+ b$ N" k
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     & x5 {. Z5 @  u2 @/ m5 b
138. 
     
139. }
     
140. 
     
141. //#=============================================================
     1 V! j3 I+ c  d$ _
142. 
     
143. double Check360 ( double angle )
     # H, e! O- Y) C: r! E, `
144. 
     
145. //#=============================================================
     9 h3 t4 n* A4 C2 ]
146. 
     2 C! ?6 m! P2 i$ [& v' M
147. {
     
148. 
     . [; D! G- F2 F$ ^  _
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
     ( b! Y( m7 d5 K  X% I; w' |
152. 
     & l1 ?7 }. Y+ r' s3 o  `6 b
153.    return (angle) ;
     
154. 
     
155. }
     : J5 M. t* q7 V( S* S* m; l( N
156. 
     & H* v, z- B3 m/ ~% b
157. //#=============================================================
     
158. 
     9 T& H, I+ D0 {. r. N% q& W1 Y  ~
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     
161. //#=============================================================
     
162. 
     ! `' K, m  T* O$ s8 Z4 D! ^# G
163. {
     , j- f8 z. l0 L
164. 
     
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     & I8 }& a/ G8 Y$ M
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     7 L  q+ L% o- p' ~5 M; `( z) D( t
168. 
     * f# O1 b  p6 c; q7 J- ~
169.    return (angle) ;
     & }- @9 G! q% I. b
170. 
     ' E, F! q3 G# j; ?! B% o
171. }

复制代码

以下为摇篮5轴计算过程代码
& ?) y7 N9 `, x# [

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   6 r/ @2 A9 ~  a2 m6 r
2. 
   
3.          j=0.; B1=0.; B0=0.;
   * Q0 D7 n4 A. N# ^1 L, p. N
4. 
   * A" ?) ?: W6 m* @
5.           if (EQ_is_ge(i,0.)) {
   
6. 
   
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   * ?. g: W7 @. D
8. 
   
9.           }
   
10. 
    
11.           if (EQ_is_lt(i,0.)) {
    $ Y( U! U) N- X7 i5 h5 l
12. 
    " A# x* p. n: c% M; h
13.              if (EQ_is_lt(k,0.)) {
    3 n8 W5 H* Q; L6 ^/ r% g
14. 
    0 F" D) r; d9 H; l9 i+ Y6 u, `
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    * S) e- j7 v- f
17.              } else {
    9 |5 |3 a! e* A9 M2 i
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    9 y5 O! j: t, N. V5 D
21.               B1=2.*PI+B0 ;
    5 {% r3 K! ~5 u, Z. Q. J$ w
22. 
    / l/ [! K# ^4 E6 a
23.              }
    
24. 
    $ M$ Q4 d9 Z9 ]  g( p: W
25.           }
    
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    
28. 
    
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    * T6 V% i* s+ M
30. 
    
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    * X" [. z8 f% l8 E0 \) z
32. 
    % E8 C3 g) x7 {$ m$ {
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

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

/ D; G+ u" g6 `- t, e
, T8 z% m+ x% T" i: x# D6 k# d测试结果：
# u1 r4 `% |. h
$ H! H8 ^( r5 x" [6 Z6 a2 ]( t
3 q/ F* ]6 {6 h) q6 @" m4 P3 g: ^" g反向测试结果
, O6 l5 k0 v* n- j  X* l

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享