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);
   . a- W$ }# I, G% o
4. int  EQ_is_le (double s, double t);
   2 ]5 x+ c5 G" E6 O$ M  I
5. int  EQ_is_lt (double s, double t);
   8 y2 F% z- L3 M: n; x
6. int  EQ_is_zero (double s);
   6 j1 e5 V0 V1 w
7. //=============================================================
   0 _! m  m' ?3 h  C3 @) K& ~
8. double ARCTAN1 (double y, double x );
   + k2 l8 ?: x* S3 C; @0 c- [/ o
9. //#=============================================================
   4 Y! r9 i% n+ C  G" h8 R  R. w
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    5 c9 y' a7 l3 U
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    4 T" t! j& w: J( |. c( R
14. double Check360 ( double angle );
    
15. //#=============================================================
    ) f7 C* _% Z/ U" j( M) L
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
      C( B" c+ ~5 k$ y# C1 t
17. //#=============================================================

复制代码

- c- K% ]5 `6 }" [" S# v以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   5 O  t3 g- q6 c7 J  s
2. 
   
3. {
   
4. 
   / q( C) L! D6 e, U* R; _9 a6 w! V) `
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   
6. 
   . e% J* ~7 J: Q. a/ s6 E
7. }
   
8. 
   
9. /***********************************************************************/
   * `7 Y+ ?1 v& p( x
10. 
    . f4 y$ p3 T# R1 u0 ?4 m" C5 P5 ?
11. int  EQ_is_ge (double s, double t)
    ; i, U# L: n6 j+ C# p
12. 
    
13. {
    # ~8 G+ J# A$ B6 ^( u8 E; g
14. 
    ' Q$ T/ g4 F. H
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    " i$ L$ \5 d, l& o- ~8 S1 [! _6 R
16. 
    4 u4 V3 f% m# C7 R+ f2 u5 z
17. }
    
18. 
    ' A* x: X3 w( h( O7 o$ x: V
19. /***********************************************************************/
    $ }6 ?; c8 C. C' `% i3 r
20. 
    
21. int  EQ_is_gt (double s, double t)
    & v( s+ t. o3 D3 G+ T0 j
22. 
    4 @+ b- ^; l* k7 P2 K0 r
23. {
    3 q( H$ z6 R1 v, n, T8 k4 a
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    
27. }
    / A. B/ t8 g' I: O
28. 
    
29. /***********************************************************************/
    
30. 
    
31. int  EQ_is_le (double s, double t)
    
32. 
    9 o$ l4 I. x7 `% d( k) ]: _
33. {
    
34. 
    * V; z* f1 ]3 ?
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    ! y( n" U, B: A
37. }
    ) [! r; D) x4 [  U/ C8 E
38. 
    
39. /***********************************************************************/
    4 j* |: {! Z" V5 y+ s/ N" N8 d
40. 
    
41. int  EQ_is_lt (double s, double t)
    
42. 
    
43. {
    
44. 
      r& o) j2 C: r) }: g4 e" U
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    + B+ l4 s) [6 c2 ^" S
46. 
    
47. }
    6 p8 j! A' ?2 O( w: I* P
48. 
    
49. /***********************************************************************/
    7 E2 g( l, Z/ |  y+ `
50. 
    
51. int  EQ_is_zero (double s)
    
52. 
    
53. {
    
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    3 l7 \5 m" O( e
57. }
    ( S: x3 q4 n+ f, a0 W
58. 
    1 J5 m3 C/ b- }
59. //=============================================================
    8 v0 @; ?& D3 q, O2 N! V
60. 
    : u* l, u! y3 b5 b+ }+ M0 u
61. double ARCTAN1 (double y, double x )
    
62. 
    $ h+ J3 A/ S6 Z7 D7 ?
63. //#=============================================================
    
64. 
    . q  j4 d0 R  S+ O
65. {
    + e4 W+ B, O' S) ~+ N# [
66. 
    
67.    double ang;
    ! O, c0 C. I3 l3 B' ?/ q. E
68. 
    * U% _6 O, F: [, x2 F" M
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    , H5 T& E& B# c) h5 H. {
72. 
    / e1 a! e& R5 f, a% u% |0 V
73.    if (y == 0 && x == 0) { return(0); }
    + e' ^( T, w4 Z
74. 
    5 {+ L. ?* a5 l% i4 [
75.    ang=atan2(y,x);
    / M5 L2 A' e" {4 G3 _/ y* r
76. 
    
77.    if (ang < 0 ) {
    
78. 
    , f1 Q+ e( T$ f7 t
79.       return(ang + PI*2);
    
80. 
    
81.    }
    
82. 
    
83.    return(ang);
    
84. 
    ; n6 S6 g7 r- L* q
85. }
    
86. 
    
87. //#=============================================================
    8 J3 f- H; l% a2 y
88. 
    
89. double ARCTAN2 (double y, double x )
    1 S# @: P: H! @# T& @( q$ j0 |
90. 
    
91. //#=============================================================
    # d, _6 H1 l& e- i7 e9 ^, v# Q# ~5 v
92. 
    ' {0 G4 p: s& o, ^
93. {
    . k( M% ?5 z/ m
94. 
    
95.    double ang;
    4 l+ B8 h2 m! ~# A* q3 `
96. 
    ; {: F9 s+ I- A1 k. ]
97.    if (EQ_is_zero(y)) {
    8 a1 [/ ?! G- ]' Q/ J. m
98. 
    : p% G9 t) k0 e0 w
99.       if (x < 0.0) { return (PI); }
    ; W; [1 a0 g4 G; E2 S" R' x
100. 
     8 F! e6 w; R1 m: l4 j8 |0 M4 n
101.       return (0.0);
     
102. 
     
103.    }
     & `% I6 [5 V7 e
104. 
     4 L( v) ~9 h- y8 k' {9 n# E1 l
105.    if (EQ_is_zero(x)) {
     " o8 c; u6 \2 V8 R9 V4 G
106. 
     , Z1 Q1 N# P4 O
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     
109.       return(PI*.5);
     : ]% z, c5 R* k/ b5 i0 b
110. 
     
111.    }
     4 `. y: Y/ j( \' F2 p
112. 
       |; m1 A( ^5 S7 y$ T
113.    ang=atan(y/x);
     1 b$ x! C2 m" ?
114. 
     8 V' l5 g4 |3 K
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     # W' f( o% ~- H8 N0 Z& `' ^
116. 
     + ^- t4 m* ?- B7 [9 S
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     
118. 
     6 j  q: F8 T: x, C$ ?; c) t0 }
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     3 u$ X: i8 _7 v9 F. v6 i) _% C# d2 P
120. 
     
121.    return(ang);
     
122. 
     5 J7 g. _( F5 G
123. }
     ' m" Y; Z2 F6 P: I
124. 
     
125. //#=============================================================
     ( G( i, U- o3 P# W$ }9 W  j5 z8 P
126. 
     ' d: b' s8 D8 O. o2 P$ z
127. double CheckConst ( double angle, double constvar  )
     
128. 
     
129. //#=============================================================
     
130. 
     
131. {
     
132. 
     ! Z5 H' f( y7 K1 F4 ~
133.    while (angle < -constvar) { angle+=constvar ; }
     
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     5 t0 X2 X. R8 A8 m* X% ~
137.    return (angle) ;
     
138. 
     # Y8 K/ }* D5 }5 _) ?
139. }
     
140. 
     2 X7 s- [4 T  r( I
141. //#=============================================================
     $ n; t& h0 [- Q
142. 
     - }5 C! E# I; _' D; r! n: Z
143. double Check360 ( double angle )
     7 b3 Q- N8 i6 B
144. 
     ! L- i) Z: i* ~2 V; W, X- i; c
145. //#=============================================================
     
146. 
     
147. {
     
148. 
     & t- _% C3 c- `+ m( |, Z2 Z. D
149.    while (angle < -360.) { angle+=360. ; }
     7 S+ M) H+ Y  ^- t% w$ P
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
     . ?; p9 i. Q% V
152. 
     
153.    return (angle) ;
     
154. 
     # e4 o/ @7 M# @" e% \! ?
155. }
     7 N* ?, }  A8 W( E
156. 
     
157. //#=============================================================
     3 t# `$ P2 A2 h" }' c
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     ( G5 O& _! O3 q* G8 T) P+ ~+ A
160. 
     
161. //#=============================================================
     
162. 
     
163. {
     . J9 l: r/ e# v3 p# a; y9 w
164. 
     ! a, J3 _5 _, w' I$ M5 n7 W* i
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     
169.    return (angle) ;
     ( S9 ]3 j# n* m" k
170. 
     
171. }

复制代码

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

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   
2. 
   + X" ?) i6 l- R  s0 a" _
3.          j=0.; B1=0.; B0=0.;
   ; M/ E' s: ?2 P# K2 }7 |! m5 S) @
4. 
   $ d2 O: n9 ~* I
5.           if (EQ_is_ge(i,0.)) {
   $ y; _" m/ y3 }* I+ B; F! ^
6. 
   4 \, I! @1 N+ A/ B8 A: X
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   2 u) _& ]5 m1 ], p  O5 d4 H
8. 
   7 @; Z( |8 t8 ?: N
9.           }
   
10. 
    + ~% z' ?* d" Z$ z5 K9 H
11.           if (EQ_is_lt(i,0.)) {
    
12. 
    3 @- N6 d" k( K0 h5 f0 i( o# g$ L& D
13.              if (EQ_is_lt(k,0.)) {
    
14. 
    
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    - L) ]$ m0 {  T* [! c! Y) n
17.              } else {
    
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    4 s7 C8 z5 m4 H' h
20. 
    
21.               B1=2.*PI+B0 ;
    
22. 
    + c1 W+ V+ k4 Y5 u: S
23.              }
    
24. 
    6 }3 [9 n" g* d& P
25.           }
    3 X: I" ^* }8 `, x4 N) H5 d* b' {
26. 
    ) E4 A1 B  W+ J2 o: n" O% u
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    % h$ X" {, p/ `1 P9 v5 h- I
28. 
    / s$ |2 f6 a1 G; o) C  D2 P& z
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    + X* a* V- F, B8 C; U
30. 
    
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    
32. 
    , G) ^4 S1 [+ N( `* h
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
" [, M* n$ [" r" a& i) R

测试结果：
4 ?/ X# ?4 l; o5 q/ J8 n. |7 Y) v
( Y  ]2 d% Y4 c* K$ f8 O& E9 _
, |; O: E% S* g8 C反向测试结果
- N. M0 F( d" `8 z: a" n6 h; R+ o

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享