APT刀軌數據生成NC程序C++源代碼

若楓

APT刀軌數據生成NC程序C++源代碼，本功能僅作為技術交流研究之用，代碼，功能可能存在缺失。需自行編寫刀軌數據的讀取與處理。以下僅為部分代碼以下為頭文件部分源代碼

1. int  EQ_is_equal (double s, double t);
   
2. int  EQ_is_ge (double s, double t);
   $ C/ o& z1 _+ H$ }+ t# Q  t
3. int  EQ_is_gt (double s, double t);
   
4. int  EQ_is_le (double s, double t);
   ' t) }) T6 T# P' \& I4 R% L
5. int  EQ_is_lt (double s, double t);
   
6. int  EQ_is_zero (double s);
   0 ]0 H8 d: C, b7 f
7. //=============================================================
   - Y9 Z6 S- u6 D# P! y
8. double ARCTAN1 (double y, double x );
   8 `- J0 t% \& r; M5 Q
9. //#=============================================================
   $ J4 N# ~+ U# B- `  r/ E* j
10. double ARCTAN2 (double y, double x );
    * U  K) s: N( ?
11. //#=============================================================
    
12. double CheckConst ( double angle, double constvar  );
    . ?, z8 n) Y/ K. x
13. //#=============================================================
    
14. double Check360 ( double angle );
    ! J! D6 M8 b5 [" R/ y' m
15. //#=============================================================
    
16. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
    % z7 Z7 E9 \7 h4 H
17. //#=============================================================

復制代碼

以下為部分源代碼，用于判斷，計算角度等
/ c# b8 c+ U5 n& y# s' A

1. int  EQ_is_equal (double s, double t)
   
2. 
   6 P3 i# W9 r6 k# d: p/ j7 M0 R
3. {
   , G* b6 L. j- n+ L# J! d9 [( {7 o
4. 
   
5.   if (fabs(s-t)<= system_tolerance)  { return(1); } else { return(0) ; }
   
6. 
   
7. }
   
8. 
   
9. /***********************************************************************/
   * V& J( m- p9 e6 f( L9 V7 Z
10. 
    ' P% x; ?: v: z0 D; a
11. int  EQ_is_ge (double s, double t)
    % ~# e$ w5 c+ r) l5 g# ?* @
12. 
    
13. {
    
14. 
    
15.   if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
    
16. 
    
17. }
    
18. 
    
19. /***********************************************************************/
    & v& |  Y! F1 C+ J8 T+ l
20. 
    ' i$ ?$ W, |( m9 a0 Q0 ~
21. int  EQ_is_gt (double s, double t)
    
22. 
    / Z9 W2 H! ~5 U
23. {
    
24. 
    2 I; T, g# h- A" g! _
25.   if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
    . i% B& I9 u. D+ |9 R  g* E  P9 \
26. 
    
27. }
    
28. 
    
29. /***********************************************************************/
    & E# \% |8 _& t6 [0 R3 t( Z
30. 
    
31. int  EQ_is_le (double s, double t)
    
32. 
    + K( G4 `8 \0 G. O/ J
33. {
      s1 J& p' t: ]0 B# M; i
34. 
    
35.   if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
    + c4 U# t8 \/ b& ]7 l& {( a
36. 
    
37. }
      s. Z$ N: b0 U/ w! P
38. 
    # r! b0 m4 i) A9 {/ K* S& s
39. /***********************************************************************/
    , I/ o: H! Z/ v- n: z, a
40. 
    ' \8 h7 X" l9 V9 }, ~/ g# }) m1 ]
41. int  EQ_is_lt (double s, double t)
    6 H1 M- P2 n' K8 c# W# a
42. 
    
43. {
    
44. 
    
45.   if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
    
46. 
    & ]% N, |6 l) ^
47. }
    
48. 
    2 n( G0 a! y4 A: B$ w6 X
49. /***********************************************************************/
    
50. 
    $ \0 v8 I, ~6 N4 ~" q
51. int  EQ_is_zero (double s)
    ; _8 q5 W, S) g; x& e4 ?. r# b
52. 
    . w9 j$ K, a6 W; k4 b
53. {
    ( @/ a# L3 s) ^% {
54. 
    & r9 \/ H4 N) b; Z4 L1 X
55.   if (fabs(s)<= system_tolerance)  { return(1); } else { return(0) ; }
    
56. 
    
57. }
    
58. 
    
59. //=============================================================
    
60. 
    + {# F. u, I2 e. b1 X& H8 l
61. double ARCTAN1 (double y, double x )
    
62. 
      \9 |( C" |# n8 p3 W3 m& \$ {- N
63. //#=============================================================
    
64. 
    
65. {
    7 o" G  H' i# t3 Q# S4 x
66. 
    : l  _. t/ i% P; M3 O+ Y. |8 ]
67.    double ang;
    
68. 
    
69.    if (EQ_is_zero(y)) { y=0; }
    1 w( S9 y! Y6 K9 M9 U1 h1 D8 t6 E
70. 
    $ @1 L! n& Z/ O! f
71.    if (EQ_is_zero(x)) { x=0; }
    
72. 
    . W3 f; v! `2 ~6 N- E* L. z8 S# N. s+ H
73.    if (y == 0 && x == 0) { return(0); }
    , r& F$ j' @% N/ T, G
74. 
    1 M' v* y/ [8 X; t5 L0 Q# ^
75.    ang=atan2(y,x);
    2 c3 o, }5 M) g! W8 S% m( H
76. 
    
77.    if (ang < 0 ) {
    
78. 
    ( @% J. D. e' F' y
79.       return(ang + PI*2);
    
80. 
    2 \& y1 ]* E2 I
81.    }
    : M! I9 j: o* {6 ^# I4 A$ `" r
82. 
    
83.    return(ang);
    
84. 
    
85. }
    . e- A, }2 x2 y- ]/ P: s
86. 
    - \4 k4 ?# J" g. g' X) G+ |$ I+ o3 P, Q
87. //#=============================================================
    , a" M+ a# E: z
88. 
    7 W6 n$ U% v+ I$ @2 h
89. double ARCTAN2 (double y, double x )
    3 c5 @5 ~7 s2 |) w
90. 
    
91. //#=============================================================
    
92. 
    ) C$ N2 {% G  E8 @) R: H( _. R1 q
93. {
    
94. 
    
95.    double ang;
    
96. 
    4 _& I& ^6 l" g' ^7 n
97.    if (EQ_is_zero(y)) {
    ; ~# z' s7 O2 t
98. 
    & b( I, M3 W' m: [7 G2 f3 N7 W8 m' [# j
99.       if (x < 0.0) { return (PI); }
    
100. 
     
101.       return (0.0);
     ' [2 \& `( K7 N) ^* c' Z$ Q
102. 
     
103.    }
     
104. 
     . I) g, L* r9 M5 \; {1 i+ s% E
105.    if (EQ_is_zero(x)) {
     4 W; U( H! k" ]/ @1 |3 t, G" L/ x
106. 
     ( B8 n8 K, n$ }- F  @4 }8 @2 l6 S
107.       if (y < 0.0) { return(PI*1.5); }
     
108. 
     
109.       return(PI*.5);
     & w* c. ^$ Q" w; v+ Z
110. 
     
111.    }
     
112. 
     
113.    ang=atan(y/x);
     4 _' s7 O- C) y. P: p9 P
114. 
     " O; m- F% I, [& c" k  e+ D7 F7 T
115.    if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
     
116. 
     
117.    if (x < 0.0 && y < 0.0) { return(ang+PI); }
       n$ q. t0 ^3 g. m' Y- [
118. 
     " B. ?( s4 \" w0 e" f
119.    if (x < 0.0 && y > 0.0) { return(ang+PI); }
     
120. 
     
121.    return(ang);
     
122. 
     2 }6 ?5 D: p0 T9 L; s! T
123. }
     
124. 
     
125. //#=============================================================
     ; Q/ x5 M( u5 ^* N  m* i
126. 
     
127. double CheckConst ( double angle, double constvar  )
     
128. 
     3 B/ y2 e- {. R6 |- i6 F
129. //#=============================================================
     
130. 
     # l# a; g* F: @  Q+ e
131. {
     
132. 
     . w8 _. I& V4 O
133.    while (angle < -constvar) { angle+=constvar ; }
     ( v0 o, o$ x0 n9 G  W
134. 
     " [$ b* W6 X+ n5 B
135.    while (angle >= constvar) { angle-=constvar ; }
     
136. 
     
137.    return (angle) ;
     
138. 
     / W8 W3 r4 X& H, A* P- @
139. }
     
140. 
     
141. //#=============================================================
     
142. 
     
143. double Check360 ( double angle )
     
144. 
     . N+ {, @2 I, L
145. //#=============================================================
     
146. 
     
147. {
       C# i, v# T- [* B" I% b3 F
148. 
     
149.    while (angle < -360.) { angle+=360. ; }
     
150. 
     $ U2 A8 y$ v* p5 f, k8 R) C
151.    while (angle >= 360.) { angle-=360. ; }
     6 K1 E5 f' c+ R3 {+ G# ^  m- [" j
152. 
     : W& h  b3 O* m4 F3 t4 B
153.    return (angle) ;
     
154. 
     7 q7 Y+ ^/ z. c. f
155. }
     ) f$ V6 C. u( `0 w( N* \. U
156. 
     + B: e3 b7 B( l! \+ X/ f8 J
157. //#=============================================================
     6 t4 L7 j0 x- r7 M5 Y& l3 C
158. 
     ( P5 e% f+ Y' V
159. double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
     ; w* Y+ R: ]( |# l, \! F( ~
160. 
     
161. //#=============================================================
     1 y1 W, Z% Y1 J9 }4 ]
162. 
     7 U. u" r2 i& P& }: v
163. {
     
164. 
     7 K0 S8 c0 J2 v" ~& X) y2 `
165.    while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
     8 l2 t! s8 J, c- M  m
166. 
     
167.    while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
     9 t6 Q. c# t8 z* C/ w. q2 N
168. 
     
169.    return (angle) ;
     
170. 
     
171. }

復制代碼

以下為搖籃5軸計算過程代碼

1. i=sin(ang_rad[1]);  j=0.0;  k=cos(ang_rad[1]);
   ' ~' n$ b. p8 C- k1 R" ^0 T7 W: F
2. 
   . g  g- z# W  D  |
3.          j=0.; B1=0.; B0=0.;
   
4. 
   & p; w$ J+ s! y$ ?6 I7 o
5.           if (EQ_is_ge(i,0.)) {
   
6. 
   % u) q0 t, t6 ~" g+ X
7.              if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
   
8. 
   ; b- P% d  ~8 U6 i5 Z
9.           }
   
10. 
    0 J, w8 w/ j% t  b" Q
11.           if (EQ_is_lt(i,0.)) {
    " G- v+ c% x* q' \/ f2 j9 Q
12. 
    * Z. B1 F+ m" `+ ?
13.              if (EQ_is_lt(k,0.)) {
    
14. 
    " T, _+ o" H$ H7 E& q
15.                 B0=atan(i/k); B1=B0+PI ;
    
16. 
    0 }3 ^% e) n2 \; F9 f
17.              } else {
    4 m1 ~& T8 R! p6 L$ P; Z3 y
18. 
    : b7 s1 f" T& h
19.               if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
    
20. 
    
21.               B1=2.*PI+B0 ;
    
22. 
    
23.              }
    7 d9 F! h% w$ v, C
24. 
    
25.           }
    
26. 
    4 C: d- @2 z1 S% N# e
27.           if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
    $ R/ z6 [1 D* ]7 a5 n
28. 
    " {! c  e" d% s* [5 E. J
29.           B2=(-1.)*B0*(2*PI-fabs(B1));
    
30. 
    7 P  \: m; r$ ?0 `$ k1 n
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.;

復制代碼

通過輸出的NC程序，反向輸出的刀軌數據與原始刀軌文件對比，其數據結果一致。

登錄/注冊后可看大圖

測試結果：

登錄/注冊后可看大圖

# F( q% X5 C1 t% r& \反向測試結果

登錄/注冊后可看大圖

yucammayco

謝謝分享

云與海的故事

謝謝分享

qms88888

感謝樓主的分享