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

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

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

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

×

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

int EQ_is_equal (double s, double t);" j& y( W2 z) E: h
int EQ_is_ge (double s, double t);
& o0 P3 }; x8 H
int EQ_is_gt (double s, double t);- C( j& g1 g$ q+ j
int EQ_is_le (double s, double t);
7 b; X& N8 _- R1 D+ x8 T% u
int EQ_is_lt (double s, double t);
6 G3 @( Z3 |: i, w! Z9 l' e( t6 n6 [
int EQ_is_zero (double s);
3 p0 ?( f' h7 }
//=============================================================
# R. q4 d' X! K# s
double ARCTAN1 (double y, double x );0 X- D) e6 c5 p$ @( H2 d+ S
//#=============================================================$ R. `/ H/ S) j1 E8 a$ R
double ARCTAN2 (double y, double x );. K# L; n# u! a' C! r6 Q/ g
//#=============================================================
' X& ^8 ^. ] _' o! x3 u; u8 ]
double CheckConst ( double angle, double constvar );: t0 O! ~. \% ~& W/ @# W% I
//#=============================================================
3 b* v. z' E5 i l, z, p6 P
double Check360 ( double angle );( U7 v$ n! n. y7 g
//#=============================================================
) U* u: V9 ]" `) m7 s
double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit );0 m. }$ T' _: P7 ^1 h+ A: \
//#=============================================================

復制代碼

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

int EQ_is_equal (double s, double t)/ U c4 D9 K2 y8 U4 k% }+ E: W% W
0 ` D9 ]) q5 n) k
{
3 \3 q- u7 _2 n. s
" t2 t- L0 u' ^& p# H+ C
if (fabs(s-t)<= system_tolerance) { return(1); } else { return(0) ; }- _! z e7 q% N1 K' `
/ M3 ^' q6 Y5 y9 Y" o
}4 Z. x. i* y; u
# L6 n3 B3 l8 L
/***********************************************************************/, x1 R: Y1 b; }8 }8 L, f7 K2 V
# Q+ H/ C S% k- X1 J' c) ^
int EQ_is_ge (double s, double t)
0 W! L" m0 I5 k9 o7 g/ t
; N) v {3 a% } ~) q
{
4 g+ J$ F, l! X3 ?$ S. u
* s' p1 M5 a6 Z v. L5 O
if (s > (t - system_tolerance)) { return(1); } else { return(0) ; }
2 {& D9 A: T5 D/ o
) B% ?. n- G3 N' |7 Z `7 p( @
}; S2 U" N* S# Q7 g; A% v
$ k$ R: U$ J& F" \
/***********************************************************************/! l# n8 u+ x& C6 z& Y0 ~6 j# Z+ ]
4 a! i: G& f, V3 Q! H/ y1 K
int EQ_is_gt (double s, double t)
% y. @- g4 J/ t9 U
: r- z* U6 X3 a+ {) Z
{
/ @+ k6 R6 V) I7 B" v
1 B; s4 ?+ |4 z {' W
if (s > (t + system_tolerance)) { return(1); } else { return(0) ; }
) m+ U# B0 |/ s/ }; n V' t8 |9 s
0 U4 \7 y5 i3 E/ L0 k
}, |- i. \( V. V- S
7 c |0 G+ B3 _" R$ [
/***********************************************************************/
: c- t' q( t7 t c1 H# O
' H0 g& b+ d' B8 U( Z
int EQ_is_le (double s, double t)' p$ V& ~* `6 r* B% M
$ F5 a# K9 K$ J
{1 q3 A' \* F4 f8 j) P4 h" \) f! F
; K3 x2 X3 o- g! ]8 R V W. j
if (s < (t + system_tolerance)) { return(1); } else { return(0) ; }5 w4 p% [' h/ p) J3 H9 T/ y* y* N
3 n2 {% K% \! U' K U
}$ Y1 O. U0 S) `5 T2 p: j) r2 S
1 c+ ]. m! F0 T h7 Y
/***********************************************************************/
) e4 u: O! h& H! |6 N
' V4 A* ]$ x' s* Q7 h. M2 K9 U
int EQ_is_lt (double s, double t)1 B4 J) E ]% Q8 P9 D
) ]1 @/ M, g/ Y! k9 h/ U# x/ N
{* M+ \! ?; B4 f0 D2 R9 K
- P* C) N9 a% t* O+ t" ?# W
if (s < (t - system_tolerance)) { return(1); } else { return(0) ; }
. \7 E$ X1 t- A/ Q( J
3 k; `9 T6 w# W x! d
}+ T3 x/ v4 T0 j4 P
. P3 J- C1 Z, X! a g; Q" r6 _
/***********************************************************************/
" d& I" ]( F$ x: v
! }, ~; x4 e3 X
int EQ_is_zero (double s)
1 J+ J$ u6 ?4 J) y. S Q- N
, ~* i( F- [, s! b) l S
{
( q8 n/ ]8 |6 e2 X
; M+ w7 [3 D0 r9 \6 }. M8 p0 O
if (fabs(s)<= system_tolerance) { return(1); } else { return(0) ; }
$ b) B( l+ I: ^
; Z" _1 _2 t8 ]( s" u. _- m
}- J0 W' B4 y& W0 f: s
; G2 ~0 X: g1 p" E4 I3 |
//=============================================================( p( w8 l# }" O. t1 c
0 t. l! I a) {& \, @: T
double ARCTAN1 (double y, double x )
3 Y+ x0 o1 T4 S& z# _- _( R
- `' K7 l1 F, \( Q4 `
//#=============================================================
7 `7 ?3 q* S3 U+ B, @7 Q! X! u
, {: K0 v6 H0 X3 ?# ^
{
: E- K/ g& `; |) D
% i% f+ r1 E/ H; `6 G" U" _
double ang;6 n& e& b% ^$ }3 p3 @
Q) B' n: g4 {6 q2 C4 S
if (EQ_is_zero(y)) { y=0; }
! h8 m! t2 d' T q
}2 M9 |- y/ ]% Q
if (EQ_is_zero(x)) { x=0; }
/ X7 q# {) {8 v$ f0 q1 [& B! e
0 {6 u, y$ w5 V, ^ N
if (y == 0 && x == 0) { return(0); }
$ t* W4 R+ Q8 a
" ]+ C; ?$ ?9 H
ang=atan2(y,x);
4 n5 ` M! A0 K8 s+ n# {/ j3 H$ H
( {4 B) Y" n& s7 w2 W$ e+ w
if (ang < 0 ) {
/ v' q) m# Z5 \
1 R5 Y J" b% ]
return(ang + PI*2);
) k% W( `/ ~7 a# Z6 U# M7 F1 ~; y
& _% e2 L, k6 \( l: `7 b
}
1 P% k* X/ Z2 t' l( g5 M0 F% n
1 m. [# ~& l2 M: P$ H& w% `8 m( w
return(ang);' V. H3 U+ p. P6 | `( p" w
$ @; S. V. u1 ?3 O9 u, T
}$ D& n8 B4 T* ^1 g7 C( U6 o7 m: ?' z
8 d: G$ w5 }/ B1 M T% O
//#=============================================================7 V# `7 R* ]1 h6 |0 o, q. V
5 R: X! f3 V4 p3 g
double ARCTAN2 (double y, double x )
! l: O% c) ?4 k+ U) g7 R6 S: e
; L- A8 {9 z, z, x9 ]
//#=============================================================
% M# J$ [2 j% a0 a$ [: f
! x- T2 v3 e/ u! d
{5 l3 W _0 P# t8 j* {4 h, E
' `, B6 w- d$ ^0 v5 T
double ang;
+ x% V' j' h# [4 r
4 ^4 {) f/ M. q; c2 v
if (EQ_is_zero(y)) {) O0 v: k I4 B: @& {! I0 |* Y! \
q+ q4 L9 _ j/ g+ K8 F+ q
if (x < 0.0) { return (PI); }5 G" r( S" {- r, @5 e, a' [
7 U6 A6 D$ K, }( n9 |( s9 E
return (0.0);
. i( \3 Y2 \* ^ G# v
8 K- k4 c4 N% j$ K9 ^
}
0 E6 `) ]) u3 V
F1 H' @! y) i* P5 h
if (EQ_is_zero(x)) {
" t) o3 p+ n4 ^4 q( s' k
; q9 m4 V" \0 X: C4 X
if (y < 0.0) { return(PI*1.5); }
/ o5 ^6 ]' l6 f9 B' Y, }
. e1 V e0 T# |+ ]' w3 z/ E
return(PI*.5);
& U/ `9 ~# L# e
) U& }4 w+ f& D l1 }* }4 d
}6 y! I" J* y7 g* X# b$ Q) \
: \& ^# {# w/ L& J" k
ang=atan(y/x);
4 @7 ~( K; b; j) m3 N; Y! p* e
; V& `, s+ p8 Z4 V0 Z
if (x > 0.0 && y < 0.0) { return(ang+PI*2.0); }
, ~; n1 S* i" ?# k5 x" K
9 |# B5 _! D: W; A2 Y4 ?$ Z
if (x < 0.0 && y < 0.0) { return(ang+PI); }
' I5 h9 N4 I9 K8 h
$ I- C) j$ ~5 s+ U/ E, y1 W+ V1 j
if (x < 0.0 && y > 0.0) { return(ang+PI); }
5 p' B7 l+ z6 g `) P
# A1 p6 u; b2 T# u
return(ang);
# j1 x Z% e8 k) Y; c
; s, Z0 h7 Q% N& }% b7 | J
}
, ?, D! M7 ^: c( @5 F3 E9 X- c
K; ?2 j6 t8 }" ~: S: d1 O( S- V, }
//#=============================================================
+ I* D7 |5 j( C: n. y/ C( e0 R
" n. J: J* c' Q+ d' A
double CheckConst ( double angle, double constvar )" F9 S7 h- u& n. d9 M
& O1 \6 z2 H6 b) u1 _6 s
//#=============================================================
$ `- U& V# @! p' Q. s, V
( ~4 |$ D$ G0 F* D, ^4 I
{! H5 H: I( L ]8 {1 p
2 n8 E9 }! n( T) Z2 ~
while (angle < -constvar) { angle+=constvar ; }
! g; u2 J. C- S
; F; S$ v0 i( J, x A
while (angle >= constvar) { angle-=constvar ; }
6 z! s! \3 M6 ~
' x- ]# s) M+ \0 ]9 ~& e
return (angle) ;; c% i1 \+ `5 i& B. k8 g
3 e0 n, O. r Y7 o
}
' C( @7 t3 L! J* s8 |
' w' n" }$ u" G+ d5 D/ J, Z2 f; _" J
//#=============================================================7 F* O+ u( `) d" r# U
7 n J# q d' Z1 c4 S* ]* F6 c
double Check360 ( double angle ); }- O# {8 G' T# j
( X' s5 t' S& T4 @- W; a. s
//#=============================================================
2 V7 }4 q' [# v
5 d7 I+ |% e, i3 x
{2 |3 E$ A, C' V2 K6 l/ S
$ R2 G6 Y" x H! t
while (angle < -360.) { angle+=360. ; }
+ ? ]1 O* u. G; \% D4 W7 }3 c
( Z9 ^, M) @5 L1 j5 s& }7 x
while (angle >= 360.) { angle-=360. ; }( o2 i. ~3 y& K& `0 _
, Z- i8 Y1 d+ \" z& N6 }8 b/ C# w4 X4 A
return (angle) ;
3 c0 u8 E2 H) g g4 j
/ i* ~" p) c8 ?2 m/ |, W6 i" g
}: _0 x! N5 R" C% a6 d* K
, A- T; {& N7 G4 ?6 U1 N
//#=============================================================
0 t; |+ e# v A" s" e
' a4 S& b& d! W
double CheckLimit ( double angle, double kin_axis_min_limit, double kin_axis_max_limit )% i( \2 P. j8 |2 U
. f4 v* ^6 G+ Y% \' X/ J6 U
//#=============================================================
/ [2 x. [$ B S# z. `9 Q/ t
$ M+ n5 t N( X, l4 E4 i4 m& \" m
{
K2 n7 B5 C n; S% A
; d) C6 m* u9 j. Z$ U$ Q
while ((angle-kin_axis_min_limit) > 360.) { angle-=360. ; }
! g7 h. `7 L; g2 X
& F( M' L- H% M) t
while ((kin_axis_max_limit-angle) <= -360.) { angle+=360. ; }, u9 Y: f- o7 L: F3 `0 M# [
, J, p: H$ g% b& w
return (angle) ;
! f" c1 n, x, K; b% D4 J
- r7 l) {, G) i8 i& I7 \8 f
}

復制代碼

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

i=sin(ang_rad[1]); j=0.0; k=cos(ang_rad[1]);
! K- N, `- z( @1 x+ K: P$ b" x
9 j) v8 e5 T4 j4 O \8 d1 K9 M$ ^
j=0.; B1=0.; B0=0.;! d M( y! B! L
' r* ]& c+ ?' m2 H9 d0 M
if (EQ_is_ge(i,0.)) {9 Z' c' x8 q& i& L
3 a2 t, ]- D- w) T* M- g+ c- G
if (EQ_is_gt(k,0.)) { B0=acos(k); B1=B0; } else { B0=acos(k); B1=B0; }
" E+ c" }& g5 J/ I+ n) k" f& _
# j/ P+ L9 A" q
}
9 ^+ P+ Q/ M9 e5 C5 X" O
6 N. p* f' Q7 L/ Q
if (EQ_is_lt(i,0.)) {
' O7 `4 U. v5 {+ J- X1 f
% S6 V* i5 ~; y" W
if (EQ_is_lt(k,0.)) {
2 J1 D9 q) A8 G2 O6 y& u% }
' m: I6 G, t2 D7 e
B0=atan(i/k); B1=B0+PI ;
9 k! N, J* U9 |! Z
2 A7 @+ N) `+ ]+ `! q7 D
} else {3 `9 G; E" y. _0 f; S- O
: e' J; V) |6 o8 R
if (EQ_is_zero(k)) { B0=-PI/2. ; } else { B0=atan(i/k); }
8 g0 L. n% ]9 S8 h0 C1 ~
5 B* H2 U9 A& m' n, Z
B1=2.*PI+B0 ;$ ]2 u, Y: T& a, q9 Z
& C% W0 `4 u' h$ s' E. V5 a/ W, s+ r
}
& D, w0 z \; U# p
+ C+ z, e" c; d) A
}
^1 M$ K9 V; v# F3 X- i8 Z
9 ?5 ^+ l& s, T2 ]2 V6 ]6 w
if (EQ_is_ge(B1,0.)) B0=1.; else B0=-1. ;5 o' M% n' m0 v" f2 c* Q3 X
& j: b$ |! @: V# @( l
B2=(-1.)*B0*(2*PI-fabs(B1));, W, Y3 h* o6 }
& a- b2 Y' n( U: G
ang_rad[0]=0.; ang_rad[1]=B1; ang_rad[2]=0.;
7 P7 V( K4 F* n) b1 ^( Z- W H
* U& i9 ^1 ]4 i1 [8 N# y
ang_rad[3]=0.; ang_rad[4]=B2; ang_rad[5]=0.;