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

若枫

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

1. int  EQ_is_equal (double s, double t);
   
2. int  EQ_is_ge (double s, double t);
   ' v7 g* K( S0 Q3 W
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);
   
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    3 F+ _, ?# S! Z( o: x* U3 z5 R# [9 [7 Z
14. double Check360 ( double angle );
      q; ]' {1 G7 f) e
15. //#=============================================================
    7 z7 T1 w! v2 x
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    , z& m. B+ m' [' m5 i9 _: Q' U  i1 n
17. //#=============================================================

复制代码

: f, Z; X! E* [. S以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   9 V- ~" b+ w  A
2. 
   
3. {
   0 q7 I) M6 t8 R3 C- J" o
4. 
   - t. d4 d* A1 ]! C
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   
6. 
   4 @3 D: J6 t# K$ `
7. }
   
8. 
   
9. /***********************************************************************/
   
10. 
    
11. int  EQ_is_ge (double s, double t)
      n& @7 A' @. x4 L
12. 
    , r- N, B4 |  L3 I+ a! O& e
13. {
    
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    3 F8 R" }% V- y0 n
16. 
    2 b+ g( c' C* M6 O& `/ z
17. }
    9 ~: K! |- `# ]; B# S
18. 
      Z  H  ~6 Z5 `
19. /***********************************************************************/
    3 t0 l; D% @% A: h8 c' U) t0 x
20. 
    
21. int  EQ_is_gt (double s, double t)
    " L! @! A% y! z8 g0 R& a
22. 
    . C* g  a0 y# ?7 F  A
23. {
    
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    - Y7 Q7 u4 w: Q
26. 
    
27. }
    
28. 
    
29. /***********************************************************************/
    ( S5 `+ B( y. S8 T
30. 
    
31. int  EQ_is_le (double s, double t)
    
32. 
    
33. {
    
34. 
    % x- X3 ]. s& Y# e6 I; n
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    9 E  X9 G% @* g6 m
36. 
    
37. }
    , Q5 F3 ?1 E6 t: l
38. 
    
39. /***********************************************************************/
    & D5 x+ J  m; h
40. 
    
41. int  EQ_is_lt (double s, double t)
    
42. 
    
43. {
    
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    ) E# v. f, G/ P* j' W! X0 U
46. 
    ; d. R0 X9 I4 d5 A' |. ~
47. }
    
48. 
    5 i6 D# ~  |! J$ Z8 {2 H( J" y
49. /***********************************************************************/
    4 {5 j* j  V( [
50. 
    
51. int  EQ_is_zero (double s)
    & O2 l, ~+ W" j
52. 
    ) C6 D+ A( ~/ c
53. {
    
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    8 i: k! v# P2 E
56. 
    
57. }
    % b5 \( m4 v( [7 f1 l3 j) Q
58. 
    
59. //=============================================================
    " ~! g" Y6 u; e  S/ U9 F% x" I/ ^
60. 
    
61. double ARCTAN1 (double y, double x )
    5 w& T: F8 n3 @2 k2 R& u2 B/ G8 {
62. 
    % J  }8 \, {9 g
63. //#=============================================================
    , q% b6 x! @% T
64. 
    
65. {
    
66. 
    
67.    double ang;
    2 z4 w. f' T) n9 v" l& [( I! {
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    $ q  Q, }4 ~7 h( _
70. 
    * f2 e* B; [- z6 m/ s, M
71.    if (EQ_is_zero(x)) { x=0; }
    ! I3 C8 T4 N& h  I! H9 U: W
72. 
    6 z- D/ H. p; E( E5 p) @7 _- X/ V4 L, N
73.    if (y == 0 && x == 0) { return(0); }
    
74. 
    
75.    ang=atan2(y,x);
    
76. 
    ; c# O& ]) A, C$ p+ i
77.    if (ang < 0 ) {
    6 X9 X' p$ n* b$ v+ j
78. 
    
79.       return(ang + PI*2);
    
80. 
    
81.    }
    9 w# r" S/ k! @! G; L! l
82. 
    
83.    return(ang);
    
84. 
    
85. }
    
86. 
      y$ i% s6 m: \# R; G. {
87. //#=============================================================
    - R9 v$ q6 `& b+ {) x9 J0 S. q7 L6 R
88. 
    
89. double ARCTAN2 (double y, double x )
    
90. 
    
91. //#=============================================================
    8 \+ [# J. F) @- S( J7 q
92. 
    
93. {
    
94. 
    
95.    double ang;
    + F- V" `' v8 E. V7 M0 {
96. 
    3 i. N8 y) ]0 H, A. n! l' ^
97.    if (EQ_is_zero(y)) {
    
98. 
    " J; C6 w6 C+ t) s! m8 C. g% a
99.       if (x < 0.0) { return (PI); }
    
100. 
     9 u$ I( l( D7 P2 _
101.       return (0.0);
     $ r9 _! {9 |; x- d3 h
102. 
     
103.    }
     
104. 
     
105.    if (EQ_is_zero(x)) {
     
106. 
     2 Y  i9 V1 G+ x4 t, ^
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     
109.       return(PI*.5);
     
110. 
     
111.    }
       t) x- D8 O# o8 J8 _0 T! a% j' Y
112. 
     
113.    ang=atan(y/x);
     
114. 
     
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     
116. 
     
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     2 W5 B/ D$ P! [. T2 T7 A
121.    return(ang);
     
122. 
     $ A7 ]% C1 P: y4 c$ X5 Y2 ?
123. }
     . \$ C. g: w7 J0 P& A& T
124. 
     7 F+ e/ C( ~% o( @6 e% f9 N
125. //#=============================================================
     
126. 
     
127. double CheckConst ( double angle, double constvar  )
     ; K2 x& y0 a) j6 \7 n* H( M
128. 
     
129. //#=============================================================
     0 m. t4 e! w* q0 n9 x7 [9 b
130. 
     4 E" h! i8 U7 `+ {6 o
131. {
     
132. 
     ; B& T/ Y1 K9 |) d7 y3 o9 A9 T+ E
133.    while (angle < -constvar) { angle+=constvar ; }
     / `  G9 @# T) _. a/ X$ r
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     $ {7 _) s0 |1 S- F
136. 
     6 ^4 P; C+ i5 P# R3 @4 @
137.    return (angle) ;
     
138. 
     
139. }
     
140. 
     . W: Y5 Z' C! M4 k
141. //#=============================================================
     
142. 
     3 T  U. ^9 }4 D! c3 r1 B5 v
143. double Check360 ( double angle )
     8 y7 R2 j. [; v' G2 a- o( i
144. 
     . W5 v, x% w) }3 b& }; j
145. //#=============================================================
     4 x' T0 Y% y* }
146. 
     
147. {
     
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     % h3 [7 X6 ]8 H3 Y- K; N( |8 `
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
       [% e0 H: ^' y; D- g; Z
152. 
     0 t5 o. f  {. k1 s/ m) C
153.    return (angle) ;
     ) |) D$ `9 T7 H. f
154. 
     ( M* P6 I) ]4 {4 C
155. }
     ! T' n$ i+ c0 d9 L7 K& V0 _
156. 
     : C! m+ y8 M: U4 v5 w
157. //#=============================================================
     9 ]# H0 S6 U# ?- K3 h* L
158. 
       l" f2 z& \$ n; @$ p
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     
161. //#=============================================================
     
162. 
     ' p# J$ V* t4 `, T5 f3 G
163. {
     * T! K4 }  Q0 s# G. [+ n9 u+ u$ p
164. 
     
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     ' r) O- n! y; I6 [8 T0 i5 n
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     " I. Q! U: k' c7 ?8 C  Q2 z9 {$ F
169.    return (angle) ;
     
170. 
     
171. }

复制代码

  v  a7 W7 O0 e! G9 i! p3 g; v以下为摇篮5轴计算过程代码
9 x- {5 t6 s1 W

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   
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. 
   4 |6 U2 I: Q8 l' B
9.           }
   / j' v. N' m8 U' J, R1 b/ Q
10. 
    
11.           if (EQ_is_lt(i,0.)) {
    
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    1 ~, \' W9 Z1 _5 v; K! s* H
14. 
    
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    " T: j' D8 w( `
17.              } else {
    9 g2 L$ ], u1 y' V3 M9 `6 E
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    
21.               B1=2.*PI+B0 ;
    * c5 z4 n: t: \6 E, n' J$ H
22. 
    
23.              }
    
24. 
    
25.           }
    * A& S* T4 W/ m8 u
26. 
    6 h' a0 b& E+ O  L2 _
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    
28. 
    + ?& w( z& `  }$ s' f; ?4 x8 t
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    , N( w7 b; C6 |) @: `% [% G
30. 
    2 d8 Y. r* D! f
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    5 L$ W- t- n. w  W$ L  u
32. 
    
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

4 k7 K) W/ W% s! Y0 m* T% n通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。


# C) [! F6 O/ O* J$ a, k: T! ^* F测试结果：
) A: e# e+ d: W& H0 ?

反向测试结果
' |2 E# G! n8 o8 d  u

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享