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

若枫

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

1. int  EQ_is_equal (double s, double t);
   # d* ^4 q0 m& p' {
2. int  EQ_is_ge (double s, double t);
   - K" n% G0 @" F0 U; ^. {2 H
3. int  EQ_is_gt (double s, double t);
   6 Z* G$ j4 K5 G0 z- P
4. int  EQ_is_le (double s, double t);
   - H" @3 Y  u6 P9 X( b% v+ ~1 Z
5. int  EQ_is_lt (double s, double t);
   ! A6 M/ C. k# s- L* Q$ F' ~
6. int  EQ_is_zero (double s);
   ( W" G& S4 ?- b) W# F, q- `
7. //=============================================================
   4 |+ J0 E* o" ^3 A: a# ]$ D& z
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   ' v. r. L- i5 f" e5 a8 R
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    / J" q0 n1 W+ C- a* @3 O
13. //#=============================================================
    4 D, G! ]0 p, C/ B" {' y# U" L% B" [
14. double Check360 ( double angle );
    
15. //#=============================================================
    & x7 o2 g) b5 e( l' a# n- |
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    
17. //#=============================================================

复制代码

* N- c  Z7 L, v# R5 y' [+ t/ a$ d以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   : X& r. z" E" N0 ^
2. 
   
3. {
   ( t+ T8 w! _1 E6 v
4. 
   . O% C+ i0 b" {- G; h
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   + w: P, J$ ^3 M# r
6. 
   
7. }
   / b- [7 h1 H# ~3 G5 a) T2 k( e
8. 
   
9. /***********************************************************************/
   , ^" e& O, X* Y3 a% Y9 \" U9 V
10. 
    
11. int  EQ_is_ge (double s, double t)
    
12. 
    
13. {
    % W0 d; v4 k2 j( }0 F$ n( U
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    / V! \5 n5 N1 S/ A7 D$ z9 o
16. 
    8 M) m8 Q3 s0 S: X9 {4 v) G
17. }
    
18. 
    / T) i: a" q$ Y
19. /***********************************************************************/
    
20. 
    
21. int  EQ_is_gt (double s, double t)
    % K$ R: {' K: h$ M
22. 
    
23. {
    
24. 
    4 e3 F& l# o( `; K- n
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    
27. }
    4 I8 y9 H7 a' o2 A
28. 
    
29. /***********************************************************************/
    ! `; E/ G7 i7 H) p4 K4 ]* {4 p
30. 
    " |4 v" h7 L1 \$ R, ^( _
31. int  EQ_is_le (double s, double t)
    ' m# r# g" |) r. L5 X
32. 
    4 q1 _- J0 M# Q9 N, O" }
33. {
    
34. 
    0 j, ?/ q- }& P
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    $ I1 h$ m( K3 M* e; s, g
37. }
    
38. 
    $ O4 A$ ]! X% ~& N" W+ V
39. /***********************************************************************/
    ! I  E" ]- G# \
40. 
    1 Z* Y& x) R. m- j# r
41. int  EQ_is_lt (double s, double t)
    
42. 
    ' \/ F' o* ?- d: ^# ^: H
43. {
    
44. 
    " y8 u! \: P& C$ Q% f
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
    * m- S1 ^) M' |7 I* g7 Z  ?2 c; \
47. }
    
48. 
    4 C' L' S7 a9 J
49. /***********************************************************************/
    
50. 
    
51. int  EQ_is_zero (double s)
    3 k" ^# j* x$ d6 l& N1 u
52. 
    5 A  A) P: n& r# m. L( Z
53. {
    * @+ N  v- t2 f
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    2 M0 g  w1 Q5 t" p4 F% r7 [* G& W0 G, f
56. 
    : U1 P/ h8 L4 _& d$ A/ ^4 x) E5 _
57. }
    
58. 
    
59. //=============================================================
    
60. 
    8 |) A' e5 V8 `. }" y# r: x5 C
61. double ARCTAN1 (double y, double x )
    / x6 S8 F, U* R" f2 O* H
62. 
    1 k# c( \% i5 B* Y
63. //#=============================================================
    : L+ e! @5 S" G  o' I
64. 
    ! H8 ]0 J2 y8 t/ Y8 b9 ]
65. {
    
66. 
    7 _' f  a; x! G- d  n& ^' Y: U
67.    double ang;
    + a5 D5 A- b9 G, G8 D* ~
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    + H5 m6 k" c1 ?
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    & w3 v- ^) o0 z0 e9 F# b7 R
74. 
    
75.    ang=atan2(y,x);
    
76. 
    
77.    if (ang < 0 ) {
    6 |7 I9 V. k* ^6 h$ i; w8 d
78. 
    # I% f; b5 B% G- h* \2 m0 ~
79.       return(ang + PI*2);
    9 v# V1 s8 _7 x( |' G* r6 d+ Y
80. 
    
81.    }
    
82. 
    
83.    return(ang);
    " P3 h2 b7 [/ j
84. 
    
85. }
    
86. 
    
87. //#=============================================================
    4 b/ B* e7 g" ]' d  z7 v7 f0 O+ E
88. 
      e) ~' V7 D# N* H, E$ [0 ^
89. double ARCTAN2 (double y, double x )
    % h, }% L' P$ A0 X/ d+ C# D
90. 
    
91. //#=============================================================
    - M) u! w- t. A5 Q* j, K
92. 
    
93. {
    ' D9 n: J: ~5 c1 p  L
94. 
    ' i" _+ ?# |% b( O  f" c
95.    double ang;
    6 |3 i/ `0 q  Y/ @2 ^' L9 `
96. 
    2 X& ?: u1 `- d8 T& J
97.    if (EQ_is_zero(y)) {
    
98. 
    
99.       if (x < 0.0) { return (PI); }
    
100. 
     
101.       return (0.0);
     . A) u/ \; l3 }  l
102. 
     6 k9 i4 E  A) d1 L/ b6 j( M/ L- Z
103.    }
     * b8 Q* e4 r- [( z. U
104. 
     
105.    if (EQ_is_zero(x)) {
     
106. 
     7 o3 \( O* ], a! \" o3 I8 P1 D
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     
109.       return(PI*.5);
     : _. P- Z9 S- ~6 E4 B8 t7 G1 G& l# c
110. 
     6 M4 }- j$ Q2 n$ w( x3 y8 ~
111.    }
     
112. 
     
113.    ang=atan(y/x);
     
114. 
     
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     + Q" I8 U' L7 I/ z4 P$ L- Q6 p
116. 
     
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     4 ?) m1 v" ?1 p
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     
121.    return(ang);
     
122. 
     
123. }
     * q( K! f* Z0 c) ?3 m
124. 
     
125. //#=============================================================
     4 h/ U; n: ~8 B& N
126. 
     + T2 p+ o; n# q. N  u* y
127. double CheckConst ( double angle, double constvar  )
     
128. 
     & `) C( `) X" }# X' M3 y
129. //#=============================================================
     # B. a& d0 n- U* y& e
130. 
     0 I- E7 V4 a. a% b3 ~$ v3 B' U
131. {
     5 O+ }+ e$ T) o. q4 J: ^' r6 y* D
132. 
     
133.    while (angle < -constvar) { angle+=constvar ; }
     8 z' z0 u, Q( u8 E
134. 
     ' d7 _8 Z" z$ T( p7 Y% r- X
135.    while (angle >= constvar) { angle-=constvar ; }
       u! R3 S7 r- C% A! w  u
136. 
     
137.    return (angle) ;
     
138. 
       W7 n  x9 K1 u
139. }
     
140. 
     
141. //#=============================================================
     
142. 
     * m+ I: ?7 f% b, Q! w4 f
143. double Check360 ( double angle )
     
144. 
     5 q' ^) Y* b( x% k
145. //#=============================================================
     1 i9 q6 z9 I" N/ R, m
146. 
     # }* D8 C' _7 Y8 T) u. u+ h
147. {
     + \* c6 e, a% F, [/ c4 T
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     * l; S0 n; S8 c- x/ a# \! G
150. 
     6 ~) S# F. Z% z: \- n% T. d
151.    while (angle >= 360.) { angle-=360. ; }
     - w2 Y' t) @: P* \- a: e/ B$ _- {
152. 
     
153.    return (angle) ;
     
154. 
     
155. }
     
156. 
     
157. //#=============================================================
     
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     + Y3 X, |: e( ~
160. 
     
161. //#=============================================================
     
162. 
     
163. {
     
164. 
       ]4 d7 m% V( a* m0 R9 {8 M
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     ! b: d) m2 u) B0 r
169.    return (angle) ;
     ' A5 p2 v0 s, j7 T& }  p' B
170. 
     $ m$ Y0 W' e- G1 u6 t
171. }

复制代码

  M8 k# H& G/ J. O8 Z0 @以下为摇篮5轴计算过程代码

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   ) A# |! n+ b0 B6 \
2. 
   
3.          j=0.; B1=0.; B0=0.;
   
4. 
   
5.           if (EQ_is_ge(i,0.)) {
   . u5 e& E0 r; b
6. 
   2 e$ b. y3 @; Q: J! `# L
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   
8. 
   % O  u7 D1 m( b: K- @' d7 R  Q
9.           }
   0 ?8 V! m; x, N
10. 
    # P8 ~4 O+ a# o5 B6 K& `+ b
11.           if (EQ_is_lt(i,0.)) {
    
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    
14. 
    
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    
17.              } else {
    ) \2 ]9 l1 i5 q4 G$ ]1 s
18. 
    $ [' C- }5 ]" A. |( E* g
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    - _, g8 ^% h0 t9 c
20. 
    
21.               B1=2.*PI+B0 ;
    , z' d) `2 F* a; r. V6 K0 ~5 z
22. 
    
23.              }
    $ o) O2 }! e& ]# K5 {6 Q. l4 w3 N
24. 
    
25.           }
    ' L4 {! _( U- {1 g
26. 
    % b: d6 X! f2 V/ O" B
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    2 P/ c( v7 k. a
28. 
    & S, r1 Y/ k$ l" _- M
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    
30. 
    
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    
32. 
    
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

9 l# @' i: d& w- j, U" z9 p: T通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。


6 X7 Y* }. a) m/ T7 w: e  y3 P# w测试结果：

* t$ f% {+ U5 C& l
; Y5 z; \) d* t反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享