RobotLink ADF Operator Manual (B-81564EN - 01)
RobotLink ADF Operator Manual (B-81564EN - 01)
B-81564EN/01
Ȧ No part of this manual may be reproduced in any form.
Ȧ All specifications and designs are subject to change without notice.
PREFACE
The approach deterrence function for the robot link monitors the
distance from the tool or arm of a robot to that of another robot in real
time If uses the Ethernet communication function installed on the R-J3
controller as standard to avoid collisions of operating robots adjacent to
each other. This function also monitors the distance between each
robot and its peripheral fixture of which the position, figure, and size
have been set to avoid collisions.
Emergency stop
p-1
B-81564EN/01 CONTENTS
CONTENTS
PREFACE...................................................................................................................................................................... p-1
1 OUTLINE..................................................................................................................................................................1
2 SETTINGS ................................................................................................................................................................4
2.1 NETWORK........................................................................................................................................................5
2.1.1 Wiring and Connection ..................................................................................................................................5
2.1.2 Settings ...........................................................................................................................................................8
2.1.3 Checking the Network-Related Settings .......................................................................................................12
2.2 CALIBRATION ...............................................................................................................................................14
2.2.1 Calibration Data ..........................................................................................................................................15
2.2.2 Setting Calibration TCPs .............................................................................................................................15
2.2.3 Teaching Reference Positions ......................................................................................................................16
2.2.4 Calculating Calibration Data ......................................................................................................................17
2.2.5 Indirect Calibration .....................................................................................................................................18
2.2.6 Setting Calibration Data ..............................................................................................................................21
2.2.7 Troubleshooting ...........................................................................................................................................24
2.3 SETTING MODELS........................................................................................................................................26
2.3.1 Definition of Elements..................................................................................................................................26
2.3.2 Setting a Hand Model ..................................................................................................................................28
2.3.3 Setting a Fixture Model................................................................................................................................37
2.3.4 Setting a Robot Model..................................................................................................................................46
2.4 SETTING APPROACH DETERRENCE COMBINATIONS.........................................................................53
2.5 SETTING OTHER PARAMETERS................................................................................................................59
2.6 MODEL DATA STORAGE DESTINATION .................................................................................................62
2.7 APPROACH WAITING COMBINATIONS...................................................................................................63
2.7.1 Approach Waiting Combination List Screen................................................................................................63
2.7.2 Detail Approach Waiting Combination Screen............................................................................................66
c-1
CONTENTS B-81564EN/01
APPENDIX
A SCREEN CONFIGURATION.............................................................................................................................107
C M-6i PARAMETERS...........................................................................................................................................111
F M-710iW PARAMETERS...................................................................................................................................120
c-2
B-81564EN/01 CONTENTS
c-3
B-81564EN/01 1.OUTLINE
1 OUTLINE
Approach deterrence function
The approach deterrence function exercises approach deterrence
control as follows:
-1-
1.OUTLINE B-81564EN/01
-2-
B-81564EN/01 1.OUTLINE
Restrictions
l The robot link approach deterrence function cannot be used
together with the following option:
− Approach deterrence function for dual robot (A05B-2400-
J780)
-3-
2.SETTINGS B-81564EN/01
2 SETTINGS
For the approach deterrence function, settings can roughly be divided
into the following six types:
1. Network settings
2. Calibration settings
3. Model settings
4. Combination settings
5. Other data settings
6. Approach waiting settings
This chapter explains each type of setting and how to make each
setting.
-4-
B-81564EN/01 2.SETTINGS
2.1 NETWORK
2.1.1.1 Environment
l For Ethernet cables, use twisted pair cables for 10BASE-T that are
protected against noise.
For details, refer to Sections 2.1 to 2.3 in CHAPTER 2,
"CONNECTING COMMUNICATION FUNCTIONS," in the
CNC operator's manual.
l A hub (concentrator) is required for constructing a network. Use a
switching hub.
To protect the robot link network against noise generated from the
main line, use of a switching hub with no shield (metal) on the
modular connectors is recommended.
l For Ethernet cables, use cross cables for two robots for which no
switching hub is used. Use straight cables for three or more robots
for which a switching hub is used.
l Run the Ethernet cables so that each cable can make a good
contact with the hub.
For example, install the Ethernet cables and hub as follows:
At least about 50 mm At least about 30 mm
Hub
-5-
2.SETTINGS B-81564EN/01
RC RC RC
Switching 10BASE-T
PC
hub
(NT)
RC RC
PC-available environment
Robot link network
2.1.1.2 Notes
Basic notes on using the robot link approach deterrence function are
listed below. Your system must satisfy the following requirements at
the minimum. You need to add measures according to the safety
standards for your system if required.
1
Robot link network A collection of multiple robot controllers which link robots
-6-
B-81564EN/01 2.SETTINGS
l The Ethernet cables must be routed so that noise will not affect
them. Therefore, do not route any Ethernet cable near what is apt
to cause noise.
l The power cable to the switching hub must be routed so that no
worker will stumble over the cable and disconnect it.
l Consider the Ethernet cable routing and location where the
switching hub is to be installed so that the connector of each cable
can make a good contact with the hub. If the contact is poor, good
communication cannot be established and wrong approach may be
detected.
This requirement is very important. Take great care.
l When an Ethernet cable is connected to the hub and the other end
of the cable is inserted into the Ethernet cable socket on the main
board on a robot controller, the orange LED on the printed circuit
board at the back of the socket glows. At this time, the power to
both the hub and robot controller must be on. If the LED does not
glow, the main board may be faulty. Contact the FANUC Service
Center.
l The front panel of the hub has an LED indicating the
communication status. If the approach is not detected normally,
this LED must be checked. For this reason, install the hub so that
the LED can be checked easily.
l On the TCP/IP setting screen, the correct IP addresses and host
names must be set. If not so, an unexpected robot connected to
Ethernet may detect the approach.
Check in particular that the common host name and IP address are
used for each robot on the robot link network. For example,
assume that there are three robots A, B, and C. If robot B
recognizes robot A with host name RC21, but robot C recognizes
robot A with host name RC31, these robots does not operate
normally. The same applies to the IP address.
l FTP communication must be started. If not so, approach
deterrence cannot be performed. For how to start FTP
communication, see the chapter titled "SETTINGS" in this
manual.
l The settings on the robot link calibration screen must be correct
and precise calibration must be performed. If not so, wrong
approach may be detected or a robot may cause interference
because it cannot detect the approach.
-7-
2.SETTINGS B-81564EN/01
2.1.2 Settings
The robot link approach deterrence function uses Ethernet. Settings for
using Ethernet must be made first.
This section explains how to make the settings using the following
system configuration as an example:
Controller 1 PC Controller 4
RC21 RC24
G1 G2 G1
Switching
G1 G1 G2 G3
Host Comm
[ TYPE ] LIST
On the host communication setting screen, check that the board address
has been set ("****" is not displayed for "Board address"). When the
board address has been set, no other processing is required.
If the board address is not set, set the address using the following
procedure:
① Turn the power to the controller and the circuit breaker off, open
the door, and draw out the main board.
② A label on which a small bar code is printed seal is affixed to the
CPU board on the main board. Write down the 12-digit number on
the label. This number indicates the board (MAC) address.
③ Remount the main board, close the door, and turn the circuit
breaker on. Turn the power on while holding the PREV and
NEXT→ keys down. The configuration menu appears.
④ Select "4 Maintenance" → "6 Ethernet based Loading …..".
⑤ There are only options 0 to 3, but enter 11.
⑥ The board (MAC) address setting screen appears. Enter the 12-
digit number you wrote down without colons (:).
After this operation, the prompt appears again. Wait until the board
(MAC) address has been written. Never turn the power off until the
write operation is complete. If the power is turned off before
completion of the write operation, the system does not start up
again unless you replace the CPU card.
2.1.2.2 Setting the host names, Internet (IP) addresses, and subnet
mask
Display the host communication setting screen, then the protocol
setting screen.
-9-
2.SETTINGS B-81564EN/01
CAUTION
Characters must be entered to set the items on this
screen. If an entered character string contains a space
(blank) (leading spaces are difficult to check in
particular), communication cannot be performed
properly. In this case, delete the entire line, then reenter
a character string.
TCP/IP
Node name : RC21
Router name : R
Board address : 08:00:19:02:F3:50
Subnet Mask : 255.255.0.0
← See the previous subsection.
Host Name (LOCAL) Internet Address
← Always set this value.
1 RC21 190.10.91.21
2 RC22 190.10.91.22
3 RC23 190.10.91.23
4 RC24 190.10.91.24
5 R 190.10.91.100
l The node name and Internet (IP) addresses must be unique in the
system. Specify any desired name that is easy-to-understand.
Make the above settings on all robot controllers on the robot link
network. Only the settings for "Node name" and "Board address" differ
depending on the controller.
Host Comm
- 10 -
B-81564EN/01 2.SETTINGS
1 Comment: ****************
2 Protocol name: ********
3 Portname: *****
4 Mode: *************************
Current
State: UNDEFINED
5 Remote: ********
6 Path: ****************************
Startup
7 State:
8 Remote: ********
Position the cursor on "2 Protocol name", press [CHOICE] (F4), and
select "3 FTP".
Then, position the cursor on "7 (Startup) State", press [CHOICE] (F4),
and select "3 START".
After that, turn the power off, then on again.
- 11 -
2.SETTINGS B-81564EN/01
After the system restarts, display the server setting screen and check
that the S1 state is "START".
CAUTION
If the state is not "START", an item set on the TCP/IP
protocol setting screen is invalid. The string set for the
node name, Internet (IP) address, board address, or host
name contains a space (blank). Set the item again.
2.1.2.4 Setting the full duplex mode (for each robot controller)
Set each robot controller to the full duplex mode. Set the system
variable $ENETMODE.$FULL_DUPLEX to TRUE.
- 12 -
B-81564EN/01 2.SETTINGS
⑤ On the server screen described above, check that the state of the S1
tag is "START".
- 13 -
2.SETTINGS B-81564EN/01
2.2 CALIBRATION
Calibration is to teach a robot the position of the reference coordinate
system viewed from the robot. More precisely, calibration is to set the
position and posture of the reference coordinate system viewed from
the world coordinate system of a certain robot in the robot.
l Copy the program containing the taught positions from each of the
reference robot and the robot to be calibrated onto a personal
computer.
l Calculate calibration data using a dedicated tool on the personal
computer.
l Set the result of calculation on the personal computer on the robot
to be calibrated.
l Repeat the above operation as many times as the number of robots.
For the reference robot itself, however, set (0,0,0,0,0,0) (initial
value).
- 14 -
B-81564EN/01 2.SETTINGS
As specific setting data, set the position (X,Y,Z) of the origin and
posture (W,P,R) of the reference coordinate system viewed from the
world coordinate system of a target robot.
Directly enter the values of the position and posture of the reference
coordinate system to set data.
X1-axis X2-axis
Y1-axis
Y2-axis
Reference robot
- 15 -
2.SETTINGS B-81564EN/01
three reference positions on each robot and process the result using a
personal computer to determine the positinal relationships between the
two robots.
Note the following points on selecting reference positions because the
selected reference positions affect the precision of calibration:
• Avoid selecting a posture with which the precision of the absolute
position of a robot is relatively low (near an operating area limit or
specific point) as much as possible.
• If the selected reference positions are close or three reference
positions are in line, the error generated through calculation for
determining the positional relationships becomes larger. As a
guide, for reference positions, select the vertexes of a triangle
whose sides are about 1 m long so that both robots will not assume
an unnatural posture at each position as much as possible.
Set TCPs on the ordinary TCP setting screen using the three-point
teaching method or direct teaching method. The TCP setting precision
greatly affects the precision of calibration. Set TCPs as precisely as
possible, checking them with posture jog feed.
- 16 -
B-81564EN/01 2.SETTINGS
Reference
position
robot.
Reference robot
Robot R1 Robot R2
- 18 -
B-81564EN/01 2.SETTINGS
each robot.
Robot R1
- 19 -
2.SETTINGS B-81564EN/01
[Reference]
If you set an invalid value in the list box at the bottom of the screen,
click the "Clear ListBox" button to erase the contents of the list box.
- 20 -
B-81564EN/01 2.SETTINGS
- 21 -
2.SETTINGS B-81564EN/01
1 C a l i b r a t i o n b e t we e n r o b o t <* DE T A I L * >
2 Models setup <*DETAIL*>
3 Check combination setup <*DETAIL*>
4 Check data setup <*DETAIL*>
5 Waiting condition setup <*DETAIL*>
[ TYPE ]
4. Position the cursor on the name of the robot for which calibration
data is to be entered. (In this example, the cursor is positioned on
G1.)
1 G1[M-6i ] NotYet
2 G2[M-6i ] NotYet
__________________
│ 1 Direct Entry │
-----+ +-----
[ TYPE ]│METHOD│ Done NotYet
- 22 -
B-81564EN/01 2.SETTINGS
G1[M-6i]
1 X: 0.000
2 Y: 0.000
3 Z: 0.000
4 W: 0.000
5 P: 0.000
6 R: 0.000
[ TYPE ] CHANGE
This screen shows the position and posture of the reference robot
viewed from the world coordinate system of the position (X,Y,Z) and
posture (W,P,R) of the displayed robot (M-6i in group 1 in the above
figure).
G1[M-6i]
1 X: 0.000
2 Y: 0.000
3 Z: 0.000
4 W: 0.000
5 P: 0.000
6 R: 0.000
[ TYPE ] COMPLETE
- 23 -
2.SETTINGS B-81564EN/01
10. After entering all required data, press the [COMPLETE] (F4) key.
G1[M-6i]
1 X: 0.000
2 Y: 1020.000
3 Z: 0.000
4 W: 90.000
5 P: 0.000
6 R: 0.000
[ TYPE ] COMPLETE
CAUTION
Registration of calibration data is not complete unless
the [COMPLETE] key is pressed.
1 G1[M-6i ] Done
2 G2[M-6i ] NotYet
2.2.7 Troubleshooting
① Although the "Calibrate" button is pressed, no calculation results
are displayed.
Check the following items:
l Check whether the programs were saved after
$FILECOMP.$TPP was set to TRUE.
l Check whether all position data in the programs is in the
Cartesian mode.
② The value indicated by "Mean Error:" exceeds 10 mm.
Check the following items:
l Check whether proper TCPs are selected. Check that the
currently selected TCPs are for calibration (for both robots).
If these TCPs are for calibration, perform posture jog feed
and check the TCP setting precision. After the TCPs are
corrected, the reference positions must also be taught again.
- 24 -
B-81564EN/01 2.SETTINGS
- 25 -
2.SETTINGS B-81564EN/01
Enabled/Disabled
When this parameter is set to "ENABLED", the element is set for the
relevant model. The initial value is "DISABLED" (except for the
parameters factory-set for a robot).
Link No.
This parameter indicates the number of the robot link attached to the
coordinate system for describing the position of the element. It is
mainly used for setting an element of a robot. For an element of a hand,
set this item to 99. This setting indicates that the reference coordinate
system indicating the position of the element matches the coordinate
system of the mechanical interface of the robot. The world coordinate
system is used as the reference coordinate system for setting an element
of a fixture regardless of which number is set (the setting is ignored).
Link type
This parameter indicates how the link is attached. It is mainly used for
setting an element of a robot. The initial value is "NORMAL".
Shape
This parameter indicates the geometrical shape of an element.
Currently, "Point" and "Link_seg" are supported.
Size
This parameter is used for determining whether to perform approach
deterrence.
Distance between points or line segments <= sum of sizes of both
models + other parameters
When the above condition is satisfied, both models are determined to
be in the approach status. Other parameters include values which vary
depending on the status such as a delay in communication.
- 26 -
B-81564EN/01 2.SETTINGS
CAUTION
Set at least 24 mm for this value. If the set value is less
than 24 mm, the robot may come into collision with an
object depending on the speed of the robot even if the
function operates as specified
Line_seg
Point
Size
Size
Pos1
Pos2
Pos1
- 27 -
2.SETTINGS B-81564EN/01
You can also clear all settings for a hand model or those for each
element at a time.
Sizes
- 29 -
2.SETTINGS B-81564EN/01
[ TYPE ]
[ TYPE ]
- 30 -
B-81564EN/01 2.SETTINGS
5. Press the Enter key. The comment edit screen appears. Press the
F1 to F5 keys and enter a comment statement. Up to 13 characters
can be entered.
G1 JOINT 100%
1 Upper Case
2 Lower Case
3 Punctuation
4 Options --Insert--
APRC Deterrence
Comment
1 GP1 HAND
2
3
4
- 31 -
2.SETTINGS B-81564EN/01
Shape Size
1 ENABLED Line_seg 40
2 ENABLED Line_seg 50
3 ENABLED Line_seg 30
4 DISABLED Point 0
5 DISABLED Point 0
- 32 -
B-81564EN/01 2.SETTINGS
G1 JOINT 100%
1 Point
2 Line_seg
3
4
APRC Deterrence
Figure data
1 ENABLED Line_seg 40
2 ENABLED Line_seg 50
3 ENABLED Line_seg 30
4 DISABLED Point 0
5 DISABLED Point 0
[ TYPE ] DETAIL
- 33 -
2.SETTINGS B-81564EN/01
Setting an element
Press the [DETAIL] (F2) key on the Figure data list screen. The detail
element data screen appears.
1 Enabled/Disabled: ENABLED
2 Link No.: 99
3 Link type: NORMAL
4 Shape: Line_seg
5 Size (mm): 40
- 34 -
B-81564EN/01 2.SETTINGS
1 Enabled/Disabled: ENABLED
2 Link No.: 99
3 Link type: NORMAL
4 Shape: Line_seg
5 Size (mm): 40
[ TYPE ] CLEAR
Clearing an element
CAUTION
Once an element is cleared, all data of the element is
deleted. Carefully clear an element.
- 35 -
2.SETTINGS B-81564EN/01
[ TYPE ] GROUP
3. Check the value set for "GROUP" and enter the number of a
desired hand for the corresponding tool coordinate system number.
In the above sample screen, hand number 1 corresponds to tool
coordinate system number 4 in group 1. According to this setting,
the function operates, assuming that the hand model having
number 1 is mounted when the tool coordinate system number is 4
in group 1. According to the settings on this screen, the function
performs a calculation, assuming that no hand is mounted when the
tool coordinate system number is not 4.
4. Press the [GROUP] (F2) key and make the setting for each group.
You can select the same hand model for different groups (when
you want to use a hand identical in shape). You can also select the
same hand for difference tool coordinate systems.
- 36 -
B-81564EN/01 2.SETTINGS
CAUTION
Once a model is cleared, the comment statement and
element data settings are all deleted. Carefully clear a
model.
- 37 -
2.SETTINGS B-81564EN/01
Data specified for "Link No." and "Link type" as element settings
are ignored. The position of each element is described based on
the world coordinate system of the specified group.
You can also clear all settings for a fixture model or those for each
element at a time.
Size
The settings for the element in this example are as follows. (Note: No
value is set for "Pos2" because the shape is set to "Point".)
- 38 -
B-81564EN/01 2.SETTINGS
[ TYPE ]
[ TYPE ]
- 39 -
2.SETTINGS B-81564EN/01
4. Position the cursor on "2 Fixture models setup" and press the Enter
key. The Fixture figure list screen appears.
5. Press the Enter key. The comment edit screen appears. Press the
F1 to F5 keys and enter a comment statement. Up to 13 characters
can be entered.
- 40 -
B-81564EN/01 2.SETTINGS
2. Position the cursor on the field under "TAUGHT GP" for a target
fixture and directly enter a value.
- 41 -
2.SETTINGS B-81564EN/01
Fixture: 1 [CLAMP A ]
Taught GP : 1
Shape Size
1 ENABLED Line_seg 40
2 ENABLED Line_seg 50
- 42 -
B-81564EN/01 2.SETTINGS
G1 JOINT 10 %
1 Point
2 Line_seg
3
4
APRC Deterrence
Figure data
1 ENABLED Line_seg 40
2 ENABLED Line_seg 50
Fixture: 1 [CLAMP A ]
Taught GP : 1
Shape Size
1 ENABLED Line_seg
2 ENABLED Line_seg 50
- 43 -
2.SETTINGS B-81564EN/01
Conceptual drawing of teaching position data (recorded using the detail element
data screen)
Recorded as "Pos1" Recorded as "Pos2"
Size
Fixture: 1 [CLAMP A ]
Element : 1
Taught GP : 1
1 Enabled/Disabled: ENABLED
2 Link No.: 0
3 Link type: NORMAL
4 Shape: Line_seg
5 Size (mm): 40
- 44 -
B-81564EN/01 2.SETTINGS
Fixture: 1 [CLAMP A ]
Element : 1
Taught GP : 1
1 Enabled/Disabled: ENABLED
2 Link No.: 0
3 Link type: NORMAL
4 Shape: Line_seg
5 Size (mm): 40
Clearing an element
You can restore all data of an element to its initial values.
Press the [CLEAR] (F3) key on the detail element data screen. The
following message appears:
"Clear this element? [Y=1/N=else]:"
To clear the element, enter 1.
- 45 -
2.SETTINGS B-81564EN/01
CAUTION
Once an element is cleared, all data of the element is
deleted. Carefully clear an element.
- 46 -
B-81564EN/01 2.SETTINGS
You can also clear all data for a desired element that was additionally
set at a time (except for factory-set data).
[ TYPE ]
[ TYPE ]
- 47 -
2.SETTINGS B-81564EN/01
[ TYPE ] DETAIL
On this screen, press the [DETAIL] (F2) key. The detail screen for the
robot on which the cursor is positioned appears. You cannot edit data
on this screen.
[ TYPE ] DETAIL
Robot: 1 [M-6i ]
Shape Size
1 ENABLED Point 40
2 ENABLED Line_seg 50
3 ENABLED Line_seg 100
4 ENABLED Line_seg 30
5 ENABLED Line_seg 50
6 DISABLED Point 0
7 DISABLED Point 0
8 DISABLED Point 0
9 DISABLED Point 0
10 DISABLED Point 0
[ TYPE ] DETAIL
- 48 -
B-81564EN/01 2.SETTINGS
G1 JOINT 100%
1 Point
2 Line_seg
3
4
APRC Deterrence
Figure data
6 ENABLED Line_seg 40
7 DISABLED Point 0
8 DISABLED Point 0
9 DISABLED Point 0
10 DISABLED Point 0
- 49 -
2.SETTINGS B-81564EN/01
Shape Size
1 DISABLED Point 40
2 ENABLED Line_seg 50
3 ENABLED Line_seg 100
4 ENABLED Line_seg 30
5 ENABLED Line_seg 50
6 DISABLED Point 25
7 DISABLED Point 0
8 DISABLED Point 0
9 DISABLED Point 0
10 DISABLED Point 0
- 50 -
B-81564EN/01 2.SETTINGS
Robot: 1 [M-6i ]
Element: 2
1 Enabled/Disabled: ENABLED
2 Link No.: 2
3 Link type: NORMAL
4 Shape: Line_seg
5 Size (mm): 113
[ TYPE ]
Robot: 1 [M-6i ]
Element: 2
1 Enabled/Disabled: ENABLED
2 Link No.: 2
3 Link type: NORMAL
4 Shape: Line_seg
5 Size (mm): 113
[ TYPE ]
Position the cursor on the field indicating the size and directly
enter size data.
l Entering position data
For both "Pos1" and "Pos2", position the cursor on the field for a
coordinate axis to be set and directly enter data. When the shape
of the element is set to "Point", set the coordinates of the center for
"Pos1". For "Point", data set for "Pos2" is ignored. When the
shape is "Line_seg", "Pos1" and "Pos2" may be specified in no
particular order. The specified link coordinate system is used as
the reference coordinate system.
- 52 -
B-81564EN/01 2.SETTINGS
Combination of models
Set a combination of models for which the approach deterrence
function is to be operated. For a combination, specify the types (robot
including a hand/fixture) and numbers (group number/fixture number)
of target models and whether to enable or disable the combination. Up
to 10 combinations can be specified.
Disable signal
Assign an input signal
.. for each specified combination. When the
specified signal is on, the approach deterrence function does not
operate for the combination. Set a signal with associating it with the
clamp signal for the fixture. An SDI, WDI, or RDI signal can be
specified. If no disable signal is defined for a combination, the
approach deterrence function always operates for the combination.
- 53 -
2.SETTINGS B-81564EN/01
[ TYPE ]
- 54 -
B-81564EN/01 2.SETTINGS
G1 J OI N T 1 0 0 %
1 5 RC24
2 RC21 6 R
3 RC22 7
4 RC23 8
A P R C De te r r e n c e
[ TYPE ]
Select the host name of the controller for the other robot.
To erase the host name, select option 1.
After setting the host name, turn the power off, then on
again.
l Setting models
Specify RH for a robot (including a hand) and F for a fixture.
Position the cursor on RH (or F) on the screen and press the
[CHOICE] (F4) key. The screen changes as shown below.
On this screen, you can specify RH or F.
G1 JOINT 10 %
1 RH
2 F
3
4
APRC Deterrence
Item1 - Item2 Host name
1 RH 1 RH 1 DISABLED
2 RH 1 RH 1 DISABLED
3 RH 1 RH 1 DISABLED
- 55 -
2.SETTINGS B-81564EN/01
[ TYPE ] DETAIL
- 56 -
B-81564EN/01 2.SETTINGS
Sample settings
Assume that the following settings are made on the controller having
host name R2:
A P R C De te r r e n c e G1 J OI N T 1 0 %
C o mb i n a ti o n to ch e c k 1 /1 0
I t e m 1 - I t e m 2 Ho s t n a m e
1 RH 1 RH 2 R1 ENABLED
2 RH 2 F 3 R2 ENABLED
[ T Y P E ] DE T A I L
[ TYPE ] DETAIL
- 57 -
2.SETTINGS B-81564EN/01
Combination[ 1]
1 DI for disabled: DI [ 0]
2 Under halted DO: DO [ 0]
3 Temporary invalid DO: DO [ 0]
3. Position the cursor on the type of signal and press the [CHOICE]
(F4) key. The signals which can be selected are displayed to set a
signal.
G1 JOINT 100%
1 DI
2 RI
3 WI
4
APRC Deterrence
Combination to check
Combination[ 1]
1 DI for disabled: DI [ 0]
2 Under halted DO: DO [ 0]
3 Temporary invalid DO: DO [ 0]
Combination[ 1]
1 DI for disabled: DI [ 0]
2 Under halted DO: DO [ 0]
3 Temporary invalid DO: DO [ 0]
- 58 -
B-81564EN/01 2.SETTINGS
Max speed
This is a constant used for calculating communication delay margins.
Do not change the setting.
Max margin
This is a constant used for calculating communication delay margins.
Do not change the setting.
Approach stop rate
The approach deterrence function monitors the distance between
models. If a model enters the approach status, the function decelerates
the robot, then stops it. If there is a possibility that the robot will cause
a collision after decelerating, then stopping, the function performs E-
Stop.
The approach stop rate adjusts the distance between models that
triggers deceleration of a robot. The greater the approach stop rate is
set, the earlier the robot starts decelerating. Do not change the setting
in principle.
When the approach stop rate is set to 100, the robot starts decelerating
so that it can stop without causing a collision.
When the approach stop rate is set to 0, the robot does not decelerate,
then stop.
- 59 -
2.SETTINGS B-81564EN/01
Procedure
1. Press the MENUS key to display the screen menu and select
"SETUP".
2. Press the [TYPE] (F1) key and select "AP Deterrenc". The setting
list screen for the approach deterrence function appears.
[ TYPE ]
- 60 -
B-81564EN/01 2.SETTINGS
3. Position the cursor on "Check data setup" and press the Enter key.
The approach deterrence data list screen appears.
GROUP: 1
1 Use command at M-lock: ENABLED
2 Speed slope factor: 0.013
3 Model size offset(mm): 0.0
4 Max margin(mm): 510.0
5 Max speed(mm/sec): 2000
6 Max margin(mm/sec^2): 2000
7 Approach stop rate(%): 100
4. To check data for another group, press the [GROUP] (F2) key and
enter the group number.
- 61 -
2.SETTINGS B-81564EN/01
- 62 -
B-81564EN/01 2.SETTINGS
Display the approach waiting condition list screen using the following
procedure:
Procedure
1. Press the MENUS key to display the screen menu and select
"SETUP".
2. Press the [TYPE] (F1) key and select "AP Deterrenc". The setting
list screen for the approach deterrence function appears.
[ TYPE ]
A P R C De te r r e n c e G1 J OI N T 1 0 0 %
Wa i ti n g co n d i ti o n 1 /1 0
I te m1 - I te m2 Ho s t n a me
1 RH 1 RH 1
2 RH 1 RH 1
3 RH 1 RH 1
4 RH 1 RH 1
5 RH 1 RH 1
[ T Y P E ] DE T A I L
- 63 -
2.SETTINGS B-81564EN/01
Item2
Specify the type and number of the other model of the approach waiting
combination.
Host name
Enter the host name of the other model.
Sample settings
Assume that the following settings are made on the controller having
host name R1:
A P R C De te r r e n c e G1 J OI N T 1 0 0 %
Wa i ti n g co n d i ti o n 1 /1 0
I te m1 - I te m2 Ho s t n a me
1 RH 1 RH 2 R2
2 RH 2 F 2 R1
[ T Y P E ] DE T A I L
- 64 -
B-81564EN/01 2.SETTINGS
A P R C De te r r e n c e G1 J OI N T 1 0 0 %
Wa i ti n g co n d i ti o n 1 /1 0
I te m1 - I te m2 Ho s t n a me
1 RH 1 RH 1
2 RH 1 RH 1
3 RH 1 RH 1
4 RH 1 RH 1
5 RH 1 RH 1
[ T Y P E ] DE T A I L
G1 JOINT 100%
1 5 RC24
2 RC21 6 R
3 RC22 7
4 RC23 8
APRC Deterrence
Select the host name of the controller for the other model.
To erase the host name, select option 1.
After setting the host name, turn the power off,
then on again.
A P R C De te r r e n c e G1 J OI N T 1 0 0 %
Wa i ti n g co n d i ti o n 1 /1 0
I te m1 - I te m2 Ho s t n a me
1 RH 1 RH 1
2 RH 1 RH 1
3 RH 1 RH 1
4 RH 1 RH 1
5 RH 1 RH 1
[ T Y P E ] DE T A I L
- 65 -
2.SETTINGS B-81564EN/01
A P R C De te r r e n c e G1 J OI N T 1 0 0 %
Wa i ti n g co n d i ti o n 1 /1 0
I te m1 - I te m2 Ho s t n a me
1 RH 1 RH 1
2 RH 1 RH 1
3 RH 1 RH 1
4 RH 1 RH 1
5 RH 1 RH 1
[ T Y P E ] DE T A I L
A P R C De te r r e n c e G1 J OI N T 1 0 0 %
Wa i ti n g co n d i ti o n 1 /1 0
I te m1 - I te m2 Ho s t n a me
1 RH 1 RH 1
2 RH 1 RH 1
3 RH 1 RH 1
4 RH 1 RH 1
5 RH 1 RH 1
[ T Y P E ] DE T A I L
- 66 -
B-81564EN/01 2.SETTINGS
A P R C De te r r e n c e G1 J OI N T 1 0 0 %
C o mb i n a ti o n o f a p p r o a ch wa i t 1 /8
C o mb i n a ti o n [ 1 ]
1 Wa i t i n te rva l R (mm): 0
2 Wa i t i n te rva l H (mm): 0
3 DI fo r d i s a b l e d : DI [ 0]
4 A u to re -s ta rt: ENABLED
5 L i mi t ti me to wai t(s ec): 10
6 DI fo r i n te rru p u ti o n : DI [ 0]
7 DO fo r va l i d s ta tu s : DO [ 0]
8 DO d u ri n g wa i ti n g s ta tu s : DO [ 0]
[ TYPE ] L I ST
- 67 -
2.SETTINGS B-81564EN/01
2.7.2.1 Settings
Wait interval R
Specifies the distance between a line segment or point of a robot model
and the other model that triggers the robot model to wait (or
temporarily stop).
Example
Assume that the size of robot model 1 of RH1 is X mm.
Also assume that "Wait interval R" is set to 100 mm.
The condition is assumed to be satisfied when
the distance from a line segment or point to the other model becomes X
+ 100 mm + other margins.
Wait interval H
Specifies the distance between a line segment or point of a hand model
and the other model that triggers the hand model to wait (or temporarily
stop).
DI for disabled
When this signal is input, the corresponding approach waiting
combination is disabled.
The robot or hand does not wait or temporarily stop even if the
condition is satisfied.
Use this signal when you do not want the approach waiting function to
cause the robot or hand to decelerate and stop during spot welding
operation. An SDO, SDI, RDO, RDI, WDO, or WDI signal can be
used.
Example) The spot signal can be set for "DI for disabled" to disable the
approach waiting function during spot welding.
Auto re-start: ENABLED/DISABLED
You can specify whether to enable or disable auto restart.
When a robot assumes that the robot and the other robot come within
the approach waiting distance, the robot turns the signal set for "DO
during waiting status" on and starts decelerating and stopping.
When auto restart is enabled at this time, the robot enters the approach
waiting status.
In this status, the robot waits for the other robot to get away from that
robot.
To determine whether to release the robot from the waiting status, the
distance between the models that triggered the waiting status is used.
The robot in the waiting status automatically restarts operation when
the distance to the other model becomes longer than the distance that
triggered the waiting status.
- 68 -
B-81564EN/01 2.SETTINGS
- 69 -
3.PROGRAM INSTRUCTIONS B-81564EN/01
3 PROGRAM INSTRUCTIONS
With the approach deterrence function, the following program
instructions are available:
l Approach deterrence enable/disable instruction
l Approach waiting enable/disable instruction
l Approach deterrence sensitivity instruction
CAUTION
The approach waiting function, when simply set, does
not operate. This function operates only after a condition
is enabled in the program. When using the approach
waiting function, be sure to use the approach waiting
condition instruction.
- 70 -
B-81564EN/01 3.PROGRAM INSTRUCTIONS
3.1.1 Details
The following instruction temporarily disables the approach deterrence
function:
Approach_STOP[1]=TMP_DISABLE (ENABLE)
Approach deterrence combination number
CAUTION
The function is enabled on the setting screen even while
the function is temporarily disabled.
Program
After ENABLE instruction After TMP_DISABLE
execution
execution instruction execution
status
During Enabled Disabled
execution
Temporary Enabled → Enabled →
stop Enabled Disabled
→ restart
Restart Enabled Enabled
from
different
line
Termination Enabled Enabled automatically
- 71 -
3.PROGRAM INSTRUCTIONS B-81564EN/01
- 72 -
B-81564EN/01 3.PROGRAM INSTRUCTIONS
PROG_A PROG_B
1: J P[1] 100% FINE 1:
2: Approach_STOP[1]=TMP_DISABLE 2: Approach_STOP[1]=ENABLE
3: RUN PROG_B 3:
4: L P[2] 200mm/sec FINE
5: L P[3] 500mm/sec FINE
6: Approach_STOP[1]=ENABLE
Incapable of being enabled
7: L P[4] 100mm/sec FINE
from PROG_B.
Approach_STOP[ ]=TMP_DISABLE
Setting
Disabling task Processing
screen
Enabled Local task (Already disabled) No processing is
performed.
Another task SSPC-154 (PAUSE.G)
None Disables approach deterrence, and
has exclusive control.
SSPC-160 (WARNING)
Disabled Local task SSPC-151 (WARNING)
Another task SSPC-154 (PAUSE.G)
None SSPC-151 (WARNING)
- 74 -
B-81564EN/01 3.PROGRAM INSTRUCTIONS
Approach_STOP[ ]=ENABLE
Setting
Disabling task Processing
screen
Enabled Local task Enables approach deterrence, and
allows any task to disable approach
deterrence.
Another task SSPC-154 (PAUSE.G)
None No processing is performed.
Disabled Local task SSPC-152 (PAUSE.G)
Another task SSPC-154 (PAUSE.G)
None SSPC-152 (PAUSE.G)
- 75 -
3.PROGRAM INSTRUCTIONS B-81564EN/01
3.2.1 Details
The following instruction is used to enable/disable an approach waiting
condition:
Approach_WAIT[1]=ENABLE (DISABLE)
In accordance with a specified approach waiting condition number, the
approach waiting function for the robot to be monitored is
enabled/disabled. An approach waiting condition includes the
specification of an approach waiting distance. So, when modifying the
approach waiting distance, switch between approach waiting
conditions with this instruction. The table below indicates the
relationship between program status and function status.
Program
After ENABLE instruction After DISABLE
execution
execution instruction execution
status
During Enabled Disabled
execution
Temporary Enabled (However,, Disabled →
stop automatic restart is not Disabled
→ restart performed) →
Enabled
Restart Disabled Disabled
from
different
line
Termination Disabled Disabled automatically
CAUTION
If reverse program execution is performed after ENABLE
instruction execution, approach waiting is disabled.
Waiting signal
When the enable instruction is executed, the approach waiting signal is
turned on. This signal continues to be on until the combination is
disabled. This means that this signal continues to be on until any of the
following is performed:
l Program termination
l Restart from a different line after a temporary stop
- 76 -
B-81564EN/01 3.PROGRAM INSTRUCTIONS
- 77 -
3.PROGRAM INSTRUCTIONS B-81564EN/01
- 78 -
B-81564EN/01 3.PROGRAM INSTRUCTIONS
Example
Suppose that the setting below is made on the controller of a host
named R1.
A P R C De te rre n c e G1 J OI N T 1 0 0 %
Wa i ti n g co n d i ti o n 1 /1 0
I te m1 - I te m2 Ho s t n a me
1 RH 1 RH 2 R2
2 RH 1 RH 2 R1
3 RH 2 F 1 R1
[ T Y P E ] DE T A I L
Robot A
Robot B
For cycle time reduction, the robots are operated from left to right so
that robot A moves after robot B.
In such a case, the approach waiting function can be used so that robot
A monitors robot B. This eliminates the need for interlocking at each
spot welding point.
Robot A
Robot B
For this use, robot B needs to move ahead of robot A. So, robot A
needs to wait for robot B to start operation. Interlocking for this
purpose is needed.
CAUTION
The approach waiting function does not eliminate the
need for interlocking. The function is useful if the
sequence of operations of robots is clearly defined.
Interlocking may be required to make an operation
sequence clear.
- 80 -
B-81564EN/01 3.PROGRAM INSTRUCTIONS
Robot A
Robot B Robot A
Robot B
Robot A Robot A
Robot B Robot B
Approaching each other Waiting for each other
In the example above, robots A and B move to their target points (¡),
but the approach waiting function places the robots in approach waiting
status.
In the right-hand figure, robot A is waiting for robot B to move away.
On the other hand, robot B is waiting for robot A to move away. The
robots are deadlocked.
The approach waiting function cannot protect against such a deadlock.
In order to avoid such a deadlock, interlocking may be required.
CAUTION
The approach waiting function does not eliminate the
need for interlocking. To avoid a deadlock, interlocking
may be required.
- 81 -
3.PROGRAM INSTRUCTIONS B-81564EN/01
3.2.7 Notes
Power supply of a communication destination
When using the approach waiting function, turn on the power to the
controller of the combination partner. If an approach waiting
combination is enabled when the power to the partner is off, the
following alarm is issued:
SSPC-190 No communication (%s)
Example:
1:Approach_WAIT[1]=ENABLE
2:L P[1] 2000mm/sec FINE
3:WAIT 100sec
- 82 -
B-81564EN/01 3.PROGRAM INSTRUCTIONS
- 83 -
3.PROGRAM INSTRUCTIONS B-81564EN/01
Approach_WAIT[ ]=ENABLE
Enabling task Processing
Local task No processing is performed.
Another task SSPC-153 (PAUSE.G)
None SSPC-162 (WARNING)
Enables approach waiting, and has
exclusive control.
Approach_WAIT[ ]=DISABLE
Enabling task Processing
Local task Disables approach waiting, and
allows any task to enable approach
waiting.
Another task SSPC-153 (PAUSE.G)
None No processing is performed.
Robot A
Robot A
Robot B Robot B
Robot A is waiting for robot B to move When robot B is jogged away from
For example, when "the waiting enable signal of robot A is on" and "TP
enabled of robot B is on", ensure that robot A is held.
- 84 -
B-81564EN/01 3.PROGRAM INSTRUCTIONS
3.3.1 Details
The instruction below modifies the approach deterrence sensitivity.
Approach_RATE[GP:1]=100%
Group number
Unlike the approach deterrence instruction and approach waiting
instruction, the result of executing this instruction is not affected by a
change in the subsequent program execution status.
3.3.3 Notes
- 85 -
4.CHECK AND RECOVERY METHODS B-81564EN/01
- 86 -
B-81564EN/01 4.CHECK AND RECOVERY METHODS
[ TYPE ] DETAIL
[ TYPE ] DETAIL
- 87 -
4.CHECK AND RECOVERY METHODS B-81564EN/01
[ TYPE ] LIST
Detected number
This is the approach deterrence combination number for which the
detail screen is currently displayed
Halted Distance
This is the distance between models when approach deterrence is
detected
Model size L
This is the size of the local model
Model size R
This is the size of the remote model
Speed L
This is the speed of the local model
Speed R
This is the speed of the remote model
Inertia Margin L
This is the coasting distance margin until the robot stops.
This margin becomes greater as the speed increases. As the speed
increases, the coasting distance until the robot stops is longer. So, in
order to avoid collision, the robot needs to start stopping earlier.
Inertia Margin R
This is the coasting distance margin for the remote model
Margin for reduction
This is the margin for deceleration stop
Net Delay
This is the communication delay
- 88 -
B-81564EN/01 4.CHECK AND RECOVERY METHODS
- 89 -
4.CHECK AND RECOVERY METHODS B-81564EN/01
[ TYPE ] DETAIL
The both elements of a combination, remote host name, and status are
displayed.
This screen is updated as the status changes.
Status
The following statuses are available:
Display Description
Disable The combination is currently disabled.
Enable The combination is currently enabled.
However, the approach waiting distance is
not reached.
Paused The combination is enabled. This status is
set when an enabled program is stopped
temporarily.
For a disabled combination, Disable remains
unchanged.
Waiting The combination is enabled, and the
approach waiting status is set.
Transit* The asterisk (*) represents a character,
which is 1, 5, 8, 9, C, E, or F.
This status means that processing is being
performed. Another status is set
immediately.
Error* The asterisk (*) represents a number, which
is 2, 3, 10, and 11.
This status represents an internal error.
When this status is set, an alarm is issued
for an internal error. Contact your FANUC
service representative.
- 90 -
B-81564EN/01 4.CHECK AND RECOVERY METHODS
[ TYPE ] DETAIL
[ TYPE ] LIST
Waiting Distance
A value set on the combination setting screen is set.
Current Distance
The current shortest distance between the model with the indicated
robot/hand and the remote model.
When the combination is disabled, "******" is displayed.
Minimum Distance
The shortest distance from the remote model during the period from the
enabling of the combination to the present time.
- 91 -
4.CHECK AND RECOVERY METHODS B-81564EN/01
This value is not cleared when the combination is disabled. Each time
a combination is enabled, the value is initialized.
Display of the approach waiting status detail screen
1. Display the approach waiting status screen according to
Subsection 4.2.1, "Approach Waiting Status List Screen."
2. Move the cursor to a condition whose detailed information is to be
displayed.
3. Press the [DETAIL] (F2) key.
- 92 -
B-81564EN/01 4.CHECK AND RECOVERY METHODS
- 93 -
5.APPROACH DETERRENCE GUIDELINES B-81564EN/01
- 94 -
B-81564EN/01 5.APPROACH DETERRENCE GUIDELINES
- 95 -
6.ALARM CODES B-81564EN/01
6
SSPC-101
[Cause]
ALARM CODES
(G:%d) is close to target
- 96 -
B-81564EN/01 6.ALARM CODES
- 97 -
6.ALARM CODES B-81564EN/01
- 98 -
B-81564EN/01 6.ALARM CODES
- 99 -
6.ALARM CODES B-81564EN/01
- 100 -
B-81564EN/01 6.ALARM CODES
- 101 -
6.ALARM CODES B-81564EN/01
- 102 -
B-81564EN/01 6.ALARM CODES
- 103 -
6.ALARM CODES B-81564EN/01
- 104 -
APPENDIX
B-81564EN/01 APPENDIX A.SCREEN CONFIGURATION
A SCREEN CONFIGURATION
l Setting screen
Coordinate system
support
Robot element
Robot figure list Robot element list detail
Other data
l Status screen
Approach deterrence Approach deterrence status
status list detail
- 107 -
B.LR-Mate 200iL PARAMTERS APPENDIX B-81564EN/01
Link4
Z is forward
- 108 -
B-81564EN/01 APPENDIX B.LR-Mate 200iL PARAMTERS
Parameters
EL Link Shape Link type Size Pos1 x Pos1 y Pos1 z Pos2 x Pos2 y Pos2 z
1 2 Line_seg NORMAL 80 0 0 90 -250 0 120
2 2 Line_seg NORMAL 78 0 0 -98 -250 0 -110
3 3 Point NORMAL 163 -31 -7 0 0 0 0
4 3 Line_seg NORMAL 113 0 0 -160 0 0 -442
- 109 -
B.LR-Mate 200iL PARAMTERS APPENDIX B-81564EN/01
Addition of elements
The position data of representative tapped positions (P1 to P3) on the
J3 flange surface in the link3 coordinate system and the position data of
a representative tapped position on the J4 arm in the link 4 coordinate
system are shown below. When adding robot elements, make use of
Position data
Item/Point P1 P2 P3 P4
Link number 3 3 3 4
Link type NORMAL NORMAL NORMAL NORMAL
X 60.0 60.0 60.0 15.0
Y 68.0 20.0 -68.0 348.0
Z -70.5 -20.0 59.5 60.5
- 110 -
B-81564EN/01 APPENDIX C.M-6i PARAMETERS
C M-6i PARAMETERS
Link coordinate systems
M-6i Robot has six coordinate systems for links as illustrated below.
All link types are "NORMAL".
Link5 Link6
Y is backward Y is forward
Link3
Y is backward
Link2
Z is forward Link4
Link1 Z is forward
Z is forward Origin is same
Link0 as L ink4 ’s
is backward
- 111 -
C.M-6i PARAMETERS APPENDIX B-81564EN/01
Element4
Element2 Size 80
Size 230
Element3
Element1 Size 110
Size 140
Parameters
EL Link Shape Link type Size Pos1 x Pos1 y Pos1 z Pos2 x Pos2 y Pos2 z
1 2 Line_seg NORMAL 140 0 0 -185 -600 0 -185
2 3 Point NORMAL 230 -30 -30 0 0 0 0
3 4 Line_seg NORMAL 110 0 0 18 0 550 18
4 5 Line_seg NORMAL 80 0 0 -45 0 0 45
- 112 -
B-81564EN/01 APPENDIX D.S-430iW/165 AND S-430iF PARAMETERS
Link4 (Z is forward)
Link3 (Y is backward)
Origin is
same as Link4’s
Link2 (Z is forward)
Link1 (Z is forward)
Link0 (Y is backward)
- 113 -
D.S-430iW/165 AND S-430iF PARAMETERS APPENDIX B-81564EN/01
Element 6
Size 161
Element 5
Size 400
Element 4
Size 118
Element 2
Size 200
Element 11
Size 424
Element 3
Size 290
Parameters
EL Link Shape Link type Size Pos1 x Pos1 y Pos1 z Pos2 x Pos2 y Pos2 z
1 1 Line_seg NORMAL 424 0 -89 -141 -510 -89 -141
2 1 Point NORMAL 200 -5 -40 276.8 0 0 0
3 2 Line_seg NORMAL 290 -1075 0 -226 0 0 -226
4 3 Line_seg NORMAL 118 0 0 -1275 0 0 -282
5 3 Point NORMAL 400 -140 55 -60 0 0 0
6 5 Line_seg NORMAL 161 0 -15 15 0 -15 -120
- 114 -
B-81564EN/01 APPENDIX D.S-430iW/165 AND S-430iF PARAMETERS
Referrence
Element 1
Size 650 Already set
Element 1
Size 400
Parameters
EL Link Shape Link type Size Pos1 x Pos1 y Pos1 z Pos2 x Pos2 y Pos2 z
Already- 1 Line_seg NORMAL 424 0 -89 -141 -510 -89 -141
set EL1
Reference 1 Point NORMAL 650 -345 -120 0 0 0 0
element
- 115 -
D.S-430iW/165 AND S-430iF PARAMETERS APPENDIX B-81564EN/01
Addition of elements
The position data of representative tapped positions (P1 to P3) on the
J3 flange surface in the link3 coordinate system and the position data of
a representative tapped position on the J4 arm in the link 4 coordinate
system are shown below. When adding robot elements, make use of
this position data as reference information.
When adding elements, use element numbers 7 and up.
Position data
Item/Pint P1 P2 P3
Link number Link3 Link3 Link4
Link type NORMAL NORMAL NORMAL
X -195 146 83
Y -120 -40 512.5
Z -244.5 -251.5 0
- 116 -
B-81564EN/01 APPENDIX D.S-430iW/165 AND S-430iF PARAMETERS
- 117 -
E.S-430iW/200 PARAMETERS APPENDIX B-81564EN/01
E S-430iW/200 PARAMETERS
Link coordinate systems
The S-430iW/200 robot has six coordinate systems for the links as
illustrated below. All link types are "NORMAL".
Link6 (Y is forward)
Link4 (Z is forward) X X
X
Z Y Z
X
Link3 (Y is backward)
Y
Link2 (Z is forward) X
Z
Link5 (Y is backward)
The origin is the same as
LINK4's.
Link0 (Y is backward) Z Y
Link1 (Z is forward)
X X
- 118 -
B-81564EN/01 APPENDIX E.S-430iW/200 PARAMETERS
Parameters
EL Link Shape Link type Size Pos1 x Pos1 y Pos1 z Pos2 x Pos2 y Pos2 z
1 1 Line_seg NORMAL 424 -510 -89 -141 0 -89 -141
2 1 Point NORMAL 200 -5 -40 276.8 0 0 0
3 2 Line_seg NORMAL 290 -925 0 -226 0 0 -226
4 3 Point NORMAL 400 -120 -55 -60 0 0 0
5 3 Line_seg NORMAL 118 0 0 -282 0 0 -1114
6 5 Line_seg NORMAL 190 0 -15 -140 0 -15 -10
- 119 -
F.M-710iW PARAMETERS APPENDIX B-81564EN/01
F M-710iW PARAMETERS
Link coordinate systems
The M-710iW robot has a origin-based coordinate system on which the
world frame is based, and six coordinate systems for the links as shown
below. All link types are "NORMAL".
Link5 (Y is backward)
Link3 (Y is backward)
X
Z X X
X Z Z
Y
Link2 (Z is forward)
X
Link6 (Y is forward)
Y
Z Y
Link0 (Y is backward)
Link4 (Z is forward)
The origin is the same as
X X LINK5's.
Link1 (Z is forward)
- 120 -
B-81564EN/01 APPENDIX F.M-710iW PARAMETERS
Parameters
EL Link Shape Link type Size Pos1 x Pos1 y Pos1 z Pos2 x Pos2 y Pos2 z
1 1 Point NORMAL 510 -50 -40 30 0 0 0
2 2 Line_seg NORMAL 240 -770 -40 -290 -20 -40 -290
3 3 Point NORMAL 460 -170 -30 0 0 0 0
4 3 Line_seg NORMAL 110 0 0 -320 0 0 -1020
5 5 Point NORMAL 170 0 -20 -40 0 0 0
- 121 -
G.S-500i PARAMETERS APPENDIX B-81564EN/01
G
Link coordinate systems
S-500i PARAMETERS
The S-500i robot has a origin-based coordinate system on which the
world frame is based, and a fixed coordinate system for each link.
There are eight link-fixed coordinate systems including coordinate
systems fixed to parallel links. Link3 has three coordinate systems
with different link types.
Link6 (Y is forward)
Link5 (Y is backward)
X
Link3: Vertical (Z is forward)
X
X X Z Z
Y Y
Link2 (Z is forward)
Y
Y
Link3: Horizontal
X (Y is forward)
X The origin is the same as
Link3:NORMAL Link2's.
(Z is forward) Y
Link1 (Z is forward)
Link0 (Y is backward)
- 122 -
B-81564EN/01 APPENDIX G.S-500i PARAMETERS
Element 6
Element 4 Size 150
Size 350
Element 5
Size 100
Element 3
Size 280
Element 2
Size 125
Element 1
Size 420
Parameters
EL Link Shape Link type Size Pos1 x Pos1 y Pos1 z Pos2 x Pos2 y Pos2 z
1 1 Point NORMAL 420 -200 -300 0 0 0 0
2 1 Line_seg NORMAL 125 -25 -45 450 -25 -45 -450
3 2 Line_seg NORMAL 280 0 90 0 -900 90 0
4 3 Point Horizontal 350 100 -110 0 0 0 0
5 3 Line_seg Horizontal 100 0 -180 0 -1600 -180 0
6 5 Line_seg NORMAL 150 0 0 -20 0 0 -70
- 123 -
H.M-16iL PARAMETERS APPENDIX B-81564EN/01
H M-16iL PARAMETERS
Link coordinate systems
The M-16iL robot has a origin-based coordinate system on which the
world frame is based, and six coordinate systems for the links as shown
below. All link types are "NORMAL".
Link5 (Y is backward)
Link3 (Y is backward) X X X
X Z Z
Z
Y
Link2 (Z is forward)
X
Y Link6 (Y is forward)
Z Y
Link0 (Y is backward)
Link4 (Z is forward)
X X The origin is the same as
LINK5's.
Link1 (Z is forward)
- 124 -
B-81564EN/01 APPENDIX H.M-16iL PARAMETERS
Parameters
EL Link Shape Link type Size Pos1 x Pos1 y Pos1 z Pos2 x Pos2 y Pos2 z
1 1 Point NORMAL 300 -125 -20 50 0 0 0
2 2 Line_seg NORMAL 120 -60 0 -175 -810 0 -175
3 3 Point NORMAL 270 -75 -10 20 0 0 0
4 4 Line_seg NORMAL 110 0 -15 10 0 935 10
5 5 Line_seg NORMAL 50 0 0 -80 0 0 85
- 125 -
I.R-2000i/165F PARAMETERS APPENDIX B-81564EN/01
I R-2000i/165F PARAMETERS
Link coordinate systems
The R-2000i/165F robot has a origin-based coordinate system on
which the world frame is based, and five coordinate systems for the
links as shown below. All link types are "NORMAL".
Link5 (Y is backward)
Link3 (Y is backward) X X X
Z Z
Z X
Y
Link2 (Z is forward)
X Link6 (Y is forward)
Y
Link0 (Y is backward)
Z Y
Link4 (Z is forward)
The origin is the same as
X X LINK5's.
Link1 (Z is forward)
- 126 -
B-81564EN/01 APPENDIX I.R-2000i/165F PARAMETERS
Parameters
EL Link Shape Link type Size Pos1 x Pos1 y Pos1 z Pos2 x Pos2 y Pos2 z
1 1 Line_seg NORMAL 415 -482 0 -80 -102 0 -80
2 2 Line_seg NORMAL 250 0 2 -250 -1075 2 -250
3 3 Point NORMAL 350 -110 40 -88 0 0 0
4 3 Line_seg NORMAL 110 0 0 -418 0 0 -1148
5 5 Line_seg NORMAL 150 0 -15 12 0 -15 -113
- 127 -
J.CONNECTION OF THE
COMMUNICATION FUNCTION APPENDIX B-81564EN/01
J CONNECTION OF THE
COMMUNICATION FUNCTION
This chapter provides information required for Ethernet connection of
the R-J3 Controller.
CAUTION
1 Before attaching or detaching a cable to the R-J3
Controller, turn off the power to the Controller, and
confirm that the power is off.
2 For network building and the condition for using
devices other than the R-J3 Controller (such as media
converters, hubs, transceivers, and cables), contact
the supplier of each device. For network installation,
care must be taken to protect the network from a
noise source. Separate the network wiring sufficiently
away from a noise source such as a power line and
motor from an electrical viewpoint, and ground each
device as required. If grounding is insufficient
because of high impedance, a communication error
may occur. Before going into actual operation after
equipment installation, check the operation by
conducting a communication test. FANUC cannot
take responsibility for network trouble arising from a
device other than the R-J3 Controller.
- 128 -
J. CONNECTION OF THE
B-81564EN/01 APPENDIX COMMUNICATION FUNCTION
Transceiver cable
Hub
(concentrator)
・
・
・
Twisted pair cable
R-J3 Controller
Transceiver
10BASE5
trunk cable
Max. 100m
- 129 -
J.CONNECTION OF THE
COMMUNICATION FUNCTION APPENDIX B-81564EN/01
The Ethernet cable can be routed only from the front of the main CPU
board unit. For connector location information, see the outside
drawing of each board.
Radius of 70 mm or more
10BASE-T
Ethernet cable
Clamp
Ground plate
- 130 -
J. CONNECTION OF THE
B-81564EN/01 APPENDIX COMMUNICATION FUNCTION
CD38
Pin No. Signal Meaning
1 TX+ Transmission +
2 TX- Transmission -
3 RX+ Reception +
4 Not used
5 Not used
6 RX- Reception -
7 Not used
8 Not used
- 131 -
J.CONNECTION OF THE
COMMUNICATION FUNCTION APPENDIX B-81564EN/01
Shield
- The cable must not be longer than 100 m. Do not extend the cable
unnecessarily.
- 132 -
J. CONNECTION OF THE
B-81564EN/01 APPENDIX COMMUNICATION FUNCTION
Shield
- The cable must not be longer than 100 m. Do not extend the cable
unnecessarily.
NOTE
A straight cable is usually used for connection between a
communication device and hub. The cable required for
connection may differ depending on the manufacturer of
the hub or media converter, however. Check whether a
straight or cross cable is required, then prepare a correct
cable.
When connection is correct, the LED marked with
"TPPIL" on the main CPU board lights up.
- 133 -
J.CONNECTION OF THE
COMMUNICATION FUNCTION APPENDIX B-81564EN/01
Contact point
Manufacturer name Contact point
Sales Division, the 2-6-1 Marunouchi Chiyoda Ward, Tokyo, 100-8233
Furukawa Electric TEL: 03-3286-3126 FAX: 03-3286-3979
Co., Ltd.
Remarks
Tamachi Office, MU Building 3F, 1-9-1 Minaminaruse, Machida City,
Nissei Electric Co., Tokyo 194-0045
Ltd. TEL: 0427-29-2531 FAX: 0427-29-3375
Contact IWATANI International Corporation
point for Tokyo Head Office
overseas 21-8 NISHI-SHINBASHI 3-CHOME, MINATO-KU,
sales TOKYO, 105-8458, JAPAN
TEL:03-5405-5810 FAX:03-5405-5666
Telex:2524256 IWATYO J
Remarks A processed cable with the both terminal connector
is provided.
NOTE
The recommended standard cables cannot be used with
movable parts.
- 134 -
J. CONNECTION OF THE
B-81564EN/01 APPENDIX COMMUNICATION FUNCTION
NOTE
Always use connector TM21CP-88P(03) manufactured
by Hirose Electric for this cable.
Cable assembly
Oki Electric Cable Co., Ltd. also supplies cable assemblies using
connector TM21CP-88P(03) manufactured by Hirose Electric.
Make arrangements directly with the manufacturer for the
specifications (length, outgoing inspection, packing, and others)
and purchase cable assemblies.
Contact point: Oki Electric Cable Co., Ltd.
Sales contact point) Nagano Sales Office
TEL: 0266-27-1597
- 135 -
J.CONNECTION OF THE
COMMUNICATION FUNCTION APPENDIX B-81564EN/01
NOTE
TM21CP-88P(03)
Connector (manufacturer standard part)
Drawing number: A63L-0001-0823#P
Manufacturer: Hirose Electric Co., Ltd.
Manufacturer catalog number: TM21CP-88P(03)
Conforms to EIA/TIA 568A categories 3 and 5.
For how to assemble the connector and cable, contact Hirose
Electric.
(Hirose Electric technical document "TM21CP-88P(03) Connection
Procedure Specifications" (technical specification No . ATAD-
E2367) is available.)
- 136 -
J. CONNECTION OF THE
B-81564EN/01 APPENDIX COMMUNICATION FUNCTION
- 137 -
J.CONNECTION OF THE
COMMUNICATION FUNCTION APPENDIX B-81564EN/01
Clamp those cables that are run into the Controller and require shield
processing, as shown below. Process the shield of a twisted pair cable
for Ethernet in the same way. This clamp processing secures a cable,
and also processes the shield of the cable. Be sure to perform this
clamp processing because it is key to stable operation of the system.
As shown below, peel off a part of the outer sheath to expose the shield,
then press the exposed portion of the shield against the ground plate
with a clamp. The user needs to prepare a ground plate and install it as
shown below.
Ground plate
Cable
Cable clamp
Ground plate
Shield
Cable sheath
- 138 -
J. CONNECTION OF THE
B-81564EN/01 APPENDIX COMMUNICATION FUNCTION
Ground terminal
(for grounding)
Clamp mounting hole
12mm
20mm
- 139 -
J.CONNECTION OF THE
COMMUNICATION FUNCTION APPENDIX B-81564EN/01
55mm max.
28mm
6mm
17mm
- 140 -
J. CONNECTION OF THE
B-81564EN/01 APPENDIX COMMUNICATION FUNCTION
Personal computer
(Note 1) 10BASE5
trunk cable
(Note 1) Power
supply for
Personal computer/ HUB hub
trunk side
Electrical separation by
10BASE-T connection STP cable STP cable
Large network
Personal computer
Power
supply for
HUB hub
(Note 1)
Personal computer/
trunk side
Electrical separation by STP cable
10BASE-T connection
(Note 1)
Small network
- 141 -
J.CONNECTION OF THE
COMMUNICATION FUNCTION APPENDIX B-81564EN/01
NOTE
1 Ensure that the ground system of the personal
computer/trunk side is separated from the ground
system of the Controller. If ground system separation
is impossible because only one grounding point is
available, run the personal computer/trunk side
ground wire and the Controller side ground wire
separately to the grounding point. (See the figure
below.) The ground resistance must be 100 ohms or
less (glass-2 grounding). The ground wire must not
be thinner than the AC power line, and must be at
2
least 5.5 mm in diameter.
2 Even when the insulation/separation method based
on 10BASE-T is used as described above, noise can
impede normal communication. When a network is
used in such a very poor environment, consider the
use of 10BASE-FLAG (optical fiber media) to
completely separate the Controller from the personal
computer side.
FG
HUB
Controller
Ground wire of the machine side
Grounding point
- 142 -
INDEX B-81564EN/01
INDEX
Details 71, 76, 85
A
Disabling Deceleration Stop Based on Approach
ALARM CODES 96
Waiting 79
APPROACH DETERRENCE FUNCTION
E
ENABLE/DISABLE INSTRUCTION 71
APPROACH DETERRENCE GUIDELINES 94 Example of Use 80
APPROACH DETERRENCE SENSITIVITY
I
INSTRUCTION 85
Indirect Calibration 18
Approach Deterrence Status Detail Screen 88
Approach Deterrence Status List Screen 87 L
Approach Waiting Combination List Screen 63
LR-Mate 200iL PARAMTERS 108
APPROACH WAITING COMBINATIONS 63
M
APPROACH WAITING CONDITION
ENABLE/DISABLE INSTRUCTION 76 M-16iL PARAMETERS 124
Approach Waiting Status List Screen 90 M-6i PARAMETERS 111
M-710iW PARAMETERS 120
C
METHOD OF CHECKING APPROACH
Cable Clamping and Shield Processing 138
DETERRENCE (STATUS SCREEN) 87
Cable Connection 132
MODEL DATA STORAGE DESTINATION 62
Cable Wire 134
N
Calculating Calibration Data 17
CALIBRATION 14 NETWORK 5
Calibration Data 15 Network Installation 141
CHECK AND RECOVERY METHODS 86 NOISE PROTECTION 138
Checking the Network-Related Settings 12 Notes 73, 82, 85
CHECKING THE STATUS OF THE APPROACH
O
WAITING FUNCTION 90
OUTLINE 1
CONNECTION OF THE COMMUNICATION
FUNCTION 128 P
CONNECTION TO ETHERNET 129
PIN ALLOCATION OF THE 10BASE-T
Connector Specifications 136
CONNECTOR (CD38N) 131
D PREFACE p-1
PROGRAM INSTRUCTIONS 70
Deadlock Caused by the Approach Waiting
Function 81 R
Definition of Elements 26
R-2000i/165F PARMAETERS 126
Detail Approach Waiting Combination Screen 66
RECOVERY METHOD 93
i-1
B-81564EN/01 INDEX
i-2
Revision Record
FANUC Robot series (R-J3/R-J3i MODELB) Approach Deterrence Function For Robot Link
OPERATOR’S MANUAL (B-81564EN)
01 Sep.,2001