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);
   2 a; ^6 \2 T5 v! m- W6 @
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. //=============================================================
   * N, h2 ?! K1 }+ P! u9 E
8. double ARCTAN1 (double y, double x );
   ) ]4 x  v6 F* ~3 I, m8 m
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    ! z  I5 t; T: A9 u; S0 W  ^6 P
13. //#=============================================================
    
14. double Check360 ( double angle );
    
15. //#=============================================================
    ) ]. @' S6 t' G3 H3 x
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    ( d, x0 k1 w) t/ b  S- o2 O" i# s* e/ N  ]
17. //#=============================================================

复制代码

: y' R0 z' X% u# m% N以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   , K  s( g9 W/ z+ G: M
2. 
   
3. {
   8 X, Z8 g, b0 W$ j! C: k2 W: l
4. 
     G1 F8 w2 Z/ o& U
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   3 _3 m3 K0 m3 f* ~
6. 
   
7. }
   $ H- |" h1 s  r  t4 L) X
8. 
   ; Q; R6 N7 S. s7 k7 P5 U2 ?* \
9. /***********************************************************************/
   ' x+ S% C: o5 }2 [7 x5 t8 t! H
10. 
      G* \; v# B; a* h- W& i: o
11. int  EQ_is_ge (double s, double t)
    
12. 
    * e: H; D, l  ?3 k; @
13. {
    4 M9 k4 O- z& f+ Y( `3 T" f
14. 
    $ \, ?' H& B: D) \
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    # J& j4 O  f) q( w! u1 ~
16. 
    3 C4 p; X% _* c$ R- h) U" E) P
17. }
    
18. 
    " O5 Z& F6 _" P/ u+ v5 V6 t- ^
19. /***********************************************************************/
    
20. 
    
21. int  EQ_is_gt (double s, double t)
    3 O3 M4 r1 Y6 L$ {, N5 w
22. 
    ! _. _7 X  {" f! n/ Q$ U
23. {
    ' F: B) X5 A) K: h3 C
24. 
    1 `+ y& Q9 R: X$ L! w2 g
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    
27. }
    
28. 
    % F) K( q' `: B5 J5 J* e
29. /***********************************************************************/
    2 U7 s! d* A+ w" l( C* X9 G) ]6 W
30. 
    4 k* t  z" J' o9 Q0 y* G+ |7 E" ]1 ^
31. int  EQ_is_le (double s, double t)
    
32. 
    
33. {
    ! Y* p9 |1 j7 h
34. 
    
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    / V( o2 s8 C1 M: D% o
36. 
    
37. }
    ( r! [+ `0 {+ W1 E% t* `5 X
38. 
    
39. /***********************************************************************/
    
40. 
    
41. int  EQ_is_lt (double s, double t)
    
42. 
    
43. {
    9 V5 F' N0 ]: l
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    0 R: G' z3 M& f# F) R0 }
46. 
    - P% A3 G6 _6 w2 i* J- F
47. }
    
48. 
    
49. /***********************************************************************/
    
50. 
    9 E+ h: v) ?6 d" v
51. int  EQ_is_zero (double s)
    
52. 
    / ]; }9 L3 {' ^$ k% L4 W
53. {
    
54. 
    . d2 ?& _1 c; U. I7 C! _7 D
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    0 \* f/ m' o4 [; s: V
56. 
    3 B5 n5 E, v; [, C, b' Y! A* C
57. }
    
58. 
    
59. //=============================================================
    
60. 
    8 r% a3 e& @) @$ Y# c/ {- S
61. double ARCTAN1 (double y, double x )
    
62. 
    
63. //#=============================================================
    1 y! @! C" O+ u2 O3 J, @0 q! D: |
64. 
    
65. {
    . y, x5 v* {. n0 f$ f6 E
66. 
    , n- F3 f1 E) g+ K: h7 s
67.    double ang;
    & A) U. V; M, H6 C% U; g) o
68. 
    , D+ l$ _* i' K
69.    if (EQ_is_zero(y)) { y=0; }
    % \0 g$ e3 d& b; w1 l
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    # D7 v  G4 Q* u. @" S
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    * Z# C/ U7 n0 s( U4 _) ^
74. 
    
75.    ang=atan2(y,x);
      E) J4 l+ l+ k# I+ O6 {
76. 
    
77.    if (ang < 0 ) {
    / v* o! _$ W5 n1 J8 c0 t+ p( o
78. 
    
79.       return(ang + PI*2);
    
80. 
    
81.    }
    
82. 
    4 D) m. d% L' W$ Y
83.    return(ang);
    
84. 
    
85. }
    
86. 
    3 X; H; T$ P3 u; B1 e; t# E9 Z
87. //#=============================================================
    
88. 
    6 l* _" S" `/ h: I- W
89. double ARCTAN2 (double y, double x )
    ) v! o& k4 \, j' E+ Q6 s
90. 
    ( `; N, B* S9 Q; q" k6 L; \
91. //#=============================================================
    , a* V: h1 N; ?3 Z5 m
92. 
    ; d4 B+ V$ ?, l
93. {
    
94. 
    
95.    double ang;
    
96. 
    
97.    if (EQ_is_zero(y)) {
    
98. 
    1 Y) t4 T4 ^/ D4 J7 E
99.       if (x < 0.0) { return (PI); }
    . h+ Q2 R7 {5 V9 X' o
100. 
     
101.       return (0.0);
     
102. 
     
103.    }
     . `0 F% t1 G3 `8 b7 v7 E4 j' _
104. 
     
105.    if (EQ_is_zero(x)) {
     7 P8 {1 h7 S) I; A& F
106. 
     ! J) t2 r, p0 j& ?2 K- x% [0 b
107.       if (y < 0.0) { return(PI*1.5); }
     - L* ^9 O/ |6 `* A! r2 h# u. v4 M5 H
108. 
     9 `8 S5 A& D$ Q, w, I4 f- F
109.       return(PI*.5);
     
110. 
     
111.    }
     & j- E: s, q/ Z
112. 
     0 }' U; g/ k6 K# N$ X, ?4 A
113.    ang=atan(y/x);
     
114. 
     . ?$ H/ D+ `. L: N  R  _$ A8 Y
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     
116. 
     7 Q  n9 q7 X- C4 G) y! B
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     * }. j, {8 V  Z! B1 a" W2 V% j
120. 
     
121.    return(ang);
     
122. 
     
123. }
     
124. 
     
125. //#=============================================================
     
126. 
     1 Y2 K5 O* e5 `6 I3 T9 O
127. double CheckConst ( double angle, double constvar  )
     8 C( A' x) J% I2 e$ [
128. 
     ( F9 k: Q7 W& K2 J! y
129. //#=============================================================
     5 t* j6 f3 {. E# _
130. 
     ! }) z& R5 e# o
131. {
     
132. 
     
133.    while (angle < -constvar) { angle+=constvar ; }
     3 w# v+ T( u9 o6 i7 H* k
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     7 y1 @& ?0 [2 G& N; F% }8 ~
137.    return (angle) ;
     
138. 
     5 y0 i1 ?$ e8 D
139. }
     
140. 
     
141. //#=============================================================
     8 n4 s: ~. c% M% c
142. 
     
143. double Check360 ( double angle )
     
144. 
     
145. //#=============================================================
     
146. 
     : H3 {+ R9 c% k/ n5 w( a% {$ l* x
147. {
     
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     ' {6 y8 b% V; I
151.    while (angle >= 360.) { angle-=360. ; }
     9 @( Z& ^4 K1 D. D8 ^; }* n
152. 
     
153.    return (angle) ;
     . k4 T% X" p+ L( C9 W
154. 
     ) E7 j5 D! u3 e7 S: c: B3 j
155. }
     4 b  J3 Y# ?/ |' Z
156. 
     ! X  g: ~$ d- y& \
157. //#=============================================================
     
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     
161. //#=============================================================
     
162. 
     
163. {
     # d' _6 g2 F4 u7 m* H: I, Z
164. 
     0 O0 ?+ \, ?+ u1 R6 D4 V# `
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     $ d4 k, h& q- X. l! {7 M. z0 S
169.    return (angle) ;
     
170. 
     : n7 |- X! e9 f2 A  n. c
171. }

复制代码

4 A* g7 g0 a7 j2 a0 h9 `以下为摇篮5轴计算过程代码
" g# ^9 D9 T# L

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   
2. 
   1 \+ [. K& ?4 r* m# S' i
3.          j=0.; B1=0.; B0=0.;
   
4. 
   ; o8 n# l6 N8 j! P) V" \
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. 
   2 E# ~( ~+ P, w6 e2 @
9.           }
   + Y. F2 [# N6 T- j/ K8 g8 M( h( @
10. 
    , A8 a6 `" e$ \9 k8 I6 Z' f
11.           if (EQ_is_lt(i,0.)) {
    " o9 r- W9 c" O* ^
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    
14. 
    
15.                 B0=atan(i/k); B1=B0+PI ;
    & O+ G6 v8 L. f2 D1 ^3 E4 `
16. 
    3 N, ?4 x; W5 A8 _  [' {
17.              } else {
    
18. 
    ' S4 R( ~' w- X
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    9 g/ m6 y+ L  g1 q$ s3 @
20. 
    % O; R! W; P$ t. a8 K0 v) Y
21.               B1=2.*PI+B0 ;
    
22. 
    
23.              }
    7 n9 A+ k& ^& ~
24. 
      E- K% M  E8 J! B+ E
25.           }
    
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    ) `) m& S6 x( U5 T. A4 G- H
28. 
    
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    1 w+ u$ Z  g8 ^' K" X  w
30. 
    ) k% j& k: ^! b
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    * l$ [! Y0 }& e' N- c
32. 
    / L3 K3 v' M5 h4 _
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

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


测试结果：


反向测试结果
+ D* g/ Q2 H) B. q+ K! {

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享