
24
88
A-78710E
Edit
Apprv. Desig.
Sheet
Title
Draw
No.
Date
Design
Descri
tion
Date
FANUC Series 16i –MB, 18i –MB5
Tool Radius Compensation For 5-Axis
machining Specifications
Dec.01.2001
02 Mar.22.2002
T.Mochia All revision
H.Kouzai
Sheet
T.Mochida H.Kouzai
03 Mar.28.2003
MTanaka All revision H.kouzai
04 Aug.05.2003
T.Horie Intersection offset, G-code unification add. H.kouzai
05 Jun.02.2004 Intersection offset(tool rotation type, Mixed type)
・Block immediately before the offset cancel command (G40)
In the block immediately before the offset cancel command (G40), a compensation
vector is created from the movement vector of that block and the tool vector at the
end point of the block as shown below :
Tool center path (after compensation)
Programmed path
V
M1
V
M2
V
T1
V
C1
V
C2
V
T2
G40
Fig.2.28 Block Immediately before G40
The compensation vector (VC2) of block 2 is created in a plane formed by the tool
vector (VT2) at the end point of block 2 and the movement vector (VM2) of block 2.
VC2 is perpendicular to VT2.
・Method of compensation vector calculation
In leading edge compensation, the compensation vector is calculated as follows :
(1) Tool vector
(2) Movement vector
The movement vector (V
Mn+1
) of block n+1 is obtained from the following
expression :
−
+
−
+
−
+
=
+
n
Z
1n
Z
n
Y
1n
Y
n
X
1n
X
1n
M
V
(3) Compensation vector
The direction of the compensation vector (VCn) of block n is defined as follows :
(1) (V
Mn+1,
V
Tn
) > 0 (0deg < θ < 90deg.)
V
Cn
V
Tn
V
Mn+1
V
Cn
θ
θ
V
Tn
V
Mn+1
Direction of V
Cn
(V
Mn+1
×
V
Tn
)
×
V
Tn
θ
represents the included angle
between V
Mn+1
and V
Tn
.
(0
°
≤
θ
≤
180
°
)
Fig.2.29 Direction of the compensation vector (1)
X
n
: Absolute coordinate value of X axis
at end point of block n
Y
n
: Absolute coordinate value of Y axis
at end point of block n
Z
n
: Absolute coordinate value of Z axis
at end
oint of block n