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);
   3 t0 }" D0 H! w$ Y9 |2 ]9 h/ D
5. int  EQ_is_lt (double s, double t);
   1 X1 t# H$ }/ V+ v/ o
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   ! ^3 n. l- a& h5 a
8. double ARCTAN1 (double y, double x );
   % p2 l0 P# f/ e% ]$ ~  ^3 c  L& L
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    8 C! {* g6 u9 ^2 y
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    6 i* m) D9 o4 T# E
14. double Check360 ( double angle );
    ' ?) h  |& q- d
15. //#=============================================================
    + H8 N6 ~& T5 r2 l: v( R
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    
17. //#=============================================================

复制代码

以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   
2. 
   
3. {
     m, y% Q0 u) r: Q, s
4. 
   5 Y- a6 B, y. D* w' e  A
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   # ?' l5 M8 z1 \# H3 Y
6. 
   + [5 U/ z! E8 A& P  j+ M
7. }
   
8. 
   7 Y0 ^5 l6 N* ~6 H. E) J! x% V
9. /***********************************************************************/
   
10. 
    7 [. C+ H0 V% H' X0 E, `3 O
11. int  EQ_is_ge (double s, double t)
    
12. 
    ) T/ c7 Z, v' x) b0 q
13. {
    " T: I  G2 x6 f3 t. \, K
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    
17. }
    
18. 
    
19. /***********************************************************************/
    
20. 
    
21. int  EQ_is_gt (double s, double t)
    & b; y1 S8 Q* J9 ^# M
22. 
    0 a' A5 a$ p; ]! C$ \. ?* U. K( ]: [
23. {
    / S7 x1 N# D8 c. F9 \  f
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    # b' g* ^5 C" [
27. }
    
28. 
    
29. /***********************************************************************/
    9 u, S6 U% t" }0 G5 Q. b
30. 
    % V" {5 E5 ^2 T7 W
31. int  EQ_is_le (double s, double t)
    / N& S# G! o1 e8 w+ o/ H
32. 
    , L0 _  \! k( z+ ?: z
33. {
    / l, Q2 R* [) y4 g8 O' C
34. 
    
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    0 E& y1 k% |  F# B6 o" d
37. }
    & y& ]. j6 ~# @5 j" B
38. 
    ' a6 @7 _0 [+ L$ @+ ?% F* V! o
39. /***********************************************************************/
    
40. 
    
41. int  EQ_is_lt (double s, double t)
    , h7 k' H" S0 ]/ S7 M
42. 
    
43. {
    1 c7 v3 i+ h; ]2 L
44. 
    : P" r7 j% m: d9 M
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
    # X* {% F  K8 i; K, r! z, R2 K
47. }
    * V/ N" S2 n* S! b- s
48. 
    & ]6 [( r  _' M# [( }9 A6 Q$ ]
49. /***********************************************************************/
    
50. 
    
51. int  EQ_is_zero (double s)
    $ h: f# ^8 o1 K0 B8 G. t
52. 
    
53. {
    
54. 
    5 f$ y( [% k' v4 n3 R3 `
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    1 r6 s- F4 [/ ?. S  k
56. 
    - [( h' U% k2 _9 L. R
57. }
    
58. 
    
59. //=============================================================
    0 u% d2 ^  h, F1 F; n
60. 
    9 ~* n/ `, V, Q4 n
61. double ARCTAN1 (double y, double x )
    
62. 
    
63. //#=============================================================
    % e" R+ q& B9 `2 H# d0 N' i% w1 N
64. 
    * Y  @; c* v! b! `+ q0 {
65. {
      r! c9 m# C/ ]/ W0 z
66. 
    
67.    double ang;
    
68. 
    ; c0 }0 V% w8 T( o+ {5 F: J
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    1 r  F8 d6 _7 v9 w" r: K
74. 
    ! E4 o" |2 V- Z( J/ A
75.    ang=atan2(y,x);
    
76. 
    + Y! _, O. q6 H2 n
77.    if (ang < 0 ) {
      b  G6 d/ G/ c! ]* u
78. 
    
79.       return(ang + PI*2);
    1 u3 u4 y9 g3 Z5 e4 ]$ J5 W) A1 [
80. 
    
81.    }
    8 U$ L3 a4 m- t  P9 ~# l  T9 t! z
82. 
    $ [) t7 }2 ~' Z  g' x0 t2 a6 p6 b8 T
83.    return(ang);
    + ^. v$ b, ~. ?# K: v7 E
84. 
    : o2 j2 m. t, b$ Q$ O# ~
85. }
    
86. 
    7 r1 ?9 n& L) T7 O: W
87. //#=============================================================
    
88. 
    
89. double ARCTAN2 (double y, double x )
    
90. 
    + t! ?+ Y" r  v# k* D& Z5 ^) ^
91. //#=============================================================
    8 b5 f9 p6 B9 F( Q
92. 
    
93. {
    ) @+ S8 `4 i! a& q) f4 Z
94. 
    : F% H* q8 X9 P5 ^. h3 p4 ~& k
95.    double ang;
    
96. 
    0 R  f# A+ g+ `0 D
97.    if (EQ_is_zero(y)) {
    1 ]% {& R! I) s3 k
98. 
    
99.       if (x < 0.0) { return (PI); }
    
100. 
     / j1 p! f: L+ u  U9 @
101.       return (0.0);
     
102. 
     ; L2 E+ t0 v# a9 A; U5 }# ]
103.    }
     6 q% Q7 E& X( y2 r
104. 
     
105.    if (EQ_is_zero(x)) {
     
106. 
     9 {9 {; _" r7 h& ~! D4 G+ R$ b: i- x% K
107.       if (y < 0.0) { return(PI*1.5); }
     % j5 A  V7 Y, c( a
108. 
     
109.       return(PI*.5);
     
110. 
     
111.    }
     
112. 
     
113.    ang=atan(y/x);
     1 c# f* q* E0 M! o! ?# ~, l) q& H  v
114. 
     / C2 a- e- T& x; [" m: e" r
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     ) l0 e; J) m- J0 ~+ i
116. 
     # x4 y0 T* H( {0 L5 C
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     + J( g2 e. A: S; g: }9 f
118. 
     : N+ o/ K3 i8 T) e5 F- g
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     
121.    return(ang);
     % a8 |8 ]! w9 g
122. 
     * k3 E$ G% M- F0 N
123. }
     1 {4 W3 f! h; R. ?8 `# Y( K/ [4 p
124. 
     * H. z, P' J/ A) C1 \$ l! w/ \
125. //#=============================================================
     ' V  x3 w- _5 X  q. {& v
126. 
     1 g2 ~5 F1 {2 C" n$ i3 l4 I8 q
127. double CheckConst ( double angle, double constvar  )
     / n7 u+ e. k6 d
128. 
     " W2 z- H4 @* l
129. //#=============================================================
     
130. 
     + m8 k5 s( D( I) k" Y
131. {
     
132. 
     
133.    while (angle < -constvar) { angle+=constvar ; }
     
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     
138. 
     4 ~; g. p# K9 g% {
139. }
     
140. 
     1 [/ K# `8 w  ]
141. //#=============================================================
     * ~( i" K* T) q+ T0 Z. G* Q- ]) d1 {
142. 
     
143. double Check360 ( double angle )
     
144. 
     * h  @$ @8 a& t. p
145. //#=============================================================
     0 v$ C; J* U, {. p, T5 C- k
146. 
     . C) V+ i% y0 L5 A- |# B) r; @' ]& T* _
147. {
     
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
     ) g/ ?/ Q* m! ]% |4 ^
152. 
     $ K' S' g7 h, C" ^
153.    return (angle) ;
     ( f" j: c7 `! {+ Z
154. 
     - w/ }0 A/ ^8 N+ }
155. }
     0 q% x, j$ v, Y4 {; Z0 e" X2 r
156. 
     
157. //#=============================================================
     6 Q4 v! w! _1 ^0 @* U5 i7 A, s, Z( _
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     
161. //#=============================================================
     
162. 
     
163. {
     9 e. r! a; @% K" }* x6 Z
164. 
     
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     # I1 Y3 q0 `6 n
166. 
     $ M4 L8 p0 L8 [* n& v! O
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     " }% Y2 N/ B1 W! Q% L
169.    return (angle) ;
     
170. 
     
171. }

复制代码

以下为摇篮5轴计算过程代码
2 }! ^% v* v& N3 c1 K, v

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   
2. 
   ( k, A) w2 B, L) M1 u
3.          j=0.; B1=0.; B0=0.;
   
4. 
   
5.           if (EQ_is_ge(i,0.)) {
   3 I% Z. X# R) }
6. 
   # h0 A; U8 ?/ r8 B( P3 ^
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   
8. 
   1 r6 P, a; a/ E6 N. Q# N
9.           }
   4 `# n! N5 S0 ~# T% y0 [1 o& ?
10. 
    * l6 ^# a$ d& Q) J( Q& c
11.           if (EQ_is_lt(i,0.)) {
    
12. 
    ( d( Y5 \2 h4 {. u. p4 A1 r; V/ p
13.              if (EQ_is_lt(k,0.)) {
    & w% b5 m% J& U
14. 
    ' G* e7 n7 Q. J2 _3 U5 H6 {& }+ ]
15.                 B0=atan(i/k); B1=B0+PI ;
    9 Y! O/ [, e; N" ?- \3 M
16. 
      i3 i. {& L" M' I
17.              } else {
    
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    * g* v$ \2 U  K! [" d# K
20. 
    7 l7 p% }& ]8 B! i% L+ q2 N
21.               B1=2.*PI+B0 ;
    , q' f- r+ q2 |0 @
22. 
    
23.              }
    
24. 
    
25.           }
    
26. 
    6 o7 ?) F! O6 h; |
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    : p8 b! `- k6 d, Z' c! N/ s
28. 
    / L# h, i' ^1 S0 k4 H
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    5 \0 q$ [- F2 n! a
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.;

复制代码

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


9 f6 X: R! f. T. g1 M* j测试结果：


; Y) a& a8 f5 H反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享