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

若楓 · 發表于 2025-5-21 20:59:21

馬上注冊，結交更多好友，享用更多功能，讓你輕松玩轉社區

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

×

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

int EQ_is_equal (double s, double t);! w9 ?6 [$ o2 J& x+ m9 D9 |
int EQ_is_ge (double s, double t);7 Z% s- }' W4 ~) G$ W1 m" ?& u
int EQ_is_gt (double s, double t);
9 p2 _* H0 _' u2 _, P
int EQ_is_le (double s, double t);0 Y& ?& m# z7 L& Y& O1 `& R* X
int EQ_is_lt (double s, double t);3 @% j1 K8 v, Q/ s& K; u
int EQ_is_zero (double s);
2 i/ E. O/ C! g4 g
//=============================================================
6 g' [* }" Y: t+ a+ G
double ARCTAN1 (double y, double x );$ M8 [8 k* I. n: Y
//#=============================================================
o. V+ g; U, N* { X) o
double ARCTAN2 (double y, double x );1 n- c- H s3 Y) k
//#=============================================================: A; O. h) T* D! o3 Z
double CheckConst ( double angle, double constvar );
$ g H. w N5 F! f5 h- S7 q
//#=============================================================; n' ]( G% B# a3 m5 J5 Y, H
double Check360 ( double angle );& R* R1 O; o, F F U. t. Y6 \
//#=============================================================' g. u. b. d7 S, X
double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );, k: O% N7 n9 W; y7 C8 n: Y0 a
//#=============================================================

復制代碼

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

int EQ_is_equal (double s, double t), @: c. w! ]. _& e: \
{! n6 J9 |" b | k1 p" Z7 m
' k+ m" _& S& I7 I( y* x. i
if (fabs(s-t)<= system_tolerance) { return(1); } else { return(0) ; }
8 d* Y8 P. }& h8 b% [( v
4 \% v* F3 t& g ^4 q8 x
}4 F! p7 c' k( z2 W6 H
& r, H$ x2 K' }: G
/***********************************************************************/
" l2 I7 ^; b y1 e. D. ^
9 Z% V5 x: I# M9 A2 n
int EQ_is_ge (double s, double t): w* l# i2 g- N+ V
4 A% B+ o) n! J! ~
{" u2 l, R b8 u$ q" ^6 @. {. X
W' o7 I+ Z- z p& v
if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }: S4 E8 k: c7 T3 D' c0 G
" Y+ n# ]( L; r
}6 z# K- d3 r t) ?7 M
, s2 W/ p, y" f
/***********************************************************************/) F; z8 i. L# U: r
5 I$ e( N8 _2 a2 ?' ]& U
int EQ_is_gt (double s, double t)
4 ?! ^) q; ^/ J! W. U
; d6 y- G" [6 \0 V* D
{" p! R; X* A! Q# B/ v
6 p4 {& i6 u8 _4 q
if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }) l$ F: B; i8 S1 c5 o3 M" Z7 o7 T8 \
" ?' w" ~2 h( I8 ]) k
}; {& E4 L8 z" H7 b7 p x
1 c' v0 W% S0 N2 a
/***********************************************************************/
5 l6 a$ x' C, C
4 O) N5 ?5 U4 [3 v
int EQ_is_le (double s, double t)3 K: D* Y% e+ h' R4 K
6 I5 V# K! m! W" t4 k2 w# L& d3 x
{4 O5 f0 T* f$ m
9 u4 E \ ?: N s n
if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }- Q; S4 {) f, ~$ v# R
/ k: S% R4 X+ N" {; r7 w! ]" B
}8 ^, j6 J# \. l7 u4 S
$ N4 f" M5 \. X, i0 j
/***********************************************************************/
7 l6 H, v: h8 q3 A; j8 P; p
% z/ V* H. G) O& L
int EQ_is_lt (double s, double t)7 ?0 _$ ?+ | y
8 f) h7 F& A6 b8 k) F9 [
{
! w0 a; |. i' l0 y1 B: j
" }' }$ A+ l" r( O. e6 i: F
if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }+ n4 P. ~6 w9 B) m+ u1 M/ ^) |
?8 F3 }$ I9 Q7 g1 m
}! j9 l1 s$ u2 q$ O) _3 t, y
. T9 r9 _3 |& ~( D1 d& C$ f( T6 u
/***********************************************************************/( H; d# y# _% C4 c( d7 e: L
% c$ D2 p% `6 {1 ]
int EQ_is_zero (double s)# p2 R% y/ t% {8 u/ q
9 F6 x+ Q' z- D: }
{
5 q2 A: w4 S3 V5 w( O
7 p/ @4 v2 R* M8 {$ X4 e9 d
if (fabs(s)<= system_tolerance) { return(1); } else { return(0) ; }" F7 L, x0 v2 J! p g: B h
* m3 I \& \4 J, F7 p
}# S5 ^& C' {+ a2 d h$ h
) o. H( `8 F' a, V9 {# q
//=============================================================& \) N% Y5 n$ G" }) R
+ a- Y( l& o* g1 w
double ARCTAN1 (double y, double x )
$ V. ?& p9 x8 {' @3 |0 G; `% C
$ e% ]9 v4 M$ x/ A
//#=============================================================7 e5 a1 J5 Q0 ?$ n$ X
$ g0 m; G8 [$ \$ G, Y9 ?
{
. u1 ~7 E5 V# [
4 z6 s8 Q# X$ F' [
double ang; f9 {% ]2 x2 _( [( S
% r" p1 l, p# S; u' k# Y7 R) Y
if (EQ_is_zero(y)) { y=0; }1 u. Q0 n* @/ y' s/ {: R) E7 w
. X- w* D c! p: h6 t
if (EQ_is_zero(x)) { x=0; }% C( K0 w6 X6 I3 A
, L) B8 Q8 Z& ~
if (y == 0 && x == 0) { return(0); }6 t- W- C! ^7 @
2 z5 [( m" k/ r& F& l# `9 b" z
ang=atan2(y,x);
( P; R5 u1 Y5 Y" f7 u- {9 v
; V# d$ u! K% t3 `% k
if (ang < 0 ) {) v5 F0 P& Y/ m z; A
0 i* \) ]5 I1 k# V% T9 I
return(ang + PI*2);1 C* g8 N* M* x. h: L
, _4 M1 g! q9 j* m! B H
}
) y8 v# w* L9 T4 m
6 p7 s3 Q3 Y$ K# J
return(ang);
; u9 L) C; T& R7 w5 Q
- Z% r* E# n) z, r$ C/ S- Z
} g f$ Z; a$ ?2 i3 Y4 u0 s! a
, c- P- W! h* w
//#=============================================================
; a, n& x9 [2 m! K! h
, d+ ~& v( ?" R1 T4 |, m. }/ B
double ARCTAN2 (double y, double x )# g! o; a8 G" x& W
( M6 E6 O8 v5 b* z; w6 S! g0 k
//#=============================================================
: D$ X- u, n; _5 g$ |
# ~0 L+ y# D+ G( i {
{
9 q9 k' G7 K& T
: O/ t, q1 B, {! ~
double ang;6 A) v7 M0 ]0 P+ M" e+ k1 G
$ c& C7 z0 C) u! S+ L
if (EQ_is_zero(y)) {
% {' ?4 _8 g4 b6 r" K0 {. Q
4 n0 x. k3 V+ j1 U- H0 ~
if (x < 0.0) { return (PI); }: e0 D( v) J: y' U4 \2 r: D" r5 c
7 T. a! J5 y6 J( Z& x) R4 N
return (0.0);
0 ^) ^& O2 `. R8 O. A! C
) D" S: \4 z8 B" f$ U
}
4 L: o' u! y' [6 R; ~7 R0 I
' r) W$ w; c, y
if (EQ_is_zero(x)) {
; B; @7 d9 d# X6 t' i! b2 G) Q3 }/ S1 W
9 B+ A: m/ J4 B* L% ^
if (y < 0.0) { return(PI*1.5); }, E% a7 ~% D: v ` U$ n0 _
return(PI*.5);4 U+ M. A) a1 c8 V" m- h4 g
) V( h) R! y, V5 m" _
}
$ s- z$ n) m& p2 G7 O' ^0 B, j
7 z+ w8 ?! {5 \! @" @8 L
ang=atan(y/x);) P% K' S" A+ e0 i. V, C; V
: R- d% I& q4 l( u _3 o
if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
) ^" y; M; M* n9 i2 v
6 m" w1 e2 j0 c1 F1 O
if (x < 0.0 && y < 0.0) { return(ang+PI); }
9 w+ ~% m% V' b7 W# O) F3 q
3 O' u% T8 _/ a
if (x < 0.0 && y > 0.0) { return(ang+PI); }
1 o; r2 [% s/ W8 q
- x3 Y, p: N7 H8 [. ]3 g# J/ w3 r/ [
return(ang);) k. m6 H3 v% q8 S; I
% i. `" r7 W# {: J
}
* c# `/ j* E: ], h
9 n# Q$ R+ h+ q: ]. F Z
//#=============================================================
. O6 {+ f4 R; l! x
' K" f/ x7 K6 Z: E. g$ O
double CheckConst ( double angle, double constvar )" p: r; a& {# W D
. j9 O) n/ M3 ?- L
//#=============================================================" [: X- }/ m3 ^: A& E9 R
7 T6 N4 O* D' Y' Q
{
Z0 ^. G+ _- @; I% z! S) ]7 M8 k
0 r* e, d; O# o' X
while (angle < -constvar) { angle+=constvar ; }3 V/ ^9 P$ |0 b7 k% f0 f* I
]- r7 K$ Z7 B3 B# D$ h8 l# x* S
while (angle >= constvar) { angle-=constvar ; }
; o/ [9 v4 @) l- p6 m' |
3 P' M: \2 }, E% T% W. }( ]
return (angle) ;: Z* ?0 h$ t# Q* @ c2 O1 c
5 x( O% j0 q1 k, g' \6 B* \, ~4 Q7 m1 W
}% b6 I F. t* L, S* m4 L4 W0 e v
, r5 f7 s4 V% ^" I" I6 l
//#=============================================================
0 }4 u" X9 K$ c( M/ y
4 t3 f( ^: I- F6 @9 t
double Check360 ( double angle )
: ^8 L8 l' \* @; M8 T
4 _; D( {9 [: Z: y* Y- t3 @; {2 Q
//#=============================================================4 Y4 K8 ?4 M- ?
# g/ c1 m, N! R4 h0 l, B
{1 f. t. Y1 S& l9 @8 Y) M3 B& z
4 ]. i9 B( E" }" Q# Z
while (angle < -360.) { angle+=360. ; }' ?' c; Y" v, y) Q1 g/ _# U' l+ C
/ m# ~2 \" m2 ]( h% t
while (angle >= 360.) { angle-=360. ; }# S( v( D: I) m8 N. f) {
0 O7 v2 A# W! ?# X
return (angle) ;& N/ F- ^5 `& R' m! I' ]- d
x- _: a) J: \$ I+ }
}* @- w& ?7 Q2 j2 G) \
1 H/ D: u5 P* H5 n( o6 R9 l
//#=============================================================
" \* F* I% j5 u. I5 A( j: F
, G7 O% `8 ?" P
double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )7 o! k# p. q7 ?" u; S/ C
/ {. Z1 _, S) o! }$ v$ c
//#=============================================================
2 ~) W D' { F% A
' H% C/ i" F3 o8 g4 G9 n
{$ g# s6 T6 R$ p0 q! o6 L, n/ g( T
% k" V" p& |* v1 Y w
while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }; x2 U' ~6 Y, z5 O
; L6 r% s' _6 t; z
while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }" w; V7 D+ E; l. l1 i# C$ `
4 A1 @" p: X' h1 x: g- b
return (angle) ;
4 Y h+ f E! m* p/ A) T
; e3 t+ K/ L. V# z- D
}

復制代碼

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

i=sin(ang_rad[1]); j=0.0; k=cos(ang_rad[1]);
7 x& M: u0 d! q- G
) `' t$ `. n& D! m8 E! L) T, l
j=0.; B1=0.; B0=0.;0 ]6 ]& X" R5 [& E5 Y K
3 g2 {9 n. B* e! `
if (EQ_is_ge(i,0.)) { Z+ t, R' y3 n5 | E+ e( ]
/ x5 s* Q, F. g& Z$ S6 p2 U4 f
if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }( K3 C" \0 J, ^5 s$ Y) g; C& l, S
0 \; q: n! U- D \1 w, ?
}
' P" @. \0 T' Z3 v2 q. d' ^
" |0 i7 i! G2 l7 ]
if (EQ_is_lt(i,0.)) {
* @8 M/ T. d2 x! d2 Q9 j- Y
) }: d$ v$ u2 U/ p) V9 n
if (EQ_is_lt(k,0.)) { ~3 t% U- O. E) G
! P. R, v2 }- I1 }6 r6 d
B0=atan(i/k); B1=B0+PI ;1 ]- q7 e3 O5 \$ I
, X$ { d: I) ?+ j
} else {7 W3 b& q: \+ ]; e) h: F, p
/ D' `; j5 J; V! H, _$ T
if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }- Q# [' }% I1 W/ T( `* \6 H
7 P6 ?' F/ C; A
B1=2.*PI+B0 ;* q" l* {% y/ j% {
5 I1 R+ ^/ g' I9 M
}; B* e1 V/ O1 f# Y) k( z8 n
. l, V8 e( n, ]2 S# Y( N$ I
}
" M3 ~+ w* @2 V6 H. Y9 v
_) s Q1 O2 Q$ p. n: b) }& U
if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
/ G4 M6 e# [# b1 {
' ]3 f* u6 K; x2 t m
B2=(-1.)*B0*(2*PI-fabs(B1));6 B2 z% J) x, M* ? E
& ^$ |+ A0 ]0 a# G! U: I
ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;- [9 j2 b4 C4 e# l' I9 C {3 N
; E+ N; O9 }9 I) @
ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;