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

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

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

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

×

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

int EQ_is_equal (double s, double t);2 K' e J) t. u. M* L
int EQ_is_ge (double s, double t);4 r# h% P6 U5 c2 F8 \
int EQ_is_gt (double s, double t);3 _; o4 C: \- t, B- p
int EQ_is_le (double s, double t);
* ?/ ~: L& |/ g5 U) X8 `
int EQ_is_lt (double s, double t);
int EQ_is_zero (double s);/ O0 R) \6 u, S* w3 M J$ ^
//=============================================================
3 j/ {& N! ~. O- t3 N- y! d: g' G
double ARCTAN1 (double y, double x );1 X( U. r( E7 T" j0 U
//#=============================================================
! L6 W: }9 n2 W: e! D) G
double ARCTAN2 (double y, double x );
3 Q H. i9 a4 H `5 M# P [
//#=============================================================3 m+ M; j7 Z R% L& k7 k P4 _
double CheckConst ( double angle, double constvar );7 D) \6 `' G6 N1 x" y5 `
//#=============================================================8 q; y3 ^3 O( i! R7 k! K& p9 v# v
double Check360 ( double angle );: M8 e. i/ |1 E1 e' q4 |
//#=============================================================0 l( R) _7 ^ ^6 Y1 n# }
double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );
$ k4 A2 f3 ?; x
//#=============================================================

復制代碼

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

int EQ_is_equal (double s, double t)
& `+ {7 w& P( e+ d; E3 _
( j% i* X9 U6 L
{$ i- y$ `5 p4 d2 d
4 T3 z. ?# N3 W1 |% H: H2 P, F
if (fabs(s-t)<= system_tolerance) { return(1); } else { return(0) ; }
5 {* q* i s1 d0 t
4 c( O. @* w# o# V8 n% x0 K
}) j' a6 k! T5 l6 s* x
9 O) G. [+ {% q
/***********************************************************************/2 {3 Z' t5 d( `
# e" b" ~6 X1 ]( f
int EQ_is_ge (double s, double t)% A+ ` d: k; D) \& i% z
& }1 Z" V6 d6 @0 k
{
/ Z1 x, @! t3 l) O. l
* s4 \: N) r/ Y: W4 t
if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }" ?0 n( S3 ~# k
8 e& Z. s: a, k- C) w
}
2 y2 j( P; c8 p: s1 G% U) v
) R. @* H: g% f
/***********************************************************************/
3 e# r9 F+ P! P) i
& b% e0 N- O' N7 K- w' I
int EQ_is_gt (double s, double t)
1 C1 X7 Q1 u, e7 ]2 V, @
* J" W2 J6 M% v6 H9 M+ A+ `
{
' n6 a! C5 O, l9 k$ r1 n
/ M" F( k7 M% Y6 Q/ I% K
if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }( N9 w/ h0 H) d. o0 s% O
- b; o. a- q" Q/ G: ?& R, u, p
}
9 f! C. c. l7 l* q* ?- X, } z3 i
5 `3 _$ L5 t( B6 R
/***********************************************************************/
+ o: o" l0 `7 t/ g X
# c+ h% h0 G! N
int EQ_is_le (double s, double t)* h% D" X! t# b6 G
7 D) c' M& C5 U7 r( G2 `- T5 n/ I
{
/ c! }6 v# {9 T+ o3 @
% l8 O* v; ?7 H
if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }
8 m2 `2 G2 G, j+ ?
- B& [' A3 N. K% o
}$ \ F z( ~8 h
+ B( i1 [# x4 z, f& O: e( H
/***********************************************************************/
6 W* C6 I6 Y* Z3 X
# ? \' j, F. {# W# b
int EQ_is_lt (double s, double t)
) R% f9 B: O! n
, F% c3 Q- S# E& ^: ]" W/ W, N
{
5 T3 o3 b# U( a) R; |
, E5 ~/ e- ^1 W
if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
% z$ r0 B+ m P" d* Z; R
, O8 w; i' M5 M2 N8 U8 n& \ _
}& H2 {9 U* A& v' }/ F
% E. x8 O% h. K9 R3 M6 c0 Q
/***********************************************************************/
6 t7 A9 D7 m5 q
! Z- S+ g. c4 y4 J8 r
int EQ_is_zero (double s)
' Z" z/ [& N! Y
- z' ^) @" H7 R0 J9 N, u' H3 J9 j
{
n% M/ ^9 d8 s% v2 \( h
/ q. s8 ~/ }* R O# E2 P
if (fabs(s)<= system_tolerance) { return(1); } else { return(0) ; }
: Q0 g* ?4 t- P+ W
+ z; W" n2 d( a: }0 k1 Z/ Y, F: J
}
c- N; n3 K, g7 a
" L! C1 V" N3 F: X6 K/ I
//=============================================================
3 O3 q% K! |0 m1 ?# ?
$ P( Y1 }- c- X3 ]( R
double ARCTAN1 (double y, double x )$ j1 P9 X# Q3 U$ b! G
( o4 ^6 W, Q4 }" O0 f1 F$ F
//#=============================================================- P) ?* A8 P/ P0 q# e0 C
) Q1 u. j2 L; c' U
{ S+ S4 l- |' X- g* A- S8 b
* K x8 m0 r- J5 H( E% K. y
double ang;
4 E' y# `3 {% ?6 x" U: x$ T
4 p$ [/ @% y! z4 y1 d
if (EQ_is_zero(y)) { y=0; }
- l0 N1 @/ Q1 C" F0 q' Z8 X
+ Z4 [* L2 c* O. E
if (EQ_is_zero(x)) { x=0; }
: b# Q, R3 T, w7 g" Y
0 m& d6 @* J6 n3 p9 k, Z8 `: W
if (y == 0 && x == 0) { return(0); }
: A' k) Q+ ~ v/ W+ @; x+ ?% i
" N' D1 ~& x! p2 ~' }& [
ang=atan2(y,x);
" M" P8 P# M# L3 @2 u9 m" E& ?' l0 n
$ p- Z$ G, J9 q- ^: Z; c" T) Y
if (ang < 0 ) {
3 u7 Y% m% \% x" c Z6 H
0 C0 C8 i; s" b: c% V$ w
return(ang + PI*2);
( q: f, h" N2 L) ]! I. Y
* H. Z0 W2 M# K2 V- n- L
}
) P5 `& I4 Y- n8 v/ U* H3 G& A3 h
& x* v$ l8 U ^4 ]/ B- {+ p! R, K
return(ang);
' _4 p7 t' d* s
G, ~/ U" m* E+ V
}
, X) C' N! ^& ]! S* c
- Z3 e; l- O% y( U3 H7 {& k8 \8 U: G
//#=============================================================
1 _& N+ C0 @5 Z; B. u
7 Q2 `5 f$ p- u0 O( E
double ARCTAN2 (double y, double x )
0 g# u! ], B M
1 ]$ R7 a4 W. [
//#=============================================================8 o- c7 ^# J* M) b6 r
3 j T2 j s, F0 z
{/ o k! X+ h h2 e3 i$ c$ G
% ?3 T5 M3 y! D# a" v
double ang;
, L: @$ K! ?: ~6 X7 |
1 u0 g1 U, x: Y# y2 e9 X: P5 K
if (EQ_is_zero(y)) {
* Z9 A& W6 a6 l1 M; i1 v9 K1 K, W2 L% e
4 b- j X: v" q: u; N
if (x < 0.0) { return (PI); }
* b4 Z# S$ c$ S
2 W1 _7 g$ o, ?" W) N6 c
return (0.0);: u0 ?* O7 m. [
7 Z: o( T t4 A' {/ K
}
1 R6 {, O$ z) _# Y
X, _1 J! Y# ?
if (EQ_is_zero(x)) {+ R! x& e# m$ k6 ^3 x1 l. N9 ~
4 n9 K' @ g3 {' C% x; m
if (y < 0.0) { return(PI*1.5); }4 f& Y% b% {6 s/ G* [
6 s0 P0 v" B1 D& @8 d, ?5 e k
return(PI*.5);
; [( U8 |. y- f' ^1 n& U) f5 G& B; J
! C& s" e2 z4 i2 H
}
7 W! q' Q$ w8 Z
/ L+ w3 O3 \4 z% U+ f% g
ang=atan(y/x);
1 D4 V7 d0 E- u. d( x0 r3 l
# M [- p" x; ~4 u/ S6 m/ T1 U
if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }: T# Z$ j; v: b- Q4 X
6 @' T. z. n: ^ B. E
if (x < 0.0 && y < 0.0) { return(ang+PI); }
: b$ v3 Y( `$ w+ w: n% Q
/ N$ A1 ~" M! S4 p! g) k- U/ I2 r
if (x < 0.0 && y > 0.0) { return(ang+PI); }
T# B8 h6 G+ H; V, X/ H9 i
0 h; N6 w; [+ i# U
return(ang);
/ p% o& Y0 V; p& C+ _, E4 n- {
# e: U" W* ?/ V3 K% s8 Z
}6 r( E9 A3 H4 ^
0 P' v( Z E6 A( E1 L7 @. Q/ @* Q
//#=============================================================
7 {* Q! l3 k% y/ `8 z
7 g* T2 I8 G) z- M* ^0 _6 P
double CheckConst ( double angle, double constvar )
& c" b1 _4 @( _2 Q
; \- r; _% E* _$ o* K
//#=============================================================3 p6 w, I: [' D
5 U2 ~) A n5 ]1 z
{
9 A+ p V: v7 c- e- ~8 }2 p
) k8 B7 C! n! O- i) r9 R
while (angle < -constvar) { angle+=constvar ; }% z1 P7 f% d# ^6 }8 S- V0 _) S2 E( u
) @4 {. s' v: Q* g% l
while (angle >= constvar) { angle-=constvar ; }
' C4 x0 c! u5 ]2 H, k6 E7 w
h' W9 O1 G* ]: k
return (angle) ;, E! M, f6 [/ y/ z0 q A
6 @* F5 e9 z; q& S( ?: U- ?
}% P% ]2 E3 A, Z
) p; d$ ?2 \. Z, D2 y( R% T- T
//#=============================================================9 i- |& _4 T% ?) _! j) `
. p5 A, m+ c; b3 \1 D
double Check360 ( double angle )
9 e6 D+ X1 v& F. L$ D
6 P9 Q; }9 J' Q+ {' F
//#=============================================================
2 g$ v- _3 _) `
L3 A) O1 s/ A7 f2 ^ ]0 u
{
' \1 Y" \& p% U
' z" o" |5 ~5 _$ P
while (angle < -360.) { angle+=360. ; }& o3 O5 g+ J4 h8 R% b4 e/ `
8 Y) P# [- k6 g' q9 P3 }: D
while (angle >= 360.) { angle-=360. ; }7 O& A7 j& j; o9 g6 m& \
2 ]% S: p6 A" B7 o$ ~
return (angle) ;- G: m+ Y# A! k/ W# U9 e
7 L n- K6 B* Z' l: A; H' L9 A) c
}
9 H) n4 q& Q$ i- l# p( X$ G
% X3 K. X2 ], e' ~+ u1 ]5 Y6 Z
//#=============================================================
5 x; t! t' S1 O1 L2 W( |9 w
" q# X4 H* l2 |& J5 F
double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )
) D) ^2 C5 i6 e+ c( K& }0 x4 h/ C
1 J# ?2 c& i. U7 E6 ~; G
//#=============================================================( P4 c$ ]1 {, S& u+ D; s
( k% A+ v. `" v4 U/ w6 \( s
{
/ k% [7 C; x& `7 a, X4 w7 \. W
1 _# c- D/ Y2 V N+ l9 @
while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
$ j8 P$ y# g4 R/ N
$ T3 Y8 V0 ~9 ?0 D* ]
while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }
+ E5 g8 `3 x. b. Z; o' ?( X
/ O& A" Z, t6 K
return (angle) ;/ O: }# \" _% V/ \6 Q
6 \8 E, D5 ]; ^$ C$ n7 N
}

復制代碼

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

i=sin(ang_rad[1]); j=0.0; k=cos(ang_rad[1]);
9 f% u, N4 f# F% v. Y6 w5 p6 k' Y
! ~( d( P4 C7 Z2 X
j=0.; B1=0.; B0=0.;
! v, Y0 r" z$ w* R0 s r o
, O& P8 c. ^+ W0 p
if (EQ_is_ge(i,0.)) {
- o$ M5 a; M; u5 e1 b \2 }
V4 D6 Z! t: M% u/ n
if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }8 h* S% S/ e Z0 o+ d/ o; E
+ k5 T7 M9 |* S3 F- \7 ~
}
6 b( N! {: `9 @. w9 H+ p
: U7 Y/ \$ ]$ G% V
if (EQ_is_lt(i,0.)) {6 `7 _/ z' j7 A3 @+ C
; o5 [, e0 Q# d
if (EQ_is_lt(k,0.)) {
' W3 p: s0 z* U' O# S2 H6 X
' F9 a' J; L5 n1 P" Q
B0=atan(i/k); B1=B0+PI ;) M$ O+ H* q& l' m! m9 F8 b4 @ n
5 U5 L0 D8 {# V* {
} else {; L7 z2 v( i0 y) x/ U$ t
1 ?% k( J, f! k0 a
if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }; g% {1 O% @+ b2 f0 l2 Y
/ g; B5 Q6 L$ @: j! P' r( ]3 L; `
B1=2.*PI+B0 ;
: C$ {- A2 r2 F- A o; ^* q
7 A. @8 a: X" x x! u: y' S; J
}
+ B' q/ [; B* D+ D
! t( W( w7 i/ _3 s6 q
}
^6 N9 U; Q- I6 {8 l9 n/ \
5 A \" X6 h c, m. |0 l
if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;# z6 Y7 y' F9 R
5 s3 \, W; U; ~: w4 P1 ?9 Y/ t
B2=(-1.)*B0*(2*PI-fabs(B1));
% B2 Y+ A% ~* Y/ k
# Y' O* u- M7 }- r R. Z* e1 V
ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
9 T/ ~( l6 H; Q' {7 P: w
5 M2 M! f0 p7 l# v! [
ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;