
3 / 13
FANUC Series 30i-MODEL A
Three-dimensional error compensation
A-79351E
Ed. Date Design Description
Date Jan.07.’04 Design. Apprv.
Title
Draw
No.
page
Detail
Calculation of compensation
Three-dimensional error compensation is calculated as follows.
Let three compensation axes be X, Y, and Z (three basic axes) and the coordinates of the
current position be P (Px, Py, Pz). consider a compensation space (rectangular parallelepiped)
containing P. Let its vertexes be P1, P2, …, and P8 and the compensation values for the
individual axes at the individual vertexes be Cnx, Cny, and Cnz (where n is a number
between 1 and 8).
Let the interior division ratio on X-axis at P be x. Here, x is standardized in the range of 0 to
1 as follows:
P1x and P2x are the X coordinates of P1 and P2. The interior division ratios on Y and Z-axes
are determined in the same way.
The compensation amount Cx for X-axis at P isdetermined as follows:
The compensation amount Cy and Cz on Y and Z-axes are determined in the same way.
|12|
|1|
xPxP
xPPx
x
−
=
zyxxCzyxxC
zyxxCzyxxC
zyxxCzyxxC
zyxxCzyxxCCx
××−×+×××+
×−××+×−×−×+
−××−×+−×××+
×−××
)1(87
)1(6)1()1(5
)1()1(4)1(3
)1()1(2)1()1()1(1
P4 [C4x, C4y, C4z]
P (Px, Py, Pz)
P5 [C5x, C5y, C5z]
P6 [C6x, C6y, C6z]
P1 [C1x, C1y, C1z]
P2 [C2x, C2y, C2z]
P3 [C3x, C3y, C3z]
P8 [C8x, C8y, C8z]
P7 [C7x, C7y, C7z]
x
y
z