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

若枫

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

1. int  EQ_is_equal (double s, double t);
   ; a! m) m, Q- y* O" G1 U
2. int  EQ_is_ge (double s, double t);
   : F  Q! f) P) a# M& ~
3. int  EQ_is_gt (double s, double t);
   . S% i/ R7 l- u& L" o& Q; \
4. int  EQ_is_le (double s, double t);
   ' ?+ E, `) A7 D6 l3 F
5. int  EQ_is_lt (double s, double t);
   ! u0 @4 \( g0 M& P+ f+ h
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   4 e( T+ y9 M1 B9 h! h' {, [6 p6 \- x
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    
14. double Check360 ( double angle );
    : i6 J: ]' v! P1 k! ^) p
15. //#=============================================================
    ; K5 p1 t* M/ ^, H- h' f1 f
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    % Y( E( R( u6 Z# W1 d
17. //#=============================================================

复制代码

以下为部分源代码，用于判断，计算角度等
: E+ I& b2 I# q  I' T2 h. n

1. int  EQ_is_equal (double s, double t)
   
2. 
   
3. {
   
4. 
   
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   $ H. J* X$ w7 S4 h
6. 
   
7. }
   
8. 
   
9. /***********************************************************************/
   
10. 
    
11. int  EQ_is_ge (double s, double t)
    
12. 
    
13. {
    ! |1 k) u0 T1 k7 `7 |
14. 
    ! N! D/ F; _/ z. o) `
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    " G8 _4 C8 |  K) Q. ^
17. }
    . c- y- w: }% l2 c* R7 [$ K: ~9 b
18. 
    : X' F% T% D% t# r" d
19. /***********************************************************************/
    " K* o* P: T1 V' G7 c4 a
20. 
    3 K& }: K1 e) W) ~2 y2 E- H
21. int  EQ_is_gt (double s, double t)
    
22. 
    
23. {
    , W2 C: h7 W1 {, A' l) V
24. 
    , n( F, P& {) Z9 u3 X
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    - k: ~& N' C4 d& V% v; i6 S8 b  k
27. }
    : p( }6 b. u. i$ _
28. 
    : p6 w, J# g5 c; G, @
29. /***********************************************************************/
      k. {+ ~" w* j9 l; \& E$ R
30. 
    ! q3 \2 l# v/ [; Y
31. int  EQ_is_le (double s, double t)
    2 _( [& m2 K% [" k! W
32. 
    
33. {
    9 {+ n  ]  q- {/ {$ o' R' m8 z
34. 
    
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    
37. }
    
38. 
      g. N: G0 I3 y. F. P- \/ _
39. /***********************************************************************/
    * b8 l) f" L3 l4 Q  d8 q
40. 
    . g2 N$ F2 M1 ]4 _  a7 i
41. int  EQ_is_lt (double s, double t)
    : ~- r0 z) h9 q
42. 
    
43. {
    
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    , [/ Z. v8 j+ G* A1 I2 }8 H
46. 
    6 m# u9 l) H+ N" o$ |& X0 H
47. }
    
48. 
    ! }( Y1 \& u# E5 r
49. /***********************************************************************/
    ! {6 u  `; I7 w$ O, @) t
50. 
    
51. int  EQ_is_zero (double s)
    
52. 
      L6 w+ N, o3 _7 W
53. {
    2 T1 e3 w8 ^# ^+ {9 s
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    ' Y4 r3 y# x. a4 H: j: [5 p
57. }
    
58. 
    
59. //=============================================================
    / T; ^* j2 R5 m9 ?/ H, T
60. 
    9 Z# ^- f% m5 K
61. double ARCTAN1 (double y, double x )
    # G8 T8 s' f# c! z( a9 b
62. 
    * k3 f# ]) C8 O; c2 D
63. //#=============================================================
    
64. 
    # B7 U. E' h: d& ^7 s! M& ~; E5 W& \) ?
65. {
      f& c/ Z5 b  m4 A" V
66. 
    
67.    double ang;
    
68. 
    8 A- D$ n7 @" k  x
69.    if (EQ_is_zero(y)) { y=0; }
    / h) ?* r# \' C" ^
70. 
    5 K4 b- Y$ u  J- ]1 T8 S
71.    if (EQ_is_zero(x)) { x=0; }
    2 i; n* d' a' W8 M. n
72. 
    $ y# s9 ~7 j2 |( z' d1 X
73.    if (y == 0 && x == 0) { return(0); }
    
74. 
    $ h* V- a" B7 N$ k0 D9 B  j
75.    ang=atan2(y,x);
    
76. 
    
77.    if (ang < 0 ) {
    
78. 
    ! e& L  g9 ~: ?9 B  ?* z
79.       return(ang + PI*2);
    
80. 
    
81.    }
    8 ?- D6 L- }4 P$ m5 u
82. 
    
83.    return(ang);
    / J2 O- u0 Q8 }  L( ^: u0 K
84. 
    9 L; I( G$ R; d. b1 r, E
85. }
    
86. 
    4 f. B7 J" n! j. a6 h
87. //#=============================================================
    * `: A- M8 m, P) v1 C
88. 
    6 G3 G& [! L2 b: |7 X" Z1 O8 {
89. double ARCTAN2 (double y, double x )
    ' a& M( V4 U, d9 D6 J0 [% h
90. 
    , {! p3 z. h0 U. q
91. //#=============================================================
    - Z' b3 `3 r% r' y$ x$ \
92. 
    
93. {
    2 V+ q' b4 `$ T/ y: _" p- y+ \
94. 
    " p4 p" Q% l, D7 V: }7 C
95.    double ang;
    
96. 
    # P6 \5 K7 E  K7 M; X- G7 G* H2 N" ?
97.    if (EQ_is_zero(y)) {
    0 K& ^' ~, V( m* r+ U9 D
98. 
    2 m1 A' G- l) C
99.       if (x < 0.0) { return (PI); }
    
100. 
     0 ?4 I7 P( s, Q) ~
101.       return (0.0);
     
102. 
     - y; L: I0 _: _% A# C' @# N& B6 U
103.    }
     
104. 
     
105.    if (EQ_is_zero(x)) {
     
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     1 @" F. r% O; r( B( f
108. 
     
109.       return(PI*.5);
     ' j8 k; j7 f) k  A& l  r3 s0 N* g9 Y
110. 
     # |2 o4 C" l5 F' f2 @- e2 M9 _
111.    }
     3 K" D7 x5 D, r" f% ]
112. 
     
113.    ang=atan(y/x);
       N; v$ e4 Y7 Z6 K
114. 
     ; h1 b% p8 A) U1 m  u; M7 q
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     
116. 
     6 a' X& ^: [7 m! l; e# m- Y
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     ) x6 H! A9 q. N0 m
118. 
     ( N1 I1 ^! v4 ^4 ]' E' `
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     
121.    return(ang);
     % L7 a3 Z% E3 `! h6 z' i
122. 
     9 j/ c3 x) q) J: a2 l3 O0 }
123. }
     $ J6 x9 o+ o7 h& x8 F% ~
124. 
     1 V- e0 P5 r4 ]( Q5 u
125. //#=============================================================
     
126. 
     
127. double CheckConst ( double angle, double constvar  )
     
128. 
     * e! Z- T6 l4 D  V8 T  {
129. //#=============================================================
     . R  u5 D9 \+ Q9 t1 H2 N9 @
130. 
     
131. {
     4 g" f9 M* n( C9 F
132. 
     
133.    while (angle < -constvar) { angle+=constvar ; }
     $ d" T5 ^% i# U9 w
134. 
     7 k# c2 e6 A5 V2 V! x, \+ i- D0 l
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     
138. 
     
139. }
     6 b4 g6 R; \  C  z
140. 
     4 i+ m) s5 X; e! m( B
141. //#=============================================================
     
142. 
     
143. double Check360 ( double angle )
     9 _* X% A. }' Z' m% q" p0 n# q# {, ^
144. 
     4 K; b6 g( p% z
145. //#=============================================================
     6 o4 s% y& J& `1 ]
146. 
     
147. {
     ( Q4 i9 s9 F8 s. v1 T
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     - t5 c" ?$ O! x! q& s$ ~
151.    while (angle >= 360.) { angle-=360. ; }
     / b' p, H3 w' T3 L1 Z# D1 l0 z
152. 
     3 b8 d0 G0 b( ?) A5 l# u
153.    return (angle) ;
     
154. 
     
155. }
     
156. 
     ' j3 x4 g# c% \1 B" `+ c6 B
157. //#=============================================================
     
158. 
     " y8 {# D7 e' }6 X/ v* u
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     / {% k: \" w$ P8 H4 M
160. 
     0 c2 H& |' z5 z
161. //#=============================================================
     0 x) J3 J! {# J
162. 
     
163. {
     / Z( Y3 }( `( V( w" g/ w
164. 
     0 o+ e! z2 r, W( d
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     # y" Q9 f2 p- ?* a: Y0 l5 L
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     7 L. o; n1 q4 h" x: D# t
168. 
     ; M1 S; _9 @$ K
169.    return (angle) ;
     
170. 
     
171. }

复制代码

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

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   0 i  K" r& ^  a
2. 
   ; K/ O7 s1 d  E8 E8 ^" R. H: P
3.          j=0.; B1=0.; B0=0.;
   , m2 _; t- L) s( U; \
4. 
   ( Y+ f/ Q2 W- v7 h* V- t9 w
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; }
   . c% {9 d- r3 l5 V' N
8. 
   
9.           }
   
10. 
    # e+ d8 O1 t/ `9 i+ m. ^9 [/ \1 ]
11.           if (EQ_is_lt(i,0.)) {
    6 C$ i) Q  _" Z" x, Q6 {
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    , U8 m. F3 S9 V( X. T
14. 
    
15.                 B0=atan(i/k); B1=B0+PI ;
    9 M# V3 e) ]) G1 [3 ~
16. 
    
17.              } else {
    
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    " C- F# i' ]1 R% Y: B1 l3 d" O' `
20. 
    
21.               B1=2.*PI+B0 ;
    
22. 
    
23.              }
    : D& P: `) K# S' Z
24. 
    
25.           }
    / w/ y- j1 X5 r! m; I4 a; g
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    9 f# K2 Q% N9 v$ g( e
28. 
    
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    
30. 
    
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    - `+ I' O9 T  M" d% t, n+ \
32. 
    
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
8 L$ K: |$ a; z4 D; G/ S! L

% S5 x1 H5 _0 c6 R6 h测试结果：


" J, u/ \( a$ T8 E! x' f反向测试结果
3 E) d' F/ J5 G. ?$ r

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享