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

若枫

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

1. int  EQ_is_equal (double s, double t);
   
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);
   
5. int  EQ_is_lt (double s, double t);
     i) J" e0 {! V! |/ E9 G3 O
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   ) H+ a  p" X6 ?4 s
8. double ARCTAN1 (double y, double x );
   9 J+ f1 I, ?/ m
9. //#=============================================================
   1 c8 M& C: q' c' O. H
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    . Y% X# j% X4 x5 F; X8 M
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    
14. double Check360 ( double angle );
    
15. //#=============================================================
    : }* K% |7 H, `2 Y: h
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    8 S5 \( w$ R- d4 f5 b- m. |; a! V
17. //#=============================================================

复制代码

0 e# M2 ~6 }$ p( S以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   
2. 
   + j* t* C& I; U1 Y9 f1 ]  S
3. {
   
4. 
   + W* Z3 H/ S' @+ @
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   
6. 
   1 x7 j6 j- U3 ^4 N. D
7. }
   + m5 q( e$ t9 q  c$ w% p, O+ }" ^) [
8. 
   9 X: z$ n2 k. Q6 G" m' x
9. /***********************************************************************/
   
10. 
    
11. int  EQ_is_ge (double s, double t)
    
12. 
    2 [3 a: f9 z+ U, D, q
13. {
    
14. 
    3 n2 N. @1 g0 [$ P  w0 @5 _
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    , q) A7 K' L/ M& ]  B
16. 
    
17. }
    
18. 
    1 f3 i  h' }# y+ H
19. /***********************************************************************/
    + ]8 g2 V) N" u/ O7 o0 l% O6 H
20. 
    
21. int  EQ_is_gt (double s, double t)
    ' u: Z& t" H9 f& A+ }: N; F
22. 
    
23. {
    
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    8 L7 \6 g( J; e1 A
27. }
    
28. 
    
29. /***********************************************************************/
    7 q# d  r- T% E2 M- w: y
30. 
    
31. int  EQ_is_le (double s, double t)
    & `# c. c  A! e& b- a$ x
32. 
    / }/ ]" ]/ i6 U9 M( X0 O
33. {
    
34. 
    
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    6 Z" p9 D1 @9 N9 G) l4 }) u
36. 
    2 h- l4 X. l* _8 X2 [2 U9 t
37. }
    
38. 
    
39. /***********************************************************************/
    5 E7 Q; n- j3 ~) J2 B$ r# X0 Y
40. 
    " \7 ?" y$ z( H" y' @7 v6 `
41. int  EQ_is_lt (double s, double t)
    
42. 
    , E; k6 C& b# p& r
43. {
    
44. 
    3 F- }; ?: d: f' k+ `2 F* P
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    0 v" X0 g% T7 K' ~; n
46. 
    
47. }
    ( {& n, \/ t- A8 m
48. 
    ( i* M9 `7 C  n
49. /***********************************************************************/
    
50. 
    & _6 j  t' P* P* r% {9 u
51. int  EQ_is_zero (double s)
    8 D$ m6 t  s# B, h4 T
52. 
    
53. {
    
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    : z( M! c' }2 m3 E5 @1 z
57. }
    
58. 
    
59. //=============================================================
    ! x5 m% _- _/ Y7 h  h) P
60. 
    ! w6 q+ j( R  o+ a* v0 q
61. double ARCTAN1 (double y, double x )
    
62. 
    5 S( h& d# X; A* L
63. //#=============================================================
    
64. 
    / W( [6 N9 n  p7 N% K
65. {
    
66. 
    # l' ~7 C5 {% W/ o! C; @
67.    double ang;
    , l" A5 g4 b: w) C1 W% S+ m
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
    + R6 }8 C0 c( S' |" Z
71.    if (EQ_is_zero(x)) { x=0; }
    3 n, X4 x7 t+ @( m, [- S
72. 
      Z8 I! b: F3 ~! f
73.    if (y == 0 && x == 0) { return(0); }
    . O1 {( v9 H4 v" S- _
74. 
    
75.    ang=atan2(y,x);
    
76. 
    * N& @9 v' a( |# W/ v9 b9 v5 c
77.    if (ang < 0 ) {
    ) @+ m/ ?' }/ ?4 k
78. 
    - U! I  G8 D8 U2 J8 ?- d. b' F
79.       return(ang + PI*2);
    ( h% E5 z7 s+ Q$ P9 K
80. 
    
81.    }
    
82. 
    
83.    return(ang);
    1 z& \$ q9 c: y
84. 
    
85. }
    
86. 
    6 l$ u. w( N1 c7 _! n8 g. w
87. //#=============================================================
    " z9 m: E" o" c; N
88. 
    ) ^9 a; {$ [4 E0 t0 W
89. double ARCTAN2 (double y, double x )
    1 }+ D9 b0 R5 L$ y
90. 
    
91. //#=============================================================
    ; {- V5 U; P: z* F) T& [" j$ }
92. 
    
93. {
    
94. 
    
95.    double ang;
    ' Y4 i! P+ L4 h3 v( N3 J
96. 
    * z9 q% p+ _- K! n0 J; w7 F) u3 p! Y
97.    if (EQ_is_zero(y)) {
    
98. 
    " S/ }  d5 Z2 V! u3 Q! i1 U/ v
99.       if (x < 0.0) { return (PI); }
    * T; [) t$ l! o* ^, p( N
100. 
     
101.       return (0.0);
     
102. 
     " G4 ?5 I% H# ]% X& `* s  a
103.    }
     $ [5 Y& @& C; _1 Y$ d& p5 U
104. 
     
105.    if (EQ_is_zero(x)) {
     2 `, G6 t4 r. d- `8 Y3 }. f
106. 
     : E# ]- s0 Q1 o
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     . i! ~; f# u+ s$ p7 I1 A
109.       return(PI*.5);
     
110. 
     * ?6 t+ z3 x& Z( A
111.    }
     
112. 
     - d- J- W: F8 \% l2 s
113.    ang=atan(y/x);
     
114. 
     
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     0 T8 D) j( N* d2 k' o8 ]1 a9 U
116. 
     ' R. c1 h# o+ {  V% o# O, p
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     
121.    return(ang);
     0 a+ ]9 K$ y4 a4 t$ ?
122. 
     
123. }
     & o' n8 N+ D5 H: V. T1 A; C! x( D  d
124. 
     
125. //#=============================================================
     
126. 
     ; L+ @8 A& f5 o: S. }$ J2 [
127. double CheckConst ( double angle, double constvar  )
     
128. 
     0 w+ a% f1 T7 w  D: F8 L' q+ I5 A
129. //#=============================================================
     9 ?* y: [$ }& J; c6 r: h
130. 
     / j/ k( w- _0 w8 ]  r
131. {
     
132. 
     8 _# e+ |/ ]2 c" d
133.    while (angle < -constvar) { angle+=constvar ; }
     1 A  G* D9 s6 _; O/ g
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     ( v& h, ]; ?4 R4 ?. G7 k, v
136. 
     
137.    return (angle) ;
     
138. 
     2 j4 {) \6 Z) J; D; ]7 z, b
139. }
     
140. 
     2 C1 `4 A- S7 q! J+ |
141. //#=============================================================
     
142. 
     
143. double Check360 ( double angle )
     
144. 
     
145. //#=============================================================
     
146. 
     
147. {
     8 ?' U! I; j9 G; ^/ [2 o
148. 
     2 ?$ `4 f8 x4 A2 }" s
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     9 E1 Y; K& s4 m6 H% E7 I' t5 m
153.    return (angle) ;
     
154. 
     - j3 a1 J" V: s6 x# W, x3 p
155. }
     
156. 
     
157. //#=============================================================
     + i+ u; B4 o, x
158. 
     . n1 k; u% q7 y+ |9 u2 t# T
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     ) m7 C, ?' I5 ?
160. 
     & H* ?; s. d# \8 S
161. //#=============================================================
     # ?) C- ?& t' [% F+ C
162. 
     
163. {
     
164. 
     . b! W/ D) `9 Y# m& ]9 g
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     
166. 
     # Z6 r# A9 t8 S* g2 M7 A
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     
169.    return (angle) ;
     # @1 o3 j" W" I) ?; [- l
170. 
     8 C0 u9 X1 ^0 ~
171. }

复制代码

9 ]4 ], G8 N+ b( L3 d以下为摇篮5轴计算过程代码
! O( U) m; i3 e6 p; Q' Y( i

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   7 V3 \4 \' ^0 V0 V3 j  R/ j
2. 
   
3.          j=0.; B1=0.; B0=0.;
   
4. 
   
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; }
   
8. 
   ! F2 C( g" M- K8 ?. q
9.           }
   7 S' U6 \3 x; w0 g/ L# w
10. 
    1 G. z0 m  a2 V3 C2 l9 q/ V( v
11.           if (EQ_is_lt(i,0.)) {
    : _  g+ J8 J' s3 R8 A' }" h1 b9 t* Z2 Z
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    8 W% y+ m! e- w* [1 \8 n
14. 
    * T+ w1 }+ H! K( D5 T/ X7 d
15.                 B0=atan(i/k); B1=B0+PI ;
    ; F9 I, _$ i) a3 J* ]; }
16. 
    ; w- e( ]2 b9 l: k8 L
17.              } else {
    
18. 
    : j5 a# s6 Y# i) T
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    
21.               B1=2.*PI+B0 ;
    $ R7 P" t& W$ s  Z( j
22. 
    
23.              }
    
24. 
    6 z" c: z' J7 W3 }
25.           }
    
26. 
    $ ~% L$ @/ M. D  e0 f1 c. ]
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    - j) n0 A. @% w! w
28. 
    1 i5 Z. X9 J% H$ t. g9 P2 l  ?
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    
30. 
    * V$ i  w8 x" k6 u  e" C
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    8 q# _& D! a) [1 V# R
32. 
    
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
; f4 b% g6 K( q$ A+ D

测试结果：
  O7 P: y3 K2 J. w

反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享