
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.
B-63534EN/02-05
Edit
Apprv. Desig.
Sheet
Title
Draw
No.
Date
Design
Description
Date
FANUC Series 16i/160i/160is-MB,18i/180i/180is-MB5,
18i/180i/180is-MB OPERATOR’S MANUAL
Concerning the addition of TOOL CENTER POINT
CONTROL FOR 5-AXIS MACHINING
Oct.27.2003
T. Horie
40/40