
A-78640E
Sheet
Title
Draw
No.
04 Feb.08.’03 Part of (4) is added or modified. Addition of 2.16.5
03 Jul.02.’02 A. Fukumoto Part of (3) is added or modified. T.Endo
02 May.13.’02 A. Fukumoto Addition of Tool Radius control for 5-axis machining etc T.Endo
Ed. Date Design Description
Date Jan.25.’02 Desig. A.Fukumoto Apprv. T.Endo
FANUC Series 16i /18i -TB
Specifications of AI High-Precision Contour Control /
I Nano High-Precision Contour control
71/190
5. Calculation of three-dimensional cutter compensation
(1) Conversion matrix for the tool rotation axis
Conversion due to the rotation of the tool rotation axis about the tool axis
having an angle of
α (parameter No.19614) is represented by the following
formula:
⎥
⎥
⎥
⎦
⎤
⎢
⎢
⎢
⎣
⎡
−
−−−−
−−−
=
aaa
aaa
aaa
aROT
cos))(sin(cos))(sin(sin
))(sin(cos)cos1)((cos1)cos1)()(sin(cos
))(sin(sin)cos1)()(sin(cos)cos1)((sin1
)(
2
2
αα
αααα
αααα
α
The conversion matrix for the reference angle is given by the following:
)(
00
aROTN
α
(
0
a
: parameter No.19620)
(2) Creation of the basic vector of coordinate system C2 for applying two-
dimensional cutter compensation
Let the tool direction vector in the state of the N2 end point be
T
V
.
⎥
⎥
⎥
⎦
⎤
⎢
⎢
⎢
⎣
⎡
−
=
−
A
BA
BA
T
R
RR
RR
NaROTV
sin
))(sin(cos
))(cos(cos
)(
1
02
α
2
e
is defined as follows. Note that
T
Ve
2
.
⎥
⎥
⎥
⎦
⎤
⎢
⎢
⎢
⎣
⎡
−
=
−
0
cos
sin
)(
1
022 B
B
R
R
NaROTe
α
where
A
R
: reference angle of the tool axis (RA) (parameter No.19622) and
B
R
: reference angle of the tool axis (RB) (parameter No.19623)
The unit vector
3
e
satisfying
T
Ve
3
and
23
ee
may be given by the following
outer product calculation:
23
eVe
T
(3) Definition of coordinate system C2
Coordinate system C2 {O;
2
e
,
3
e
,
1
e
} is an Cartesian coordinate system
having
O = (0,0,0) as its origin and the following unit vectors as its basic vectors:
2
e
3
e
T
Ve
1