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

若枫

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

1. int  EQ_is_equal (double s, double t);
   
2. int  EQ_is_ge (double s, double t);
   + |0 v2 b3 ^: L) M$ M* v- w/ V% {! ~
3. int  EQ_is_gt (double s, double t);
   " V4 m9 R& R) N4 U2 H' T
4. int  EQ_is_le (double s, double t);
   : w0 e- e; b& m
5. int  EQ_is_lt (double s, double t);
   ! m, h0 {( f) h$ |0 J5 x) \3 G
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   " e, C8 w3 m, |7 S6 r8 E  u
10. double ARCTAN2 (double y, double x );
    8 |! v7 c% S0 |  P7 n+ @1 }. J  d! U
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    5 c5 v+ T# e" \& \; x% O
13. //#=============================================================
    " c" T  F0 Z. U) S; S
14. double Check360 ( double angle );
    
15. //#=============================================================
    ) O# |1 C% R  L4 n5 T
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    
17. //#=============================================================

复制代码

以下为部分源代码，用于判断，计算角度等
* R4 d9 v2 m8 K  ^3 `7 }

1. int  EQ_is_equal (double s, double t)
   
2. 
   5 i* w9 Q' _- f: ^( G
3. {
   / e* C) Z$ J/ C
4. 
   5 M! g- E) j7 y5 }( y$ K
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   8 `# u  Q( Z- I" x+ a9 c+ c
6. 
   
7. }
   
8. 
   
9. /***********************************************************************/
   9 ^8 x# h* r' W
10. 
    ! P7 a" s0 i8 q! F$ }, Y, G: j
11. int  EQ_is_ge (double s, double t)
    
12. 
    
13. {
    
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    
17. }
    ; U5 P/ B9 J# W3 M; N! [" ?. D
18. 
      G2 c" n; k) S1 v
19. /***********************************************************************/
    2 q+ X1 @# \( x9 {4 T# z, c8 z
20. 
    " J# H) v; s0 |& I% M: ?6 p) l
21. int  EQ_is_gt (double s, double t)
    
22. 
    " Q4 r6 J4 Y7 O9 f8 z
23. {
    
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    
27. }
    
28. 
    
29. /***********************************************************************/
    
30. 
    9 a  e) S' E0 M6 Y  J; C
31. int  EQ_is_le (double s, double t)
    ! R0 |4 w" \9 E% R! o  j! o$ j* J( B
32. 
    . H# I$ K) P4 g. J: [* e
33. {
    + [2 n1 t% r. i) B1 {8 e
34. 
    5 H. \; M; q4 \/ C( O! n: }
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    / Z7 D4 \+ k7 r: X# X
37. }
    
38. 
    
39. /***********************************************************************/
    ) \1 i6 O5 O5 a# ^$ t
40. 
    
41. int  EQ_is_lt (double s, double t)
    
42. 
    
43. {
    
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
    
47. }
    
48. 
    
49. /***********************************************************************/
    
50. 
    
51. int  EQ_is_zero (double s)
    
52. 
    
53. {
    + u! T/ F7 A4 l$ j* x
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    
57. }
    2 Q3 r% H4 W$ u9 h2 }
58. 
    ! W2 F. v  O  {' A* F: h) [
59. //=============================================================
    
60. 
    
61. double ARCTAN1 (double y, double x )
    
62. 
    $ Y8 w* z0 Z- b
63. //#=============================================================
    
64. 
    
65. {
    
66. 
    + |- ~4 A) j# t, W! h* @3 ?: @
67.    double ang;
    
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
    / Z8 |# t& v& _& G/ P
71.    if (EQ_is_zero(x)) { x=0; }
    
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    0 B9 C" L5 i+ \
74. 
    5 Y8 G2 X8 M7 Y0 n9 M: C) M
75.    ang=atan2(y,x);
    
76. 
    
77.    if (ang < 0 ) {
    . u! i- G" v5 Q0 }# g0 t
78. 
    
79.       return(ang + PI*2);
    
80. 
    
81.    }
    ) j" {6 |/ e! H
82. 
    
83.    return(ang);
    0 X: [* e/ w1 K& S9 M
84. 
    ! W& v. R1 h+ |8 q- K
85. }
    ' O+ A5 s6 Z5 O
86. 
    % K9 @1 P3 F% N% F) |
87. //#=============================================================
    2 a6 G. T( T! M% o8 _! Y
88. 
    
89. double ARCTAN2 (double y, double x )
    4 V' d. S6 q5 G5 j3 C, |
90. 
    
91. //#=============================================================
    3 p2 B; H5 \3 b/ `* ^
92. 
    - P! S" ~1 Y* L8 ]) x% o) T6 A
93. {
    
94. 
    
95.    double ang;
    
96. 
    3 i. ~' `9 W! C* V/ }
97.    if (EQ_is_zero(y)) {
    
98. 
    
99.       if (x < 0.0) { return (PI); }
    ) \& b4 y- j0 S
100. 
     
101.       return (0.0);
     * h" B- c' a3 T* e( c  L. {
102. 
     % e. r* c' `. c4 u7 I/ a
103.    }
     
104. 
     
105.    if (EQ_is_zero(x)) {
     ( C- O6 ]) c6 T* j. s
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     9 M  V/ M  v" r/ r
108. 
     . t: z$ |' B; ^1 `. y  g2 h9 ^6 x% |4 j( S
109.       return(PI*.5);
     ' p0 x8 P4 L) m4 w4 A8 v2 `* M5 T
110. 
     
111.    }
     # u2 |0 N; F) P, Y
112. 
     
113.    ang=atan(y/x);
     , B. F& X# ?  }2 B( E+ b% [$ t3 O3 y
114. 
     
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     7 s0 ^8 k: i8 f6 P: q( ]9 S
116. 
     
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     . F, B  O; Y7 b2 l0 `
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     " B4 H8 a; h( R( t
120. 
     * p+ R6 [5 @" ^. A
121.    return(ang);
     
122. 
     # d, {; E+ ]+ C) h
123. }
     
124. 
     ' I5 p( D% W8 ]" X4 C+ d8 g: \
125. //#=============================================================
     
126. 
     
127. double CheckConst ( double angle, double constvar  )
     7 \/ Z% n' z0 r3 @
128. 
     
129. //#=============================================================
     % T- |- U5 T9 p+ J. |) K# E; b; u
130. 
     " {/ n% ]7 \0 @% i& T3 P
131. {
     
132. 
     9 Y$ _) _8 Q5 i5 c2 p3 k" o
133.    while (angle < -constvar) { angle+=constvar ; }
     1 s6 N9 b! P0 \/ ~* \
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     $ s* `6 s1 H# U
137.    return (angle) ;
     
138. 
     ! ~& }' x6 x9 Z4 g; Z. k) Q
139. }
     
140. 
     8 ^" @' i( b& `; ~5 M1 c, \8 J
141. //#=============================================================
     
142. 
     
143. double Check360 ( double angle )
     : B' \) X3 c8 I* |* W
144. 
     : P' \0 C/ \' d* }# B
145. //#=============================================================
     8 B  R+ J$ r* ?6 {! y! v7 {
146. 
     
147. {
     
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     ( F3 L8 D# o" {# D
150. 
     1 B+ E" e; f6 O- l6 U, R
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     
153.    return (angle) ;
     
154. 
     . y7 _% w& w( T1 v, W$ F
155. }
     . z; h0 {1 D  l- ~6 J# }$ A/ j  K
156. 
     2 s% n# _5 g- E7 v* Y8 a
157. //#=============================================================
     0 p0 Z. s) R9 W! W# u3 J
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     8 x- p9 l7 t1 V; u* P3 M4 d
160. 
     ' V! I" ]9 d. m7 q
161. //#=============================================================
       L9 H- L7 C( v
162. 
     
163. {
     
164. 
     9 n9 t' O6 z% V/ K( c
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     : d* a3 y, w0 O- T) v
166. 
     $ t! O8 P$ h/ u' O0 t$ _
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     3 _: k) b+ ]' u7 B4 E
168. 
     $ o" f# C/ w  C. ~  w( ~0 X
169.    return (angle) ;
     
170. 
     6 V5 L" H: D. e% O9 D5 j6 k- o' `
171. }

复制代码

以下为摇篮5轴计算过程代码
2 A9 W8 a1 T, q; k8 Q) `8 r

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   - b2 b" `" ^  |
2. 
   
3.          j=0.; B1=0.; B0=0.;
   : h$ {; F: z* z7 m3 v
4. 
   " |- o& N( y$ \/ c7 l6 g: G/ l
5.           if (EQ_is_ge(i,0.)) {
   
6. 
     t. ]) P7 d+ _8 J9 o4 J( ~3 n. F+ \
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   
8. 
   8 J& `" b0 g; G1 M  {
9.           }
   . a9 o; R4 }# F$ }" R( C
10. 
    9 P6 q/ V4 m/ Y6 U. K  l+ y
11.           if (EQ_is_lt(i,0.)) {
    
12. 
    . L1 s6 h1 q, o( T* M# [
13.              if (EQ_is_lt(k,0.)) {
    ) \# V7 P9 O" U/ m1 x
14. 
    
15.                 B0=atan(i/k); B1=B0+PI ;
    8 |# c2 p1 U' i% W% e6 ?6 }
16. 
    
17.              } else {
    & B8 [* `2 u; Q. J% h* N
18. 
    + _$ K; s! F' U0 x) n9 h
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    * r- c$ C) v  {8 E& Z: n
20. 
    
21.               B1=2.*PI+B0 ;
    + X+ v- B5 A0 B5 Z( H: p+ O6 ~
22. 
    
23.              }
    * f0 c2 J/ ^2 {) ?4 Q
24. 
    - f! b' E0 G; y' w: o, ?
25.           }
    
26. 
    5 g7 f7 b! I: |# k- [7 @' _+ J
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    , b+ b/ x6 h7 L. x2 Z9 m  f! Y
28. 
    : U4 V& J; ~3 f' x7 `
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    6 `+ R" i/ y  R* _% ~& [2 d
30. 
    % N# i* t  ?4 r/ J. b9 t7 j6 S% j
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    . z4 u+ P0 ^. C7 i4 w: L6 l3 y
32. 
    ! A- x3 z5 v8 ^4 U; ~
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

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

" \: Y- [3 x( s
测试结果：
4 Z, S# A1 w# R) g" c
+ j6 f/ I: }" G& T8 b0 U) u: H
7 |, u, z9 b6 f8 d# T4 e2 `7 ]反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享