
Title
No.
FANUC Series 16i-MA/MB
Tool axis compensation in tool axis direction
A-78437E
Page
13/24
Newly registered
Ver Date Design Description
01 01.03.16
Hosokawa
Jx, Jy, Jz :Rotation center compensation vector
Cx, Cy, Cz :Spindle center compensation vector
Sx, Sy, Sz:Shift vector
Suppose the above. Then, the tool length compensation vector for each axis is calculated
depending on the machine type, as follows:
(1) A- and C-axes. The tool axis is the Z-axis.
ù
ê
ê
ê
ë
é
+
÷
÷
÷
ø
ö
ç
ç
ç
è
æ
ú
ú
ú
ù
ê
ê
ê
ë
é
+
ú
ú
ú
ù
ê
ê
ê
ë
é
++
ú
ú
ú
ù
ê
ê
ê
ë
é
−
ú
ú
ú
ù
ê
ê
ê
ë
é
−
=
ú
ú
ú
ù
ê
ê
ê
ë
é
Sz
Sy
Sx
Jz
Jy
Jx
CzHoTo
Cy
Cx
AA
AACC
CC
Vz
Vy
Vx
cossin0
sincos0
001
100
0cossin
0sincos
(2) B- and C-axes. The tool axis is the Z-axis.
ù
ê
ê
ê
ë
é
+
÷
÷
÷
ø
ö
ç
ç
ç
è
æ
ú
ú
ú
ù
ê
ê
ê
ë
é
+
ú
ú
ú
ù
ê
ê
ê
ë
é
++
ú
ú
ú
ù
ê
ê
ê
ë
é
−
ú
ú
ú
ù
ê
ê
ê
ë
é
−
=
ú
ú
ú
ù
ê
ê
ê
ë
é
Sz
Sy
Sx
Jz
Jy
Jx
CzHoTo
Cy
Cx
BB
BB
CC
CC
Vz
Vy
Vx
cos0sin
010
sin0cos
100
0cossin
0sincos
(3) A- and B-axes. The tool axis is the X-axis.
ú
ú
ú
ù
ê
ê
ê
ë
é
+
÷
÷
÷
ø
ö
ç
ç
ç
è
æ
ú
ú
ú
ù
ê
ê
ê
ë
é
+
ú
ú
ú
ù
ê
ê
ê
ë
é
++
ú
ú
ú
ù
ê
ê
ê
ë
é
−
ú
ú
ú
ù
ê
ê
ê
ë
é
−=
ú
ú
ú
ù
ê
ê
ê
ë
é
Sz
Sy
Sx
Jz
Jy
Jx
Cz
Cy
CxHoTo
BB
BB
AA
AA
Vz
Vy
Vx
cos0sin
010
sin0cos
cossin0
sincos0
001
(4) A- and B-axes. The tool axis is the Z-axis, and the B-axis is the
master.
ú
ú
ú
ù
ê
ê
ê
ë
é
+
÷
÷
÷
ø
ö
ç
ç
ç
è
æ
ú
ú
ú
ù
ê
ê
ê
ë
é
+
ú
ú
ú
ù
ê
ê
ê
ë
é
++
ú
ú
ú
ù
ê
ê
ê
ë
é
−
ú
ú
ú
ù
ê
ê
ê
ë
é
−
=
ú
ú
ú
ù
ê
ê
ê
ë
é
Sz
Sy
Sx
Jz
Jy
Jx
CzHoTo
Cy
Cx
AA
AA
BB
BB
Vz
Vy
Vx
cossin0
sincos0
001
cos0sin
010
sin0cos
(5) A- and B-axes. The tool axis is the Z-axis, and the A-axis is the
master.
ú
ú
ú
ù
ê
ê
ê
ë
é
+
÷
÷
÷
ø
ö
ç
ç
ç
è
æ
ú
ú
ú
ù
ê
ê
ê
ë
é
+
ú
ú
ú
ù
ê
ê
ê
ë
é
++
ú
ú
ú
ù
ê
ê
ê
ë
é
−
ú
ú
ú
ù
ê
ê
ê
ë
é
−=
ú
ú
ú
ù
ê
ê
ê
ë
é
Sz
Sy
Sx
Jz
Jy
Jx
CzHoTo
Cy
Cx
BB
BB
AA
AA
Vz
Vy
Vx
cos0sin
010
sin0cos
cossin0
sincos0
001
The shift vector (Sx, Sy, Sz) is calculated as follows:
(A) When bit 5 (SVC) of parameter No.19665 = 0, the vector is set to 0.
(B) When bit 5 (SVC) of parameter No.19665 = 1, and bit 4 (SPR) of
parameter No. 19665 = 0:
When the machine type is other than (3)
ù
ê
ê
ê
ë
é
++
+
+
−=
ú
ú
ú
ù
ê
ê
ê
ë
é
HoJzCz
JyCy
JxCx
Sz
Sy
Sx
When the machine type is (3)
ù
ê
ê
ê
ë
é
+
+
++
−=
ú
ú
ú
ù
ê
ê
ê
ë
é
JzCz
JyCy
HoJxCx
Sz
Sy
Sx
(C) When bit 5 (SVC) of parameter No.19665 = 1, and bit 4 (SPR) of
parameter No. 19665 = 1, the vector specified in parameter No.
19667 is set.