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

若枫

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

1. int  EQ_is_equal (double s, double t);
   ' B: l  H9 v! F  X/ Q9 Z4 D
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);
   
5. int  EQ_is_lt (double s, double t);
   
6. int  EQ_is_zero (double s);
   - j/ p+ n( `) v% \+ K
7. //=============================================================
   * B: A! g( C  R
8. double ARCTAN1 (double y, double x );
   6 H$ w. X2 h  w* {4 c
9. //#=============================================================
   
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    
13. //#=============================================================
    % E0 [$ b5 N% \- a* j3 O
14. double Check360 ( double angle );
    
15. //#=============================================================
    8 W% J  _6 |$ m( H
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    * ~  Y' N- M: p4 h8 W
17. //#=============================================================

复制代码

1 B9 H# f$ ~! A. T& r0 S7 W以下为部分源代码，用于判断，计算角度等

1. int  EQ_is_equal (double s, double t)
   ; E$ o: O- b- s3 E3 R1 o
2. 
   
3. {
   
4. 
   3 v) b+ W6 c' W, v- {- V  B2 R6 ^
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   
6. 
   
7. }
   
8. 
   1 B+ O7 B. G8 G  t
9. /***********************************************************************/
   
10. 
    
11. int  EQ_is_ge (double s, double t)
    % ~/ N0 ?& M) h4 c3 @+ V8 l! w
12. 
    
13. {
    
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    & M) L7 P: ?& w0 \* f1 p( ~4 T
17. }
    
18. 
    
19. /***********************************************************************/
    
20. 
    
21. int  EQ_is_gt (double s, double t)
    1 U  _9 e6 F1 E. i" Y- J+ v
22. 
    : @3 a) E4 W- t* P
23. {
    : I& U+ ~- F; A7 r6 x- e
24. 
    
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    9 ^2 z& [, p& p
27. }
    
28. 
    9 ?9 x: L! Y& K. h' e& o7 ~
29. /***********************************************************************/
    
30. 
    : S( w6 [2 s, C( M* E/ N( ^8 U
31. int  EQ_is_le (double s, double t)
    + c  U1 x, H/ d
32. 
    # `! [) z: |3 p0 ?5 n7 J( D  Z
33. {
    . i' [; c. Q. f/ |
34. 
    
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    
37. }
    , J9 u. e/ t! C9 s+ ^5 @; F% t) H
38. 
    " C2 \/ n$ }  A3 w) e- b
39. /***********************************************************************/
    
40. 
    
41. int  EQ_is_lt (double s, double t)
    . h# [; Z  H  g. Q% r# ~1 ^
42. 
    " k' i: I9 E1 i
43. {
    ! R, I, f  ?+ Y) w' d5 b) Q0 m
44. 
    $ o0 y* M# {& ]% X
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    " C. M# M* D- P0 c
46. 
    
47. }
    
48. 
    & G# @; z( F6 z7 e
49. /***********************************************************************/
    
50. 
    
51. int  EQ_is_zero (double s)
    
52. 
    
53. {
    2 Y) ]: s$ I6 |  Z+ o; }
54. 
    - ^, J& a4 m  \. L' v! N/ i
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    ; [2 p! A' z9 Z( y6 t/ _
56. 
    # B- F2 r1 S) j+ _  d4 X' y8 \
57. }
    
58. 
    4 F- {) J" _5 T5 A9 q1 ~" G
59. //=============================================================
    
60. 
    3 P- m( T0 P% C6 M8 P7 b+ e
61. double ARCTAN1 (double y, double x )
    4 x7 Z0 A. Z! H% X+ }8 ?' k
62. 
    
63. //#=============================================================
    
64. 
    
65. {
    
66. 
    0 b+ v1 T# ~# |! g+ S. ~
67.    double ang;
    
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
    % T6 W8 U4 m* {: V; W/ ^
71.    if (EQ_is_zero(x)) { x=0; }
    
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    ! O4 R# S0 z# V2 m2 R! i
74. 
    
75.    ang=atan2(y,x);
    ' b; v$ a3 s9 }2 Q$ B9 w# _. P5 f
76. 
    4 K- n  E2 c( N5 n  c2 _
77.    if (ang < 0 ) {
    
78. 
    / L1 M6 j% C# B: J2 a
79.       return(ang + PI*2);
    
80. 
    
81.    }
      F; \" y# o6 T7 D8 C" K( S8 r$ R' J
82. 
    
83.    return(ang);
    0 N* ~  j, u# X/ I
84. 
    8 i% _- K1 Y, ]/ X2 i
85. }
    1 k& O) u$ x: m, x: i
86. 
    
87. //#=============================================================
    
88. 
    $ J4 s$ R6 b1 U* \
89. double ARCTAN2 (double y, double x )
    
90. 
    9 m: t! j  q4 w) W$ l. ?6 g
91. //#=============================================================
    ; z/ n2 y8 U1 Q+ p6 A8 ?6 \$ ~
92. 
    & I, Z! f- a: U3 ?
93. {
    0 Y+ p1 x6 n/ M  q
94. 
    
95.    double ang;
    
96. 
    
97.    if (EQ_is_zero(y)) {
    
98. 
    
99.       if (x < 0.0) { return (PI); }
    
100. 
     6 h- [3 Z, Y/ I$ |' U' |
101.       return (0.0);
     
102. 
     # }6 {2 `$ k* U0 t
103.    }
     + n" q0 N3 P4 g# \7 M+ M' ?. u) J4 U
104. 
     " t" }$ Y# [$ E% ?, r- ^
105.    if (EQ_is_zero(x)) {
     
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     / Q9 j/ Z. M% D! W
109.       return(PI*.5);
     / q5 W5 ]+ J! @3 |- |4 P
110. 
     0 Z& m& k/ \' F" i5 u* V
111.    }
     
112. 
     
113.    ang=atan(y/x);
     ) K0 {  o! J: X; n5 P4 I& ~
114. 
     
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     
116. 
     1 A" [' O: q) m- B& T- w
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     . `1 X& X- Z! u
118. 
     
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     0 Q) s. M: g7 a% H# E4 f
120. 
     
121.    return(ang);
     
122. 
     8 t% j+ x: r6 N6 Q8 D" d
123. }
     
124. 
     
125. //#=============================================================
     
126. 
     
127. double CheckConst ( double angle, double constvar  )
     % w; K" b3 W7 y- E8 C1 @( }
128. 
     + h7 w: Y# E2 X3 A# Z6 h) ~
129. //#=============================================================
     
130. 
     
131. {
     
132. 
     
133.    while (angle < -constvar) { angle+=constvar ; }
     / D- ?' A3 ^# q7 Z' U" L+ T, p
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     & W: o0 z$ p, [% X
136. 
     
137.    return (angle) ;
     
138. 
     $ z4 r7 ~1 Q* [& `4 |
139. }
     
140. 
     & ^7 a' G6 U/ m3 _
141. //#=============================================================
     # j) P. J9 o4 x! Y9 d
142. 
     
143. double Check360 ( double angle )
     
144. 
     
145. //#=============================================================
     ) ]7 @4 e' |9 `1 S2 y* }9 h
146. 
     
147. {
     
148. 
     % I: l* e. B% Z
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     
151.    while (angle >= 360.) { angle-=360. ; }
     
152. 
     . y4 _9 y: B+ p2 Z6 V
153.    return (angle) ;
     # r) f  B4 d; @( y) u/ |# r& s( n" i; L
154. 
     $ Z0 b" ~) q! `7 V
155. }
     
156. 
     
157. //#=============================================================
     - B! B" X) L+ w1 x- `4 k
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     " t! Q- Z7 F( i' n' C: {8 h
160. 
     
161. //#=============================================================
     , E* {: {$ h$ u4 L
162. 
     " f* N0 ]% ~$ u( d* h# H# R( f9 _# K% v( I
163. {
     6 N% s: N& _% u; R
164. 
     
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     
166. 
     - ~4 i  ?) j+ X% J3 t
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     3 Y/ I4 j0 x' P
168. 
     
169.    return (angle) ;
     
170. 
     . F5 _$ X; e) K( t8 T
171. }

复制代码

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

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   
2. 
   
3.          j=0.; B1=0.; B0=0.;
   ( G, W5 P) I$ r! e+ G
4. 
   
5.           if (EQ_is_ge(i,0.)) {
   
6. 
   5 t& ]7 x5 n+ e& C6 g
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   . K+ u" ?8 ]) @0 y9 b
8. 
   
9.           }
   
10. 
    7 O& W8 a, }' X3 q
11.           if (EQ_is_lt(i,0.)) {
    
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    
14. 
    
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    
17.              } else {
    6 M: }; s* N9 _2 i. ~; N
18. 
    # K. o  T  q+ M
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    ( x7 b7 {& T. s/ H5 H
20. 
    $ G) T& g5 T- b/ p) Z
21.               B1=2.*PI+B0 ;
    / g: r2 |$ e" N8 |  ^  c2 t( z
22. 
    
23.              }
    0 o# K1 y& ?5 b
24. 
    / i5 l) B: W! B' c# Q
25.           }
    
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    ( r: Z" j* b4 W4 ?/ ]5 b
28. 
    ' G- j0 c2 M) R: I8 Q0 k) Q
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    5 E! Z" F* Y& o; _
30. 
    
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    
32. 
    5 t5 R  A# ]( V) D0 w6 h7 Y- i
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

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


测试结果：
* v& Q' V' {/ q  n( \" Q  p% m& i

; m  A6 P5 Y4 H1 ^4 g3 Y  e# R2 p8 d反向测试结果
% ^. t8 D# Q9 l  u( n- k2 M4 P& \

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享