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

若枫

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

1. int  EQ_is_equal (double s, double t);
   ( ]; k; ^+ w" F
2. int  EQ_is_ge (double s, double t);
   
3. int  EQ_is_gt (double s, double t);
   . C, a5 D/ h5 c4 g
4. int  EQ_is_le (double s, double t);
   
5. int  EQ_is_lt (double s, double t);
   8 g( b5 i4 {: A& A
6. int  EQ_is_zero (double s);
   ' D, u  [  C6 R# \
7. //=============================================================
   
8. double ARCTAN1 (double y, double x );
   9 i: F( ~, z' g' R: k
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    ; [3 m# F! E9 T% i. l
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    $ v* S. F  v9 |% q" o
14. double Check360 ( double angle );
    
15. //#=============================================================
    6 E6 o2 q0 ^! {* d$ g
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    
17. //#=============================================================

复制代码

以下为部分源代码，用于判断，计算角度等
' [  ]* _! F+ F0 O, _" o1 c9 I

1. int  EQ_is_equal (double s, double t)
   - a: \0 r! Z0 T/ Y) H2 O+ C
2. 
   
3. {
   * R" M/ M: z( ]% a5 s1 M7 I- Z
4. 
   ) b+ E# T! I1 n. F; }! T/ C4 L: {0 V7 l
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   + f- \/ d& k% j7 r7 j1 p7 ~
6. 
   ! u+ U9 W1 K: A% v1 j) R: b
7. }
   
8. 
   . B9 _/ A. f8 u7 f- M6 c% R9 v
9. /***********************************************************************/
   
10. 
    1 A6 U: x# C. Z5 D/ J: b4 ]
11. int  EQ_is_ge (double s, double t)
    : z; L) Q( Z7 i3 _
12. 
    / Q4 N; n3 `% U( \
13. {
    
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    ( ]3 j  s  W, w2 N9 a
16. 
    9 A1 N4 y8 F5 ?
17. }
    ( c5 r1 h6 O9 E
18. 
    
19. /***********************************************************************/
    ! v) R! Q8 R# @. }/ h
20. 
    
21. int  EQ_is_gt (double s, double t)
    * |+ `% O$ d9 S, @4 b
22. 
    6 a0 S( v. H- C( j6 Z( a/ v
23. {
    % I, d5 H  M& f4 P2 W; G
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    
27. }
    
28. 
    
29. /***********************************************************************/
    ' t) P3 l* H$ j# s
30. 
    
31. int  EQ_is_le (double s, double t)
    
32. 
    
33. {
    * f1 k! ^  j6 J2 r
34. 
    $ _3 {- K& y, W7 m6 U2 z' f
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    
37. }
    
38. 
    " f/ ^! R6 }' i% U# L# i4 n
39. /***********************************************************************/
    
40. 
      b0 f) {! I, O+ d  N; S
41. int  EQ_is_lt (double s, double t)
    
42. 
    
43. {
    ' w0 i, G% @+ d# J, f
44. 
    $ M0 v& K, D" w% H6 B9 s
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    0 [) n! [) s- Y* R* [8 {* r
46. 
    
47. }
    
48. 
    
49. /***********************************************************************/
    0 r& M4 ?; _0 ~: b5 I* @
50. 
    
51. int  EQ_is_zero (double s)
    
52. 
    . a8 ^- o( i3 F# r1 `
53. {
    
54. 
    
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    
57. }
    
58. 
    8 B1 I7 V5 d, H1 m9 D! ?" s
59. //=============================================================
    7 U! P0 z' V- a
60. 
    
61. double ARCTAN1 (double y, double x )
    
62. 
    6 u% z2 t7 W' s" c8 m2 S3 X
63. //#=============================================================
    
64. 
    ; H5 d4 c) k: Y
65. {
    
66. 
    
67.    double ang;
    7 I  o5 _' Z& G, W1 ?: C7 p7 O
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    % b) X! C: o$ C! E9 ?
70. 
    1 p* z5 v5 |6 n3 j! x
71.    if (EQ_is_zero(x)) { x=0; }
    
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    9 v/ e. g/ H  m; Y# P& ?! O
74. 
    / W/ E6 g5 f: A5 w
75.    ang=atan2(y,x);
    , X3 j2 F: Y* {- o: ^/ b
76. 
    2 f& @, B! g5 Q. x
77.    if (ang < 0 ) {
    & }! q+ s% K" u( C5 Y/ J
78. 
    
79.       return(ang + PI*2);
    1 x8 w8 g" a4 ]" \
80. 
    
81.    }
    . t6 L: n. k- k1 y1 q
82. 
    , |  i- ^0 l. D) H& c2 R8 e
83.    return(ang);
    $ q1 W/ R" j8 C% k2 |
84. 
    
85. }
    : V( Q, p6 B/ F: \) k+ z9 ^
86. 
    
87. //#=============================================================
    4 w/ U$ Y. E+ |2 U
88. 
    
89. double ARCTAN2 (double y, double x )
      V& b1 [' ]* k5 ]& C3 J
90. 
    
91. //#=============================================================
    
92. 
    
93. {
    + f1 d" I: j* ]3 @
94. 
    
95.    double ang;
    & O- |( g. I. c, {* i& x( w* @% W
96. 
    
97.    if (EQ_is_zero(y)) {
    
98. 
    # y3 k8 Y  h+ \( g1 C
99.       if (x < 0.0) { return (PI); }
    
100. 
     
101.       return (0.0);
     - N* G+ a/ \! O4 n+ ?! P
102. 
     
103.    }
     " ^4 A& c- a8 E: {  Z: U
104. 
     
105.    if (EQ_is_zero(x)) {
     
106. 
     # [( q, z0 s7 t, A, N" ?  O* ~
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     + h. N! ~. n8 g
109.       return(PI*.5);
     
110. 
     9 ]- o* Z. q8 o  @
111.    }
     - T9 L, d. Z4 e; u% a  v
112. 
     ! I  k% H3 U/ X0 O' g9 |
113.    ang=atan(y/x);
     - j9 P0 d, N' P" i
114. 
     4 `9 B  f8 O( j6 l% e
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     1 I: w: E/ I0 ?" X2 y: n# n
116. 
     
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     ( v4 ~" M- |" T* R! O& J
120. 
     + @+ F. [4 T$ \  W) S
121.    return(ang);
     ! q; z4 `3 D: ?" r
122. 
     
123. }
     
124. 
     
125. //#=============================================================
     
126. 
     
127. double CheckConst ( double angle, double constvar  )
     * i; u) M- |1 P8 ]3 ^. M! u
128. 
     
129. //#=============================================================
     
130. 
     + F$ K2 b. G; H5 s. O" }
131. {
     , W# s! t9 k& e, s. |) l
132. 
     
133.    while (angle < -constvar) { angle+=constvar ; }
     " ^. |; `; a" @4 k6 m' z
134. 
     3 e3 `0 Q1 Q' p7 o6 M: I# y
135.    while (angle >= constvar) { angle-=constvar ; }
       T( o) l! K' {# {8 z
136. 
     
137.    return (angle) ;
     ) v, C$ A+ X8 p0 E% z1 n- {3 J9 y
138. 
     ) ]3 p# D# D' G; ^  t* Y/ k9 D
139. }
     7 p  `% _$ @9 C( ~1 V; c
140. 
     
141. //#=============================================================
     0 P0 ~2 r6 v/ r% e* S
142. 
     * ]0 Q' u- i' o# B9 Z$ G
143. double Check360 ( double angle )
     
144. 
     
145. //#=============================================================
     
146. 
     
147. {
     
148. 
     ) _4 S# i# N& c. i/ Q5 I0 F# W
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     2 S5 M3 ^+ t& L( e/ x- f2 a9 S" \
151.    while (angle >= 360.) { angle-=360. ; }
     7 u2 G  I" [- w) P; J. C
152. 
     8 l2 t3 _* r' D( P& \( x
153.    return (angle) ;
     ) o* K" b7 H  B+ [+ ?2 }
154. 
     ) q" U6 u$ }; o4 V1 Q' j; g* }
155. }
     $ T4 [9 T. x* r
156. 
     1 y# b& q  N* e
157. //#=============================================================
     
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     4 r% L. l# a. k) d6 `: n3 W
160. 
     
161. //#=============================================================
     
162. 
     1 w4 v0 k; O4 |$ C# w* S
163. {
     0 g7 Y* H9 o* r2 U  T1 g" x
164. 
     9 Z5 P" O) l$ N6 j6 Y5 G
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     
166. 
     4 K0 |3 e( s2 t4 s
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     : D" I0 y& N  Y' Y* O# @  n0 g
169.    return (angle) ;
     8 p. r/ v: A5 T3 H% X4 ^
170. 
     1 H7 |; p6 a) N. L
171. }

复制代码

- I! }' P/ o4 k8 o7 ^以下为摇篮5轴计算过程代码
9 O  a6 k3 b4 a# L8 k

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   8 [6 y/ E: v. q* d
2. 
   9 @2 c0 E: A( ^' J, d) n! G
3.          j=0.; B1=0.; B0=0.;
   
4. 
   ) A0 c7 L* p% b- M0 N: S
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. 
   
9.           }
   
10. 
    
11.           if (EQ_is_lt(i,0.)) {
    
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    
14. 
    . |( k7 b; _' A5 M  G! i7 u
15.                 B0=atan(i/k); B1=B0+PI ;
    ( L2 |1 v, f0 G* g7 p, g7 f% {0 C
16. 
    
17.              } else {
    
18. 
    " S! V' }( R5 E5 l& ?& `
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    
21.               B1=2.*PI+B0 ;
    2 ^/ k. {9 ^& e; _4 ^+ u: R/ }$ i8 Q
22. 
    
23.              }
    
24. 
    % s9 W7 `5 G, L5 u
25.           }
    : e6 u' k  h5 E
26. 
    5 {% |  V4 P. `1 }/ J$ ?
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    
28. 
    6 t( f7 p0 ~& o+ `" Z' z" j! s
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    - X; ]) F8 t5 U! X2 l8 D
30. 
    ( D- T# ?1 j5 R6 i; f" @+ R/ P
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    ( K" `/ a+ Y; `) x1 I; l
32. 
    
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

& S( M0 r8 P) H/ m; t* r通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
5 W0 w  Z4 S/ Z& q3 P! |
" B0 e, d* }1 s$ D' I$ {
6 ?7 a, I7 a- T2 d测试结果：

% P; j) F$ o: O
反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享