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);
   + L' Y: ^8 |, G
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. //=============================================================
   ! g0 \6 p+ B; o
8. double ARCTAN1 (double y, double x );
   
9. //#=============================================================
   ' k7 R6 J' g5 V
10. double ARCTAN2 (double y, double x );
    
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    5 v: g; t9 d: ~" N( i- s; @
13. //#=============================================================
    ; @5 F4 F2 }2 W$ l, Y: \* R
14. double Check360 ( double angle );
    - r2 O* |; Y& m9 O  V. g
15. //#=============================================================
    0 I# f+ y$ r- D' v. I
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    4 N+ J. ^) i+ ], \, I
17. //#=============================================================

复制代码

以下为部分源代码，用于判断，计算角度等
" ?: x8 |7 m6 Q. K4 h& Y/ t

1. int  EQ_is_equal (double s, double t)
   
2. 
   
3. {
   
4. 
   " O) ^# Q" S0 C) Z
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   
6. 
   
7. }
   
8. 
   : Z6 s) r2 ~3 Q
9. /***********************************************************************/
   
10. 
    
11. int  EQ_is_ge (double s, double t)
    
12. 
    
13. {
    
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    0 ?1 W8 t3 }4 n( L) W( J+ h3 `
17. }
    
18. 
    
19. /***********************************************************************/
    # J6 u, ^# @  d0 a; g
20. 
    $ ^8 h) Y: N! @# b9 I
21. int  EQ_is_gt (double s, double t)
    8 H& G) x3 T3 F( ?; M
22. 
    2 o& d( o$ M& f
23. {
    
24. 
    ' h6 g) {1 U; D: _: W& @( _
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    
26. 
    
27. }
    
28. 
    
29. /***********************************************************************/
    - r+ T1 t1 Z- x5 O- a0 j& T
30. 
    ' {/ j, ]/ J) t9 G5 C1 g
31. int  EQ_is_le (double s, double t)
    4 R9 W  n& Q5 _8 r
32. 
    - u8 ^) R$ G' M( V& X
33. {
    
34. 
    
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    : |& K' K1 g4 x# E
36. 
    
37. }
    
38. 
    ) d& f' A; y; P$ Y
39. /***********************************************************************/
    
40. 
    
41. int  EQ_is_lt (double s, double t)
    
42. 
    
43. {
    ; T$ X* l7 z7 n+ v
44. 
    # c/ N! E& y0 ?) [3 v
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
    8 Q  y# z( A: ]( E( ^
47. }
    " b: p7 ?) q( w+ l+ h8 r
48. 
    
49. /***********************************************************************/
    
50. 
    2 a% q& p( P, O- r
51. int  EQ_is_zero (double s)
    : @( U- U; x1 T& w0 ^5 s
52. 
    
53. {
    2 @# W$ D# A, W7 p
54. 
    7 T) M. G' Q5 z) o# r
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    * v+ E0 q" j! _2 z
57. }
    3 C7 ~/ V* a0 }" I% y7 I
58. 
    
59. //=============================================================
    
60. 
    5 V. P! n7 ~/ J$ o
61. double ARCTAN1 (double y, double x )
    5 T  }- `3 Z0 E' T
62. 
    
63. //#=============================================================
    % i9 |  x' }0 G& ?
64. 
    " L3 H. p+ E6 _
65. {
    
66. 
    
67.    double ang;
    9 m! ^* R3 l  x2 i6 ^! n
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    
70. 
    
71.    if (EQ_is_zero(x)) { x=0; }
    # T4 d/ H3 N% h5 Y1 `4 ^
72. 
    
73.    if (y == 0 && x == 0) { return(0); }
    
74. 
    
75.    ang=atan2(y,x);
    0 R. P9 H) V& ?6 @9 v
76. 
    * U% F4 C( |" a' y4 w
77.    if (ang < 0 ) {
    
78. 
    ! ~$ \8 ^- y; N. E
79.       return(ang + PI*2);
    ; C; I. P6 q8 ?$ L# J
80. 
    
81.    }
    
82. 
    , U" P% U7 g" z& D
83.    return(ang);
    
84. 
    
85. }
    
86. 
    ! T" W# q' t1 w3 D# g
87. //#=============================================================
    
88. 
    " n; [; C6 |' k2 C9 U* n" s, Q
89. double ARCTAN2 (double y, double x )
    : }4 A0 R* S, S- z, ]
90. 
    1 b# @7 A! Z# `- h- U
91. //#=============================================================
    0 O7 V! Z% j9 }% v5 i* ?! g
92. 
    " n" |3 B! @  L" A% ^
93. {
    ( {# ~( Q" L0 e  m- d# `* L
94. 
    4 z5 R8 H0 s: n- _: V- z
95.    double ang;
    # S( Q$ C. a' A# w) B) R& n
96. 
    
97.    if (EQ_is_zero(y)) {
    $ C8 C: Q2 [8 U) k( {/ ^" y! I1 h
98. 
    
99.       if (x < 0.0) { return (PI); }
    8 E# ]4 ]; L/ H- ]( S3 \
100. 
     
101.       return (0.0);
     # R5 k) y9 o2 q6 ]' {
102. 
     
103.    }
     
104. 
     
105.    if (EQ_is_zero(x)) {
     
106. 
     / c* [) `0 k: u2 ~' ]* o( r
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     
109.       return(PI*.5);
     / L- W9 ^" q3 G  F
110. 
     
111.    }
     ( F; M2 ]$ }8 ?. G9 R  ?
112. 
     0 n# q9 h( I# a: d# T/ z
113.    ang=atan(y/x);
     ! a: D% O2 C9 L8 v
114. 
     ( f; i4 D5 U# x
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     
116. 
     ; Y5 u8 M8 i1 ]  ]
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
     
118. 
     : W! P3 g, L& t. L; o  K: V
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     - ~' f7 y$ S9 W0 R5 |# D" P
120. 
     - U' b2 g- |& N/ X. i
121.    return(ang);
     ' r: [) k$ P/ z0 B
122. 
     
123. }
     
124. 
     
125. //#=============================================================
     
126. 
     
127. double CheckConst ( double angle, double constvar  )
     
128. 
     ; ]8 S0 |3 O, ~0 b% P+ j
129. //#=============================================================
     2 S0 c2 T/ x+ @+ X
130. 
     
131. {
     ) K! O( S) f5 f) a& T0 S
132. 
     
133.    while (angle < -constvar) { angle+=constvar ; }
     # m. g- v9 `5 r5 @
134. 
     
135.    while (angle >= constvar) { angle-=constvar ; }
     ' [6 i4 b$ r6 z' m
136. 
     
137.    return (angle) ;
     
138. 
     ( H4 e0 ~- j$ Q3 @; f& `
139. }
     
140. 
     
141. //#=============================================================
     
142. 
     
143. double Check360 ( double angle )
     
144. 
     / v" F% Z+ }% |9 p$ m/ {$ L
145. //#=============================================================
     , \9 N# r: G/ P2 _: ]' x9 p: x
146. 
     
147. {
     : @$ m  m+ l- L- e- f3 m. ]
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     ( l  i0 u; r% ?8 v) i
150. 
     * f: M! G- }. x0 {* Y! n: D
151.    while (angle >= 360.) { angle-=360. ; }
     4 e/ }3 R5 i9 D" z) P
152. 
     
153.    return (angle) ;
     
154. 
     
155. }
     6 E0 r1 L$ a% f
156. 
     9 a) l+ Z$ F% h8 S
157. //#=============================================================
     
158. 
     3 S* ~  t  u* w9 R+ M8 a3 L' m
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     
160. 
     ( a, h5 @- u; D7 L  ?3 N8 `) f7 {) A
161. //#=============================================================
     2 Z$ ]9 }! X1 `8 j. y
162. 
     . D( T8 l# r6 k  T3 k+ h
163. {
     6 h7 l( k: {8 g5 i3 J# J
164. 
     8 y/ S& n+ q/ I8 p6 D
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     
166. 
     8 f# I9 i8 K& c+ ]5 }
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     
168. 
     - e" S) e3 p& c  l/ W5 _) }1 q' t
169.    return (angle) ;
     8 ~  Z. y/ N+ I' Y, y
170. 
     
171. }

复制代码

/ A# ^3 Y7 w; D7 j/ k2 g以下为摇篮5轴计算过程代码
6 F8 c+ U: a0 ~* I

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   3 U9 A( a1 \: @
2. 
   * ?. }+ W$ _1 a% ~7 J! R
3.          j=0.; B1=0.; B0=0.;
   
4. 
   
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. 
   / x0 e3 l6 U( ~4 R, |
9.           }
   ( o* i. r8 {  o9 ?/ f/ Y
10. 
    * T- T5 v. i, l) f5 F- h
11.           if (EQ_is_lt(i,0.)) {
    " `/ b- D2 T  v  C$ ^2 }8 }
12. 
    
13.              if (EQ_is_lt(k,0.)) {
    , W3 ?$ s0 ~- q' g3 r1 d3 ]
14. 
    9 `8 J, @' ]4 N% h0 n
15.                 B0=atan(i/k); B1=B0+PI ;
    0 Q" X0 y' M. s/ P
16. 
    / K) D: ]7 F3 N( b5 t
17.              } else {
    
18. 
    . l  A. W5 [3 K  L4 Y, e) l. Q
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    % o5 \; H. u; @7 o$ e  v
20. 
    
21.               B1=2.*PI+B0 ;
    1 I$ G+ @* B3 f: B: k8 j! E
22. 
    ' _2 k1 y0 C0 h, v  Z9 [  r
23.              }
    
24. 
    - b9 B' \9 L0 Z
25.           }
    + j9 r# T6 l5 y# R6 R# L
26. 
    3 m, O" c( X4 C" w; {; g  x: ~
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    ! Q- t% y$ x5 i& B3 A" l7 T: ~) G
28. 
    
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    ! f( i  M; C. J' A
30. 
    ' }  m9 ]& V( s( ~
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.;

复制代码

7 {$ Z: t6 E& Q) c4 n! E通过输出的NC程序，反向输出的刀轨数据与原始刀轨文件对比，其数据结果一致。
3 n- m# ?( ?, R0 r- [

测试结果：

. ^" `4 F( T( ?5 k$ a' \; t) P
反向测试结果

yucammayco

谢谢分享

云与海的故事

谢谢分享

qms88888

感谢楼主的分享