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

若枫

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

1. int  EQ_is_equal (double s, double t);
   
2. int  EQ_is_ge (double s, double t);
   % K7 I$ _' q6 ?) q$ A; ]; M) n- c
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);
   : o- e% _/ d5 Z
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   1 H8 _! J/ b% [, M& [  p
8. double ARCTAN1 (double y, double x );
   : m5 M: c' u* B
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    
14. double Check360 ( double angle );
    
15. //#=============================================================
    0 t2 u: r, }. g' T! T
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    ) L: U0 @+ Z5 X: f' w( Z
17. //#=============================================================

复制代码

. x/ z4 w; I) z# E% y1 e3 G以下为部分源代码，用于判断，计算角度等
; b5 a& [9 U6 y/ {6 ^. K# @3 N  r

1. int  EQ_is_equal (double s, double t)
   
2. 
   
3. {
   : Z+ J2 N, Q+ u
4. 
   7 f2 H' }0 v8 N& U0 W7 l2 R
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   6 W7 ?0 H, t* |6 t0 b' \. H
6. 
   % O. n0 y; o" p+ z  g% U
7. }
   6 ^% t; M# f3 M7 C0 M' i* I( S4 V
8. 
   
9. /***********************************************************************/
   
10. 
    
11. int  EQ_is_ge (double s, double t)
    
12. 
    
13. {
    
14. 
    2 e( d1 c5 U8 S; u+ n6 M& u4 O
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    5 Z3 X, s+ H# U) }, t
17. }
    
18. 
    % k. t: f/ m' k% G% p
19. /***********************************************************************/
    8 }" f& Q( |* i: W8 M  T& B$ M
20. 
    
21. int  EQ_is_gt (double s, double t)
    
22. 
    4 F* L2 d% Z/ m1 n: T9 }
23. {
    
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    
27. }
    
28. 
      W+ V2 i8 q) n
29. /***********************************************************************/
    , [" O8 N4 _  m/ p1 T
30. 
    
31. int  EQ_is_le (double s, double t)
    
32. 
    
33. {
    / w' }% N: L; Q: H7 H! W
34. 
    
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    
37. }
    6 A& I8 K* u! |8 D( C9 W
38. 
    1 U: u9 S% F' N+ I: S8 F* R
39. /***********************************************************************/
    " l, P$ i6 L" M
40. 
    
41. int  EQ_is_lt (double s, double t)
    4 f: m, P5 T7 k3 ?& z  `3 m% g9 A5 j! E
42. 
    # G( @1 |% k7 ~. ?4 \) a
43. {
      F5 ^  g8 c4 m; h
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    $ V5 G# U% y; X" s5 p
46. 
    
47. }
    2 Y( c+ n- Y3 I
48. 
    9 T2 {4 Q9 j$ r7 r5 [* [
49. /***********************************************************************/
    
50. 
    3 r6 P. Y: C! e
51. int  EQ_is_zero (double s)
    - `+ Y/ _) o( [* U9 h: w; {% X5 g
52. 
    9 f9 _5 j9 F; l( v1 e
53. {
    
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    ; [, Q. V( |* z+ x6 M3 }1 F
56. 
    
57. }
    * {5 ?/ f$ L5 F/ ]! K' ]2 l! A" Z
58. 
    
59. //=============================================================
    
60. 
    
61. double ARCTAN1 (double y, double x )
    1 i! N% H6 e8 A, f9 [9 h* L
62. 
    
63. //#=============================================================
    
64. 
    " I: K7 m: C. F7 \% L7 a
65. {
    
66. 
    
67.    double ang;
    7 `) |7 a1 ~) V5 h6 V
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    9 y" K0 L7 D) k# v1 x+ q; M6 O% G
72. 
    9 a. _4 a7 \4 |$ G6 r
73.    if (y == 0 && x == 0) { return(0); }
    
74. 
    " u) U+ a2 ~! t5 ]  f! s
75.    ang=atan2(y,x);
    
76. 
    * z& Q/ N8 d% w' K9 a6 _" g
77.    if (ang < 0 ) {
    
78. 
    
79.       return(ang + PI*2);
    ) _4 l: c: S1 F) U4 U8 z' q
80. 
    
81.    }
    
82. 
    ' Z/ Z* U- H6 |. O' H
83.    return(ang);
    " g, p( _! D0 w  V4 t$ p) g( c/ Q; y
84. 
    
85. }
    
86. 
    # q7 v  s5 M, [) z7 v
87. //#=============================================================
    
88. 
    
89. double ARCTAN2 (double y, double x )
    
90. 
    
91. //#=============================================================
    
92. 
    / _+ J. J, K* K
93. {
    
94. 
    
95.    double ang;
    
96. 
    
97.    if (EQ_is_zero(y)) {
    
98. 
    6 U4 N, I. B5 K1 q$ W" y
99.       if (x < 0.0) { return (PI); }
    
100. 
     0 r$ z, q( K( f" C0 C
101.       return (0.0);
     
102. 
     4 v0 q4 W, k9 y7 |" N
103.    }
     ' q1 u  j5 c+ ~' k0 i" A
104. 
     
105.    if (EQ_is_zero(x)) {
     
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     & Q& E, x% W; V3 f" j
109.       return(PI*.5);
     5 Q% S& F5 H/ }5 D" Q4 D
110. 
     
111.    }
     
112. 
     
113.    ang=atan(y/x);
     , U5 Y4 Y( V) h- m+ z
114. 
     
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     & z/ s. P8 Z, N  E/ a8 c1 u
116. 
     
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     
118. 
     ; X# x" O5 W( k- d, r: h3 a; p
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     8 \$ V6 d* Z; n9 D/ r
120. 
     6 H' ~$ `2 x3 Y4 O/ `/ B
121.    return(ang);
     
122. 
     
123. }
     
124. 
     
125. //#=============================================================
     
126. 
     
127. double CheckConst ( double angle, double constvar  )
     
128. 
       t: Q  q! d& t2 G  g& |/ n& e
129. //#=============================================================
     
130. 
     - X  V8 w3 _- E! r' s
131. {
     2 ^8 v( t( d/ ~/ ~: K( h+ o7 M
132. 
     ; c9 J  I6 H5 h- `1 `2 O9 c
133.    while (angle < -constvar) { angle+=constvar ; }
     ' _- F" \; v# L/ _$ r% C
134. 
     : E  E3 v# I. {# N4 X
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     9 D6 M9 v: H  j9 P% e
137.    return (angle) ;
     , F8 ^$ `$ m$ M( {. I5 w7 I( G6 `* \
138. 
     6 y" t) V; h9 ^# J7 v3 b' M; n" b
139. }
     . b- a' ?7 C# Y" P0 k0 D' N
140. 
       ]. u2 Q8 ?: w$ b
141. //#=============================================================
     
142. 
     ' i4 `) x' B7 a7 \3 w  n
143. double Check360 ( double angle )
     ! _+ k- Y1 F5 ?3 V" e+ U
144. 
     
145. //#=============================================================
     
146. 
     ) m! b+ A9 e. {  G
147. {
     " G0 I( }5 r) ^9 T5 m7 r, V' n7 r& A7 I
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     ( l+ w# U. J: ^- i
150. 
     ( {0 B2 ?1 |; p+ w" T# ~
151.    while (angle >= 360.) { angle-=360. ; }
     & V4 V6 k  N' I" m) m5 o
152. 
     + x; @+ O! I1 l( q0 Y
153.    return (angle) ;
     3 v' O2 s& f, L1 m2 x
154. 
     9 w: h/ v1 L0 e( }2 [2 N
155. }
     
156. 
     # E: \7 U* v- Y0 l* H+ z
157. //#=============================================================
     
158. 
     ; ]) |" i" l4 X) B) V) K
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     , C: N& [: ^& ^7 G
160. 
     9 l" v# S2 C3 b( y2 I; a
161. //#=============================================================
     ) T) ]& s; b3 M- N' Q6 P0 T" A
162. 
     
163. {
     
164. 
     
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     6 y3 e5 s5 g: W( a- S: o  g+ U
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     3 o2 p' r4 W2 L2 b
169.    return (angle) ;
     
170. 
     ! L) X4 p' A% S' O' i& r0 {
171. }

复制代码

以下为摇篮5轴计算过程代码

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   9 u& X* ?& y4 ^/ `$ Y5 n9 }+ ]
2. 
   
3.          j=0.; B1=0.; B0=0.;
   
4. 
   ) }$ m% s6 X8 x" L5 b/ }
5.           if (EQ_is_ge(i,0.)) {
   / O' @( O3 ^7 @& J1 e! u
6. 
   
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   % v" o; V' Q, n& v6 Z+ x
8. 
   
9.           }
   8 Z# s9 w7 C) p' G, I  B
10. 
    + u9 L3 X9 T, A/ p
11.           if (EQ_is_lt(i,0.)) {
    1 l: h4 e" z# p9 b
12. 
    7 O  I# O) ?' x5 l! P3 N6 q+ e( b
13.              if (EQ_is_lt(k,0.)) {
    " G4 m" I* I# B. w
14. 
    
15.                 B0=atan(i/k); B1=B0+PI ;
    7 B/ g0 @: f+ \  Z, N& B
16. 
    
17.              } else {
    
18. 
    ! j2 p7 s' u7 A% j: l
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    
21.               B1=2.*PI+B0 ;
    / E! v# b0 j) v- H( ]
22. 
    ) I3 H) ^! U6 [8 b
23.              }
    6 k' P) z! u+ _
24. 
    
25.           }
    
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    
28. 
    0 u9 U0 a% R. O. g4 C( R  {: S  [
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    
30. 
    * M7 X# t" B2 a! u
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    6 p% a" W! P) k0 Z6 w
32. 
    # `. b( m- j, U# K* A
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

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

+ H( O! F0 K7 y* N
测试结果：

: c$ @5 M+ Y4 o# y, R
$ T. q( C. o( @* c0 R7 P0 f反向测试结果
5 y4 K9 Z# ~% y& n" b+ [* E) J, a

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享