Robot Software Manual 3.3 (E)
Robot Software Manual 3.3 (E)
-HRSS 3.3
User Manual
Original Instruction
www.hiwin.tw
INDUSTRIE 4.0 Best Partner
Multi-Axis Robot
Pick-and-Place / Assembly /
Array and Packaging / Semiconductor /
Electro-Optical Industry /
Automotive Industry / Food Industry
• Articulated Robot
• Delta Robot
• SCARA Robot
• Wafer Robot
• Electric Gripper
• Integrated Electric Gripper
• Rotary Joint
HIWIN does not provide any warranty or compensation to all the damage caused
by above-mentioned circumstances unless the user can prove that the product is
defective.
For more information towards warranty terms and conditions, please contact
the technical stuff or the dealer who you purchased with.
1
C05UE202-2006
1. Improper modification or disassemble the robot might reduce the robot function, stability
or lifespan.
2. The end-effector or the cable for devices should be installed and designed by a professional
staff to avoid damaging the robot and robot malfunction.
3. Please contact the technical stuff for special modification coming from production line set
up.
4. For the safety reason, any modification for HIWIN product is strictly prohibited.
2
C05UE202-2006
Safety Precautions
1. Safety Information
Safety Responsibility and Effect
1. This chapter explains how to use the robot safely. Be sure to read this
chapter carefully before using the robot.
2. The user of the HIWIN industrial robot has responsibility to design and
install the safety device meeting the industrial safety regulations in
order to ensure personal safety.
3. In compliance with the safety information on industrial robot described
in this manual can’t guarantee that HIWIN robot will not occur any safety
problems.
4. This machine is defined as a partly completed machinery, the associated
hazards must be handled by system integrator in accordance with ISO
102018-1/ ISO 102018-2.
5. A safety-related part of control system (SRP/CS) should conform to the
requirement of performance level d and category 3 according to ISO
13849-1.
6. The installation for emergency functions shall be defined by the system
integrator in accordance with ISO 10218-1/ ISO 10218-2.
3
C05UE202-2006
Safety Precautions
i. General
All personnel involved in the use or setup of the industrial robot arm must read
the safety related literature for the robot arm and instruction manual in detail
and operate it in accordance with the specifications.
Safety Symbol
Users must strictly abide by the content description, otherwise it will cause
serious casualties.
Users must strictly abide by the content instructions, otherwise it may cause
minor injuries or equipment damage.
User must strictly abide by the content description, otherwise it may cause poor
product performance.
Use Limit
Robotic arm is prohibited for use in the following environments and uses
Personnel carrying purposes
Explosive environment
Environment without safety precautions
Outdoor environment
Environment affected by oil, water, dust, etc.
4
C05UE202-2006
All personnel working on industrial robotic arms must read and understand
the manual containing the safety section of the system of the robotic arm.
System Integrator
Refers to the person who integrates the industrial robot arm into a set of equipment
according to safety regulations and puts it into operation.
User
Users must be professionally trained, have the knowledge and experience in this
area, and be familiar with the prescribed standards, and thus be able to make a
correct judgment of the work to be performed and identify potential hazards.
Users can be defined into three categories based on operational permissions:
1. Operator
System startup and shutdown
Power on and off
Alarm system status recovery
2. Engineer
Operating personnel usage authority
Programming and changing
Arm teaching operation
5
C05UE202-2006
3. Expert
Engineer usage authority
Mechanical arm maintenance work
System Operation
Those who do not use functional safety kits must implement safety-fence guidance.
The system operation of personnel is divided into the following three levels
1. Operator
2. Engineer
3. Expert
Its control permissions are shown in the following table.
No. Function Operator Engineer Expert
Function Table
1 File X X O
2 Configuration>User group O O O
3 Display>Input/Output X O O
4 Display>Variable X O O
5 Display>Mileage O O O
6 Display>Utilization O O O
7 Display>Motor Torque O O O
8 Display>Fieldbus X X O
9 Diagnosis>Logbook O O O
10 Start-up>Calibrate X X O
11 Start-up>Master X X O
12 Start-up>Robot data X O O
13 Start-up>Network Config X X O
14 Start-up>RS-232 X X O
15 Start-up>System Setting X X O
16 Track>Setting X O O
17 Track>Vision Setting X O O
18 Track>Vision Object X O O
19 Track>Calibration X O O
20 Track>Monitor O O O
21 Help>About O O O
22 Help>Operating Time O O O
23 Help>Update X X O
24 Help>TP Calibration O O O
6
C05UE202-2006
25 Help>Manual O O O
Interface
26 Message box O O O
27 Velocity configuration X O O
28 Tool/base coordinate X X O
29 Teach Pendant configuration X O O
30 Change JOG coordinate system X O O
31 JOG X O O
32 On-screen keyboard O O O
33 Remove teach pendant X O O
34 Step execution X X O
35 Program execution O O O
36 Program selection O O O
37 Modify program X X O
38 Tool/base calibration X O O
39 IO operation X O O
40 Functional IO modification X X O
7
C05UE202-2006
Collaboration area
The area in which the operator and the robot arm may work together in the
protection zone. The collaboration area includes the working area and the
stopping distance of the robotic arm and the additional axis (optional). The area
can be protected by an isolation devices.
Note: Stop distance = reaction distance (time to get the message) + braking
distance (time to receive the message)
Protective area
A protected area is an area of the working area that is protected by a safe
guard device. The area must include working areas and collaboration areas,
and the safety areas ensure safety in the working area.
4
Illustration of axis A1
1. Workspace
2. Robot
3. Collaborative distance
4. Protective area
8
C05UE202-2006
9
C05UE202-2006
Automatic Mode
The automatic mode startup should include the following conditions:
The safe guard devices have been set up and confirmed that their functions are
working properly.
All suspended security should restore its full functionality.
Confirm that there are no people in the protected area.
Relevant workflow rules are complied.
To enter the protection area in this mode, the emergency stop function must be
activated before entering.
Stop Functions
Stop Category Description
Stop Category 0: The drive immediately cuts off the power after triggered.
Stop Category 1: The drive cuts off the power after the robot stops moving.
Stop Category 2: The drive maintains the power supply after the robot stops moving.
10
C05UE202-2006
11
C05UE202-2006
12
C05UE202-2006
General considerations
13
C05UE202-2006
18. Be sure power is disconnected prior to repair and maintenance, and ensure to
operate under the condition of no electrical shock risk.
19. Do not disassembly the controller without permission. If there’s any issues,
please contact our engineers.
14
C05UE202-2006
15
C05UE202-2006
Maintenance Precautions
1. More attention must be paid to the design of the end effector to prevent power
loss or any other errors that could lead to workpiece falling or damage.
2. The tool-type end effector is usually equipped with high voltage, high
temperature and active rotary shaft. Special attention should be paid to the
operating safety.
3. The end effector should be mounted firmly on the robot to avoid workpiece fall
during operation which may cause personal injury or hazard.
16
C05UE202-2006
1. The end effector may be equipped with its own control unit. During installation,
pay attention to installed location. Ensure that the control unit does not interfere
with robot operation.
2. The gripper-type end effector should prevent the workpiece from dropping or
damaging when the robot experiences a power error or other errors. If potential
dangers or abnormal situations exist when using end effector, the associated
hazards must be handled by the system integrator in accordance with the related
standards.
1. When using the pneumatic or hydraulic system, the gripped workpiece may fall
due to insufficient pressure or gravity.
2. The pneumatic or hydraulic system must be equipped with the relief valve, so
that it can be applied in an emergency.
1. The robot or other control component should have at least one device for
immediate halt, such as an emergency stop switch.
2. The emergency stop button must be installed in an easily accessible location for
quick stop.
3. While executing an emergency stop, power to the servo motor will be cut, and
all movements will be stopped. And the control system will be shut down.
Emergency stop should be reset if the restoration of operating procedure is
wanted.
4. Avoid using emergency stop to replace a normal stop procedure. This could
reduce the lifespan of the robot.
17
C05UE202-2006
1. When an emergency stop is performed, the power of the drive is cut off, all
operations are stopped, and the control system of the robot arm is turned off.
2. To resume execution, reset the emergency stop switch.
3. Emergency stop is immediate stop: Immediately stop the movement of the robot
arm and cut off the power of the drive.
4. The emergency stop switch is for emergency stop only.
5. HIWIN's industrial robot arm has two emergency stop switches, one of which is
located on the teach pendant and the other is automatically connected to the
controller via a dedicated cable. If there is a need for other emergency stop
switches, the other means of connection can be used to achieve the purpose of
emergency stop.
6. Based on the relevant industrial safety regulations, the emergency stop switch
needs to be directly connected to the control box of the robot arm through a
physical connection line.
7. Additional installed safety equipment must comply with PLD level.
18
C05UE202-2006
Content
1. Product Description ......................................................................................................... 39
2. Operation ......................................................................................................................... 41
2.10. JOG................................................................................................................ 56
19
C05UE202-2006
20
C05UE202-2006
2.20. Conveyor Belt Tracking Sensor Trigger Object Identification Function .... 119
2.21.2. Calibration setting for external axis mathematically coupled function .... 125
21
C05UE202-2006
22
C05UE202-2006
23
C05UE202-2006
24
C05UE202-2006
6.2. Programming for PTP, LIN, CIRC, SPINE Motion .................................... 229
25
C05UE202-2006
26
C05UE202-2006
27
C05UE202-2006
28
C05UE202-2006
6.20.1.6. EG_RUN_GRIP(str Dir, int Str, str GriSpeed, str GriForce) ............. 298
29
C05UE202-2006
30
C05UE202-2006
31
C05UE202-2006
7.4.3. Electric Gripper Controller Alarm Signal Error (04-01-3X) ....................... 377
32
C05UE202-2006
33
C05UE202-2006
34
C05UE202-2006
35
C05UE202-2006
Version Update
Applicable Applicable
Edition Date Remark
Software Range
RA605、
RA610、
HRSS RA620、
1.0.0 2017.07.10 Preliminary Issue
V3.2.0 RD4D5、
RD401、
RD403
RA605、
RA610、 Add 4.6、4.17、5.9、8.15.2、9.3.3、
HRSS RA620、 9.3.4、11.1 Content
1.1.0 2017.09.11
V3.2.2 RD4D5、 Modified 5.8、8.2.2.4、9、10.5.5、
RD401、 10.8 Content
RD403
RA605、
RA610、 1.Add 5.5.2.1、9.1.10
RA620、 2.Modified 3.5.1、3.5.2、3.5.8、
HRSS
1.2.0 2017.12.15 RD4D5、 3.5.10、3.5.11、3.5.12、3.6.1、
V3.2.5
RD401、 4.6、4.11.3、4.16、9.1.4、9.3.2、
RD403、 9.3.4
RT605
RA605、
RA610、
1.Add 4.13.7、4.16、6.6.3、9.1.11
RA620、
HRSS 2.Modified 4.9 、4.15 、4.17 、
1.3.0 2018.01.08 RD4D5、
V3.2.6 5.3.1、5.3.2、5.5.2、9.1.2、9.1.5、
RD401、
9.2.2、10.7.1、10.7.2、10.10.2
RD403、
RT605
RA605、
RA610、 1.Add 5.10、8.16.10、8.16.11、
RA620、 8.20、10.5.10、10.5.11、10.5.12
HRSS
1.4.0 2018.02.13 RD4D5、 2.Modified 4.15、4.17、5.3.1、
V3.2.7
RD401、 5.7.2、8.16.6、8.19.1.5、8.19.1.7、
RD403、 9.1.2、9.1.4、10.15
RT605
36
C05UE202-2006
RA605、
RA610、
RA620、
HRSS 1.Add 4.12.13、4.17、4.18、8.16.1
1.5.0 2018.04.17 RD4D5、
V3.2.8 2.Modified 9.4、10.3.1
RD401、
RD403、
RT605
RA605、
RA610、
RA620、 1.Add 4.11.9、4.20、4.23、8.15.3、
HRSS
1.6.0 2018.09.28 RD4D5、 8.16.2、8.17.12
V3.2.12
RD401、 2.Modified 9.3.2、9.3.4
RD403、
RT605
RA605、
RA610、
RA620、 1.Add 8.17.13, 10.5.13, 10.5.14
HRSS
1.7.0 2018.12.11 RD4D5、 2.Modified 4.15, 8.20, 9.4,
V3.2.14
RD401、 10.15, 11.1
RD403、
RT605
RA605、
RA610、 1.Add 4.13.3, 4.13.4, 8.16.2,
RA620、 8.16.3
HRSS
1.8.0 2019.05.22 RD4D5、 2.Modified 3.2, 4.7, 4.12.13,
V3.2.15
RD401、 4.13.1, 4.13.2, 8.10.1, 9.1.1,
RD403、 9.1.2, 9.4.2, 9.4.3
RT605
RA605、
RA610、
RA620、
HRSS
1.9.0 2019.12.17 RD4D5、 1.Modified 2.23, 2.24
V3.3.2
RD401、
RD403、
RT605
HRSS RA605、 1.Add 6.27, 6.28, 6.29, 8.2.5,
1.10.0 2020.04.14
V3.3.5 RA610、 8.20, 8.21
37
C05UE202-2006
38
C05UE202-2006
1. Product Description
1.1. Software Overview
The following software will be applied:
HIWIN Robot System Software
Windows 7 Embedded
Robot illustration
39
C05UE202-2006
The operating interface may differ from the standard model depending on the
user's settings.
40
C05UE202-2006
2. Operation
2.1. Teach Pendant
2.1.1. Front view
Function
The Teach Pendant is a portable programming device for the robot, which can
provide both programming operation and display. It is equipped with a touch
screen: the HRSS can operate by finger or stylus without an external mouse and
external keyboard.
Overview
No. Description
Used to change operation mode and turn on/off the monitor. Only after the key
1
is inserted, the switch can be turned.
Emergency Stop Button, used to stop the robot in emergency. It will lock when
2
the Emergency Stop Button is pressed.
3 Run Button, used for JOG.
4 Velocity adjustment
5 Space Operation Button
41
C05UE202-2006
Description
Component Description
Model
Model Plate
Plate
42
C05UE202-2006
If the Teach Pendant is removed, the robot cannot be stopped from the Emergency
Stop Button on the Teach Pendant. An external Emergency Stop Device is required
to connect to the control system.
The providers should take responsibility to remove the Teach Pendant from the
robot and keep it safe. It should be stored out of operator’s view and away from
contact. The purpose is to avoid confusion of valid and invalid emergency stop
devices.
Failure to take these measurements could lead to serious injury, death or
equipment damage
43
C05UE202-2006
44
C05UE202-2006
45
C05UE202-2006
Overview
2.2.3. Keyboard
The Teach Pendant is equipped with a touch screen. The HRSS can be operated by
finger or stylus.
The keyboard on the HRSS can be used to enter alphabets and numbers.
46
C05UE202-2006
Description
1. Property for Main Menu window
The Main Menu is displayed in the left window.
Click an item to display the next-level function table (e.g. File).
Display table or opened interface by pressing the menu button on the upper
left.
You can select these function items again without closing the next-level
table.
47
C05UE202-2006
48
C05UE202-2006
Operation steps
1. Time Settings
1. Main menu>Configuration>User group>Expert
2. Main menu>Configuration>Time setting
3. Enter required time under time setting
4. Press SET button
2. NTP Settings
1. Main menu>Configuration>User group>Expert
2. Main menu>Configuration>Time setting
3. Enter required NTP under NTP setting
4. Press SET button
49
C05UE202-2006
50
C05UE202-2006
Description
In the HRSS, the functions can be selected according to the user group. The
following user group exist:
1. Operator
Operator group
This is the default user group.
2. Engineer
Engineer group
This user group is protected by a password. The default password is “HIWIN”.
Modification unavailable.
3. Expert
Expert group
This user group is protected by a password. The default password is “HIWIN”.
Modification unavailable.
51
C05UE202-2006
14 Start-up>RS-232 X X O
15 Start-up>System Setting X X O
16 Track>Setting X O O
No. Function Operator Engineer Expert
17 Track>Vision Setting X O O
18 Track>Vision Object X O O
19 Track>Calibration X O O
20 Track>Monitor O O O
21 Help>About O O O
22 Help>Operating Time O O O
23 Help>Update X X O
24 Help>TP Calibration O O O
25 Help>Manual O O O
Interface O O O
26 Message box O O O
27 Velocity configuration X O O
28 Tool/base coordinate X X O
Teach Pendant
29 X O O
configuration
Change JOG coordinate
30 X O O
system
31 JOG X O O
32 On-screen keyboard O O O
33 Remove teach pendant X O O
34 Step execution X X O
35 Program Execution O O O
36 Program selection O O O
37 Modify program X X O
38 Tool/base calibration X O O
39 IO operation X O O
40 Functional IO modification X X O
52
C05UE202-2006
Don’t modify the run during programming period. If it is changed, the robot
will stop.
Prerequisite
The controller doesn’t processing any program.
Insert the key for the mode selector switch.
Operation steps
1. Turn the mode selector switch on the Teach Pendant, and display the mode
selection.
2. Select the run.
3. The selected mode will be displayed in the status bar of the Teach Pendant.
53
C05UE202-2006
Overview
Description
1. ROBOT
The ROBOT used the Cartesian coordinate system. If it is a 6 axes robot,
it will be fixed at the location of the 1st –axis center point and the 2nd –axis
center point of the robot. If it is a 4 axes robot, it will be fixed at the robotic
foot. This is used as the origin coordinate system of the base coordinate
system.
In the default configuration, the coordinate system of ROBOT is consistent
with the BASE coordinate system.
2. BASE
The BASE Coordinate System is Cartesian system used to describe the
position of the workpiece. It is based on the ROBOT Coordinate System.
54
C05UE202-2006
3. TOOL
The TOOL Coordinate System is a Cartesian system, located at the tool
center point.
By default, the home of the Tool Coordinate System is located at the flange
center point (called the Flange Coordinate System). The Tool Coordinate
System is offset to the tool center point by the user.
Rotation of the six axes robot coordinate system
Corner Rotation around axis
55
C05UE202-2006
2.10. JOG
Description
There are two types of jogging:
Cartesian jogging, TCP (Tool Center Point) is jogged in the positive or negative
direction along an axis of the coordinate system.
Axis-specific jogging, each axis can independently be moved in a positive or
negative direction.
Axis-specific jogging
56
C05UE202-2006
Operation steps
1. Open the speed options window (shown as the chart button).
2. Change the JOG speed.
3. It is also possible to use the left button of teach pendant to change the JOG
speed.
57
C05UE202-2006
58
C05UE202-2006
No. Description
1 Tool coordinate currently selected
2 Parameters relate to selected tool coordinate
3 Base coordinate currently selected
4 Parameters relate to selected base coordinate
5 Recalibrate
6 Directly enter a value on the selected item to calibrate
59
C05UE202-2006
Operation steps
Open the TOOL/BASE window.
You can directly choose the tool/base coordinate system by click on ○
1 and ○
3
in figure respectively.
Operation Steps
1. Start-up -> Robot data -> Mount Position
2. Select Floor mode
Description
Define the user’s position relative to the robot before you use space button.
60
C05UE202-2006
Operation Steps
1. Start-up -> Robot data -> Mount Position
2. Select Ceiling mode
Description
Define the user’s position relative to the robot before you use space button.
Operation steps
1. Click the jogging ratio button.
2. Set the desired jogging ratio. Set with the +/- button or the adjustor.
3. Touch the area outside the jogging ratio window. The window closes and
the ratio is applied,
Other method
Use the +/- button at the left side of the Teach Pendant to set the ratio.
61
C05UE202-2006
The position where the TCP is located can be displayed in the following method:
select Main Menu>Display > Actual Position.
62
C05UE202-2006
Prerequisite
T1 mode
Operation steps
1. Open the window of Teach Pendant Configuration.
63
C05UE202-2006
2. Set the position where the Teach Pendant is located with regards to the
robot.
3. Close the window of the Teach Pendant configuration.
When switching to the external auto run, the Space Operation Button will be
automatically positioned as 0°.
Prerequisite
T1 mode
Ensure the Teach Pendant is positioned
Operation steps
1. Set the manual ratio
2. Hold the Enable Switch.
3. Press the Space Operation button, so that the arm can move to the
relative direction.
When the space operation is used for manual movement, the moving direction
depends on the position of Teach Pendant, not relevant to Base coordinate.
64
C05UE202-2006
2.12. Display
Description
Display the motor position, the axis angle and the Cartesian coordinate of the
current base.
If the 6-axis robot is operated, 6-axis information will be displayed.
If the 4-axis robot is operated, 4-axis information will be displayed.
65
C05UE202-2006
Description
No. Description
1 Input/Output No.
2 Simulation, opened as red
The input/output simulated signal (can be used when the
simulation is selected)
3
ON is displayed in red and showed On.
OFF is displayed in white and showed Off.
4 Input/output name (double-click to modify)
※When equipped with one I/O card (standard), 16 DIO can be used in HRSS, if there
is two I/O card (optional), HRSS can use 48 DIO.
66
C05UE202-2006
Description
No. Description
1 Input/Output No.
2 Simulation, opened as red.
The input/output simulated signal (can be used when the
simulation is selected)
3
ON is displayed in red and showed On.
OFF is displayed in white and showed Off.
4 Input/output name (double-click to modify)
67
C05UE202-2006
Description
No. Description
1 Input/Output No.
2 Simulation, opened as red
The input/output simulated signal (can be used when the simulation is selected)
3 ON is displayed in red and showed On.
OFF is displayed in white and showed Off.
4 Input/output name
Program name
5
Click and hold two seconds to remove the program
68
C05UE202-2006
Description
No. Description
1 Input/Output No.
The opened input/output signal displays in red and shows On.
2
OFF is displayed in white and showed Off.
3 Input/output name
69
C05UE202-2006
Description
Displays the posture when the robot runs or simulates the program.
70
C05UE202-2006
Description
Counter interface
No. Description
1 Counter No.
2 Counter value
3 Counter name (double-click to change the name)
71
C05UE202-2006
Description
Timer interface
No. Description
1 Timer No.
Timer status
2 On
Off
3 Timer value
4 Timer name (double-click to change the name)
72
C05UE202-2006
Description
2 3 4
5 6 7 8 9 10
Points interface
Item No. Description
1 Numbering for points
2 Name for points
3 Functional comment for points (free to edit by oneself)
Information for points, includes angle of each axis (A1~A6), Cartesian
4
coordinates (X, Y, Z, A, B, C), plus numbering of Tool and Base used.
5 Select a point and move to that point with LINE mode.
6 Select a point and move to that point with PTP mode.
7 Function to adjust the arrangement of data
8 Select a point and replicate the information for that point.
9 Select a point and delete that point.
10 Newly add a point with the current information.
73
C05UE202-2006
74
C05UE202-2006
75
C05UE202-2006
Description
Mileage Interface
Item No. Description
1 Numbering of motor axis
2 Total accumulated mileage
3 Current mileage (can be zeroed)
4 Unit of mileage (number of turns)
5 Zeroed reset「Current Mileage」
76
C05UE202-2006
Description
Utilization Interface
Item No. Description
1 Utilization rate
2 Total time of executing program
3 Total time of turning on power
4 Name of executing program
5 Start time of executing program
6 End/pause time of executing program
77
C05UE202-2006
Description
In offline, when 6-axis robot motion stop, press Show Data can display torque
analysis information of each axis.
78
C05UE202-2006
Item No Description
Name and color of motor.
1
Ps. Prog_Line is execution line of the program.
Root mean square value of motor torque.
2
If the value is over 100%, there is a problem.
3 The item for adjust the visibility of the line.
79
C05UE202-2006
Description
80
C05UE202-2006
81
C05UE202-2006
82
C05UE202-2006
83
C05UE202-2006
84
C05UE202-2006
85
C05UE202-2006
87
C05UE202-2006
88
C05UE202-2006
89
C05UE202-2006
90
C05UE202-2006
91
C05UE202-2006
92
C05UE202-2006
C. Select the Register Number that user wanted to store the parameter into
93
C05UE202-2006
94
C05UE202-2006
ERR_CODE:
Default 0
95
C05UE202-2006
2.14. Communication
TCP/IP interface
96
C05UE202-2006
No. Description
1 Server/Client configuration
2 Message sending field
3 IP and Port configuration
4 Send message
5 Connect/Disconnect button
6 Cancel
7 Set
8 Change IP
9 Cancel format
10 Display Content of Sending Message and Receiving Message
11 Division symbol
12 Parenthesis type
Operation steps
Main Menu>Start-up >Network Config
3. Client
1. Enter the Server’s IP and Port
2. Press [Connect].
3. Display “Connection is successful!” to represent the connection success.
4. Server
1. Enter the port you want to connect.
2. Press [Connect].
3. Display “Server is opened!” to represent opened.
97
C05UE202-2006
Change IP interface
No. Description
1 DHCP / Static IP mode selection
2 Static IP, specific IP address
3 Enter Change IP interface
4 Confirm setting
5 Select to change Port 1/ Port2 IP address
6 Cancel setting
Operation Steps
Main menu >Start-up >Network Config>Change IP
1. DHCP
2. Click [DHCP] option.
3. Press [Set] button.
4. Wait for the bar to finish loading, setting is completed.
98
C05UE202-2006
5. Static IP
6. Click [Static IP] option.
7. In [My Computer IP] column enter required IP address.
8. Press [Set] botton.
9. Wait for the bar to finish loading, setting is completed.
If setting failed message appeared, please check the internet connection to see if it is
connected properly or there is a problem in IP setting.
RS232 interface
99
C05UE202-2006
No. Description
1 Message sending field
2 Send message
3 Connect/Disconnect button
4 Cancel format
5 RS232 Stop bit
6 RS232 Parity
7 RS232 Data bit
8 RS232 Baud rate
Display Content of Transmitting Message & Receiving
9
Message
10 Division symbol
11 Parenthesis type
Operation steps
Main Menu>Start-up>RS-232
1. Enter RS232 parameters.
2. Press [Connect].
3. Display “Connection is successful!” to represent the connection success.
100
C05UE202-2006
No. Description
1 Set the model of Gripper
2 Connect/Disconnect with the Gripper
3 Rest Gripper
4 Display current Gripper status
5 Display current Gripper position
6 Install Gripper driver
101
C05UE202-2006
Operation Steps
Main menu>Start-up>Electric Gripper
1. If driver not installed, driver needed to be installed first, installation steps
are as follows:
A. HRSS software version has to be updated to 3.2.5 and above.
B. Download the Electric Gripper Driver.exe from official website and save
the file in USB under HIWIN folder. Then insert the USB into controller.
C. In the main screen of HRSS, select Start-up->Electric Gripper, once Electric
Gripper interface is opened, click the install driver button.
D. If HRSS detected the driver installation file from the USB, a warning signal
will appear to inform user that installation will stop the robot and reboot.
Press OK to start driver installation; Press CANCEL to exit.
102
C05UE202-2006
E. Press OK to end HRSS and start rebooting. Once reboot completed, the
driver installation will appear, click Extract.
103
C05UE202-2006
104
C05UE202-2006
105
C05UE202-2006
No. Description
1 Execute vision system
2 Update vision system
3 Install vision system driver
Operation steps
Main menu>Configuration>Vision System
1. If driver not installed, driver needed to be installed first, installation steps
are as follows:
106
C05UE202-2006
D. If HRSS detected the driver installation file from the USB, a warning signal
will appear to inform user that installation will stop the robot and reboot.
Press OK to start driver installation; Press CANCEL to exit.
107
C05UE202-2006
E. Press OK to end HRSS and start rebooting. Once reboot completed, the
driver installation will start execute, please wait patiently for installation to
complete.
108
C05UE202-2006
109
C05UE202-2006
110
C05UE202-2006
i. If HRSS detected update file in the USB, update will start operate
and a “update successfully” message will appear.
111
C05UE202-2006
Module Input
112
C05UE202-2006
Module Output
Operation Steps
Main Menu>Track>Setting
The interface is as follows and four parameters can be set: DI Trigger Type、DI
Detect Time、DI Keep Time、Strategy
1. DI Trigger Type: The state when manipulator picks an object.
2. DI Detect Time: After DO signal is sent, the time of DI detection is
maintained.
3. DI Keep Time: Detecting the duration of DI, when over the duration,
determine the detect DI.
4. Strategy: During pick, response strategy DI is detected
113
C05UE202-2006
Module Output
114
C05UE202-2006
Operation Step
Main Menu> Start-up>System Setting>Remote Access
1. Ensure robot controller is connected to network
2. Ensure TeamViewer is installed on the robot controller, HRSS version
3.2.8 and above is already installed automatically, if user has version
3.2.7 or earlier, please install the software manually, the manual
installation steps is as follows:
A. The HRSS software version need to be updated to 3.2.8 or higher.
115
C05UE202-2006
116
C05UE202-2006
117
C05UE202-2006
118
C05UE202-2006
I. Inform the sales about the remote ID of the ID and password displayed
on the interface of the robot.
J. After the customer service has successfully connected, the robot
controller screen can be obtained and the manipulator can remotely
operated.
Identification Function
Description
In the belt tracking, if the trigger source is selected to use the sensor trigger
(Sensor Latch), the corresponding input detection signal when the object is
119
C05UE202-2006
triggered can be set in the specified conveyor belt in the HRSS. If the input
detection signal reaches the set time (Keep Time) in the Detec Time set after the
object is triggered, the object is identified as the desired type, and generally can
be applied to the good product detection, and used the command CNV_OBJECT
to perform different program processing.
No. Description
Set the object recognition trigger signal, detection time,
1
duration of the specified conveyor belt.
2 Save setting
3 Cancel setting
Operation steps
Main Menu>Track>Sensor Object
1. Conveyor belt related setting calibration is completed, and
sensor trigger is selected.
2. Set the selection of the conveyor object identification input
trigger source.
120
C05UE202-2006
3. Set the input signal detection time for the selected conveyor
object identification.
4. Set the input signal duration for the selected conveyor object
identification.
5. The program uses the value of CNV_OBJECT after the
CNV_PICK instruction for subsequent programming planning
121
C05UE202-2006
No. Description
1 Select external axis
2 Enable/disable the selected external axis
3 Set the external axis type to linear / rotary axis
Set the motion mode of external axis to synchronous /
asynchronous axis
Synchronous motion:
Synchronous motion means that the motion of all axes
including the robot and the external axis starts and ends at
4
the same time. In the synchronous motion mode, calibrate
the motion path relationship between the robot and the
external axis and set its kinematics type to control the
external axis under the synchronous coordination control.
Asynchronous motion:
122
C05UE202-2006
Click the Add Group button to display the following group setting interface.
Currently, only one two axis positioner groups can be set and fixed to E1 and E2
axes.
123
C05UE202-2006
No. Description
18 Select external axis group name
19 Set the kinematics type of the external axis group
20 Set the external axis in the group
Operation Step
Main Menu> Start up>External Axis>Setting
1. Select the external axis to be set
2. Enable external axis
3. Set the external axis type
4. Set external axis motion interpolation mode
5. Set the motor direction
6. Set the maximum speed of the motor
7. Set the reduction ratio
8. Set high and low limits
9. Set the motor resolution
10. Set the pitch (only linear axis)
11. Set infinite rotation function (rotation axis only)
12. If the synchronous axis is selected and the calibration is completed, the
synchronous coupled function can be set
13. Save settings
14. Repeat the above steps to set other external axes in sequence
15. Set external axis group kinematics according to application
When setting the motor resolution, please pay attention to the maximum
resolution that the driver can support.
124
C05UE202-2006
coupled function
Description
If the motion mode of the external axis is set to synchronous axis, point
calibration can be performed to achieve synchronous coupled control. The linear
axis needs to calibrate two points and the rotary axis needs to calibrate three
points. The calibration process is as shown in the figure below. The user needs to
first Calibrate the tool coordinates, and then use the tool coordinate center (TCP)
to move to different reference points on the external axis. If the calibration
information is known, you can also directly input it manually.
No. Description
1 Select the external axis to be calibrated
Display calibration point position and coordinate information
2
and click to enter the value
3 Perform calibration
125
C05UE202-2006
Operation Step
Main Menu> Start up>External Axis>Setting
1. Select the external axis to be calibrated
2. Press the Measure button to perform the calibration step by step or
directly click the table to enter the value
3. After the calibration is completed, you can go to the Setting interface
and check to enable the coordinated control function
No. Description
1 Double-click the external axis to reset the zero point
Operation Step
Main Menu> Start up>External Axis>Zero Position
1. Double-click the external axis to reset the zero point
126
C05UE202-2006
2. After reset, confirm whether the external axis position and simulation
screen are correct
Operation Step
Main Menu> Start up>External Axis>Zero Position
1. Click to switch to T1 mode
2. Select external axis manual movement mode
127
C05UE202-2006
128
C05UE202-2006
No. Description
Display the value of the motor encoder of each axis of the
1
external axis
2 Display the position of each axis of the external axis
3 Display the acceleration of each axis of the external axis
4 Display the deceleration of each axis of the external axis
5 Display the speed of each axis of the external axis
6 Switch the position information of the robot or external axis
Operation Step
1. Click on the Pos. tab
2. Click the Ext Axis button to switch the position information to the
external axis
129
C05UE202-2006
No. Description
Display external axis point position and external axis mode
1
information
2 Select a point to execute LINE motion
3 Select a point to execute PTP motion
4 Overwrite selected point
5 Delete selected point
6 Record the current position of the robot and external axis
Operation Step
1. Click the Points tab
2. Click the Add button to record the current point
3. Select the point and click Delete to delete the point
4. Select the point and click Overwrite to overwrite the point
130
C05UE202-2006
5. Select a point and hold down the enabling switch and click LINE to
execute LINE motion to that point
6. Select a point and hold down the enabling switch and click PTP to
execute PTP motion to that point
No. Description
1 Edit function
2 Enable function
3 Select output as DO or SO (Fieldbus output)
4 Select a output
5 Save the output settings
131
C05UE202-2006
Operation Step
1. Click Edit to edit the settings
2. Check Enable to enable function
3. Select the output type as DO or SO
4. Select output index
5. Save the output settings
6. Double-click the list to set the check allowable range value
7. Move to the desired point and click Save Point
8. Write a program and monitor whether the specified output is on when
robot and external axis is within the range
132
C05UE202-2006
No. Description
Disable welding function, user can confirm welding teaching
1
path
Welding speed setting, need to match WELD_SPEED
2
instruction, for example:LIN WELD_SPEED
3 Torch gas purge time setting
4 Torch gas purge input signal setting
5 Torch collision detection input signal setting
6 Welder setting, select the welder and connect
7 Wire feed speed setting
8 Gas preflow time setting
9 Gas postflow time setting
10 Arc start error time setting
11 Arc loss error time setting
12 Save settings
133
C05UE202-2006
Operation Step
Main Menu> Start up> Arc Weld>Weld Equipment
1. Set whether to disable the arc for the teaching path during welding
2. Set the speed during welding
3. Set the torch gas purge time
4. Set the welding torch gas purge input signal
5. Set the input signal for torch collision detection
6. Set up the welder and connect
7. Set wire feed speed
8. Set gas preflow time
9. Set gas postflow time
10. Set arc start error time
11. Set arc loss error time
12. Save settings
134
C05UE202-2006
No. Description
1 Welding procedure
2 Number of welding schedules in the welding procedure
3 Welding mode
Selected workpiece, wire diameter and gas information in the
4
welding mode
5 Welding start-up process for smooth start-up of welding
Crater treatment is used to specify a lower voltage and current at
6 a certain time at the end of welding to avoid the crater hole
caused by a sharp drop in voltage
Post-welding treatment is used to prevent welding wire and
7 workpiece from welding by applying voltage at an appropriate
time after the wire feed is completed.
8 Save welding procedure settings
135
C05UE202-2006
No. Description
1 Welding procedure
2 Number of welding schedules in the welding procedure
3 Welding mode
4 Specified program in welding mode
Selected workpiece, wire diameter and gas information in the
5
welding mode
6 Welding start-up process for smooth start-up of welding
7 Save welding procedure settings
Welding schedule parameter setting, generally including
8 voltage, current, arc length, wire feed speed and execution time
and other parameters
136
C05UE202-2006
Operation Step
Main Menu> Start up>Arc Weld> Weld Procedure
1. Select welding procedure
2. Set welding schedules
3. Set the welding mode
4. Set the specified program in the welding mode
5. Set whether to enable runin process, crater process (Lincoln welding
machine only), burnback process (Lincoln welding machine only)
6. Save welding procedure settings
7. Select welding schedule to set
137
C05UE202-2006
Welding input
No. Description
Welding input signal
Voltage: voltage feedback value during welding
Current: current feedback value during welding
Wire feed speed: wire feed speed feedback value
Arc detection: Check whether the welding torch emits
1 voltage to confirm whether welding is being performed
Gas fault: Check whether the gas is exhausted. If this
signal is detected during welding, an alarm will be issued
to stop the welding
Wire fault: Check the wire feeder failure or welding wire
exhaustion
138
C05UE202-2006
139
C05UE202-2006
Welding output
No. Description
Welding output signal
Wire inch: the wire feeding amount of the jog wire feeding
function
Gas start: start welding machine gas supply
Inch forward: feed the wire feed amount set when the
1
signal is triggered
Inch backward: when this signal is triggered, withdrawn
the set wire feed amount
Feed forward: when this signal is triggered, the welder
continuously feeds wire
140
C05UE202-2006
Weaving setting
141
C05UE202-2006
No. Description
Dwell delay type:
Stop: stop completely at both ends of the weaving.
1 Move: at the two ends of the weaving, only the motion of the
weaving stops, and during this period, it moves in the direction
of the welding travel.
Elevation angle: the tilt of the swing angle by a specified angle
2
relative to the weaving coordinate system.
Azimuth angle: the tilt of the azimuth angle of the weaving on
3
the weaving plane.
Center rise: the bulge of the welding torch at the center of the
4
weaving, which will only be applied in the sinusoidal weaving.
Radius: the amplitude value of the circle-shaped weaving
5
relative to the welding direction.
L angle: set in the L-shaped weaving, the angle between the left
6
and right of the weaving and the plane.
Blend weave end: setting the weaving connection can smoothly
7 connect the weaving trajectory before and after the teaching
point of the action command.
Peak output port: set the endpoint output DO. During the
8 welding process, when the torch reaches the endpoint, the
specified DO signal is output.
9 Set the pulse width of the endpoint output DO.
10 Set the delay time of endpoint output DO.
11 Save weaving settings
12 Weaving schedule list
13 Edit specified weaving conditions
142
C05UE202-2006
No. Description
1 Frequency: the number of cycles per second for weaving
2 Amplitude: the distance from the welding line to the end point
Left dwell: the left dwell time and specify the stop time at the
left end of the weaving. When the dwell delay type is moving,
3
the robot moves in the welding direction. This setting is invalid
during the circular weaving.
Right dwell: the right dwell time, specify the stop time at the
right end of the weaving. When the dwell delay type is moving,
4
the robot moves in the welding direction. This setting is invalid
during the circular weaving.
Elevation: the elevation angle and tilt the swing angle by a
5
specified angle relative to the weaving coordinate system.
Azimuth: the tilt of the azimuth angle of the weaving on the
6
weaving plane.
Center rise: the center bulge and specify the bulge of the
7 welding torch at the center of the weaving, which will only be
applied in the sinusoidal weaving.
Radius: the amplitude value of the circular weaving relative to
8
the welding direction.
143
C05UE202-2006
L angle: set in the L-shaped weaving, the angle between the left
9
and right of the weaving and the plane.
10 Confirm and save condition settings
11 Cancel condition setting
Operation Step
Main Menu> Start up>Arc Weld> Weaving
1. Set the dwell delay type of weaving
2. Set the elevation angle of weaving
3. Set the azimuth angle of weaving
4. Set the center rise of weaving
5. Set the radius of weaving(circle weaving only)
6. Set the L angle of weaving(L-shaped weaving only)
7. Set the blend weave end
8. Set the peak output port of weaving
9. Set the pulse width of the endpoint output DO
10. Set the delay time of endpoint output DO
11. Save the weaving settings
12. Select weaving schedules for editing
13. Set the frequency of the weaving schedule
14. Set the amplitude of the weaving schedule
15. Set the left dwell time of the weaving schedule
16. Set the right dwell time of the weaving schedule
17. Set the angle of the weaving schedule
18. Set the azimuth angle of the weaving schedule
19. Set the center rise of the weaving schedule
20. Set the radius of the weaving schedule(circle weaving only)
21. Set the L angle of the weaving schedule(L-shaped weaving only)
22. Confirm and save the weaving schedules
144
C05UE202-2006
the correct welding cannot be performed, and the position of the wire tip needs to
be reset leading to long-term shutdown. The torch recovery function can
automatically correct the position of the wire tip in a short time. Using this
function can shorten the shutdown time and obtain stable welding quality.
No. Description
1 Set the tool number to perform TCP recovery
2 Set the base number to perform TCP recovery
Set the input signal type to be triggered when the welding wire
contacts the torch recovery fixture:
3
DI: general digital input
SI: fieldbus digital input
145
C05UE202-2006
146
C05UE202-2006
Operation Step
Main Menu> Start up>Arc Weld> Torch Mate
1. Set the base to perform TCP recovery. The relationship between the set
base and the fixture is as shown in the figure below. At the same time,
move the direction along the edge of the fixture to confirm the
correction accuracy.
147
C05UE202-2006
No. Description
1 Enable the resume program function, the default is enabled.
Set the adjustment distance of the resume position when
2
specifying the resume program
3 Save settings
148
C05UE202-2006
Operation Step
Main Menu> Start up>System Setting>Resume Program
1. Enable the resume program function
2. Set the adjustment distance of the resume position when specifying the
resume program
3. Save settings
4. Write a program, use the RESUME_PROG and
CLEAR_RESUME_PROG instructions. If the alarm occurs in the
LINE motion command within the specified range or the program is
manually stopped, the original program can be restarted from the
interrupted position
Under the situation that this function is turned on, although it can reduce the
damage of the robot and equipment. However, this force will still cause injury,
operators should pay attention to their own safety.
149
C05UE202-2006
No. Description
Click it can turn off collision detection, it can be temporarily
modified in the program by commands.
1
If it doesn’t be modified in the program, parameters will be
executed according to settings in the interface.
The range of sensitivity is 1-100, default is 80
2 The sensitivity can be adjusted for different situation to limit
false alarm or improve response.
Avoid operating the robot without fully warming up, causing
excessive resistance to trigger a collision alarm. Default is turned
3 it on.
If the robot has been already fully warmed up, user can evaluate
whether it needs to be closed.
When a collision occurs, select DO or SO (Fieldbus Output) as
4
the signal output.
150
C05UE202-2006
Restriction
1. When clicking the "disable" button, collision detection is invalid.
2. During the payload estimation, collision detection is invalid.
3. False alarm condition:
A. Parameters of payload are not set correctly.
B. Payload exceeds the maximum limit.
C. Using SET_ACC command, causing the acceleration to be too high.
D. Movement of the arm to near the singular point will cause high speed
operation.
E. Some commands of motion will have high acceleration.
4. False alarm can be avoided by modification of commands.
In the sample code, CD_START can turn on collision detection and set the
sensitivity to 80 first. During Lin to position of P1, P2, it check whether a
collision occurred. After reaching P2, CD_END can turn off collision detection,
and subsequent motion commands will not detect for collision events.
151
C05UE202-2006
152
C05UE202-2006
Advance
2.24. Payload
Description
Set the weight of the end of the robot, including the end tool and the object of
gripping, to improve the performance of the movement, adjust the speed limit of
the robot and ensure the accuracy of the robot for collision detection. In terms of
payload estimation, whether the robot arm will warm up and the weight of
payload will affect the accuracy of its estimation.
153
C05UE202-2006
Before estimating, please pay attention to the position of the equipment to avoid
collision. At the same time, you need to confirm that the related accessories on
the arm to avoid interference or falling off.
154
C05UE202-2006
155
C05UE202-2006
No. Description
1 Store 20 groups of payload data and comment
2 Set the mass of payload, unit: kilogram
3 Set the center position of the payload, unit: mm
4 Set the moment of inertia, unit: kg*mm^2
5 Payload estimation, it is executed in T2 mode
6 Enter the manual setting page
7 Set the desired group of payload
8 Save parameters of manual setting
9 Edit parameters of manual setting
10 Back to payload estimation page
156
C05UE202-2006
The first group of payload data is the tool at the end of the robot. After moving to
P2, gripping the object and it is changed to the second group of payload data,
which is the sum of the tool and the object.
157
C05UE202-2006
158
C05UE202-2006
1
B. Cylinder 2: I = 12
𝑚𝑚(3𝑅𝑅 2 + 𝐿𝐿2 )
1
C. Cuboid: I = 12
𝑚𝑚(𝑊𝑊 2 + 𝐷𝐷2 )
2
D. Sphere: I = 5
𝑚𝑚𝑅𝑅 2
159
C05UE202-2006
160
C05UE202-2006
161
C05UE202-2006
The size of the simplified model is shown in Figure 2; the mass of the connecting
plate (cuboid) is 2kg, the length, width, and height are 300, 100, and 40mm; the
mass of the gripper (cuboid) is 1kg, and the length, width, and height are
respectively 200, 50, 100mm; the mass of the object (cylinder) is 1kg, the
diameter is 120mm, and the height is 200mm. According to this parameter, the
load information can be calculated:
A. Mass
𝑚𝑚 = 𝑚𝑚1 + 𝑚𝑚2 + 𝑚𝑚3 = 2 + 1 + 1 = 4
B. The distance of centroid
Connecting plate (cuboid):
𝑋𝑋𝑐𝑐1 = 0
𝑌𝑌𝑐𝑐1 = 100
𝑍𝑍𝑐𝑐1 = 20
Gripper (cuboid):
𝑋𝑋𝑐𝑐2 = 25
𝑌𝑌𝑐𝑐2 = 150
𝑍𝑍𝑐𝑐2 = 40 + 50 = 90
The calculation:
𝑚𝑚1 𝑚𝑚2 𝑚𝑚3 2 1 1
𝑋𝑋𝑐𝑐 = 𝑋𝑋𝑐𝑐1 ∙ + 𝑋𝑋𝑐𝑐2 ∙ + 𝑋𝑋𝑐𝑐3 ∙ = 0 ∙ + 25 ∙ + 25 ∙ = 12.5
𝑚𝑚 𝑚𝑚 𝑚𝑚 4 4 4
𝑚𝑚1 𝑚𝑚2 𝑚𝑚3 2 1 1
𝑌𝑌𝑐𝑐 = 𝑌𝑌𝑐𝑐1 ∙ + 𝑌𝑌𝑐𝑐2 ∙ + 𝑌𝑌𝑐𝑐3 ∙ = 100 ∙ + 150 ∙ + 150 ∙ = 125
𝑚𝑚 𝑚𝑚 𝑚𝑚 4 4 4
𝑚𝑚1 𝑚𝑚2 𝑚𝑚3 2 1 1
𝑍𝑍𝑐𝑐 = 𝑍𝑍𝑐𝑐1 ∙ + 𝑍𝑍𝑐𝑐2 ∙ + 𝑍𝑍𝑐𝑐3 ∙ = 20 ∙ + 90 ∙ + 240 ∙ = 92.5
𝑚𝑚 𝑚𝑚 𝑚𝑚 4 4 4
1
𝐼𝐼𝑧𝑧𝑧𝑧1 = ∙ 2 ∙ (1002 + 3002 ) ≅ 16666
12
Gripper (cuboid):
1
𝐼𝐼𝑥𝑥𝑥𝑥2 = ∙ 1 ∙ (1002 + 2002 ) ≅ 4166
12
1
𝐼𝐼𝑦𝑦𝑦𝑦2 = ∙ 1 ∙ (1002 + 502 ) ≅ 1041
12
1
𝐼𝐼𝑧𝑧𝑧𝑧2 = ∙ 1 ∙ (502 + 2002 ) ≅ 3541
12
The calculation:
𝐼𝐼𝑥𝑥𝑥𝑥 = 𝐼𝐼𝑥𝑥𝑥𝑥1 + 𝑚𝑚1 ((𝑌𝑌𝑐𝑐 − 𝑌𝑌𝑐𝑐1 )2 + (𝑍𝑍𝑐𝑐 − 𝑍𝑍𝑐𝑐1 )2 ) +
𝐼𝐼𝑥𝑥𝑥𝑥2 + 𝑚𝑚2 ((𝑌𝑌𝑐𝑐 − 𝑌𝑌𝑐𝑐2 )2 + (𝑍𝑍𝑐𝑐 − 𝑍𝑍𝑐𝑐2 )2 ) +
𝐼𝐼𝑥𝑥𝑥𝑥3 + 𝑚𝑚3 ((𝑌𝑌𝑐𝑐 − 𝑌𝑌𝑐𝑐3 )2 + (𝑍𝑍𝑐𝑐 − 𝑍𝑍𝑐𝑐3 )2 )
≅ 15266 + 2�((125 − 100)2 + (92.5 − 20)2 )� +
4166 + 1�((125 − 150)2 + (92.5 − 90)2 )� +
4233 + 1�((125 − 150)2 + (92.5 − 240)2 )� ≅ 58442
𝐼𝐼𝑦𝑦𝑦𝑦 = 𝐼𝐼𝑦𝑦𝑦𝑦1 + 𝑚𝑚1 ((𝑋𝑋𝑐𝑐 − 𝑋𝑋𝑐𝑐1 )2 + (𝑍𝑍𝑐𝑐 − 𝑍𝑍𝑐𝑐1 )2 ) +
𝐼𝐼𝑦𝑦𝑦𝑦2 + 𝑚𝑚2 ((𝑋𝑋𝑐𝑐 − 𝑋𝑋𝑐𝑐2 )2 + (𝑍𝑍𝑐𝑐 − 𝑍𝑍𝑐𝑐2 )2 ) +
𝐼𝐼𝑦𝑦𝑦𝑦3 + 𝑚𝑚3 ((𝑋𝑋𝑐𝑐 − 𝑋𝑋𝑐𝑐3 )2 + (𝑍𝑍𝑐𝑐 − 𝑍𝑍𝑐𝑐3 )2 )
≅ 1933 + 2�((12.5 − 0)2 + (92.5 − 20)2 )� +
1041 + 1�((12.5 − 25)2 + (92.5 − 90)2 )� +
4233 + 1�((12.5 − 25)2 + (92.5 − 240)2 )� ≅ 40108
𝐼𝐼𝑧𝑧𝑧𝑧 = 𝐼𝐼𝑧𝑧𝑧𝑧1 + 𝑚𝑚1 ((𝑋𝑋𝑐𝑐 − 𝑋𝑋𝑐𝑐1 )2 + (𝑌𝑌𝑐𝑐 − 𝑌𝑌𝑐𝑐1 )2 ) +
𝐼𝐼𝑧𝑧𝑧𝑧2 + 𝑚𝑚2 ((𝑋𝑋𝑐𝑐 − 𝑋𝑋𝑐𝑐2 )2 + (𝑌𝑌𝑐𝑐 − 𝑌𝑌𝑐𝑐2 )2 ) +
𝐼𝐼𝑧𝑧𝑧𝑧3 + 𝑚𝑚3 ((𝑋𝑋𝑐𝑐 − 𝑋𝑋𝑐𝑐3 )2 + (𝑌𝑌𝑐𝑐 − 𝑌𝑌𝑐𝑐3 )2 )
≅ 16666 + 2�((12.5 − 0)2 + (125 − 100)2 )� +
3541 + 1�((12.5 − 25)2 + (125 − 150)2 )� +
163
C05UE202-2006
164
C05UE202-2006
The high and low limits of each axis and the high and low limits of the Cartesian
coordinates can be set in the software limit setting interface. The limit range of
the Cartesian coordinates is set according to the tool center position (TCP) of the
robot when the base is marked as 0 (Base 0). Choose whether to enable the limit
check for each axis or the Cartesian coordinate setting, and the setting user
interface is different according to different robot arms. The articulated robot can
set the high and low limits of the A1 ~ A6 axis on each axis limit, and the
Cartesian coordinate limit can be set The high and low limits of X, Y, and Z. The
SCARA robot can set the high and low limits of the A1 to A4 axes on the limits
of each axis. The limit of the Cartesian coordinate can also set the high and low
limits of X, Y, and Z. The parallel robot limits on each axis The high and low
limits of the A1 ~ A3 axis are set uniformly, and the A4 axis is set separately.
The limit of the Cartesian coordinate is to set the high and low limits of the
radius and the high and low limits of Z.
165
C05UE202-2006
166
C05UE202-2006
167
C05UE202-2006
No. Description
1 Enable/disable the soft limit function of joint
2 Set software limits for each axis
3 Enable/disable Cartesian coordinate soft limit function
4 Set the soft limit of each Cartesian coordinate
5 Save settings
168
C05UE202-2006
Operation Step
Main Menu>Start up>System Setting>Soft Limit
1. Set whether to enable the soft limit function of each axis
2. Set software limits for each axis
3. Save settings
4. Set whether to enable the Cartesian coordinate soft limit function
5. Set the soft limit of each Cartesian coordinate
6. Save settings
Operation steps
1. Connect to the official website of HIWIN (www.hiwin.tw).
On the web page select: PRODUCTS>Robot
.
169
C05UE202-2006
Robot Model
2. Find the model number of robot from the Industrial Robot area below, and
then click to enter.
Download documents
3. Select「Documents」from the above list.
4. Click the updated version of Download from below, and download to USB,
the path is placed under the HIWIN folder of root, insert into the USB port of
controller.
5. Select Main Menu>Help>Update.
6. A window will appear warning that the Robot will stop when updating
software. After pressing OK, software will start to update; to cancel update,
press CANCEL.
7. HRSS will reboot and complete update.
Before updating the software, please check current software version, for example:
HRSS 3.2.1.2673, please download version with same two number at the front, e.g.
HRSS 3.2.2.2775 or HRSS 3.2.4.2925. Do not download version that has two
different number at the front, e.g. HRSS 3.3.x.x to avoid incompatible.
170
C05UE202-2006
Operation Steps
1. Open main menu
2. Main Menu>Shutdown
171
C05UE202-2006
172
C05UE202-2006
3. Initial Settings
3.1. Check Parameters
Description
The correct robot program data must be loaded. During parameter check, the
loaded robot data must match with the data of the model plate.
If loading the new data is required, the status of the robot data must fully match
with the HRSS. This is to ensure that when the data is applied, it can be
submitted with the HRSS.
If the wrong data is loaded, the robot should not be operated! Failure to take these
measurements could lead to serious injury, death or equipment damage
Operation steps
Main Menu>Help>about
173
C05UE202-2006
174
C05UE202-2006
Overview
Each robot must be mastered. The robot can make Cartesian motion only after
being mastered and moved to the programmed position. The mechanical
position of the robot will be made consistent with the encoder during mastering.
The robot must be placed on a defined mechanical position, which is the
mastered position. The encoder value of each axis will be saved.
Situation Remark
Before commissioning ---
The value of motor position is lost after
---
maintenance such as replacement of a motor
If the robot moves without robot controller
---
instruction (for example, with a device release)
175
C05UE202-2006
Based on the model number, the position of the mastering marks could be
slightly different from the illustration. For origin calibration method and image,
please refer to the manual of each model.
Prerequisite
The “jog key” has been activated.
T1 mode
176
C05UE202-2006
Operation steps
1. Select the axis as the coordinate system for the jog keys.(Please refere to
Section 2.11.5)
2. Hold the Enabling Switch. The axis A1 to A6 will be dsiplayed beside the jog
keys.
3. Press the + or – button, so that the axis moves to the positive or negative
direction.
4. Start to jog from the axis A1, so that it can overlap with the mastering mark.
5. After mastering, click Main Menu>Start-up>Master>Zero Position.
6. Click Axis 1 in the list twice, a pop-up message of “Clear axis 1
position?”will appear.
7. Press OK to complete the setting of zero position for 1st - axis.
8. And so on for 2nd - axis to 6th - axis.
9. After completing the clearing, press Home button to confirm if the angle is
correct, if the position shown on the screen is different from the actual
position, please clear the position again.
When the simulated robot posture is located beyond the limit to cause motion
disabled, please execute [Zero Position] first.
1. Master first-axis
A mastering pin is used to attach the plate on the zero axis. The first-axis
velocity is reduced to the minimum velocity until the first axis is close to the
plate. First-axis mastering is completed, as shown below.
177
C05UE202-2006
3. Mastering third-axis
The third-axis velocity is reduced to the minimum velocity until the third-
axis mastering hole matches with the third-axis hole and a mastering rod can
be placed into position. The third-axis mastering is completed, as shown in
below.
4. Master fourth-axis
The fourth-axis velocity is reduced to the minimum velocity until the fourth-
axis mastering notch matches with the third-axis notch and a mastering key
can be placed into position. The fourth-axis mastering is completed. A screw
can be used to remove the mastering key from the notch after calibration, as
shown in below.
178
C05UE202-2006
Calibration
Calibration surface
179
C05UE202-2006
Prerequisite
Expert group
Operation steps
1. Manually release the robot brake.
2. Move the arm (Axis-1) to the top (lowest) side.
3. Use the hardware brake.
4. Select HightLimit or LowLimit, and click Axis 1 twice.
5. Appear “Clear axis 1 position?”
6. Press the OK button to clear the position.
7. Follow the previous procedures for second and third axis.
8. Once cleared, press the Home button to ensure the angle is correct. If the
position on the figure is different from the actual position, clear the position
again.
180
C05UE202-2006
When the simulated robot posture is located beyond the motion limit to cause
motion disabled, execute [Zero Position].
181
C05UE202-2006
Before operating this step, please pay attention to the following parts:
6-axis robot:
To calibrate sixth axis, please make sure fifth axis angle is zero and encoder
value is in the single turn, if it does not match, fifth axis must be calibrated first.
4-axis robot
To calibrate third axis, please make sure forth axis angle is zero and encoder
value is in the single turn, if it does not match, forth axis must be calibrated first.
182
C05UE202-2006
8. Select Axis 1.
9. Press Clear ABS Error.
10. After cleared, press the Home button to ensure the angle is correct. If the
position on the figure is different from the actual position, please clear the
encoder again.
If a workpiece has been installed on the mounting flange, the calibration described
here will not apply.
183
C05UE202-2006
3-point Method
Prerequisite
Install a calibrated tool on the mounting flange.
T1 mode
Operation steps
1. In the main menu select Start-up > Calibrate > Base.
2. In the pull-down menu, given a number and a name for base coordinate
system. Confirm with OK button.
3. Select a number for the base to be calibrated, and then press [Measure].
4. Give a name for the base to be calibrated.
5. Move TCP to the origin of new base coordinate. Click [Measure], and then
confirm by pressing the OK button.
6. Move TCP to a point on positive X axis of new base coordinate. Click
[Measure], and then confirm by pressing the OK button.
184
C05UE202-2006
The calibration method described here must not be used for a fixed tool.
185
C05UE202-2006
The 4 flange positions at the reference point must be sufficiently apart from one
another.
4-point method
Prerequisite
1.Install the tool to be calibrated on the mounting flange.
2.T1 mode
3. Select a fixed reference point position, it is recommended that this reference
point is a shape that is easy to recognize, for example: cuspidal point.
Operation steps
1. In the main menu select Start-up > Calibrate > Tool
2. Select a tool number from the pull-down menu for the tool to be measured,
and then press [Measure].
3. Give a name for the tool to be calibrated.
4. Use TCP to move to the configured reference point. Click [Measure], if the
position of reference point is to be confirmed, please use OK button for
confirmation, otherwise, use No or Cancel to cancel the operation.
5. Use TCP to replace another posture position of arm, move to the reference
point. Click [Measure], if the position of reference point is to be confirmed,
186
C05UE202-2006
187
C05UE202-2006
Prerequisite
Known X, Y, Z, A, B, C distance dimension as relative to the flange coordinate
system.
T1 mode
Operation steps
1. In the main menu select Start-up > Calibrate > Tool
2. Select a number for the tool to be measured in the pull-down menu.
3. Select the coordinate axis you want to enter, and then press [Set Value].
4. If it is the first time entering the value, then a name shall be given to the tool
to be measured.
5. Enter a value.
6. Press confirmation button after completion. The data displays the reference
point of new base coordinate system and is saved. The changed coordinate
system can also be observed from the 3D simulation window.
188
C05UE202-2006
Operation steps
1. In the main menu select Start-up > Calibrate > Base
2. A number and a name is given to the Base Coordinate System, and then
press the CONTINUE button to confirm.
3. Select a number for the base to be calibrated, and then press [Measure].
4. Give a name for the base to be calibrated.
5. Move TCP to the origin of new base coordinate. Click [Measure], and
confirm by pressing the OK button.
189
C05UE202-2006
Origin
A point on
positive X axis
Z
Y
X
190
C05UE202-2006
Prerequisite
X, Y, Z, A, B and C relative to the flange coordinate system is known
T1 mode
Operation steps
1. In the main menu Select Start-up > Calibrate > Base
2. Select a number for the base to be measured.
3. Select the coordinate you want to enter, and then press [Set Value].
4. Give a name for the base to be measured.
5. Enter the value.
6. Press the OK button after completed. The data will be saved.
The calibration method described here must not be used to a fixed tool.
191
C05UE202-2006
A, B, C:
The rotation of tool coordinate, relative to flange coordinate
X: X coordinate
Y: Y coordinate
Z: Z coordinate
A: Rotate along X coordinate
B: Rotate along Y coordinate
C: Rotate along Z coordinate
Flange coordinates
192
C05UE202-2006
The 3 flange positions at the reference point must be sufficiently apart from
one another.
Prerequisite
1.Install the tool to be calibrated on the mounting flange.
2.T1 mode
3.Select a fixed reference point position, it is recommended that this reference
point is a shape that is easy to recognize, for example: cuspidal point.
Operation steps
1. In the main menu select Start-up > Calibrate > Tool
2. Select a tool number from the pull-down menu for the tool to be measured,
and then press [Measure].
3. Give a name for the tool to be calibrated.
4. Use TCP to move to the configured reference point.
5. Click [Measure] to confirm the first calibration point, if the position of
reference point is to be confirmed, please use OK button for confirmation,
otherwise, use No or Cancel to cancel the operation.
6. Use TCP to replace another posture position of arm, move to the reference
point. Click [Measure] to confirm second point, if the position of reference
point is to be confirmed, please use OK button for confirmation, otherwise,
use No or Cancel to cancel the operation.
7. Repeat Step 6 to confirm third point.
8. Press confirmation button after completion. The data displays the reference
point of new tool coordinate system and is saved, the changed coordinate
system can also be observed from the 3D simulation window.
193
C05UE202-2006
Prerequisite
Known X, Y, Z, A, B and C relative to flange coordinate
T1 mode
Operation steps
1. In main menu select Start-up > Calibrate > Tool
2. Select a value for the tool to be measured.
3. Select the coordinate axis you want to enter, and then press [Set Value].
4. Give a name for the tool to be measured.
5. Enter a value.
6. Press the OK button after completed. The data will be saved.
194
C05UE202-2006
Calibration plate
The Image System needs to decide the origin of image coordinate, the ratio of
pixel length and the reading of conveyor encoder via the calibration plate (Figure
above).
Please ensure that there is a reading on the conveyor encoder before performing
the calibration.
Figure below is an illustration of picking. From the direction of the conveyor, the
upstream is before the robot, and the downstream is after the robot.
CAMERA ROBOT
LATCH
Conveyor
Upstream
Downstream
195
C05UE202-2006
196
C05UE202-2006
Upstream Downstream
Illustration to calibrate arm position
197
C05UE202-2006
198
C05UE202-2006
Configure IP
& Port Save Setting
199
C05UE202-2006
200
C05UE202-2006
Output Delay:Configure the D.O. time required to open when the arm is tracked
in place, use the positive/negative value to advance or delay. Range -1500~1500,
default value is -25.
Min Latch Cnt:Sensor triggers the filtering. Configure the minimum interval of
Latch. For example: if the difference between the previous object of Latch and
the current object of Latch is less than the setting of Count, the current object of
Latch will be ignored, default value is 0. Figure below shows 3 object on the
conveyor, when Min Latch Cnt is set as 25, Queue 2 will be ignored.
201
C05UE202-2006
202
C05UE202-2006
Prerequisite
T1 mode
Operation steps
1. Select Start-up>System Setting>Home Setting. (Figure below)
2. Use Jog to move to the user-defined origin position.
3. Press the Setting Home Point button after moving. (Figure below)
4. The ”Do you want to set new home point?” window appears.
5. Press the OK button to complete.
6. If you want to recover the initial setting, press the Default button.
7. The ”Do you want to recover default value?” window appears.
8. Press the OK button to complete.
1
2
Home Setting
203
C05UE202-2006
Prerequisite
T1 mode
Operation steps
1. Select Start-up>System Setting>Home Setting. (Figure below)
2. Click Warning Setting button (Figure below).
204
C05UE202-2006
3. In the Define allowable error value field, the tolerant error range of the first
axis to the sixth axis can be set. If the angle difference before shutdown and
after booting is greater than this setting value, the alarm will appear “Start
pos declination error.” Code 01-04-30.
4. In the Define the range of home position field, you can set the range of
angles that can remove the alarm. When the position check alarm appears,
you need to manually move back to the origin. If the final position is
located in this range, you can use Confirm Home Point to remove the
alarm.
5. Press the Save button to save the set value.
205
C05UE202-2006
206
C05UE202-2006
207
C05UE202-2006
4. Program Management
4.1. Document Navigator
Overview
Navigator
208
C05UE202-2006
No. Description
Content structure
1
When double click the folder, refresh the document list.
Document list
2
Display the program in the content structure
3 Click on No. 1 to display the folder operation
4 Click on No. 2 to display the program file operation
5 Add new program
6 Add new file
7 Delete program file
8 Delete folder
9 Open program
10 Operate program file
11 Copy folder
12 Rename program
13 Rename folder
14 Add the program to Functional I/O
Click on No. 10 to open this operation. Program file can be
15
“COPY”, “COPY TO” and “MOVE TO”.
209
C05UE202-2006
Overview
One program file can be added.
Operation Steps
1. Click on New File
2. Enter the name of the new file, make sure it meets the file name specification.
3. Press Ok to complete adding new program.
Overview
One program file can be copied.
Operation Steps
1. Click the program file from the program list.
2. Select the COPY from the operate file or COPY TO folder
3. If selected COPY, the current program in the folder will be copied.
4. If selected COPY TO, user can choose which folder to copy.
5. The name of the copied file is called “xxx_copy.hrb”, if the name is existed, the
rename window will appear. Please type in the name that has not been used and
make sure the file of the name meets the file name specification.
210
C05UE202-2006
Overview
Select or open a program. An editor and a program will be displayed, but not
the navigator.
Operation steps
1. Select the program in the navigator and press the Open button. That program
will be displayed on the editor.
2. Edit the program.
3. Close the program.
When bring external computer-edited program file is loaded into the controller,
the file cannot be opened if the file name does not meet the format of the file
name.
211
C05UE202-2006
Description
Program interface
No. Description
Cursor & highlighted line
1
The line is highlighted when a cursor is moved on it.
2 Cursor position
3 Program path and filename
4 Basic motion command
212
C05UE202-2006
213
C05UE202-2006
Line Description
8 LIN motion
14 PTP motion
If the first motion command is not a default home position or that position has changed,
one of the following commands must be used:
Complete PTP command
Complete LIN command
“Complete” represents all contents which must enter the target points.
If you change the home position, all programs will be affected and may cause the
injury and property loss.
If the home position is changed, all programs will be affected which could lead
to serious injury, death or equipment damage.
214
C05UE202-2006
The program will pause after each line. The unseen lines
Single step and empty lines are included. The Start button must be
pressed again for each line.
4.6.3. Pre-reading
Description
Pre-reading means that the controller will pre-read the program to calculate the
motion of the smooth track for example:
LIN P1 CONT
LIN P2 CONT
IF $DI[1] == TRUE THEN
LIN P3 CONT
ENDIF
During the execution of the program, if IF $DI[1] == TRUE the condition is true,
the controller will pre-read LIN P3 command. If you want to reach P2 before
condition is judged, please add WAIT SEC command on the next line of LIN P2.
With the command, the program will then judge the condition of $DI[1] after P2
is reached to decide whether execute LIN P3
215
C05UE202-2006
In T1, the maximum velocity is 250mm/s, nothing to do with the set value.
Operation steps
1. Open the velocity window.
2. Set the program ratio. The +/- button or scroll can be used to set.
3. Select the area outside the window. Close the window or apply the ratio.
Another method
The +/- button on the left side of Teach Pendant can be used to set the ratio.
Operation steps
1. Select Program Running.
2. Press the Enabling Switch until it displays the status bar “Driver ready”:
216
C05UE202-2006
Operation steps
1. Select program running.
2. Press the Start button.
3. The program starts to run.
4. To stop a program in automatic mode, press the Stop button.
Operation steps
1. Select “EXT”.
2. The program starts to activate from the higher-level control system (PLC).
In order to stop the program in EXT Auto Run, press the Stop button.
If a selected program is edited in the expert group, a cursor must be moved to another
line from the edited line after edited. This will ensure the contents are saved when
the program is closed.
217
C05UE202-2006
218
C05UE202-2006
Operation steps
1. Select the program lines to be deleted. It is not necessary to highlight the
program line. If a cursor is in the program line, it is ok. (No need to highlight
that program bar, only need the cursor in that program bar.)
2. Select menu Program>Delete.
219
C05UE202-2006
220
C05UE202-2006
Prerequisite
Connect a USB memory stick to the control system.
Operation steps
1. Main Menu>File>Save to USB.
2. Wait for the completion window, and close it.
3. Remove the USB memory stick when the LED indicator turns off.
Only load saved file data with the same model and same software version in the
robot program. If other files are loaded, the following results could appear:
1. Errored information
2. The robot controller will not run
3. Injury or property damage could occur
Prerequisite
Connect USB memory stick with files to the controller.
Operation steps
1. Main Menu>File>Load from USB, and then select the program you need.
2. Click Yes to answer the safety inquiry. The saved files will be recovered on
the control system.
3. Remove the USB memory stick when the LED indicator turns off.
4. Reboot the control system.
221
C05UE202-2006
Content
1. Only Arabic numerals (0-9), English letters (a-z, A-Z) and
underscore ( _ ) can be used for naming.
2. Special symbols「~!@#$%^&*()-+={}[]<>,.?/\|」 are not allowed.
3. The first character cannot be a number.
4. Not more than 100 words.
If the name of the program file does not correspond to the rules, follow situation
may occur when operating other function :
1. Unable to open the file
2. Unable to copy the file
3. Unable to be added to external startup functions list
4. Unable to use external subroutine functions
222
C05UE202-2006
PTP motion
LIN motion
223
C05UE202-2006
TCP at the start point of motion could be in an orientation different from the
target point. The orientation of TCP will gradually change during the motion.
When the TCP is at the start point of motion and in the same orientation as the
target point, the orientation of TCP will remain the same in the motion.
224
C05UE202-2006
5.5. Blend
Blend: Not accurately moved to the point programmed. The over blending is
another option that can be selected during the motion program.
PTP motion
The TCP will leave a track where it can accurately reach the target point, and
adopt the faster one. When over blending takes place in a PTP motion, the
track change cannot be foreseen. The point through which side on the track
cannot be forecasted.
225
C05UE202-2006
LIN motion
TCP will leave a track where it should accurately move to the target point, and
run on a shorter track. The region where the track path runs is not an arc.
CIRC motion
TCP will leave a track where it should accurately move to the target point, and
run on a shorter track. The auxiliary point can reach accurately. The region
where the track path runs is not an arc.
226
C05UE202-2006
For the overhead singular point, the wrist point (the middle point of axis A5) is
vertical to the axis A1.
The position of the axis A1 cannot be confirmed by the inverse conversion, and
it can be any value.
At this point, if the inverse motion is performed, an error will appear.
Extended position
For the singular point at the extended position, the wrist point (the middle point
of axis A5) is located in the extension of axis A2 and A3.
The robot is located at the edge of the workspace.
Although only one axis angle can be obtained by the inverse conversion, the
small Cartesian variation will cause the large velocity of the axis A2 and A3.
At this point, if the inverse motion is performed, an error will appear.
227
C05UE202-2006
Wrist axis
For the singular point of the wrist axis, the axis A4 is parallel with A6, and the
axis A5 is within the range ±0.1° .
The positions of two axes can't be confirmed by the inverse conversion.
Although the axis A4 and A6 can have many positions but the sum of the axis
angle is the same.
At this point, if the inverse motion is performed, an error will appear.
228
C05UE202-2006
Commands can be program without inline forms. The HRL (HIWIN robot language)
is used to program.
When motion is programmed, ensure the power supply will not wind or be
damaged when the program is run.
6.2.1.1. PTP
Prerequisite
Program selected
T1 mode
Operation steps
1. The TCP move should be configured as the target position.
2. Put the cursor behind, and insert on the line of the motion command.
3. Select Motion>PTP。
4. Change the relevant parameters.
5. Press the OK button.
Overview
229
C05UE202-2006
PTP interface
Operation steps
1. Put the cursor behind, and insert on the line of the motion command.
2. Input the command by keyboard.
Example:
E6POS POINT = {X 0,Y 300,Z 200}
PTP POINT CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
Example:
PTP {X 100} CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
Example:
PTP {A1 45} CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
(See the Appendix example at P342. For the description of CONT, please see
the Appendix at P338.)
Command flowchart
PTP&PTP_REL flowchart
230
C05UE202-2006
Operation steps
1. Put the cursor behind, and insert on the line of the motion command.
2. Input the command by keyboard.
Example:
PTP_REL {X 100} CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
Example:
PTP_REL {A1 45} CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
(See the Appendix example at P344. For the description of CONT, please see
the Appendix at P368.)
Command flowchart
Refer to PTP
When the motion is programming, it is sure the power supply will not wind or
damage when programming to run.
6.2.2.1. LIN
Prerequisite
Program selected
T1 mode
Operation steps
1. The TCP move should be configured as the target position.
2. Put the cursor behind, and insert on the line of the motion command.
3. Select Motion>LIN.
4. Change the relevant parameters.
5. Press the OK button.
231
C05UE202-2006
Overview
LIN interface
Operation steps
1. Put the cursor behind, and insert on the line of the motion command.
2. Input the command by keyboard.
Example:
E6POS POINT = {X 0,Y 300,Z 200}
LIN POINT CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
Example:
LIN {X 100} CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
Example:
LIN {A1 45} CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
(See the Appendix example at P344. For the description of CONT, please see
the Appendix at P368.)
Command flowchart
LIN&LIN_REL flowchart
232
C05UE202-2006
Operation steps
1. Put the cursor behind, and insert on the line of the motion command.
2. Input the command by keyboard.
Example:
LIN_REL {X 100} CONT=100% Vel=2000mm/s Acc=50% TOOL[0]
BASE[0]
Example:
LIN_REL {A1 45} CONT=100% Vel=2000mm/s Acc=50% TOOL[0]
BASE[0]
(See the Appendix example at P345. For the description of CONT, please see
the Appendix at P368.)
Command flowchart
Refer to LIN
Operation steps
1. Put the cursor behind, and insert on the line of the motion command.
2. Input the command by keyboard.
3. One axis can be rotated at a time
Example:
LIN_REL_TOOL {X 100} CONT=100% Vel=2000mm/s Acc=50%
TOOL[0] BASE[0]
233
C05UE202-2006
Example:
LIN_REL_TOOL {A 45} CONT=100% Vel=2000mm/s Acc=50% TOOL[0]
BASE[0]
(See the Appendix example at P346. For the description of CONT, please see
the Appendix at P368.)
When the motion is programming, it is sure the power supply will not wind
or damage when programming to run.
6.2.3.1. CIRC
Prerequisite
Program selected
T1 mode
Operation steps
1. The TCP move should be configured as the arc position.
2. Put the cursor behind, and insert on the line of the motion command.
3. Select Motion>CIRC.
4. Click [SET].
5. The TCP move should be configured as the target position.
6. Click [SET].
7. Click [FINSH].
8. Enter the Paramer interface to change the relevant parameters.
9. Press the OK button.
Overview
CIRC interface
234
C05UE202-2006
Operation steps
1. Put the cursor behind, and insert on the line of the motion command.
2. Input the command by keyboard.
Example:
E6POS POINT1 = {X 0,Y 300,Z 200}
E6POS POINT2= {X 20,Y 320,Z 220}
CIRC POINT1 POINT2 CONT=100% Vel=2000mm/s Acc=50% TOOL[0]
BASE[0]
Example:
CIRC {X 0, Y 450} {X -150, Y 300} CONT=100% Vel=2000mm/s
Acc=50% TOOL[0] BASE[0]
Example:
CIRC {A1 5.0, A2 5.0, A3 5.0, A4 5.0} {A1 10.0, A2 10.0, A3 10.0, A4
10.0,} CONT=100% Vel=2000mm/s Acc=50% TOOL[0] BASE[0]
(See the Appendix example at P347. For the description of CONT, please see
the Appendix at P368.)
Command flowchart
CIRC&CIRC_REL flowchart
235
C05UE202-2006
Operation steps
1. Put the cursor behind, and insert on the line of the motion command.
2. Input the command by keyboard.
Example:
CIRC_REL {X -150, Y 150} {X -150, Y -150} CONT=100%
Vel=2000mm/s Acc=50% TOOL[0] BASE[0]
Example:
CIRC_REL {A1 5.0, A2 5.0, A3 5.0, A4 5.0} {A1 10.0, A2 10.0, A3 10.0,
A4 10.0,} CONT=100% Vel=2000mm/s Acc=50% TOOL[0] BASE[0]
(See the Appendix example at P349. For the description of CONT, please see
the Appendix at P368.)
Command flowchart
Refer to CIRC
236
C05UE202-2006
When perform the motion programming, please assure that the power supply
system will not be wound or damaged while running the written progrm.
Operating Steps
1. Put the cursor behind, and insert on the line of the motion command.
2. Input the command by keyboard.
Example:
E6POINT P1 ={ X 95 , Y 0 , Z -500 }
E6POINT P2 ={ X 94.63849632 , Y 3.922008424 , Z -500 }
E6POINT P3 ={ X 93.55673654 , Y 7.814167995 , Z -500 }
…..
SPLINE
SPL P1
SPL P2
SPL P3
…..
ENDSPLINE
237
C05UE202-2006
6.3.1. REAL
Prerequisite
Program selected
T1 mode
Operation steps
1. Put a cursor behind, and insert on the line of the logic command.
2. Select Configure>Variable>REAL.
3. Set the parameters in the interface.
4. Save the command by pressing OK.
Overview
REAL interface
No. Description
1 Variable name
2 Initial value
Operation steps
1. Put the cursor behind, and insert on the line of the motion command.
2. Input the command by keyboard.
Example:
238
C05UE202-2006
INT Two = 2
(See the Appendix example at P338.)
Operation steps
1. Put the cursor behind, and insert on the line of the motion command.
2. Input the command by keyboard
Example:
BOOL K = TRUE
(See the Appendix example at P338.)
Operation steps
1. Put the cursor behind, and insert on the line of the motion command.
2. Input the command by keyboard.
Example:
CHAR COLOR = 'R'
(See the Appendix example at P339.)
239
C05UE202-2006
Operation steps
1. Put the cursor behind, and insert on the line of the motion command.
2. Input the command by keyboard.
Example:
STRING str = “HIWIN”
(See the Appendix Example at P381)
Operation steps
1. Put the cursor behind, and insert on the line of the motion command.
2. Input the command by keyboard.
Example:
E6POS POINT = {X 0,Y 300,Z 200}
PTP POINT CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
(See the Appendix example at P339. For the description of CONT, please see
the Appendix at P368.)
Operation steps
1. Put the cursor behind, and insert on the line of the motion command.
2. Input the command by keyboard.
Example:
E6AXIS POINT = {A1 90}
PTP POINT CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
240
C05UE202-2006
(See the Appendix example at P339. For the description of CONT, please see
the Appendix at P368.)
241
C05UE202-2006
Operation steps
1. Put the cursor behind, and insert on the line of the motion command.
2. Input the command by keyboard.
Example:
E6POINT HOME = {X 0,Y 200,Z -1000,A 90}
PTP HOME CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
(See the Appednix example at P339. For the description of CONT, plese see
the Appendix at P368.)
Tip: E6POINT does not have the definition of axis point, hence not able to directly set
the value of A1~A6.
Format
FRAME POINT_A
POINT_A.X = 0
POINT_A.Y = 1
POINT_A.A = 2
POINT_A.C = 3
Format Description
The variable type is the floating-point number, if there is no input, it will set to
the default 0.
242
C05UE202-2006
Operation steps
1. Put the cursor behind, and insert on the line of the variable command.
2. Select Configure>Variable>Counter.
3. Set the parameters in the interface.
4. Save the command by pressing OK.
Overview
COUNTER interface
243
C05UE202-2006
Operation steps
7. Put the cursor behind, and insert on the line of the variable command.
8. Select Configure>Variable>Timer.
9. Set the parameters in the interface.
10. Add “$T_STOP[n]=FALSE” on the previous line to start timing.
11. Add “$ T_STOP [n]=TURE” on the next line to end timing.
12. Save the command by pressing OK.
Overview
TIMER interface
244
C05UE202-2006
6.5.1. Input/Output
Digital Input/Output
The control system can manage up to 24 digital inputs and 24 digital outputs.
The configuration can set depending on the user requirements.
6.5.2. OUT
Prerequisite
Program selected
T1 mode
Operation steps
1. Put the cursor behind, and insert on the line of the logic command.
2. Select Configure> Output>Digital, or other IO output interface.
3. Set the parameters in the interface.
4. Save the command by pressing OK.
Overview
OUTPUT interface
6.5.3. WAIT
Prerequisite
Program selected
T1 mode
245
C05UE202-2006
Operation steps
1. Put the cursor behind, and insert on the line of the logic command.
2. Select Function> WAIT FOR.
3. Set the parameters in the interface.
4. Save the command by pressing OK.
Overview
Operation steps
1. Put the cursor behind, and insert on the line of the logic command.
2. Select Function> INPUT.
3. Set the parameters in the interface.
4. Save the command by pressing OK.
Overview
246
C05UE202-2006
Operation steps
1. Put the cursor behind, and insert on the line of the motion command.
2. Input the command by keyboard.
Example:
QUIT
6.6.1. IF
Prerequisite
Program selected
T1 mode
Operation steps
1. Put the cursor behind, and insert on the line of the logic command.
2. Select Function> IF ENDIF> Determination.
3. Set the parameters in the interface.
4. Save the command by pressing OK.
Overview
IF interface
247
C05UE202-2006
T1 mode
Keyboard connected
Operation steps
1. Put the cursor behind, and insert on the line of the motion command.
2. Input the command by keyboard.
Example:
FOR start TO last STEP increment
………………
ENDFOR
(see the Appendix example at P356)
Operation steps
1. Put a cursor behind, and insert on a line of the motion command.
2. Input the command by keyboard.
Example:
LOOP
………………
ENDLOOP
(see the Appendix example at P357)
6.6.4. WHILE
Prerequisite
Program selected
T1 mode
Operation steps
1. Put a cursor behind, and insert on a line of the logic command.
2. Select Function> WHILE ENDWHILE> Determination.
248
C05UE202-2006
WHILE interface
Operation steps
1. Put a cursor behind, and insert on a line of the motion command.
2. Input the command by keyboard.
Example:
REPEAT
………………
UNTIL condition
(See the Appendix example at P360)
Operation steps
1. Put a cursor behind, and insert on a line of the motion command.
2. Input the command by keyboard.
Example:
249
C05UE202-2006
IF condition THEN
GOTO LABEL 1
ENDIF
IF condition THEN
GOTO LABEL 2
ENDIF
IF condition THEN
GOTO LABEL 3
ENDIF
LABEL 1:
………………
LABEL 2:
………………
LABEL 3:
………………
(See the Appendix example at P361)
The label specified by the GOTO grammar must be in the current function, cross
functions cannot be applied.
Operation steps
1. Put a cursor behind, and insert on a line of the motion command.
2. Input the command by keyboard
Example:
SWITCH number
………………
CASE number1
………………
CASE number2
………………
250
C05UE202-2006
ENDSWITCH
(See the Appendix example at P363)
keyboard)
Premise
Program selected
T1 mode
Stl file putted in the stl folder
Operating Steps
1. Put a cursor behind, and insert on a line of the instruction command
2. Input the command by keyboard.
Example:
ADDTOOL File Name (no need to enter the extension)
Take ee.stl as an example
ADDTOOL ee
Attention: stl file will be in binary format, and the coordinate system of file will
be consistent with the end coordinate system of the flange surface. Currently the
file named with underscore ( _ ) or started with Upper/Lower case are all
acceptable.
251
C05UE202-2006
keyboard )
Premise
Program selected
T1 mode
Stl file putted in the stl folder
Operating Steps
1. Put a cursor behind, and insert on a line of the instruction command
2. Input the command by keyboard.
Exampe:
ADDOBJ File Nmae (no need to enter the extension) P: X, Y, Z, A, B, C C: R,
G, B
P: Displacement (mm) & rotation (degree) as relative to the robot origin
C: Color, RGB Value
Take table.stl as an example
ADDTOOL table P: 500 C:200
ADDTOOL table P: 500, 200 C: 200,50
Attention: stl file must be in binary format, and the coordinate system of file
must be consistent with the end coordinate system of flange surface. Currently
the file named with underscore ( _ ) or started with Upper/Lower case are all
acceptable.
keyboard)
Premise
252
C05UE202-2006
Program selected
T1 mode
Stl file putted in the stl folder
Operating Steps
1. Put a cursor behind, and insert on a line of the instruction command
2. Input the command by keyboard.
Example:
SHOW_OBJ File Name (no need to enter the extension) TRUE/FALSE
Take table.stl as an example
Show table.stl: SHOW_OBJ table TRUE
Hide table.stl: SHOW_OBJ table FALSE
Attention: stl file will be in binary format, and the coordinate system of file will
be consistent with the end coordinate system of the flange surface. Currently the
file named with underscore ( _ ) or started with Upper/Lower case are all
acceptable.
by keyboard)
Premise
Program selected
T1 mode
Operation Steps
1. Put a cursor behind, and insert on a line of the instruction command
2. Input the command by keyboard.
Example:
MOVEFLOOR 100 (moving distance)
253
C05UE202-2006
Operating Steps
1. Put a cursor behind, and insert on a line of the instruction command
2. Input the command by keyboard
Example:
AXISOFF
Operation steps
1. Put a cursor behind, and insert on a line of motion command
2. Input the command by keyboard.
Example:
STRUC LABEL INT PARAMETER1, REAL PARAMETER2
DECL LABEL PART1 ,PART2, ……. , …….
254
C05UE202-2006
Operation steps
1. Put a cursor behind, and insert on a line of motion command
2. Input the command by keyboard.
Example:
………………
LABEL
DEFFCT VOID LABEL
………………
ENDFCT
(See the example in the Appendix at P373)
255
C05UE202-2006
NOTE: It is possible to perform a manual test on this page to check if the connection
and transfer value are successful.
256
C05UE202-2006
Code Comment
Open communication
SER indicates the opened communication is
COPEN(SER,*NAME*)
RS232
Save the opened state to *NAME*
Read and save the data to *val*,
CREAD(*NAME*,*val*) When read mulitple data, it may use multiple
CREAD(*NAME*,*val1*,*val2*) variables *val1*, *val2*.., however, please
beaware that each
Code Comment
257
C05UE202-2006
e.q.2
Camera:
CREAD(*NAME*,*val*) send {100,200}
CREAD(*NAME*,*val1*,*val2*) Robot:
CREAD(*NAME*,*val1*,*val2*,*val3*)
val1 = 100 ; val2 = 200 ;val3 = 0
e.q.3
Camera:
send {100,200,45,50}
Robot:
CREAD(*NAME*,*val1*,*val2*,*val3*)
val1 = 100 ; val2 = 200 ; val3 = 45
Clear the data in the temporary storage
When the packet number is greater than the
CCLEAR(*NAME*) instruction number of CREAD, the old data
will be read, therefore, CCLEAR will be
added before or after the reading instruction.
Transfer the data in *val*
Multiple data *val1*, *val2*…can be sent at
one time
CWRITE(*NAME*,*val*) However, please be aware that val can only
CWRITE(*NAME*,*val1*,*val2*) be real type and unable to send text, plus
each CWRITE instruction is a set of packet.
e.q.1
Robot:
258
C05UE202-2006
CWRITE(*NAME*,100,200,45)
Camera:
read {100,200,45}
Code Comment
e.q.2
Robot:
CWRITE(*NAME*,*val*) CWRITE(*NAME*,100)
CWRITE(*NAME*,*val1*,*val2*) CWRITE(*NAME*,200,45)
Camera:
read {100}{200,45}
259
C05UE202-2006
260
C05UE202-2006
261
C05UE202-2006
e.q.2
Camera:
send {100,200}
CREAD(*NAME*,*val*)
Robot:
CREAD(*NAME*,*val1*,*val2*)
CREAD(*NAME*,*val1*,*val2*,*val3*)
e.q.3
Camera:
sned {100,200,45,50}
Robot:
CREAD(*NAME*,*val1*,*val2*,*val3*)
262
C05UE202-2006
Code Comment
e.q.1
Robot:
CWRITE(*NAME*,100,200,45)
Camera:
read{100,200,45}
CWRITE(*NAME*,*val*)
CWRITE(*NAME*,*val1*,*val2*) e.q.2
Robot:
CWRITE(*NAME*,100)
CWRITE(*NAME*,200,45)
Camera:
read {100}{45}
263
C05UE202-2006
6.11.1. CNV_START
Description:
Start conveyor procedures, and connect with the system. The command for
other conveyor can be executed after this command, used for the start of the
conveyor program.
Format:
CNV_START CNV=1
…
CNV_END CNV=1
Format description:
CNV is the parameter for the conveyor number, which can be input from 1 to 4.
6.11.2. CNV_END
Description:
End the conveyor and the connection with the system, used for the end of the
conveyor program.
Format:
CNV_START CNV=1
…
CNV_END CNV=1
Format description:
CNV is the parameter for the conveyor number, which can be input from 1 to 4.
6.11.3. CNV_PICK_QUANTITY
Description:
The variables for the conveyor are used to set the maximum quantity of the
object that the robot can pick every time. When the quantity reaches this value,
the following pick commands will not be executed.
264
C05UE202-2006
Format:
CNV_PICK_QUANTITY = 1
Format description:
The variable type is positive integer. The default is 1, which can be input from 1
to 8.
6.11.4. CNV_TRIGGER_TIMES[NUM]
Description:
This is a variable for the conveyor, used when the conveyor is set as a sensor
trigger. When the conveyor sensor is triggered, the robot will receive a task to
pick or place. This variable can be set to increase the speed of a task after the
sensor is triggered several times, require to specify a conveyor number, # as the
conveyor number.
Format:
CNV_TRIGGER_TIMES[NUM] = 1
Format description:
This variable type is positive integer from 1 to 100. If no quantity is assigned,
the default is 1. NUM is the number of the conveyor. Input can be from 1 to 4,
and represented by CNV1 to CNV4.
6.11.5. CNV_PICK
Description:
Pick the object. Automatically waits for messages from the system when the
command is given that it can pick the object. After a successful pick, the robot
will return to the height that the pick started from. If the pick fails, the robot will
return to the starting position.
Format:
265
C05UE202-2006
Command flowchart:
PICK flowchart
266
C05UE202-2006
Flowchart description:
# is the number.
CNV, OBJ, P, Vel and Acc can be omitted to input.
Please select either CONT, CONT = #%, CONT = #mm or FINE.
6.11.6. CNV_PLACE
Description:
The objects can be picked and placed or selected according to the object number
or O (chosen object); the object will return the safety height after successfully
placed. When the place fails, the conveyor will return to the starting position.
Format:
CNV_PLACE CNV=1 OBJ=1 $DO[1] P1 Down=5.000mm CONT=100%
Vel=2000mm/s Acc=50% TOOL[0] BASE[0]
Format description:
CNV is the parameter for the conveyor number. When it is necessary to track the
object, the CNV number will be entered. If the number is omitted, it will not
track. The input range is from 1 to 4.
OBJ is the object parameter, which can be used to assign the picked object
number. If it is omitted, the object number is not assigned. All objects are
placed. The input range is 1 to 8.
$DO[] is the parameter for the number O, which represents the position to
place the object in this time. If it is omitted, it will represent to place according
to the object number.
P is the position parameter, which represents the position to place the object.
Down is the height that pressed downwardly to pick the object. During
picking, the robot will stop a distance over the object and move downwardly.
This parameter is used to assign this distance, which should be positive integer
or 0.
FINE and CONT are the paramaters for the discontinuous and continuous
motion. The percentage behind the paramter is the smooth extent. For the
description of CONT, please see the Appendix at P368.
Vel is the velocity parameter. The defaut is 2000mm/s.
Acc is the acceleration parameter. The default is 100%.
267
C05UE202-2006
PLACE flowchart
Flowchart description
# is the number.
CNV, OBJ, P, Vel and Acc can be omitted to input.
Please select either CONT, CONT = #%, CONT = #mm or FINE.
6.11.7. CNV_OBJECT
Description:
The variable for picking represents the latest object number picked. After the
object is placed, the number will be automatically reset, which can be used to
determine the current object and perform the specific action.
(ATTENTION: CNV_OBJECT can be used only after CNV_PICK)
Format:
CNV_PICK CNV=1 $DO[1] P1 Down=5.000mm CONT=50% Vel=2000mm/s
Acc=50% TOOL[0] BASE[0]
IF CNV_OBJECT == 1 THEN
CNV_PLACE CNV=1 $DO[1] P3 Down=5.000mm CONT=100%
Vel=2000mm/s Acc=50% TOOL[0] BASE[0]
ENDIF
CNV_PLACE CNV=1 $DO[1] P2 Down=5.000mm CONT=100%
Vel=2000mm/s Acc=50% TOOL[0] BASE[0]
268
C05UE202-2006
Format description:
The variable type is integer, which can be used for WHILE or IF.
6.11.8. CNV_FULL
Description:
The Boolean variable for picking (For the description of Boolean, please see the
Appendix at P338) represents when the quantity of objects that have been
picked by the robot reaches the upper limit. When the picking quantity has
reached the value set by CNV_PICK_QUANTITY, this variable is TRUE; if the
quantity doesn’t reach the setting value, it will be FALSE.
Format:
CNV_PICK_QUANTITY = 2
WHILE CNV_FULL == FALSE
…
ENDWHILE
Format description:
The variable type is Boolean, which can be used for WHILE or IF.
6.11.9. CNV_EMPTY
Description:
The Boolean variable for picking (For the description of Boolean, please see the
Appendix at P380) represents the quantity of the objects that have been picked
by the robot. When no object is picked, this variable is TRUE; if one or more
object is picked, this variable is FALSE.
Format:
WHILE CNV_EMPTY == FALSE
…
ENDWHILE
Format description:
The variable type is Boolean, and can be used for WHILE or IF.
269
C05UE202-2006
6.11.10. CNV_SET_DELAY_TIME[NUM]
Description:
This parameter is used to set the delay time for the conveyor. By setting this
variable, the robot can continue to move with the object in the specific time and
leave after reaching the position to pick or place.
As shown in below, the robot will move with the object in 50ms and leave after
picking or placing.
Format:
CNV_SET_DELAY_TIME[NUM] = 50
Format description:
NUM is the number of the conveyor. Input can be from 1 to 4, and represented
by CNV1 to CNV4.
The variable type is positive integer. The default is 0, which can be input from 0
to 1500 with a unit of ms.
270
C05UE202-2006
6.11.11. CNV_QUEUE_SIZE[NUM]
Description:
This is the pick variable. This variable shows the sensor has been triggered on
the conveyor, but there is a quantity of object not picked.
As shown in below, the sensor for the Conveyor 2 has triggered three objects,
but the robot has not picked them. Therefore, this variable is 3.
Format:
IF CNV_QUEUE_SIZE[NUM] > 0 THEN
…
ENDIF
Format description:
NUM is the number of the conveyor. Input can be from 1 to 4, and represented
by CNV1 to CNV4.
The variable type is a positive integer, and can be used for WHILE or IF.
271
C05UE202-2006
Illustration of CNV_QUEUE_SIZE
6.11.12. CNV_OBJ_CNT_DIST[NUM]
Description:
This is the conveyor variable. When the variable CNV_QUEUE_SIZE[NUM] is
greater than or equal to 2 (Two or more objects on the conveyor have been
triggered.) can be used immediately.
This variable can display the difference between the position of the first object
and the second object triggered by the sensor from the difference in Encoder
value. It is usually used to determine if the triggered objects are continuous.
Format:
IF CNV_QUEUE_SIZE[NUM] > 1 THEN
IF CNV_OBJ_CNT_DIST[NUM] < 2600 THEN
…
ELSE
…
ENDIF
ENDIF
Format Description:
NUM is the number of the conveyor. Input can be from 1 to 4, and represented
by CNV1 to CNV4.
The variable type is positive integer, and can be used for WHILE or IF.
272
C05UE202-2006
6.11.13. CNV_PLACE_BATCH[NUM]
Description:
The place variable is used when many objects are placed in the same work
space.
When the senor that releases an object is triggered, the robot will obtain a
position where the object can be placed. The maximum number of times that the
robot can place an object in this position can be set by this variable.
Format:
CNV_PLACE_BATCH[NUM] = 1
Format Description:
The variable type is a positive integer. If no quantity is assigned, the default is
1. The input range is 1 to 100 and represented by CNV1 to CNV4.
6.11.14. CNV_RESET_ENC
Description:
Conveyor Tracking Instruction. The user can use this instruction to clear the
counting value of the external encoder when writing program.
The effect of using this instruction is same as the effect of pressing “CLEAR”
on the conveyor calibration interface. (Please refer to the description of P155).
Format:
CNV_RESET_ENC
Format Description:
No need to enter parameter.
6.11.15. CNV_QUEUE_REMOVE[NUM]
Description:
Flying pick/flying place state variable. The user is able to remove the temporary
value placed at the forefront of the waiting queue by using this instruction during
the process of writing the program.
273
C05UE202-2006
Format:
CNV_QUEUE_REMOVE[NUM]
Format Description:
NUM is the number of the conveyor. Input can be from 1 to 4, and represented
by CNV1 to CNV4.
6.11.16. CNV_PICK_ACC[NUM]
Description:
Flying pick state variable. The user is able to configure the acceleration time of
tracking push-down by using this instruction when writing program.
Format:
CNV_PICK_ACC[NUM]
Format Description:
NUM is the number of the conveyor. Input can be from 1 to 4, and represented
by CNV1 to CNV4. The default value is 30, range from 10 to 100.
6.11.17. CNV_OFFSET_X[NUM]
Description:
Flying pick/flying place state variable. The user is able to configure the offset
value of X by using this instruction when writing program.
Format:
CNV_OFFSET_X[NUM] = 10
Format Description:
NUM is the number of the conveyor. Input can be from 1 to 4, the offset value of
X is configured as 10mm.
274
C05UE202-2006
6.11.18. CNV_OFFSET_Y[NUM]
Description:
Flying pick/flying place state variable. The user is able to configure the offset
value of Y by using this instruction when writing program.
Format:
CNV_OFFSET_Y[NUM] = 10
Format Description:
NUM is the number of the conveyor. Input can be from 1 to 4, the offset value of
Y is configured as 10mm.
6.11.19. CNV_OFFSET_Z[NUM]
Description:
Flying pick/flying place state variable. The user is able to configure the offset
value of Z by using this instruction during the process of writing program.
Format:
CNV_OFFSET_Z[NUM] = 10
Format Description:
NUM is the number of the conveyor. Input can be from 1 to 4, the offset value of
Z is configured as 10mm.
275
C05UE202-2006
6.11.20. CNV_SPEED[NUM]
Description:
Conveyor state variable, user is able to read the current speed of conveyor.
Format:
INT ISpeed
ISpeed = CNV_SPEED[NUM]
Format Description:
NUM is the number of the conveyor. Input can be from 1 to 4, and represented
by CNV1 to CNV4.
Description
TCP can be output in motion. The command for START, END and PATH can
be used.
The delay time of START and END is ±1000 ms.
The range of PATH is ±2000 mm.
Attention: Due to the limit of software memory, it limits the count of SYN, the
maximum count is eight (8) counts, if the SYN instruction is entered over 8
counts before the motion instruction, Error Code 3010 will be pop-out:
SYNC_CMD_QUEUE_FULL_ERROR.
(See the Appendix example at P385)
Operation steps
1. Put a cursor behind, and insert on a line of the motion command.
2. Input the command by keyboard.
(See the Appendix example at P385)
276
C05UE202-2006
Operating Steps
1. Click the completed program in the program directory, press “Add to” and
then add the program to the list of RSR Program.
2. In the paging of I/O, click F.I. and F.O., it is possible to observe the
execution of the program triggered by exterior source.
3. When Enable of F.I. is “On”, and if RSR1~RSR4 are “On”, it is possible to
enable the corresponding RSR Program, and execute that program.
4. ACK1~ACK4 of F.O. will be able to output the signal corresponded to F.I.
5. Double click on the column of RSR Program, it will be able to delete the
program from the list.
Period Chart
1. When two RSR signal is detected simultaneously, execute the one with
the lowest number, from the period chart, RSR2 and RSR3 appeared
simultaneously, RSR2 will be executed while RSR3 will be ignored.
2. During execution of RSR, when other RSR signal is detected, they will
be ignored, from period chart, RSR4 is detected when RSR2 is being
executed, and thus it is ignored.
277
C05UE202-2006
278
C05UE202-2006
279
C05UE202-2006
Operating Steps
1. Select Start-up>System Setting>Ref. Position
2. Click “Edit”, check Enable and configure DO, and then press “Save” for
saving the setting.
3. Move the arm to the position to be configured as the check point.
4. Press “Save point” button, save the Point column with the new value.
5. Click twice on the table, it enables the tolerance range of each axis
(Tolerance) to be edited.
280
C05UE202-2006
281
C05UE202-2006
Operating Steps
1. Select Start-up>System Setting>DIO Setting.
2. Select the specific D.I. from the Clear Error option, it will enable to use as
the functional signal of clearing error through the configured D.I.
3. If Disable is selected, it indicates that this function is disabled.
4. Press Save to save the setting.
282
C05UE202-2006
Operating Steps
1. Select Start-up>System Setting>DIO Setting
2. Select the specific D.I. from the External Alarm option, it will enable to
use as the functional signal of external alarm through the configured D.I.
3. If Disable is selected, it indicates that this function is disabled.
4. Set the word to be appeared in Show Text when the alarm is triggered.
5. Press Save to save the setting.
Operation Steps
1. Select Start-up>System Setting>DIO Setting.
2. Select the specific D.I. from the System Shutdown option, it will enable to
use as the functional signal of system shutdown through the configured D.I.
3. If Disable is selected, it indicates that this function is disabled.
4. Press Save to save the setting.
283
C05UE202-2006
Operating Steps
1. Select Start-up>System Setting>DIO Setting.
2. Select the specific D.O. from the Motor Warning option, it will enable to
use as the functional signal of motor warning through the configured D.O.
3. If Disable is selected, it indicates that this function is disabled.
284
C05UE202-2006
Operating Steps
1. Select Start-up>System Setting>DIO Setting.
2. Select the specific D.O. from the System Start Up option, it will enable to
use as the functional signal of starting up through the configured D.O.
3. If Disable is selected, it indicates that this function is disabled.
Operating Steps
1. Select Start-up>System Setting>DIO Setting.
2. Select the specific D.O. from the Mode Output option, it will enable to use
as the functional signal of selected manual/auto mode through the
configured D.O.
Select T1/T2 mode, D.O. is OFF;AUT/EXT mode, D.O. is ON.
3. If Disable is selected, it indicates that this function is disabled.
keyboard)
Prerequisite
Program selected
T1 mode
Keyboard connected
6.17.1. SET_OVERRIDE_SPEED
Description
Use this instruction in the program to change the program override during
movement.
285
C05UE202-2006
Format
SET_OVERRIDE_SPEED 100
Format Description
The variable type is a positive integer, the allowable range is from 1 to 100 and
can not be 0.
Format
SET_ SPEED 2000
Format Description
The variable type is a positive integer that can not be 0, different model has a
different default.
286
C05UE202-2006
Format
SET_ ACC 250
Format Description
The variable type is the positive integer which cannot be 0.
Format
SET_ ROTATION_SPEED 100
Format Description
The variable type is the positive integer which cannot be 0.
6.17.5. SET_TOOL
Description
Use this instruction in the program to allow the arm to select the specified
number of TOOL setting, or change the setting of current parameters of TOOL.
Format
FRAME T_ONE
287
C05UE202-2006
T_ONE.X = 100
SET_TOOL 1
SET_TOOL T_ONE
Format Description
SET_TOOL supports the input of a positive integer and 2 types of parameter for
FRAME.
The allow the range of positive integer from 0 to 15, if the positive integer is
entered, it will set the arm to select specified number of Tool setting, the Tool
number on the upper right corner will also be changed.
If FRAME is entered, it will change the currently selected Tool setting parameter
to the value of FRAME. (Please refer to P199 for the using example of FRAME.)
6.17.6. SET_BASE
Description
Use this instruction in the program to allow the arm to select the specified
number of BASE setting, or change the setting of current parameters of BASE.
Format
FRAME B_ONE
B_ONE.Y = 100
SET_BASE 1
SET_BASE B_ONE
Format Description
SET_BASE supports the input of a positive integer and 2 types of parameter for
FRAME.
The allow the range of positive integer from 0 to 31, if a positive integer is
entered, it will set the arm to select speified number of Base setting, the Base
number on the upper right corner will also be changed.
If FRAME is entered, it will change the currently selected Base setting parameter
to the value of FRAME. (Please refer to P199 for the using example of FRAME.)
6.17.7. TRUE_PATH
Description
288
C05UE202-2006
Configure this parameter to select in the program if the accurate moving mode is
enabled.
If the accurate moving mode is enabled, it will enhance the absolute accuracy
during arm movement, however, if excessive moving speed is configured under
the accurate moving mode, it may cause the arm to produce abnormal sound.
Format
TRUE_PATH = TRUE
Format Description
The variable type is Boolean, if this variable is not configured, the default is
FALSE.
289
C05UE202-2006
6.17.8. GETPOINT
Description
Acquire the coordinate value and angle value of current position.
Format
E6POINT E6TEST
E6TEST = GETPOINT
Format Description
E6TEST acquires the coordinate value and angle value of current position.
6.17.9. GET_MOTION_STATUS
Description
Acquire the current motion status.
Format
INT Istatus
Istatus = GET_MOTION_STATUS
Format Description
Istatus acquires the value of current motion status.
0 is the idle status, 1 is the running status, 2 is the hold status.
6.17.10. BRAKE
Description
Stop and clear the motion command which contained motion queue command.
Format
LIN P1
LINP2
…
BRAKE
Format Description
When executed to BRAKE, the motion will stop.
290
C05UE202-2006
Format
EXT_TCP_START
LIN P1
LINP2
…
EXT_TCP_END
Format Description
The motion command between EXT_TCP_START and EXT_TCP_END will
move as external tool point.
6.17.12. CHECK_LIN
Description
The manipulator may move to the singular point in addition to the PTP command
during the movement. At this time, the manipulator will trigger the alarm to stop
the manipulator. This command can be checked whether the singular point
occurs between two points in advance, and perform different motion design to
avoid moving to singular point and stop in the midway, this increase the
efficiency of use.
Format
IF CHECK_LIN(P1,P2) == FALSE THEN
LIN P1
LIN P2
ENDIF
Format Description
Using CHECK_LIN command to determine that P1 and P2 will not be singular,
then execute the movement of LIN P1 and LIN P2.
291
C05UE202-2006
292
C05UE202-2006
Example 2:
E6POS A = {X 10 ,Y 10 ,Z 10 ,A 10 ,B 10 ,C 10}
E6AXIS B = {A1 20 , A2 20 , A3 20 , A4 50 ,A5 10 , A6 20}
E6POINT C = { X 5 ,Y 15 ,Z 25 ,A 35 ,B 45 ,C 55}
$PR[1] = A
$PR[2] = B
$PR[3] = C
Example 3:
$PR [1] = GETPOINT
Attention: TYPE of two PR used by CIRC and CIRC_REL must be the same
(same DEG or same POS).
293
C05UE202-2006
Operating Steps
1. Select Main menu > Start-up > System Setting > User Alarm Setting
2. Click twice on the column of Message, and then edit the alarm text content
of that column.
Format
USER_ALARM [n]
Format Description
The variable type is a positive integer, from 1 to 10 and cannot be 0.
294
C05UE202-2006
295
C05UE202-2006
Format
EG_OPEN(Type)
Format Description
Type will be representing the model of the XEG series electric gripper, the
code for each model will be represented below:
6.20.1.2. EG_CLOSE
Description
Close the connection for current XEG electric gripper. Can be used to close
the current electric gripper and switch on connection for other model of
XEG electric gripper.
Format
EG_CLOSE
296
C05UE202-2006
Format Description
No other parameters
6.20.1.3. EG_RESET
Description
Execute reset for XEG series electric gripper. After the connection with
electric gripper is completed, the reset has to be performed to ensure that
each control parameters are read and write.
Format
EG_RESET
Format Description
No other parameters
6.20.1.4. EG_GET_STATUS
Description
Obtain the status of XEG series electric gripper, each status code are as followed:
Code Status of Electric Gripper
0 Idle Ready
1 In action Busy
2 Grip Hold
-1 Abnormal Alarm 1
position
-2 Over trip Alarm 2
-3 Unusual origin Alarm 3
return
Format
IF EG_GET_STATUS == 2 THEN
…
ENDIF
297
C05UE202-2006
Format Description
Using IF condition to determine the status of XEG series electric gripper in
order to execute different operation.
Format
EG_RUN_MOVE(MovPos, MovSpeed)
Format Description
- MovPost Moving electric gripper to the specified position, minimum unit
0.01mm.
- MovSpeed Movement speed of the electric gripper, minimum unit 1mm/s.
Setting range for each electric gripper as followed:
Model of Electric MovPos MovSpeed
Gripper
XEG-16 0~16 (mm) 0~60 (mm/s)
XEG-32 0~32 (mm) 0~80 (mm/s)
XEG-64 0~64 (mm) 0~100 (mm/s)
GriForce)
Description
Execute the gripping movement of XEG series electric gripper. According to the
direction, displacement, speed and force of gripping set by the user to control the
electric gripper for operating gripping action (relative coordinates).
Format
EG_RUN_GRIP(Dir, Str, GriSpeed ,GriForce)
298
C05UE202-2006
Format Description
- Dir Electric gripper moving direction, C represent moving inwards, O represent
moving outwards.
- Str Displacement of the grip, minimum unit as 1mm;
(XEG-16 range(0~16mm)、XEG-32 range(0~32mm)、XEG-64range(0~64mm))
- GriSpeed Speed of the grip, L represent Low, M represent Medium, H represent
High
- GriForce Force of the grip, L represent Low, M represent Medium, H represent
High
Format
EG_RUN_EXPERT(Dir, MovStr ,MovSpeed,GriStr,GriSpeed,GriForce)
Format Description
- Dir Electric gripper moving direction, C represent moving inwards, O represent
moving outwards.
- MovStr Movement displacement, minimum unit 0.01mm.
- MovSpeed Movement speed, minimum unit 1mm/s.
- GriStr Displacement of the grip, minimum unit 1mm/s
- GriSpeed Speed of the grip, minimum unit 1mm/s
- GriForceForce of the grip, minimum unit 5%
299
C05UE202-2006
6.20.1.8. EG_GET_POS
Description
Obtain the position of XEG series electric gripper, minimum unit 0.01mm. Used
to confirm whether the electric gripper has moved to the specified position or
within a range, as one of the basis of object recognition.
Format
IF EG_GET_POS > 5.00 AND EG_GET_POS < 7.00 THEN
…
ENDIF
Format Description
Using IF condition to determine the position of XEG series electric gripper in
order to execute different operation.
300
C05UE202-2006
6.21.1. CT_A6
Description
Execute the infinite rotation of the sixth axis of the robot, this command must be
used with Keypro.
Format
CT_A6 velocity_ratio
Format Description
velocity_ratio is the ratio of infinite rotation speed, the input range is -100 to 100,
the sign indicates the direction of rotation, and the input 0 stops the infinite
rotation.
301
C05UE202-2006
6.22.2. STRCMP
Description:
Compare two strings. If two strings are the same, return true. If two strings are
not the same, return false.
Format:
BOOL STRCMP(STRING str1, STRING str2)
Format Description:
Parameter:STRING Return: BOOL
Example:
STRING str1 = “abcd”
STRING str2 = “abcd”
BOOL flag
flag = STRCMP (str1, str2)
;flag == true
6.22.3. STRPOS
Description:
Search str2 in str1 and return the pos which is found in str1.
302
C05UE202-2006
Format:
INT STRPOS (STRING str1, STRING str2)
Format Description:
Parameter:STRING Return: INT
Example:
flag = COMPARE(str1, str2) STRING str1 = abcde
STRING str2 = cd
INT pos
pos = STRPOS (str1,str2)
;pos == 3
pos = STRPOS (str,”ac”)
;pos == 0
6.22.4. STRCPY
Description:
Copy string with specific pos and length from source string and save to
destination string.
Format:
VOID STRCPY (STRING dst, STRING source, INT pos, INT length)
Format Description:
Parameter:STRING, INT
Example:
STRING str1 = “aaaaaaa”
STRING str2 = “abcdefg”
STRCPY (str1,str2,2,3)
;str1 == “bcd”
6.22.5. STRLEN
Description:
Return length of string
Format:
INT STRLEN (STRING str)
Format Description:
Parameter:STRING Return: INT
Example:
303
C05UE202-2006
6.22.6. INTTOSTR
Description:
Return result which is string casted from integer value.
Format:
STRING INTTOSTR(INT num)
Format Description:
Parameter: INT Return: STRING
Example:
INT num = 5
STRING str
str = INTTOSTR(num)
;str == 5
6.22.7. REALTOSTR
Description:
Return result which is string casted from floating point value.
Format:
STRING REALTOSTR(REAL num)
Format Description:
Parameter: REAL Return: STRING
Example:
REAL num = 5.5
STRING str
str = REALTOSTR(num)
;str == 5.5
6.22.8. STRTOINT
Description:
Return result which is INT casted from string.
304
C05UE202-2006
Format:
INT STRTOINT(STRING str)
Format Description:
Parameter:STRING Return:INT
Example:
STRING str = “20”
INT num
num = STRTOINT(str)
;num == 20
6.22.9. STRTOREAL
Description:
Return result which is REAL casted from string.
Format:
REAL STRTOREAL(STRING str)
Format Description:
Parameter:STRING Return: REAL
Example:
STRING str = “130.600”
REAL num
num = STRTOREAL(str)
;num == 130.600
6.23. Interrupt
6.23.1. Declaration
Description:
Declare priority, trigger event, and subprogram of interrupt
Format:
INTERRUPT Priority WHEN Event DO Subprogram
Format Description:
Priority: INT 1~8 represent the priority of interrupt. 1 is the highest priority.
Event: DI as an input signal to trigger interrupt ex. $DI[1] == true
Subprogram: the activity when interrupt is triggered.
Example:
INTERRUPT 1 WHEN $DI[1] == TRUE DO PRO_1()
305
C05UE202-2006
Description:
Support INT、REAL、CHAR、E6POS、E6POINT、E6AXIS data type to use
array
Format:
Type Name[num1] ; 1 dimension array
Type Name[num1,num2] ; 2 dimension array
Type Name[num1,num2,num3] ; 3 dimension array
Format Description:
Type: INT、REAL、CHAR、E6POS、E6POINT、E6AXIS
Name: name of variable
num: quantity of the elements
Example:
INT i1DArr[10]
INT i2DArr[10,10]
INT i3DArr[10,10,10]
REAL rArr[10,10,10]
CHAR cArr[10,10,10]
E6POS PosArr[10,10,10]
E6POINT PointArr[10,10,10]
E6AXIS AXISArr[10,10,10]
307
C05UE202-2006
PROG1(ARRAY_IN, ARRAY_OUT)
Format:
EX_AX[AXIS_NUM] = TRUE
Format Description
AXIS_NUM is the external axis number, the range is 1 ~ 3
308
C05UE202-2006
6.25.2. EX_AX_ASYNC
Description:
Set the external axis to be a synchronous axis or an asynchronous axis. You can
use this command to switch the motion mode of the external axis to perform
synchronous or asynchronous related control.
Format:
EX_AX_ASYNC[AXIS_NUM] = TRUE
Format Description
AXIS_NUM is the external axis number, the range is 1 ~ 3
6.25.3. EX_AX_SYNC_COUPLE
Description:
When the external axis is set as the synchronous axis and the calibration has been
completed correctly, you can use this command to open/close the coupled control
function of the external axis.
Format:
EX_AX_SYNC_COUPLE[AXIS_NUM] = TRUE
Format Description
AXIS_NUM is the external axis number, the range is 1 ~ 3
6.25.4. EX_AX_SET_ACC
Description:
Set the acceleration and deceleration time of the external axis, you can use this
command to modify the acceleration and deceleration of the specified external
axis.
Format:
EX_AX_SET_ACC[AXIS_NUM] 100
309
C05UE202-2006
Format Description
AXIS_NUM is the external axis number, the range is 1 ~ 3
6.25.5. EX_AX_SET_SPEED
Description:
Set the speed of the specified external axis, the linear axis unit is mm / sec, and
the rotary axis unit is deg / sec
Format:
EX_AX_SET_SPEED[AXIS_NUM] 100
Format Description
AXIS_NUM is the external axis number, the range is 1 ~ 3
6.25.6. EX_AX_CT
Description:
Perform the infinite rotation of the external axis at the specified infinite rotation
speed of the external axis (the external infinite rotation function must be enabled
first).
Format:
EX_AX_CT[AXIS_NUM] VEL_RATIO
Format Description
AXIS_NUM is the external axis number, the range is 1 ~ 3.
VEL_RATIO is the infinite rotation speed ratio, the range is -100 ~ 100, the sign
indicates the direction of rotation, enter 0 to stop the infinite rotation.
310
C05UE202-2006
6.25.7. ASYPTP
Description:
When the external axis is set as an asynchronous axis, you can use this command
to control it execute point-to-point motion.
Format:
ASYPTP{E1 60} CONT=100% Vel=100% Acc=50%
ASYPTP{E1 60, E2 100} CONT=100% Vel=100% Acc=50%
Format Description
ASYPTP can input the position of E1 ~ E3, and set its smoothing, speed and
acceleration and deceleration settings.
6.25.8. PTP
Description:
When the external axis is set as an asynchronous axis, you can use this command
to control it execute point-to-point motion.
Format:
E6POINT P1{A1 50, E1 60}
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0]BASE[0]
PTP{A1 40, E1 50} CONT=100% Vel=100% Acc=50% TOOL[0]BASE[0]
PTP{X 100, E1 50} CONT=100% Vel=100% Acc=50% TOOL[0]BASE[0]
Format Description
PTP instruction can increase the position of input E1 ~ E3.
6.25.9. LIN
Description:
When the external axis is set as a synchronous axis, this command can be used to
control the synchronous linear motion of the robot and the external axis.
Format:
E6POINT P1{A1 50, E1 60}
311
C05UE202-2006
Format Description
LIN instruction can increase the position of input E1 ~ E3.
6.25.10. CIRC
Description:
When the external axis is set as the synchronous axis, this command can be used
to control the synchronous arc motion of the robot and the external axis.
Format:
E6POINT P1{A1 50, E1 60}
E6POINT P2{X 100, E1 0}
CIRC P1 P2 CONT=100% Vel=2000mm/s Acc=50% TOOL[0]BASE[0]
CIRC{A1 50, E1 60} {X 100, E1 0}CONT=100% Vel=2000mm/s Acc=50%
TOOL[0]BASE[0]
CIRC{A1 50, E1 60} {X 100, E1 0} CONT=100% Vel=2000mm/s Acc=50%
TOOL[0]BASE[0]
Format Description
CIRC instruction can increase the position of input E1 ~ E3.
Format:
WELD_START WP = procedure number WS= schedule number
312
C05UE202-2006
Format Description
procedure number is the set welding procedure number, the range is 1 ~ 20
schedule number is the set welding condition number, the range is 1 ~ 32
6.26.2. WELD_END
Description:
Welding end instruction, according to the specified welding procedures and
conditions for crater processing and end welding.
Format:
WELD_END WP = procedure number WS= schedule number
Format Description
procedure number is the set welding procedure number, the range is 1 ~ 20
schedule number is the set welding condition number, the range is 1 ~ 32
6.26.3. WEAVE
Description:
According to the pre-set weaving conditions or directly specify the frequency,
amplitude, left stop and right stop conditions when executing weaving, the
command to start the weaving in the specified mode, the remaining settings will
be based on the settings of the pendulum welding setting interface.
Format:
WEAVE pattern WS = schedule number
WEAVE pattern Freq = frequency Hz Amp= amplitude mm LD = left dwell sec
RD= right dwell sec
Format Description
pattern is the weaving mode, you can input SINE, CIRCLE and L
schedule number is the number of the weaving condition, the range is 1 ~ 10
frequency is the weaving frequency
amplitude is the amplitude of weaving
left dwell is the left dwell time
313
C05UE202-2006
6.26.4. WEAVE_END
Description:
End the current weaving motion.
Format:
WEAVE_END
Format Description
No parameters
7. Error Message
The error message with * symbol, on behalf of this error does not stop robot.
314
C05UE202-2006
315
C05UE202-2006
316
C05UE202-2006
317
C05UE202-2006
Conveyor 4
01-01-53
encoder initial fail
External parameter
01-01-54
initial fail
01-01-55 HRSS Loading fail
1. Please confirm
whether the data
is stored
1. The
correctly, and
HRSS is
avoid turning off
not turned
the HRSS in the
off
same way (the
properly,
HRSS is not
and the
turned off when
HRSS is
the program is
not turned
stopped, or the
HRSS last off when
HRSS last main power is
01-01-57 shutdown the
shutdown error turned off instead
abnormality program is
of turning off the
stopped.
controller power).
2. Directly
2. If the program
cut off the
has stopped and
main power
the main power is
instead of
not cut off
turning off
directly, please
the
contact the
controller.
engineer to check
and repair the
controller.
FBWF
FBWF
FBWF memory anti-write
memory User needs to
01-01-58 consumption memory is
consumption reboot
128MB full to 128
128MB
MB
FBWF memory FBWF
FBWF User needs to
01-01-59 consumption anti-write
memory reboot
512MB memory is
318
C05UE202-2006
319
C05UE202-2006
Axis 3 exceeded
Axis 3 following
01-03-12 position over deviation
error too big
deviation
Axis 4
Axis 4 following
01-03-13 position over
error too big
deviation
Axis 5
Axis 5 following
01-03-14 position over
error too big
deviation
Axis 6
Axis 6 following
01-03-15 position over
error too big
deviation
Axis 1 Motion to
Axis 1 position
exceeded Axis 1 reach Axis 1 move
01-03-16 overlimit of
positive positive negative
positive
rotation limit limit
Axis 1 Motion to
Axis 1 position
exceeded Axis 1 reach Axis 1 move
01-03-17 overlimit of
negative negative positive
negative
rotation limit limit
Axis 2 Motion to
Axis 2 position
exceeded Axis 2 reach Axis 2 move
01-03-18 overlimit of
positive positive negative
positive
rotation limit limit
Axis 2 Motion to
Axis 2 position
exceeded Axis 2 reach Axis 2 move
01-03-19 overlimit of
negative negative positive
negative
rotation limit limit
Axis 3 Motion to
Axis 3 position
exceeded Axis 3 reach Axis 3 move
01-03-1A overlimit of
positive positive negative
positive
rotation limit limit
Axis 3 Motion to
Axis 3 position
exceeded Axis 3 reach Axis 3 move
01-03-1B overlimit of
negative negative positive
negative
rotation limit limit
320
C05UE202-2006
Axis 4 Motion to
Axis 4 position
exceeded Axis 4 reach Axis 4 move
01-03-1C overlimit of
positive positive negative
positive
rotation limit limit
Axis 4 Motion to
Axis 4 position
exceeded Axis 4 reach Axis 4 move
01-03-1D overlimit of
negative negative positive
negative
rotation limit limit
Axis 5 Motion to
Axis 5 position
exceeded Axis 5 reach Axis 5 move
01-03-1E overlimit of
positive positive negative
positive
rotation limit limit
Axis 5 Motion to
Axis 5 position
exceeded Axis 5 reach Axis 5 move
01-03-1F overlimit of
negative negative positive
negative
rotation limit limit
Axis 6 Motion to
Axis 6 position
exceeded Axis 6 reach Axis 6 move
01-03-20 overlimit of
positive positive negative
positive
rotation limit limit
Axis 6 Motion to
Axis 6 position
exceeded Axis 6 reach Axis 6 move
01-03-21 overlimit of
negative negative positive
negative
rotation limit limit
321
C05UE202-2006
determine a
shaft speed
too fast.
Near wrist Near wrist
01-03-32 Wrist singularity
singular point singular point
Near Near Try to avoid the
Shoulder
01-03-33 shoulder shoulder singular point
singularity
singular point singular point of motion
Near elbow Near elbow
01-03-34 Elbow singularity
singular point singular point
Circle command 3 Circle
01-03-40 reference points on command on
the same line the same line
Unable to
calculate
Circle comm can't
01-03-41 center of
found center point
circle in two
Command Check CIRC
point space
setting error. description.
Circle
command
Circle comm can't parameter
01-03-42 calculate transpose error, unable
matrix to calculate
transpose
matrix
Synchronize
1. Please check
Synchronize output
if the
output command too connecting line
Synchronize output
01-03-50 command much, is correctly
queue overflow
buffer causing connected, and
overflow buffer turn off the
power and then
overflow
re-start.
Synchronize Synchronize 2. Please
output activate contact
Synchronize output
01-03-51 control output engineer from
overlimit
command command too the original
overlimit much
322
C05UE202-2006
equipment
manufacturer.
Motion
During command
Found motion Clear error and
compliance cannot be
command when stop sending
01-03-52 tuning, send performed
compliance motion
motion during
teaching command
command compliance
tuning.
Axis 1 happen
01-03-53
collision
Axis 2 happen
01-03-54
collision
1. Clear error
Axis 3 happen
01-03-55 and check if the
collision
action caused
Axis 4 happen
01-03-56 collision
collision
1. Collision
Axis 5 happen Robot happen
01-03-57 2. False 2. Please
collision collision
alarm contact
Axis 6 happen
01-03-58 engineer from
collision
the original
E1 Axis happen
01-03-59 equipment
collision
manufacturer.
E2 Axis happen
01-03-5A
collision
E3 Axis happen
01-03-5B
collision
1. Missing 1. Execute
data payload
Payload data
01-03-60 2. The data in estimation
processing error
The data is the file is again
abnormal incorrect 2. Please
Payload contact
1. Missing
01-03-61 identification file is engineer from
data
abnormal the original
323
C05UE202-2006
324
C05UE202-2006
write back
failed Driver Check driver
Axis 3 driver connection is connection.
Write data to driver parameter abnormality
01-04-18
3 is abnormality write back
failed
Axis 4 driver
Write data to driver parameter
01-04-19
4 is abnormality write back
failed
Axis 5 driver
Write data to driver parameter
01-04-1A
5 is abnormality write back Driver Check driver
failed connection is connection.
Axis 6 driver abnormality
Write data to driver parameter
01-04-1B
6 is abnormality write back
failed
325
C05UE202-2006
Clear Axis 5
Clear driver 5
driver
01-04-20 encoder is
encoder
abnormality
failed
Clear Axis 6
Clear driver 6
driver
01-04-21 encoder is
encoder
abnormality
failed
Start position
01-04-30 declination is
abnormality
A1 declination is
01-04-31
abnormality .
A2 declination is
01-04-32
abnormality
A3 declination is The robot's
01-04-33 Please move to
abnormality position is
the origin and
A4 declination is different
01-04-34 Robot confirm that the
abnormality from when it
position angle is correct.
A5 declination is was last
01-04-35 declination Refer 5.8
abnormality powered off.
A6 declination is
01-04-36
abnormality
326
C05UE202-2006
328
C05UE202-2006
y disconnect
from client
Network port Network port Network port Check port
01-05-34
setting error setting error setting error setting.
Check sever
Network whether
Network client
Network client client interact with
01-05-35 disconnect time
disconnect time out disconnect client
out
time out disconnect
message
Fieldbus slot 1 Confirm
01-05-36
open failed The fieldbus whether the
PCI card is fieldbus PCI
Fieldbus slot 2 not installed card is
01-05-37
open failed correctly. installed
correctly.
Fieldbus slot 1 1. Check
1. The
01-05-38 communication whether the
fieldbus line
error connection
is not
line is
connected
normal.
properly.
2. Check
Fieldbus 2. The
whether the
connection failed connection
connection
parameter
Fieldbus slot 2 parameters
setting does
01-05-39 communication are set
not
error correctly.
correspond to
3. Check
the PLC.
whether the
3. The PLC is
PLC device
not operating
operates
normally.
normally.
Fieldbus slot 1 The fieldbus Confirm that
01-05-40 connection related files the fieldbus
timeout were not related files
329
C05UE202-2006
330
C05UE202-2006
331
C05UE202-2006
Enable smooth
01-06-19
motion error
Disable smooth
01-06-1A
motion error
Error code Error Message Reason Solution
Counter index
01-06-20
abnormality
Timer index
01-06-21
abnormality
Counter stop
01-06-22 number
abnormality
DI index
01-06-23
abnormality
DO index
01-06-24
abnormality
RI index
01-06-25 Index not
abnormality Confirm Index
within setting
RO index No.
01-06-26 range
abnormality
VI index Parameter
01-06-27
abnormality cannot be set
VO index
01-06-28
abnormality
SI index
01-06-29
abnormality
SO index
01-06-2A
abnormality
SR index
01-06-2B
abnormality
DI setting
01-06-30 DI can't be setting DI not set
unavailable
RI setting
01-06-31 RI can't be setting RI not set
unavailable
SI setting
01-06-32 SI can't be setting SI not set
unavailable
332
C05UE202-2006
333
C05UE202-2006
E3 axis
motion
E3 axis command
E3 axis following
01-07-12 position over and actual
error overlimit
deviation position
exceeded
deviation
334
C05UE202-2006
E2 axis 2. Axis
E2 axis clear driver clear prohibits this
01-07-1A
encoder error encoder command.
failed
E3 axis
E3 axis clear driver clear
01-07-1B
encoder error encoder
failed
335
C05UE202-2006
336
C05UE202-2006
337
C05UE202-2006
338
C05UE202-2006
properly
connected.
The adjustment
procedure moves
the welding
The welding torch torch to a
and the workpiece position where it
01-0C-15 Piece touched Piece touched
touched before does not touch
welding. the workpiece
before
performing
welding.
Clear the alarm
Safety limit
Safety limit no Safety limit no after turning on
01-0C-16 switch is not
active active the safety limit
turned on.
switch.
Check the
welding torch
Antishock Antishock The torch is mechanism and
01-0C-17
alarm alarm collided. confirm the TCP
position to clear
the alarm.
An arc is detected
Check whether
during the arc
the torch
extinguishing
01-0C-20 Arc detect Arc detect connection
phase, and the
configuration is
torch may leak
normal.
electricity.
The adjustment
procedure moves
The welding torch the welding
and the workpiece torch to a
01-0C-21 Touch sensed Touch sensed
touched before position where it
welding. does not touch
the workpiece
before
339
C05UE202-2006
performing
welding.
1. Check
whether the gas
cylinder is
Gas control connected
01-0C-22 Gas fault Gas fault device is properly.
abnormal. 2. Replace the
gas cylinder and
related control
devices.
1. Manually run
the wire feed
mechanism to
check whether
Wire feeder is
01-0C-23 Wire fault Wire fault the wire feed is
abnormal.
normal.
2. Change the
wire feeder
control device.
Welding water Please check the
01-0C-24 Water fault Water fault device does not welding water
function correctly device
Restart the
Abnormality in
welder after
01-0C-25 Inverter fault Inverter fault the power source
checking the
of the welder
power supply.
The welding torch Cut off the
electrode and the welding wire
01-0C-26 Wire stick Wire stick
workpiece are and restart
short-circuited. welding.
Confirm the
An error occurred DeviceNet
01-0C-27 DN fault DN fault in the DeviceNet connection and
I/O of the welder. restart the
welder.
340
C05UE202-2006
Confirm whether
The welding
the welding
Process select Process select parameters have
01-0C-29 parameters are
no ack no ack been set over
set in the correct
limit.
range.
Welding Confirm the
Weld Weld command is not DeviceNet
01-0C-30 command command waiting for the connection and
timeout timeout correct return restart the
signal welder.
Issued at the input Confirm the
signal of the status of the
01-0C-31 Torch collided Torch collided collision of the welding torch
welding torch and perform
connection TCP reset.
Confirm the
Not waiting for DeviceNet
Weld down Weld down
01-0C-32 the correct return connection and
slope error slope error
signal restart the
welder.
The above figure as an example, the message is divided into two main parts:
1. Error location: (2: 9), on behalf of 9th words on line 2 is wrong.
2. Error message: syntax error.
Error code Error Message Reason Solution
Command
spelling Check spelling
01-02-10 syntax error Syntax error
error. Wrong and spaces.
space.
341
C05UE202-2006
Declare
Variable not Variable not
01-02-10 ID not exist variable before
exist declared.
use.
Character
Use special Change
01-02-10 Unknown character cannot be
symbols. variable name.
recognized
Declare
Variable not Variable not
01-02-10 … is not declared variable before
declared declared.
use.
Value out of Modify value
01-02-10 Invalid value Invalid value range according to
instruction
Index of … is out Index is out Array index Modify array
01-02-10
of range of range out of range index
Change to the
01-02-10 Type should be … Type error Type error.
correct type.
Structure
Check the
Fail in handling member Struct
declaration of
01-02-10 STRUC member variable member not
structure
expression expression declared.
variables.
error
1.Assign data
Can not with wrong 1.Please check
01-02-10 string assign error
assign string data type to data type.
string.
1.copy data
String copy 1.Please check
01-02-10 string copy error which is not
error source of string.
string.
1.Casecad
Can not string with
can not plus string 1.Cast data to
01-02-10 cascade other data
with other data type string type.
string which is not
string.
1.Input
casting error: Input data parameter 1. Please check
01-02-10
wrong data type type error with wrong data type.
data type.
342
C05UE202-2006
1.Compare
data which is
Can not
can not compare not string. 1. Please check
01-02-10 compare
string 2.Compare data type.
string
two constant
value.
1.Input
Can not parameter 1. Please check
01-02-10 can not find string
search string with wrong data type.
data type.
1.Input
Can not get
parameter 1. Please check
01-02-10 can not get length length of
with wrong data type.
string
data type.
1.Pleas check
Can not copy 1.Copy string copy
01-02-10 can not copy string
string to constant. destination is
variable
1.Input
STRCPY pos 1.Please check
STRCPY pos and parameter
01-02-10 and length pos and length
length should be int with wrong
should be int is int
data type.
1.Please check
string out of 1. string out
01-02-10 string out of size length of string
size of size
is under 255.
string copy 1 string copy 1.Please Pos
string copy out of
01-02-10 out of out of and Length is
boundary
boundary boundary correct.
1.Please check
CREAD
CREAD string out 1.string length of
01-02-10 string out of
of size oversize receive string is
size
under 255
1. .Please check
CWRITE
CWRITE string out 1.string length of
01-02-10 string out of
of size oversize transfer string is
size
under 1000
343
C05UE202-2006
344
C05UE202-2006
345
C05UE202-2006
1.The
effective
torque 1. Change the
exceeds the motion plan, or
rated torque. reduce load.
Torque is too 2. The 2. Check that
03-0m(En)-41 overload
large. motor's hold the wiring and
brake is not the driver
released. voltage are
3. Power correct.
supply wiring
is incorrect
1.
1. Replace the
Insufficient
external
external
regenerative Regenerative regeneration
regeneration
03-0m(En)-43 resistor load rate is resistor
resistor
overload too large. capacity
capacity.
2. Replace
2. Amplifier
amplifier
failed.
The
servomotor
Exceeded
speed is Change
average
03-0m(En)-45 overspeed above the operating
rotational
maximum conditions.
speed
rotational
speed
1.
1. Change the
Regenerative
amplifier
power is too
installation
amplifier The amplifier large.
conditions.
03-0m(En)-51 thermal temperature 2. The
2. Check
abnormality is too high. surrounding
whether the
air
cooling fan is
temperature
running.
is too high.
346
C05UE202-2006
3. Built-in
Fan in
amplifier
Stopped.
347
C05UE202-2006
348
C05UE202-2006
cable. encoder is
2.The amplifier correctly wired.
internal circuit is 2.Replace
bad. amplifier.
1. Check the
1. Wrong
Encoder encoder cable.
connection.
encoder signal is 2. Check the
03-0m(En)-81 2. Connector off.
disconnect disconnecte power supply
3. Poor
d. voltage on the
connection
motor side.
1. Correct the
wiring around
the encoder by
separating the
1. Malfunction
encoder cable
caused by noise
encoder from the
Encoder interference.
communicat servomotor
03-0m(En)-84 Communica 2. Contact fault of
ion main circuit
tions Error connector or
abnormality cable or by
incorrect wiring
checking the
for encoder cable.
grounding and
other wiring.
2. Check the
encoder cable.
349
C05UE202-2006
voltage on the
motor side.
1. Check the
1. The encoder
encoder
encoder cable
connector
multi-turn Encoder disconnected,
battery or the
03-0m(En)-A1 data error Backup and connected
connect or
(battery Error again.
contact status.
abnormality) 2. The battery
2. Measure the
voltage is low.
battery voltage.
Motor Modify motion
Servomoto acceleration condition,
encoder
03-0m(En)-A3 r speed is exceeds allowable increase
overspeed
too high. acceleration acceleration/dec
range. eleration time
Detected 1. Check noise
encoder
encoder in the cable
03-0m(En)-A5 single turn
single turn between the
error 1. Excessive noise
error SERVOPACK
to the encoder
and the host
cable.
controller.
Detected 2. The amplifier
encoder 2. Re-insert the
encoder internal circuit is
03-0m(En)-A6 multi-turn connector and
single turn bad.
error confirm that the
error
encoder is
correctly wired.
350
C05UE202-2006
351
C05UE202-2006
compare the
driver Error
code.
Motor
software Motor
reaches Reduce speed or
03-0m(En)-F4 thermal temperature is too
temperature reduce load.
reach limit high.
limit.
Motor
motor Check the motor
03-0m(En)-F5 cannot Motor disconnect.
disconnect cable.
connect.
amplifier amplifier Phase
03-0m(En)-F6 phase initial phase initial initialization
1. Replace
error error failed.
motor or driver.
Hall sensor Hall sensor
03-0m(En)-F7 Hall sensor error. 2. Check the
error error.
cable.
Hall phase Hall phase Hall phase check
03-0m(En)-F8
error error. error.
352
C05UE202-2006
353
C05UE202-2006
354
C05UE202-2006
355
C05UE202-2006
engineer from
manufacturer.
Y-041 Division Parameter setting Parameter 1. Please turn
pulse output abnormal. setting is off the power
setting abnormal. and restart.
abnormal. 2. Please
contact the
engineer from
manufacturer.
Y-042 Parameters Parameter setting Parameter 1. Please turn
combination abnormal. setting is off the power
abnormal. abnormal. and restart.
2. Please
contact the
engineer from
manufacturer.
Y-044 Semi/closed Parameter setting Parameter 1. Please turn
loop/ Full abnormal. setting is off the power
close loop abnormal. and restart.
parameters. 2. Please
contact the
engineer from
manufacturer.
Y-050 Combination Servo unit is Servo unit is 1. Please turn
error. abnormal. abnormal. off the power
and restart.
2. Please
contact the
engineer from
manufacturer.
Y-051 Product is Servo unit is Servo unit is 1. Please turn
not abnormal. abnormal. off the power
supported. and restart.
2. Please
contact the
engineer from
manufacturer.
356
C05UE202-2006
357
C05UE202-2006
2. Please
contact the
engineer from
manufacturer.
Y-400 Overvoltage Servo unit is Servo unit is 1. Please turn
abnormal. abnormal. off the power
and restart.
2. Please
contact the
engineer from
manufacturer.
Y-410 Insufficient Servo unit is Servo unit is 1. Please turn
voltage abnormal. abnormal. off the power
and restart.
2. Please
contact the
engineer from
manufacturer.
Y-450 Main circuit Servo unit is Servo unit is 1. Please turn
capacitor abnormal. abnormal. off the power
overvoltage. and restart.
2. Please
contact the
engineer from
manufacturer.
Y-510 Overspeed Motor speed is Command 1. Adjust the
above maximum input value is operating
speed. too high or conditions.
the servo unit 2. Please turn
is abnormal. off the power
and restart.
3. Please
contact the
engineer from
manufacturer.
358
C05UE202-2006
359
C05UE202-2006
engineer from
manufacturer.
Y-730 DB The power The motor is 1. Do not
Y-731 overload. consumption of driven by an drive the
the detected DB is external motor by
too large. force or the external force.
servo unit is 2. Please turn
abnormal. off the power
and restart.
3. Please
contact the
engineer from
manufacturer.
Y-740 The surge Main circuit is Servo unit is 1. Adjust the
current limit energized too abnormal. operating
resistor is high. conditions.
overloaded. 2. Please turn
off the power
and restart.
3. Please
contact the
engineer from
manufacturer.
Y-7A0 Heat sink is The heat sink The ambient 1. Adjust the
overheated. temperature temperature operating
exceeds 100 °C. is too high or conditions.
the servo unit 2. Please turn
is abnormal. off the power
and restart.
3. Please
contact the
engineer from
manufacturer.
Y-7AB Built-in fan The internal fan There is a 1. Remove
stopped. of the foreign foreign
SERVOPACK object objects.
stopsped. entering, or
360
C05UE202-2006
361
C05UE202-2006
362
C05UE202-2006
data is 2. Please
abnormal. contact the
engineer from
manufacturer.
Y-B20 The torque When the servo is The servo 1. Please turn
command turned ON, the unit is off the power
A/D is torque command abnormal. and restart.
abnormal. input is 2. Please
incorrectly contact the
operated. engineer from
manufacturer.
Y-B31 Current U phase current The servo 1. Please turn
detection detection loop is unit is off the power
error 1 abnormal. abnormal. and restart.
2. Please
contact the
engineer from
manufacturer.
Y-B32 Current V phase current The servo 1. Please turn
detection detection loop is unit is off the power
error 2 abnormal. abnormal. and restart.
2. Please
contact the
engineer from
manufacturer.
Y-B33 Current The current The servo 1. Please turn
detection detection loop is unit is off the power
error 3 abnormal. abnormal. and restart.
2. Please
contact the
engineer from
manufacturer.
363
C05UE202-2006
364
C05UE202-2006
acceleration is 2. Please
abnormal. contact the
engineer from
manufacturer.
The encoder The encoder is The servo 1. Please turn
communication malfunctioning. unit is off the power
timer is abnormal. and restart.
Y-C92 abnormal. 2. Please
contact the
engineer from
manufacturer.
The encoder The encoder is The servo 1. Please turn
parameters are malfunctioning. unit is off the power
abnormal. abnormal. and restart.
Y-CA0 2. Please
contact the
engineer from
manufacturer.
Encoder The encoder is The servo 1. Please turn
calibration malfunctioning. unit is off the power
returned abnormal. and restart.
Y-CB0 abnormal. 2. Please
contact the
engineer from
manufacturer.
The upper limit The encoder is The servo 1. Please turn
of the number malfunctioning. unit is off the power
of revolutions abnormal. and restart.
Y-CC0 is inconsistent. 2. Please
contact the
engineer from
manufacturer.
The position In the state of The position 1. Please turn
deviation is too servo ON, the command is off the power
Y-D00 large. position too fast, or and restart.
deviation exceeds the servo 2. Please
the upper limit. contact the
365
C05UE202-2006
366
C05UE202-2006
367
C05UE202-2006
specified
range.
Replace the
drive.
Drive Drive temperature Ambient Confirm that
temperature is abnormal. temperature the drive
error. is too high ambient
or the drive temperature
S-4110
is damaged. does not
exceed 55 ̊C.
Replace the
drive.
Anti-surge Anti-surge Drive Replace the
resistor resistor failure or drive.
overheating. overheating. ambient Confirm that
S-4210 temperature the ambient
is too high. temperature
does not
exceed 55 ̊C.
Control power Control power Undervoltag Replace the
supply low supply low e ±5V drive or
voltage 2. voltage 2. control Confirm
S-5113
switching external
power circuit..
supply.
Control power Control power Control Replace the
supply low supply low power drive
voltage. voltage. supply Check if the
voltage is power supply
S-5114
too low. voltage is
within the
specified
range.
Control power Control power Undervoltag Replace the
supply low supply low e ±12V drive or
S-5115
voltage 1. voltage 1. control
switching
368
C05UE202-2006
power Confirm
supply. external
circuit.
Abnormal Abnormal Drive Replace the
current current. damage or motor or
S-5210
detection. motor drive.
damage.
System error. System error. Setting Replace the
S-5220
mismatch. drive.
Main power Abnormal power Abnormal Confirm
supply supply. power wiring,
equipment supply, replace servo
error. over-current motor or
or drive.
S-5400
overheating Confirm that
of the servo the
module. environment
does not
exceed 55 ̊C.
Memory error. Memory error. CPU access Replace the
error of drive.
S-5510
CPU built-
in memory.
EEPROM EEPROM error Drive built- Replace the
error in drive.
S-5530
EEPROM
abnormal.
Initialization Initialization The Replace the
thread timeout. thread timeout. initializatio drive.
n thread Confirm that
was not the drive is
S-6010
completed properly
within the grounded.
initializatio
n time.
369
C05UE202-2006
370
C05UE202-2006
higher than
4.75V or
replace the
motor
Communicatio Communication Abnormal Check if the
n error. error. communicat communicatio
S-7510
ion. n format is
correct.
Link lost. Communication Communica Confirm that
disconnect. tion cable is the
damaged or communicatio
S-7520
not n cable is
connected. connected or
normal.
Overload Overload Motor load Reduce load
S-8311
is too large. or slow down.
STO safe STO safe torque STO input Confirm stop.
S-8312 torque off off abnormal. is abnormal.
abnormal.
Average Average Motor Reduce
continuous continuous speed speed operating
S-8400
speed overspeed. overspeed. speed.
overspeed.
Position Position Position Reduce the
command command error. command is amount of
S-8500 error. out of input
setting movement
range. command.
Position Position deviation Position Confirm
deviation is too is too large. deviation wiring.
large. exceeds the Confirm the
set value. power supply
S-8611
voltage.
Replace the
drive or
motor.
371
C05UE202-2006
372
C05UE202-2006
373
C05UE202-2006
and reconnect
it.
Replace the
USB cable.
Gripper Gripper Connection Re-plug the
reconnection reconnection port is USB cable
failed. failed. interrupt and and reconnect
04-01-16
an attempt to it.
reconnect Replace the
failed. USB cable.
Gripper serial Gripper serial When a Check if the
port is port is repeatedly duplicate gripper is
repeatedly connected. connection repeatedly
connected. port is connected.
04-01-17
detected, the
connection is
automatically
disconnected.
374
C05UE202-2006
375
C05UE202-2006
the range of
motion.
Gripping Gripping speed Gripping Check that the
speed setting setting is speed is gripping speed
04-01-2A is incorrect. incorrect. greater than input is correct.
the preset
range.
Gripping
speed is
04-01-2B smaller than
the preset
range.
Gripping force Gripping force Gripping force Check that
04-01-2C setting is setting is is greater than gripping force
incorrect. incorrect. the preset input is correct.
range.
Gripping force
04-01-2D is smaller than
the preset
range.
Gripping Gripper failed to After the user This alarm is
failed. grip. turns on the used to detect if
grip detection the jaws are
function, the clamped to the
gripping action object. If you do
04-01-2E is performed not need to send
and the electric this detection
gripper detects alarm, you can
the unwound cancel this
object. function in the
setting interface.
Gripper is set Gripper is set Gripper Check if the
incorrectly incorrectly with exceeds the gripper moving
with respect to respect to the movable range distance and the
04-01-2F
the total total stroke. with respect to total gripping
stroke. the total displacement are
stroke. correct.
376
C05UE202-2006
Gripper is less
than the
04-01-80 movable range
relative to the
total stroke
Gripper speed Gripper speed Gripper Check that the
setting error. setting error. moving speed gripper moving
04-01-81 is less than the speed input is
gripping correct.
speed.
3X)
Error code Error Message Reason Solution
377
C05UE202-2006
(04-01-4X)
Error code Error Message Reason Solution
Gripper Gripper
04-01-41 connection connection
Check that the
timeout timeout
24V power
Gripper Gripper
supply is
firmware firmware
04-01-42 properly
communication communication
connected.
timeout timeout
Check that the
Gripper stop Gripper stop
04-01-43 Electric USB cable is
action timeout action timeout
gripper properly
Gripper reset Gripper reset
04-01-44 command connected,
timeout timeout
communication Check that the
Gripper Gripper
failed and data serial port is
04-01-45 movement movement
returned set correctly.
timeout timeout.
timeout. Refer to the
Gripping Gripping
04-01-46 manual to
timeout timeout
install the jaw
Gripper expert Gripper expert
driver.
04-01-47 mode action mode action
Replace the
timeout timeout
controller
Gripper state Gripper state
unit.
04-01-48 reading reading timeout
timeout
378
C05UE202-2006
8. Program Examples
8.1. Register
Description:
The constant 10 is saved into COUNTER 1. After the program is closed, the number
of the variable definition still registered.
Hint:
There are 20 COUNTERs from 1 to 20. The saved number is integer. The storage
capacity is 32bit, which is -2147483648 ~ 2147483647.
Description:
Calculate the period when the robot moves from the original position to P0. After the
program is closed, the number of the variable definition still registered.
Parameter explanation:
Start counting when $T_STOP[n]=FALSE. And stop when $T_STOP[n]=TRUE.
Hint:
There are 20 TIMERs, from 1 to 20. $T[n] represents the TIMER n. Before starting
and ending $T_Stop, “WAIT SEC 0” command which can stop pre-read is necessary.
Every TIMER is 32bit, the display range is from -2147483648 ~ 2147483647(ms).
379
C05UE202-2006
8.2.1. REAL
Program:
REAL One
One = 1
Description:
The format is similar to the data type of the decimal data. This variable will disappear
after the program is closed.
Hint: The storage capacity is 32bit about 10-37~1038, effective to 6 digits after the
decimal point.
8.2.2. INT
Program:
INT Two = 2
Description:
Which is a format of the integer-type data, and will disappear after the program is
closed.
8.2.3. BOOL
Program:
BOOL K = TRUE
Description:
Which means “Boolean”, is a logically variable. Will disappear after the program is
closed.
380
C05UE202-2006
8.2.4. CHAR
Program:
CHAR COLOR = 'R'
Description:
Which represents the character variable. Will disappear after the program is closed.
Description:
Define POINT in Cartesian coordinate, and move the robot to POINT.
Hint:
If the parameter is not set, its value will not changed(A, B, C in this case). This point
doesn’t define E6AXIS(A1~A6) values.
Hint:
Parameter A2、A3、A4 are not set, and will remain the original value. This point
doesn’t define E6POS(X, Y, Z, A, B, C) value.
381
C05UE202-2006
8.2.7. E6POINTPoint
Program:
E6POINT HOME = {Y 200,Z -1000,A 90}
PTP HOME CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
or you change the definition of HOME like this:
E6POINT HOME = {A1 90}
Description:
The first definition of HOME is in Cartesian coordinate, and then move the robot to
HOME. The second definition is in Joint coordinate.
Hint:
If there is parameter not defined, it will remain the current value.
8.3. Operator
382
C05UE202-2006
Hint: If the format is INT and there are decimals after operation, decimals will be
removed. After INT and REAL are operated by “+”, “-“, or “*”, the result format will
be REAL.
383
C05UE202-2006
8.4. Input/Output
384
C05UE202-2006
8.5.1. PTP
Point Definition 1
Program:
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
Description:
Only require the position of the starting point and the terminal point. There is no limit
for the middle process. TCP will be guided with the fastest trace of the robot to the
target point. P0 is additionally established for TCP except for the Home status. TCP
will move point-to-point from Home to P0.
Parameter explanation:
PTP ; name of point-to-point command, the shortest trace for the robot
P0 ; any point except for Home
CONT ; smooth extent
Vel ; moving velocity relative to maximum velocity
Acc ; moving acceleration relative to maximum acceleration
-------------------------------------------------------------------
Point Definition 2
Program:
E6POS POINT = {X 0,Y 300,Z 200}
PTP POINT CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
Description:
Move to POINT.
385
C05UE202-2006
-------------------------------------------------------------------
Point Definition 3
Program:
PTP {X 100} CONT=100% Vel=2000mm/s Acc=50% TOOL[0] BASE[0]
Description:
The TCP moves to this coordinate (refer to the base coordinate). The parameters not
defined will remain the same.
-------------------------------------------------------------------
Point Definition 4
Program:
PTP {A1 45} CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
Description:
The A1 axis of TCP moves to +45° (refer to the base coordinate). For the axis not
defined, the angle will not change.
8.5.2. PTP_REL
Point Definition 1
Program:
PTP_REL {X 100 } CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
Description:
The TCP moves to this coordinate (refer to the base coordinate). The coordinates not
defined will remain the same.
-------------------------------------------------------------------
Point Definition 2
Program:
PTP_REL {A1 45} CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
Description:
The A1 axis of TCP moves at +45° relative to the original A1 axis (refer to the base
coordinate). For the axis not defined, the angle will not change.
386
C05UE202-2006
8.5.3. LIN
Point Definition 1
Program:
LIN P0 CONT=100% Vel=2000mm/s Acc=50% TOOL[0] BASE[0]
Description:
P0 is additionally established for TCP except for the Home status. TCP will move
point-to-point from Home via P0 to P1. The robot will guide TCP to the target point
along the linear trace with the defined velocity.
Parameter explanation:
LIN ; name of point-to-point command, linear trace connecting two points
P0 ; any point except for Home
CONT ; smooth extent
Vel ; velocity moving on linear trace
Acc ; acceleration moving on linear trace
-------------------------------------------------------------------
Point Definition 2
Program:
E6POS POINT = {X 0,Y 368,Z 293}
LIN POINT CONT=100% Vel=2000mm/s Acc=50% TOOL[0] BASE[0]
-------------------------------------------------------------------
Point Definition 3
Program:
LIN {X 100} CONT=100% Vel=2000mm/s Acc=50% TOOL[0] BASE[0]
387
C05UE202-2006
Description:
The TCP moves to this coordinate (refer to the base coordinate). The coordinates not
defined will remain the same.
-------------------------------------------------------------------
Point Definition 4
Program:
LIN {A1 45} CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
Description:
The A1 axis of TCP moves at +45° relative to the original A1 axis (refer to the base
coordinate). For the axis not defined, the angle will not change.
8.5.4. LIN_REL
Point Definition 1
Program:
LIN_REL {X 100 } CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
Description:
The coordinates of TCP moves in relative to this coordinate (refer to the base
coordinate). For the direction not defined, the coordinates will not change.
-------------------------------------------------------------------
Point Definition 2
Program:
LIN_REL {A1 45} CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
Description:
The A1 axis of TCP moves at +45° relative to the original A1 axis (refer to the base
coordinate). For the axis not defined, the angle will not change.
Program:
LIN_REL {X 100 } CONT=100% Vel=2000mm/s Acc=50% TOOL[0] BASE[0]
388
C05UE202-2006
8.5.5. LIN_REL_TOOL
Point Definition 1
Program:
LIN_REL_TOOL {X 100 } CONT=100% Vel=2000mm/s Acc=50% TOOL[0]
BASE[0]
Description:
The TCP of the robot will move along the axis of the command(“X” in this case) by
increasing the value(“100” in this case).
-------------------------------------------------------------------
Point Definition 2
Program:
LIN_REL_TOOL {A 45} CONT=100% Vel=2000mm/s Acc=50% TOOL[0]
BASE[0]
Description:
In this case, the TCP will rotate +45° along the X axis of the TCP coordinate. And the
command “B”(“C”) means to rotate along “Y”(“Z”) axis.
8.5.6. CIRC
Point Definition 1
Program:
CIRC P0 P1 CONT=100% Vel=2000mm/s Acc=50% TOOL[0] BASE[0]
Description:
P0 and P1 are additionally established for TCP except for the Home status. TCP will
move with circular trace from Home via P0 to P1. The robot will guide TCP to the
target point along the circular trace with the defined velocity.
Parameter explanation:
CIRC ; name of point-to-point command, the starting point arrives the target point
via the auxiliary point along the circular trace
P0 ; any point except for Home as auxiliary point
P1 ; any point except for Home as target point
389
C05UE202-2006
Hint:
P0 and P1 should be established first.
-------------------------------------------------------------------
Point Definition 2
Program:
E6POS POINT1 = {X 0,Y 300,Z 200}
E6POS POINT2= {X 20,Y 320,Z 220}
CIRC POINT1 POINT2 CONT=100% Vel=2000mm/s Acc=50% TOOL[0] BASE[0]
-------------------------------------------------------------------
Point Definition 3
Program:
CIRC {X 0, Y 450} {X -150, Y 300} CONT=100% Vel=2000mm/s Acc=50%
TOOL[0] BASE[0]
Description:
TCP based on the starting point as the original coordinate moves to the auxiliary point
and then arrives the destination point (refer to the base coordinates).
-------------------------------------------------------------------
Point Definition 4
Program:
CIRC {A1 5.0, A2 5.0, A3 5.0, A4 5.0} {A1 10.0, A2 10.0, A3 10.0, A4 10.0}
CONT=100% Vel=2000mm/s Acc=50% TOOL[0] BASE[0]
Description:
TCP based on the starting point as the original coordinate moves to the auxiliary point
and then arrives at the destination point (refer to the base coordinates).
390
C05UE202-2006
8.5.7. CIRC_REL
Point Definition 1
Program:
CIRC_REL {X -150, Y 150} {X -150, Y -150} CONT=100% Vel=2000mm/s
Acc=50% TOOL[0] BASE[0]
Description:
TCP based on the starting point as the original coordinate moves to the auxiliary point
and then arrives the destination point (refer to the base coordinates).
-------------------------------------------------------------------
Point Definition 2
Program:
CIRC_REL {A1 5.0, A2 5.0, A3 5.0, A4 5.0} {A1 10.0, A2 10.0, A3 10.0, A4 10.0}
CONT=100% Vel=2000mm/s Acc=50% TOOL[0] BASE[0]
Description:
TCP based on the starting point as the original coordinate moves to the auxiliary point
and then arrives at the destination point (refer to the base coordinates).
8.5.8. SPLINE
Point Definition 1
Program:
E6POINT P1 ={ X 95 , Y 0 , Z -500 }
E6POINT P2 ={ X 94.63849632 , Y 3.922008424 , Z -500 }
…..
E6POINT P54 ={ X -8.279795561 , Y -44.82876141 , Z -500 }
E6POINT P55 ={ X 0 , Y -45 , Z -500 }
E6POINT P56 ={ X 8.279795561 , Y -44.82876141 , Z -500 }
…..
E6POINT P73 ={ X 95 , Y 0 , Z -500 }
SPLINE
SPL P1
SPL P2
…..
391
C05UE202-2006
SPL P54
SPL P55
SPL P56
…..
SPL P73
ENDSPLINE
Description:
Start from P1 point and move to P73 point with B-Spline curvilinear motion.
Description:
The A1 coordinate of P0 accumulates 10 degrees every time, and the other
coordinates will not change.
8.5.10. CT_A6
Program:
LIN P0 FINE=1 Vel=100mm/s Acc=100% TOOL[0] BASE[0]
CT_A6 100
WHILE $C[1] <2
$C[1] = $C[1]+1
LIN P1 FINE=1 Vel=100mm/s Acc=100% TOOL[0] BASE[0]
LIN P2 FINE=1 Vel=100mm/s Acc=100% TOOL[0] BASE[0]
ENDWHILE
$C[1] = 0
CT_A6 -50
WHILE $C[2] <2
$C[2] = $C[2]+1
LIN P1 FINE=1 Vel=100mm/s Acc=100% TOOL[0] BASE[0]
392
C05UE202-2006
Description:
The sixth axis of the robot first reciprocates between P1 and P2 at a speed of 100% in
the positive direction, and then reciprocates between P1 and P2 at a speed of 50% in
the negative direction, and then ends infinite rotation and returns to the P0 point.
8.5.11. BRAKE
Program:
LIN P0 FINE=1 Vel=3000mm/s Acc=100% TOOL[0] BASE[0]
LIN_REL {Z -200}
LOOP
IF $DI[1] == TRUE THEN
BRAKE
EXIT
ENDIF
ENDLOOP
LIN P1 FINE=1 Vel=3000mm/s Acc=100% TOOL[0] BASE[0]
Description:
The robot moves to P0, it moves 200mm down along Z axis. The sensor of DI[1] is
triggered on the way, the robot stop the motion and moves linearly from the stop point
to P1.
8.5.12. EXT_TCP
Front work:
1. At the external tool point, teach a Base coordinate system, and the origin of the
Base coordinate system is at the tool processing point.
2. Teaching starting point is at point P1 and ending point at P2
393
C05UE202-2006
Using EXT_TCP
394
C05UE202-2006
8.6.1. IF
Format 1 of IF
IF condition THEN
………………
ENDIF
Program:
INT n = 1
IF n > 0 THEN
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
ENDIF
Description:
Because the condition is true, TCP will move to P0.
Parameter description:
Condition; condition
Because the condition is true, the statement in IF will be executed.
Format 2 of IF
IF condition THEN
………………
ELSE
………………
ENDIF
Program:
INT n = 0
IF n > 0 THEN
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
ELSE
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
ENDIF
395
C05UE202-2006
Description:
Because the condition is false, TCP will execute ELSE and move to P0.
Application for determining IF condition
Program:
INT n, m
n=1
m=2
IF ((n == 1) AND (m ==2)) THEN
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
ENDIF
Description:
Because the condition is true, TCP will move to P0.
-------------------------------------------------------------------
Program:
INT n,m
n =1
m =3
IF ((n == 1) OR (m == 2)) THEN
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
ENDIF
Description:
Because the condition is true, TCP will move to P0.
-------------------------------------------------------------------
396
C05UE202-2006
IF condition THEN
………………
ENDIF
Program:
IF $DI[1] == TRUE THEN
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
ENDIF
Description:
If DI[1] is true, the condition will be true. TCP will move to P0.
397
C05UE202-2006
8.6.2. FOR
FOR TO STEP ENDFOR
INT n
FOR n = 0 TO 2 STEP 1
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
ENDFOR
Description:
TCP moves to and fro between P0 and P1 three times.
Parameter explanation:
start ; start
last ; condition
increment ; increment
After FOR is executed from the start to the condition, FOR will end.
If the STEP increment is omitted, the increment default is 1.
FOR application
Program:
INT n
FOR n = 0 TO 20 STEP 10
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
ENDFOR
Description:
TCP moves to and fro between P0 and P1 three times.
-------------------------------------------------------------------
398
C05UE202-2006
Program:
INT n
FOR n = 2 TO 0 STEP 1
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
ENDFOR
Description:
TCP moves to and fro between P0 and P1 three times.
-------------------------------------------------------------------
Program:
INT n
FOR n = -1 TO 3 STEP 2
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
ENDFOR
Description:
TCP moves to and fro between P0 and P1 three times.
8.6.3. LOOP
LOOP ENDLOOP
LOOP
………………
ENDLOOP
Program:
LOOP
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
ENDLOOP
Description:
TCP repeatedly moves to and fro between P0 and P1.
399
C05UE202-2006
Parameter explanation:
LOOP is an infinite loop.
LOOP
………………
EXIT
………………
ENDLOOP
Program:
INT n =0
LOOP
IF n == 1 THEN
EXIT
ELSE
n=n+1
ENDIF
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
ENDLOOP
Description:
TCP will move to P0.
Parameter explanation:
LOOP execute to EXIT and end LOOP.
8.6.4. WHILE
WHILE ENDLOOP
WHILE condition
………………
ENDWHILE
Program:
400
C05UE202-2006
INT n = 2
WHILE n > 0
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
n=n-1
ENDWHILE
Description:
TCP moves to and fro between P0 and P1 twice.
Parameter explanation:
condition ; condition
When the condition of WHILE is true, repeatedly execute the statement in WHILE
until the condition is false and ends.
Program:
INT n,m
n=1
m=2
WHILE ((n == 1) AND (m == 2))
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
n=n+1
ENDWHILE
Description:
TCP moves to and fro between P0 and P1 once.
-------------------------------------------------------------------
401
C05UE202-2006
Program:
INT n,m
n=1
m=2
WHILE ((n == 1) OR (m == 3))
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
ENDWHILE
Description:
TCP moves to and fro between P0 and P1 once.
8.6.5. REPEAT
REPEAT UNTIL
REPEAT
………………
UNTIL condition
Program:
INT n =0
REPEAT
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
n=n+1
UNTIL n > 2
Description:
TCP will move to P0 and P1 as well as repeatedly execute twice.
Parameter explanation:
Condition ; condition
Repeatedly execute the statement in REPEAT until the condition is true, and end
REPEAT.
Application for determining REPEAT condition
REPEAT
………………
UNTIL((FALSE) OR (TRUE))
402
C05UE202-2006
Program:
INT n =0
INT k =1
REPEAT
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
n=n+1
UNTIL (k ==2) OR (n > 2)
Description:
TCP will move to P0 and P1 as well as repeatedly execute twice.
-------------------------------------------------------------------
REPEAT
………………
UNTIL((TRUE) AND (TRUE))
Program:
INT n =0
INT k =1
REPEAT
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
n=n+1
UNTIL(k ==1) AND (n > 2)
Description:
TCP will move to P0 and P1 as well as repeatedly execute twice.
8.6.6. GOTO
IF condition THEN
GOTO LABEL1
ENDIF
IF condition THEN
403
C05UE202-2006
GOTO LABEL 2
ENDIF
IF condition THEN
GOTO LABEL 3
ENDIF
LABEL 1:
………………
LABEL 2:
………………
LABEL 3:
………………
Program:
INT n =0
LOOP
IF n == 0 THEN
GOTO STEP0
ENDIF
IF n == 1 THEN
GOTO STEP1
ENDIF
IF n == 2 THEN
GOTO STEP2
ENDIF
PRO:
n=n+1
ENDLOOP
STEP0:
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
GOTO PRO
STEP1:
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
GOTO PRO
STEP2:
404
C05UE202-2006
Description:
TCP moves from P0 to P1, and then ends LOOP.
Parameter explanation:
LABEL ; label
The label of GOTO corresponds to the following statement of the label. If the label
doesn't have the statement, it will end program. The specified label must be in the
current function, cross function cannot be applied.
8.6.7. SWITCH
SWITCH without default
SWITCH number
………………
CASE number1
………………
CASE number2
………………
ENDSWITCH
Program:
INT n =0
LOOP
SWITCH n
CASE 0
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
CASE 1
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
CASE 2
EXIT
ENDSWITCH
n=n+1
ENDLOOP
Description:
TCP moves from P0 to P1, and then executes EXIT to end LOOP.
405
C05UE202-2006
Parameter explanation:
number ; argument
The argument of SWITCH corresponds to the statement of CASE.
When the argument of SWITCH doesn't correspond to CASE, it will directly
correspond to ENDSWITCH.
-------------------------------------------------------------------
SWITCH with default
SWITCH number
………………
CASE number1
………………
CASE number2
………………
DEFAULT
EXIT
ENDSWITCH
Program:
INT n =0
LOOP
SWITCH n
CASE 0
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
CASE 1
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
DEFAULT
EXIT
ENDSWITCH
n=n+1
ENDLOOP
Description:
TCP moves from P0 to P1, and then executes EXIT to end LOOP.
Parameter explanation:
The argument of SWITCH corresponds to CASE. If there is no correspondence, the
statement of DEFAULT will be executed.
406
C05UE202-2006
When the argument of SWITCH doesn't correspond to CASE, the statement with
DEFAULT will jump to the statement of DEFAULT.
------------------------------------------------------------------
SWITCH Extension 1
SWITCH number
………………
CASE number1, number3, number5
………………
CASE number2, number4
………………
DEFAULT
EXIT
ENDSWITCH
Program:
INT n =0
LOOP
SWITCH n
CASE 0,2,4
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
CASE 1,3
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
CASE 5
EXIT
ENDSWITCH
n=n+1
ENDLOOP
Description:
TCP moves to and fro between P0 and P1, moves to P0, and then executes EXIT to
end LOOP.
------------------------------------------------------------------
407
C05UE202-2006
SWITCH Extension 2
SWITCH character
………………
CASE character1
………………
CASE character2
………………
DEFAULT
EXIT
ENDSWITCH
Program:
CHAR COLOR = 'R'
LOOP
SWITCH COLOR
CASE 'R'
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
CASE 'G'
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
DEFAULT
EXIT
ENDSWITCH
IF COLOR =='G' THEN
COLOR ='Y'
ENDIF
IF COLOR =='R' THEN
COLOR ='G'
ENDIF
ENDLOOP
Description:
TCP moves from P0 to P1, and then executes EXIT to end LOOP.
408
C05UE202-2006
8.6.8. WAIT
WAIT SEC
Program:
WAIT SEC 3
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
Description:
After the program waits for three second, TCP will move to P0.
WAIT INPUT
Program:
WAIT FOR $DI[1] == TRUE
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
Description:
When the program waits the Digital INPUT Channel 1 is TRUE, TCP will move to
P0.
-------------------------------------------------------------------
Program:
WAIT FOR $RI[1] == TRUE
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
Description:
When the program waits the INPUT Channel 1 for the robot is TRUE, TCP will move
to P0.
8.6.9. QUIT
QUIT:
LOOP
IF $DI[1] == TRUE THEN
QUIT
ENDIF
ENDLOOP
Description:
The program will be closed when executing “QUIT” command(when DI[1] == TRUE
in this case).
409
C05UE202-2006
8.7.1. CONT
Continue Trajectory
If the “CONT” command is called, the robot controller will consider the next motion
point, and will move in a smoother path. The path smooth level will depend on the
motion velocity and acceleration.
There are three kinds of CONT command: CONT, CONT = #%, CONT = #mm. Last
two kinds represent the fixed path, like CONT = 50% or CONT = 30mm.
CONT
LIN P1 CONT
LIN P2 CONT
LIN P3 CONT
When execute the commands open, there will be the smooth path in “LIN P2 CONT”,
but there won’t move to P1 and P3(because they are the origin and destination).
P3 P1
destination origin
CONT motion
CONT = #%
LIN P1 CONT
LIN P2 CONT = 50%
LIN P3 CONT
As Figure 10.2 show:
The distance between P2, P3 is shorter than the one between P1, P2, which is called
the short length.
When execute the open program, the trajectory will start fairing when 50% short
length away before P2.
410
C05UE202-2006
Because the “CONT= # %” command will create a fixed path, so the velocity of
the robot may change.
P2
short length 50% Fairing Trajectory
P3
destination P1
origin
CONT = 50%
CONT = #mm
LIN P1 CONT
LIN P2 CONT = 5mm
LIN P3 CONT
The path will start fairing when 5mm away before P2.
P2
5mm Fairing Path
P3
destination P1
origin
CONT = 5mm
Because the “CONT= # mm” command will create a fixed path, so the velocity
of the robot may change.
When using “CONT= # mm” command, it does not mean that the value specified
by the user will be exactly the same. However, the system will attempt at the
distance specified by the user.
411
C05UE202-2006
If there is “DO” command before the “CONT”, then the path won’t be smoothed.
Example:
LIN P1 CONT
LIN P2 CONT
$DO[1] = TRUE
LIN P3 CONT
Originally, the path moving to P2 should be faired, but in this case, the path won’t be
smoothed.
412
C05UE202-2006
8.7.2. FINE
Discontinuous Motion
FINE motion
“FINE” command make TCP arrive the point without fairing the path.
FINE has four kinds:
FINE, pre-read the next command, not check the actual position.
FINE = 0, pre-read the next command, not check the actual position.
FINE = 1, not pre-read the next command, not check the actual position.
FINE = 2, not pre-read the next command, check the actual position.
8.7.3. VEL
Vel=100%
Define the velocity. If the PTP motion is used, the expression is the percentage that
the maximum velocity can move. If this parameter is not entered, the default is 20%.
Vel=2000mm/s
Define the velocity. If the LINE and CIRC motions are used, the expression is mm/s.
If this parameter is not entered, the default is 250mm/s.
8.7.4. ACC
Acc=50%
Define the acceleration. The expression is the percentage of maximum acceleration.
413
C05UE202-2006
Program:
STRUC CASTING_TYPE INT MASS, REAL VOLUME
DECL CASTING_TYPE PART1 ,PART2
PART1 = {MASS 10, VOLUME 500 }
PART2 = {MASS 20, VOLUME 100 }
Description:
For the different objects in the specific type, the different parameters can be assigned
in the same variable.
Parameter explanation:
STRUC LABEL ; define the type name
INT PARAMETER1 ; define the format of object parameter
REAL PARAMETER2 ; define the format of object parameter
PART1 ; define the object
PART2 ; define the object
Hint:
PART1. PARAMETER1 = K, which can obtain the parameter.
414
C05UE202-2006
Function is a program code which allows the user to execute the specific task or
specific motion. User may write the frequently repeated program code in the function,
and may also decide to write the program code with any length in the function.
Usually, one function only performs one task.
The declaration of function tells the compiler with respect to the function name, post
back value and parameters.
Definition of Function:
DEFFCT return_type function_name ( parameter list )
ENDFCT
The declaration of function includes the function header and function body. The
description of each part is shown as follows:
return_type: Data type returns from function.
function_name: Function name.
parameter list: Function parameters. User may deliver the parameters into the
function. The data type of parameter will refer to the data type and support point type
declared in the function field. If the parameter is input, then use “parameter: IN” for
indication, use as the input parameter, it will not affect the incoming variable even it
is modified in the function. If it is used as the output variable and modified in the
function, then use “parameter: OUT”. As the output variable, if it is modified in the
function, the originally incoming variable will also be changed accordingly. One
function may have no function parameters, and up to five (5) parameters as the
maximum.
statement body: Function body. If the function has parameter, then the user needs to
declare the type of parameter in order to undertake.
415
C05UE202-2006
Example of program 1:
INT iFUN
iFUN = FCT_1(2,3)
DEFFCT INT FCT_1(num1:IN,num2:IN)
INT num1
INT num2
RETURN num1+num2
ENDFCT
Description:
Declare one function named as FCT_1, income two (2) INT parameters i.e. num1 and
num2 respectively, and then post back after adding these two parameters.
Example of program 2:
E6POINT RE_E6,OUT_E6
INT iX
OUT_E6 = P1
RE_E6 = FCT_2(P0,OUT_E6)
iX = OUT_E6.X
Description:
Declare one function named as FCT_2, income one parameter of E6POINT and one
output parameter B of E6POINT, the function assigns the X value of B to X of A first,
and then configures X of B to 100, and then executes the point to point moving to A,
and finally post back A, and B is taken as output returning to the calling procedure.
416
C05UE202-2006
The difference between the defined subprogram and function are: the subprogram has
no post back value and the declaration is different.
Definition of subprogram:
DEF subprogram_name ( parameter list )
END
The declaration of function includes the subprogram header and subprogram body.
Description of each part is shown as follows:
subprogram_name: Subprogram name.
parameter list: Subprogram parameter and up to five (5) parameters as the maximum.
statement body: Subprogram body.
Example of program 1:
INT iNUM
iNUM = 4
$C[4] = 0
PROG_1(3,iNUM)
$C[4] = iNUM
DEF PROG_1(num1:IN,num2:OUT)
INT num1
INT num2
num2= num1+num2
END
Description:
Declare one subprogram named as PROG_1, income one parameter num1 of INT and
one output parameter num2 of INT, and then add these two parameters, and assign to
num2 as the output.
417
C05UE202-2006
Example of program 2:
E6POINT E6_OUT_A,E6_OUT_B
E6_OUT_A = P0
E6_OUT_B = P1
PROG_2(E6_OUT_A,E6_OUT_B)
DEF PROG_2(A:OUT,B:OUT)
E6POINT A
E6POINT B
A.X = B.X
B.X = 100
PTP A
END
Description:
Declare one subprogram named as PROG_2, income two (2) output parameters of
E6POINT i.e. A and B respectively, the subprogram assigns X of B to X of A first,
and then configures X of B to 100, and then executes the pint to point moving A,
takes the modified A and B as the output returning to the calling procedure.
418
C05UE202-2006
Function(EXTFCT)
Declare the external function which indicates that the user writes this function into a
separate independent file, and the name of this independent file shall be the same as
the function name, and call this function outside this independent file. The external
function locates on the first line of program code and must begin with the keyword of
DEFFCT, one file can only define one external function. If it desires to call the
external function, it will have to declare the external function at the calling program.
The declaration of external function must use the keyword of EXTFCT. After
declaration, it will be the same as the calling of general function.
Example of program:
419
C05UE202-2006
iNum = 10
iNum = FCT_1(6,8)
Description:
In the program with the file name of FCT_1, declare one function named as FCT_1,
income two (2) parameters of INT i.e. num1 and num2 respectively, and then add these
two parameters, and post back to the calling procedure, in addition, in another external
file program, use EXTFCT to declare the external function of FCT_1, and then perform
the calling by using the function mode directly, please be aware that the calling of
external function can be up to eight (8) layers as the deepest, the compiler will report
error if exceeded.
Subprogram(EXT)
Declare the external subprogram which indicates that the user writes this subprogram
into a separate independent file, and the name of this independent file shall be the
same as the subprogram name, and call this program outside this independent file.
The external subprogram locates on the first line of program code and must begin
with the keyword of DEF, one file can only define one external function. If it desires
to call the external subprogram, it will have to declare the external subprogram at the
calling program. The declaration of external subprogram must use the keyword of
EXT. After declaration, it will be the same as the calling of general subprogram.
Example of program:
420
C05UE202-2006
iNum = 7
PROG_1(4,iNum)
Description:
In the program with the file name of PROG_1, declare one function named as
PROG_1, income one (1) parameter num1 of INT and one output parameter num2 of
INT, and then add these two parameters, and assign to num2 as the output returning to
the calling procedure, in addition, in another external file program, use EXT to
declare the external function of PROG_1, and then perform the calling by using the
subprogram mode directly, please be aware that the calling of external subprogram
can be up to eight (8) layers as the deepest, the compiler will report error if exceeded.
421
C05UE202-2006
Description:
Program writing and reading the number via RS232.
Parameter explanation:
SER ; RS232
HANDEL ; target folder
CWRITE (HANDLE, SERDATA) ; write the number of SERDATA into
HANDLE
CREAD (HANDLE, SERDATA) ; give the number of HANDLE to SERDATA
CCLEAR (HANDLE) ; clear the number of HANDLE
CINQUIRE(HANDLE,NUM) ; read the received quantity
422
C05UE202-2006
Description:
Program writing and reading the number via network
Parameter explanation:
ETH ; Internet
HANDLE ; target folder
CWRITE (HANDLE, ETHDATR) ; write the number of ETHDATR into
HANDLE
CREAD (HANDLE, ETHDATR) ; give the number of HANDLE to ETHDATR
CCLEAR (HANDLE) ; clear the number of HANDLE
CINQUIRE(HANDLE,NUM)
423
C05UE202-2006
Conveyor 1 CAMERA
Conveyor 2
P2
Pick Example 1
Program description:
This is a visual example.
The robot picks the object from the Conveyor 1 to place on the Conveyor 2. The
position is visually picked, and place P2 on the Conveyor 2.
Program:
CNV_START CNV=1 ; start pick&place
CNV_PICK_QUANTITY = 2 ; set the maximum quantity to pick object
WHILE CNV_FULL == FALSE ; go to loop when the quantity on the robot
doesn’t reach the upper limit..
CNV_PICK CNV=1 OBJ=1 $DO[1] Down=5.000mm FINE Vel=2000mm/s
Acc=50% TOOL[0] BASE[0] ; execute pick
ENDWHILE
WHILE CNV_EMPTY == FALSE ; go to loop when the quantity on the robot is
not empty.
CNV_PLACE $DO[1] P2 FINE Vel=2000mm/s Acc=50% TOOL[0] BASE[0]
; execute place
ENDWHILE
CNV_END CNV=1 ; end pick&place
424
C05UE202-2006
Conveyor 1 Sensor P1
P0
Conveyor 2
P2
Pick Example 2
Program description:
When the position to trigger a sensor is within the picking range, P can be directly set
as the pick and place position.
The robot picks and places the object from the Conveyor 1 to the Conveyor 2. When
the object is triggered by the sensor, the robot will move to P0 and pick, and then
move to P1 and finally place P2.
Program:
CNV_START CNV=1 ; start pick&place
CNV_PICK_QUANTITY = 2 ; set the maximum quantity to pick object
WHILE CNV_FULL == FALSE ; go to loop when the quantity on the robot
doesn’t reach the upper limit.
CNV_PICK CNV=1 $DO[1] P0 Down=5.000mm FINE Vel=2000mm/s Acc=50%
TOOL[0] BASE[0] ; execute pick
ENDWHILE
PTP P1 CONT Vel=100% Acc=50% TOOL[0] BASE[0] ; move to P1
WHILE CNV_EMPTY == FALSE ; go to loop when the quantity on the robot is
not empty.
CNV_PLACE CNV=2 $DO[1] P2 FINE Vel=2000mm/s Acc=50% TOOL[0]
BASE[0]
; execute place
ENDWHILE
CNV_END CNV=1 ; end pick&place
425
C05UE202-2006
ROBOT
Sensor
Conveyor 1 P1
PICKPOINT
Conveyor 2
PLACEPOINT
Pick Example 3
Program description:
When the position to trigger a sensor is beyond the picking range, the command
E6POINT can be used to set the pick and place position.
(Before using the command E6POINT, please ensure the ToolBase coordinates have
been parallel with those for the conveyor. So, you just need to adjust X coordinate or
Y coordinate following P is adjusted).
The robot picks from the Conveyor 1 to the Conveyor 2, waits for the object to move
to PICKPOINT, and then place to PLACEPOINT after moving to P1.
This example will release two objects after they are simultaneously picked.
Program:
CNV_START CNV=1 ; start pick&place
CNV_PICK_QUANTITY = 2 ; set the maximum quantity to pick
object
E6POINT PICKPOINT = P0 ; set the pick point of E6POINT
PICKPOINT.X = PICKPOINT.X - 200
; If our ToolBase coordinate is parallel with the conveyor coordinate, X for
PICKPOINT will be needed.
; the coordinate position minus 200, no change for Y coordinate
E6POINT PLACEPOINT = P2 ; set place point for E6POINT
PLACEPOINT.X = PLACEPOINT.X – 50
; If our ToolBase coordinate is parallel with the conveyor coordinate, X for
426
C05UE202-2006
427
C05UE202-2006
Description:
As shown in below, the command for SYN is given when moving from P1 to P2. P1
and P2 are not in the smooth circumstance. The range of START is from the position
of the accurate position for P1 to P2. The range for END is from P2 to P1; the
command for START Delay in SYN is given to 50ms, which executes the command
for DO[1]=True after the time elapses 50ms. The command for END Delay in SYN is
given to -50ms, which backwards 50ms from P2 to execute DO[2]=True.
Illustration of Example 1
428
C05UE202-2006
Illustration of Example 2
429
C05UE202-2006
Description:
As shown in below, the command for SYN is given when moving from P1 to P2. P1
and P2 are in the smooth circumstance. The range of START is from the position of
the smooth termination for P1 to the smooth start for P2. The range for END is from
the position of the smooth start for P2 to the smooth termination for P2; the command
for START Delay in SYN is given to 50ms, which executes the command for
DO[1]=True after the time elapses 50ms from the position of the smooth termination
for P1. The command for END Delay in SYN is given to -50ms, which executes the
command for DO[2]=True after the time elapses 50ms forward from the central point
of the Bezier curve in the smooth range of P2. For the description of CONT, please
see the Appendix at Chap.8.7.1.
Illustration of Example 3
430
C05UE202-2006
Description:
As shown in below, the command for SYN is given when moving from P1 to P2. The
path is used, as well as P2 and P3 are in the smooth circumstance. The range of
START is from the position of the smooth start for P1 to P4; PATH=50mm and
DELAY = -50ms are in SYN, counting 50mm from the start of P1, moving to 50ms
and executing DO[1] = False; if P3 is the accurate position, the range of START is
from the smooth start of P1 to P3. For the description of CONT, please see the
Appendix at Chap.8.7.1.
Illustration of Example 4
431
C05UE202-2006
Description:
As shown in below, the command for SYN is given when moving from P1 to P2. The
path is used, as well as P1, P2 and P3 are in the smooth circumstance. The range of
START is from the position of the smooth start for P1 to P4; PATH=50mm and
DELAY = -50ms are in SYN, counting 50mm from the smooth start of P1, moving to
50ms and executing DO[1] = False; if P3 is the accurate position, the range of
START is from the smooth start of P1 to P3. For the description of CONT, please see
the Appendix at Chap.8.7.1.
Illustration of Example 5
432
C05UE202-2006
;Initialize: move the robot to the original position, connect to the XEG, and reset the
XEG.
PTP P1 FINE Vel=100% Acc=100% TOOL[0] BASE[0]
;try to connect to the XEG
EG_OPEN(X32)
;reset the XEG
EG_RESET
$C[1]=0
;The major part of the program: recognize two different objects by pick and place.
WHILE $C[1] <= 100
$C[1] = $C[1]+1
;move XEG to a specific position
IF EG_GET_STATUS <0 THEN
;TO DO the handling commands if XEG gets errors
ENDIF
EG_RUN_MOVE(26.5,80)
PTP P6 FINE Vel=100% Acc=100% TOOL[0] BASE[0]
PTP P3 FINE Vel=100% Acc=100% TOOL[0] BASE[0]
;execute the picking command
IF EG_GET_STATUS <0 THEN
;TO DO the handling commands if XEG gets errors
ENDIF
EG_RUN_GRIP(C,25,H,M)
;recognize the objects by the position and status of XEG
IF SelectObject(EG_GET_POS, EG_GET_STATUS) ==2 THEN
PTP P6 FINE Vel=100% Acc=100% TOOL[0] BASE[0]
PTP P2 FINE Vel=100% Acc=100% TOOL[0] BASE[0]
ENDIF
;move XEG to a known position
433
C05UE202-2006
434
C05UE202-2006
435
C05UE202-2006
RETURN 2
ELSE
RETURN 0
ENDIF
ENDIF
ENDFCT
436
C05UE202-2006
8.17. Welding(Optional)
The following is an example program that uses welding and weaving related
commands. Welding is performed according to the welding procedure and welding
conditions set by the interface when starting the arc. The welding operation is
performed according to the set weaving parameters and welding speed. Welding
procedures and welding conditions are processed by arc pits and the welding is ended.
During the welding process, an error resume function is set. When an alarm occurs
between points P0 or a program is manually stopped, the original program can be
restarted and moved to At point P0, if an alarm occurs or a program is manually
stopped at point P1, the reset program named WELD_RESUME in the same directory
will be executed, then the arc will start and move to point P1.
437
C05UE202-2006
CD_START 80
;Turn on collision detection, and set the sensitivity to 80
SET_PAYLOAD[1]
LIN P1 FINE=1 Vel=100mm/s Acc=100% TOOL[0] BASE[0]
LIN P2 FINE=1 Vel=100mm/s Acc=100% TOOL[0] BASE[0]
CD_END
;When gripping an object, it is an expected collision, so turn off collision detection
LIN P3 FINE=1 Vel=100mm/s Acc=100% TOOL[0] BASE[0]
$DO[1] = TRUE
SET_PAYLOAD[2]
CD_START 50
;Turn it on again, and set the sensitivity to 50
LIN P4 FINE=1 Vel=100mm/s Acc=100% TOOL[0] BASE[0]
8.19. Payload
There is a sample program below. Using command to change different payloads after
setting parameters of payload correctly.
SET_PAYLOAD[1]
;Setting payload 1, the weight is only TOOL self
LIN P1 FINE=1 Vel=100mm/s Acc=100% TOOL[0] BASE[0]
LIN P2 FINE=1 Vel=100mm/s Acc=100% TOOL[0] BASE[0]
$DO[1] = TRUE
;Gripping an object
SET_PAYLOAD[2]
;Setting payload 2, the weight is include TOOL and object
LIN P3 FINE=1 Vel=100mm/s Acc=100% TOOL[0] BASE[0]
LIN P4 FINE=1 Vel=100mm/s Acc=100% TOOL[0] BASE[0]
8.20. Interrupt
EXT TEST1()
438
C05UE202-2006
;--------------------------------Interrupt declaration----------------------------------------
INTERRUPT 1 WHEN $DI[1] == TRUE DO TEST1() ; If DI[1] is TRUE trigger
INTERRUPT 2 WHEN $DI[2] == TRUE DO TEST2() ; If DI[2] is TRUE trigger
INTERRUPT 3 WHEN $DI[3] == TRUE DO TEST3() ; If DI[3] is TRUE trigger
INTERRUPT 4 WHEN $DI[4] == TRUE DO TEST4() ; If DI[4] is TRUE trigger
INTERRUPT 5 WHEN $DI[5] == TRUE DO TEST5() ; If DI[5] is TRUE trigger
INTERRUPT 6 WHEN $DI[6] == TRUE DO TEST6() ; If DI[6] is TRUE trigger
INTERRUPT 7 WHEN $DI[7] == TRUE DO TEST7() ; If DI[7] is TRUE trigger
INTERRUPT 8 WHEN $DI[8] == TRUE DO TEST8() ; If DI[8] is TRUE trigger
;INTERRUPT ON 1 ; ENABLE INTERRUPT
;INTERRUPT ON 2; ENABLE INTERRUPT
;INTERRUPT ON 3; ENABLE INTERRUPT
;INTERRUPT ON 4; ENABLE INTERRUPT
;INTERRUPT ON 5; ENABLE INTERRUPT
;INTERRUPT ON 6; ENABLE INTERRUPT
;INTERRUPT ON 7; ENABLE INTERRUPT
;INTERRUPT ON 8; ENABLE INTERRUPT
INTERRUPT ON ALL
;INTERRUPT OFF ALL
;------------------------------------------Initialize------------------------------------------
$C[1] = 0
$C[2] = 0
$C[3] = 0
$C[4] = 0
$C[5] = 0
$C[6] = 0
$C[7] = 0
$C[8] = 0
;------------------------------------------Main Activity------------------------------------------
LOOP
PTP P0 CONT Vel=100% Acc=100% TOOL[0] BASE[0]
PTP P1 CONT Vel=100% Acc=100% TOOL[0] BASE[0]
ENDLOOP
;------------------------------------------------------------------------------------------------------
;----------------------------------------Interrupt subprogram------------------------------------
439
C05UE202-2006
DEF TEST2()
$C[2] = $C[2] + 1 ;Record times of interrupt triggered
E6POINT P10
P10 = GETPOINT ; Record position
PTP P3
PTP P10 Vel = 50% ; Recover robot position
END
DEF TEST3()
$C[3] = $C[3] + 1 ;Record times of interrupt triggered
E6POINT P10
P10 = GETPOINT ; Record position
PTP P4
PTP P10 Vel = 50% ; Recover robot position
END
DEF TEST4()
$C[4] = $C[4] + 1 ;Record times of interrupt triggered
E6POINT P10
P10 = GETPOINT ; Record position
PTP P5
PTP P10 Vel = 50% ; Recover robot position
END
DEF TEST5()
$C[5] = $C[5] + 1 ;Record times of interrupt triggered
E6POINT P10
P10 = GETPOINT ; Record position
PTP P6
PTP P10 Vel = 50% ; Recover robot position
END
DEF TEST6()
$C[6] = $C[6] + 1 ;Record times of interrupt triggered
E6POINT P10
P10 = GETPOINT ; Record position
PTP P7
440
C05UE202-2006
DEF TEST7()
$C[7] = $C[7] + 1 ;Record times of interrupt triggered
E6POINT P10
P10 = GETPOINT ; Record position
PTP P8
PTP P10 Vel = 50% ; Recover robot position
END
DEF TEST8()
$C[8] = $C[8] + 1 ;Record times of interrupt triggered
E6POINT P10
P10 = GETPOINT ; Record position
PTP P9
PTP P10 Vel = 50% ; Recover robot position
END
8.21. Array
E6POS P_ARR[3,3]
INT i,j
FOR i = 1 TO 3 STEP
FOR j = 1 TO 3 STEP
P_ARR[i,j].x = i * 50
P_ARR[i,j].y = 300-j*20
P_ARR[i,j].z = 250
ENDFOR
ENDFOR
441
C05UE202-2006
442
C05UE202-2006
9. Appendix
9.1. Software commands
Motion commands:
Commands Description
PTP Point to point motion
PTP_REL Point to point relative motion
LIN Linear motion
LIN_REL Linear relative motion
CIRC Circular motion
CIRC_REL Circular relative motion
SPLINE…SPL…ENDSPLINE B-Spline curvilinear motion
PTP&PTP_REL flowchart:
LIN&LIN_REL flowchart:
CIRC&CIRC_REL flowchart:
SPLINE Instructions:
SPLINE
SPL P1
…..
SPL P73
443
C05UE202-2006
ENDSPLINE
RS232 or EtherNet Commands:
Commands Description
COPEN Open RS232 or EtherNet
CCLOSE Close RS232 or EtherNet
CCLEAR Delete RS232 or EtherNet data
CREAD Read received data from RS232 or
EtherNet
CWRITE Write RS232 or EtherNet data
CINQUIRE Inquire RS232 or EtherNet package
numbers
Example:
INT HANDLE
INT NUM
REAL SERDATA
COPEN ( SER , HANDLE)
LOOP
IF HANDLE > -1 THEN
CINQUIRE(HANDLE,NUM)
If NUM>0 THEN
CREAD (HANDLE, SERDATA)
ENDIF
CCLEAR (HANDLE)
SERDATA = SERDATA + 1
CWRITE (HANDLE, SERDATA)
ENDIF
WAIT SEC 0.3
ENDLOOP
CCLOSE (HANDLE)
444
C05UE202-2006
445
C05UE202-2006
446
C05UE202-2006
447
C05UE202-2006
Register commands:
Commands Description
$C[#] Counter register
$DI[#] Digital input point register
$DO[#] Digital output point register
$PR[#] Robot input point register
$RI[#] Robot output point register
$RO[#] Timer register
$T[#] Start timer register
$T_STOP[#] Valve output register
$VO[#] Counter register
Example:
$C[1] = 0
$DO[1] = TRUE
WAIT FOR $DI[1] == TRUE
$RO[1] = TRUE
WAIT FOR $RI[1] == TRUE
$VO[1] = TRUE
$T_STOP[1] = TRUE
$T[1] = 0
PR Example 1:
$PR[1] = {A1 1 , A2 2 , A3 3 , A4 4 ,A5 5 , A6 6}
$PR[2] = {X 7 ,Y 8 , Z 9 , A 10 ,B 11 , C 12}
$PR[3] = {A1 1 , A2 2 , A3 3 , A4 4 ,A5 5 , A6 6, X 7 ,Y 8 , Z 9 , A 0,B 0, C 0}
PR Example 2:
E6POS A = {X 10 ,Y 10 ,Z 10 ,A 10 ,B 10 ,C 10}
E6AXIS B = {A1 20 , A2 20 , A3 20 , A4 50 ,A5 10 , A6 20}
E6POINT C = {A1 20 , A2 20 , A3 20 , A4 50 ,A5 10 , A6 20 ,X 10 ,Y 10 ,Z 10 ,A
10 ,B 10 ,C 10}
$PR[1] = A
$PR[2] = B
$PR[3] = C
PR Example 3:
$PR[1] = GETPOINT
448
C05UE202-2006
Variable types:
Commands Description
BOOL Boolean variable type
CHAR Character variable type
E6AXIS Angular variable value type
E6POINT Coordinates or angular variable type
E6POS Coordinates variable type
FRAME BASE or TOOL coordinate system
INT Integer variable type
REAL Real point variable type
Example:
BOOL K = TRUE
CHAR COLOR = 'R'
INT I = 0
REAL R = 0
FRAME:
FRAME POINT = {A1 90}
E6POS/E6AXIS:
E6POS POINT = {X 0,Y 300,Z 200}
E6AXIS POINT = {A1 90}
PTP POINT CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
E6POINT:
E6POINT HOME = {Y 200,Z -1000,A 90}
or
E6POINT HOME = {A1 90}
PTP HOME CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
449
C05UE202-2006
Math Calculation:
Commands Description
ACOS Arc cosine(X)
ASIN Arc sine(X)
ATAN Arc tangent(X)
ATAN2 Arc tangent(X, Y)
COS Cosine(X)
SIN Sine(X)
TAN Tangent(X)
Example:
REAL TESTA
TESTA=ACOS(0)
TESTA=ASIN(0)
TESTA=ATAN(0)
TESTA=ATAN2(0,1)
TESTA=COS(0)
TESTA=SIN(0)
TESTA=TAN(0)
450
C05UE202-2006
Control function
Commands Description
FOR…ENDFOR For loop
GOTO Go to label position
IF…ENDIF IF statement
LOOP…ENDLOOP LOOP
REPEAT…UNTIL Repeat loop
SWITCH…ENDSWITCH Switch statement
WHILE…ENDWHILE While loop
Example:
FOR…ENDFOR:
INT n
FOR n = 0 TO 2 STEP 1
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
ENDFOR
GOTO:
FOUND:
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
GOTO FOUND
IF…ENDIF:
INT n = 1
IF n > 0 THEN
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
ENDIF
LOOP…ENDLOOP:
LOOP
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
ENDLOOP
REPEAT…UNTIL:
INT n =0
REPEAT
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
n=n+1
UNTIL n > 2
451
C05UE202-2006
SWITCH…ENDSWITCH:
INT n =0
LOOP
SWITCH n
CASE 0
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
CASE 1
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
CASE 2
EXIT
ENDSWITCH
n=n+1
ENDLOOP
WHILE…ENDWHILE:
INT n = 2
WHILE n > 0
PTP P0 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
PTP P1 CONT=100% Vel=100% Acc=50% TOOL[0] BASE[0]
n=n-1
ENDWHILE
452
C05UE202-2006
Gripper commands:
Commands Description Example
EG_OPEN Connect with XEG series EG_OPEN(Type)
electric gripper
EG_CLOSE Disconnect current XEG EG_CLOSE
series electric gripper
connection
EG_RESET Reset XEG series electric EG_RESET
gripper
EG_GET_STATUS Get XEG series electric IF EG_GET_STATUS == 2 THEN
gripper status …
ENDIF
EG_RUN_MOVE Move XEG series electric EG_RUN_MOVE(10,20)
gripper
EG_RUN_GRIP Grip action of XEG series EG_RUN_GRIP(C,5,L,M)
electric gripper
EG_RUN_EXPERT Grip action and EG_RUN_EXPERT(C,10,20,5,10,100)
movement of XEG series
electric gripper
EG_GET_POS Get XEG series electric IF EG_GET_POS > 5.00 THEN
gripper position …
ENDIF
Other commands
Commands Description Example
ADDTOOL Add tool ADDTOOL ee
ADDOBJECT Add object ADDTOOL table P:500,200
C:200,50
SET_TOOL Set tool coordinate FRAME T_ONE
system T_ONE.X = 100
SET_TOOL 1
SET_TOOL T_ONE
SET_BASE Set base coordinate FRAME B_ONE
system B_ONE.Y = 100
SET_BASE 1
SET_BASE B_ONE
453
C05UE202-2006
454
Robot System Software-HRSS 3.3 (Original Instruction) User Manual
Publication Date:June 2020, first edition
1. HIWIN is a registered trademark of HIWIN Technologies Corp. For your protection, avoid buying
counterfeit products from unknown sources.
2. Actual products may differ from specifications and photos provided in this catalog. These differences
may be the result of various factors including product improvements.
3. HIWIN website for patented product directory: http://www.hiwin.tw/Products/Products_patents.aspx
4. HIWIN will not sell or export products or processes restricted under the "Foreign Trade Act" or
related regulations. Export of restricted products should be approved by proper authorities in
accordance with relevant laws and shall not be used to manufacture or develop nuclear, biochemical,
missiles or other weapons.
HIWIN GmbH HIWIN Schweiz GmbH HIWIN KOREA HIWIN TECHNOLOGIES CORP.
OFFENBURG, GERMANY JONA, SWITZERLAND SUWON‧CHANGWON, KOREA No. 7, Jingke Road,
www.hiwin.de www.hiwin.ch www.hiwin.kr Taichung Precision Machinery Park,
www.hiwin.eu [email protected] [email protected]
[email protected] Taichung 40852, Taiwan
Tel: +886-4-23594510
Fax: +886-4-23594420
www.hiwin.tw
HIWIN JAPAN HIWIN s.r.o. HIWIN CHINA [email protected]
KOBE‧TOKYO‧NAGOYA‧NAGANO‧ BRNO, CZECH REPUBLIC SUZHOU, CHINA
TOHOKU‧SHIZUOKA.HOKURIKU‧ www.hiwin.cz www.hiwin.cn
HIROSHIMA‧FUKUOKA‧KUMAMOTO, [email protected] [email protected]
JAPAN
www.hiwin.co.jp
[email protected]
HIWIN Srl
BRUGHERIO, ITALY
www.hiwin.it
[email protected]