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

若枫

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

1. int  EQ_is_equal (double s, double t);
   
2. int  EQ_is_ge (double s, double t);
   " {; \. A% x% h0 H$ s
3. int  EQ_is_gt (double s, double t);
   / ]* W; {" D9 U9 t8 P9 T- k: n
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);
   9 i! N2 `1 F3 l" r
7. //=============================================================
   . o/ D( V9 S+ a
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    2 b3 b( c4 n6 x" b) J
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    
14. double Check360 ( double angle );
    9 ^9 h& |7 L6 J" \( {
15. //#=============================================================
    
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    ! \- w+ l# i* d
17. //#=============================================================

复制代码

$ R7 ?4 E& N- Q7 K' ^& p( E! \' [$ Q以下为部分源代码，用于判断，计算角度等
' ?1 l& |$ O& {, I! D* q/ v

1. int  EQ_is_equal (double s, double t)
   5 C/ e1 d) [4 {1 O/ R7 z8 P0 M
2. 
   9 f( Y4 {: X  ^
3. {
   
4. 
   ; Y9 q, H4 [9 {3 y' P' U
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   
6. 
   
7. }
   
8. 
   
9. /***********************************************************************/
   * E* U' b6 z6 l4 \; w+ H
10. 
    4 K9 W$ K) a8 z# g% n0 ]: t* t
11. int  EQ_is_ge (double s, double t)
    + [3 v" p6 Q0 i' P
12. 
    3 `3 M1 z6 ?/ I4 q! r6 H
13. {
    % }4 }$ t5 Y* v$ c+ \4 T
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    / @: T% c  B/ w3 q
16. 
    
17. }
    & Y2 f/ d9 A- c
18. 
    - [" E* U0 A4 m& C2 v- V+ c0 @
19. /***********************************************************************/
    
20. 
    
21. int  EQ_is_gt (double s, double t)
    " X; k& S: a" n& d4 I* }
22. 
    
23. {
    
24. 
    . \2 B* `: l& _% W. M! ~
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    
27. }
    
28. 
    % P# l+ J/ V) k. b
29. /***********************************************************************/
    + W9 i# u1 v/ l" b7 f( ^
30. 
    
31. int  EQ_is_le (double s, double t)
    
32. 
    
33. {
    2 o( |. q+ i& |9 t& c; a
34. 
    $ `9 R6 R+ n% R) h# n" y
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    
37. }
    : R. [+ t( \- }9 G2 U
38. 
    
39. /***********************************************************************/
    3 E3 M4 ?6 {& z! S/ a
40. 
    
41. int  EQ_is_lt (double s, double t)
      W8 _0 u4 ~; S: ~* M& V
42. 
    9 q0 `6 {$ T" q0 Y
43. {
    
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    6 ^0 O& Z+ T  T; Q+ D, M5 e
46. 
    
47. }
    
48. 
    4 F1 I/ S& W9 k) |0 Y3 d
49. /***********************************************************************/
    5 f2 f$ q/ o0 }0 o
50. 
    
51. int  EQ_is_zero (double s)
    5 V$ O8 e4 y' V2 Q1 L* k
52. 
    6 ]/ l1 A6 J& z' C4 S2 T
53. {
    
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    ( o8 V. `1 h' x, ?+ V; \1 U/ ^% [
57. }
    
58. 
    
59. //=============================================================
    8 a. V% D* t/ E" F- i3 v, Y' A" R
60. 
    # ^  _( R& f) E2 D" ?
61. double ARCTAN1 (double y, double x )
    
62. 
    
63. //#=============================================================
    " C& U5 `- z- R6 u+ V
64. 
    
65. {
    
66. 
    + j4 _' z( H, L) V# J0 j
67.    double ang;
    
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    , H+ C5 g% K  A  O" A+ q- I8 n9 @, F- u
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    
72. 
    , P1 G* X( Z* m0 s5 D
73.    if (y == 0 && x == 0) { return(0); }
    
74. 
    , V' A# @: w+ a4 B
75.    ang=atan2(y,x);
    
76. 
    8 S* o8 O) ~! B7 c, _5 K$ s
77.    if (ang < 0 ) {
    
78. 
      P/ P7 u( C8 U$ W; r- R
79.       return(ang + PI*2);
      U( V, f& N6 Y6 f& l/ `; g
80. 
    
81.    }
    / f- {: t# {" |6 D& E7 E0 h
82. 
    
83.    return(ang);
    
84. 
    ) J/ V6 e* D4 L9 c
85. }
    
86. 
    . f0 G! I( c) j  G5 d, F: ]
87. //#=============================================================
    ' j1 w3 M0 `4 Y& R6 C3 L
88. 
    
89. double ARCTAN2 (double y, double x )
    
90. 
    
91. //#=============================================================
    & R2 w. a  z! @. j3 k
92. 
    7 q7 G) n  t" k1 k: f: D8 N& C
93. {
    0 |. j& `4 T: X; w# p! P% f& k
94. 
    
95.    double ang;
    
96. 
    * p9 s  ^6 L) g4 s0 O
97.    if (EQ_is_zero(y)) {
    
98. 
    % n9 b  n  X6 ~" N
99.       if (x < 0.0) { return (PI); }
    
100. 
     ; b. ^  y5 C- }
101.       return (0.0);
     2 o- x. o, m4 ?# T7 p) e4 @$ X
102. 
     $ K5 g/ H' h! J  S& _
103.    }
     2 Y! b2 h: d5 m
104. 
     ' r* A" K: }6 S* {5 _" U# i
105.    if (EQ_is_zero(x)) {
       j! ~& a4 b5 Z3 Z) l8 U
106. 
     $ g* E/ R# Y0 y
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     
109.       return(PI*.5);
     7 i0 ~- ?8 F, Z: L
110. 
     / s. w0 ^2 v" |; M
111.    }
     
112. 
     ) O& i( `9 v1 {5 V
113.    ang=atan(y/x);
     9 C# m1 _# g/ N0 S1 q% R( ~- y9 {: K& W
114. 
     
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     : c, b3 S7 B4 P& t' D
116. 
     0 E; a2 C0 m7 _$ }* a2 y5 ?
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     : W' [$ k& T" X) ^) Z
118. 
     4 x7 o' k7 W0 e
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     # G1 X) p3 v: I
121.    return(ang);
     , y& G) X: X. v* D+ ?& u/ L
122. 
     
123. }
     
124. 
     5 |, L( i  ]1 C: g& t6 G
125. //#=============================================================
     4 u. x8 |; J% V7 u
126. 
     
127. double CheckConst ( double angle, double constvar  )
     
128. 
     
129. //#=============================================================
     * ]# e* ?7 ?) s9 w7 `! k
130. 
     
131. {
     # o" T3 D, B* p2 @2 b1 R
132. 
     
133.    while (angle < -constvar) { angle+=constvar ; }
     6 a, s8 s+ _; k5 e
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     6 U8 Y9 f8 e( k2 u( m
136. 
     ' U: n. [  l9 ]
137.    return (angle) ;
     
138. 
     
139. }
     
140. 
     0 ?; x0 _8 U8 @* Z
141. //#=============================================================
     8 i$ z7 f0 Z* l
142. 
     % f; B, l$ t7 v. ~
143. double Check360 ( double angle )
     
144. 
     
145. //#=============================================================
     
146. 
     
147. {
     
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
     1 r; S$ F! X3 P# Y# C, E
152. 
     ( [/ o8 ~. k. O$ P
153.    return (angle) ;
     
154. 
     
155. }
     
156. 
     
157. //#=============================================================
     ( N: ?( ]$ o1 l2 `
158. 
     # h7 P% B+ V4 G1 A$ g
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     
161. //#=============================================================
     $ S- x5 Y, F  a2 Y, G9 O5 X
162. 
     
163. {
     * c( }( ]# l3 X9 g5 b4 Q# [
164. 
     
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     
166. 
     ) j5 Q& Q* Y" I5 k( W6 Z
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     % \" G& K& I( k- G& v/ @, S
169.    return (angle) ;
     7 _* l8 O* S* i# ?) W: X3 c) t
170. 
     
171. }

复制代码

$ o1 R- h+ j/ Q' ?7 k以下为摇篮5轴计算过程代码
, S) v4 Z7 |# ?/ D

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   
2. 
   ; H) R( x/ m8 q9 ^: p% g
3.          j=0.; B1=0.; B0=0.;
   
4. 
     O2 [4 @6 q9 P0 u: {+ G2 V
5.           if (EQ_is_ge(i,0.)) {
   
6. 
   2 k  k% s2 Q- \: J! |4 o$ H1 N$ O
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   , h( W0 d9 C" V9 a+ h0 j
8. 
   ) `  j+ {# B) t* u
9.           }
   ) W2 G3 `& O5 k# j
10. 
    
11.           if (EQ_is_lt(i,0.)) {
    # d5 ]. v/ z; F! p
12. 
    " v+ p& w7 r) \- ~# e9 M
13.              if (EQ_is_lt(k,0.)) {
    
14. 
    7 s$ c+ x  t7 a1 F3 G" R
15.                 B0=atan(i/k); B1=B0+PI ;
    2 I8 c5 i/ r$ H3 A
16. 
    , }6 v8 f5 S% {9 m( l
17.              } else {
    # `4 g2 B4 c6 G% V7 T- }
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    . H' L. ]5 _1 b: M1 T6 H2 R
20. 
    
21.               B1=2.*PI+B0 ;
    ) ]+ z0 m/ c- D, d
22. 
    
23.              }
    1 Z- J" L& i6 |) _* H- B0 \
24. 
    
25.           }
    
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    : J& c) y& h" \" O/ N6 ?+ ?
28. 
    
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    6 w: ^/ T5 ]" X2 @2 ~
30. 
    ! Q: l) B, z2 x. C
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    
32. 
    & M4 c. t; j( Q- S3 S( n- N
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
# H( M, o6 l- X9 }+ Z+ W3 U- h+ B
) l* f. \5 P; f" D
测试结果：
) m7 ^1 m& z# t  G; Y2 \6 i
1 [- Q1 D/ b# _% Y! c1 U
反向测试结果
, S' }* t  L8 C

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享