
A-79348E
Title
Draw
No.
35/88
page
FANUC Series 30i-MODEL A
Tool center point control
for 5-axis machining
Ed. Date Design Description
Date Jan.16.’04 Design. Apprv.
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 rotary 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 rotary 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 rotary axis A is (θ2 + 360 × N) degrees and that of rotary
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 rotary 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 rotary axis B, the
angle belonging to the same group as θ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 (0 to 360
degrees), even if N is set to 0 and coordinates are rounded to 0 to 360
degrees.
Namely, if the movement range is not specified, θ1 + 360 degrees nearest to
the current position is adopted as the computed angle for rotary axis A and,
from the computed angles belonging to the same group as θ1, φ1 degrees
nearest to the current position is adopted as the computed angle for rotary
axis B. Rotary axis A moves in the plus direction. As its coordinate is
rounded to 360 degrees, rotary axis A reaches θ1 degrees while moving in
the plus direction.
By contrast, when the movement range is set to 0 to 360 degrees, the output
angles are (A θ2 degrees; B φ2 degrees). Neither rotary axis A nor B
moves in a way that it exceeds 0 degree (360 degrees).