FANUC Series: Operator'S Manual
FANUC Series: Operator'S Manual
B-82914EN/01
Before using the Robot, be sure to read the "FANUC Robot Safety Manual (B-80687EN)" and understand
the content.
The products in this manual are controlled based on Japan’s “Foreign Exchange and
Foreign Trade Law”. The export from Japan may be subject to an export license by the
government of Japan.
Further, re-export to another country may be subject to the license of the government of
the country from where the product is re-exported. Furthermore, the product may also be
controlled by re-export regulations of the United States government.
Should you wish to export or re-export these products, please contact FANUC for advice.
In this manual we have tried as much as possible to describe all the various matters.
However, we cannot describe all the matters which must not be done, or which cannot be
done, because there are so many possibilities.
Therefore, matters which are not especially described as possible in this manual should be
regarded as “impossible”.
SAFETY
B-82914EN/01 1.SAFETY PRECAUTIONS
1 SAFETY PRECAUTIONS
This manual contains safety precautions against injury and property damage. Those precautions are
labeled “Warning” or “Caution,” according to the degree of importance. Supplementary explanation is
given under “Note.” Before starting to use a robot, carefully read the “Warning,” “Caution,” and
“Note.”
WARNING
Failure to follow the instruction given under “Warning” can cause fatal or serious
injury to the user. This information is indicated in bold type in a box so that it can be
easily distinguished from the main body of this manual.
CAUTION
Failure to follow the instruction given under “Caution” can cause injury to the user
or property damage. This information is indicated in a box so that it can be
easily distinguished from the main body of this manual.
NOTE
The information given under “Note” is a supplementary explanation, which is
neither a warning nor a caution.
1.1 WORKERS
A robot cannot do anything alone. The robot can operate only after it is equipped with a hand or other
device and connected with peripheral equipment to form a system.
Give considerations for the safety of not only the robot but also the entire system. When using the robot,
provide a safety fence and other safety measures. FANUC defines the system personnel as indicated
below. Check which worker should be trained in a specialist robot course.
Operator
The jobs of an operator are:
• Turning on and off the system
• Starting and stopping programs of a robot
• Recovering the system from an alarm state
The operator must not enter the area enclosed by the safety fence to do his or her work.
Maintenance engineer
The jobs of the maintenance engineer include the jobs of the programmer and the following:
• Repair and maintenance of the robot
The maintenance engineer should be trained in a specialist robot course.
- iii -
1.SAFETY PRECAUTIONS B-82914EN/01
General rules
WARNING
1 When the robot is used, the following precautions should be taken. Otherwise,
the robot and peripheral equipment can be adversely affected, or workers can be
severely injured.
- Avoid using the robot in a flammable environment.
- Avoid using the robot in an explosive environment.
- Avoid using the robot in an environment full of radiation.
- Avoid using the robot under water or at high humidity.
- Avoid using the robot to carry a person or animal.
- Avoid using the robot as a stepladder. (Never climb up on or hang from the
robot.)
2 Robot personnel must wear the following safety articles:
- Clothing suitable for each job
- Safety shoes
- Helmet
NOTE
Programmers and maintenance staff should be trained in a suitable course at
FANUC.
Notes on installation
WARNING
The robot should be transported and installed by accurately following the
procedures recommended by FANUC. Wrong transportation or installation may
cause the robot to fall, resulting in severe injury to workers.
CAUTION
In the first operation of the robot after installation, the operation should be
restricted to low speeds. Then, the speed should be gradually increased to
check the operation of the robot.
- iv -
B-82914EN/01 1.SAFETY PRECAUTIONS
Notes on operation
WARNING
Before the robot is started, it should be checked that no one is in the area of the
safety fence. At the same time, a check must be made to ensure that there is
no risk of hazardous situations. If detected, such a situation should be
eliminated before the operation.
CAUTION
Operators should be ungloved while manipulating the operator’s panel or teach
pendant. Operation with gloved fingers could cause an operation error.
NOTE
Programs, system variables, and other information can be saved on external
storage. Be sure to save the data periodically in case the data is lost in an
accident. (See the file input/output section for saving the data.)
Notes on programming
WARNING
Programming should be done outside the area of the safety fence as far as
possible. If programming needs to be done in the area of the safety fence, the
programmer should take the following precautions:
- Before entering the area of the safety fence, ensure that there is no risk of
dangerous situations in the area.
- Be prepared to press the emergency stop button whenever necessary.
- Robot motions should be made at low speeds.
- Before starting programming, check the entire system status to ensure that no
remote instruction to the peripheral equipment or motion would be dangerous
to the user.
CAUTION
After programming is completed, a text execution should be given according to a
specified procedure. (See the section of program execution on this manual).
During the text execution, workers must stay out of the safety fence.
-v-
1.SAFETY PRECAUTIONS B-82914EN/01
NOTE
Programmers should be trained in a suitable course at FANUC.
Notes on maintenance
WARNING
1 During maintenance, the robot and system should be in the power-off state. If
the robot or system is in the power-on state, a maintenance operation could
cause a shock hazard. If necessary, a lock should be provided to prevent any
other person from turning on the robot or system. If maintenance needs to be
executed in the power-on state, the emergency stop button should be pressed.
2 When replacing a part, please contact FANUC service center. If a wrong
procedure is followed, an accident may occur, causing damage to the robot and
injury to the worker.
3 When entering the area enclosed by the safety fence, the maintenance worker
should check the entire system to make sure that no dangerous situations are
present. If the worker needs to enter the area of the fence while a dangerous
situation exists, the worker should always take extreme care and check the
current system status.
4 A part should be replaced with a part recommended by FANUC. If other parts
are used, malfunction or damage would occur. Especially, a fuse that is not
recommended by FANUC should not be used. Such a fuse may cause a fire.
5 When a motor or brake is removed, the robot arm should be supported with a
crane or other equipment beforehand so that the arm would not fall during the
removal.
6 If a robot motion is necessary during maintenance, the following precautions
should be taken:
- Reserve an escape route. During the maintenance, always check the motions
of the whole system so that the escape route will not be blocked by the robot
or peripheral equipment.
- Always pay attention to risk of dangerous situations and get prepared to press
the emergency stop button whenever necessary.
7 When a motor, decelerator, or other heavy load is handled, a crane or other
equipment should be used to protect maintenance workers from excessive load.
Otherwise, the maintenance workers would be severely injured.
- vi -
B-82914EN/01 1.SAFETY PRECAUTIONS
CAUTION
1 Whenever grease is spilled on the floor, it should be removed as quickly as
possible to prevent dangerous falls.
2 The robot should not be stepped on or climbed up during maintenance. If it is
attempted, the robot would be adversely affected. In addition, a misstep can
cause injury to the worker.
3 The following parts are heated. If a maintenance worker needs to touch such a
part in the heated state, the worker should wear heat-resistant gloves or use
other protective tools.
- Servo motor
- Inside the control unit
4 When a part is replaced, all bolts and other related components should put back
into their original places. A careful check must be given to ensure that no
components are missing or left unmounted.
5 Before the maintenance of the pneumatic system is started, the supply pressure
should be shut off and the pressure in the piping should be reduced to zero.
6 After a part is replaced, a text execution should be given for the robot according
to a predetermined method. (See the program execution of this manual.)
During the text execution, the maintenance staff should work outside the safety
fence.
7 After the maintenance is completed, spilled oil or water and metal chips should
be removed from the floor around the robot and within the safety fence.
8 When a part is replaced, care must be taken to prevent dust from entering the
robot.
NOTE
1 Each maintenance worker or inspection worker should be trained in a suitable
course at FANUC.
2 Maintenance should be done under suitable light. Care must be taken that the
light would not cause any danger.
3 The robot should be periodically inspected. (Refer to the controller and
mechanical manual.) A failure to do the periodical inspection can adversely
affect the performance or service life of the robot and may cause an accident.
- vii -
1.SAFETY PRECAUTIONS B-82914EN/01
• Put a protective fence with safety door around the system so that only the operator can enter the
operating area by the door. Design the system so that it will stop when the door is opened.
NOTE
Connect the *EAS1, *EAS11, *EAS2, *EAS22 (*FENCE1, *FENCE2 for single
chain controller) input signal to the safety door. Refer to the controller
maintenance manual for explanations about how to connect.
• Put a protective fence so that the motion range of the robot is surrounded completely. Moreover, put
the controller outside of the protective fence.
• Install an emergency stop button where it will be readily accessible to the operator.
NOTE
Upon receiving an emergency stop signal, the controller immediately stops the
robot.
NOTE
When the hand break (*HBK) input signal goes off, the controller immediately
stops the robot.
- viii -
B-82914EN/01 1.SAFETY PRECAUTIONS
• Hand breakage detection can be disabled when the *HBK input signal is off. This can be set on the
system setting screen. See the section of the system config menu.
• Ground all peripheral units properly.
• When a desired operating area is smaller than the maximum operating area of the robot, the desired
area can be specified by parameters.
• The robot receives interlock signals sent from remote equipment. Upon receiving a signal indicating
the operating status of the remote equipment, the robot can stop or halt.
• When required, install a lock so that only authorized personnel can switch the power on.
NOTE
The circuit breaker on the control unit door is designed such that power-on can
be disabled by setting a padlock.
- ix -
1.SAFETY PRECAUTIONS B-82914EN/01
• Before approaching the robot to program it, hold the teach pendant in your hand, press the deadman
switch, and set the teach pendant enable switch on.
NOTE
If the deadman switch is released while the teach pendant enable switch is on,
the robot immediately stops.
Fig. 1.3 (h) Deadman switch and Teach pendant enable switch
• Before moving the robot by jog feed, carefully observe the operation of the jog keys and the robot.
• Before moving the robot by jog feed, sufficiently lower the feedrate override of the robot.
- xi -
B-82914EN/01 TABLE OF CONTENTS
TABLE OF CONTENTS
SAFETY........................................................................................................... i
1 OVERVIEW ............................................................................................. 1
1.1 OVERVIEW ................................................................................................... 1
1.2 TERMINOLOGY ............................................................................................ 2
1.2.1 Overview ..................................................................................................................2
1.2.2 Motion Group ...........................................................................................................2
1.2.3 Leader Group............................................................................................................2
1.2.4 Follower Group ........................................................................................................2
1.2.5 Linear Axis ...............................................................................................................2
1.2.6 Rotary Axis ..............................................................................................................3
1.2.7 Axis Offset ...............................................................................................................3
1.2.8 Coordinated Frame ...................................................................................................3
1.2.9 Follower UFRAME..................................................................................................3
1.2.10 Follower UTOOL .....................................................................................................4
1.2.11 Leader UTOOL ........................................................................................................4
1.2.12 Leader UFRAME .....................................................................................................4
1.2.13 Leader World Frame.................................................................................................4
1.3 SETUP STEPS .............................................................................................. 4
2 INSTALLATION ...................................................................................... 5
2.1 OVERVIEW ................................................................................................... 5
2.2 INSTALLATION CONCEPTS ........................................................................ 5
2.2.1 Overview ..................................................................................................................5
2.2.2 Kinematics Type.......................................................................................................6
2.2.3 Axis Arrangement, Direction, and Assignment........................................................7
2.2.4 Offsets for Known Kinematics Types ....................................................................10
c-2
B-82914EN/01 1.OVERVIEW
1 OVERVIEW
1.1 OVERVIEW
Coordinated motion is a motion control method in which the tool center point (TCP) speed and position
of a follower motion group is executed relative to a leader motion group. This method provides constant
relative speed between the two motion groups, and provides for path execution by the follower in a
moving frame of the leader.
See Fig. 1.1 .
-1-
1.OVERVIEW B-82914EN/01
• In simultaneous motion, relative TCP speed is not controlled automatically. You must do this
manually by programming several regularly-spaced, time-based moves along the weld path,
generally every four to eight millimeters.
Operation
Coordinated motion occurs between coordinated motion group pairs, called CD_pairs . CD_pairs consist
of a leader motion group and a follower motion group. The leader group can be any kind of positioner,
such as a table. The follower group is usually the robot.
The leader group (for example, a positioner) must have FANUC Robotics motors and be controlled by the
robot as a separate motion group. This differs from the conventional positioner installation, which
typically uses extended axes or uses the multiple-motion group "Independent Axes" configuration.
Supported Options
Coordinated motion is supported for the following options:
• Touch Sensing
• Thru Arc Seam Tracking (TAST)
• Automatic Voltage Control Tracking (AVC)
• Root Pass Memorization (RPM)
• Multipass Welding (MPASS)
1.2 TERMINOLOGY
1.2.1 Overview
This section contains descriptions of terms that are used in coordinated motion. Become familiar with
these terms before you continue with coordinated motion setup, operation, and programming.
When you use coordinated motion, the "coordination" that is performed is between two motion groups.
-2-
B-82914EN/01 1.OVERVIEW
CAUTION
Unless dynamic uframe is used, do not shift UFRAME to compensate for shifted
workpieces or programs. Otherwise, motion might not occur as expected relative
to the workpiece.
-3-
1.OVERVIEW B-82914EN/01
-4-
B-82914EN/01 2.INSTALLATION
2 INSTALLATION
2.1 OVERVIEW
Before you can set up or use coordinated motion, you must install coordinated motion software and
hardware. This chapter describes how to install the software necessary to use coordinated motion.
Refer to the Extended Axis Connection and Maintenance Manual for information on how to install the
hardware associated with motion groups and extended axes when you use coordinated motion.
2.2.1 Overview
In order to perform a proper installation, you must make several selections to define the axes of the leader
group. This section contains descriptions of some of the key concepts you must understand to define the
axes properly during installation:
For Standard Positioners:
• Kinematics type
• Axis arrangement, direction, assignment
• Axis offsets for known kinematics types
• Illegal axis configurations
Fig. 2.2.1 contains examples of leader devices you might install. Note that the "Robot" axes demonstrate
one possible robot location. Choose the robot location based on your positioner and application.
-5-
2.INSTALLATION B-82914EN/01
-6-
B-82914EN/01 2.INSTALLATION
NOTE
Assign axes and axes direction (+/-) in the most convenient manner for your
hardware and application setup and operation.
Axis Arrangement
Standard positioner axes must be either parallel or perpendicular to the other axes in the positioner. See
Fig. 2.2.3(a) .
Axis assignment is arbitrary for single axis positioners. Choose the most convenient axis assignment for
your configuration. Axes are usually assigned according to the robot axes to which they are most closely
parallel.
-7-
2.INSTALLATION B-82914EN/01
-8-
B-82914EN/01 2.INSTALLATION
Axis Assignment
When you assign an axis, you must decide whether it will be x, y, or z of the leader (positioner) frame. It
might be more convenient to align the leader frame (positioner) axis with axes in one of the following
robot frames:
• World
• User
• Jog
NOTE
There might be a reason to assign -x, -y, or -z to the positive direction of rotation
or linear motion of the leader axis. This is permitted.
If the positive jog key direction needs to move the axis in the opposite direction, complete the following
steps:
1. Perform a Controlled start (START CTRL).
2. Press MENUS.
3. Select MAINTENANCE, Group 2.
4. Press MANUAL.
5. Modify the axis sign to the opposite: from TRUE to FALSE, or from FALSE to TRUE for any axis
that needs to be reversed.
Example Assignment
This example describes axis assignment as illustrated in Fig. 2.2.1 and Fig. 2.2.2 . Refer to Fig. 2.2.1 and
Fig. 2.2.2 as you read the descriptions in this example. Note that the robot placement in Fig. 2.2.1 and Fig.
2.2.2 is arbitrary. The "typical" assignment is based on the shown robot location.
For Fig. 2.2.1 , drawing 1, the axis assignment is arbitrary (x, y, z, -x, -y, or -z). In typical applications,
this axis would be assigned -z.
For Fig. 2.2.1 , drawing 2, select axis 1 arbitrarily (x, y, z, -x, -y, or -z). Axis 2 must not be the same as
axis 1 or its negative. In this drawing, a typical assignment is axis 1 as -y and axis 2 as -z.
For Fig. 2.2.1 , drawing 3, select axis 1 arbitrarily (x, y, z, -x, -y, or -z). Axis 2 must not be the same as
axis 1 or its negative. A typical assignment would be axis 1 as +x and axis 2 as -y.
For Fig. 2.2.1 , drawing 4, select axis 1 arbitrarily (x, y, z, -x, -y, or -z). Select axis 2 and axis 3 in the
same direction as each other, but not the same direction as axis 1 or its negative. A typical assignment
would be axis 1 as +y, axis 2 as +z, and axis 3 as +z.
For Fig. 2.2.2 , axis 1 and axis 2 must be the same axis assignment and in the same direction, and axis 3
must be the same axis assignment but in the opposite direction. A typical assignment would be axis 1 as
+z, axis 2 as +z, and axis 3 as -z.
-9-
2.INSTALLATION B-82914EN/01
NOTE
Each axis is at 0°. Also, in the leader frame, the leader TCP is:
• X=a+d
• Y = -b
• Z=c+e
- 10 -
B-82914EN/01 3.SETTING UP COORDINATED PAIRS
Steps
1. Press MENUS.
2. Select SETUP.
3. Press F1, [TYPE].
4. Select Coord. You will see a screen similar to the following.
- 11 -
3.SETTING UP COORDINATED PAIRS B-82914EN/01
SETUP Coord
Coord Pair Number : [ 1]
Leader Group : 2
Follower Group : 1
X: 800.000 Y:0.000 Z:0.000
W: 0.000 P:0.000 R:0.000
Follower orientation:ATTACHED
Use Leader Frame number: 1
5. To display setup information for another pair, move the cursor to Coord Pair Number and type the
CD_pair number.
NOTE
The group numbers you use depend on the number of groups defined and set up
on your controller at installation. If they have been set up, motion groups 1-5 are
available for coordinated motion leaders and followers.
6. Move the cursor to Leader group and type the group number of the leader.
7. Confirm the change:
• To confirm the change, press F4, YES.
• To cancel the change, press F5, NO.
8. Move the cursor to Follower group and type the group number of the follower.
9. Confirm the change:
• To confirm the change, press F4, YES.
• To cancel the change, press F5, NO.
NOTE
If you change the leader or follower of an existing CD_pair, the calibration data will
be set to zero. After the first calibration, the axis assignment can be changed at
CTRL start. This will also cause calibration data to be set to zero.
- 12 -
B-82914EN/01 4.CALIBRATION
4 CALIBRATION
4.1 OVERVIEW
After you have set up the CD_pairs you will use ( Chapter 3), you must calibrate each CD_pair. The
kinematics type of the CD_pair leader group you set up during installation will determine the kind of
calibration you must perform.
Kinematics Type
The kinematics type is determined when the leader group (positioner) is installed. Kinematics is
determined for the leader group through installation parameters. Two kinematics types are available:
• Known
• Unknown
Known kinematics type is applied to leader groups for which the arm length and offsets are known. This
information is required at the time the axes of the leader group are installed. This type can also be used
when you have existing calibration information that was defined previously for the CD_pair.
Unknown kinematics type is used for leader groups such as turntables or positioners for which the arm
length(s) and offset(s) are not known, or are not known accurately. Unknown kinematics type is the most
common kinematics type.
The kind of calibration you perform depends on the kinematics type you specified during leader group
installation. Refer to Chapter 2 for more information.
Calibration
CD_pair calibration defines the relationship between the leader and follower, by finding the motion
transformation from the follower group (robot) to the leader group (positioner). When you perform
calibration, you establish the location of the leader origin with respect to the follower origin. In addition,
for unknown kinematics cases, the kinematics of the leader are determined during calibration. Offset
information is installed when the axes are installed for "known" type calibration.
The kinematics type, which was established when the leader group axis was installed, will determine the
kind of calibration you must perform:
• Known four point - for known kinematics types
• Known direct - when previous calibration data is to be re-entered
• Unknown point - for unknown kinematics types
NOTE
After you have calibrated a CD_pair, you do not need to change the calibration
unless the relationship of the leader origin to follower origin changes, the CD_pair
groups is changed, the axis type is changed, or the calibration type is changed (at
a controlled start).
NOTE
After you have calibrated a CD_pair, you must perform a cold start for the data to
take effect.
Known four point calibration provides a method for calibrating the CD_pair without touching the leader's
origin point compared to three point frame setup. Known four point calibration uses three taught positions
to set the positioner frame alignment, and a fourth position to set the leader TCP location. The
transformation from robot origin to positioner origin will be calculated based on the TCP information
plus the axis offset data. The three frame positions must reflect the axis alignment selected during Coord
Independent Axes installation.
In known four point calibration, you define the following points:
• Leader's TCP.
• Orient origin point, which is a "temporary" origin point that can be located at any position within the
follower's working motion range.
• X direction point, which aligns with the position X axis.
• Y direction point, which aligns with the position Y axis.
The second, third, and fourth points are used to determine a temporary leader frame. This frame is
translated to the TCP position of the leader, which is then translated to the leader origin via the leader axis
offset values.
Guidelines
When you perform known four point calibration, use the following guidelines:
• Use this method only for known kinematics leader devices.
• The axis "direction" selected for each axis during the installation of the positioner axes and the axes'
offsets will determine the way that the follower (robot) motion will coordinate with the leader
(positioner) motion.
• The method will set only the leader (positioner) frame - the alignment is independent of the robot
world frame alignment - and will calculate the origin point of the positioner frame in robot space
(relative to the follower UFRAME).
• Correct alignment of the leader frame is essential. The positioner axis whose axis "direction" was
assigned as "+x" at axis installation should coincide with (or be parallel to) the "+x" axis in the
positioner frame.
The frame positions you define relative to the Orient Origin Point for the X Direction Point at this
time should be aligned exactly with the x-axis of the leader group; Y Direction Point corresponds to
the positive y direction (or axis). This will ensure that a "+x" motion of the leader (positioner) will
result in the correct follower (robot) motion in the leader's moving frame. See Fig. 4.2(a) .
NOTE
The positioner +z direction must be perpendicular to the +x - +y plane formed by
the X and Y Direction Points.
- 14 -
B-82914EN/01 4.CALIBRATION
CAUTION
Be sure to align the Orient Origin, X Direction, and Y Direction positions carefully.
Otherwise, the calculated calibration frame will be incorrect and the coordinated
motion will not be accurate.
If you do not align these positions carefully, the calibration frame will be incorrect, but a calibration
frame will be calculated. In this case, the coordinated motion will not be accurate.
Use Procedure 4-1 to perform known four point calibration.
Conditions
• The follower group and leader group have been mastered and calibrated. (Refer to the appropriate
application-specific S etup and Operations Manual.)
• Axes in the leader group must be either parallel or perpendicular to each other. ( Fig. 2.2.1 )
• The selection of "axis direction" for the multiple-axis devices must be consistent with the right-hand
rule. ( Chapter 2 )
• The CD_pair has been set up ( Chapter 3 ).
Steps
1. Press MENUS.
2. Select SETUP.
3. Press F1, [TYPE].
4. Select Coord.
5. Press F3, [C_TYPE].
6. Select Known 4 Pt. You will see a screen similar to the following.
- 15 -
4.CALIBRATION B-82914EN/01
NOTE
If you indicated "unknown kinematics" during installation, you cannot select Known
4 Pt or Known Direct for C_TYPE.
SETUP Coord
Known type calibration Coord Pair: 1
Group Number Leader: 3 Follower: 1
X: ******** Y: ******** Z: ********
W: ******** P: ******** R: ********
Leader's TCP point : UNINIT
Orient Origin point : UNINIT
X Direction Point : UNINIT
Y Direction Point : UNINIT
- 16 -
B-82914EN/01 4.CALIBRATION
- 17 -
4.CALIBRATION B-82914EN/01
NOTE
Jog only the follower in Step 10.b and Step 10.c .
b. Jog the follower TCP to the Orient Origin Point.
c. Jog the follower to a position along (parallel to) the leader x-y plane in the positive y-axis of
the leader frame.
d. Press and hold SHIFT and press F5, RECORD.
UNINIT is changed to RECORDED.
11. Press F3, EXEC, to execute the calibration.
The leader coordinated frame is displayed in the SETUP Coord screen when this calculation is
complete.
If the calibration was not successful, or if a calibration message is displayed on the prompt line of the
teach pendant screen, refer to Table 7.2 in Chapter 7 .
Conditions
• The follower group and leader group have been mastered and calibrated. (Refer to the appropriate
application-specific S etup and Operations Manual.)
• The leader group hardware configuration is correct.
• The CD_pair has been set up ( Chapter 3 ).
• The selection of "axis direction" for the multiple-axis devices must be consistent with
three-dimensional right hand rule conventions for axis labeling.
• The follower and the leader must be positioned in the workcell exactly. The relationship of the
leader origin and the follower origin, including frame rotation planes, must be calculated precisely.
or
Previous calibration data is known and is to be entered manually.
Steps
1. If you are using known direct calibration to restore calibration data (for example, after reloading
system software), set the following system variables to their previous values:
• $SCR_GRP[leader_group].$ofst[leader_axis].$X
• $SCR_GRP[leader_group].$ofst[leader_axis].$Y
• $SCR_GRP[leader_group].$ofst[leader_axis].$Z
2. Press MENUS.
3. Select SETUP.
4. Press F1, [TYPE].
5. Select Coord.
6. Press F2, [C_TYPE].
7. Select Known Direct and press ENTER. You will see a screen similar to the following.
- 18 -
B-82914EN/01 4.CALIBRATION
SETUP Coord
Known type calibration Coord Pair: 1
Group Number Leader: 3 Follower: 1
X: 0.000 Y: 0.000 Z: 0.000
W: 0.000 P: 0.000 R: 0.000
X: 0.0000
Y: 0.0000
Z: 0.0000
W: 0.0000
P: 0.0000
R: 0.0000
8. Move the cursor to X, type the x value of the leader frame origin point, and press ENTER.
9. Move the cursor to Y, type the y value of the leader frame origin point, and press ENTER.
10. Move the cursor to Z, type the z value of the leader frame origin point, and press ENTER.
11. Move the cursor to W, type the rotation about the follower x axis that the leader frame has relative to
the follower frame, and press ENTER.
12. Move the cursor to P, type the rotation about the follower y axis that the leader frame has relative to
the follower frame, and press ENTER.
13. Move the cursor to R, type the rotation about the follower z axis that the leader frame has relative to
the follower frame, and press ENTER.
14. When you have set all of the values, press F3, EXEC, to execute the calibration.
The leader coordinated frame is displayed in the SETUP Coord screen when this calculation is
complete.
If the calibration was not successful, or if a calibration message is displayed on the prompt line of the
teach pendant screen, refer to Table 7.2 in Chapter 7.
- 19 -
4.CALIBRATION B-82914EN/01
- 20 -
B-82914EN/01 4.CALIBRATION
If possible, the alignment should reflect a logical alignment for leader frame x, y and z. Often,
it is best to align these with the follower (robot) WORLD axes, or with the UFRAME or
UTOOL axes of the follower.
For example, in Fig. 4.4(a) ,
• The one-axis rotary table can be any axis (x, y, z, -x, -y, or -z). See Drawing 1.
• Axis 1 of the two-axis rotary table can be any frame axis, such as y. However, the
perpendicular axes cannot be y or -y. See Drawings 2 and 3.
• Parallel axes with the same positive axis direction must be assigned the same. In the three-axis
parallel illustration, axis 2 and axis 3 must be defined as, for example, (x and x), (-x and -x), (y
and y), or (-y and -y). See Drawing 4.
• Mastering and calibration of the leader and follower groups has been completed.
• The CD_pair has been set up ( Chapter 3 ).
• The tool frame of the follower group has been defined.
• A mark or pointer has been placed on the last axis of the leader (positioner) device. This pointer
reference must be in the plane of rotation of the last axis, level with the surface (on the table top, for
example).
Use Procedure 4-3 to perform unknown point calibration for a rotary axis. Use Procedure 4-4 to perform
unknown point calibration for a linear axis. Use both Procedure 4-3 and Procedure 4-4 for positions with
linear and rotary axes.
Conditions
• The number, direction, and order of axes for the leader group is set and known.
• The leader frame alignment has been determined.
• Mastering and calibration of the leader and follower groups has been completed.
• The tool frame and user frame (if applicable) of the follower group have been defined.
• A mark or pointer has been placed on the last axis of the leader device (positioner).
• The CD_pair has been set up ( Chapter 3 ).
Hint
It is recommended that you define the positions you use in the calibration in a program so that the
program can be executed later in the event that the CD_pair calibration data is lost. Add some JOINT
motion instructions between the calibration positions so that the robot does not hit the positioner. A
typical calibration program has 6 to 8 positions per axis. After you have created this program, you can
execute the program in single step mode while recording the CD_pair calibration positions in the
- 21 -
4.CALIBRATION B-82914EN/01
coordinate calibration screen on the SETUP menu. Each axis will be calibrated. Note that all axes, except
the one being calibrated, must be at their zero positions.
NOTE
When you calibrate axes, you must start at the base axis and finish with the
tabletop or work surface axis. See Fig. 4.4(c).
SETUP Coord
Unknown type calibration Coord Pair: 1
Group Number Leader: 3 Follower: 1
X: 0.000 Y: 0.000 Z: 0.000
W: 0.000 P: 0.000 R: 0.000
Axis Number: 1 (Total:2)
Axis Type: ROTARY
Axis Direction: +Y
Point 1: UNINIT
Point 2: UNINIT
Point 3: UNINIT
NOTE
For the next two points, if the total positive rotation is less than60°, split the
available angular motion into two portions of roughly equal size. Very small
angular moves of less than 20°might yield less accurate calibration information.
- 23 -
4.CALIBRATION B-82914EN/01
12. If your positioner has a single axis, press F3, EXEC, to complete the CD_pair calibration. Otherwise,
go to Step 13.
13. Record Point 1 (Second Axis):
a. Move the cursor to Point 1.
b. Move the robot to Point 1 you defined in Step 9.
You can do this as follows: Move the robot clear of the positioner, change to Group 2, press
SHIFT and F4, MOVE_TO. This moves Group 2 to P[1]. Change to Group 1, press SHIFT and
F4, MOVE_TO.
Make sure axes 1 and 2 are each in the zero position. See Fig. 4.4(g).
NOTE
If you have written a calibration teach pendant program, move the cursor to the
position that is the Point 1 position, and press SHIFT and FWD.
NOTE
Use the same pointer or reference mark for all axes.
c. Press and hold SHIFT and press F5, RECORD.
- 24 -
B-82914EN/01 4.CALIBRATION
b. Jog the second axis only of the leader from 30 to 90 degrees in the positive direction.
c. Jog the follower (robot) so that the pointing device touches the marked position on the leader.
d. Press and hold SHIFT and press F5, RECORD.
16. Repeat Step 6 through Step 15 for all of the rotary axes of the positioner.
17. Perform Procedure 4-4 for all of the linear axes of the positioner.
18. When all of the axes (rotary and linear) have been calibrated, press F3, EXEC, to execute the
calibration.
- 25 -
4.CALIBRATION B-82914EN/01
The leader coordinated frame is displayed in the SETUP Coord screen when this calculation is
complete.
If the calibration was not successful, or if a calibration message is displayed on the prompt line of
the teach pendant screen, refer to Table 7.2 in Chapter 7.
19. Turn off the controller and then turn it on again to enable this data for system use.
Conditions
• The number, direction, and order of axes for the leader group is set and known.
• The leader frame alignment has been determined.
• Mastering and calibration of the leader and follower groups has been completed.
• The tool frame and user frame (if applicable) of the follower group have been defined.
• A mark or pointer has been placed on the last axis of the positioning device.
• The CD_pair has been set up ( Chapter 3 ).
NOTE
When you calibrate axes, you must start at the base axis and finish with the
tabletop or work surface axis. See Fig. 4.4(j).
- 26 -
B-82914EN/01 4.CALIBRATION
- 27 -
4.CALIBRATION B-82914EN/01
NOTE
Use the same pointer or reference mark for all axes.
- 28 -
B-82914EN/01 4.CALIBRATION
13. Repeat Step 6 through Step 10 for all of the linear axes of the positioner.
14. Perform Procedure 4-3 for all of the rotary axes of the positioner.
15. When all of the axes (rotary and linear) have been calibrated, press F3, EXEC, to execute the
calibration.
The leader coordinated frame is displayed in the SETUP Coord screen when this calculation is
complete.
If the calibration was not successful, or if a calibration message is displayed on the prompt line of
the teach pendant screen, refer to Table 7.2 in Chapter 7.
16. Turn off the controller and then turn it on again to enable this data for system use.
- 29 -
4.CALIBRATION B-82914EN/01
NOTE
In a table top coordination application, the leader is the table. It would be difficult to
define this leader frame by moving the leader position; therefore, use the follower
to teach the leader frames.
Conditions
• The coordinate pairs must be calibrated.
• The workpiece of the coordinate motion application is located on the leader group face plate.
Steps
1. Press MENUS.
2. Select SETUP.
3. Press F1, [TYPE].
4. Select Coord. You will see a screen similar to the following.
SETUP Coord
Coord Pair Number : [ 1]
Leader Group : 2
Follower Group : 1
X: 800.000 Y: 0.000 Z: 0.000
W: 0.000 P: 0.000 R: 0.000
Follower orientation: BOTH
Use Leader Frame number: 1
SETUP Coord
Leader's Frame Setup Coord Pair: 1
Group Number Leader: 2 Follower: 1
Leader Frame:
X: 0.000 Y: 0.000 Z: 0.000
W: 0.000 P: 0.000 R: 0.000
Leader Frame number: : 1
Origin Point: : UNINIT
X Direction Point: : UNINIT
Y Direction Point: : UNINIT
NOTE
If you do not see the option to select Leader Frame, you need to calibrate the
coordinate pair.
NOTE
The default value of all leader frames for x, y, z, w, p, and r, is zero.
7. You can select the leader frame whose values you wish to define:
a. Move the cursor to Leader Frame number.
b. Type the number of the leader frame and press ENTER.
8. Record Origin Point:
a. Move the cursor to Origin Point.
b. Jog the follower (robot) so that the pointing device touches the marked position on the leader.
See Fig. 4.5(b) .
c. Press and hold SHIFT and press F5, RECORD.
- 30 -
B-82914EN/01 4.CALIBRATION
- 31 -
4.CALIBRATION B-82914EN/01
Setting
1. To enable Dynamic UFrame on 7DA3/18 or later, set the following system variable and cycle
power.
$CD_PARAM.$DYN_UFRAME -> TRUE (default: FALSE)
After this setting and cycle power, the new item ‘Follower UFrame number’ appears on Coord pair
setting.
SETUP Coord
Coord Pair Number : [ 1]
Leader Group : 2
Follower Group : 1
X: 800.000 Y:0.000 Z:0.000
W: 0.000 P:0.000 R:0.000
Follower orientation : ATTACHED
Leader frame number : 1
Follower UFrame number : 0
In case of 7DA4 software, the option function “A05B-2500-R700 Dynamic UFrame” is needed
when the operator would like to use Dynamic UFrame. And when the above option is ordered, the
item “Follower UFrame number” appears on Coord pair setting without requiring the system
variable to be set manually.
2. Select “Leader frame number”. The selected leader frame is related with the following uframe.
Before this setting, you may need to define leader frame. For the procedure to define leader frame,
see the chapter of Section 4.5.
3. After setting “Follower UFrame number” and cycling power, the selected uframe of the follower is
treated as Dynamic Uframe. This means that the leader frame position based on the follower’s world
- 32 -
B-82914EN/01 4.CALIBRATION
frame will be set to the follower’s uframe. When this number is 0, Dynamic UFrame is disabled.
(default: 0)
For example, if Leader frame number is 1 and Follower Uframe number is 9, the position of the
leader frame 1 with respect to the follower’s world frame is set to the UF9 of the follower. So, UF9
content dynamically varies depending on the leader’s position.
And when one changes “Follower UFrame number” or “Leader frame number” setting, cycle power
operation is needed.
Programming
On the TPE program, use the uframe number set as Dynamic UFrame for the position to which you want
to apply TPE offset in relative frame.
On this TP program, we suppose Leader frame number is 1 and Follower Uframe number is 9. Here, note
that the position P[5], P[6], P[7], P[8] and P[9] are follower’s TCP position based on the leader frame 1.
And other positions are based on the follower’s world frame. Since P[5]-P[9] are relative form based on
the leader frame 1, i.e. work frame, the OFFSET, PR[100] works on the work frame.
Restriction
This function can be used in the following versions of software.
• 7DA3/18 or later
• 7DA4/01 or later
This function cannot be used with the following motion.
• Weaving
• Multi-follower programs
• Remote TCP
• Tracking motion (Line Tracking, TAST etc.)
• Multi-Pass
• Any option that is not supported with Coordinated motion
- 33 -
4.CALIBRATION B-82914EN/01
WARNING
The value of the User Frame that is used as Dynamic UFrame changes according
to the motion of the leader group. So if one operates the nomal motion by using
the User Frame that is used as Dynamic UFrame, the robot may move to
unexpected direction by the change of the leader robot’s position. Please don’t use
the User Frame that is used as Dynamic UFrame when operating the other
(nomal) motion.
- 34 -
B-82914EN/01 5.JOGGING
5 JOGGING
5.1 OVERVIEW
Coordinated jogging of a CD_pair allows one leader and its followers to be jogged in a coordinated
manner. The jog speed of the coordinated pair is determined by the speed of the leader group. The
relationship of the follower TCP to the leader frame is fixed during the jogging of the CD_pair.
How you jog CD_pairs depends on the kinds of groups used in the pairs:
• Fixed Orientation jogging is used to jog leader and follower groups together. Only the location of
the TCP of the follower is preserved with respect to the Leader frame. The orientation of the
follower remains constant with respect to the robot WORLD frame.
• Coordinated jogging is used to jog leader and follower groups together. The orientation and TCP of
the follower are maintained with respect to the leader frame is maintained.
• Coordinated sub-group jogging is used when integrated extended axes (sub-groups) are used in
leader groups. This type of jogging is only available in cases where auxiliary axes are included in
the leader group.
• Leader Frame (LDR) jogging is used to jog the follower group in the leader group frame.
WARNING
The farther the follower TCP is from the rotary leader axis center you are jogging,
the farther and faster the follower (robot) will move for the same override
percentage. Be aware of this when you jog; otherwise, you could injure personnel
or damage equipment.
In Fig. 5.2(b) , the leader group is group 2, the follower group is group 1. Subgroup jogging is used, so an
"S" is displayed instead of a "C."
PROGRAM NAME S21 JOINT 10%
Fig. 5.2(b) Coordinated Subgroup Jogging Display
In Fig. 5.2(c) , the leader group is group 2, the follower group is group 1. Fixed Orientation coordinated
jog is selected, so an "F" is displayed instead of a "C."
PROGRAM NAME F21 JOINT 10%
Fig. 5.2(c) Fixed Orientation Coordinated Jogging Display
- 35 -
5.JOGGING B-82914EN/01
Table 5.2 lists various jogging designations for a leader group 2 and follower groups 1 and 3.
F21 Jog leader (2) and follower (1), coordinated with fixed
orientation
Conditions
• The coordinate pairs must be calibrated.
Steps
1. Press MENUS.
2. Select SETUP.
3. Press F1, [TYPE].
4. Select Coord. You will see a screen similar to the following.
SETUP Coord
Coord Pair Number : [ 1]
Leader Group : 2
Follower Group : 1
X: 800.000 Y: 0.000 Z: 0.000
W: 0.000 P: 0.000 R: 0.000
Follower orientation: BOTH
Use Leader Frame number: 1
- 36 -
B-82914EN/01 5.JOGGING
NOTE
Before leader group jogging can be used, leader frames must be setup. Refer to
Section 4.5 for information on setting up leader frames.
Fig. 5.3(c) Rotary Leader Coordinated Jogging (F21) - Tilt (Fixed Orientation)
- 37 -
5.JOGGING B-82914EN/01
Fig. 5.3(d) Rotary Leader Coordinated Jogging (F21) - Turn (Fixed Orientation)
If the jog group is a leader group, then leader frame jogging will be turned off and you will not be able to
use the LDR jog mode. If the jog group is a follower group, the LDR jog coordinate will be displayed in
the status bar as LDR 2, where 2 is the leader group number. See Fig. 5.3.1(b).
POSITION G1 LDR2 50%
Fig. 5.3.1(b) LDR Jogging Display
NOTE
When you select the leader group (robot) to jog, and LDR2 jog is displayed, the
jog direction for the TCP is defined in the Leader group WORLD frame. See Fig.
5.3.1(b).
G1 in the status bar indicates that the current jog group is Group 1.
- 38 -
B-82914EN/01 5.JOGGING
If there is more than one leader group for the follower group, you can switch between leader groups using
the TOGGLE LDR GROUP function that is available on the FCTN menu. Refer to Section 5.5 for
information on jogging the robot.
Table 5.4 Kinds of Coordinated Motion Jogging (Group 1: follower, Group 2: leader)
Display Description Effect of JOINT Jog Type Effect of WORLD, TOOL, or USER
Jog Type
C21 Coordinated group jog Coordinated frame of the leader No effect for coordinated
moves in JOINT Independent Axes
Follower moves with the coordinated
frame without changing relative
position in the leader frame
F21 Fixed orientation coordinated Coordinated frame of the leader No effect for coordinated
group jog moves in JOINT. Independent Axes
Follower moves with the coordinated
frame without changing relative
location in the leader frame, and
orientation remains the same
S21 Coordinated subgroup jog Coordinated frame of the leader Coordinated frame of the leader
(Integrated extended axes) moves in JOINT moves by only X, Y, or Z (dependent
Follower moves with the coordinated on axis assignment, effective for
frame without changing relative integrated linear axes)
position in the leader frame Follower moves with the coordinated
frame
LDR2(G1) Follower (robot) jog Follower jogging occurs with respect Appears to jog like a JOG frame or a
to the leader frame. USER frame, but this frame moves if
the leader group axes are moved.
Fig. 5.4(a) , through Fig. 5.4(e) show examples of the effect of coordinated jogging.
- 39 -
5.JOGGING B-82914EN/01
NOTE
The tool orientation remains constant relative to the tabletop during jogging. You
can have coordinated motion on more than one axis being jogged at the same
time.
- 40 -
B-82914EN/01 5.JOGGING
WARNING
The farther the follower TCP is from the leader rotary axis center you are jogging,
the farther and faster the follower (robot) will move for the same override
percentage. Be aware of this when you jog; otherwise, you could injure personnel
or damage equipment.
Conditions
• All personnel and unnecessary equipment are out of the workcell.
• All EMERGENCY STOP faults have been cleared.
• All other faults have been cleared and the fault light is not illuminated.
WARNING
Make certain that all safety requirements for your workplace have been followed;
otherwise, you could injure personnel or damage equipment.
- 41 -
5.JOGGING B-82914EN/01
Steps
1. Hold the teach pendant and continuously press the DEADMAN switch on the back of the teach
pendant.
NOTE
If you release the DEADMAN switch while the teach pendant is ON, an error will
occur. To clear the error, continuously press the DEADMAN switch and then press
the RESET key on the teach pendant.
WARNING
The farther the follower TCP is from the leader axis you are jogging, the farther the
follower (robot) will move for the same override percentage. Be aware of this when
you jog; otherwise, you could injure personnel or damage equipment.
- 42 -
B-82914EN/01 5.JOGGING
"C#*" or "F#*" will be displayed in the status line, where a "#" is the leader group, and a "*" is
the follower group. F indicates that the orientation of the follower group is fixed. You will see a
screen similar to the following.
PROGRAM NAME C21 JOINT 10%
f. To change the number of the follower group, press FCTN and select TOGGLE COORD JOG.
Do this until the CD_pair you want is displayed.
g. To change to a fixed orientation coordinate jogging mode (orientation does not change), select
TOGGLE COOR ORNT. For more information on the types of Leader coordinate jogging
modes available, refer to Section 5.3.
NOTE
If there is no follower group, TOGGLE COOR ORNT will not be displayed.
h. To end coordinated jogging, press FCTN and select TOGGLE COORD JOG.
NOTE
Set the jog speed to a low percentage (%) value if you are inexperienced in
jogging the robot, or if you are uncertain how the robot will move.
4. Select a jog speed by pressing and releasing the appropriate jog speed key until the jog speed you
want is displayed in the upper right hand corner of the teach pendant screen.
WARNING
In the next step, the robot will move. To stop the robot immediately any time during
jogging, release the DEADMAN switch or press the EMERGENCY STOP button.
5. To jog, press and hold the SHIFT key and continuously press the jog key that corresponds to the
positioner axis you want to move in a coordinated fashion with the follower (robot). To stop jogging,
release the jog key.
6. When you are finished jogging, turn the teach pendant ON/OFF switch to OFF, and release the
DEADMAN switch.
- 43 -
6.PROGRAMMING B-82914EN/01
6 PROGRAMMING
6.1 OVERVIEW
To use coordinated motion within a teach pendant program, you must include the COORD motion option
in the appropriate motion instructions. This chapter contains information on using coordinated motion in
a teach pendant program.
To use coordinated motion in a teach pendant program, you must
1. Modify the program header information.
2. Include the COORD coordinated motion option and define the speed in the motion instructions that
will perform coordinated motion.
3. Execute the program.
In this example, coordinated motion will be performed in lines 2, 3, and 4. If the follower is a robot and
the leader is a single-axis tabletop, when line 2 of the program is executed, the leader and follower will
move together, and the TCP speed relative to the tabletop will be 20mm/sec. The two groups will start at
the same time and finish at the same time. The motion path of the follower, although it appears to be an
arc or circular, will travel along a straight line relative to the moving frame of the leader. The move to
P[6] will be a normal linear move.
You can include the COORD motion option only in linear (L) and circular (C) motion instructions.
Conditions
Before you record coordinated motion instructions, make sure that the tool frame for the follower group
have been defined properly.
Limitations
Coordinated motion in a program has the following limitations:
• You cannot use the INC incremental motion option in motion instructions that contain the COORD
motion option.
• You cannot use wrist jogging.
• You cannot use the Wjnt wrist joint motion option in motion instructions that contain the COORD
motion option.
• You can execute weaving only on the follower group (robot).
• You cannot use program shift or mirror image copy.
• UTOOL and UFRAME for the leader group (positioner) are not supported.
• The COORD motion option can be applied to a robot-only move (when the positioner does not
move). The effect is the same as a non-coordinated linear or circular move.
• You cannot put a non-coordinated linear or circular motion instruction of termination type
CNT1-CNT100 before a coordinated motion instruction. See Example 6.2 .
• For Coordinated motion RPM and Multipass, the starting position for tracking and replay must be
linear and must contain the COORD option.
Incorrect:
1: L P[1] 250mm/sec CNT100
2: L P[2] 20mm/sec FINE COORD
- 45 -
6.PROGRAMMING B-82914EN/01
You can also use COORD [ R[ ] ] to specify the leader group number in a register.
In a multi-arm system, it is possible that one robot could function as a leader at one time, but then
function as a follower at another time. If the COORD option is used in a system where the program group
mask has more than one “potential leader”, the alarm CD-009 “More than one leader” is posted. An
example system shown in Table 6.4 is illustrated in Fig. 6.4(a) and Fig. 6.4(b) .
Table 6.4
CD_PAIR setup Leader Follower
CD_PAIR[1] G1 G3
CD_PAIR[2] G2 G4
CD_PAIR[3] G1 G2
CD_PAIR[4] G1 G4
In Fig. 6.4(b) , there are two potential leaders. In this case, you could use COORD[1] in Program C to
specify group 1 as the leader.
- 46 -
B-82914EN/01 6.PROGRAMMING
Limitations
• If the leader group number changes within the same program
• they must be separated by at least one non-COORD motion
and
• the non-COORD motion immediately before the COORD[LDR] motion must use the FINE
termtype
L P[1] 25mm/sec CNT100 COORD [ m ]
L P[2] 25mm/sec FINE COORD [ m ]
….
L P[2] 1000mm/sec CNT100 <– reposition moves (non-COORD)
L P[3] 1000mm/sec FINE
L P[4] 25mm/sec CNT100 COORD [ n ] <– change leader group
L P[5] 25mm/sec FINE COORD [ n ]
• Dynamic switching of the leader group number in consecutive COORD [ LDR ] motion, as shown in
the following example, is not allowed.
The CD-029 “Illegal to switch leader” alarm will be posted.
L P[1] 25mm/sec CNT100 COORD [ m ]
L P[2] 25mm/sec CNT100 COORD [ n ]
- 47 -
6.PROGRAMMING B-82914EN/01
Programming Guidelines
When programming a linear coordinated motion instruction, keep in mind the following guidelines:
• Divide the motion so that half is performed by the robot and half is performed by the table. This will
reduce the time required on that segment. Preferably, this will have the two groups moving in
opposite directions.
• Try to orient the workpiece so that a preferred (application-dependent) position is achieved.
• Try to arrange the leader and follower at the end position of the segment so that
• The next path segment can be executed without stopping the process.
• The next path segment is in a preferred position.
• The distance to the next path segment is minimized.
NOTE
A fast linear coordinated move can be used for an air cut move, which might be
quicker than a joint air cut move.
• You can minimize the motion of either the leader or follower group, especially in cases where the
leader or follower is close to an axis limit, or the follower group is approaching singularity or wrist
flip positions.
• A coordinated motion from P[n] to P[n+1] should not be defined by recording P[n], then coordinated
jogging to P[n+1]. The effect of doing this is that the follower motion in the coordinated frame will
be of zero length and the motion will be executed at the maximum speed of the leader group axis
(axes).
• Work and travel angles will be executed as though there were no leader group motion when viewed
with respect to the workpiece being welded. If torch orientation of the first and second positions is
- 48 -
B-82914EN/01 6.PROGRAMMING
maintained relative to the workpiece, the entire path will maintain the torch orientation relative to
the workpiece.
Programming Guidelines
When you program a circular coordination motion instruction, keep in mind the following guidelines:
• The smoothest execution tends to occur when the predominant motion occurs on the positioner.
• Try to orient the workpiece so that a preferred (application-dependent) position is achieved.
• Try to arrange the leader and follower positions at the end position of the segment so that
• The next path segment can be executed without stopping the process.
• The next path segment is in a preferred position.
• The distance to the next path segment is minimized.
• You use a fast linear coordinated move for an air cut move that might be quicker than a joint air
cut move.
NOTE
You minimize the motion of either the leader or follower group in cases where the
leader or follower is close to an axis limit, or the follower group is approaching
singularity or wrist flip positions.
It is possible to define circular positions that can not be executed in program mode. Typically, this is
caused by one or more joints going into singularity. In those cases, do the following:
1. Stop execution.
2. Select coordinated jogging mode.
3. Jog the leader group to a position in which the singularity no longer exists.
4. Touch up the position in this new position.
5. Re-teach the next position by the same method until the motion problem no longer exists.
6. Try a complete execution of the circular move.
7. If you cannot complete the move, rotate the leader axis only (G2) until the workpiece is in a section
of the robot work envelope that does not cause the motion problem to occur, then record the new
position.
WARNING
As with non-coordinated circular moves, if you abort a program during the
execution of a circular move, and if you jog the robot out of the plane of the
motion, the resumed motion will include the robot's current location. This might
cause the tool to hit the positioner or workpiece. Be sure to execute the program at
a low override for safety; otherwise, the robot could injure personnel or damage
equipment.
The (x,y,z) data of the VIA position is not used in the motion path execution, only for planning the circle.
The plane of execution of the circle will be determined by the start and end positions. The plane of
- 49 -
6.PROGRAMMING B-82914EN/01
circular motion during program execution is not changed by re-teaching the VIA position, only by
changing the start and end positions.
The plane in which circular motion OCCURS is relative to the tabletop of the positioner. As the
positioner moves, the circular motion plane also moves. This will appear as a helical motion.
To perform a spiral or helical motion on a headstock-mounted workpiece, use circular motion training
positions approximately every 45°of headstock rotation.
In order to execute a circular motion that changes the motion plane during execution, two circular moves
must be defined for the circular path. In Fig. 6.7 , to rotate the table top (axis 2) while rotating axis 1, you
must program two arcs:
• The first arc is created using points [P1], P[2] (via), and P[3]
• The second arc is created using points P[3], P[4] (via), and P[5]
The VIA position Cartesian data is used during single step execution.
• G1:arc robot
• G2:handling robot
• G3:handling robot
• Pair 1: G2 leader, G1 follower
• Pair 2: G2 leader, G3 follower
- 50 -
B-82914EN/01 6.PROGRAMMING
For pair 1, much more attention will be paid to the follower’s relative motion than the leader’s one while
teaching. For pair 2, much more attention will be paid to the leader’s motion while teaching. Because the
relative motion is almost none. Pair 1's motion is called 'Relative motion', and pair 2's motion is called
'Simultaneous motion'.→Table 6.8
For example, the follower’s arc robot For example, a work piece is held by
Description
welds the work peace held by leader’s more than one robot in material
handling robot. In this case, the handling. In this case, the leader’s
follower’s relative motion is important. motion is important. Normally, robot
Normally, the coordinated motion is link is used.
used.
Leader’s motion type If motion type is CIRCULAR or ARC, Programmed motion type.
it’s changed to LINEAR.
Follower’s relative motion type to Programmed motion type. If motion type is CIRCULAR or ARC,
leader it’s changed to LINEAR. *2
If leader’s move time is dominant in The warning message "CD-020 Not No warning message.
coordinated motion planning. reach relative speed" is shown.
(*1)The move time of coordinated motion is the longest one among all groups.
(*2)Since folower's TCP realtive to leader don't move, this move is zero distance move.
On Fig. 6.8 both relative motion (pair 1) and simultaneous motion (pair 2) should be done at the same
time. But coordinated motion dose not support simultaneous motion regularly . So following setting
enables to use simultaneous motion.
Setting
On Fig. 6.8, Pair2 (G2, G3) motion is simultaneous motion. So G2 and G3 is handling robot.
1. For all handling robot、you calculate as below.
G2 2^(2-1) = 2
G3 2^(3-1) = 4
(For example, G1=1, G4=8, G5=16)
2. Next, you sum up all value. In this case, total is 6 (=2+4).
3. You set $CD_PARAM.$MH_ROB_GMSK to this value.
If all follower robots are handling robot, the leader is treated as the leader of simultaneous motion. If a
non-handling follower robot exists, the leader is treated as the leader of relative motion.
In the case of Fig. 6.8 G2 treated as the leader of relative motion, because G2 has non- handling follower
G1. So, if G2's motion type is CIRCULAR, G2's motion changes LINEAR and moves at a maximum
speed.(Table 6.8)
For coordinated jogging, a handling follower robot must follow about leader. For example, you can
toggle 'C21', 'C23', and 'C231' as coordinated jogging before simultaneous motion setting. But you cannot
toggle 'C21' after setting, because handling robot G3 don't follow about leader G2. This specification
prevent G2 and G3 from dropping their work piece.
If you want to toggle 'C21', please set '$CD_PARAM.$MH_JOG_ENB' to False.
- 51 -
7.TROUBLESHOOTING B-82914EN/01
7 TROUBLESHOOTING
7.1 OVERVIEW
This section contains information on solving problems that arise when you are setting up and using
coordinated motion.
• Refer to the calibration error table in Section 7.2 if you have an error during calibration.
• Refer to the coordinated motion error codes listed in Section 7.3 if you want to look up a specific
coordinated motion error code.
Record must be shifted The RECORD function key was pressed before or without
pressing the SHIFT key.
Move to must be shifted A MOVE_TO function key operation was attempted before or
without pressing the SHIFT key.
Cannot move to uninitialized point A MOVE_TO function key operation was attempted on a point
that has not been not recorded.
Point Not Recorded This will happen only under the following circumstances:
• An internal memory allocation error has occurred.
• The system is out of memory.
• The CD (coordinated motion) system variables have
not been loaded.
All points have to be recorded for calibration An EXEC calibration operation was attempted before all positions
were recorded.
Pair calibrated. Please cold start. A successful calibration matrix was calculated. In order for it to
take effect, the system requires a COLD START.
Position data will be cleared! This is the message normally displayed when changing the value
of either the leader or follower in a CD_pair. Verify the change,
and the CD_XF transform will be uninitialized.
Exec must be shifted An EXEC calibration operation was attempted before or without
pressing the SHIFT key.
Recorded points are on one line Rotary axis calibration positions all lie on a single line. Re-record
all calibration positions using the correct method.
Improper axis direction On a multiple-axis positioner, one or more axes have been
labelled incorrectly. Verify that the desired frame has been
defined, and that all axes have been labelled correctly.
- 52 -
B-82914EN/01 7.TROUBLESHOOTING
Recorded points are too close This will be displayed in the following cases:
• For a rotary axis, two positions have been recorded at
the same location.
• Three positions have been recorded at the same
location.
• The follower has been moved, but the leader has not
been moved, for calibration positions.
• For a linear axis, the positions are in the same
location.
Improper points are recorded This will be displayed in the following cases:
• One position has been recorded using a different
UTOOL.
• Rotary non-orthogonal axes have been defined.
• Rotary non-parallel axes have been defined.
• For a linear or rotary axis, the move on the robot is
not along the axis of the positioner.
• For an integrated linear extended axis of a leader, the
move on the robot is not along the axis of the
positioner.
CD-009 More than one leader There is more than one leader in the Check motion statement. Perform
coordinated motion Coordinated Motion SETUP and then
perform a COLD START.
CD-016 INC motion is not supported INCREMENTAL motion is not Delete INC instruction.
supported with coordinated motion.
CD-018 No calibration for CD Calibration for coordinated motion is Execute calibration of coordinated
not done. motion in SETUP screen.
CD-019 Illegal follower setting" Number of follower is zero or two or Set number of follower correctly or set
greater on this motion. group mask correctly.
CD-020 Not reach relative speed Follower can not reach relative speed Teach follower and leader position
in program. again to reach relative speed.
CD-021 No kinematics in CD group Attempt to perform coordinated motion Initialize robot library correctly.
with non-kinematics robot.
CD-023 Illegal CD setting. Setting of coordinated motion is not Check setting of coordinated motion in
correct. SETUP screen and set correctly.
CD-029 Illegal to switch leader Cannot switch leader group while in Use same leader group number.
coordinated motion. Change leader only when preceeded
by a non-coordinated motion.
- 53 -
B-82914EN/01 INDEX
INDEX
<A> <O>
Axis Arrangement, Direction, and Assignment................7 Offsets for Known Kinematics Types............................ 10
Axis Offset .......................................................................3 Overview....................................................................... 2,5
OVERVIEW ........................................ 1,5,11,13,35,44,52
<C>
CALIBRATION.............................................................13 <P>
CALIBRATION ERRORS ............................................52 PROGRAM HEADER INFORMATION ...................... 44
CIRCULAR MOTION PROGRAMMING....................49 PROGRAMMING ......................................................... 44
COORD COORDINATED MOTION OPTION ............45
COORD[ LDR ] COORDINATED MOTION OPTION45 <R>
Coordinated Frame...........................................................3 Relative motion and Simultaneous motion .................... 50
RESTRICTIONS AND GUIDELINES ......................... 11
<D> Rotary Axis...................................................................... 3
Dynamic UFrame ...........................................................32
<S>
<E> SAFETY ...........................................................................i
ERROR CODES ............................................................53 SELECTING CD_PAIRS .............................................. 11
SETTING UP COORDINATED PAIRS ....................... 11
<F> SETUP STEPS................................................................. 4
Follower Group ................................................................2 SPEED DEFINITION.................................................... 48
Follower UFRAME..........................................................3
Follower UTOOL.............................................................4 <T>
TERMINOLOGY ............................................................ 2
<I> TROUBLESHOOTING................................................. 52
INSTALLATION.............................................................5
INSTALLATION CONCEPTS........................................5 <U>
UNKNOWN POINT CALIBRATION FOR POSITIONERS
<J> ....................................................................................... 19
JOGGING ......................................................................35
JOGGING DESIGNATION...........................................35
JOGGING EXAMPLES.................................................39
JOGGING PROCEDURE ..............................................41
<K>
Kinematics Type ..............................................................6
KNOWN DIRECT CALIBRATION .............................18
KNOWN FOUR POINT CALIBRATION ....................13
<L>
Leader Frame (LDR) Jog Coordinate Mode...................38
LEADER FRAME SETUP ............................................29
Leader Group ...................................................................2
LEADER GROUP JOGGING (COORDINATED, FIXED
ORIENTATION COORDINATED)..............................36
Leader UFRAME .............................................................4
Leader UTOOL ................................................................4
Leader World Frame ........................................................4
Linear Axis.......................................................................2
LINEAR MOTION PROGRAMMING .........................48
<M>
Motion Group...................................................................2
i-1
FANUC Robot series R-30iA/R-30iA Mate CONTROLLER
Coordinated Motion Function OPERATOR’S MANUAL (B-82914EN)
01 Mar., 2009
* B - 8 2 9 1 4 E N / 0 1 *