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

若枫

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

1. int  EQ_is_equal (double s, double t);
   2 ?# }$ O7 k# c2 w
2. int  EQ_is_ge (double s, double t);
   
3. int  EQ_is_gt (double s, double t);
   0 i* n5 @; P+ E! Q% V1 ~( F) X
4. int  EQ_is_le (double s, double t);
   - [9 r0 c* s! j. Y+ d
5. int  EQ_is_lt (double s, double t);
   0 Z1 O: v# t) V9 ^
6. int  EQ_is_zero (double s);
   
7. //=============================================================
   
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   % U- @9 h- q7 x6 \; [. B; E' |+ F
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    0 w$ a1 E9 v0 v8 a  n* v- V! j
12. double CheckConst ( double angle, double constvar  );
    $ w6 ]" a$ H, Q- s3 H
13. //#=============================================================
    
14. double Check360 ( double angle );
    
15. //#=============================================================
    
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    $ o- U! `9 K  Q& p
17. //#=============================================================

复制代码

以下为部分源代码，用于判断，计算角度等
) [% [5 Z$ e* z5 H% a0 F" O

1. int  EQ_is_equal (double s, double t)
   , W$ H* v0 O- \0 |) _! W
2. 
   + b, S; h% ~/ J5 d* @6 }
3. {
   * \! Z5 N3 W: o. I1 J
4. 
   
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   
6. 
   8 {3 [  D) ]/ |3 d  h
7. }
   
8. 
   4 j& n* H2 H  M2 N# ]: F3 R$ g
9. /***********************************************************************/
   8 W6 e9 g; s3 {/ O, K( N
10. 
    
11. int  EQ_is_ge (double s, double t)
    ; p! h( T  r" G" E7 H+ O2 z
12. 
    
13. {
    % x' B* e5 |# e4 ?1 G
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    
17. }
    : A& J1 t* ?1 ^" u. k
18. 
    
19. /***********************************************************************/
    & B$ X/ x# N1 [) i
20. 
    & }  d: @( l# k/ v
21. int  EQ_is_gt (double s, double t)
    * m* C. B5 U  Q/ H
22. 
    8 ^2 H# c* F* T( o4 `8 q
23. {
    " B* B( H! n: o
24. 
    1 `/ I) e: W# Q" q
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    7 u0 C  i& O  C- |
26. 
    
27. }
    - O4 f+ T% R) h( D9 J: Z
28. 
    
29. /***********************************************************************/
    # K* ^9 X4 y! C8 L2 j
30. 
    5 u2 g6 J7 y2 m6 A) t
31. int  EQ_is_le (double s, double t)
    
32. 
    * T) Z# b7 N! P% h4 q! j+ L
33. {
    
34. 
    
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    
36. 
    
37. }
    
38. 
    
39. /***********************************************************************/
    
40. 
    0 q$ b9 ]: X; F7 Q4 _% A! W9 _
41. int  EQ_is_lt (double s, double t)
    
42. 
    3 G6 M( _* S9 K4 C4 F4 z
43. {
    % O1 j" [/ e7 K( @" _
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    % V1 y3 v3 V  Y* k0 W
46. 
    
47. }
    
48. 
    ; b- t# f, w& P) n- G. D
49. /***********************************************************************/
    - F: s: p9 U, `/ X6 b8 N
50. 
    
51. int  EQ_is_zero (double s)
    
52. 
    $ k, y& n  L7 g# `. K4 x, f
53. {
    
54. 
    / ?6 A# h3 n; q
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    ) [, O3 G! p) P/ D2 w% G6 G$ Y
56. 
    * i# M6 A! J: Y1 r: J
57. }
    
58. 
    ) X. x; a5 ]  @7 ~- ]" {: c
59. //=============================================================
    5 C2 r$ R2 L/ D1 ^5 \* W3 ^: c# H
60. 
    $ M; F2 [: }" w( q6 b
61. double ARCTAN1 (double y, double x )
    
62. 
    / i2 l2 H9 A8 N2 }* j6 c
63. //#=============================================================
    , i2 Z3 Y5 C+ K$ x: ]/ G, e  S" j8 E, y
64. 
    6 p( p% R7 y2 j* ?$ n
65. {
    
66. 
    1 }& h- H3 E: d) u) W
67.    double ang;
    
68. 
    . a, x* r5 t& i8 U, @( Q  t9 w
69.    if (EQ_is_zero(y)) { y=0; }
    / b+ t8 X& w) N$ C3 m/ a! q
70. 
    & n+ Y5 _3 t- B9 J
71.    if (EQ_is_zero(x)) { x=0; }
    
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    
74. 
    5 ^  N% I/ h  H% e4 Q$ H
75.    ang=atan2(y,x);
    
76. 
    
77.    if (ang < 0 ) {
    - k+ T5 s% p: U" x
78. 
    ; I1 ?& \7 I; W! L
79.       return(ang + PI*2);
    
80. 
    % Q% Y" A  K1 T" W) [7 B
81.    }
    ( F0 d2 |# H" X
82. 
    . p" S2 h0 J, v/ |0 M5 K
83.    return(ang);
    
84. 
    9 U% {) ^0 L+ E. e/ j5 ~
85. }
    7 F+ b: `' e% j+ }* A% C: Q2 \
86. 
    - t0 z& z8 W" l* }3 Q7 T$ a+ h, l9 r4 l
87. //#=============================================================
    5 |" I4 ]+ O  ^
88. 
    " P6 m4 ^. A9 ^( a
89. double ARCTAN2 (double y, double x )
    
90. 
    5 R; c: r/ ?1 K- z4 u  B2 h$ I# |
91. //#=============================================================
    & C* z# p. A8 z0 z, X" d. _
92. 
    5 j7 z% z1 K, \- O4 W7 @
93. {
    # ?5 t0 z" @5 I
94. 
    1 q" d5 W* G/ t- Q2 W0 {/ A8 x1 W9 {
95.    double ang;
    . z* L% W5 Y9 c# d2 X/ {$ X9 o" ^% K
96. 
    
97.    if (EQ_is_zero(y)) {
    2 f9 N, P8 C; P' _/ K
98. 
    , v4 h. I$ w) |/ U+ O
99.       if (x < 0.0) { return (PI); }
    
100. 
     
101.       return (0.0);
     ' s. n4 G- c* o1 f
102. 
     
103.    }
     
104. 
     
105.    if (EQ_is_zero(x)) {
     " g; m  _: j0 g7 O" q, c, Q
106. 
     
107.       if (y < 0.0) { return(PI*1.5); }
     4 C! F3 N0 `" A' w% {1 R9 l
108. 
     
109.       return(PI*.5);
     
110. 
     
111.    }
     / _1 h, N$ g# ]- q' o4 j
112. 
     ! q6 k  p7 I. e
113.    ang=atan(y/x);
     
114. 
     
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     ! B1 c& c7 z# K% |/ ]3 Z
116. 
     
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     ( e0 A. O! B7 X2 d0 F) a7 Q2 a$ L
118. 
     9 n; E" q/ i3 C8 a/ c
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     
121.    return(ang);
     
122. 
     
123. }
     ! D( x: {  g, H7 x+ x6 W5 J
124. 
     7 z: R" S0 H/ |1 S
125. //#=============================================================
     
126. 
     
127. double CheckConst ( double angle, double constvar  )
     
128. 
     
129. //#=============================================================
     
130. 
     
131. {
     ; W$ j( }/ j" m) U- ]
132. 
     2 X( l6 ?0 t! t7 e) G: ~# H2 D
133.    while (angle < -constvar) { angle+=constvar ; }
     
134. 
     ( P) T/ J3 ]: b3 w. J
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     ( p+ ]. o& s) a  ]& K3 m
138. 
     
139. }
     
140. 
     3 w; ]- R; E" R. `
141. //#=============================================================
     
142. 
     
143. double Check360 ( double angle )
     . B, v8 T& U  h. H! B0 e
144. 
     8 |) t- |# L1 Z/ x8 r. ^" v# V
145. //#=============================================================
     
146. 
     
147. {
     6 Y# G+ w, M- d  n6 n9 I+ O$ `& C
148. 
     ( ]. ]* A5 i! F3 W
149.    while (angle < -360.) { angle+=360. ; }
     ! f% E" F# i  P% {2 `
150. 
     % t! ?$ C: T+ U* Y
151.    while (angle >= 360.) { angle-=360. ; }
     & ]& Q6 Z% i8 B3 }
152. 
     
153.    return (angle) ;
     * i8 Y# e- ~. H+ ~
154. 
     
155. }
     
156. 
     
157. //#=============================================================
     4 X& J$ h, Q( f
158. 
     
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     ( l# L8 o! i% a2 a+ V& K1 t
161. //#=============================================================
     
162. 
     - q2 v  D. O! V% N4 n0 G
163. {
     2 q5 J$ H# f% [9 O
164. 
     
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     ! A) f. h6 s: F: n
166. 
     9 s- _4 Y$ T( t; L, c
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     6 F5 X% I& t; U4 P1 B
168. 
     
169.    return (angle) ;
     , O" e. U2 E' C1 r8 n5 X: b
170. 
     0 q; H+ J2 o- S. l
171. }

复制代码

6 y: L) p, m$ B8 |, V以下为摇篮5轴计算过程代码
( ?. K% A% h4 K: F1 ^

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   1 |) b. h4 `/ R1 }9 @3 o( a+ u
2. 
   
3.          j=0.; B1=0.; B0=0.;
   
4. 
   
5.           if (EQ_is_ge(i,0.)) {
   8 x6 B3 E! D6 l* o2 Y5 o' m0 J: z
6. 
   
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   
8. 
   
9.           }
   # b! J: v9 f0 d3 M7 d3 v) s+ r
10. 
    , H6 `( q7 Q9 m0 S; Q, W$ ]2 F
11.           if (EQ_is_lt(i,0.)) {
    / U0 K3 O# s  [: o
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    3 g6 A& Z! G/ x7 \
14. 
    6 K2 ^1 R0 ^% b8 ~+ g! i6 d9 w/ f
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    
17.              } else {
    ) O  b" e- @- I4 U; ~+ U
18. 
    
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    3 ^6 ^1 q2 U$ B
20. 
    
21.               B1=2.*PI+B0 ;
    
22. 
    
23.              }
    * j: w) ^1 |( b) H( ~( i
24. 
    
25.           }
    
26. 
    
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    1 k* ^% k" Y( ^& Q
28. 
    % o5 q2 o, Y- T4 v+ F. J9 Q0 d
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    ; ?: E5 `% M5 D1 b
30. 
    0 _; y" ^) T9 R0 x% ~& l+ X: v* K
31.           ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
    
32. 
    
33.           ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;

复制代码

: `4 @6 n7 V" ?3 d: P- J, T. H通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。

5 B; K( u& X& e; R
测试结果：


/ x0 o2 j9 W) ~+ B+ p; D; s) y) y反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享