
A-78709E
Edit
Apprv. Desig.
Sheet
Title
Draw
No.
Date
Design
Descri
tion
Date
FANUC Series 16i –MB, 18i –MB5
Tool Center Point Control For 5-Axis
machining Specifications
Dec.01.2001
02 Mar.22.2002
T.Mochida All revision H.Kouzai
T.Mochida H.Kouzai
03 Dec.27.2002
T.MochidaWorkpiece coordinate system,circular ,Type2 add H.Kouzai
04 Mar.12.2003 M.Tanaka All revision H.kouzai
42
97
05 Jan.26.2004 T.Mochida Correction and addition of 5) E.Genma
360
(N + 1) degrees
360
N degrees
•
Computed angle A
Current position A
Movement range A
θ
1 + 360
×
N
θ
2 + 360
×
N
θ
2 + 360
×
(N - 1)
θ
1 + 360
×
(N + 1)
"Computed angle of rotation axis A and its current position and movement
range"
360
×
(N + 1) degrees
360
×
N degrees
•
Computed angle B
Current position B
Movement range B
φ
2 + 360
×
N
1 + 360
N
φ
1 + 360
×
(N - 1)
φ
2 + 360
×
(N + 1)
"Computed angle of rotation axis B and its current position and movement
range"
When the two axes have a positional relationship as shown in the figure, the output
angle of rotation axis A is (θ2 + 360 × N) degrees and that of rotation axis B is (φ2 +
360 × N) degrees (when parameter PRI (No.19608#5) is set to 0).
More concretely, from the computed angles obtained for rotation axis A, the nearest
angle within the movement range, i.e. θ2 + 360 × N degrees, is first adopted. Then,
from the computed angles obtained for rotation axis B, the angle belonging to the
same pair with θ2, i.e. φ2 + 360 × N, is adopted.
Note that, in this example, the output angles and moving direction differ depending on
whether the movement range is specified or not, even if N is set to 0 and coordinates
are rounded to 0 to 360 degrees.
Namely, in the case of N=0, if the movement range is not specified, θ1 + 360 degrees
nearest to the current position is adopted as the output angle for rotation axis A and,
from the computed angles belonging to the same pair with θ1, φ1 degrees nearest to
the current position is adopted as the output angle for rotation axis B. Rotation axis
A moves in the plus direction. As its coordinate is rounded to 360 degrees, rotation
axis A reaches θ1 degrees while moving in the plus direction.