APT刀軌數(shù)據(jù)生成NC程序C++源代碼

若楓 · 發(fā)表于 2025-5-21 20:59:21

馬上注冊，結(jié)交更多好友，享用更多功能，讓你輕松玩轉(zhuǎn)社區(qū)

您需要登錄才可以下載或查看，沒有賬號？立即注冊

×

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

int EQ_is_equal (double s, double t);
1 O2 f m3 Y' m, ^" C
int EQ_is_ge (double s, double t);
7 F# j7 u$ A8 n6 f" a, e" |
int EQ_is_gt (double s, double t);
2 u& c" Q. j4 p( X( y* b) ?5 Z! r/ H2 J
int EQ_is_le (double s, double t);
. C1 w! M! `# `$ u
int EQ_is_lt (double s, double t);
5 G7 j: @% V) E9 d4 Z1 f v; q; l" M
int EQ_is_zero (double s);. Z2 {0 x6 T- L& }5 p
//=============================================================
9 d; T7 d8 `! z8 A
double ARCTAN1 (double y, double x );5 {# ~4 ^: a: X' n3 o
//#=============================================================
: f* K$ Z v; J2 t" U! X0 F
double ARCTAN2 (double y, double x );4 @9 G* v' |5 B; v* H
//#=============================================================$ U$ s9 \0 \/ E4 Q. l
double CheckConst ( double angle, double constvar );2 Y% n% [& [% {, k
//#=============================================================# |! |& H5 n4 N r. R! ?/ d
double Check360 ( double angle );
8 ~5 ?$ S/ O+ c9 p: q
//#=============================================================4 `- c6 Q8 G1 m; _3 K
double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
a: ^ m: [* D- I
//#=============================================================

復(fù)制代碼

以下為部分源代碼，用于判斷，計(jì)算角度等

int EQ_is_equal (double s, double t)
% ^+ @9 H# \( |" l8 e$ e
, b& w5 B6 ~ [& f- p
{" K- ^ H% n2 G" w
9 E' n p* p0 t2 Z
if (fabs(s-t)<= system_tolerance) { return(1); } else { return(0) ; }1 e4 W" v1 I: ]( M9 {
, _/ L7 P1 Z" a9 u
}
# j5 h- _: K+ ]0 b: I9 T
0 q% P0 {3 S$ V: Q- u
/***********************************************************************/
& U7 P- E# p, J% a% W) `1 W5 B5 {
# x) L' f4 E* t( Z! U" p' c: q U
int EQ_is_ge (double s, double t)
/ F2 I5 q% R" z* e* g
% P# P. f( C1 n4 R, e; j" v1 q
{/ i! ]# n1 v% g: W S- Y# e* _
# g; d% G' i8 w
if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }" z- S. } o) { v2 J8 |
6 ?) P- ?1 V. P
}7 H+ g; S/ M* }
4 f- H# N" y7 V: C, Q8 `1 t" s
/***********************************************************************/
% p) [) j" K% Y: P/ a
2 I c1 g, F6 U; r5 f: B
int EQ_is_gt (double s, double t)
! Z' l4 ]+ x/ H# R5 B6 n
# }# _/ U4 s. C+ `4 b
{
) ~! K' o { d5 [/ T8 R
. t# E$ U$ g4 o4 s" z& ]
if (s > (t + system_tolerance)) { return(1); } else { return(0) ; } ]: |" y6 {. [+ [* w# r/ S
: C- K. K% M/ K: [9 u& |. @
}3 L9 B# W' [9 E# A
; T! y* x; o. r. y o) Z/ R
/***********************************************************************// ]4 O" _, _8 e4 S4 A! M
1 ?* z/ V L8 @6 }
int EQ_is_le (double s, double t). d! Z% |% J- s* B. q. _/ I
% l9 }4 ]" ?! f( ?4 _( K, o5 I
{
! P5 @+ U! b& a
; Z3 G# c* H+ g5 e0 l" e- h
if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
9 q% }7 h% }; }1 G& Y
9 \5 [& O- }) n) [
}
& v* j+ n* m" }2 d
% s" K5 N( x C9 Y/ c4 t/ `
/***********************************************************************/
3 u4 M4 s* O, S- u% W, n9 V
' R( g7 G$ {0 n- G4 P6 U# G \
int EQ_is_lt (double s, double t)
; x3 T" Z% `0 j$ y
2 T; G2 b+ P/ l% y" i. Y: \
{0 ]3 G. {* e J% [: E1 L
1 D0 n9 p1 p' m4 R
if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
2 r0 I6 w4 ~+ J
- z* ~- g: |+ U6 a9 n9 M( A: @
}
$ w8 ^' v- C7 d4 D
3 w4 o. r) E l" E
/***********************************************************************/
( g `! y9 ?/ {2 d) y! Q1 X
: p5 t7 Z8 i* O
int EQ_is_zero (double s)
, z( _8 Z3 n* O! x* |( c% k+ u
- m' k. x7 l G5 R" W0 x
{
$ \+ u- o2 S% Q6 F& D ~( |) q
; ? G3 S9 k8 Q/ E8 U0 d; j
if (fabs(s)<= system_tolerance) { return(1); } else { return(0) ; }
1 b4 H4 ?! K: |! `
D5 m, w+ _; F: C
}2 D# B% b- g( A% a+ e N
" A( p, a, x+ u: L. B
//============================================================= b! M, P, l! d0 Y7 {; G) @5 c1 ^
& z/ N& U9 K7 z4 A0 c
double ARCTAN1 (double y, double x )& |& f6 m1 ?- {% |( g& t) h
0 _( ^" j/ T! K
//#=============================================================
2 n* z: t) U# I! @" ?, n
% R3 F' y9 `) P6 Q* Z% ]1 b
{+ w7 h. |4 K& E/ b
/ d- K( F2 c, X! q0 Y) ?. T
double ang;
0 `9 J% Z, | |
% z% V& _% |8 L0 w
if (EQ_is_zero(y)) { y=0; }+ W h5 I" a6 l9 C( F; k; L
' `, H' S1 r& z* [+ a$ q
if (EQ_is_zero(x)) { x=0; }
' Z2 J3 K, j R- g
3 q. n: e2 [7 b& n$ W
if (y == 0 && x == 0) { return(0); }: _5 F& @! ]& f- g
3 x* y I+ T2 Q2 t* `" ?9 y7 ^
ang=atan2(y,x);! r" u+ \; t& f& {9 J
/ X7 c6 a4 R& A: v" k1 r5 d& a
if (ang < 0 ) {: r% V& }: I* Y4 |% _
( f% T2 Q1 a, n, ~$ |$ `
return(ang + PI*2);, S8 ]: K' T4 v
! S& h# I) g: v$ X4 T% x% e
}. T& x1 q2 t% T1 |- r, k$ G* L, E/ x
8 B/ v) e4 R$ m9 p M
return(ang);9 g; M# I5 h; _7 w/ V2 e( y
}3 I9 y9 o1 _/ B7 q) O7 l+ [
}$ G/ M6 v; n- \
' G; `/ z- U% H" A6 `8 F
//#=============================================================
; h2 _' h, X- T+ g5 i
: o( W3 k( u; H/ U8 N
double ARCTAN2 (double y, double x )
2 A0 e9 z/ |4 }1 v. T
6 v$ e3 j% j `" |9 ~0 S* k
//#=============================================================
2 X8 o: Q/ ]2 \4 z5 R& X' P- |
) \1 S/ ?6 \ F8 p! c* N% h% o: I
{
6 E8 S- I) v6 N6 `8 W
1 n8 B' c5 n; j) H
double ang;3 s- T( f! R& V9 T
+ |* V4 z, ~3 V. w$ `8 p
if (EQ_is_zero(y)) {
& R4 x, A/ H1 a4 S6 X, Q
6 P1 t. L( z$ v) p$ g
if (x < 0.0) { return (PI); }5 j, E' k, r) U b! N5 \/ l; S
/ N- }+ I) r+ u8 H4 k
return (0.0);- v; E0 {: d. C& ~4 X( {: e% s2 \% {
/ b$ Z! X9 }1 r8 Q m2 _+ h+ v
}
" i9 Z$ c' m# d5 Q6 ~
( l$ p$ r6 q- s7 s+ n
if (EQ_is_zero(x)) {* q. f: k$ u1 {; m
" n! |) _ X, r8 E
if (y < 0.0) { return(PI*1.5); }" }9 {2 P8 R- N( G/ Z
- N' H# c- y" A# h6 w5 O5 n3 ^' W
return(PI*.5);
4 p7 x9 u q1 i# p4 [9 d
' _" C2 X) i9 k2 i' o9 i
}
$ q, ^- F7 X3 p3 s
# V& Z- W" [8 x
ang=atan(y/x);
1 R: ~& f" V' c/ O' b/ }
+ o/ m& P6 v% I9 _7 x; P) n
if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
, j! |9 U# m; ?2 R; F( Y
3 q* j2 Q* [% Z }, E# h! s
if (x < 0.0 && y < 0.0) { return(ang+PI); }4 w% ?3 L+ \+ m5 K$ I: ~$ m; v9 r3 C2 i
9 C/ b- s ?0 x/ |; q
if (x < 0.0 && y > 0.0) { return(ang+PI); }
: W6 F0 i! @4 ?# R
* C. A1 X, Q$ Z9 ^. S0 Q
return(ang);
( }! c! R( y, `4 l Q
0 J8 b; D, } }2 _9 j0 S( m! Z; U9 ^
}
* O. a: a! z- o/ C5 Y, z; g
. C2 T( b* C3 Y6 G
//#=============================================================& v7 {! q' K) Q+ h
) m1 y' o; n1 a: z# b: e+ j& I/ D
double CheckConst ( double angle, double constvar )& F; T3 Y# y4 n }) b2 \
' z6 \1 U0 ^9 s3 y0 y
//#=============================================================( D7 A7 N; e, p" a8 m0 m5 R
; b/ N; W% y" l" _& g# x4 R
{
G% U. [: _8 i$ f$ V4 s4 ?. v& U
/ W! J3 A0 y$ v0 S0 P; K: g) H
while (angle < -constvar) { angle+=constvar ; }( y- Q1 k7 H# G% C# y
' [# B$ H$ W; S4 c
while (angle >= constvar) { angle-=constvar ; }
$ _. K8 F$ v; D% {& G9 g
) m0 ]: j% ~! |
return (angle) ;2 y0 j9 X6 M) M) j' X# A
, B H+ p. k& q( b, ^/ {7 a* P
}: h3 t, v5 r0 U
) `& w/ S( J' G
//#=============================================================
: f4 k% a8 S& B9 T! O# K/ o' C E
9 k; v6 o- p2 y0 Y5 z6 x
double Check360 ( double angle )2 W0 A- B; l$ N
8 E( z" Q- M3 h$ I* @+ ~* _ f
//#============================================================= d9 M4 o* g2 g2 w
" S: e4 |; q3 f$ ?
{
+ H$ ^4 o5 G* }3 \! o# ?. b
! i+ M8 e, G! u5 n/ k; n
while (angle < -360.) { angle+=360. ; }
3 R- [+ j5 O3 U N+ _4 G1 @: f
+ z; [# Q( ~' _3 r
while (angle >= 360.) { angle-=360. ; }
( T0 l3 u+ X! b: x/ l% u0 U* l
1 v9 o- U- |" |% s% Q
return (angle) ; S) H( H3 H/ q+ G# I) P
6 j# f8 Q& A5 d" P
}
+ R, G8 ?/ s2 R* z
9 y9 }4 G! x( f3 G- j( l/ S# B
//#=============================================================0 g y* _2 j- A# q2 ?" p& |
- P# P" }8 G# x
double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )( }9 W3 K3 H1 q4 i
B% p, ^5 O! u
//#=============================================================
! \7 h, F7 b+ R- J( b
2 h" D2 Z4 M, k' k5 R q
{ W, J: @# J3 j" Z' ^1 c! P2 V
5 `; R# C6 E5 Z) k3 a
while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }% o2 B4 L) | K3 U; J2 W0 C
. ~3 e$ W* W3 q- F$ w7 ~
while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
6 Y2 U/ b/ j# d2 d! Z
5 d. n/ _( N6 G; j7 N
return (angle) ;8 Y9 P" Y/ m$ e2 r# R. {
0 K" c7 W4 y7 L
}

復(fù)制代碼

以下為搖籃5軸計(jì)算過程代碼

i=sin(ang_rad[1]); j=0.0; k=cos(ang_rad[1]);8 X2 S; F/ G3 n; _( n9 J
% w4 D) g ~ l( ]7 \
j=0.; B1=0.; B0=0.;# F1 {+ \( M. m9 C9 s: i1 p4 _; x
% j* {* }$ A* f# Y
if (EQ_is_ge(i,0.)) {
- _" M T0 w, N1 v8 K
- S2 Q" r1 }, l, r; s. v" d
if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
- X% Y) Y. I2 i. W" _. g
* Y5 z7 m8 Q2 o( K0 ^
}. Z3 d2 ~4 \, R0 s5 D: y( M
" |; I0 l3 |: ?0 S. F2 T1 a
if (EQ_is_lt(i,0.)) { P) Y- D' W8 M9 [$ C( E* S
2 }& C; b1 b& C( G+ Z1 X
if (EQ_is_lt(k,0.)) {$ N( Q" S' e) v' c7 x" O; r( f7 P% K
# c' W5 @) N% k( E5 \
B0=atan(i/k); B1=B0+PI ;" V! C" I: Z" @* z9 X
( h3 o$ W5 Y' l" t `; M) A3 N, c
} else {
4 Z; C6 o$ \& a1 C Y9 K4 H$ i
5 J" e* F8 q& E' a% e
if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
1 \4 x0 ^) d0 m. L) C* L
f: v5 b2 T% y6 @
B1=2.*PI+B0 ;8 |1 Q5 k7 x4 H& l
, w7 X2 G" o4 i
}, S1 k- d1 |7 c
5 i1 W1 I3 L- E: Y. e
}2 R; K: ]- J0 Y" Z% `
; A* U6 f& y- L! e- r1 z+ B
if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;( F0 I4 r& P0 g8 P8 H! M
5 }1 g8 {; w, d& C6 J
B2=(-1.)*B0*(2*PI-fabs(B1));
. m+ D) N. ]5 |, F1 _; D
3 T! X- B6 Z7 M4 F- A* Y& [
ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
4 H0 D9 A% A( @: y
+ [/ i& }, _5 P: M, H( ~7 V
ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;