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

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

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

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

×

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

int EQ_is_equal (double s, double t);' D3 M( N9 {0 n9 _1 d& g" B
int EQ_is_ge (double s, double t);
' E( C, H$ a$ U0 }4 A
int EQ_is_gt (double s, double t);
# k' {' Z, w3 }1 D# K. p+ y2 ?8 s; ?
int EQ_is_le (double s, double t);
* [( Z7 d, {6 r5 P
int EQ_is_lt (double s, double t);: a u; A$ [* }2 S
int EQ_is_zero (double s);6 T" [ q9 r/ q) B% m
//=============================================================* @' V! G9 |% M* l: g6 H7 G
double ARCTAN1 (double y, double x );. S' C. ?" C# h2 N
//#=============================================================
! d1 _+ R7 b; k8 C
double ARCTAN2 (double y, double x );
$ ]1 t# {3 |7 n) l8 N- W5 l
//#=============================================================
7 ?# W" @+ H3 _1 L# [
double CheckConst ( double angle, double constvar );
' [, D0 m/ B/ {) O, j
//#=============================================================+ e6 T D2 S+ O) ^6 @
double Check360 ( double angle );+ j! R4 F) k$ B
//#=============================================================
8 F0 c( \6 u2 T$ z, ^' U
double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit ); l H. F. R: c/ \' b: {4 [! O
//#=============================================================

復制代碼

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

int EQ_is_equal (double s, double t)
6 R. F8 F% |, i( v8 D: ^7 a; Y
2 P" ^* l6 C! v( g2 Q& [* X; x
{/ x6 J! j. J2 d% ~% z
, F. U4 C# ^3 |5 B8 J
if (fabs(s-t)<= system_tolerance) { return(1); } else { return(0) ; }
; o/ Z6 J; C' S% a! o. [( T2 f
" @0 R! [( T' o1 ~' R( Q6 i, s
}; F% F( v) C7 K4 U, e' B7 U0 i
* l3 c& B. _9 j# B/ w5 u
/***********************************************************************/2 ^6 m( T; U, H: U
' `1 s% V) @& g8 @) V1 O, |
int EQ_is_ge (double s, double t)
, t! W/ F& c6 O0 p x; _
( k( o6 [4 x2 w) v
{* |+ m' V8 G5 Z7 w6 t- }
; u2 D7 [ h- T, v9 \9 [0 C: j
if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
( i( ]7 I8 S+ P |
4 m; p1 c" \ o. f% p
}
% X1 s" i! u. {: p7 M
/ J' d9 g/ o1 _
/***********************************************************************/4 W% i* }4 P* e' \% n6 J" O
! b. N& G; p4 g
int EQ_is_gt (double s, double t)' A2 [3 M9 S; ?/ X5 v2 ^; I, K7 c) q
& e6 z2 ]* k0 y8 _* t
{
# v( U; ]% o) W7 W1 p" F( d
- p$ X1 B, F# j" M
if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
4 Y4 M6 k1 ]8 _
9 r6 s5 K7 I7 ^3 [
}
4 V5 W4 G; [# L# R5 E+ y" D
5 @# ^- g( I& i9 J# z' v
/***********************************************************************/) x L- y* @* M, ]
) W6 c6 w V( {% @0 U
int EQ_is_le (double s, double t)# \8 S4 u$ E8 L) H
7 P: p4 \6 G1 H( ^! P" r# W
{5 R6 C! C; f5 p0 }
% W5 d8 o+ O0 C+ I9 u; c2 e
if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
9 \" {: h; }' R) h$ F
( L6 e$ z4 o8 H o
}: b- o. Q2 n& O
4 i0 \( K& G: s$ `' p1 Y
/***********************************************************************/3 ~! d- Y7 L7 ]; \+ v! o
( z( J" ^6 n) l* w9 f- A
int EQ_is_lt (double s, double t)
2 C0 H7 t2 Q @% O
- e! ]2 N9 d+ x ]+ h8 K1 Y
{5 G' q8 R9 G6 W1 x) g5 g
# c9 J3 j ^* n# X& \
if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }! S6 {' V7 A/ Z( _4 j
8 |5 l& t; `0 s: w
}% q( Q$ O. b" G8 \% {
6 }7 E, o0 x( F2 s8 `( m" D L; ?! ?
/***********************************************************************/& x% ?% X/ Q% `# d
9 i* v/ z1 o6 i$ o: ]2 q. Y
int EQ_is_zero (double s); }7 d) i4 b0 z7 Y8 H! D
/ u; B. z3 S% B+ p5 Z
{, R$ K) \% w. |9 U% w% i
- F) o. |3 }% S1 I, D f5 s
if (fabs(s)<= system_tolerance) { return(1); } else { return(0) ; }, s' }, H) z2 p# P
( l6 }; Q* q0 ~1 b
}( u( u* k7 N! n% e( L
: k( I+ ~& p' L d
//=============================================================
& I/ j+ f S7 O+ u
2 S& ~7 u& x" k g9 Z
double ARCTAN1 (double y, double x )9 U$ c. c4 d# j. z
2 l b. X9 h* ~* J- R, I
//#=============================================================
8 y/ v* j% V [% h
3 ~; i8 ~9 K$ }# J7 _- s! r4 G
{
1 w- ]2 A5 M) v7 J
; J! @8 S3 B* E) f
double ang;
, W7 T4 `( C+ H5 z7 _
; y& E' p9 k/ i0 d
if (EQ_is_zero(y)) { y=0; }
" ?1 a2 ]0 G, M' b
$ L/ m8 k- `6 W4 X4 W: r
if (EQ_is_zero(x)) { x=0; }" I& @$ K+ g5 u& Z# ?/ {( G
# o+ {$ |" r8 P( W4 n
if (y == 0 && x == 0) { return(0); }9 p' k( L V3 e. G9 B! ~: a1 e
+ R$ {1 O# m+ \
ang=atan2(y,x);
( k5 `8 _+ i$ [* m
4 [/ j0 ?. p: l6 q
if (ang < 0 ) {! J9 i& Y; A( P, b$ F2 o" Z
9 V4 n3 k! g* `4 ?
return(ang + PI*2);
# D; b9 ^, `2 ?/ j) n" u
3 {/ X; W8 T- F9 a1 g
}
0 A$ Y6 M& P$ \8 O
$ J& u/ S4 P, \0 I: k! a
return(ang);9 z5 M2 P7 t& T. i; V L
+ I$ M+ L0 I: }. V, ~/ t: ~9 U
}
; L6 ?4 D0 {4 i. u
- P E) x: g3 }, W0 s8 V( o$ C5 j2 g
//#=============================================================% _. |" h" ~% E9 N0 d, K) O9 A
; u' [/ O' x. [3 Y+ T. _8 H( A" L
double ARCTAN2 (double y, double x ) d$ Y+ Q( M4 t: T: e+ `6 A6 o+ l7 u
# J. \; B* l; Q9 [8 N
//#=============================================================% A) I& f9 ]; Q
4 _; ^2 d m( V7 j5 ^
{. C" I0 T1 \9 g7 s9 u8 {
/ ~2 P5 h3 q9 n& w6 x4 f: p
double ang; @& P2 Z0 Z+ M$ L4 y
8 r/ b& }* A4 X X" f% `6 G0 P
if (EQ_is_zero(y)) {
5 C8 d( V5 b# S" F( H f) S" @, r
( B+ ~! ~6 p7 K0 J0 ]
if (x < 0.0) { return (PI); }
* Z# q" @# z8 ]7 y/ }
0 k4 |0 X4 t& H$ \4 n* l( U1 X* n
return (0.0);4 J" Z! Z) z0 M, N) S8 g
1 X9 w5 c$ c1 }& m
}0 Q; O a, M# S! O5 Z S' e
$ }1 Z5 A2 e0 b4 w) w7 K p# x
if (EQ_is_zero(x)) {
; o" G, h$ J/ ^4 U' p6 x5 d' E
0 k2 w( o" v3 L0 V
if (y < 0.0) { return(PI*1.5); }0 p/ l: [8 \; ]. i
) M* ]$ w" _( k; Q$ m u
return(PI*.5);. i+ s1 }+ y$ d
4 l( C1 U \* Z9 U1 C# @+ n
}
3 u# I0 Y! e( W' m
, O# S/ g5 _7 Q7 U1 {
ang=atan(y/x);
( o. R# |1 ?5 m# Y
! ~4 Z+ S o# q- r: o+ e( |. S5 O' a# F
if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }1 U$ g5 }7 o/ P) l+ y& v0 V; w2 B
2 O8 p+ S1 D$ G% B; m* O6 j
if (x < 0.0 && y < 0.0) { return(ang+PI); }) V* m# b4 L5 s: q8 ?# w6 [8 H
$ Y" E5 h3 [6 Q1 \* z
if (x < 0.0 && y > 0.0) { return(ang+PI); }
& l! N9 [& R/ b
$ V2 ?( P. U% r2 N
return(ang);4 K. l6 m9 U) J8 g$ y! s. Z
1 \, b$ ?2 l3 [, Q* ?; W( s
}
" l) k- ]5 `, j
$ K8 D, ~: ?# K B
//#=============================================================0 K) J0 ]4 v: l1 U6 z5 S
- I) F# q% b; n( ]
double CheckConst ( double angle, double constvar )( {3 S5 M0 w/ N$ [8 [, B
% m; s1 p* ? R6 Q5 w$ o6 n: m
//#=============================================================
8 T( r3 m, Y; q& G5 {+ B$ C/ }
5 Q' J1 X0 f( r! y1 L3 q* \
{
' O9 l' N( L! q n- V: ?8 B: t7 v% t
# ]7 w: g+ c/ W
while (angle < -constvar) { angle+=constvar ; }* ~4 h6 N5 z2 m: H4 O: E
5 J2 `6 W0 m+ {* V8 @
while (angle >= constvar) { angle-=constvar ; }( [8 g. r; Q1 w: O% E
* d: t# Z2 ~8 B8 Y
return (angle) ;
! t) W( Q1 n. R1 Q
; w, w' F x @& Q# `. \
}
% `" ^( B9 O) ~$ S) s
! n* b$ V# q# G
//#=============================================================, i( t5 C4 p- z; U# p7 l, P
; N) \, \7 J+ M+ u _
double Check360 ( double angle )4 {% w# V# C+ m2 v E
$ Q% f/ F4 p8 F* l2 f
//#=============================================================
* }$ k3 _) u2 D' h9 _
" l/ Q6 D9 b$ d8 p5 N
{, |- s$ f8 z: g2 W( x1 C. F
2 c: C$ N1 i# F6 Y: V; D9 x6 H
while (angle < -360.) { angle+=360. ; }, e% P: ?& F; ]- _/ }: u+ d t
" N7 Q1 {; X9 S* D$ @
while (angle >= 360.) { angle-=360. ; }
! X# L. U: n" p) X; R
x- N( K/ `) }
return (angle) ;2 Q3 x l9 t* B& h
f" N6 ~4 \3 I# M
}& d8 Z: \, a3 H/ b5 n) ]
" a( V4 c( _7 n2 o, z. q
//#=============================================================
/ c! N3 N$ q& J$ v
3 t. \2 w6 v* K6 `3 q
double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
0 N/ g$ H+ j( @; b( Q5 }. e7 p
0 B, k' q" U4 @8 r) Q" }3 S" S
//#=============================================================' a9 f5 t. X9 {' O/ O
/ b6 t! |6 i# b( ]# d$ z
{
, M# [* t; \; w! l* m7 E! l: o
9 c9 T) g1 g5 e5 z) g# Q. h3 q. o) k) f
while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }" ]3 y+ H2 i) k
5 N5 H G u6 f
while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }) G% w; X3 J8 c1 a& |9 K l4 t
0 o! }0 u2 q: M/ u" y
return (angle) ;
' g( N* c3 i" `5 \* b
( R+ h. s8 [0 ~: n2 s6 u/ A8 \
}

復制代碼

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

i=sin(ang_rad[1]); j=0.0; k=cos(ang_rad[1]);8 n$ h# h6 l7 S
2 y5 ?$ I0 i) s/ B
j=0.; B1=0.; B0=0.;8 ?$ i- u7 D; W- q: ?# S
4 |8 q0 w- o( X9 z# O
if (EQ_is_ge(i,0.)) {
& F( v y1 j. I, t- J
0 A2 F3 @* r2 P* R a$ Z& P* @
if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
. l+ H( d% g5 R8 J5 p
5 c* h) U7 L9 D5 |0 @
}
! ]# M& }" ^6 l# P4 |
4 y' R' x* y: j: G) u/ I+ B
if (EQ_is_lt(i,0.)) {
( t! n- r% l: k: i0 l* T
3 }* k* U/ `3 n7 V
if (EQ_is_lt(k,0.)) {& \6 b; J3 n$ X* d
3 V0 G3 @' {( O) |! Q# }
B0=atan(i/k); B1=B0+PI ;
% T, t7 F. R r! m8 T6 K3 a
* z4 \, C+ C u- g: n' j
} else {; S- ~7 Z& p+ |5 O0 R$ w) {
! }5 P; n8 k) l" P
if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }2 K8 [$ B4 h7 c, L) b. n- G1 [5 J
% @4 a/ T/ _( j9 V# x) z
B1=2.*PI+B0 ;& n2 Z+ R( u! N, C9 Y
$ k+ q" o* B: j0 T/ u9 H+ {% I' b
}- X0 v2 I4 i0 d0 T$ Z$ t
, A' a9 M f* h- W) r8 m# i5 U
}3 \" @* i6 Q, V
# t3 F0 W% K0 p6 p; @9 Z! _
if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;
7 z8 P7 N- |+ Q! k4 R: r
0 Q6 S0 x( @7 V% `. l |
B2=(-1.)*B0*(2*PI-fabs(B1));6 x0 s# `+ u- P0 \2 q
4 E& j% z I0 G
ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;% f- Q0 V; o/ v8 B$ Z( U2 m
$ O) s+ ^% M ~4 Z% }( [2 @
ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;