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

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

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

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

×

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

int EQ_is_equal (double s, double t);
) R; f7 \$ V1 G9 W; h
int EQ_is_ge (double s, double t);+ X' {4 o) L. z" I( d3 G& p
int EQ_is_gt (double s, double t);
+ Q+ b0 J% I; b" ?& T% C7 B' |
int EQ_is_le (double s, double t);# V* u4 c n8 R, u
int EQ_is_lt (double s, double t);+ O5 Z( [9 B* `' S- o# @8 C
int EQ_is_zero (double s);. ~: p$ c$ a3 O1 S; s
//=============================================================# S6 Z; x* P5 q7 |8 t
double ARCTAN1 (double y, double x );
- ?8 d8 _ ^ G; X
//#=============================================================* l; K" i' u. C% R2 }
double ARCTAN2 (double y, double x );7 g1 f0 E& L/ o/ E- B' |: b
//#=============================================================' v( D) ` [0 r1 S6 t
double CheckConst ( double angle, double constvar );6 h6 n4 u6 k$ y0 W4 s4 K
//#=============================================================
4 o4 h+ D1 b2 ~' O
double Check360 ( double angle );
! D0 U2 l8 }: b! V x: u
//#=============================================================
5 l# r& T7 a4 B$ h, w3 D) j
double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );) j/ U; f8 X5 R S8 p
//#=============================================================

復制代碼

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

int EQ_is_equal (double s, double t)3 h% r3 E: {9 V/ c# A7 Z/ r
( a' D+ P# C. m' ^2 R, n* S5 {
{/ C7 [5 d: ? J" c% s/ Z
4 G6 i2 A3 x7 t/ Q/ z
if (fabs(s-t)<= system_tolerance) { return(1); } else { return(0) ; }& W) T9 Z7 r* v# [2 R: o
0 {% |6 c: X0 E6 n4 a% l2 N
}
5 l7 l9 ?" U ?5 h& R% M9 x/ o3 L
2 q/ R0 V' a; P3 q
/***********************************************************************/
* {7 c- N6 W) m# n% q0 C6 _) z G
% D# q8 N4 g: k/ c% Z
int EQ_is_ge (double s, double t)* @& R( j* B* j$ e3 R2 f* k" f
- @. R1 l+ w: ]+ Z! K
{ _. j& A2 L' {
3 N: E% s" m {' W$ c4 e" j
if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }6 u7 U5 c; G+ @
( X8 A1 I0 Q" ?4 @. H: M p
}
$ S, t4 p# `' @2 n# N) U6 i0 Q1 q: W
, h$ Q- Y8 ^. K" N
/***********************************************************************/! g) h; L. h7 b
# u* [- p; l4 g s4 z# z/ N
int EQ_is_gt (double s, double t)
+ y0 I+ D: c- M! Y! W0 v6 G
7 ]8 S& K4 d. R* j% i
{
\. K" T, @+ Z9 \
0 d4 s$ l4 Z$ R; O: g
if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
( d4 I& r/ e' U
! y( M# P& \ Y1 `, t' @, }
}
, Z5 K6 Q2 ^4 ^% ?) f% ?
: p" X' e. Y6 m# }; Z
/***********************************************************************/
0 p% E( x$ O. D" z% i" L" v
q6 |* O% N Q# A1 r6 A1 a
int EQ_is_le (double s, double t)
5 Q9 a( h( O$ o. R4 L
3 T) z/ \7 N6 Q4 y8 L6 @
{
% G; v7 j; Z. f
0 y) b5 r0 q& X! t9 }; t& P5 C
if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
4 ]! D5 y7 l, i
! W0 ?7 u/ g1 @7 i8 n7 d
}
' ~9 R9 i/ H$ v2 A% Y+ h4 o. {" K
" K9 A0 Z' P. J* p% M0 T
/***********************************************************************/5 e( [9 g( c% t
- I; X- d. k: h: a% x6 s* n! B
int EQ_is_lt (double s, double t)4 G* a, F# E1 c2 u
9 G. \7 N. t6 {' K4 n$ F6 n8 i
{
8 V5 r$ s8 K* a& Y5 Z- Q
/ V6 \$ P3 s1 B; u' F+ D
if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
( v; \. B; n8 a3 s3 @- Q6 i
A; \" X! e4 e6 b. d
}
, H! I6 L* j9 ~$ K: `
/ Y7 o2 x; q5 c) v1 s
/***********************************************************************/; V& m: [7 H# e+ _6 t- D
3 \! C8 q/ k+ F+ d
int EQ_is_zero (double s)
1 c0 ]8 ]7 X' l2 V. {# k
. ~' k7 S+ v8 l5 h2 G$ X
{6 Q2 \( K: f/ i0 ~" @9 A
P; r! {) X9 i$ b9 t ~
if (fabs(s)<= system_tolerance) { return(1); } else { return(0) ; }
: y7 a% @- U) S: D& x5 `
2 @6 x. \' x6 ^5 S) [
}6 e S. y, ]. |7 k- W1 z& p# p
2 P! `: J# \- H
//=============================================================. }( p1 d; P3 t) {
( m7 S0 z$ b' Z L! v3 @* r# ]3 n
double ARCTAN1 (double y, double x )
0 |$ A2 l2 o; T9 D
; g' C3 x: y% n d
//#=============================================================
5 r+ g2 m7 N) r! J+ l2 [! x9 b
+ p: _7 s: K4 ^% b
{
1 Q6 k4 U0 w$ ]0 n( S" @/ y: H$ n
4 i1 c1 C" k5 n' ^$ v7 f1 N5 n
double ang;
4 f; T. C" l( Z5 A+ }. w
5 h' c/ d- c0 I3 R& l7 q* j; D
if (EQ_is_zero(y)) { y=0; }
7 F4 m$ C- U3 {$ r! h! d. B1 T: e
# d7 O( b5 J" S |3 Y
if (EQ_is_zero(x)) { x=0; }
1 q5 ~5 U$ Y" E" I+ S) w/ V- C' q7 K
2 Z7 m5 u! e$ E' w I& ^
if (y == 0 && x == 0) { return(0); }
% f/ {1 _" }- u. \2 b
- n9 d8 U2 z" o: c" e
ang=atan2(y,x);2 E2 W0 I0 d1 B1 R1 {) w, V
' R( v& }1 V& Y
if (ang < 0 ) {. S( K9 X# f9 Z' n% Q" y1 X
1 B$ \; ] y+ k/ b! W3 P7 z
return(ang + PI*2);, g8 C7 Q$ p5 m5 G! A7 l
$ B& b2 e/ U5 A( j5 a/ G5 W$ f
}
) T' j* S/ u0 F' A& Q3 ]
1 o: G- A( U F" t8 Z
return(ang);
/ n, y! C! p0 p$ y; T* ^. _
% {* \6 ]& |8 X9 g; `5 O3 w
}( s( `" \7 z. p4 l3 V$ \% \# U9 F' @
# C4 W9 M, g. |( k
//#=============================================================6 G5 \' X( p$ V ]9 | `9 |
1 h0 M7 j# D! y
double ARCTAN2 (double y, double x ): T- M/ C# @ p: Z9 }6 h, d( a
) x5 u2 ]6 P' W& @4 x& M) L
//#=============================================================& e+ S% H4 y6 o1 M, }4 R) v
# \$ Q1 V) R: [0 `7 N% a v
{
/ n: N) z; y1 I5 x# C$ Q! W
% C; ?0 t- [: L7 L* f; G2 W
double ang;5 B% h( G( v7 a, K% g
2 b1 P {; U5 x* B
if (EQ_is_zero(y)) {
/ l7 ?; c" B/ H8 Q! @
0 k0 T+ n0 O8 C: E/ R! ^' q
if (x < 0.0) { return (PI); }
7 Y1 N6 J' J9 I& P# z* y
0 r* u* i/ h& h k8 M7 c
return (0.0);
8 U6 V# ^/ ]6 _ w
! ?" q S0 o# }
}
/ V0 N1 n# O# R2 j8 x- ?
0 j5 E. r) I2 @3 s; u7 E0 l
if (EQ_is_zero(x)) {4 X2 A4 N' u/ s i4 T
9 M0 `" A3 H0 M
if (y < 0.0) { return(PI*1.5); }
' I0 `' n5 ~7 z
; G7 \1 t' W+ N2 y
return(PI*.5);: V) H- P4 N/ ]7 N
) `5 X" ^/ H2 w& t# a) m9 W
}
) u1 v( p4 Y3 w1 v4 d* v
; o7 ]1 ^* |9 @" J
ang=atan(y/x);$ t" S! S$ z& `+ J: D% q. ~
: s: D/ q4 f" x
if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }+ J+ ?, K2 A W* ~3 @( t
) x/ V% W9 N* |- R) X5 h& a% o" m7 d
if (x < 0.0 && y < 0.0) { return(ang+PI); }7 j/ T- \1 w K# O, w5 |
6 S l' S# t: w: N) F
if (x < 0.0 && y > 0.0) { return(ang+PI); }
9 R5 V+ P0 |- |5 I8 `1 R) r
* R) a+ z5 }+ F2 T5 s1 o$ x5 \
return(ang);5 O- u$ q, D7 h8 k8 C( R W5 d0 ?
3 z6 [$ \, S) N9 O& ~
}
( O2 A- h( @* S3 A* |& x
0 b/ |) [6 W H( Z2 n- U% M
//#=============================================================4 Q4 o8 k8 H, N+ _
2 `# ^4 r4 k4 N( a$ V) g
double CheckConst ( double angle, double constvar )0 Q5 l! O9 W4 U7 j) q
; B' q& p' h5 v3 U* `3 G: |
//#=============================================================
/ T& B' J" n% T( T4 y
( S- ~$ y0 U: P7 _5 ?/ D
{
9 @# [8 t, T- [# {( O
5 ~+ m4 j2 [/ \$ c3 Q I
while (angle < -constvar) { angle+=constvar ; }' c7 M% g8 Y* y+ f
/ Y4 X6 l! b7 Q4 ~4 v2 `% J
while (angle >= constvar) { angle-=constvar ; }5 c$ q% m8 O- d' E" c" B
8 H8 U% n/ {- B
return (angle) ;* ^- r7 K+ f: k6 m+ d& P
# s @* b8 w; g+ m5 t$ P
}
, s2 b( H+ u- R1 e q+ s/ l
0 f! e! b) n4 |! s2 {
//#=============================================================6 ~: \! W E( }; N, d" ?; U6 [
1 a1 j k9 G$ v7 m Q' x* k
double Check360 ( double angle )
/ P6 Z4 C, N# f' p" Z/ Q: Y1 e& b
- d, [, q* w$ o/ e& ~ j0 _
//#=============================================================
3 ^; \1 `4 _% D7 x
" L2 Q c9 b6 b" p0 e' j
{8 I# }3 _1 Q0 }; Y1 ^( l5 S+ N$ q
, ^* Y/ q) n4 E2 @& U
while (angle < -360.) { angle+=360. ; }
- m/ I5 N4 Z4 t T0 n! I0 s
A% S6 a+ z+ M+ P" t- b
while (angle >= 360.) { angle-=360. ; }
( i. q6 P2 ]0 ?# I4 _; V
; h- x, T7 t/ [& x
return (angle) ;0 j1 W4 u/ f, J: V) g' G
$ f* w. t M: @+ s$ G8 O
}
: G0 T2 J; x' {; r O% T
6 k g. J; N& h& c) R
//#=============================================================
" N6 ?2 Y) a" v# e
3 P5 q( S! y1 T6 \: d
double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )8 S! F. y- z. z" @& Q6 w# G$ r3 W0 l
; {. Q' R4 Q8 t: Z/ ]' V7 F1 ?3 @
//#=============================================================
* q/ w2 W" K8 i2 `* P! V
# a, U Z6 U$ C5 V( t
{
4 u3 q6 @1 ?) N! k2 @' z
4 W4 T" e- \% Z% c% L. t
while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }: Y# ]1 h, ?0 _* ^' O" Q$ [
6 [+ P* b" C4 ], n
while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }. x, H7 q) X8 I, {9 o# c
. o5 t$ j4 |. o% f" l/ r0 A/ g0 Q3 q
return (angle) ;5 C" a' c, P! j
' E! I( i) |( O. Z' W/ ?7 q }
}

復制代碼

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

i=sin(ang_rad[1]); j=0.0; k=cos(ang_rad[1]);, {! B# l6 t4 }% O0 w2 P
" i. L6 @$ G! t
j=0.; B1=0.; B0=0.;
0 z9 `, X' R1 ]" N
# b, l" l2 @& T s3 |
if (EQ_is_ge(i,0.)) {. ]# E2 A5 Y* A3 n/ P. R/ E; c8 E
4 I- K2 {4 Z* q+ x
if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }' E5 a2 ]7 o6 N' L% x- S
' _; j4 {8 \ W* C9 @; e
}
, o* k4 F$ z$ _5 t5 \/ [+ s
6 ?3 B, m! z8 ]1 B# }
if (EQ_is_lt(i,0.)) {3 L: V# P8 y3 m: e: z
: I* T6 H% e' I
if (EQ_is_lt(k,0.)) {' G) S' r9 C3 r$ v+ [9 |& T
) q* a" O$ c5 }: T' d7 }. E
B0=atan(i/k); B1=B0+PI ;: r9 N' `3 ]0 d: O) N" i/ J, y+ Y
$ A& d7 `( ?- H1 q; ^
} else {
' B. O4 B- L8 K+ r9 u4 r6 x
0 v) B! X# L) W2 ]; M4 ^& k
if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
3 O% c/ G, H, U% G
, o! u: z, d; `4 g) T
B1=2.*PI+B0 ;
4 ^# J% `: S1 |+ S( c d6 r7 x* q
# o. a( G, C' d9 [% ]6 Z" b' C# t
}8 C3 g9 w% `1 E3 k& i
' K0 G8 g' `, P. O* W
}
7 G* Z3 K" k& D, ~! K, O
/ R3 Z1 \" P1 M$ W6 _
if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;3 ~' t. X; T8 h2 \
* l# K0 Z: F/ d. Z5 Y
B2=(-1.)*B0*(2*PI-fabs(B1));
]! i7 A) B! d+ ]
8 ^$ [! F; C) W. Z ?
ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;6 L2 Y* l/ @1 S. n
# q( ]6 i; W, M: l
ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;