RAPID Refer4.0
RAPID Refer4.0
RAPID Refer4.0
Instructions
Functions
Index
The information in this document is subject to change without notice and should not be construed as a commit-
ment by ABB Robotics AB. ABB Robotics AB assumes no responsibility for any errors that may appear in this
document.
In no event shall ABB Robotics AB be liable for incidental or consequential damages arising from use of this doc-
ument or of the software and hardware described in this document.
This document and parts thereof must not be reproduced or copied without ABB Robotics AB´s written permis-
sion, and contents thereof must not be imparted to a third party nor be used for any unauthorized purpose. Con-
travention will be prosecuted.
Additional copies of this document may be obtained from ABB Robotics AB at its then current charge.
© ABB Robotics AB
ABB Robotics AB
S-721 68 Västerås
Sweden
Data Types
CONTENTS
aiotrigg (Analog I/O Trigger) is used to define the condition to generate an interrupt
for an analog input or output signal.
Description
Data of the type aiotrigg defines the way a low and a high threshold will be used to
determine whether the logical value of an analog signal satisfies a condition to generate
an interrupt.
Example
VAR intnum sig1int;
CONNECT sig1int WITH iroutine1;
ISignalAI \Single, ai1, AIO_BETWEEN, 1.5, 0.5, 0, sig1int;
Orders an interrupt which is to occur the first time the logical value of the analog
input signal ai1 is between 0.5 and 1.5. A call is then made to the iroutine1 trap
routine.
Predefined data
The following symbolic constants of the data type aiotrigg are predefined and can be
used when specifying a condition for the instructions ISignalAI and ISignalAO.
5 AIO_BETWEEN Signal will generate interrupts if between specified low and high
values
Characteristics
aiotrigg is an alias data type for num and consequently inherits its characteristics.
Related information
Described in:
Interrupt from analog input signal Instructions - ISignalAI
Interrupt from analog output signal Instructions - ISignalAO
Data types in general, alias data types Basic Characteristics - Data Types
Description
The value of data of the type bool can be either TRUE or FALSE.
Examples
flag1 := TRUE;
highvalue is assigned the value TRUE if reg1 is greater than 100; otherwise,
FALSE is assigned.
Related information
Described in:
Logical expressions Basic Characteristics - Expressions
Operations using logical values Basic Characteristics - Expressions
Byte is used for decimal values (0 - 255) according to the range of a byte.
This data type is used in conjunction with instructions and functions that handle the bit
manipulations and convert features.
Description
Data of the type byte represents a decimal byte value.
Examples
CONST num parity_bit := 8;
Bit number 8 (parity_bit) in the variable data1 will be set to 0, e.g. the content
of the variable data1 will be changed from 130 to 2 (decimal representation).
Error handling
If an argument of the type byte has a value that is not in the range between 0 and 255,
an error is returned on program execution.
Characteristics
Byte is an alias data type for num and consequently inherits its characteristics.
Related information
Described in:
Alias data types Basic Characteristics- Data Types
Bit functions RAPID Summary - Bit Functions
Clock is used for time measurement. A clock functions like a stopwatch used for tim-
ing.
Description
Data of the type clock stores a time measurement in seconds and has a resolution of
0.01 seconds.
Example
VAR clock clock1;
ClkReset clock1;
The clock, clock1, is declared and reset. Before using ClkReset, ClkStart, ClkStop and
ClkRead, you must declare a variable of data type clock in your program.
Limitations
The maximum time that can be stored in a clock variable is approximately 49 days
(4,294,967 seconds). The instructions ClkStart, ClkStop and ClkRead report clock
overflows in the very unlikely event that one occurs.
A clock must be declared as a VAR variable type, not as a persistent variable type.
Characteristics
Clock is a non-value data type and cannot be used in value-oriented operations.
Related Information
Described in:
Summary of Time and Date Instructions RAPID Summary - System & Time
Non-value data type characteristics Basic Characteristics - Data Types
Description
All positions of the robot are defined and stored using rectangular coordinates. When
calculating the corresponding axis positions, there will often be two or more possible
solutions. This means that the robot is able to achieve the same position, i.e. the tool is
in the same position and with the same orientation, with several different positions or
configurations of the robots axes.
Some robot types use iterative numerical methods to determine the robot axes
positions. In these cases the configuration parameters may be used to define good
starting values for the joints to be used by the iterative procedure.
-4 3
-1 0
-3 -2 1 2
For a linear axis, the value defines a meter interval for the robot axis. For each axis,
value 0 means a position between 0 and 1 meters, 1 means a position between 1 and 2
meters. For negative values, -1 means a position between -1 and 0 meters, etc. (see
Figure 2).
-3 -2 -1 0 1 2 Configuration value
cfx is used to select one of eight possible robot configurations numbered from 0
through 7. The table below describes each one of them in terms of how the robot is
positioned relative to the three singularities.
The pictures below give an example of how the same tool position and orientation is
ABB
ABB
beta -beta
cfx = 0 cfx = 1
Figure 3 Example of robot configuration 0 and 1. Note the different signs of the axis 5 angle.
Axis 1 Axis 1
beta -beta
ABB
ABB
Wrist centre
Wrist centre
cfx = 2 cfx = 3
Figure 4 Example of robot configuration 2 and 3. Note the different signs of the axis 5 angle.
AB
B
AB
B
Lower arm Lower arm
cfx = 4 cfx = 5
Figure 5 Example of robot configuration 4 and 5. Note the different signs of the axis 5 angle.
ABB
beta ABB -beta
cfx = 6 cfx = 7
Figure 6 Example of robot configuration 6 and 7. Note the different signs of the axis 5 angle.
Because the robot’s structure is mainly linear, the correct setting of the configuration
parameters c1, cx is of less importance.
Components
cf1 Data type: num
Rotating axis:
Linear axis:
Rotating axis:
Linear axis:
Rotating axis:
Linear axis:
Rotating axis:
For the IRB140, the current robot configuration, expressed as an integer in the
range from 0 to 7.
For other robots, using the current quadrant of axis 2, expressed as a positive or
negative integer.
Linear axis:
Example
VAR confdata conf15 := [1, -1, 0, 0]
Structure
< dataobject of confdata >
< cf1 of num >
< cf4 of num >
< cf6 of num >
< cfx of num >
Related information
Described in:
Coordinate systems Motion and I/O Principles -
Coordinate Systems
Handling configuration data Motion and I/O Principles - Robot
Configuration
Dionum (digital input output numeric) is used for digital values (0 or 1).
This data type is used in conjunction with instructions and functions that handle digital
input or output signals.
Description
Data of the type dionum represents a digital value 0 or 1.
Examples
CONST dionum close := 1;
Error handling
If an argument of the type dionum has a value that is neither equal to 0 nor 1, an error
is returned on program execution.
Characteristics
Dionum is an alias data type for num and consequently inherits its characteristics.
Related information
Described in:
Summary input/output instructions RAPID Summary -
Input and Output Signals
Configuration of I/O User’s Guide - System Parameters
Alias data types Basic Characteristics- Data Types
Errnum is used to describe all recoverable (non fatal) errors that occur during program
execution, such as division by zero.
Description
If the robot detects an error during program execution, this can be dealt with in the
error handler of the routine. Examples of such errors are values that are too high and
division by zero. The system variable ERRNO, of type errnum, is thus assigned
different values depending on the nature of an error. The error handler may be able to
correct an error by reading this variable and then program execution can continue in
the correct way.
An error can also be created from within the program using the RAISE instruction.
This particular type of error can be detected in the error handler by specifying an error
number (within the range 1-90 or booked with instruction BookErrNo) as an argument
to RAISE.
Examples
reg1 := reg2 / reg3;
.
ERROR
IF ERRNO = ERR_DIVZERO THEN
reg3 := 1;
RETRY;
ENDIF
If reg3 = 0, the robot detects an error when division is taking place. This error,
however, can be detected and corrected by assigning reg3 the value 1. Following
this, the division can be performed again and program execution can continue.
An error occurs in a machine (detected by means of the input signal di1). A jump
is made to the error handler in the routine which, in turn, calls the error handler
of the calling routine where the error may possibly be corrected. The constant,
machine_error, is used to let the error handler know exactly what type of error
has occurred.
Predefined data
The system variable ERRNO can be used to read the latest error that occurred. A
number of predefined constants can be used to determine the type of error that has
occurred.
Characteristics
Errnum is an alias data type for num and consequently inherits its characteristics.
Related information
Described in:
Error recovery RAPID Summary - Error Recovery
Basic Characteristics - Error Recovery
Data types in general, alias data types Basic Characteristics - Data Types
Extjoint is used to define the axis positions of external axes, positioners or workpiece
manipulators.
Description
The robot can control up to six external axes in addition to its six internal axes, i.e. a
total of twelve axes. The six external axes are logically denoted: a, b, c, d, e, f. Each
such logical axis can be connected to a physical axis and, in this case, the connection
is defined in the system parameters.
Data of the type extjoint is used to hold position values for each of the logical axes a - f.
For each logical axis connected to a physical axis, the position is defined as follows:
- For rotating axes – the position is defined as the rotation in degrees from the
calibration position.
- For linear axes – the position is defined as the distance in mm from the calibra-
tion position.
If a logical axis is not connected to a physical one, the value 9E9 is used as a position
value, indicating that the axis is not connected. At the time of execution, the position
data of each axis is checked and it is checked whether or not the corresponding axis is
connected. If the stored position value does not comply with the actual axis connection,
the following applies:
- If the position is not defined in the position data (value is 9E9), the value will
be ignored if the axis is connected and not activated. But if the axis is activated,
it will result in an error.
- If the position is defined in the position data, although the axis is not connected,
the value will be ignored.
If an external axis offset is used (instruction EOffsOn or EOffsSet), the positions are
specified in the ExtOffs coordinate system.
Components
eax_a (external axis a) Data type: num
...
The position of the external logical axis “f”, expressed in degrees or mm (depend-
ing on the type of axis).
Example
VAR extjoint axpos10 := [ 11, 12.3, 9E9, 9E9, 9E9, 9E9] ;
- The position of the external logical axis “a” is set to 11, expressed in degrees or
mm (depending on the type of axis).
- The position of the external logical axis “b” is set to 12.3, expressed in degrees
or mm (depending on the type of axis).
- Axes c to f are undefined.
Structure
< dataobject of extjoint >
< eax_a of num >
< eax_b of num >
< eax_c of num >
< eax_d of num >
< eax_e of num >
< eax_f of num >
Related information
Described in:
Position data Data Types - robtarget
ExtOffs coordinate system Instructions - EOffsOn
Description
When a variable of type intnum is connected to a trap routine, it is given a specific
value identifying the interrupt. This variable is then used in all dealings with the inter-
rupt, such as when ordering or disabling an interrupt.
More than one interrupt identity can be connected to the same trap routine. The system
variable INTNO can thus be used in a trap routine to determine the type of interrupt that
occurs.
Examples
VAR intnum feeder_error;
.
CONNECT feeder_error WITH correct_feeder;
ISignalDI di1, 1, feeder_error;
An interrupt is generated when the input di1 is set to 1. When this happens, a call
is made to the correct_feeder trap routine.
An interrupt is generated when either of the inputs di1 or di2 is set to 1. A call is
then made to the correct_feeder trap routine. The system variable INTNO is used
in the trap routine to find out which type of interrupt has occurred.
Limitations
The maximum number of active variables of type intnum at any one time (between
CONNECT and IDelete) is limited to 40.The maximum number of interrupts, in the
queue for execution of TRAP routine at any one time, is limited to 30.
Characteristics
Intnum is an alias data type for num and thus inherits its properties.
Related information
Described in:
Summary of interrupts RAPID Summary - Interrupts
Alias data types Basic Characteristics-
Data Types
Iodev (I/O device) is used for serial channels, such as printers and files.
Description
Data of the type iodev contains a reference to a file or serial channel. It can be linked
to the physical unit by means of the instruction Open and then used for reading and
writing.
Example
VAR iodev file;
.
Open “HOME:/LOGDIR/INFILE.DOC”, file\Read;
input := ReadNum(file);
The file INFILE.DOC is opened for reading. When reading from the file, file is
used as a reference instead of the file name.
Characteristics
Iodev is a non-value data type.
Related information
Described in:
Communication via serial channels RAPID Summary - Communication
Configuration of serial channels User’s Guide - System Parameters
Characteristics of non-value data types Basic Characteristics - Data Types
Jointtarget is used to define the position that the robot and the external axes will move
to with the instruction MoveAbsJ.
Description
Jointtarget defines each individual axis position, for both the robot and the external
axes.
Components
robax (robot axes) Data type: robjoint
Axis position is defined as the rotation in degrees for the respective axis (arm) in
a positive or negative direction from the axis calibration position.
The position is defined as follows for each individual axis (eax_a, eax_b ...
eax_f):
- For rotating axes, the position is defined as the rotation in degrees from the cal-
ibration position.
- For linear axes, the position is defined as the distance in mm from the calibra-
tion position.
External axes eax_a ... are logical axes. How the logical axis number and the
physical axis number are related to each other is defined in the system parame-
ters.
The value 9E9 is defined for axes which are not connected. If the axes defined in
the position data differ from the axes that are actually connected on program exe-
cution, the following applies:
- If the position is not defined in the position data (value 9E9) the value will be
ignored, if the axis is connected and not activated. But if the axis is activated it
will result in error.
- If the position is defined in the position data yet the axis is not connected, the
value is ignored.
Examples
CONST jointtarget calib_pos := [ [ 0, 0, 0, 0, 0, 0], [ 0, 9E9, 9E9, 9E9, 9E9, 9E9] ];
The normal calibration position for IRB2400 is defined in calib_pos by the data
type jointtarget. The normal calibration position 0 (degrees or mm) is also
defined for the external logical axis a. The external axes b to f are undefined.
Structure
< dataobject of jointtarget >
< robax of robjoint >
< rax_1 of num >
< rax_2 of num >
< rax_3 of num >
< rax_4 of num >
< rax_5 of num >
< rax_6 of num >
< extax of extjoint >
< eax_a of num >
< eax_b of num >
< eax_c of num >
< eax_d of num >
< eax_e of num >
< eax_f of num >
Related information
Described in:
Move to joint position Instructions - MoveAbsJ
Positioning instructions RAPID Summary - Motion
Configuration of external axes User’s Guide - System Parameters
Loaddata is used to describe loads attached to the mechanical interface of the robot
(the robot’s mounting flange).
Load data usually defines the payload (grip load is defined by the instruction Gri-
pLoad) of the robot, i.e. the load held in the robot gripper. The tool load is specified in
the tool data (tooldata) which includes load data.
Description
Specified loads are used to set up a model of the dynamics of the robot so that the robot
movements can be controlled in the best possible way.
It is important to always define the actual tool load and when used, the payload
of the robot too. Incorrect definitions of load data can result in overloading of the
robot mechanical structure.
When incorrect load data is specified, it can often lead to the following consequences:
- If the value in the specified load data is greater than that of the value of the true
load;
-> The robot will not be used to its maximum capacity
-> Impaired path accuracy including a risk of overshooting
-> Risk of overloading the mechanical structure
- If the value in the specified load data is less than the value of the true load;
-> Impaired path accuracy including a risk of overshooting
-> Risk of overloading the mechanical structure
Components
mass Data type: num
The centre of gravity of a tool load expressed in the wrist coordinate system.
If a stationary tool is used, it means the centre of gravity for the tool holding the
work object.
The centre of gravity of a payload expressed in the tool coordinate system. The
object coordinate system when a stationary tool is used.
The orientation of the coordinate system defined by the inertial axes of the tool
load. Expressed in the wrist coordinate system as a quaternion (q1, q2, q3, q4). If
a stationary tool is used, it means the inertial axes for the tool holding the work
object.
The orientation of the tool load coordinate system must coincide with the orien-
tation of the wrist coordinate system. It must always be set to 1, 0, 0, 0.
The orientation of the coordinate system defined by the inertial axes of the pay-
load. Expressed in the tool coordinate system as a quaternion (q1, q2, q3, q4). The
object coordinate system if a stationary tool is used.
The orientation of the payload coordinate system must coincide with the orienta-
tion of the wrist coordinate system. It must always be set to 1, 0, 0, 0.
Because of this limitation, the best way is to define the orientation of the tool
coordinate system (tool frame) to coincide with the orientation of the wrist coor-
dinate system.
IY’
IZ’
Payload coordinate system -
Inertial axes of payload
IX’
Figure 7 Restriction on the orientation of tool load and payload coordinate system.
Z Gripper
Y Tool coordinate system
Z
Y’
Payload coordinate
X
Z’ system -
Inertial axes of payload
X
Payload
The moment of inertia of the load around the x-axis of the tool load or payload
coordinate system in kgm2.
Correct definition of the inertial moments will allow optimal utilisation of the
path planner and axes control. This may be of special importance when handling
large sheets of metal, etc. All inertial moments of inertia ix, iy and iz equal to
0 kgm2 imply a point mass.
Normally, the inertial moments must only be defined when the distance from the
mounting flange to the centre of gravity is less than the dimension of the load
(see Figure 9).
payload
distance
x
dimension
Figure 9 The moment of inertia must normally be defined when the distance
is less than the load dimension.
The inertial moment of the load around the y-axis, expressed in kgm2.
The inertial moment of the load around the z-axis, expressed in kgm2.
Examples
PERS loaddata piece1 := [ 5, [50, 0, 50], [1, 0, 0, 0], 0, 0, 0];
- Weight 5 kg.
- The centre of gravity is x = 50, y = 0 and z = 50 mm in the tool coordinate sys-
tem.
- The payload is a point mass.
Set gripper;
WaitTime 0.3;
GripLoad piece1;
Connection of the payload, piece1, specified at the same time as the robot grips
the load piece1.
Reset gripper;
WaitTime 0.3;
GripLoad load0;
Disconnection of a payload, specified at the same time as the robot releases a pay-
load.
Limitations
The payload should only be defined as a persistent variable (PERS) and not within a
routine. Current values are then saved when storing the program on diskette and are
retrieved on loading.
Arguments of the type load data in the GripLoad instruction should only be an entire
persistent (not array element or record component).
Predefined data
The load load0 defines a payload, the weight of which is equal to 0 kg, i.e. no load at
all. This load is used as the argument in the instruction GripLoad to disconnect a pay-
load.
The load load0 can always be accessed from the program, but cannot be changed (it is
stored in the system module BASE).
Structure
< dataobject of loaddata >
< mass of num >
< cog of pos >
< x of num >
< y of num >
< z of num >
< aom of orient >
< q1 of num >
< q2 of num >
< q3 of num >
< q4 of num >
< ix of num >
< iy of num >
< iz of num >
Related information
Described in:
Coordinate systems Motion and I/O Principles - Coordi-
nate Systems
Definition of tool loads Data Types - tooldata
Activation of payload Instructions - GripLoad
Description
Data of the type loadsession is used in the instructions StartLoad and WaitLoad, to
identify the load session. Loadsession only contains a reference to the load session.
Characteristics
Loadsession is a non-value data type and cannot be used in value-oriented operations.
Related information
Described in:
Loading program modules during execution Instructions - StartLoad, WaitLoad
Characteristics of non-value data types Basic Characteristics - Data Types
Mecunit is used to define the different mechanical units which can be controlled and
accessed from the robot and the program.
The names of the mechanical units are defined in the system parameters and, conse-
quently, must not be defined in the program.
Description
Data of the type mecunit only contains a reference to the mechanical unit.
Limitations
Data of the type mecunit must not be defined in the program. The data type can, on the
other hand, be used as a parameter when declaring a routine.
Predefined data
The mechanical units defined in the system parameters can always be accessed from
the program (installed data).
Characteristics
Mecunit is a non-value data type. This means that data of this type does not permit
value-oriented operations.
Related information
Described in:
Activating/Deactivating mechanical units Instructions - ActUnit, DeactUnit
Configuration of mechanical units User’s Guide - System Parameters
Characteristics of non-value data types Basic Characteristics - Data Types
Motsetdata is used to define a number of motion settings that affect all positioning
instructions in the program:
This data type does not normally have to be used since these settings can only be set
using the instructions VelSet, AccSet, SingArea, ConfJ, ConfL, PathResol and
MotionSup.
The current values of these motion settings can be accessed using the system variable
C_MOTSET.
Description
The current motion settings (stored in the system variable C_MOTSET) affect all
movements.
Components
vel.oride Data type: veldata/num
The orientation of the tool is allowed to deviate somewhat in order to prevent arm
singularity (not implemented).
Maximum permitted deviation in degrees for axis 1 (not used in this version).
Maximum permitted deviation in degrees for axis 4 (not used in this version).
Maximum permitted deviation in degrees for axis 6 (not used in this version).
Limitations
One and only one of the components sing.wrist, sing.arm or sing.base may have a value
equal to TRUE.
Example
IF C_MOTSET.vel.oride > 50 THEN
...
ELSE
...
ENDIF
Different parts of the program are executed depending on the current velocity
override.
Predefined data
C_MOTSET describes the current motion settings of the robot and can always be
accessed from the program (installed data). C_MOTSET, on the other hand, can only
be changed using a number of instructions, not by assignment.
- at a cold start-up
- when a new program is loaded
- when starting program execution from the beginning.
Structure
<dataobject of motsetdata>
<vel of veldata > -> Affected by instruction VelSet
< oride of num >
< max of num >
<acc of accdata > -> Affected by instruction AccSet
< acc of num >
< ramp of num >
<sing of singdata > -> Affected by instruction SingArea
< wrist of bool >
< arm of bool >
< base of bool >
<conf of confsupdata > -> Affected by instructions ConfJ and ConfL
< jsup of bool >
<lsup of bool >
< ax1 of num >
< ax4 of num >
< ax6 of num >
<pathresol of num> -> Affected by instruction PathResol
<motionsup of bool> -> Affected by instruction MotionSup
<tunevalue of num> -> Affected by instruction MotionSup
Related information
Described in:
Description
The value of the num data type may be
Integers between -8388607 and +8388608 are always stored as exact integers.
Decimal numbers are only approximate numbers and should not, therefore, be used in
is equal to or is not equal to comparisons. In the case of divisions, and operations using
decimal numbers, the result will also be a decimal number; i.e. not an exact integer.
E.g. a := 10;
b := 5;
IF a/b=2 THEN As the result of a/b is not an integer,
this condition is not necessarily
... satisfied.
Example
VAR num reg1;
.
reg1 := 3;
a := 10 DIV 3;
b := 10 MOD 3;
Predefined data
The constant pi (π) is already defined in the system module BASE.
The constants EOF_BIN and EOF_NUM are already defined in the system.
Related information
Described in:
Numeric expressions Basic Characteristics - Expressions
Operations using numeric values Basic Characteristics - Expressions
o_jointtarget (original joint target) is used in combination with the function Absolute
Limit Modpos. When this function is used to modify a position, the original position is
stored as a data of the type o_jointtarget.
Description
If the function Absolute Limit Modpos is activated and a named position in a movement
instruction is modified with the function Modpos, then the original programmed posi-
tion is saved.
The same program after ModPos in which the point jpos40 is corrected to 2 degrees
for robot axis 1:
The original programmed point has now been saved in o_jpos40 (by the data type
o_jointtarget) and the modified point saved in jpos40 (by the data type jointtarget).
By saving the original programmed point, the robot can monitor that further Modpos
of the point in question are within the acceptable limits from the original programmed
point.
The fixed name convention means that an original programmed point with the name
xxxxx is saved with the name o_xxxxx by using Absolute Limit Modpos.
Components
robax (robot axes) Data type: robjoint
Structure
< dataobject of o_jointtarget >
< robax of robjoint>
< rax_1 of num >
< rax_2 of num >
< rax_3 of num >
< rax_4 of num >
< rax_5 of num >
< rax_6 of num >
< extax of extjoint >
< eax_a of num >
< eax_b of num >
< eax_c of num >
< eax_d of num >
< eax_e of num >
< eax_f of num >
Related information
Described in:
Position data Data Types - Jointtarget
Configuration of Limit Modpos User’s Guide - System Parameters
orient Orientation
Orient is used for orientations (such as the orientation of a tool) and rotations (such as
the rotation of a coordinate system).
Description
The orientation is described in the form of a quaternion which consists of four ele-
ments: q1, q2, q3 and q4. For more information on how to calculate these, see below.
Components
q1 Data type: num
Quaternion 1.
Quaternion 2.
Quaternion 3.
Quaternion 4.
Example
VAR orient orient1;
.
orient1 := [1, 0, 0, 0];
The orient1 orientation is assigned the value q1=1, q2-q4=0; this corresponds to
no rotation.
Limitations
The orientation must be normalised; i.e. the sum of the squares must equal 1:
q 12 + q 22 + q 32 + q 42 = 1
What is a Quaternion?
The orientation of a coordinate system (such as that of a tool) can be described by a
rotational matrix that describes the direction of the axes of the coordinate system in
relation to a reference system (see Figure 10).
z
z
x
y Rotated
Reference
coordinate
coordinate
system
x system
y
Figure 10 The rotation of a coordinate system is described by a quaternion.
The rotated coordinate systems axes (x, y, z) are vectors which can be expressed in the
reference coordinate system as follows:
This means that the x-component of the x-vector in the reference coordinate system
will be x1, the y-component will be x2, etc.
These three vectors can be put together in a matrix, a rotational matrix, where each of
the vectors form one of the columns:
x1 y1 z1
x2 y2 z2
x3 y3 z3
A quaternion is just a more concise way to describe this rotational matrix; the quater-
nions are calculated based on the elements of the rotational matrix:
x1 + y2 + z3 + 1
q1 = -----------------------------------------
2
x 1 – y2 – z3 + 1
q2 = ----------------------------------------
2
sign q2 = sign (y3-z2)
y 2 – x1 – z3 + 1
q3 = ----------------------------------------
2
sign q3 = sign (z1-x3)
z3 – x 1 – y2 + 1
q4 = ----------------------------------------
2
sign q4 = sign (x2-y1)
Example 1
A tool is orientated so that its Z’-axis points straight ahead (in the same direction as the
X-axis of the base coordinate system). The Y’-axis of the tool corresponds to the Y-
axis of the base coordinate system (see Figure 11). How is the orientation of the tool
defined in the position data (robtarget)?
The orientation of the tool in a programmed position is normally related to the coordi-
nate system of the work object used. In this example, no work object is used and the
base coordinate system is equal to the world coordinate system. Thus, the orientation
is related to the base coordinate system.
Z´
X´
X
Figure 11 The direction of a tool in accordance with example 1.
x’ = -z = (0, 0, -1)
y’ = y = (0, 1, 0)
z’ = x = (1, 0, 0) 0 0 1
0 1 0
Which corresponds to the following rotational matrix:
–1 0 0
The rotational matrix provides a corresponding quaternion:
0+1+0+1 2
q1 = ----------------------------------- = ------- = 0,707
2 2
0–1–0+1
q2 = ---------------------------------- = 0
2
1–0–0+1 2
q3 = ---------------------------------- = ------- = 0,707 sign q3 = sign (1+1) = +
2 2
0–0–1+1
q4 = ---------------------------------- = 0
2
Example 2
The direction of the tool is rotated 30o about the X’- and Z’-axes in relation to the wrist
coordinate system (see Figure 11). How is the orientation of the tool defined in the tool
data?
X Z´
X´
x’ = (cos30o, 0, -sin30o)
x’ = (0, 1, 0)
x’ = (sin30o, 0, cos30o)
cos 30 ° 0 sin 30 °
Which corresponds to the following rotational matrix: 0 1 0
– sin 30 ° 0 cos 30 °
The rotational matrix provides a corresponding quaternion:
cos 30 ° + 1 + cos 30° + 1
q1 = ---------------------------------------------------------------- = 0,965926
2
Structure
<dataobject of orient>
<q1 of num>
<q2 of num>
<q3 of num>
<q4 of num>
Related information
Described in:
Operations on orientations Basic Characteristics - Expressions
o_robtarget (original robot target) is used in combination with the function Absolute
Limit Modpos. When this function is used to modify a position, the original position is
stored as a data of the type o_robtarget.
Description
If the function Absolute Limit Modpos is activated and a named position in a movement
instruction is modified with the function Modpos, then the original programmed posi-
tion is saved.
CONST robtarget p50 := [[500, 500, 500], [1, 0, 0, 0], [1, 1, 0, 0],
[500, 9E9, 9E9, 9E9, 9E9, 9E9] ];
...
MoveL p50, v1000, z50, tool1;
The same program after ModPos in which the point p50 is corrected to 502 in the x-
direction:
CONST robtarget p50 := [[502, 500, 500], [1, 0, 0, 0], [1, 1, 0, 0],
[500, 9E9, 9E9, 9E9, 9E9, 9E9] ];
CONST o_robtarget o_p50 := [[500, 500, 500], [1, 0, 0, 0], [1, 1, 0, 0],
[ 500, 9E9, 9E9, 9E9, 9E9, 9E9] ];
...
MoveL p50, v1000, z50, tool1;
The original programmed point has now been saved in o_p50 (by the data type
o_robtarget) and the modified point saved in p50 (by the data type robtarget).
By saving the original programmed point, the robot can monitor that further Modpos
of the point in question are within the acceptable limits from the original programmed
point.
The fixed name convention means that an original programmed point with the name
xxxxx is saved with the name o_xxxxx by using Absolute Limit Modpos.
Components
trans (translation) Data type: pos
The position (x, y and z) of the tool centre point expressed in mm.
The orientation of the tool, expressed in the form of a quaternion (q1, q2, q3 and q4).
The axis configuration of the robot (cf1, cf4, cf6 and cfx).
Structure
< dataobject of o_robtarget >
< trans of pos >
< x of num >
< y of num >
< z of num >
< rot of orient >
< q1 of num >
< q2 of num >
< q3 of num >
< q4 of num >
< robconf of confdata >
< cf1 of num >
< cf4 of num >
< cf6 of num >
< cfx of num >
< extax of extjoint >
< eax_a of num >
< eax_b of num >
< eax_c of num >
< eax_d of num >
< eax_e of num >
< eax_f of num >
Related information
Described in:
Position data Data Types - Robtarget
Configuration of Limit Modpos User’s Guide - System Parameters
The robtarget data type is used for the robot’s position including the orientation of the
tool and the configuration of the axes.
Description
Data of the type pos describes the coordinates of a position: X, Y and Z.
Components
x Data type: num
Examples
VAR pos pos1;
.
pos1 := [500, 0, 940];
The pos1 position is assigned the value: X=500 mm, Y=0 mm, Z=940 mm.
Structure
<dataobject of pos>
<x of num>
<y of num>
<z of num>
Related information
Described in:
Operations on positions Basic Characteristics - Expressions
Robot position including orientation Data Types- robtarget
Description
Data of the type pose describes how a coordinate system is displaced and rotated
around another coordinate system. The data can, for example, describe how the tool
coordinate system is located and oriented in relation to the wrist coordinate system.
Components
trans (translation) Data type: pos
Example
VAR pose frame1;
.
frame1.trans := [50, 0, 40];
frame1.rot := [1, 0, 0, 0];
Structure
<dataobject of pose>
<trans of pos>
<rot of orient>
Related information
Described in:
What is a Quaternion? Data Types - orient
Progdisp is used to store the current program displacement of the robot and the exter-
nal axes.
This data type does not normally have to be used since the data is set using the instruc-
tions PDispSet, PDispOn, PDispOff, EOffsSet, EOffsOn and EOffsOff. It is only used
to temporarily store the current value for later use.
Description
The current values for program displacement can be accessed using the system variable
C_PROGDISP.
For more information, see the instructions PDispSet, PDispOn, EOffsSet and EOffsOn.
Components
pdisp (program displacement) Data type: pose
The program displacement for the robot, expressed using a translation and an ori-
entation. The translation is expressed in mm.
The offset for each of the external axes. If the axis is linear, the value is expressed
in mm; if it is rotating, the value is expressed in degrees.
Example
VAR progdisp progdisp1;
.
SearchL sen1, psearch, p10, v100, tool1;
PDispOn \ExeP:=psearch, *, tool1;
EOffsOn \ExeP:=psearch, *;
.
progdisp1:=C_PROGDISP;
PDispOff;
EOffsOff;
.
PDispSet progdisp1.pdisp;
EOffsSet progdisp1.eoffs;
Predefined data
The system variable C_PROGDISP describes the current program displacement of the
robot and external axes, and can always be accessed from the program (installed data).
C_PROGDISP, on the other hand, can only be changed using a number of instructions,
not by assignment.
Structure
< dataobject of progdisp >
<pdisp of pose>
< trans of pos >
< x of num >
< y of num >
< z of num >
< rot of orient >
< q1 of num >
< q2 of num >
< q3 of num >
< q4 of num >
< eoffs of extjoint >
< eax_a of num >
< eax_b of num >
< eax_c of num >
< eax_d of num >
< eax_e of num >
< eax_f of num >
Related information
Described in:
Robjoint is used to define the axis position in degrees of the robot axes.
Description
Data of the type robjoint is used to store axis positions in degrees of the robot axes 1
to 6. Axis position is defined as the rotation in degrees for the respective axis (arm) in
a positive or negative direction from the axis calibration position.
Components
rax_1 (robot axis 1) Data type: num
...
Structure
< dataobject of robjoint >
< rax_1 of num >
< rax_2 of num >
< rax_3 of num >
< rax_4 of num >
< rax_5 of num >
< rax_6 of num >
Related information
Described in:
Joint position data Data Types - jointtarget
Move to joint position Instructions - MoveAbsJ
Robtarget (robot target) is used to define the position of the robot and external axes.
Description
Position data is used to define the position in the positioning instructions to which the
robot and external axes are to move.
As the robot is able to achieve the same position in several different ways, the axis
configuration is also specified. This defines the axis values if these are in any way
ambiguous, for example:
The position is defined based on the coordinate system of the work object,
including any program displacement. If the position is programmed with some
other work object than the one used in the instruction, the robot will not move in
the expected way. Make sure that you use the same work object as the one used
when programming positioning instructions. Incorrect use can injure someone or
damage the robot or other equipment.
Components
trans (translation) Data type: pos
The position (x, y and z) of the tool centre point expressed in mm.
The orientation of the tool, expressed in the form of a quaternion (q1, q2, q3 and q4).
The axis configuration of the robot (cf1, cf4, cf6 and cfx). This is defined in the
form of the current quarter revolution of axis 1, axis 4 and axis 6. The first
positive quarter revolution 0 to 90 o is defined as 0. The component cfx is only
used for the robot model IRB5400.
The position is defined as follows for each individual axis (eax_a, eax_b ...
eax_f):
- For rotating axes, the position is defined as the rotation in degrees from the
calibration position.
- For linear axes, the position is defined as the distance in mm from the
calibration position.
External axes eax_a ... are logical axes. How the logical axis number and the
physical axis number are related to each other is defined in the system
parameters.
The value 9E9 is defined for axes which are not connected. If the axes defined in
the position data differ from the axes that are actually connected on program
execution, the following applies:
- If the position is not defined in the position data (value 9E9), the value will be
ignored, if the axis is connected and not activated. But if the axis is activated, it
will result in an error.
- If the position is defined in the position data although the axis is not connected,
the value is ignored.
Examples
CONST robtarget p15 := [ [600, 500, 225.3], [1, 0, 0, 0], [1, 1, 0, 0],
[ 11, 12.3, 9E9, 9E9, 9E9, 9E9] ];
- The position of the robot: x = 600, y = 500 and z = 225.3 mm in the object
coordinate system.
- The orientation of the tool in the same direction as the object coordinate system.
- The axis configuration of the robot: axes 1 and 4 in position 90-180o, axis 6 in
position 0-90o.
- The position of the external logical axes, a and b, expressed in degrees or mm
(depending on the type of axis). Axes c to f are undefined.
The position p20 is set to the same position as the current position of the robot by
calling the function CRobT. The position is then moved 10 mm in the x-direction.
Limitations
When using the configurable edit function Absolute Limit Modpos, the number of
characters in the name of the data of the type robtarget, is limited to 14 (in other cases
16).
Structure
< dataobject of robtarget >
< trans of pos >
< x of num >
< y of num >
< z of num >
< rot of orient >
< q1 of num >
< q2 of num >
< q3 of num >
< q4 of num >
< robconf of confdata >
< cf1 of num >
< cf4 of num >
< cf6 of num >
< cfx of num >
< extax of extjoint >
< eax_a of num >
< eax_b of num >
< eax_c of num >
< eax_d of num >
< eax_e of num >
< eax_f of num >
Related information
Described in:
Positioning instructions RAPID Summary - Motion
Coordinate systems Motion and I/O Principles -
Coordinate Systems
Handling configuration data Motion and I/O Principles - Robot
Configuration
Configuration of external axes User’s Guide - System Parameters
What is a quaternion? Data Types - Orient
Description
World zones can be defined in 3 different geometrical shapes:
- a straight box, with all sides parallel to the world coordinate system and defined
by a WZBoxDef instruction
- a sphere, defined by a WZSphDef instruction
- a cylinder, parallel to the z axis of the world coordinate system and defined by
a WZCylDef instruction
The geometry of a world zone is defined by one of the previous instructions and the
action of a world zone is defined by the instruction WZLimSup or WZDOSet.
Example
VAR wzstationary pole;
VAR wzstationary conveyor;
...
PROC ...
VAR shapedata volume;
...
WZBoxDef \Inside, volume, p_corner1, p_corner2;
WZLimSup \Stat, conveyor, volume;
WZCylDef \Inside, volume, p_center, 200, 2500;
WZLimSup \Stat, pole, volume;
ENDPROC
A conveyor is defined as a box and the supervision for this area is activated. A
pole is defined as a cylinder and the supervision of this zone is also activated. If
the robot reaches one of these areas, the motion is stopped.
Characteristics
shapedata is a non-value data type.
Related information
Described in:
World Zones Motion and I/O Principles -
World Zones
World zone shape Data Types - shapedata
Define box-shaped world zone Instructions - WZBoxDef
Define sphere-shaped world zone Instructions - WZSphDef
Define cylinder-shaped world zone Instructions - WZCylDef
Activate world zone limit supervision Instructions - WZLimSup
Activate world zone digital output set Instructions - WZDOSet
Data types within signalxx are used for digital and analog input and output signals.
The names of the signals are defined in the system parameters and are consequently
not to be defined in the program.
Description
Data type Used for
signalai analog input signals
signalao analog output signals
signaldi digital input signals
signaldo digital output signals
signalgi groups of digital input signals
signalgo groups of digital output signals
Variables of the type signalxo only contain a reference to the signal. The value is set
using an instruction, e.g. DOutput.
Variables of the type signalxi contain a reference to a signal as well as the possibility
to retrieve the value directly in the program, if used in value context.
The value of an input signal can be read directly in the program, e.g. :
! Digital input
IF di1 = 1 THEN ...
! Analog input
IF ai1 > 5.2 THEN ...
Limitations
Data of the data type signalxx must not be defined in the program. However, if this is
in fact done, an error message will be displayed as soon as an instruction or function
that refers to this signal is executed. The data type can, on the other hand, be used as a
parameter when declaring a routine.
Predefined data
The signals defined in the system parameters can always be accessed from the program
by using the predefined signal variables (installed data). It should however be noted
that if other data with the same name is defined, these signals cannot be used.
Characteristics
Signalxo is a non-value data type. Thus, data of this type does not permit value-
oriented operations.
Signalxi is a semi-value data type.
Related information
Described in:
Summary input/output instructions RAPID Summary -
Input and Output Signals
Input/Output functionality in general Motion and I/O Principles -
I/O Principles
Configuration of I/O User’s Guide - System Parameters
Characteristics of non-value data types Basic Characteristics - Data Types
Speeddata is used to specify the velocity at which both the robot and the external axes
move.
Description
Speed data defines the velocity:
When several different types of movement are combined, one of the velocities often
limits all movements. The velocity of the other movements will be reduced in such a
way that all movements will finish executing at the same time.
The velocity is also restricted by the performance of the robot. This differs, depending
on the type of robot and the path of movement.
Components
v_tcp (velocity tcp) Data type: num
If a stationary tool or coordinated external axes are used, the velocity is specified
relative to the work object.
If a stationary tool or coordinated external axes are used, the velocity is specified
relative to the work object.
Example
VAR speeddata vmedium := [ 1000, 30, 200, 15 ];
vmedium.v_tcp := 900;
Predefined data
A number of speed data are already defined in the system module BASE.
Name TCP speed Orientation Linear ext. axis Rotating ext. axis
v5 5 mm/s 500o/s 5000 mm/s 1000o/s
v10 10 mm/s 500o/s 5000 mm/s 1000o/s
v20 20 mm/s 500o/s 5000 mm/s 1000o/s
v30 30 mm/s 500o/s 5000 mm/s 1000o/s
v40 40 mm/s 500o/s 5000 mm/s 1000o/s
v50 50 mm/s 500o/s 5000 mm/s 1000o/s
v60 60 mm/s 500o/s 5000 mm/s 1000o/s
v80 80 mm/s 500o/s 5000 mm/s 1000o/s
v100 100 mm/s 500o/s 5000 mm/s 1000o/s
v150 150 mm/s 500o/s 5000 mm/s 1000o/s
v200 200 mm/s 500o/s 5000 mm/s 1000o/s
v300 300 mm/s 500o/s 5000 mm/s 1000o/s
v400 400 mm/s 500o/s 5000 mm/s 1000o/s
v500 500 mm/s 500o/s 5000 mm/s 1000o/s
v600 600 mm/s 500o/s 5000 mm/s 1000o/s
v800 800 mm/s 500o/s 5000 mm/s 1000o/s
v1000 1000 mm/s 500o/s 5000 mm/s 1000o/s
v1500 1500 mm/s 500o/s 5000 mm/s 1000o/s
v2000 2000 mm/s 500o/s 5000 mm/s 1000o/s
v2500 2500 mm/s 500o/s 5000 mm/s 1000o/s
v3000 3000 mm/s 500o/s 5000 mm/s 1000o/s
v4000 4000 mm/s 500o/s 5000 mm/s 1000o/s
v5000 5000 mm/s 500o/s 5000 mm/s 1000o/s
vmax 5000 mm/s 500o/s 5000 mm/s 1000o/s
v6000 6000 mm/s 500o/s 5000 mm/s 1000o/s
v7000 7000 mm/s 500o/s 5000 mm/s 1000o/s
Structure
< dataobject of speeddata >
< v_tcp of num >
< v_ori of num >
< v_leax of num >
< v_reax of num >
Related information
Described in:
Positioning instructions RAPID Summary - Motion
Motion/Speed in general Motion and I/O Principles - Position-
ing during Program Execution
Defining maximum velocity Instructions - VelSet
Configuration of external axes User’s Guide - System Parameters
Motion performance Product Specification
Description
A position can be terminated either in the form of a fly-by point or a stop point.
A fly-by point means that the programmed position is never reached. A zone is speci-
fied in the instruction for the movement, defining a corner path. Instead of heading for
the programmed position, the direction of the motion is formed into the corner path
before the position is reached.
A stop point means that the robot and external axes must reach the specified position
before the robot/external axes continues with the next movement. The robot is consid-
ered to have reached a stop point when the convergence criteria of the point are satis-
fied. The convergence criteria are speed and position. It is also possible to specify
timing criteria.
The stoppointdata also determines whether the movement shall be synchronised with
the RAPID execution or not. If the movement is synchronised, the RAPID execution
waits for the robot to come into position. If the movement is not synchronised, the
RAPID execution gets a “prefetch” event almost a half second before the physical
robot reaches the programmed position. When the program server receives an “in-pos”
or a “prefetch” event, it continues with the next instruction. When the “prefetch” event
arrives, the robot still has a long way to move. When the “in-pos” event arrives, the
In-pos
Reference speed
h
Constant lag
Min/max time
Stop time
The termination of the stop points is described in the figure above. The robot speed
does not decrease linearly. The robot controller is always ahead of the physical robot.
It is shown as the constant lag in the figure above. The constant lag is about 0.1 seconds.
The timing elements of stoppointdata use the reference speed as a trigger. The time
measurement starts when the reference speed is zero. Therefore, the time in the timing
elements always includes the constant lag. Consequently there is no sense in using val-
ues less than the constant lag, except followtime.
Components
stoppoint
Stoppoint is an alias data type for num. It is used to choose the type of stop point or
which data elements to use in the stoppointdata. Predefined values are:
stoppointdata
The position condition (the radius) for the TCP as a percentage of a normal fine
stop point.
The speed condition for the TCP as a percentage of a normal fine stop point.
The minimum wait time in seconds before in position. Used to make the robot
wait at the point for at least the specified time. Maximum value is 20.0 seconds.
The maximum wait time in seconds for convergence criteria to be satisfied. Used
to assure that the robot does not get stuck in the point if the speed and position
conditions are set too tight. Maximum value is 20.0 seconds.
The time in seconds the TCP stands still in position before starting the next move-
ment. Maximum value is 20.0 seconds.
The time in seconds the TCP follows the movement of the external manipulator.
Examples
In-pos
VAR stoppointdata my_inpos := [ inpos, TRUE, [ 25, 40, 0.1, 5], 0, 0, 0, 0, 0];
MoveL *, v1000, z0\Inpos:=my_inpos, grip4;
The stop point data my_inpos is defined by means of the following characteris-
tics:
The robot moves towards the programmed position until one of the criteria posi-
tion or speed is satisfied.
my_inpos.inpos.position := 40;
MoveL *, v1000, z0\Inpos:=my_inpos, grip4;
Stop time
The stop point data my_stoptime is defined by means of the following character-
istics:
The robot moves towards the programmed position until the prefetch event
arrives. The next RAPID instruction executes. If it is a move-instruction the
robot stops for 1.45 seconds before it starts the next motion.
my_inpos.stoptime := 6.66;
The stop point stop time is adjusted to 6.66 seconds. If the next RAPID instruc-
tion is a move-instruction, the robot stops for 6.66 s.
Follow time
The stop point data my_followtime is defined by means of the following charac-
teristics:
The robot will follow the external manipulator for 500 ms before leaving it with
the zone 50 mm, z50.
my_inpos.followtime := 0.4;
Predefined data
A number of stop point data are already defined in the system module BASE.
Structure
< data object of stoppointdata >
< type of num >
< progsynch of bool >
< inpos of inposdata >
< position of num >
< speed of num >
< mintime of num >
< maxtime of num >
< stoptime of num >
< followtime of num >
< x1 of num >
< x2 of num >
< x3 of num >
Related information
Described in:
Positioning instructions RAPID Summary - Motion
Movements/Paths in general Motion and I/O Principles - Position-
ing during Program Execution
Configuration of external axes User’s Guide - System Parameters
Fly-by points Rapid Reference manual - zonedata
string Strings
Description
A character string consists of a number of characters (a maximum of 80) enclosed by
quotation marks (“”),
If the quotation marks are to be included in the string, they must be written twice,
If the back slash are to be included in the string, it must be written twice,
Example
VAR string text;
.
text := “start welding pipe 1”;
TPWrite text;
Limitations
A string may have from 0 to 80 characters; inclusive of extra quotation marks or back
slash.
A string may contain any of the characters specified by ISO 8859-1 as well as control
characters (non-ISO 8859-1 characters with a numeric code between 0-255).
Predefined data
A number of predefined string constants are available in the system and can be used
together with string functions.
The following constants are already defined in the system module BASE:
Structure
String is an atomic data type; i.e. does not consist of other data types.
Related information
Described in:
Operations using strings Basic Characteristics - Expressions
String values Basic Characteristics - Basic Elements
Description
A symnum constant is intended to be used when checking the return value from the
functions OpMode and RunMode. See example below.
Example
IF RunMode() = RUN_CONT_CYCLE THEN
.
.
ELSE
.
.
ENDIF
Predefined data
The following symbolic constants of the data type symnum are predefined and can be
used when checking return values from the functions OpMode and RunMode.
Characteristics
Symnum is an alias data type for num and consequently inherits its characteristics.
Related information
Described in:
Data types in general, alias data types Basic Characteristics - Data Types
System Data
System data is the internal data of the robot that can be accessed and read by the pro-
gram. It can be used to read the current status, e.g. the current maximum velocity.
C_MOTSET Current motion settings, i.e.: motsetdata Instructions Data Types - motsetdata
- max. velocity and velocity override - VelSet Instructions - VelSet
- max. acceleration - AccSet Instructions - AccSet
- movement about singular points - SingArea Instructions - SingArea
- monitoring the axis configuration - ConfL,ConfJ Instructions - ConfL, ConfJ
- path resolution - PathResol Instructions - PathResol
- motion supervision with tunevalue - MotionSup Instructions - MotionSup
C_PROGDISP Current program displacement for robot and exter- progdisp Instructions Data Types - progdisp
nal axes. - PDispSet Instructions - PDispSet
- PDispOn Instructions - PDispOn
- PDispOff Instructions - PDispOff
- EOffsSet Instructions - EOffsSet
- EOffsOn Instructions - EOffsOn
- EOffsOff Instructions - EOffsOff
ERRNO The latest error that occurred errnum The robot Data Types - errnum
RAPID Summary -
Error Recovery
INTNO The latest interrupt that occurred intnum The robot Data Types - intnum
RAPID Summary -Interrupts
The names of the program tasks are defined in the system parameters and, conse-
quently, must not be defined in the program.
Description
Data of the type taskid only contains a reference to the program task.
Limitations
Data of the type taskid must not be defined in the program. The data type can, on the
other hand, be used as a parameter when declaring a routine.
Predefined data
The program tasks defined in the system parameters can always be accessed from the
program (installed data).
For all program tasks in the system, predefined variables of the data type taskid will be
available. The variable identity will be "taskname"+"Id", e.g. for MAIN task the vari-
able identity will be MAINId, TSK1 - TSK1Id etc.
Characteristics
Taskid is a non-value data type. This means that data of this type does not permit value-
oriented operations.
Related information
Described in:
Saving program modules Instruction - Save
Configuration of program tasks User’s Guide - System Parameters
Characteristics of non-value data types Basic Characteristics - Data Types
The data type testsignal is used when a test of the robot motion system is performed.
Description
A number of predefined test signals are available in the robot system. The testsignal
data type is available in order to simplify programming of instruction TestSignDefine.
Examples
TestSignDefine 2, speed, Orbit, 2, 0;
Predefined data
The following test signals for external manipulator axes are predefined in the system.
All data is in SI units and measured on the motor side of the axis.
Characteristics
Testsignal is an alias data type for num and consequently inherits its characteristics.
Related information
Described in:
Define test signal Instructions - TestSignDefine
Read test signal Functions - TestSignRead
Reset test signals Instructions - TestSignReset
Tooldata is used to describe the characteristics of a tool, e.g. a welding gun or a gripper.
If the tool is fixed in space (a stationary tool), common tool data is defined for this tool
and the gripper holding the work object.
Description
Tool data affects robot movements in the following ways:
- The tool centre point (TCP) refers to a point that will satisfy the specified path
and velocity performance. If the tool is reorientated or if coordinated external
axes are used, only this point will follow the desired path at the programmed
velocity.
- If a stationary tool is used, the programmed speed and path will relate to the
work object.
- Programmed positions refer to the position of the current TCP and the orienta-
tion in relation to the tool coordinate system. This means that if, for example,
a tool is replaced because it is damaged, the old program can still be used if the
tool coordinate system is redefined.
- Define the TCP that is not to move when the tool is reorientated.
- Define the tool coordinate system in order to facilitate moving in or rotating
about the tool directions.
It is important to always define the actual tool load and when used, the payload
of the robot too. Incorrect definitions of load data can result in overloading of the
robot mechanical structure.
When incorrect tool load data is specified, it can often lead to the following conse-
quences:
- If the value in the specified load is greater than that of the value of the true load;
-> The robot will not be used to its maximum capacity
-> Impaired path accuracy including a risk of overshooting
- If the value in the specified load is less than the value of the true load;
-> Impaired path accuracy including a risk of overshooting
-> Risk of overloading the mechanical structure
Components
robhold (robot hold) Data type: bool
- The position of the TCP (x, y and z) in mm, expressed in the wrist coordinate
system (See figure 1).
- The orientation of the tool coordinate system, expressed in the wrist coordinate
system as a quaternion (q1, q2, q3 and q4) (See figure 1).
If a stationary tool is used, the definition is defined in relation to the world coor-
dinate system.
If the direction of the tool is not specified, the tool coordinate system and the
wrist coordinate system will coincide.
TCP
Y’
X
X’
Z’
Figure 14 Definition of the tool coordinate system.
TCP
IX Y’
X Tool coordinate systeem
X’
Z’
For more information (such as coordinate system for stationary tool or restric-
tions), see the data type loaddata.
If a stationary tool is used, the load of the gripper holding the work object must
be defined.
Note that only the load of the tool is to be specified. The payload handled by a
gripper is connected and disconnected by means of the instruction GripLoad.
Examples
PERS tooldata gripper := [ TRUE, [[97.4, 0, 223.1], [0.924, 0, 0.383 ,0]],
[5, [23, 0, 75], [1, 0, 0, 0], 0, 0, 0]];
gripper.tframe.trans.z := 225.2;
Limitations
The tool data should be defined as a persistent variable (PERS) and should not be
defined within a routine. The current values are then saved when the program is stored
on diskette and are retrieved on loading.
Arguments of the type tool data in any motion instruction should only be an entire per-
sistent (not array element or record component).
Predefined data
The tool tool0 defines the wrist coordinate system, with the origin being the centre of
the mounting flange. Tool0 can always be accessed from the program, but can never be
changed (it is stored in system module BASE).
Structure
< dataobject of tooldata >
< robhold of bool >
< tframe of pose >
< trans of pos >
< x of num >
< y of num >
< z of num >
< rot of orient >
< q1 of num >
< q2 of num >
< q3 of num >
< q4 of num >
< tload of loaddata >
< mass of num >
< cog of pos >
< x of num >
< y of num >
< z of num >
< aom of orient >
< q1 of num >
< q2 of num >
< q3 of num >
< q4 of num >
< ix of num >
< iy of num >
< iz of num >
Related information
Described in:
Positioning instructions RAPID Summary - Motion
Coordinate systems Motion and I/O Principles - Coordi-
nate Systems
Definition of payload Instructions - Gripload
Definition of load Data types - Load data
tpnum is used to represent the Teach Pendant Window number with a symbolic
constant.
Description
A tpnum constant is intended to be used in instruction TPShow. See example below.
Example
TPShow TP_PROGRAM;
The Production Window will be active if the system is in AUTO mode and the
Program Window will be active if the system is in MAN mode, after execution of
this instruction.
Predefined data
The following symbolic constants of the data type tpnum are predefined and can be
used in instruction TPShow:
Characteristics
tpnum is an alias data type for num and consequently inherits its characteristics.
Related information
Described in:
Data types in general, alias data types Basic Characteristics - Data Types
Communicating using the teach pendant RAPID Summary - Communication
Switch window on the teach pendant Instructions - TPShow
Triggdata is used to store data about a positioning event during a robot movement.
A positioning event can take the form of setting an output signal or running an interrupt
routine at a specific position along the movement path of the robot.
Description
To define the conditions for the respective measures at a positioning event, variables
of the type triggdata are used. The data contents of the variable are formed in the pro-
gram using one of the instructions TriggIO or TriggInt, and are used by one of the
instructions TriggL, TriggC or TriggJ.
Example
VAR triggdata gunoff;
The digital output signal gun is set to the value off when the TCP is at a position
5 mm before the point p1.
Characteristics
Triggdata is a non-value data type.
Related information
Described in:
Definition of triggs Instructions - TriggIO, TriggInt
Use of triggs Instructions - TriggL, TriggC,
TriggJ
Characteristics of non-value data types Basic Characteristics- Data Types
Description
A tunetype constant is intended to be used as an argument to the instruction TuneServo.
See example below.
Example
TuneServo MHA160R1, 1, 110 \Type:= TUNE_KP;
Predefined data
The following symbolic constants of the data type tunetype are predefined and can be
used as argument for the instruction TuneServo.
Characteristics
Tunetype is an alias data type for num and consequently inherits its characteristics.
Related information
Described in:
Data types in general, alias data types Basic Characteristics - Data Types
Use of data type tunetype Instructions - TuneServo
Wobjdata is used to describe the work object that the robot welds, processes, moves
within, etc.
Description
If work objects are defined in a positioning instruction, the position will be based on
the coordinates of the work object. The advantages of this are as follows:
If a stationary tool or coordinated external axes are used the work object must be
defined, since the path and velocity would then be related to the work object instead of
the TCP.
Components
robhold (robot hold) Data type: bool
- TRUE -> The robot is holding the work object, i.e. using a stationary tool.
- FALSE -> The robot is not holding the work object, i.e. the robot is holding
the tool.
The mechanical unit with which the robot movements are coordinated. Only
specified in the case of movable user coordinate systems (ufprog is FALSE).
Specified with the name that is defined in the system parameters, e.g. "orbit_a".
The user coordinate system, i.e. the position of the current work surface or fixture
(see Figure 16):
- The position of the origin of the coordinate system (x, y and z) in mm.
- The rotation of the coordinate system, expressed as a quaternion (q1, q2, q3,
q4).
If the robot is holding the tool, the user coordinate system is defined in the world
coordinate system (in the wrist coordinate system if a stationary tool is used).
When coordinated external axes are used (ufprog is FALSE), the user coordinate
system is defined in the system parameters.
The object coordinate system, i.e. the position of the current work object (see Fig-
ure 16):
- The position of the origin of the coordinate system (x, y and z) in mm.
- The rotation of the coordinate system, expressed as a quaternion (q1, q2, q3,
q4).
Tool coordinates
Y
TCP
X
Z Z
Z User coordinates
Y Z Object coordinates
Z X Y
Base coordinates Y X
Y X
X
World coordinates
Figure 16 The various coordinate systems of the robot (when the robot is holding the tool).
Example
PERS wobjdata wobj2 :=[ FALSE, TRUE, "", [ [300, 600, 200], [1, 0, 0 ,0] ],
[ [0, 200, 30], [1, 0, 0 ,0] ] ];
wobj2.oframe.trans.z := 38.3;
- The position of the work object wobj2 is adjusted to 38.3 mm in the z-direction.
Limitations
The work object data should be defined as a persistent variable (PERS) and should not
be defined within a routine. The current values are then saved when the program is
stored on diskette and are retrieved on loading.
Arguments of the type work object data in any motion instruction should only be an
entire persistent (not array element or record component).
Predefined data
The work object data wobj0 is defined in such a way that the object coordinate system
coincides with the world coordinate system. The robot does not hold the work object.
Wobj0 can always be accessed from the program, but can never be changed (it is stored
in system module BASE).
PERS wobjdata wobj0 := [ FALSE, TRUE, "", [ [0, 0, 0], [1, 0, 0 ,0] ],
[ [0, 0, 0], [1, 0, 0 ,0] ] ];
Structure
< dataobject of wobjdata >
< robhold of bool >
< ufprog of bool>
< ufmec of string >
< uframe of pose >
< trans of pos >
< x of num >
< y of num >
< z of num >
< rot of orient >
< q1 of num >
< q2 of num >
< q3 of num >
< q4 of num >
< oframe of pose >
< trans of pos >
< x of num >
< y of num >
< z of num >
< rot of orient >
< q1 of num >
< q2 of num >
< q3 of num >
< q4 of num >
Related information
Described in:
Positioning instructions RAPID Summary - Motion
Coordinate systems Motion and I/O Principles - Coordi-
nate Systems
Coordinated external axes Motion and I/O Principles - Coordi-
nate Systems
Calibration of coordinated external axes User’s Guide - System Parameters
A world zone is supervised during robot movements both during program execution
and jogging. If the robot’s TCP reaches this world zone, the movement is stopped or a
digital output signal is set or reset.
Description
A wzstationary world zone is defined and activated by a WZLimSup or a WZDOSet
instruction.
WZLimSup or WZDOSet gives the variable or the persistent of data type stationary a
numeric value. The value identifies the world zone.
A stationary world zone is always active and is only erased by a warm start (switch
power off then on, or change system parameters). It is not possible to deactivate,
activate or erase a stationary world zone via RAPID instructions.
Stationary world zones should be active from power on and should be defined in a
POWER ON event routine or a semistatic task.
Example
VAR wzstationary conveyor;
...
PROC ...
VAR shapedata volume;
...
WZBoxDef \Inside, volume, p_corner1, p_corner2;
WZLimSup \Stat, conveyor, volume;
ENDPROC
A conveyor is defined as a straight box (the volume below the belt). If the robot
reaches this volume, the movement is stopped.
Limitations
A wzstationary data can be defined as a variable (VAR) or as a persistent (PERS).
It can be global in task or local within module, but not local within a routine.
Arguments of the type wzstationary should only be entire data (not array element or
record component).
An init value for data of the type wzstationary is not used by the control system. When
there is a need to use a persistent variable in a multi-tasking system, set the init value
to 0 in both tasks,
e.g. PERS wzstationary share_workarea := [0];
Example
For a complete example see instruction WZLimSup.
Characteristics
wzstationary is an alias data type of wztemporary and inherits its characteristics.
Related information
Described in:
World Zones Motion and I/O Principles -
World Zones
World zone shape Data Types - shapedata
Temporary world zone Data Types - wztemporary
Activate world zone limit supervision Instructions - WZLimSup
Activate world zone digital output set Instructions - WZDOSet
A world zone is supervised during robot movements both during program execution
and jogging. If the robot’s TCP reaches this world zone, the movement is stopped or a
digital output signal is set or reset.
Description
A wztemporary world zone is defined and activated by a WZLimSup or a WZDOSet
instruction.
WZLimSup or WZDOSet gives the variable or the persistent of data type wztemporary
a numeric value. The value identifies the world zone.
All temporary world zones in the MAIN task are automatically erased and all data
objects of type wztemporary in the MAIN task are set to 0:
Example
VAR wztemporary roll;
...
PROC ...
VAR shapedata volume;
CONST pos t_center := [1000, 1000, 1000];
...
WZCylDef \Inside, volume, t_center, 400, 1000;
WZLimSup \Temp, roll, volume;
ENDPROC
Limitations
A wztemporary data can be defined as a variable (VAR) or as a persistent (PERS).
It can be global in a task or local within a module, but not local within a routine.
Arguments of the type wztemporary must only be entire data, not an array element or
record component.
A temporary world zone must only be defined (WZLimSup or WZDOSet) and free
(WZFree) in the MAIN task. Definitions of temporary world zones in the background
would affect the program execution in the MAIN task The instructions WZDisable and
WZEnable can be used in the background task. When there is a need to use a persistent
variable in a multi-tasking system, set the init value to 0 in both tasks,
e.g. PERS wztemporary share_workarea := [0];
Example
For a complete example see instruction WZDOSet.
Structure
<dataobject of wztemporary>
<wz of num>
Related information
Described in:
World Zones Motion and I/O Principles -
World Zones
World zone shape Data Types - shapedata
Stationary world zone Data Types - wzstationary
Activate world zone limit supervision Instructions - WZLimSup
Activate world zone digital output set Instructions - WZDOSet
Deactivate world zone Instructions - WZDisable
Activate world zone Instructions - WZEnable
Erase world zone Instructions - WZFree
Zonedata is used to specify how a position is to be terminated, i.e. how close to the
programmed position the axes must be before moving towards the next position.
Description
A position can be terminated either in the form of a stop point or a fly-by point.
A stop point means that the robot and external axes must reach the specified position
(stand still) before program execution continues with the next instruction. It is also pos-
sible to define stop points other than the predefined fine. The stop criteria, that tells if
the robot is considered to have reached the point, can be manipulated using the stop-
pointdata.
Start of reorientation
towards next position
Zones function in the same way during joint movement, but the zone size may differ
somewhat from the one programmed.
The zone size cannot be larger than half the distance to the closest position (forwards
or backwards). If a larger zone is specified, the robot automatically reduces it.
A corner path (parabola) is generated as soon as the edge of the zone is reached
(see Figure 17).
Reorientation starts as soon as the TCP reaches the extended zone. The tool is
reoriented in such a way that the orientation is the same leaving the zone as it
would have been in the same position if stop points had been programmed.
Reorientation will be smoother if the zone size is increased, and there is less of a
risk of having to reduce the velocity to carry out the reorientation.
Figure 18a Three positions are programmed, the last with different tool orientation.
Figure 18b If all positions were stop points, program execution would look like this.
Zone size
Figure 18c If the middle position was a fly-by point, program execution would look like this
External axes start to move towards the next position as soon as the TCP reaches
the extended zone. In this way, a slow axis can start accelerating at an earlier
stage and thus execute more evenly.
Reduced zone
With large reorientations of the tool or with large movements of the external axes,
the extended zone and even the TCP zone can be reduced by the robot. The zone
will be defined as the smallest relative size of the zone based upon the zone com-
ponents (see next page) and the programmed motion.
90 mm 60 mm
MoveL with 200 mm movements pzone_ori
of the tool, 25o reorientation of pzone_tcp
P1 the tool and with zone z60 P2
The relative sizes of the zone are
pzone_tcp
________________________ = 60/200 = 30%
length of movement P1 - P2 9o
pzone_ori zone_ori
________________________ = 90/200 = 45%
length of movement P1 - P2
zone_ori
________________________ = 9o/25o = 36%
angle of reorientation P1 - P2
Figure 19 Example of reduced zone for reorientation of the tool to 36% of the motion due to
zone_ori.
P1 P2
Figure 20 Example of reduced zone for reorientation of the tool and TCP path to 15% of the
motion due to zone_ori.
When external axes are active they affect the relative sizes of the zone according to
these formulas:
pzone_eax
________________________
length of movement P1 - P2
zone_leax
________________________
length of max linear ext. axis movement P1 - P2
zone_reax
________________________
angle of max reorientation of rotating ext. axis P1 - P2
NOTE: If the TCP zone is reduced because of zone_ori, zone_leax or zone_reax the
path planner enters a mode that can handle the case of no TCP movement. If there is a
TCP movement when in this mode the speed is not compensated for the curvature of
the path in a corner zone. For instance, this will cause a 30% speed reduction in a 90
degree corner. If this is a problem, increase the limiting zone component.
Components
finep (fine point) Data type: bool
The extended zone will be defined as the smallest relative size of the zone based
upon the following components and the programmed motion.
The zone size (the radius) for the tool reorientation. The size is defined as the dis-
tance of the TCP from the programmed point in mm.
The size must be larger than the corresponding value for pzone_tcp.
If a lower value is specified, the size is automatically increased to make it the
same as pzone_tcp.
The zone size (the radius) for external axes. The size is defined as the distance of
the TCP from the programmed point in mm.
The size must be larger than the corresponding value for pzone_tcp.
If a lower value is specified, the size is automatically increased to make it the
same as pzone_tcp.
The zone size for the tool reorientation in degrees. If the robot is holding the work
object, this means an angle of rotation for the work object.
Examples
VAR zonedata path := [ FALSE, 25, 40, 40, 10, 35, 5 ];
path.pzone_tcp := 40;
Predefined data
A number of zone data are already defined in the system module BASE.
Stop points
Name
fine 0 mm
Fly-by points
Structure
< data object of zonedata >
< finep of bool >
< pzone_tcp of num >
< pzone_ori of num >
< pzone_eax of num >
< zone_ori of num >
< zone_leax of num >
< zone_reax of num >
Related information
Described in:
Positioning instructions RAPID Summary - Motion
Movements/Paths in general Motion and I/O Principles - Position-
ing during Program Execution
Configuration of external axes User’s Guide - System Parameters
Other Stop points Data Types stoppointdata
CONTENTS
Examples
reg1 := 5;
counter := counter + 1;
Arguments
Data := Value
Data Data type: All
Examples
tool1.tframe.trans.x := tool1.tframe.trans.x + 20;
pallet{5,8} := Abs(value);
An element in the pallet matrix is assigned a value equal to the absolute value of
the value variable.
Limitations
The data (whose value is to be changed) must not be
- a constant
- a non-value data type.
The data and value must have similar (the same or alias) data types.
Syntax
(EBNF)
<assignment target> ’:=’ <expression> ’;’
<assignment target> ::=
<variable>
| <persistent>
| <parameter>
| <VAR>
Related information
Described in:
Expressions Basic Characteristics - Expressions
Non-value data types Basic Characteristics - Data Types
Assigning an initial value to data Basic Characteristics - Data
Programming and Testing
Manually assigning a value to data Programming and Testing
Examples
AccSet 50, 100;
Arguments
AccSet Acc Ramp
Acc Data type: num
Acceleration
Time
AccSet 100, 100, i.e. normal acceleration
Acceleration Acceleration
Time Time
AccSet 30, 100 AccSet 100, 30
Figure 21 Reducing the acceleration results in smoother movements.
Program execution
The acceleration applies to both the robot and external axes until a new AccSet instruc-
tion is executed.
- at a cold start-up
- when a new program is loaded
- when starting program executing from the beginning.
Syntax
AccSet
[ Acc ’:=’ ] < expression (IN) of num > ’,’
[ Ramp ’:=’ ] < expression (IN) of num > ’;’
Related information
Described in:
Positioning instructions RAPID Summary - Motion
It can be used to determine which unit is to be active when, for example, common drive
units are used.
Example
ActUnit orbit_a;
Arguments
ActUnit MecUnit
MecUnit (Mechanical Unit) Data type: mecunit
Program execution
When the robot and external axes have come to a standstill, the specified mechanical
unit is activated. This means that it is controlled and monitored by the robot.
If several mechanical units share a common drive unit, activation of one of these
mechanical units will also connect that unit to the common drive unit.
Limitations
Instruction ActUnit cannot be used in
Syntax
ActUnit
[MecUnit ’:=’ ] < variable (VAR) of mecunit> ’;’
Related information
Described in:
Deactivating mechanical units Instructions - DeactUnit
Mechanical units Data Types - mecunit
More examples Instructions - DeactUnit
Examples
Add reg1, 3;
Arguments
Add Name AddValue
Name Data type: num
Syntax
Add
[ Name ’:=’ ] < var or pers (INOUT) of num > ’,’
[ AddValue ’:=’ ] < expression (IN) of num > ’;’
Related information
Described in:
Incrementing a variable by 1 Instructions - Incr
Decrementing a variable by 1 Instructions - Decr
Changing data using an arbitrary Instructions - :=
expression, e.g. multiplication
Signals with alias names can be used for predefined generic programs, without any
modification of the program before running in different robot installations.
The instruction AliasIO must be run before any use of the actual signal. See example 1
below for loaded modules and example 2 below for builtin modules.
Example 1
VAR signaldo alias_do;
PROC prog_start()
AliasIO config_do, alias_do;
ENDPROC
Arguments
AliasIO FromSignal ToSignal
FromSignal Data type: signalxx or
string
Loaded modules:
The signal identifier named according to the configuration (data type signalxx)
from which the signal descriptor is copied. The signal must be defined in the IO
configuration.
Built-in modules:
The signal identifier according to the program (data type signalxx) to which the
signal descriptor is copied. The signal must be declared in the RAPID program.
The same data type must be used (or find) for the arguments FromSignal and ToSignal
and must be one of type signalxx (signalai, signalao, signaldi, signaldo, signalgi or sig-
nalgo).
Program execution
The signal descriptor value is copied from the signal given in argument FromSignal to
the signal given in argument ToSignal.
Example 2
VAR signaldi alias_di;
PROC prog_start()
CONST string config_string := "config_di";
AliasIO config_string, alias_di;
ENDPROC
Limitation
When starting the program, the alias signal cannot be used until the AliasIO instruction
is executed.
Instruction AliasIO is not available for programming from the Teach Pendant (only
from Program Maker). Option Developer’s Functions is required.
Syntax
AliasIO
[ FromSignal ’:=’ ] < reference (REF) of anytype> ’,’
[ ToSignal ’:=’ ] < variable (VAR) of anytype> ’;’
Related information
Described in:
Input/Output instructions RAPID Summary -
Input and Output Signals
Input/Output functionality in general Motion and I/O Principles -
I/O Principles
Configuration of I/O User’s Guide - System Parameters
Defining event routines User’s Guide - System Parameters
Loaded/Built-in task modules User’s Guide - System Parameters
Example
..
Break;
...
Program execution stops and it is possible to analyse variables, values etc. for
debugging purposes.
Program execution
The instruction stops program execution at once, without waiting for the robot and
external axes to reach their programmed destination points for the movement being
performed at the time. Program execution can then be restarted from the next
instruction.
If there is a Break instruction in some event routine, the routine will be executed from
the beginning of the next event.
Syntax
Break’;’
Related information
Described in:
Stopping for program actions Instructions - Stop
Stopping after a fatal error Instructions - EXIT
Terminating program execution Instructions - EXIT
Only stopping robot movements Instructions - StopMove
Examples
weldpipe1;
errormessage;
Set do1;
.
PROC errormessage()
TPWrite "ERROR";
ENDPROC
Arguments
Procedure { Argument }
Procedure Identifier
The procedure arguments (in accordance with the parameters of the procedure).
Example
weldpipe2 10, lowspeed;
weldpipe3 10 \speed:=20;
Calls the weldpipe3 procedure, including one mandatory and one optional
argument.
Limitations
The procedure’s arguments must agree with its parameters:
A routine can call a routine which, in turn, calls another routine, etc. A routine can also
call itself, i.e. a recursive call. The number of routine levels permitted depends on the
number of parameters, but more than 10 levels are usually permitted.
Syntax
(EBNF)
<procedure> [ <argument list> ] ’;’
Related information
Described in:
Arguments, parameters Basic Characteristics - Routines
More examples Program Examples
Example
reg1 := 2;
CallByVar “proc”, reg1;
Arguments
CallByVar Name Number
Name Data type: string
The numeric value for the number of the procedure. This value will be converted
to a string and gives the 2:nd part of the procedure name e.g. 1. The value must
be a positive integer.
Example
Static selection of procedure call
TEST reg1
CASE 1:
lf_door door_loc;
CASE 2:
rf_door door_loc;
CASE 3:
lr_door door_loc;
CASE 4:
rr_door door_loc;
DEFAULT:
EXIT;
ENDTEST
reg1 := 2;
%”proc”+NumToStr(reg1,0)% door_loc;
Limitation: All procedures must have a specific name e.g. proc1, proc2, proc3.
reg1 := 2;
CallByVar “proc”,reg1;
Limitation: All procedures must have specific name, e.g. proc1, proc2, proc3,
and no arguments can be used.
Limitations
Can only be used to call procedures without parameters.
Execution of CallByVar takes a little more time than execution of a normal procedure
call.
Error handling
In the event of a reference to an unknown procedure, the system variable ERRNO is set
to ERR_REFUNKPRC.
In the event of the procedure call error (not procedure), the system variable ERRNO is
set to ERR_CALLPROC.
Syntax
CallByVar
[Name ‘:=’] <expression (IN) of string>’,’
[Number ‘:=‘] <expression (IN) of num>’;’
Related information
Described in:
Calling procedures Basic Characteristic - Routines
User’s Guide - The programming
language RAPID
Example
Clear reg1;
Arguments
Clear Name
Name Data type: num
Syntax
Clear
[ Name ’:=’ ] < var or pers (INOUT) of num > ’;’
Related information
Described in:
Incrementing a variable by 1 Instructions - Incr
Decrementing a variable by 1 Instructions - Decr
Example
VAR iodev channel2;
...
Open "sio1:", channel2 \Bin;
ClearIOBuff channel2;
The input buffer for the serial channel referred to by channel2 is cleared.
Arguments
ClearIOBuff IODevice
IODevice Data type: iodev
The name (reference) of the serial channel whose input buffer is to be cleared.
Program execution
All buffered characters from the input serial channel are discarded. Next read instruc-
tions will wait for new input from the channel.
Limitations
This instruction can only be used for serial channels.
Syntax
ClearIOBuff
[IODevice ’:=’] <variable (VAR) of iodev>’;’
Related information
Described in:
Opening a serial channel RAPID Summary - Communication
This instruction can be used before using a clock to make sure that it is set to 0.
Example
ClkReset clock1;
Arguments
ClkReset Clock
Clock Data type: clock
Program execution
When a clock is reset, it is set to 0.
Syntax
ClkReset
[ Clock ’:=’ ] < variable (VAR) of clock > ’;’
Related Information
Described in:
Other clock instructions RAPID Summary - System & Time
Example
ClkStart clock1;
Arguments
ClkStart Clock
Clock Data type: clock
Program execution
When a clock is started, it will run and continue counting seconds until it is stopped.
A clock continues to run when the program that started it is stopped. However, the
event that you intended to time may no longer be valid. For example, if the program
was measuring the waiting time for an input, the input may have been received while
the program was stopped. In this case, the program will not be able to “see” the event
that occurred while the program was stopped.
A clock continues to run when the robot is powered down as long as the battery back-
up retains the program that contains the clock variable.
Example
VAR clock clock2;
ClkReset clock2;
ClkStart clock2;
WaitUntil DInput(di1) = 1;
ClkStop clock2;
time:=ClkRead(clock2);
Error handling
If the clock runs for 4,294,967 seconds (49 days 17 hours 2 minutes 47 seconds) it
becomes overflowed and the system variable ERRNO is set to ERR_OVERFLOW.
Syntax
ClkStart
[ Clock ’:=’ ] < variable (VAR) of clock > ’;’
Related Information
Described in:
Other clock instructions RAPID Summary - System & Time
Example
ClkStop clock1;
Arguments
ClkStop Clock
Clock Data type: clock
Program execution
When a clock is stopped, it will stop running.
Error handling
If the clock runs for 4,294,967 seconds (49 days 17 hours 2 minutes 47 seconds) it
becomes overflowed and the system variable ERRNO is set to ERR_OVERFLOW.
Syntax
ClkStop
[ Clock ’:=’ ] < variable (VAR) of clock > ’;’
Related Information
Described in:
Other clock instructions RAPID Summary - System & Time
More examples Instructions - ClkStart
Example
Close channel2;
Arguments
Close IODevice
IODevice Data type: iodev
Program execution
The specified file or serial channel is closed and must be re-opened before reading or
writing. If it is already closed, the instruction is ignored.
Syntax
Close
[IODevice ’:=’] <variable (VAR) of iodev>’;’
Related information
Described in:
Opening a file or serial channel RAPID Summary - Communication
comment Comment
Comment is only used to make the program easier to understand. It has no effect on the
execution of the program.
Example
! Goto the position above pallet
MoveL p100, v500, z20, tool1;
Arguments
! Comment
Comment Text string
Any text.
Program execution
Nothing happens when you execute this instruction.
Syntax
(EBNF)
’!’ {<character>} <newline>
Related information
Described in:
Characters permitted in a comment Basic Characteristics-
Basic Elements
Comments within data and routine Basic Characteristics-
declarations Basic Elements
With ConfJ\Off, the robot cannot switch main axes configuration - it will search for a
solution with the same main axes configuration as the current one. It moves to the clos-
est wrist configuration for axes 4 and 6.
Examples
ConfJ \Off;
MoveJ *, v1000, fine, tool1;
The robot moves to the programmed position and orientation. If this position can
be reached in several different ways, with different axis configurations, the clos-
est possible position is chosen.
ConfJ \On;
MoveJ *, v1000, fine, tool1;
The robot moves to the programmed position, orientation and axis configuration.
If this is not possible, program execution stops.
Arguments
ConfJ [\On] | [\Off]
\On Data type: switch
The robot always moves to the programmed axis configuration. If this is not pos-
sible using the programmed position and orientation, program execution stops.
The IRB5400 robot will move to the pogrammed axis configuration or to an axis
configuration close the the programmed one. Program execution will not stop if
it is impossible to reach the programmed axis configuration.
Program execution
If the argument \On (or no argument) is chosen, the robot always moves to the pro-
grammed axis configuration. If this is not possible using the programmed position and
orientation, program execution stops before the movement starts.
If the argument \Off is chosen, the robot always moves to the closest axis configuration.
This may be different to the programmed one if the configuration has been incorrectly
specified manually, or if a program displacement has been carried out.
- at a cold start-up
- when a new program is loaded
- when starting program executing from the beginning.
Syntax
ConfJ
[ ’\’ On] | [ ’\’ Off] ’;’
Related information
Described in:
Handling different configurations Motion Principles -
Robot Configuration
Robot configuration during linear movement Instructions - ConfL
NOTE: For the IRB 6400 robot the monotoring is always off independant of the
switch.
Examples
ConfL \On;
MoveL *, v1000, fine, tool1;
SingArea \Wrist;
Confl \On;
MoveL *, v1000, fine, tool1;
The robot moves to the programmed position, orientation and wrist axis config-
uration. If this is not possible, program execution stops.
ConfL \Off;
MoveL *, v1000, fine, tool1;
Arguments
ConfL [\On] | [\Off]
\On Data type: switch
Program execution
During linear or circular movement, the robot always moves to the programmed posi-
tion and orientation that has the closest possible axis configuration. If the argument \On
(or no argument) is chosen, then the program execution stops as soon as:
- the configuration of the programmed position will not be attained from the
current position.
- the needed reorientation of any one of the wrist axes to get to the programmed
position from the current position exceeds a limit (140-180 degrees).
However, it is possible to restart the program again, although the wrist axes may con-
tinue to the wrong configuration. At a stop point, the robot will check that the config-
urations of all axes are achieved, not only the wrist axes.
If SingArea\Wrist is also used, the robot always moves to the programmed wrist axes
configuration and at a stop point the remaining axes configurations will be checked.
- at a cold start-up
- when a new program is loaded
- when starting program executing from the beginning.
Syntax
ConfL
[ ’\’ On] | [ ’\’ Off] ’;’
Related information
Described in:
Handling different configurations Motion and I/O Principles-
Robot Configuration
Robot configuration during joint movement Instructions - ConfJ
The interrupt is defined by ordering an interrupt event and specifying its identity. Thus,
when that event occurs, the trap routine is automatically executed.
Example
VAR intnum feeder_low;
CONNECT feeder_low WITH feeder_empty;
ISignalDI di1, 1 , feeder_low;
Arguments
CONNECT Interrupt WITH Trap routine
Interrupt Data type: intnum
Program execution
The variable is assigned an interrupt identity which can then be used when ordering or
disabling interrupts. This identity is also connected to the specified trap routine.
Note that before an event can be handled, an interrupt must also be ordered, i.e. the
event specified.
Limitations
An interrupt (interrupt identity) cannot be connected to more than one trap routine.
Different interrupts, however, can be connected to the same trap routine.
Error handling
If the interrupt variable is already connected to a TRAP routine, the system variable
ERRNO is set to ERR_ALRDYCNT.
If the interrupt variable is not a variable reference, the system variable ERRNO is set
to ERR_CNTNOTVAR.
If no more interrupt numbers are available, the system variable ERRNO is set to
ERR_INOMAX.
Syntax
(EBNF)
CONNECT <connect target> WITH <trap>‘;’
Related information
Described in:
Summary of interrupts RAPID Summary - Interrupts
More information on interrupt management Basic Characteristics- Interrupts
It can be used to determine which unit is to be active when, for example, common drive
units are used.
Examples
DeactUnit orbit_a;
The unit track_motion will be stationary when the robot moves to p20 and p30.
After this, both the robot and track_motion will move to p40.
Arguments
DeactUnit MecUnit
MecUnit (Mechanical Unit) Data type: mecunit
Program execution
When the robot and external axes have come to a standstill, the specified mechanical
unit is deactivated. This means that it will neither be controlled nor monitored until it
is re-activated.
If several mechanical units share a common drive unit, deactivation of one of the
mechanical units will also disconnect that unit from the common drive unit.
Limitations
Instruction DeactUnit cannot be used
The movement instruction previous to this instruction, should be terminated with a stop
point in order to make a restart in this instruction possible following a power failure.
Syntax
DeactUnit
[MecUnit ’:=’ ] < variable (VAR) of mecunit> ’;’
Related information
Described in:
Activating mechanical units Instructions - ActUnit
Mechanical units Data Types - mecunit
Decr Decrements by 1
Decr is used to subtract 1 from a numeric variable or persistent.
Example
Decr reg1;
Arguments
Decr Name
Name Data type: num
Example
TPReadNum no_of_parts, "How many parts should be produced? ";
WHILE no_of_parts>0 DO
produce_part;
Decr no_of_parts;
ENDWHILE
The operator is asked to input the number of parts to be produced. The variable
no_of_parts is used to count the number that still have to be produced.
Syntax
Decr
[ Name ’:=’ ] < var or pers (INOUT) of num > ’;’
Related information
Described in:
Incrementing a variable by 1 Instructions - Incr
Subtracting any value from a variable Instructions - Add
Changing data using an arbitrary Instructions - :=
expression, e.g. multiplication
The offset for external axes is activated by the instruction EOffsSet or EOffsOn and
applies to all movements until some other offset for external axes is activated or until
the offset for external axes is deactivated.
Examples
EOffsOff;
An offset is defined as the difference between the position of each axis at p10 and
p11. This displacement affects the movement to p20 and p30, but not to p40.
Program execution
Active offsets for external axes are reset.
Syntax
EOffsOff ‘;’
Related information
Described in:
Definition of offset using two positions Instructions - EOffsOn
Definition of offset using values Instructions - EOffsSet
Deactivation of the robot’s motion displacement Instructions - PDispOff
Examples
MoveL p10, v500, z10, tool1;
EOffsOn \ExeP:=p10, p20;
Activation of an offset for external axes. This is calculated for each axis based
on the difference between positions p10 and p20.
Activation of an offset for external axes. Since a stop point that is accurately
defined has been used in the previous instruction, the argument \ExeP does not
have to be used. The displacement is calculated on the basis of the difference
between the actual position of each axis and the programmed point (*) stored in
the instruction.
Arguments
EOffsOn [ \ExeP ] ProgPoint
[\ExeP ] (Executed Point) Data type: robtarget
The new position of the axes at the time of the program execution. If this argument
is omitted, the current position of the axes at the time of the program execution is
used.
Program execution
The offset is calculated as the difference between ExeP and ProgPoint for each sepa-
rate external axis. If ExeP has not been specified, the current position of the axes at the
time of the program execution is used instead. Since it is the actual position of the axes
that is used, the axes should not move when EOffsOn is executed.
This offset is then used to displace the position of external axes in subsequent position-
ing instructions and remains active until some other offset is activated (the instruction
EOffsSet or EOffsOn) or until the offset for external axes is deactivated (the instruction
EOffsOff).
Only one offset for each individual external axis can be activated at any one time. Sev-
eral EOffsOn, on the other hand, can be programmed one after the other and, if they are,
the different offsets will be added.
- at a cold start-up
- when a new program is loaded
- when starting program executing from the beginning.
Example
SearchL sen1, psearch, p10, v100, tool1;
PDispOn \ExeP:=psearch, *, tool1;
EOffsOn \ExeP:=psearch, *;
A search is carried out in which the searched position of both the robot and the
external axes is stored in the position psearch. Any movement carried out after
this starts from this position using a program displacement of both the robot and
the external axes. This is calculated based on the difference between the searched
position and the programmed point (*) stored in the instruction.
Syntax
EOffsOn
[ ‘\’ ExeP ’:=’ < expression (IN) of robtarget > ’,’]
[ ProgPoint ’:=’ ] < expression (IN) of robtarget > ’;’
Related information
Described in:
Deactivation of offset for external axes Instructions - EOffsOff
Definition of offset using values Instructions - EOffsSet
Displacement of the robot’s movements Instructions - PDispOn
Coordinate Systems Motion Principles- Coordinate Systems
Example
VAR extjoint eax_a_p100 := [100, 0, 0, 0, 0, 0];
.
EOffsSet eax_a_p100;
Activation of an offset eax_a_p100 for external axes, meaning (provided that the
external axis “a” is linear) that:
- The ExtOffs coordinate system is displaced 100 mm for the logical axis “a” (see
Figure 22).
- As long as this offset is active, all positions will be displaced 100 mm in the
direction of the x-axis.
.
100
Normal
Coordinate System
0 +X
ExtOffs
Coordinate System
0 +X
Figure 22 Displacement of an external axis.
Arguments
EOffsSet EAxOffs
EAxOffs (External Axes Offset) Data type: extjoint
The offset for external axes is defined as data of the type extjoint, expressed in:
Program execution
The offset for external axes is activated when the EOffsSet instruction is activated and
remains active until some other offset is activated (the instruction EOffsSet or EOffsOn)
or until the offset for external axes is deactivated (the EOffsOff).
Only one offset for external axes can be activated at any one time. Offsets cannot be
added to one another using EOffsSet.
- at a cold start-up
- when a new program is loaded
- when starting program executing from the beginning.
Syntax
EOffsSet
[ EAxOffs ’:=’ ] < expression (IN) of extjoint> ’;’
Related information
Described in:
Deactivation of offset for external axes Instructions - EOffsOff
Definition of offset using two positions Instructions - EOffsSet
Displacement of the robot’s movements Instructions - PDispOn
Definition of data of the type extjoint Data Types - extjoint
Coordinate Systems Motion Principles- Coordinate Systems
Example
ErrWrite “PLC error”, “Fatal error in PLC” \RL2:=”Call service”;
Stop;
A message is stored in the robot log. The message is also shown on the teach
pendant display.
A message is stored in the robot log only. Program execution then continues.
Arguments
ErrWrite [ \W ] Header Reason [ \RL2] [ \RL3] [ \RL4]
[ \W ] (Warning) Data type: switch
Gives a warning that is stored in the robot error message log only (not shown
directly on the teach pendant display).
Program execution
An error message (max. 5 lines) is displayed on the teach pendant and written in the
robot message log.
ErrWrite always generates the program error no. 80001 or in the event of a warning
(argument \W) generates no. 80002.
Limitations
Total string length (Header+Reason+\RL2+\RL3+\RL4) is limited to 145 characters.
Syntax
ErrWrite
[ ’\’ W ’,’ ]
[ Header ’:=’ ] < expression (IN) of string> ‘,’
[ Reason ’:=’ ] < expression (IN) of string>
[ ’\’ RL2 ’:=’ < expression (IN) of string> ]
[ ’\’ RL3 ’:=’ < expression (IN) of string> ]
[ ’\’ RL4 ’:=’ < expression (IN) of string> ] ‘;’
Related information
Described in:
Display a message on Instructions - TPWrite
the teach pendant only
Message logs Service
The EXIT instruction should be used when fatal errors occur or when program
execution is to be stopped permanently. The Stop instruction is used to temporarily stop
program execution.
Example
ErrWrite "Fatal error","Illegal state";
EXIT;
Program execution stops and cannot be restarted from that position in the
program.
Syntax
EXIT ’;’
Related information
Described in:
Stopping program execution temporarily Instructions - Stop
If the program is executed in continuous mode, it will start to execute the next cycle.
If the execution is in cycle mode, the execution will stop at the first instruction in the
main routine.
Example
VAR num cyclecount:=0;
VAR intnum error_intno;
PROC main()
IF cyclecount = 0 THEN
CONNECT error_intno WITH error_trap;
ISignalDI di_error,1,error_intno;
ENDIF
cyclecount:=cyclecount+1;
! start to do something intelligent
....
ENDPROC
TRAP error_trap
TPWrite “ERROR, I will start on the next item”;
ExitCycle;
ENDTRAP
This will start the next cycle if the signal di_error is set.
Program execution
Execution of ExitCycle in the MAIN program task, results in the following in the
MAIN task:
Execution of ExitCycle in some other program task (besides MAIN) results in the
following in the actual task:
- All instructions that are started but not finished on all execution levels (both
normal and TRAP level) are interrupted
- The program pointer is moved to the first instruction in the main routine
- The program execution continues to execute the next cycle
All other modal things in the program and system are not affected by ExitCycle such as:
Syntax
ExitCycle’;’
Related information
Described in:
Stopping after a fatal error Instructions - EXIT
Terminating program execution Instructions - EXIT
Stopping for program actions Instructions - Stop
Finishing execution of a routine Instructions - RETURN
If the instructions are to be repeated as long as a given condition is met, the WHILE
instruction is used.
Example
FOR i FROM 1 TO 10 DO
routine1;
ENDFOR
Arguments
FOR Loop counter FROM Start value TO End value
[STEP Step value] DO ... ENDFOR
Loop counter Identifier
The name of the data that will contain the value of the current loop counter.
The data is declared automatically and its name should therefore not be the same
as the name of any data that exists already.
The value by which the loop counter is to be incremented (or decremented) each loop.
(usually integer values)
If this value is not specified, the step value will automatically be set to 1 (or -1 if
the start value is greater than the end value).
Example
FOR i FROM 10 TO 2 STEP -1 DO
a{i} := a{i-1};
ENDFOR
The values in an array are adjusted upwards so that a{10}:=a{9}, a{9}:=a{8} etc.
Program execution
1. The expressions for the start, end and step values are calculated.
2. The loop counter is assigned the start value.
3. The value of the loop counter is checked to see whether its value lies between the
start and end value, or whether it is equal to the start or end value. If the value of the
loop counter is outside of this range, the FOR loop stops and program execution con-
tinues with the instruction following ENDFOR.
4. The instructions in the FOR loop are executed.
5. The loop counter is incremented (or decremented) in accordance with the step value.
6. The FOR loop is repeated, starting from point 3.
Limitations
The loop counter (of data type num) can only be accessed from within the FOR loop
and consequently hides other data and routines that have the same name. It can only be
read (not updated) by the instructions in the FOR loop.
Decimal values for start, end or stop values, in combination with exact termination con-
ditions for the FOR loop, cannot be used (undefined whether or not the last loop is run-
ning).
Syntax
(EBNF)
FOR <loop variable> FROM <expression> TO <expression>
[ STEP <expression> ] DO
<instruction list>
ENDFOR
<loop variable> ::= <identifier>
Related information
Described in:
Expressions Basic Characteristics - Expressions
Identifiers Basic Characteristics -
Basic Elements
With this instruction it is possible to fetch data for and the name of the current active
Tool or Work Object.
Example
PERS tooldata curtoolvalue := [TRUE, [[0, 0, 0], [1, 0, 0, 0]],
[0, [0, 0, 0], [1, 0, 0, 0], 0, 0, 0]];
VAR string curtoolname;
GetSysData curtoolvalue;
Copy current active tool data value to the persistent variable curtoolvalue.
Arguments
GetSysData DestObject [\ ObjectName ]
DestObject Data type: anytype
The data type of this argument also specifies the type of system data (Tool or
Work Object) to fetch.
Option argument (variable or persistent) to also fetch the current active system
data name.
Program execution
When running the instruction GetSysData the current data value is stored in the speci-
fied persistent in argument DestObject.
If argument \ObjectName is used, the name of the current data is stored in the specified
variable or persistent in argument ObjectName.
Current system data for Tool or Work Object is activated by execution of any move
instruction or can be manually set in the jogging window.
Syntax
GetSysData
[ DestObject’:=’] < persistent(PERS) of anytype>
[’\’ObjectName’:=’ < expression (INOUT) of string> ] ’;’
Related information
Described in:
Definition of tools Data Types - tooldata
Definition of work objects Data Types - wobjdata
Examples
GOTO next;
.
next:
reg1 := 1;
next:
.
reg1 := reg1 + 1;
IF reg1<=5 GOTO next;
If reg1 is greater than 100, the highvalue program loop is executed; otherwise
the lowvalue loop is executed.
Arguments
GOTO Label
Label Identifier
Limitations
It is only possible to transfer program execution to a label within the same routine.
Syntax
(EBNF)
GOTO <identifier>’;’
Related information
Described in:
Label Instructions - label
Other instructions that change the program RAPID Summary -
flow Controlling the Program Flow
Description
It is important to always define the actual tool load and when used, the payload
of the robot too. Incorrect definitions of load data can result in overloading of the
robot mechanical structure.
When incorrect load data is specified, it can often lead to the following consequences:
- If the value in the specified load data is greater than that of the value of the true
load;
-> The robot will not be used to its maximum capacity
-> Impaired path accuracy including a risk of overshooting
If the value in the specified load data is less than the value of the true load;
-> Impaired path accuracy including a risk of overshooting
-> Risk of overloading the mechanical structure
Examples
GripLoad piece1;
GripLoad load0;
Arguments
GripLoad Load
Load Data type: loaddata
Program execution
The specified load affects the performance of the robot.
- at a cold start-up
- when a new program is loaded
- when starting program executing from the beginning.
Syntax
GripLoad
[ Load ’:=’ ] < persistent (PERS) of loaddata > ’;’
Related information
Described in:
Definition of load data Data Types - loaddata
Definition of tool load Data Types - tooldata
Example
IDelete feeder_low;
Arguments
IDelete Interrupt
Interrupt Data type: intnum
Program execution
The definition of the interrupt is completely erased. To define it again, it must first be
re-connected to the trap routine.
The instruction should be preceded by a stop point. Otherwise the interrupt will be
deactivated before the end point is reached.
Syntax
IDelete
[ Interrupt ‘:=’ ] < variable (VAR) of intnum > ‘;’
Related information
Described in:
Summary of interrupts RAPID Summary - Interrupts
Temporarily disabling an interrupt Instructions - ISleep
Temporarily disabling all interrupts Instructions - IDisable
Example
IDisable;
FOR i FROM 1 TO 100 DO
character[i]:=ReadBin(sensor);
ENDFOR
IEnable;
Program execution
Interrupts which occur during the time in which an IDisable instruction is in effect are
placed in a queue. When interrupts are permitted once more, the interrupt(s) of the pro-
gram then immediately start generating, executed in “first in - first out” order in the
queue.
Syntax
IDisable‘;’
Related information
Described in:
Summary of interrupts RAPID Summary - Interrupt
Permitting interrupts Instructions - IEnable
Example
IDisable;
FOR i FROM 1 TO 100 DO
character[i]:=ReadBin(sensor);
ENDFOR
IEnable;
No interrupts are permitted as long as the serial channel is reading. When it has
finished reading, interrupts are once more permitted.
Program execution
Interrupts which occur during the time in which an IDisable instruction is in effect, are
placed in a queue. When interrupts are permitted once more (IEnable), the interrupt(s)
of the program then immediately start generating, executed in “first in - first out” order
in the queue.Program execution then continues in the ordinary program and interrupts
which occur after this are dealt with as soon as they occur.
Interrupts are always permitted when a program is started from the beginning,. Inter-
rupts disabled by the ISleep instruction are not affected by the IEnable instruction.
Syntax
IEnable‘;’
Related information
Described in:
Summary of interrupts RAPID Summary - Interrupts
Permitting no interrupts Instructions - IDisable
Examples
IF reg1 > 5 GOTO next;
Arguments
IF Condition ...
Condition Data type: bool
Syntax
(EBNF)
IF <conditional expression> ( <instruction> | <SMT>) ’;’
Related information
Described in:
Conditions (logical expressions) Basic Characteristics - Expressions
IF with several instructions Instructions - IF
Examples
IF reg1 > 5 THEN
Set do1;
Set do2;
ENDIF
The do1 and do2 signals are set only if reg1 is greater than 5.
The do1 and do2 signals are set or reset depending on whether reg1 is greater
than 5 or not.
Arguments
IF Condition THEN ...
{ELSEIF Condition THEN ...}
[ELSE ...]
ENDIF
Condition Data type: bool
The condition that must be satisfied for the instructions between THEN and
ELSE/ELSEIF to be executed.
Example
IF counter > 100 THEN
counter := 100;
ELSEIF counter < 0 THEN
counter := 0;
ELSE
counter := counter + 1;
ENDIF
Program execution
The conditions are tested in sequential order, until one of them is satisfied. Program
execution continues with the instructions associated with that condition. If none of the
conditions are satisfied, program execution continues with the instructions following
ELSE. If more than one condition is met, only the instructions associated with the first
of those conditions are executed.
Syntax
(EBNF)
IF <conditional expression> THEN
<instruction list>
{ELSEIF <conditional expression> THEN <instruction list> | <EIF>}
[ELSE
<instruction list>]
ENDIF
Related information
Described in:
Conditions (logical expressions) Basic Characteristics - Expressions
Incr Increments by 1
Incr is used to add 1 to a numeric variable or persistent.
Example
Incr reg1;
Arguments
Incr Name
Name Data type: num
Example
WHILE stop_production=0 DO
produce_part;
Incr no_of_parts;
TPWrite "No of produced parts= "\Num:=no_of_parts;
ENDWHILE
The number of parts produced is updated on the teach pendant each cycle.
Production continues to run as long as the signal stop_production is not set.
Syntax
Incr
[ Name ’:=’ ] < var or pers (INOUT) of num > ’;’
Related information
Described in:
Decrementing a variable by 1 Instructions - Decr
Adding any value to a variable Instructions - Add
Changing data using an arbitrary Instructions - :=
expression, e.g. multiplication
Example
InvertDO do15;
Arguments
InvertDO Signal
Signal Data type: signaldo
Program execution
The current value of the signal is inverted (see Figure 23).
:
1
Signal level
0
Execution of the instruction InvertDO
Execution of the instruction InvertDO
1
Signal level
0
Syntax
InvertDO
[ Signal ’:=’ ] < variable (VAR) of signaldo > ’;’
Related information
Described in:
Input/Output instructions RAPID Summary -
Input and Output Signals
Input/Output functionality in general Motion and I/O Principles -
I/O Principles
Configuration of I/O System Parameters
I/O units are automatically enabled after start-up if they are defined in the system
parameters. When required for some reason, I/O units can be disabled or enabled dur-
ing program execution.
Examples
CONST string cell1:=”cell1”;
IODisable cell1, 5;
Arguments
IODisable UnitName MaxTime
UnitName Data type: string
The name of the I/O unit to be disabled (with same name as configured).
Program execution
The specified I/O unit starts the disable steps. The instruction is ready when the disable
steps are finished. If the MaxTime runs out before the I/O unit has finished the disable
steps, a recoverable error will be generated.
After disabling an I/O unit, any setting of outputs in this unit will result in an error.
Error handling
Following recoverable errors can be generated. The errors can be handled in an error
handler. The system variable ERRNO will be set to:
ERR_IODISABLE if the time out time runs out before the unit is
disabled.
ERR_CALLIO_INTER if an IOEnable or IODisable request is interrupted
by another request to the same unit.
ERR_NAME_INVALID if the unit name don’t exist or if the unit isn’t
allowed to be disabled.
Example
PROC go_home()
VAR num recover_flag :=0;
...
! Start to disable I/O unit cell1
recover_flag := 1;
IODisable “cell1”, 0;
! Move to home position
MoveJ home, v1000,fine,tool1;
! Wait until disable of I/O unit cell1 is ready
recover_flag := 2;
IODisable “cell1”, 5;
...
ERROR
IF ERRNO = ERR_IODISABLE THEN
IF recover_flag = 1 THEN
TRYNEXT;
ELSEIF recover_flag = 2 THEN
RETRY;
ENDIF
ELSEIF ERRNO = ERR_EXCRTYMAX THEN
ErrWrite “IODisable error”, “Not possible to disable I/O unit cell1”;
Stop;
ENDIF
ENDPROC
To save cycle time, the I/O unit cell1 is disabled during robot movement to the
home position. With the robot at the home position, a test is done to establish
whether or not the I/O unit cell1 is fully disabled. After the max. number of retries
(5 with a waiting time of 5 s), the robot execution will stop with an error message.
The same principle can be used with IOEnable (this will save more cycle time
compared with IODisable).
Syntax
IODisable
[ UnitName ’:=’ ] < expression (IN) of string> ’,’
[ MaxTime ’:=’ ] < expression (IN) of num > ’;’
Related information
Described in:
Enabling an I/O unit Instructions - IOEnable
Input/Output instructions RAPID Summary -
Input and Output Signals
Input/Output functionality in general Motion and I/O Principles -
I/O Principles
Configuration of I/O User’s Guide - System Parameters
I/O units are automatically enabled after start-up if they are defined in the system
parameters. When required for some reason, I/O units can be disabled or enabled dur-
ing program execution.
Examples
CONST string cell1:=”cell1”;
IOEnable cell1, 5;
Arguments
IOEnable UnitName MaxTime
UnitName Data type: string
The name of the I/O unit to be enabled (with same name as configured).
Program execution
The specified I/O unit starts the enable steps. The instruction is ready when the enable
steps are finished. If the MaxTime runs out before the I/O unit has finished the enable
steps, a recoverable error will be generated.
After a sequence of IODisable - IOEnable, all outputs for the current I/O unit will be
set to the old values (before IODisable).
Error handling
Following recoverable errors can be generated. The errors can be handled in an error
ERR_IOENABLE if the time out time runs out before the unit is
enabled.
ERR_CALLIO_INTER if an IOEnable or IODisable request is interrupted
by another request to the same unit.
ERR_NAME_INVALID if the unit name don’t exist or if the unit isn’t
allowed to be disabled.
Example
IOEnable can also be used to check whether some I/O unit is disconnected for some
reason.
Before using signals on the I/O unit cell1, a test is done by trying to enable the I/
O unit with timeout after 0 sec. If the test fails, a jump is made to the error han-
dler. In the error handler, the program execution waits for 1 sec. and a new retry
is made. After 5 retry attempts the error ERR_IOENABLE is propagated to the
caller of this routine.
Syntax
IOEnable
[ UnitName ’:=’ ] < expression (IN) of string> ’,’
[ MaxTime ’:=’ ] < expression (IN) of num > ’;’
Related information
Described in:
More examples Instructions - IODisable
Disabling an I/O unit Instructions - IODisable
Input/Output instructions RAPID Summary -
Input and Output Signals
Input/Output functionality in general Motion and I/O Principles -
I/O Principles
Configuration of I/O User’s Guide - System Parameters
Example
VAR intnum sig1int;
CONNECT sig1int WITH iroutine1;
ISignalAI \Single, ai1, AIO_BETWEEN, 1.5, 0.5, 0, sig1int;
Orders an interrupt which is to occur the first time the logical value of the analog
input signal ai1 is between 0.5 and 1.5. A call is then made to the iroutine1 trap
routine.
Orders an interrupt which is to occur each time the logical value of the analog
input signal ai1 is between 0.5 and 1.5, and the absolute signal difference com-
pared to the stored reference value is bigger than 0.1.
Orders an interrupt which is to occur each time the logical value of the analog
input signal ai1 is lower than 0.5 or higher than 1.5, and the absolute signal dif-
ference compared to the stored reference value is bigger than 0.1.
Arguments
ISignalAI [\Single] Signal Condition HighValue LowValue
DeltaValue [\DPos] | [\DNeg] Interrupt
[\Single] Data type: switch
If the argument Single is set, the interrupt occurs once at the most. If the argu-
ment is omitted, an interrupt will occur each time its condition is satisfied.
Defines the minimum logical signal difference before generation of a new inter-
rupt. The current signal value compared to the stored reference value must be
greater than the specified DeltaValue before generation of a new interrupt.
Specifies that only positive logical signal differences will give new interrupts.
Specifies that only negative logical signal differences will give new interrupts.
If none of \DPos and \DNeg argument is used, both positive and negative differ-
ences will generate new interrupts.
The interrupt identity. This interrupt should have previously been connected to a
trap routine by means of the instruction CONNECT.
Program execution
When the signal fulfils the specified conditions (both Condition and DeltaValue), a
call is made to the corresponding trap routine. When this has been executed, program
execution continues from where the interrupt occurred.
Before the interrupt subscription is ordered, each time the signal is sampled, the value
of the signal is read, saved, and later used as a reference value for the DeltaValue con-
dition.
At the interrupt subscription time, if specified DeltaValue = 0 and after the interrupt
subscription time always at each time the signal is sampled, its value is then compared
to HighValue and LowValue according to Condition and with consideration to DeltaV-
alue, to generate or not generate an interrupt. If the new read value satisfies the speci-
fied HighValue and LowValue Condition, but its difference compared to the last stored
reference value is less or equal to the DeltaValue argument, no interrupt occurs.
If the signal difference is not in the specified direction, no interrupts will occur.
(argument \DPos or \DNeg).
The stored reference value for the DeltaValue condition is updated with a newly read
value for later use at any sample, if the following conditions are satisfied:
The reference value is only updated at the sample time, not at the interrupt subscription
time.
An interrupt is also generated at the sample for update of the reference value, if the
direction of the signal difference is in accordance with the specified argument
(any direction, \DPos or \DNeg).
When the \Single switch is used, only one interrupt at the most will be generated.
If the switch \Single (cyclic interrupt) is not used, a new test of the specified conditions
(both Condition and DeltaValue) is made at every sample of the signal value, com-
pared to the current signal value and the last stored reference value, to generate or not
generate an interrupt.
RefValue := CurrentValue
Interrupt subscription
False
CurrentValue tested against Condition
HighValue and LowValue
True
False
DeltaValue = 0
True
Interrupt generated
Continue
New Sample
False
CurrentValue checked against Condition
HighValue and LowValue
True
True
No DPos or DNeg specified and
ABS(CurrentValue - RefValue) > DeltaValue
False
False
True
DNeg specified and
(RefValue - CurrentValue) > DeltaValue
False
RefValue := CurrentValue
False
True
RefValue := CurrentValue
Continue
HighValue
Signal Value
LowValue
0 1 2 3 4 5 6 7 8 9 10 11 12 Samples
Time for order of interrupt subscription
Storage of reference value
Assuming the interrupt is ordered between sample 0 and 1, the following instruction
will give the following results:
sample 1 will generate an interrupt, because the signal value is between High-
Value and LowValue and the signal difference compared to sample 0 is more than
DeltaValue.
sample 2 will generate an interrupt, because the signal value is between High-
Value and LowValue and the signal difference compared to sample 1 is more than
DeltaValue.
samples 3, 4, 5 will not generate any interrupt, because the signal difference is
less than DeltaValue.
samples 7 to 10 will not generate any interrupt, because the signal is above
HighValue
sample 11 will not generate any interrupt, because the signal difference compared
to sample 6 is equal to DeltaValue.
sample 12 will not generate any interrupt, because the signal difference compared
to sample 6 is less than DeltaValue.
HighValue
Signal Value
LowValue
0 1 2 3 4 5 6 7 8 9 10 11 12 Samples
Time for order of interrupt subscription
Storage of reference value
Assuming the interrupt is ordered between sample 0 and 1, the following instruction
will give the following results:
A new reference value is stored at sample 1 and 2, because the signal is within
limits and the absolute signal difference between the current value and the last
stored reference value is greater than 1.0.
No interrupt will be generated because the signal changes are in the negative
direction.
sample 6 will generate an interrupt, because the signal value is between High-
Value and LowValue and the signal difference in the positive direction compared
to sample 2 is more than DeltaValue.
HighValue
Signal Value
LowValue
0 1 2 3 4 5 6 7 8 9 10 11 12 Samples
Time for order of interrupt subscription
Storage of reference value
Assuming the interrupt is ordered between sample 0 and 1, the following instruction
will give the following results:
A new reference value is stored at sample 7, because the signal is within limits
and the absolute signal difference between the current value and the last stored
reference value is greater than 1.0
sample 8 will generate an interrupt, because the signal value is above HighValue
and the signal difference in the positive direction compared to sample 7 is more
than DeltaValue.
HighValue
Signal Value
LowValue
0 1 2 3 4 5 6 7 8 9 10 11 12 Samples
Time for order of interrupt subscription
Storage of reference value
Assuming the interrupt is ordered between sample 0 and 1, the following instruction
will give the following results:
A new reference value is stored at sample 1 and 2, because the signal is within
limits and the absolute signal difference between the current value and the last
stored reference value is greater than 1.0
sample 6 will generate an interrupt, because the signal difference in the positive
direction compared to sample 2 is more than DeltaValue.
sample 7 and 8 will generate an interrupt, because the signal difference in the
positive direction compared to previous sample is more than DeltaValue.
A new reference value is stored at sample 11 and 12, because the signal is within
limits and the absolute signal difference between the current value and the last
stored reference value is greater than 1.0
Error handling
If there is a subscription of interrupt on an analog input signal, an interrupt will be
given for every change in the analog value that satisfies the condition specified when
ordering the interrupt subscription. If the analog value is noisy, many interrupts can be
generated, even if only one or two bits in the analog value are changed.
To avoid generating interrupts for small changes of the analog input value, set the
DeltaValue to a level greater than 0. Then no interrupts will be generated until a change
of the analog value is greater than the specified DeltaValue.
Limitations
The HighValue and LowValue arguments should be in the range: logical maximum
value, logical minimum value defined for the signal.
The limitations for the interrupt identity are the same as for ISignalDI.
Syntax
ISignalAI
[ ’\’Single’,’]
[ Signal’:=’ ]<variable (VAR) of signalai>’,’
[ Condition’:=’ ]<expression (IN) of aiotrigg>’,’
[ HighValue’:=’ ]<expression (IN) of num>’,’
[ LowValue’:=’ ]<expression (IN) of num>’,’
[ DeltaValue’:=’ ]<expression (IN) of num>
[ ’\’DPos] | [ ’\’DNeg] ’,’
[ Interrupt’:=’ ]<variable (VAR) of intnum>’;’
Related information
Described in:
Summary of interrupts RAPID Summary - Interrupts
Definition of constants Data Types - aiotrigg
Interrupt from analog output signal Instructions - ISignalAO
Interrupt from digital input signal Instructions - ISignalDI
Interrupt from digital output signal Instructions - ISignalDO
More information on interrupt management Basic Characteristics - Interrupts
More examples Data Types - intnum
Related system parameters (filter) System Parameters - IO Signals
Example
VAR intnum sig1int;
CONNECT sig1int WITH iroutine1;
ISignalAO \Single, ao1, AIO_BETWEEN, 1.5, 0.5, 0, sig1int;
Orders an interrupt which is to occur the first time the logical value of the analog
output signal ao1 is between 0.5 and 1.5. A call is then made to the iroutine1 trap
routine.
Orders an interrupt which is to occur each time the logical value of the analog
output signal ao1 is between 0.5 and 1.5, and the absolute signal difference com-
pared to the previous stored reference value is bigger than 0.1.
Orders an interrupt which is to occur each time the logical value of the analog
output signal ao1 is lower than 0.5 or higher than 1.5, and the absolute signal dif-
ference compared to the previous stored reference value is bigger than 0.1.
Arguments
ISignalAO [\Single] Signal Condition HighValue LowValue
DeltaValue [\DPos] | [\DNeg] Interrupt
[\Single] Data type: switch
If the argument Single is set, the interrupt occurs once at the most. If the argu-
ment is omitted, an interrupt will occur each time its condition is satisfied.
Defines the minimum logical signal difference before generation of a new inter-
rupt. The current signal value compared to the previous stored reference value
must be greater than the specified DeltaValue before generation of a new inter-
rupt.
Specifies that only positive logical signal differences will give new interrupts.
Specifies that only negative logical signal differences will give new interrupts.
If neither of the \DPos and \DNeg arguments are used, both positive and negative
differences will generate new interrupts.
The interrupt identity. This interrupt should have previously been connected to a
trap routine by means of the instruction CONNECT.
Program execution
See instruction ISignalAI for information about:
- Program execution
- Condition for interrupt generation
- More examples
Limitations
The HighValue and LowValue arguments should be in the range: logical maximum
value, logical minimum value, defined for the signal.
The limitations for the interrupt identity are the same as for ISignalDO.
Syntax
ISignalAO
[ ’\’Single’,’]
[ Signal’:=’ ]<variable (VAR) of signalao>’,’
[ Condition’:=’ ]<expression (IN) of aiotrigg>’,’
[ HighValue’:=’ ]<expression (IN) of num>’,’
[ LowValue’:=’ ]<expression (IN) of num>’,’
[ DeltaValue’:=’ ]<expression (IN) of num>
[ ’\’DPos] | [ ’\’DNeg] ’,’
[ Interrupt’:=’ ]<variable (VAR) of intnum>’;’
Related information
Described in:
Summary of interrupts RAPID Summary - Interrupts
Definition of constants Data Types - aiotrigg
Interrupt from analog input signal Instructions - ISignalAI
Interrupt from digital input signal Instructions - ISignalDI
Interrupt from digital output signal Instructions - ISignalDO
More information on interrupt management Basic Characteristics - Interrupts
More examples Data Types - intnum
Related system parameters (filter) System Parameters - IO Signals
Examples
VAR intnum sig1int;
CONNECT sig1int WITH iroutine1;
ISignalDI di1,1,sig1int;
Orders an interrupt which is to occur each time the digital input signal di1 is set
to 1. A call is then made to the iroutine1 trap routine.
ISignalDI di1,0,sig1int;
Orders an interrupt which is to occur each time the digital input signal di1 is set
to 0.
Orders an interrupt which is to occur only the first time the digital input signal
di1 is set to 1.
Arguments
ISignalDI [ \Single ] Signal TriggValue Interrupt
[ \Single ] Data type: switch
If the argument Single is set, the interrupt occurs once at the most. If the argu-
ment is omitted, an interrupt will occur each time its condition is satisfied.
The value to which the signal must change for an interrupt to occur.
The interrupt identity. This should have previously been connected to a trap rou-
tine by means of the instruction CONNECT.
Program execution
When the signal assumes the specified value, a call is made to the corresponding trap
routine. When this has been executed, program execution continues from where the
interrupt occurred.
If the signal changes to the specified value before the interrupt is ordered, no interrupt
occurs (see Figure 24).
:
1
Signal level
0
Interrupt occurs
Interrupt ordered
Interrupt ordered
1
Signal level
0
Interrupt occurs
Figure 24 Interrupts from a digital input signal at signal level 1.
Limitations
The same variable for interrupt identity cannot be used more than once, without first
deleting it. Interrupts should therefore be handled as shown in one of the alternatives
below.
PROC main ( )
VAR intnum sig1int;
CONNECT sig1int WITH iroutine1;
ISignalDI di1, 1, sig1int;
WHILE TRUE DO
:
:
ENDWHILE
ENDPROC
PROC main ( )
VAR intnum sig1int;
CONNECT sig1int WITH iroutine1;
ISignalDI di1, 1, sig1int;
:
:
IDelete sig1int;
ENDPROC
The interrupt is deleted at the end of the program, and is then reactivated. It
should be noted, in this case, that the interrupt is inactive for a short period.
Syntax
ISignalDI
[ ’\’ Single’,’]
[ Signal ’:=’ ] < variable (VAR) of signaldi > ’,’
[ TriggValue ’:=’ ] < expression (IN) of dionum >’,’
[ Interrupt ’:=’ ] < variable (VAR) of intnum > ’;’
Related information
Described in:
Summary of interrupts RAPID Summary - Interrupts
Interrupt from an output signal Instructions - ISignalDO
More information on interrupt management Basic Characteristics - Interrupts
More examples Data Types - intnum
Examples
VAR intnum sig1int;
CONNECT sig1int WITH iroutine1;
ISignalDO do1,1,sig1int;
Orders an interrupt which is to occur each time the digital output signal do1 is
set to 1. A call is then made to the iroutine1 trap routine.
ISignalDO do1,0,sig1int;
Orders an interrupt which is to occur each time the digital output signal do1 is
set to 0.
ISignalDO\Single, do1,1,sig1int;
Orders an interrupt which is to occur only the first time the digital output signal
do1 is set to 1.
Arguments
ISignalDO [ \Single ] Signal TriggValue Interrupt
[ \Single ] Data type: switch
If the argument Single is set, the interrupt occurs once at the most. If the argu-
ment is omitted, an interrupt will occur each time its condition is satisfied.
The value to which the signal must change for an interrupt to occur.
The interrupt identity. This should have previously been connected to a trap rou-
tine by means of the instruction CONNECT.
Program execution
When the signal assumes the specified value 0 or 1, a call is made to the corresponding
trap routine. When this has been executed, program execution continues from where
the interrupt occurred.
If the signal changes to the specified value before the interrupt is ordered, no interrupt
occurs (see Figure 25).
1
Signal level
0
Interrupt occurs
Interrupt ordered
Interrupt ordered
1
Signal level
0
Interrupt occurs
Figure 25 Interrupts from a digital output signal at signal level 1.
Limitations
The same variable for interrupt identity cannot be used more than once, without first
deleting it. Interrupts should therefore be handled as shown in one of the alternatives
below.
PROC main ( )
CONNECT sig1int WITH iroutine1;
ISignalDO do1, 1, sig1int;
WHILE TRUE DO
:
:
ENDWHILE
ENDPROC
PROC main ( )
VAR intnum sig1int;
CONNECT sig1int WITH iroutine1;
ISignalDO do1, 1, sig1int;
:
:
IDelete sig1int;
ENDPROC
The interrupt is deleted at the end of the program, and is then reactivated. It
should be noted, in this case, that the interrupt is inactive for a short period.
Syntax
ISignalDO
[ ’\’ Single’,’]
[ Signal ’:=’ ] < variable (VAR) of signaldo > ’,’
[ TriggValue ’:=’ ] < expression (IN) of dionum >’,’
[ Interrupt ’:=’ ] < variable (VAR) of intnum > ’;’
Related information
Described in:
Summary of interrupts RAPID Summary - Interrupts
Interrupt from an input signal Instructions - ISignalDI
More information on interrupt management Basic Characteristics- Interrupts
More examples Data Types - intnum
During the deactivation time, any generated interrupts of the specified type are
discarded without any trap execution.
Example
ISleep sig1int;
Arguments
ISleep Interrupt
Interrupt Data type: intnum
Program execution
Any generated interrupts of the specified type are discarded without any trap
execution, until the interrupt has been re-activated by means of the instruction IWatch.
Interrupts which are generated while ISleep is in effect are ignored.
Example
VAR intnum timeint;
CONNECT timeint WITH check_serialch;
ITimer 60, timeint;
.
ISleep timeint;
WriteBin ch1, buffer, 30;
IWatch timeint;
.
TRAP check_serialch
WriteBin ch1, buffer, 1;
IF ReadBin(ch1\Time:=5) < 0 THEN
TPWrite “The serial communication is broken”;
EXIT;
ENDIF
ENDTRAP
Error handling
Interrupts which have neither been ordered nor enabled are not permitted. If the inter-
rupt number is unknown, the system variable ERRNO will be set to ERR_UNKINO
(see “Data types - errnum”). The error can be handled in the error handler.
Syntax
ISleep
[ Interrupt ‘:=’ ] < variable (VAR) of intnum > ‘;’
Related information
Described in:
Summary of interrupts RAPID Summary - Interrupts
Enabling an interrupt Instructions - IWatch
Disabling all interrupts Instructions - IDisable
Cancelling an interrupt Instructions - IDelete
This instruction can be used, for example, to check the status of peripheral equipment
once every minute.
Examples
VAR intnum timeint;
CONNECT timeint WITH iroutine1;
ITimer 60, timeint;
Arguments
ITimer [ \Single ] Time Interrupt
[ \Single ] Data type: switch
If the argument Single is set, the interrupt occurs only once. If the argument is
omitted, an interrupt will occur each time at the specified time.
The amount of time that must lapse before the interrupt occurs.
The value is specified in second if Single is set, this time may not be less than
0.05 seconds. The corresponding time for cyclical interrupts is 0.25 seconds.
The variable (interrupt identity) of the interrupt. This should have previously
been connected to a trap routine by means of the instruction CONNECT.
Program execution
The corresponding trap routine is automatically called at a given time following the
interrupt order. When this has been executed, program execution continues from where
the interrupt occurred.
If the interrupt occurs cyclically, a new computation of time is started from when the
interrupt occurs.
Example
VAR intnum timeint;
CONNECT timeint WITH check_serialch;
ITimer 60, timeint;
.
TRAP check_serialch
WriteBin ch1, buffer, 1;
IF ReadBin(ch1\Time:=5) < 0 THEN
TPWrite “The serial communication is broken”;
EXIT;
ENDIF
ENDTRAP
Limitations
The same variable for interrupt identity cannot be used more than once, without being
first deleted. See Instructions - ISignalDI.
Syntax
ITimer
[ ’\’Single ’,’]
[ Time ’:=’ ] < expression (IN) of num >’,’
[ Interrupt ’:=’ ] < variable (VAR) of intnum > ’;’
Related information
Described in:
Summary of interrupts RAPID Summary - Interrupts
More information on interrupt management Basic Characteristics- Interrupts
This instruction can be used, for example, to get seam volume or gap values from a
seam tracker.
Examples
LOCAL PERS num adtVlt{25}:=[1,1.2,1.4,1.6,1.8,2,2.16667,2.33333,2.5,...];
LOCAL PERS num adptWfd{25}:=[2,2.2,2.4,2.6,2.8,3,3.16667,3.33333,3.5,...];
LOCAL PERS num adptSpd{25}:=10,12,14,16,18,20,21.6667,23.3333,25[,...];
LOCAL CONST num GAP_VARIABLE_NO:=11;
PERS num gap_value;
VAR intnum IntAdap;
PROC main()
! Setup the interrupt. The trap routine AdapTrp will be called
! when the gap variable with number ‘GAP_VARIABLE_NO’ in
! the sensor interface has been changed. The new value will be available
! in the PERS gp_value variable.
CONNECT IntAdap WITH AdapTrp;
IVarValue GAP_VARIABLE_NO, gap_value, IntAdap;
! Start welding
ArcL\On,*,v100,adaptSm,adaptWd,adaptWv,z10,tool\j\Track:=track;
ArcL\On,*,v100,adaptSm,adaptWd,adaptWv,z10,tool\j\Track:=track;
ENDPROC
TRAP AdapTrap
VAR num ArrInd;
Arguments
IVarValue VarNo Value, Interrupt
VarNo Data type: num
The variable (interrupt identity) of the interrupt. This should have previously
been connected to a trap routine by means of the instruction CONNECT.
Program execution
The corresponding trap routine is automatically called at a given time following the
interrupt order. When this has been executed, program execution continues from where
the interrupt occurred.
Limitations
The same variable for interrupt identity cannot be used more than five times, without
first being deleted.
Syntax
IVarValue
[ VarNo ’:=’ ] < expression (IN) of num >’,’
[ Value ’:=’ ] < persistent(PERS) of num >’,’
[ Interrupt ’:=’ ] < variable (VAR) of intnum > ’;’
Related information
Described in:
Summary of interrupts RAPID Summary - Interrupts
More information on interrupt management Basic Characteristics- Interrupts
Example
IWatch sig1int;
Arguments
IWatch Interrupt
Interrupt Data type: intnum
Program execution
Re-activates interrupts of the specified type once again. However, interrupts generated
during the time the ISleep instruction was in effect, are ignored.
Example
VAR intnum sig1int;
CONNECT sig1int WITH iroutine1;
ISignalDI di1,1,sig1int;
.
ISleep sig1int;
weldpart1;
IWatch sig1int;
During execution of the weldpart1 routine, no interrupts are permitted from the
signal di1.
Error handling
Interrupts which have not been ordered are not permitted. If the interrupt number is
unknown, the system variable ERRNO is set to ERR_UNKINO (see “Date types - err-
num”). The error can be handled in the error handler.
Syntax
IWatch
[ Interrupt ‘:=’ ] < variable (VAR) of intnum > ‘;’
Related information
Described in:
Summary of interrupts RAPID Summary - Interrupts
Deactivating an interrupt Instructions - ISleep
Example
GOTO next;
.
next:
Arguments
Label:
Label Identifier
Program execution
Nothing happens when you execute this instruction.
Limitations
The label must not be the same as
A label hides global data and routines with the same name within the routine it is
located in.
Syntax
(EBNF)
<identifier>’:’
Related information
Described in:
Identifiers Basic Characteristics-
Basic Elements
Moving program execution to a label Instructions - GOTO
The loaded program module will be added to the already existing modules in the pro-
gram memory.
Static mode
Table 1 How different operations affects static loaded program or system modules
Dynamic mode
Table 2 How different operations affects dynamic loaded program or system modules
Both static and dynamic loaded modules can be unloaded by the instruction UnLoad.
Example
Load \Dynamic, diskhome \File:="PART_A.MOD";
Load the program module PART_A.MOD from the diskhome into the program
memory. diskhome is a predefined string constant "HOME:". Load the program
module in the dynamic mode.
Arguments
Load [\Dynamic] FilePath [\File]
[\Dynamic] Data type: switch
The switch enables load of a program module in dynamic mode. Otherwise the
load is in static mode.
The file path and the file name to the file that will be loaded into the program
memory. The file name shall be excluded when the argument \File is used.
When the file name is excluded in the argument FilePath then it must be defined
with this argument.
Program execution
Program execution waits for the program module to finish loading before proceeding
with the next instruction.
To obtain a good program structure, that is easy to understand and maintain, all loading
and unloading of program modules should be done from the main module which is
always present in the program memory during execution.
After the program module is loaded it will be linked and initialised. The initialisation
of the loaded module sets all variables at module level to their init values. Unresolved
references will be accepted if the system parameter for Tasks is set (BindRef = NO).
However, when the program is started or the teach pendant function Program/File/
Check is used, no check for unresolved references will be done if the parameter Bind-
Ref = NO. There will be a run time error on execution of an unresolved reference.
Examples
Load \Dynamic, "HOME:/DOORDIR/DOOR1.MOD";
Same as the two examples above but the module is loaded in the static mode.
Limitations
Loading a program module that contains a main routine is not allowed.
Avoid using the floppy disk for loading since reading from the floppy drive is very time
consuming.
Error handling
If the file in the Load instructions cannot be found, then the system variable ERRNO
is set to ERR_FILNOTFND. If the module already is loaded into the program memory
then the system variable ERRNO is set to ERR_LOADED (see "Data types - errnum").
The errors above can be handled in an error handler.
Syntax
Load
[‘\’Dynamic ‘,’]
[FilePath’:=’]<expression (IN) of string>
[’\’File’:=’ <expression (IN) of string>]’;’
Related information
Described in:
Unload a program module Instructions - UnLoad
Load a program module in parallel Instructions - StartLoad-WaitLoad
with another program execution
Accept unresolved references System Parameters - Controller /
Tasks / BindRef
This instruction should be used for all mechanical units with dynamic model in servo
to achieve the best motion performance.
Example
IRBP_L
axis 1
ActUnit IRBP_L;
MechUnitLoad IRBP_L, 1, load0;
Activate mechanical unit IRBP_L and define the payload load0 corresponding to
no load (at all) mounted on axis 1.
ActUnit IRBP_L;
MechUnitLoad IRBP_L, 1, fixture1;
Activate mechanical unit IRBP_L and define the payload fixture1 corresponding
to fixture fixture1 mounted on axis 1.
ActUnit IRBP_L;
MechUnitLoad IRBP_L, 1, workpiece1;
Activate mechanical unit IRBP_L and define the payload workpiece1 corre-
sponding to fixture and work piece named workpiece1 mounted on axis 1.
Arguments
MechUnitLoad MechUnit AxisNo Load
MechUnit (Mechanical Unit) Data type: mecunit
The axis number, within the mechanical unit, that holds the load.
Program execution
After execution of MechUnitLoad, when the robot and external axes have come to a
standstill, the specified load is defined for the specified mechanical unit and axis. This
means that the payload is controlled and monitored by the control system.
The default payload at cold start-up, for a certain mechanical unit type, is the prede-
fined maximal payload for this mechanical unit type.
When some other payload is used, the actual payload for the mechanical unit and axis
should be redefined with this instruction. This should always be done after activation
of the mechanical unit.
X Fixture
End-effector coordinate system
for the mechanical unit
Work piece
Example
IRBP_K
axis 2
axis 1
axis 3
Figure 28 A mechanical unit named IRBP_K of type IRBP K with three axes.
The axes of the mechanical unit IRBP_K move to the switch position homeside2
with mounted payload on both axes 2 and 3.
Limitations
The movement instruction previous to this instruction should be terminated with a stop
point in order to make a restart in this instruction possible following a power failure.
Syntax
MechUnitLoad
[MechUnit ’:=’ ] < variable (VAR) of mecunit> ’,’
[AxisNo ‘:=’ ] <expression (IN) of num ‘,’
[ Load ’:=’ ] < persistent (PERS) of loaddata > ’;’
Related information
Described in:
Identification of payload for external LoadID&CollDetect
mechanical units - Program muloadid.prg
Mechanical units Data Types - mecunit
Definition of load data Data Types - loaddata
Definition of payload for the robot Instructions - GripLoad
Data Types - tooldata
The final position of the robot, during a movement with MoveAbsJ, is neither affected
by the given tool and work object, nor by active program displacement. However, the
robot uses these data to calculating the load, TCP velocity, and the corner path. The
same tools can be used as in adjacent movement instructions.
The robot and external axes move to the destination position along a non-linear path.
All axes reach the destination position at the same time.
Examples
MoveAbsJ p50, v1000, z50, tool2;
The robot with the tool tool2 is moved along a non-linear path to the absolute
axis position, p50, with velocity data v1000 and zone data z50.
The robot with the tool grip3, is moved along a non-linear path to a stop point
which is stored as an absolute axis position in the instruction (marked with an *).
The entire movement takes 5 s.
Arguments
MoveAbsJ [ \Conc ] ToJointPos [\NoEOffs] Speed [ \V ] | [ \T ]
Zone [ \Z ] [ \Inpos ] Tool [ \WObj ]
[ \Conc ] (Concurrent) Data type: switch
Subsequent instructions are executed while the robot is moving. The argument is
used to shorten the cycle time when, for example, communicating with external
equipment, if synchronisation is not required.
If this argument is omitted and the ToPoint is not a stop point, the subsequent
instruction is executed some time before the robot has reached the programmed
zone.
The destination absolute joint position of the robot and external axes. It is defined
as a named position or stored directly in the instruction (marked with an * in the
instruction).
If the argument NoEOffs is set, then the movement with MoveAbsJ is not affected
by active offsets for external axes.
The speed data that applies to movements. Speed data defines the velocity of the
tool centre point, the tool reorientation and external axes.
This argument is used to specify the velocity of the TCP in mm/s directly in the
instruction. It is then substituted for the corresponding velocity specified in the
speed data.
This argument is used to specify the total time in seconds during which the robot
moves. It is then substituted for the corresponding speed data.
Zone data for the movement. Zone data describes the size of the generated corner
path.
This argument is used to specify the position accuracy of the robot TCP directly
in the instruction. The length of the corner path is given in mm, which is substi-
tuted for the corresponding zone specified in the zone data.
This argument is used to specify the convergence criteria for the position of the
robots TCP in the stop point. The stop point data substitutes the zone specified in
the Zone parameter.
The position of the TCP and the load on the tool are defined in the tool data. The
TCP position is used to decide the velocity and the corner path for the movement.
This argument can be omitted if the tool is held by the robot. However, if the
robot holds the work object, i.e. the tool is stationary, or with coordinated exter-
nal axes, then the argument must be specified.
In the case of a stationary tool or coordinated external axes, the data used by the
system to decide the velocity and the corner path for the movement, is defined in
the work object.
Program execution
A movement with MoveAbsJ is not affected by active program displacement and if
executed with switch \NoEOffs, there will be no offset for external axes.
Without switch \NoEOffs, the external axes in the destination target are affected by
active offset for external axes.
The tool is moved to the destination absolute joint position with interpolation of the
axis angles. This means that each axis is moved with constant axis velocity and that all
axes reach the destination joint position at the same time, which results in a non-linear
path.
Generally speaking, the TCP is moved at approximate programmed velocity. The tool
is reoriented and the external axes are moved at the same time as the TCP moves. If
the programmed velocity for reorientation, or for the external axes, cannot be attained,
the velocity of the TCP will be reduced.
A corner path is usually generated when movement is transferred to the next section of
the path. If a stop point is specified in the zone data, program execution only continues
when the robot and external axes have reached the appropriate joint position.
Examples
MoveAbsJ *, v2000\V:=2200, z40 \Z:=45, grip3;
The tool, grip3, is moved along a non-linear path to an absolute joint position
stored in the instruction. The movement is carried out with data set to v2000 and
z40. The velocity and zone size of the TCP are 2200 mm/s and 45 mm respec-
tively.
The tool, grip3, is moved along a non-linear path to an absolute joint position p5.
The robot considers it to be in the point when 50% of the position condition and
50% of the speed condition for a stop point fine are satisfied. It waits at most for
2 seconds for the conditions to be satisfied. See predefined data inpos50 of data
type stoppointdata.
The tool, grip3, is moved along a non-linear path to an absolute joint position
stored in the instruction. Subsequent logical instructions are executed while the
robot moves.
Same movement as above but the movement is not affected by active offsets for
external axes.
GripLoad obj_mass;
MoveAbsJ start, v2000, z40, grip3 \WObj:= obj;
The robot moves the work object obj in relation to the fixed tool grip3 along a
non-linear path to an absolute axis position start.
Error handling
When running the program, a check is made that the arguments Tool and \WObj do not
contain contradictory data with regard to a movable or a stationary tool respectively.
Limitations
In order to be able to run backwards with the instruction MoveAbsJ involved, and
avoiding problems with singular points or ambiguous areas, it is essential that the sub-
sequent instructions fulfil certain requirements, as follows (see Figure 1).
Singular point
MoveJ
MoveAbsJ
Ambiguous area
MoveAbsJ
Syntax
MoveAbsJ
[ ’\’ Conc ’,’ ]
[ ToJointPos ’:=’ ] < expression (IN) of jointtarget >
[ ’\’ NoEoffs ] ’,’
[ Speed ’:=’ ] < expression (IN) of speeddata >
[ ’\’ V ’:=’ < expression (IN) of num > ]
| [ ’\’ T ’:=’ < expression (IN) of num > ] ’,’
[Zone ’:=’ ] < expression (IN) of zonedata >
[ ’\’ Z ‘:=’ < expression (IN) of num > ]
[ ’\’ Inpos ’:=’ < expression (IN) of stoppointdata > ] ‘,’
[ Tool ’:=’ ] < persistent (PERS) of tooldata >
[ ’\’ WObj ’:=’ < persistent (PERS) of wobjdata > ] ’;’
Related information
Described in:
Other positioning instructions RAPID Summary - Motion
Definition of jointtarget Data Types - jointtarget
Definition of velocity Data Types - speeddata
Definition of zone data Data Types - zonedata
Definition of stop point data Data Types - stoppointdata
Definition of tools Data Types - tooldata
Definition of work objects Data Types - wobjdata
Motion in general Motion and I/O Principles
Concurrent program execution Motion and I/O Principles -
Synchronisation Using Logical Instructions
Examples
MoveC p1, p2, v500, z30, tool2;
The TCP of the tool, tool2, is moved circularly to the position p2, with speed data
v500 and zone data z30. The circle is defined from the start position, the circle
point p1 and the destination point p2.
The TCP of the tool, grip3, is moved circularly to a fine point stored in the
instruction (marked by the second *). The circle point is also stored in the
instruction (marked by the first *). The complete movement takes 5 seconds.
A complete circle is performed if the positions are the same as those shown in
Figure 2.
p1
p4 p2
p3
Figure 2 A complete circle is performed by two MoveC instructions.
Arguments
MoveC [ \Conc ] CirPoint ToPoint Speed [ \V ] | [ \T ] Zone [ \Z]
[ \Inpos ] Tool [ \WObj ] [ \Corr ]
[ \Conc ] (Concurrent) Data type: switch
If this argument is omitted, and the ToPoint is not a Stop point the subsequent
instruction is executed some time before the robot has reached the programmed
zone.
The circle point of the robot. The circle point is a position on the circle between
the start point and the destination point. To obtain the best accuracy, it should be
placed about halfway between the start and destination points. If it is placed too
close to the start or destination point, the robot may give a warning. The circle
point is defined as a named position or stored directly in the instruction (marked
with an * in the instruction). The position of the external axes are not used.
The destination point of the robot and external axes. It is defined as a named
position or stored directly in the instruction (marked with an * in the instruction).
The speed data that applies to movements. Speed data defines the velocity of the
TCP, the tool reorientation and external axes.
This argument is used to specify the velocity of the TCP in mm/s directly in the
instruction. It is then substituted for the corresponding velocity specified in the
speed data.
This argument is used to specify the total time in seconds during which the robot
and external axes move. It is then substituted for the corresponding speed data.
Zone data for the movement. Zone data describes the size of the generated corner
path.
This argument is used to specify the position accuracy of the robot TCP directly
in the instruction. The length of the corner path is given in mm, which is
substituted for the corresponding zone specified in the zone data.
This argument is used to specify the convergence criteria for the position of the
robot’s TCP in the stop point. The stop point data substitutes the zone specified
in the Zone parameter.
The tool in use when the robot moves. The tool centre point is the point that is
moved to the specified destination point.
The work object (object coordinate system) to which the robot position in the
instruction is related.
This argument can be omitted, and if it is, the position is related to the world
coordinate system. If, on the other hand, a stationary TCP or coordinated
external axes are used, this argument must be specified in order for a circle
relative to the work object to be executed.
Program execution
The robot and external units are moved to the destination point as follows:
CirPoint
Tool orientation
Start point
ToPoint
- The orientation at the circle point is not critical; it is only used to distinguish
between two possible directions of reorientation. The accuracy of the
reorientation along the path depends only on the orientation at the start and
destination points.
- Uncoordinated external axes are executed at constant velocity in order for them
to arrive at the destination point at the same time as the robot axes. The position
in the circle position is not used.
If it is not possible to attain the programmed velocity for the reorientation or for the
external axes, the velocity of the TCP will be reduced.
A corner path is usually generated when movement is transferred to the next section of
a path. If a stop point is specified in the zone data, program execution only continues
when the robot and external axes have reached the appropriate position.
Examples
MoveC *, *, v500 \V:=550, z40 \Z:=45, grip3;
The TCP of the tool, grip3, is moved circularly to a position stored in the
instruction. The movement is carried out with data set to v500 and z40; the
velocity and zone size of the TCP are 550 mm/s and 45 mm respectively.
The TCP of the tool, grip3, is moved circularly to a stop point p6. The robot
considers it to be in the point when 50% of the position condition and 50% of the
speed condition for a stop point fine are satisfied. It waits at most for 2 seconds
for the conditions to be satisfied. See predefined data inpos50 of data type
stoppointdata.
The TCP of the tool, grip3, is moved circularly to a position stored in the
instruction. The circle point is also stored in the instruction. Subsequent logical
instructions are executed while the robot moves.
The TCP of the tool, grip3, is moved circularly to a position, p15, via the circle
point cir1. These positions are specified in the object coordinate system for
fixture.
Limitations
A change of execution mode from forward to backward or vice versa, while the robot
is stopped on a circular path, is not permitted and will result in an error message.
The instruction MoveC (or any other instruction including circular movement) should
never be started from the beginning, with TCP between the circle point and the end
point. Otherwise the robot will not take the programmed path (positioning around the
circular path in another direction compared with that programmed).
Make sure that the robot can reach the circle point during program execution and
divide the circle segment if necessary.
Syntax
MoveC
[ ’\’ Conc ’,’ ]
[ CirPoint ’:=’ ] < expression (IN) of robtarget > ’,’
[ ToPoint ’:=’ ] < expression (IN) of robtarget > ’,’
[ Speed ’:=’ ] < expression (IN) of speeddata >
[ ’\’ V ’:=’ < expression (IN) of num > ]
| [ ’\’ T ’:=’ < expression (IN) of num > ] ’,’
[Zone ’:=’ ] < expression (IN) of zonedata >
[ ’\’ Z ’:=’ < expression (IN) of num > ]
[ ’\’ Inpos ’:=’ < expression (IN) of stoppointdata > ] ‘,’
[ Tool ’:=’ ] < persistent (PERS) of tooldata >
[ ’\’ WObj ’:=’ < persistent (PERS) of wobjdata > ]
[ ’\’ Corr ]’;’
Related information
Described in:
Other positioning instructions RAPID Summary - Motion
Definition of velocity Data Types - speeddata
Definition of zone data Data Types - zonedata
Definition of stop point data Data Types - stoppointdata
Definition of tools Data Types - tooldata
Definition of work objects Data Types - wobjdata
Writes to a corrections entry Instructions - CorrWrite
Motion in general Motion and I/O Principles
Coordinate systems Motion and I/O Principles -
Coordinate Systems
Concurrent program execution Motion and I/O Principles -
Synchronisation Using Logical
Instructions
Examples
MoveCDO p1, p2, v500, z30, tool2, do1,1;
The TCP of the tool, tool2, is moved circularly to the position p2, with speed data
v500 and zone data z30. The circle is defined from the start position, the circle
point p1 and the destination point p2. Output do1 is set in the middle of the corner
path at p2.
Arguments
MoveCDO CirPoint ToPoint Speed [ \T ] Zone Tool [\WObj ]
Signal Value
CirPoint Data type: robtarget
The circle point of the robot. The circle point is a position on the circle between
the start point and the destination point. To obtain the best accuracy, it should be
placed about halfway between the start and destination points. If it is placed too
close to the start or destination point, the robot may give a warning. The circle
point is defined as a named position or stored directly in the instruction (marked
with an * in the instruction). The position of the external axes are not used.
The destination point of the robot and external axes. It is defined as a named
position or stored directly in the instruction (marked with an * in the instruction).
The speed data that applies to movements. Speed data defines the velocity of the
TCP, the tool reorientation and external axes.
This argument is used to specify the total time in seconds during which the robot
and external axes move. It is then substituted for the corresponding speed data.
Zone data for the movement. Zone data describes the size of the generated corner
path.
The tool in use when the robot moves. The tool centre point is the point that is
moved to the specified destination point.
The work object (object coordinate system) to which the robot position in the
instruction is related.
This argument can be omitted, and if it is, the position is related to the world coor-
dinate system. If, on the other hand, a stationary TCP or coordinated external
axes are used, this argument must be specified in order for a circle relative to the
work object to be executed.
Program execution
See the instruction MoveC for more information about circular movement.
The digital output signal is set/reset in the middle of the corner path for flying points,
as shown in Figure 4.
.
CirPoint
Next
ToPoint point
Zone
Figure 4 Set/Reset of digital output signal in the corner path with MoveCDO.
For stop points, we recommend the use of “normal” programming sequence with
MoveC + SetDO. But when using stop point in instruction MoveCDO, the digital output
signal is set/reset when the robot reaches the stop point.
The specified I/O signal is set/reset in execution mode continuously and stepwise for-
ward but not in stepwise backward.
Limitations
General limitations according to instruction MoveC.
Syntax
MoveCDO
[ CirPoint ’:=’ ] < expression (IN) of robtarget > ’,’
[ ToPoint ’:=’ ] < expression (IN) of robtarget > ’,’
[ Speed ’:=’ ] < expression (IN) of speeddata >
[ ’\’ T ’:=’ < expression (IN) of num > ] ’,’
[ Zone ’:=’ ] < expression (IN) of zonedata > ’,’
[ Tool ’:=’ ] < persistent (PERS) of tooldata >
[ ’\’ WObj ’:=’ < persistent (PERS) of wobjdata > ] ’,’
[ Signal ’:=’ ] < variable (VAR) of signaldo>] ‘,’
[ Value ‘:=’ ] < expression (IN) of dionum > ] ’;’
Related information
Described in:
Other positioning instructions RAPID Summary - Motion
Definition of velocity Data Types - speeddata
Definition of zone data Data Types - zonedata
Definition of tools Data Types - tooldata
Definition of work objects Data Types - wobjdata
Motion in general Motion and I/O Principles
Coordinate systems Motion and I/O Principles -
Coordinate Systems
Movements with I/O settings Motion and I/O Principles - Synchroni-
sation Using Logical Instructions
Examples
MoveCSync p1, p2, v500, z30, tool2, “proc1”;
The TCP of the tool, tool2, is moved circularly to the position p2, with speed data
v500 and zone data z30. The circle is defined from the start position, the circle
point p1 and the destination point p2. Procedure proc1 is executed in the middle
of the corner path at p2.
Arguments
MoveCSync CirPoint ToPoint Speed [ \T ] Zone Tool [\WObj ]
ProcName
CirPoint Data type: robtarget
The circle point of the robot. The circle point is a position on the circle between
the start point and the destination point. To obtain the best accuracy, it should be
placed about halfway between the start and destination points. If it is placed too
close to the start or destination point, the robot may give a warning. The circle
point is defined as a named position or stored directly in the instruction (marked
with an * in the instruction). The position of the external axes are not used.
The destination point of the robot and external axes. It is defined as a named
position or stored directly in the instruction (marked with an * in the instruction).
The speed data that applies to movements. Speed data defines the velocity of the
TCP, the tool reorientation and external axes.
This argument is used to specify the total time in seconds during which the robot
and external axes move. It is then substituted for the corresponding speed data.
Zone data for the movement. Zone data describes the size of the generated corner
path.
The tool in use when the robot moves. The tool centre point is the point that is
moved to the specified destination point.
The work object (object coordinate system) to which the robot position in the
instruction is related.
This argument can be omitted, and if it is, the position is related to the world coor-
dinate system. If, on the other hand, a stationary TCP or coordinated external
axes are used, this argument must be specified.
Name of the RAPID procedure to be executed at the middle of the corner path in
the destination point.
Program execution
See the instruction MoveC for more information about circular movements.
The specified RAPID procedure is executed when the TCP reaches the middle of the
corner path in the destination point of the MoveCSync instruction, as shown in Figure 5:
Figure 5 Execution of user-defined RAPID procedure at the middle of the corner path.
For stop points, we recommend the use of “normal” programming sequence with
MoveC + other RAPID instructions in sequence.
Limitation
General limitations according to instruction MoveC.
Switching execution mode after program stop from continuously or cycle to stepwise
forward or backward results in an error. This error tells the user that the mode switch
can result in missed execution of a RAPID procedure in the queue for execution on the
path. This error can be avoided if the program is stopped with StopInstr before the
mode switch.
Syntax
MoveCSync
[ CirPoint ’:=’ ] < expression (IN) of robtarget > ’,’
[ ToPoint ’:=’ ] < expression (IN) of robtarget > ’,’
[ Speed ’:=’ ] < expression (IN) of speeddata >
[ ’\’ T ’:=’ < expression (IN) of num > ] ’,’
[ Zone ’:=’ ] < expression (IN) of zonedata > ’,’
[ Tool ’:=’ ] < persistent (PERS) of tooldata >
[ ’\’ WObj ’:=’ < persistent (PERS) of wobjdata > ] ’,’
[ ProcName ‘:=’ ] < expression (IN) of string > ] ’;’
Related information
Described in:
Other positioning instructions RAPID Summary - Motion
Definition of velocity Data Types - speeddata
Definition of zone data Data Types - zonedata
Definition of tools Data Types - tooldata
Definition of work objects Data Types - wobjdata
Motion in general Motion and I/O Principles
Coordinate systems Motion and I/O Principles -
Coordinate Systems
The robot and external axes move to the destination position along a non-linear path.
All axes reach the destination position at the same time.
Examples
MoveJ p1, vmax, z30, tool2;
The tool centre point (TCP) of the tool, tool2, is moved along a non-linear path
to the position, p1, with speed data vmax and zone data z30.
The TCP of the tool, grip3, is moved along a non-linear path to a stop point
stored in the instruction (marked with an *). The entire movement takes 5 sec-
onds.
Arguments
MoveJ [ \Conc ] ToPoint Speed [ \V ] | [ \T ] Zone [ \Z ]
[ \Inpos ] Tool [ \WObj ]
[ \Conc ] (Concurrent) Data type: switch
Subsequent instructions are executed while the robot is moving. The argument is
used to shorten the cycle time when, for example, communicating with external
equipment, if synchronisation is not required.
If this argument is omitted and the ToPoint is not a stop point, the subsequent
instruction is executed some time before the robot has reached the programmed
zone.
The destination point of the robot and external axes. It is defined as a named
position or stored directly in the instruction (marked with an * in the instruction).
The speed data that applies to movements. Speed data defines the velocity of the
This argument is used to specify the velocity of the TCP in mm/s directly in the
instruction. It is then substituted for the corresponding velocity specified in the
speed data.
This argument is used to specify the total time in seconds during which the robot
moves. It is then substituted for the corresponding speed data.
Zone data for the movement. Zone data describes the size of the generated corner
path.
This argument is used to specify the position accuracy of the robot TCP directly
in the instruction. The length of the corner path is given in mm, which is substi-
tuted for the corresponding zone specified in the zone data.
This argument is used to specify the convergence criteria for the position of the
robot’s TCP in the stop point. The stop point data substitutes the zone specified
in the Zone parameter.
The tool in use when the robot moves. The tool centre point is the point moved
to the specified destination point.
The work object (coordinate system) to which the robot position in the instruction
is related.
This argument can be omitted, and if it is, the position is related to the world coor-
dinate system. If, on the other hand, a stationary TCP or coordinated external
axes are used, this argument must be specified.
Program execution
The tool centre point is moved to the destination point with interpolation of the axis
angles. This means that each axis is moved with constant axis velocity and that all axes
reach the destination point at the same time, which results in a non-linear path.
and the external axes are moved at the same time as the TCP moves. If the programmed
velocity for reorientation, or for the external axes, cannot be attained, the velocity of
the TCP will be reduced.
A corner path is usually generated when movement is transferred to the next section of
the path. If a stop point is specified in the zone data, program execution only continues
when the robot and external axes have reached the appropriate position.
Examples
MoveJ *, v2000\V:=2200, z40 \Z:=45, grip3;
The TCP of the tool, grip3, is moved along a non-linear path to a position stored
in the instruction. The movement is carried out with data set to v2000 and z40;
the velocity and zone size of the TCP are 2200 mm/s and 45 mm respectively.
The TCP of the tool, grip3, is moved a non-linear path to a stop point p5. The
robot considers it to be in the point when 50% of the position condition and 50%
of the speed condition for a stop point fine are satisfied. It waits at most for 2
seconds for the conditions to be satisfied. See predefined data inpos50 of data
type stoppointdata.
The TCP of the tool, grip3, is moved along a non-linear path to a position stored
in the instruction. Subsequent logical instructions are executed while the robot
moves.
The TCP of the tool, grip3, is moved along a non-linear path to a position, start.
This position is specified in the object coordinate system for fixture.
Syntax
MoveJ
[ ’\’ Conc ’,’ ]
[ ToPoint ’:=’ ] < expression (IN) of robtarget > ’,’
[ Speed ’:=’ ] < expression (IN) of speeddata >
[ ’\’ V ’:=’ < expression (IN) of num > ]
| [ ’\’ T ’:=’ < expression (IN) of num > ] ’,’
[Zone ’:=’ ] < expression (IN) of zonedata >
[ ’\’ Z ‘:=’ < expression (IN) of num > ]
[ ’\’ Inpos ’:=’ < expression (IN) of stoppointdata > ] ‘,’
[ Tool ’:=’ ] < persistent (PERS) of tooldata >
[ ’\’ WObj ’:=’ < persistent (PERS) of wobjdata > ] ’;’
Related information
Described in:
Other positioning instructions RAPID Summary - Motion
Definition of velocity Data Types - speeddata
Definition of zone data Data Types - zonedata
Definition of stop point data Data Types - stoppointdata
Definition of tools Data Types - tooldata
Definition of work objects Data Types - wobjdata
Motion in general Motion and I/O Principles
Coordinate systems Motion and I/O Principles -
Coordinate Systems
Concurrent program execution Motion and I/O Principles -
Synchronisation Using Logical Instructions
The robot and external axes move to the destination position along a non-linear path.
All axes reach the destination position at the same time.
Examples
MoveJDO p1, vmax, z30, tool2, do1, 1;
The tool centre point (TCP) of the tool, tool2, is moved along a non-linear path
to the position, p1, with speed data vmax and zone data z30. Output do1 is set in
the middle of the corner path at p1.
Arguments
MoveJDO ToPoint Speed [ \T ] Zone Tool
[ \WObj ] Signal Value
ToPoint Data type: robtarget
The destination point of the robot and external axes. It is defined as a named
position or stored directly in the instruction (marked with an * in the instruction).
The speed data that applies to movements. Speed data defines the velocity of the
tool centre point, the tool reorientation and external axes.
This argument is used to specify the total time in seconds during which the robot
moves. It is then substituted for the corresponding speed data.
Zone data for the movement. Zone data describes the size of the generated corner
path.
The tool in use when the robot moves. The tool centre point is the point moved
to the specified destination point.
The work object (coordinate system) to which the robot position in the instruction
is related.
This argument can be omitted, and if it is, the position is related to the world coor-
dinate system. If, on the other hand, a stationary TCP or coordinated external
axes are used, this argument must be specified.
Program execution
See the instruction MoveJ for more information about joint movement.
The digital output signal is set/reset in the middle of the corner path for flying points,
as shown in Figure 6.
p3
p1 p2
Zone
Figure 6 Set/Reset of digital output signal in the corner path with MoveJDO.
For stop points, we recommend the use of “normal” programming sequence with
MoveJ + SetDO. But when using stop point in instruction MoveJDO, the digital output
signal is set/reset when the robot reaches the stop point.
The specified I/O signal is set/reset in execution mode continuously and stepwise for-
ward but not in stepwise backward.
Syntax
MoveJDO
[ ToPoint ’:=’ ] < expression (IN) of robtarget > ’,’
[ Speed ’:=’ ] < expression (IN) of speeddata >
[ ’\’ T ’:=’ < expression (IN) of num > ] ’,’
[ Zone ’:=’ ] < expression (IN) of zonedata > ’,’
[ Tool ’:=’ ] < persistent (PERS) of tooldata >
[ ’\’ WObj ’:=’ < persistent (PERS) of wobjdata > ] ’,’
[ Signal ’:=’ ] < variable (VAR) of signaldo>] ‘,’
[ Value ‘:=’ ] < expression (IN) of dionum > ] ’;’
Related information
Described in:
Other positioning instructions RAPID Summary - Motion
Definition of velocity Data Types - speeddata
Definition of zone data Data Types - zonedata
Definition of tools Data Types - tooldata
Definition of work objects Data Types - wobjdata
Motion in general Motion and I/O Principles
Coordinate systems Motion and I/O Principles -
Coordinate Systems
Movements with I/O settings Motion and I/O Principles - Synchronisa-
tion Using Logical Instructions
The robot and external axes move to the destination position along a non-linear path.
All axes reach the destination position at the same time.
Examples
MoveJSync p1, vmax, z30, tool2, “proc1”;
The tool centre point (TCP) of the tool, tool2, is moved along a non-linear path
to the position, p1, with speed data vmax and zone data z30. Procedure proc1 is
executed in the middle of the corner path at p1.
Arguments
MoveJSync ToPoint Speed [ \T ] Zone Tool [ \WObj ]
ProcName
ToPoint Data type: robtarget
The destination point of the robot and external axes. It is defined as a named
position or stored directly in the instruction (marked with an * in the instruction).
The speed data that applies to movements. Speed data defines the velocity of the
tool centre point, the tool reorientation and external axes.
This argument is used to specify the total time in seconds during which the robot
moves. It is then substituted for the corresponding speed data.
Zone data for the movement. Zone data describes the size of the generated corner
path.
The tool in use when the robot moves. The tool centre point is the point moved
to the specified destination point.
The work object (coordinate system) to which the robot position in the instruction
is related.
This argument can be omitted, and if it is, the position is related to the world coor-
dinate system. If, on the other hand, a stationary TCP or coordinated external
axes are used, this argument must be specified.
Name of the RAPID procedure to be executed at the middle of the corner path in
the destination point.
Program execution
See the instruction MoveJ for more information about joint movements.
The specified RAPID procedure is executed when the TCP reaches the middle of the
corner path in the destination point of the MoveJSync instruction, as shown in Figure 7:
p1
Figure 7 Execution of user-defined RAPID procedure in the middle of the corner path.
For stop points, we recommend the use of “normal” programming sequence with
MoveJ + other RAPID instructions in sequence.
Limitation
Switching execution mode after program stop from continuously or cycle to stepwise
forward or backward results in an error. This error tells the user that the mode switch
can result in missed execution of a RAPID procedure in the queue for execution on the
path. This error can be avoided if the program is stopped with StopInstr before the
mode switch.
Syntax
MoveJSync
[ ToPoint ’:=’ ] < expression (IN) of robtarget > ’,’
[ Speed ’:=’ ] < expression (IN) of speeddata >
[ ’\’ T ’:=’ < expression (IN) of num > ] ’,’
[ Zone ’:=’ ] < expression (IN) of zonedata >
[ ’\’ Z ‘:=’ < expression (IN) of num > ] ’,’
[ Tool ’:=’ ] < persistent (PERS) of tooldata >
[ ’\’ WObj ’:=’ < persistent (PERS) of wobjdata > ] ’,’
[ ProcName‘:=’ ] < expression (IN) of string > ] ’;’
Related information
Described in:
Other positioning instructions RAPID Summary - Motion
Definition of velocity Data Types - speeddata
Definition of zone data Data Types - zonedata
Definition of tools Data Types - tooldata
Definition of work objects Data Types - wobjdata
Motion in general Motion and I/O Principles
Coordinate systems Motion and I/O Principles -
Coordinate Systems
Example
MoveL p1, v1000, z30, tool2;
The TCP of the tool, tool2, is moved linearly to the position p1, with speed data
v1000 and zone data z30.
The TCP of the tool, grip3, is moved linearly to a fine point stored in the
instruction (marked with an *). The complete movement takes 5 seconds.
Arguments
MoveL [ \Conc ] ToPoint Speed [ \V ] | [ \T ] Zone [ \Z ]
[ \Inpos ] Tool [ \WObj ] [ \Corr ]
[ \Conc ] (Concurrent) Data type: switch
If this argument is omitted and the ToPoint is not a stop point, the subsequent
instruction is executed some time before the robot has reached the programmed
zone.
The destination point of the robot and external axes. It is defined as a named
position or stored directly in the instruction (marked with an * in the instruction).
The speed data that applies to movements. Speed data defines the velocity for the
tool centre point, the tool reorientation and external axes.
This argument is used to specify the velocity of the TCP in mm/s directly in the
instruction. It is then substituted for the corresponding velocity specified in the
speed data.
This argument is used to specify the total time in seconds during which the robot
moves. It is then substituted for the corresponding speed data.
Zone data for the movement. Zone data describes the size of the generated corner
path.
This argument is used to specify the position accuracy of the robot TCP directly
in the instruction. The length of the corner path is given in mm, which is
substituted for the corresponding zone specified in the zone data.
This argument is used to specify the convergence criteria for the position of the
robot’s TCP in the stop point. The stop point data substitutes the zone specified
in the Zone parameter.
The tool in use when the robot moves. The tool centre point is the point moved
to the specified destination position.
The work object (coordinate system) to which the robot position in the instruction
is related.
This argument can be omitted, and if it is, the position is related to the world
coordinate system. If, on the other hand, a stationary tool or coordinated external
axes are used, this argument must be specified in order to perform a linear
movement relative to the work object.
Program execution
The robot and external units are moved to the destination position as follows:
If it is not possible to attain the programmed velocity for the reorientation or for the
external axes, the velocity of the TCP will be reduced.
A corner path is usually generated when movement is transferred to the next section of
a path. If a stop point is specified in the zone data, program execution only continues
when the robot and external axes have reached the appropriate position.
Examples
MoveL *, v2000 \V:=2200, z40 \Z:=45, grip3;
The TCP of the tool, grip3, is moved linearly to a position stored in the
instruction. The movement is carried out with data set to v2000 and z40. The
velocity and zone size of the TCP are 2200 mm/s and 45 mm respectively.
The TCP of the tool, grip3, is moved linearly to a stop point p5. The robot
considers it to be in the point when 50% of the position condition and 50% of the
speed condition for a stop point fine are satisfied. It waits at most for 2 seconds
for the conditions to be satisfied. See predefined data inpos50 of data type
stoppointdata.
The TCP of the tool, grip3, is moved linearly to a position stored in the
instruction. Subsequent logical instructions are executed while the robot moves.
The TCP of the tool, grip3, is moved linearly to a position, start. This position is
specified in the object coordinate system for fixture.
Syntax
MoveL
[ ’\’ Conc ’,’ ]
[ ToPoint ’:=’ ] < expression (IN) of robtarget > ’,’
[ Speed ’:=’ ] < expression (IN) of speeddata >
[ ’\’ V ’:=’ < expression (IN) of num > ]
| [ ’\’ T ’:=’ < expression (IN) of num > ] ’,’
[Zone ’:=’ ] < expression (IN) of zonedata >
[ ’\’ Z ’:=’ < expression (IN) of num > ]
[ ’\’ Inpos ’:=’ < expression (IN) of stoppointdata > ] ‘,’
[ Tool ’:=’ ] < persistent (PERS) of tooldata >
[ ’\’ WObj ’:=’ < persistent (PERS) of wobjdata > ]
[ ’\’ Corr ]’;’
Related information
Described in:
Other positioning instructions RAPID Summary - Motion
Definition of velocity Data Types - speeddata
Definition of zone data Data Types - zonedata
Definition of stop point data Data Types - stoppointdata
Definition of tools Data Types - tooldata
Definition of work objects Data Types - wobjdata
Writes to a corrections entry Instructions - CorrWrite
Motion in general Motion and I/O Principles
Coordinate systems Motion and I/O Principles -
Coordinate Systems
Concurrent program execution Motion and I/O Principles -
Synchronisation Using Logical
Instructions
When the TCP is to remain stationary, this instruction can also be used to reorient the
tool.
Example
MoveLDO p1, v1000, z30, tool2, do1,1;
The TCP of the tool, tool2, is moved linearly to the position p1, with speed data
v1000 and zone data z30. Output do1 is set in the middle of the corner path at p1.
Arguments
MoveLDO ToPoint Speed [ \T ] Zone Tool
[ \WObj ] Signal Value
ToPoint Data type: robtarget
The destination point of the robot and external axes. It is defined as a named
position or stored directly in the instruction (marked with an * in the instruction).
The speed data that applies to movements. Speed data defines the velocity for the
tool centre point, the tool reorientation and external axes.
This argument is used to specify the total time in seconds during which the robot
moves. It is then substituted for the corresponding speed data.
Zone data for the movement. Zone data describes the size of the generated corner
path.
The tool in use when the robot moves. The tool centre point is the point moved
to the specified destination position.
The work object (coordinate system) to which the robot position in the instruction
is related.
This argument can be omitted, and if it is, the position is related to the world coor-
dinate system. If, on the other hand, a stationary TCP or coordinated external
axes are used, this argument must be specified.
Program execution
See the instruction MoveL for more information about linear movements.
The digital output signal is set/reset in the middle of the corner path for flying points,
as shown in Figure 8.
p3
p1 p2
Zone
Figure 8 Set/Reset of digital output signal in the corner path with MoveLDO.
For stop points, we recommend the use of “normal” programming sequence with
MoveL + SetDO. But when using stop point in instruction MoveLDO, the digital output
signal is set/reset when the robot reaches the stop point.
The specified I/O signal is set/reset in execution mode continuously and stepwise for-
ward but not in stepwise backward.
Syntax
MoveLDO
[ ToPoint ’:=’ ] < expression (IN) of robtarget > ’,’
[ Speed ’:=’ ] < expression (IN) of speeddata >
[ ’\’ T ’:=’ < expression (IN) of num > ] ’,’
[ Zone ’:=’ ] < expression (IN) of zonedata > ’,’
[ Tool ’:=’ ] < persistent (PERS) of tooldata >
[ ’\’ WObj ’:=’ < persistent (PERS) of wobjdata > ] ’,’
[ Signal ’:=’ ] < variable (VAR) of signaldo>] ‘,’
[ Value ‘:=’ ] < expression (IN) of dionum > ] ’;’
Related information
Described in:
Other positioning instructions RAPID Summary - Motion
Definition of velocity Data Types - speeddata
Definition of zone data Data Types - zonedata
Definition of tools Data Types - tooldata
Definition of work objects Data Types - wobjdata
Motion in general Motion and I/O Principles
Coordinate systems Motion and I/O Principles -
Coordinate Systems
Movements with I/O settings Motion and I/O Principles - Synchroni-
sation Using Logical Instructions
When the TCP is to remain stationary, this instruction can also be used to reorient the
tool.
Example
MoveLSync p1, v1000, z30, tool2, “proc1”;
The TCP of the tool, tool2, is moved linearly to the position p1, with speed data
v1000 and zone data z30. Procedure proc1 is executed in the middle of the corner
path at p1.
Arguments
MoveLSync ToPoint Speed [ \T ] Zone Tool
[ \WObj ] ProcName
ToPoint Data type: robtarget
The destination point of the robot and external axes. It is defined as a named
position or stored directly in the instruction (marked with an * in the instruction).
The speed data that applies to movements. Speed data defines the velocity for the
tool centre point, the tool reorientation and external axes.
This argument is used to specify the total time in seconds during which the robot
moves. It is then substituted for the corresponding speed data.
Zone data for the movement. Zone data describes the size of the generated corner
path.
The tool in use when the robot moves. The tool centre point is the point moved
to the specified destination position.
The work object (coordinate system) to which the robot position in the instruction
is related.
This argument can be omitted, and if it is, the position is related to the world coor-
dinate system. If, on the other hand, a stationary TCP or coordinated external
axes are used, this argument must be specified.
Name of the RAPID procedure to be executed at the middle of the corner path in
the destination point.
Program execution
See the instruction MoveL for more information about linear movements.
The specified RAPID procedure is executed when the TCP reaches the middle of the
corner path in the destination point of the MoveLSync instruction, as shown in Figure 9:
p1
Figure 9 Execution of user-defined RAPID procedure in the middle of the corner path.
For stop points, we recommend the use of “normal” programming sequence with
MoveL + other RAPID instructions in sequence.
Limitation
Switching execution mode after program stop from continuously or cycle to stepwise
forward or backward results in an error. This error tells the user that the mode switch
can result in missed execution of a RAPID procedure in the queue for execution on the
path. This error can be avoided if the program is stopped with StopInstr before the
mode switch.
Syntax
MoveLSync
[ ToPoint ’:=’ ] < expression (IN) of robtarget > ’,’
[ Speed ’:=’ ] < expression (IN) of speeddata >
[ ’\’ T ’:=’ < expression (IN) of num > ] ’,’
[ Zone ’:=’ ] < expression (IN) of zonedata > ’,’
[ Tool ’:=’ ] < persistent (PERS) of tooldata >
[ ’\’ WObj ’:=’ < persistent (PERS) of wobjdata > ] ’,’
[ ProcName‘:=’ ] < expression (IN) of string > ] ‘;’
Related information
Described in:
Other positioning instructions RAPID Summary - Motion
Definition of velocity Data Types - speeddata
Definition of zone data Data Types - zonedata
Definition of tools Data Types - tooldata
Definition of work objects Data Types - wobjdata
Motion in general Motion and I/O Principles
Coordinate systems Motion and I/O Principles -
Coordinate Systems
Example
VAR iodev logfile;
...
Open "HOME:" \File:= "LOGFILE1.DOC", logfile \Write;
The file LOGFILE1.DOC in unit HOME:, is opened for writing. The reference
name logfile is used later in the program when writing to the file.
Arguments
Open Object [\File] IODevice [\Read] | [\Write] | [\Append] [\Bin]
Object Data type: string
The I/O object (I/O device) that is to be opened, e.g. "HOME:", "TEMP:",
"flp1:"(option). or “sio1:”
Table 1 Different I/O device in the system
1) ”xxxx” means the system name, defined when booting the system
2) User defined serial channel name, defined in system parameters
A reference to the file or serial channel to open. This reference is then used for
reading from and writing to the file or serial channel.
Opens a file or serial channel for reading. When reading from a file, the reading
is started from the beginning of the file.
Opens a file or serial channel for writing. If the selected file already exists, its
contents are deleted. Anything subsequently written is written at the start of the
file.
Opens a file or serial channel for writing. If the selected file already exists, any-
thing subsequently written is written at the end of the file.
Open a file or serial channel with \Append and without the \Bin arguments. The
instruction opens a character-based file or serial channel for writing.
Open a file or serial channel with \Append and \Bin arguments. The instruction
opens a binary file or serial channel for both reading and writing.
The arguments \Read, \Write, \Append are mutually exclusive. If none of these are spec-
ified, the instruction acts in the same way as the \Write argument for character-based
files or a serial channel (instruction without \Bin argument) and in the same way as the
\Append argument for binary files or a serial channel (instruction with \Bin argument).
The set of instructions to access a binary file or serial channel is different from the set
of instructions to access a character-based file.
Example
VAR iodev printer;
...
Open "sio1:", printer \Bin;
WriteStrBin printer, "This is a message to the printer\0D";
Close printer;
The serial channel sio1: is opened for binary reading and writing.
The reference name printer is used later when writing to and closing the serial
channel.
Program execution
The specified file or serial channel is opened so that it is possible to read from or write
to it.
It is possible to open the same physical file several times at the same time, but each
invocation of the Open instruction will return a different reference to the file (data type
iodev). E.g. it is possible to have one write pointer and one different read pointer to the
same file at the same time.
The iodev variable used when opening a file or serial channel must be free from use. If
it has been used previously to open a file, this file must be closed prior to issuing a new
Open instruction with the same iodev variable.
Error handling
If a file cannot be opened, the system variable ERRNO is set to ERR_FILEOPEN. This
error can then be handled in the error handler.
Syntax
Open
[Object ’:=’] <expression (IN) of string>
[’\’File’:=’ <expression (IN) of string>] ’,’
[IODevice ’:=’] <variable (VAR) of iodev>
[’\’Read] | [’\’Write] | [’\’Append]
[’\’Bin] ’;’
Related information
Described in:
Writing to and reading from RAPID Summary - Communication
files or serial channel
Description
The path resolution affects the accuracy of the interpolated path and the program cycle
time. The path accuracy is improved and the cycle time is often reduced when the
parameter PathSampleTime is decreased. A value for parameter PathSampleTime
which is too low, may however cause CPU load problems in some demanding applica-
tions. However, use of the standard configured path resolution (PathSampleTime
100%) will avoid CPU load problems and provide sufficient path accuracy in most sit-
uations.
Example of PathResol usage:
Dynamically critical movements (max payload, high speed, combined joint motions
close to the border of the work area) may cause CPU load problems. Increase the
parameter PathSampleTime.
Low performance external axes may cause CPU load problems during coordination.
Increase the parameter PathSampleTime.
Arc-welding with high frequency weaving may require high resolution of the interpo-
lated path. Decrease the parameter PathSampleTime.
Small circles or combined small movements with direction changes can decrease the
path performance quality and increase the cycle time. Decrease the parameter Path-
SampleTime.
Gluing with large reorientations and small corner zones can cause speed variations.
Decrease the parameter PathSampleTime.
Example
MoveJ p1,v1000,fine,tool1;
PathResol 150;
With the robot at a stop point, the path sample time is increased to 150% of the
configured.
Arguments
PathResol PathSampleTime
PathSampleTime Data type: num
Program execution
The path resolutions of all subsequent positioning instructions are affected until a new
PathResol instruction is executed. This will affect the path resolution during all pro-
gram execution of movements (default path level and path level after StorePath) and
also during jogging.
The default value for override of path sample time is 100%. This value is automatically
set
- at a cold start-up
- when a new program is loaded
- when starting program execution from the beginning.
The current override of path sample time can be read from the variable C_MOTSET
(data type motsetdata) in the component pathresol.
Limitations
The robot must be standing still at a stop point before overriding the path sample time.
When there is a corner path in the program, the system will instead create a stop point
(warning 50146) and it is not possible to restart in this instruction following a power
failure.
Syntax
PathResol
[PathSampleTime ’:=’ ] < expression (IN) of num> ’;’
Related information
Described in:
Positioning instructions Motion and I/O Principles- Movements
Motion settings RAPID Summary - Motion Settings
Configuration of path resolution System Parameters -
CPU Optimization
Examples
PDispOff;
Program execution
Active program displacement is reset. This means that the program displacement coor-
dinate system is the same as the object coordinate system, and thus all programmed
positions will be related to the latter.
Syntax
PDispOff ‘;’
Related information
Described in:
Definition of program displacement Instructions - PDispOn
using two positions
Definition of program displacement using Instructions - PDispSet
values
Program displacement is used, for example, after a search has been carried out, or
when similar motion patterns are repeated at several different places in the program.
Examples
MoveL p10, v500, z10, tool1;
PDispOn \ExeP:=p10, p20, tool1;
Arguments
PDispOn [ \Rot ] [ \ExeP ] ProgPoint Tool [ \WObj ]
[\Rot ] (Rotation) Data type: switch
The difference in the tool orientation is taken into consideration and this involves
a rotation of the program.
The tool used during programming, i.e. the TCP to which the ProgPoint position
is related.
The work object (coordinate system) to which the ProgPoint position is related.
This argument can be omitted and, if it is, the position is related to the world
coordinate system. However, if a stationary TCP or coordinated external axes are
used, this argument must be specified.
The arguments Tool and \WObj are used both to calculate the ProgPoint during
programming and to calculate the current position during program execution if
no ExeP argument is programmed.
Program execution
Program displacement means that the ProgDisp coordinate system is translated in
relation to the object coordinate system. Since all positions are related to the ProgDisp
coordinate system, all programmed positions will also be displaced. See Figure 10.
y
New
position, ExeP
y
Original
position, ProgPoint
x
Program displacement Program Displacement Coordinate System
(ProgDisp)
x
Object Coordinate System
Only one program displacement can be active at any one time. Several PDispOn
instructions, on the other hand, can be programmed one after the other and, in this case,
the different program displacements will be added.
If the argument \Rot is used, the rotation is also calculated based on the tool orientation
at the two positions. The displacement will be calculated in such a way that the new
position (ExeP) will have the same position and orientation in relation to the displaced
coordinate system, ProgDisp, as the old position (ProgPoint) had in relation to the
original coordinate system (see Figure 11).
New
y position, ExeP
y
New
Original
position, ProgPoint
orientation x
Original
orientation Program displacement Program Displacement Coordinate System
(ProgDisp)
x
Object Coordinate System
- at a cold start-up
- when a new program is loaded
- when starting program executing from the beginning.
Example
PROC draw_square()
PDispOn *, tool1;
MoveL *, v500, z10, tool1;
MoveL *, v500, z10, tool1;
MoveL *, v500, z10, tool1;
MoveL *, v500, z10, tool1;
PDispOff;
ENDPROC
.
MoveL p10, v500, fine \Inpos := inpos50, tool1;
draw_square;
MoveL p20, v500, fine \Inpos := inpos50, tool1;
draw_square;
MoveL p30, v500, fine \Inpos := inpos50, tool1;
draw_square;
The routine draw_square is used to execute the same motion pattern at three
different positions, based on the positions p10, p20 and p30. See Figure 12.
p30
p10
p20
A search is carried out in which the robot’s searched position is stored in the
position psearch. Any movement carried out after this starts from this position
using a program displacement (parallel movement). The latter is calculated based
on the difference between the searched position and the programmed point (*)
stored in the instruction. All positions are based on the fixture1 object coordinate
system.
Syntax
PDispOn
[ [ ’\’ Rot ]
[ ’\’ ExeP ’:=’ < expression (IN) of robtarget >] ’,’]
[ ProgPoint ’:=’ ] < expression (IN) of robtarget > ’,’
[ Tool ’:=’ ] < persistent (PERS) of tooldata>
[ ‘\’WObj ’:=’ < persistent (PERS) of wobjdata> ] ‘;’
Related information
Described in:
Deactivation of program displacement Instructions - PDispOff
Definition of program displacement using Instructions - PDispSet
values
Coordinate systems Motion Principles - Coordinate Systems
Definition of tools Data Types - tooldata
Definition of work objects Data Types - wobjdata
More examples Instructions - PDispOff
Program displacement is used, for example, when similar motion patterns are repeated
at several different places in the program.
Example
VAR pose xp100 := [ [100, 0, 0], [1, 0, 0, 0] ];
.
PDispSet xp100;
- The ProgDisp coordinate system is displaced 100 mm from the object coordi-
nate system, in the direction of the positive x-axis (see Figure 13).
- As long as this program displacement is active, all positions will be displaced
100 mm in the direction of the x-axis.
Object ProgDisp
100 X
Figure 13 A 100 mm-program displacement along the x-axis.
Arguments
PDispSet DispFrame
DispFrame (Displacement Frame) Datatyp: pose
Program execution
Program displacement involves translating and/or rotating the ProgDisp coordinate
system relative to the object coordinate system. Since all positions are related to the
ProgDisp coordinate system, all programmed positions will also be displaced.
See Figure 14.
New
y position
y
New
Original
position
orientation x
Original
orientation Program displacement Program Displacement Coordinate System
(ProgDisp)
x
Object Coordinate System
Only one program displacement can be active at any one time. Program displacements
cannot be added to one another using PDispSet.
- at a cold start-up
- when a new program is loaded
- when starting program executing from the beginning.
Syntax
PDispSet
[ DispFrame ’:=’ ] < expression (IN) of pose> ’;’
Related information
Described in:
Deactivation of program displacement Instructions - PDispOff
Definition of program displacement Instructions - PDispOn
using two positions
Definition of data of the type pose Data Types - pose
Coordinate systems Motion Principles- Coordinate Systems
Examples of how program displacement Instructions - PDispOn
can be used
Examples
PulseDO do15;
A pulse with a pulse length of 0.2 s is generated on the output signal do15.
Positive pulse (value 1) is generated on the signal do3 from two program tasks
at almost the same time. It will result in one positive pulse with a pulse length
longer than the default 0.2 s or two positive pulses after each other with a pulse
length of 0.2 s.
Arguments
PulseDO [ \High ] [ \PLength ] Signal
[ \High ] (High level) Data type: switch
Specifies that the signal value should always be set to high (value 1) when the
instruction is executed, independently of its current state.
Program execution
A pulse is generated with a specified pulse length (see Figure 15).
Pulse length
1
Signal level
0
Execution of the instruction PulseDO
Execution of the instruction PulseDO
1
Signal level
0
Pulse length
1
Signal level
0
Execution of the instruction PulseDO \High
Execution of the instruction PulseDO \High
1
Signal level
0
y
x
1
Signal level
0
The next instruction is executed directly after the pulse starts. The pulse can then be set/
reset without affecting the rest of the program execution.
Limitations
The length of the pulse has a resolution of 0.01 seconds. Programmed values that differ
from this are rounded off.
Syntax
PulseDO
[ [ ’\’High]
[ ’\’PLength ’:=’ < expression (IN) of num >] ‘,’ ]
[ Signal ’:=’ ] < variable (VAR) of signaldo > ’;’
Related information
Described in:
Input/Output instructions RAPID Summary -
Input and Output Signals
Input/Output functionality in general Motion and I/O Principles -
I/O Principles
Configuration of I/O User’s Guide - System Parameters
This instruction can, for example, be used to jump back to a higher level in the structure
of the program, e.g. to the error handler in the main routine, if an error occurs at a lower
level.
Example
IF ...
IF ...
IF ...
RAISE escape1;
.
ERROR
IF ERRNO=escape1 RAISE;
The routine is interrupted to enable it to remove itself from a low level in the
program. A jump occurs to the error handler of the called routine.
Arguments
RAISE [ Error no. ]
Error no. Data type: errnum
Error number: Any number between 1 and 90 which the error handler can use to
locate the error that has occurred (the ERRNO system variable).
It is also possible to book an error number outside the range 1-90 with the
instruction BookErrNo.
The error number must be specified outside the error handler in a RAISE
instruction in order to be able to transfer execution to the error handler of that
routine.
If the instruction is present in a routine’s error handler, the error number may not
be specified. In this case, the error is propagated to the error handler of the calling
routine.
Program execution
Program execution continues in the routine’s error handler. After the error handler has
been executed, program execution can continue with:
If the RAISE instruction is present in a trap routine, the error is dealt with by the
system’s error handler.
Error handling
If the error number is out of range, the system variable ERRNO is set to
ERR_ILLRAISE (see "Data types - errnum"). This error can be handled in the error
handler.
Syntax
(EBNF)
RAISE [<error number>] ’;’
Related information
Described in:
Error handling Basic Characteristics -
Error Recovery
Booking error numbers Instructions - BookErrNo
Example
VAR iodev channel2;
VAR robtarget next_target;
...
Open "sio1:", channel2 \Bin;
ReadAnyBin channel2, next_target;
The next robot target to be executed, next_target, is read from the channel
referred to by channel2.
Arguments
ReadAnyBin IODevice Data [\Time])
IODevice Data type: iodev
The max. time for the reading operation (timeout) in seconds. If this argument is
not specified, the max. time is set to 60 seconds.
If this time runs out before the read operation is finished, the error handler will
be called with the error code ERR_DEV_MAXTIME. If there is no error han-
dler, the execution will be stopped.
The timeout function is in use also during program stop and will be noticed in
the RAPID program at program start.
Program execution
As many bytes as required for the specified data are read from the specified binary
serial channel or file.
Limitations
This instruction can only be used for serial channels or files that have been opened for
binary reading.
The data to be read by this instruction must have a value data type of atomic, string, or
record data type. Semi-value and non-value data types cannot be used.
Note that the VAR or PERS variable, for storage of the data read, can be updated in sev-
eral steps. Therefore, always wait until the whole data structure is updated before using
read data from a TRAP or another program task.
Error handling
If an error occurs during reading, the system variable ERRNO is set to
ERR_FILEACC.
If timeout before the read operation is finished, the system variable ERRNO is set to
ERR_DEV_MAXTIME.
If there is a checksum error in the data read, the system variable ERRNO is set to
ERR_RANYBIN_CHK.
If the end of the file is detected before all the bytes are read, the system variable
ERRNO is set to ERR_RANYBIN_EOF.
Example
CONST num NEW_ROBT:=12;
CONST num NEW_WOBJ:=20;
VAR iodev channel;
VAR num input;
VAR robtarget cur_robt;
VAR wobjdata cur_wobj;
Close channel;
As a first step, the opcode of the message is read from the serial channel. Accord-
ing to this opcode a robtarget or a wobjdata is read from the serial channel.
Syntax
ReadAnyBin
[IODevice’:=’] <variable (VAR) of iodev>’,’
[Data’:=’] <var or pers (INOUT) of ANYTYPE>
[’\’Time’:=’ <expression (IN) of num>]’;’
Related information
Described in:
Opening (etc.) of serial channels RAPID Summary - Communication
or files
Examples
Reset do15;
Reset weld;
Arguments
Reset Signal
Signal Data type: signaldo
Program execution
The true value depends on the configuration of the signal. If the signal is inverted in
the system parameters, this instruction causes the physical channel to be set to 1.
Syntax
Reset
[ Signal ’:=’ ] < variable (VAR) of signaldo > ’;’
Related information
Described in:
Setting a digital output signal Instructions - Set
Input/Output instructions RAPID Summary -
Input and Output Signals
Input/Output functionality in general Motion and I/O Principles -
I/O Principles
Configuration of I/O System Parameters
Example
RestoPath;
Program execution
The current movement path of the robot and the external axes is deleted and the path
stored earlier using StorePath is restored. Nothing moves, however, until the instruc-
tion StartMove is executed or a return is made using RETRY from an error handler.
Example
ArcL p100, v100, seam1, weld5, weave1, z10, gun1;
...
ERROR
IF ERRNO=AW_WELD_ERR THEN
gun_cleaning;
RETRY;
ENDIF
...
PROC gun_cleaning()
VAR robtarget p1;
StorePath;
p1 := CRobT();
MoveL pclean, v100, fine, gun1;
...
MoveL p1, v100, fine, gun1;
RestoPath;
ENDPROC
In the event of a welding error, program execution continues in the error handler
of the routine, which, in turn, calls gun_cleaning. The movement path being exe-
cuted at the time is then stored and the robot moves to the position pclean where
the error is rectified. When this has been done, the robot returns to the position
where the error occurred, p1, and stores the original movement once again. The
weld then automatically restarts, meaning that the robot is first reversed along
the path before welding starts and ordinary program execution can continue.
Limitations
Only the movement path data is stored with the instruction StorePath.
If the user wants to order movements on the new path level, the actual stop position
must be stored directly after StorePath and before RestoPath make a movement to the
stored stop position on the path.
The movement instruction which precedes this instruction should be terminated with a
stop point.
Syntax
RestoPath‘;’
Related information
Described in:
Storing paths Instructions - StorePath
More examples Instructions - StorePath
Example
reg2 := reg3/reg4;
.
ERROR
IF ERRNO = ERR_DIVZERO THEN
reg4 := 1;
RETRY;
ENDIF
Program execution
Program execution continues with (re-executes) the instruction that caused the error.
Error handling
If the maximum number of retries (4 retries) is exceeded, the program execution stops
with an error message and the system variable ERRNO is set to ERR_EXCRTYMAX
(see "Data types - errnum").
Limitations
The instruction can only exist in a routine’s error handler. If the error was created using
a RAISE instruction, program execution cannot be restarted with a RETRY instruction,
then the instruction TRYNEXT should be used.
Syntax
RETRY ’;’
Related information
Described in:
Error handlers Basic Characteristics-
Error Recovery
Continue with the next instruction Instructions - TRYNEXT
Examples
errormessage;
Set do1;
.
PROC errormessage()
TPWrite "ERROR";
RETURN;
ENDPROC
Arguments
RETURN [ Return value ]
Return value Data type: According to the function decla-
ration
If the instruction is present in a procedure or trap routine, a return value may not
be specified.
Program execution
The result of the RETURN instruction may vary, depending on the type of routine it is
used in:
- Main routine: If a program stop has been ordered at the end of the cycle, the
program stops. Otherwise, program execution continues with
the first instruction of the main routine.
- Procedure: Program execution continues with the instruction following the
procedure call.
- Function: Returns the value of the function.
- Trap routine: Program execution continues from where the interrupt
occurred.
- Error handler: In a procedure:
Program execution continues with the routine that called the
routine with the error handler (with the instruction following
the procedure call).
In a function:
The function value is returned.
Syntax
(EBNF)
RETURN [ <expression> ]’;’
Related information
Described in:
Functions and Procedures Basic Characteristics - Routines
Trap routines Basic Characteristics - Interrupts
Error handlers Basic Characteristics - Error Recovery
Example
Rewind iodev1;
The file referred to by iodev1 will have the file position set to the beginning of
the file.
Arguments
Rewind IODevice
IODevice Data type: iodev
Program execution
The specified file is rewound to the beginning.
Example
! IO device and numeric variable for use together with a binary file
VAR iodev dev;
VAR num bindata;
! Open the binary file with \Write switch to erase old contents
Open "HOME:"\File := "bin_file",dev \Write;
Close dev;
! Open the binary file with \Bin switch for binary read and write access
Open "HOME:"\File := "bin_file",dev \Bin;
WriteStrBin dev,"Hello world";
The instruction Rewind is used to rewind a binary file to the beginning so that the
contents of the file can be read back with ReadBin.
Error handling
If an error occurs during the rewind, the system variable ERRNO is set to
ERR_FILEACC. This error can then be handled in the error handler.
Syntax
Rewind
[IODevice ’:=’] <variable (VAR) of iodev>’;’
Related information
Described in:
Opening (etc.) of files RAPID Summary - Communication
The specified program module in the program memory will be saved with the original
(specified in Load or StartLoad) or specified file path.
Example
Load "HOME:/PART_B.MOD";
...
Save "PART_B";
Load the program module with the file name PART_B.MOD from HOME: into
the program memory.
Save the program module PART_B with the original file path HOME: and with
the original file name PART_B.MOD.
Arguments
Save [\Task] ModuleName [\FilePath] [\File]
If this argument is omitted, the specified program module in the current (execut-
ing) program task will be saved.
For all program tasks in the system, predefined variables of the data type taskid
will be available. The variable identity will be "taskname"+"Id", e.g. for the
MAIN task the variable identity will be MAINId, TSK1 - TSK1Id etc.
The file path and the file name to the place where the program module is to be
saved. The file name shall be excluded when the argument \File is used.
When the file name is excluded in the argument \FilePath, it must be specified
with this argument.
The argument \FilePath can only be omitted for program modules loaded with Load or
StartLoad-WaitLoad and the program module will be stored at the same destination as
specified in these instructions. To store the program module at another destination it is
also possible to use the argument \FilePath.
To be able to save a program module that previously was loaded from the teach pen-
dant, external computer, or system configuration, the argument \FilePath must be used.
Program execution
Program execution waits for the program module to finish saving before proceeding
with the next instruction.
Example
Save "PART_A" \FilePath:="HOME:/DOORDIR/PART_A.MOD";
Save the program module PART_A to HOME: in the file PART_A.MOD and in
the directory DOORDIR.
Save program module PART_A in program task TSK1 to the specified destination.
This is an example where the instruction Save is executing in one program task
and the saving is done in another program task.
Limitations
TRAP routines, system I/O events and other program tasks cannot execute during the
saving operation. Therefore, any such operations will be delayed.
The save operation can interrupt update of PERS data done step by step from other pro-
gram tasks. This will result in inconsistent whole PERS data.
A program stop during execution of the Save instruction can result in a guard stop with
motors off and the error message "20025 Stop order timeout" will be displayed on the
Teach Pendant.
Error handling
If the program module cannot be saved because there is no module name, unknown, or
ambiguous module name, the system variable ERRNO is set to ERR_MODULE.
If the save file cannot be opened because of permission denied, no such directory, or
no space left on device, the system variable ERRNO is set to ERR_IOERROR.
If argument \FilePath is not specified for program modules loaded from the Teach Pen-
dant, System Parameters, or an external computer, the system variable ERRNO is set
to ERR_PATH.
Syntax
Save
[ ’\’ Task ’:=’ <variable (VAR) of taskid> ’,’ ]
[ ModuleName ’:=’ ] <expression (IN) of string>
[ ’\’ FilePath ’:=’<expression (IN) of string> ]
[ ’\’ File ’:=’ <expression (IN) of string>] ’;’
Related information
Described in:
Program tasks Data Types - taskid
During the movement, the robot supervises a digital input signal. When the value of
the signal changes to the requested one, the robot immediately reads the current
position.
This instruction can typically be used when the tool held by the robot is a probe for
surface detection. Using the SearchC instruction, the outline coordinates of a work
object can be obtained.
Examples
SearchC sen1, sp, cirpoint, p10, v100, probe;
The TCP of the probe is moved circularly towards the position p10 at a speed of
v100. When the value of the signal do1 changes to active, the position is stored
in sp.
The TCP of the probe is moved circularly towards the position p10. When the
value of the signal do1 changes to active, the position is stored in sp and the robot
stops immediately.
Arguments
SearchC [ \Stop ] | [ \PStop ] | [ \SStop ] | [ \Sup ] Signal [ \Flanks ]
SearcPoint CirPoint ToPoint Speed [ \V ] | [ \T ] Tool [ \WObj ] [ \Corr
]
[ \Stop ] (Stiff Stop) Data type: switch
The robot movement is stopped, as quickly as possible, without keeping the TCP
on the path (hard stop), when the value of the search signal changes to active.
However, the robot is moved a small distance before it stops and is not moved
back to the searched position, i.e. to the position where the signal changed.
The robot movement is stopped as quickly as possible, while keeping the TCP
on the path (soft stop), when the value of the search signal changes to active.
However, the robot is moved a distance before it stops and is not moved back to
the searched position, i.e. to the position where the signal changed.
The robot movement is stopped as quickly as possible, while keeping the TCP
close to or on the path (smooth stop), when the value of the search signal changes
to active. However, the robot is moved only a small distance before it stops and
is not moved back to the searched position, i.e. to the position where the signal
changed. SStop is faster then PStop. But when the robot is running faster than 100
mm/s, it stops in the direction of the tangent of the movement which causes it to
marginally slide of the path.
If the argument \Stop, \PStop, \SStop or \Sup is omitted, the movement continues
(flying search) to the position specified in the ToPoint argument (same as with
argument \Sup),
The positive and the negative edge of the signal is valid for a search hit.
If the argument \Flanks is omitted, only the positive edge of the signal is valid for
a search hit and a signal supervision will be activated at the beginning of a search
process. This means that if the signal has a positive value already at the beginning
of a search process, the robot movement is stopped as quickly as possible, while
keeping the TCP on the path (soft stop). However, the robot is moved a small
distance before it stops and is not moved back to the start position. A user
recovery error (ERR_SIGSUPSEARCH) will be generated and can be dealt with
by the error handler.
The position of the TCP and external axes when the search signal has been
triggered. The position is specified in the outermost coordinate system, taking the
specified tool, work object and active ProgDisp/ExtOffs coordinate system into
consideration.
The circle point of the robot. See the instruction MoveC for a more detailed
description of circular movement. The circle point is defined as a named position
or stored directly in the instruction (marked with an * in the instruction).
The destination point of the robot and external axes. It is defined as a named
position or stored directly in the instruction (marked with an * in the instruction).
SearchC always uses a stop point as zone data for the destination.
The speed data that applies to movements. Speed data defines the velocity of the
tool centre point, the external axes and of the tool reorientation.
This argument is used to specify the velocity of the TCP in mm/s directly in the
instruction. It is then substituted for the corresponding velocity specified in the
speed data.
This argument is used to specify the total time in seconds during which the robot
moves. It is then substituted for the corresponding speed data.
The tool in use when the robot moves. The tool centre point is the point that is
moved to the specified destination position.
The work object (coordinate system) to which the robot positions in the
instruction are related.
This argument can be omitted, and if it is, the position is related to the world
coordinate system. If, on the other hand, a stationary TCP or coordinated
external axes are used, this argument must be specified for a linear movement
relative to the work object to be performed.
Program execution
See the instruction MoveC for information about circular movement.
The movement is always ended with a stop point, i.e. the robot is stopped at the
destination point.
When a flying search is used, i.e. the \Sup argument is specified, the robot movement
always continues to the programmed destination point. When a search is made using
the switch \Stop, \PStop or \SStop, the robot movement stops when the first signal is
detected.
The SearchC instruction returns the position of the TCP when the value of the digital
signal changes to the requested one, as illustrated in Figure 16.
Figure 16 Flank-triggered signal detection (the position is stored when the signal is changed the
first time only).
Example
SearchC \Sup, sen1\Flanks, sp, cirpoint, p10, v100, probe;
The TCP of the probe is moved circularly towards the position p10. When the
value of the signal do1 changes to active or passive, the position is stored in sp.
If the value of the signal changes twice, program execution stops.
Limitations
Zone data for the positioning instruction that precedes SearchC must be used carefully.
The start of the search, i.e. when the I/O signal is ready to react, is not, in this case, the
programmed destination point of the previous positioning instruction, but a point along
the real robot path. Figure 17 illustrates an example of something that may go wrong
when zone data other than fine is used.
The instruction SearchC should never be restarted after the circle point has been
passed. Otherwise the robot will not take the programmed path (positioning around the
circular path in another direction compared with that programmed).
End point
Figure 17 A match is made on the wrong side of the object because the wrong zone data was
used.
Error handling
An error is reported during a search when:
Errors can be handled in different ways depending on the selected running mode:
Instruction backward
During backward execution, the instruction just carries out the movement
without any signal supervision.
Syntax
SearchC
[ ’\’ Stop’,’ ] | [ ’\’ PStop ’,’] | [ ’\’ SStop ’,’ ] | [ ’\’ Sup ’,’ ]
[ Signal ’:=’ ] < variable (VAR) of signaldi >
[‘\’ Flanks]’,’
[ SearchPoint ’:=’ ] < var or pers (INOUT) of robtarget > ’,’
[ CirPoint ’:=’ ] < expression (IN) of robtarget > ’,’
[ ToPoint ’:=’ ] < expression (IN) of robtarget > ’,’
[ Speed ’:=’ ] < expression (IN) of speeddata >
[ ’\’ V ’:=’ < expression (IN) of num > ]
| [ ’\’ T ’:=’ < expression (IN) of num > ] ’,’
[ Tool ’:=’ ] < persistent (PERS) of tooldata >
[ ’\’ WObj ’:=’ < persistent (PERS) of wobjdata > ]
[ ’\’ Corr ]’;’
Related information
Described in:
Linear searches Instructions - SearchL
Writes to a corrections entry Instructions - CorrWrite
Circular movement Motion and I/O Principles -
Positioning during Program Execution
Definition of velocity Data Types - speeddata
Definition of tools Data Types - tooldata
Definition of work objects Data Types - wobjdata
Using error handlers RAPID Summary - Error Recovery
Motion in general Motion and I/O Principles
More searching examples Instructions - SearchL
During the movement, the robot supervises a digital input signal. When the value of
the signal changes to the requested one, the robot immediately reads the current
position.
This instruction can typically be used when the tool held by the robot is a probe for
surface detection. Using the SearchL instruction, the outline coordinates of a work
object can be obtained.
Examples
SearchL do1, sp, p10, v100, probe;
The TCP of the probe is moved linearly towards the position p10 at a speed of
v100. When the value of the signal do1 changes to active, the position is stored
in sp.
The TCP of the probe is moved linearly towards the position p10. When the
value of the signal do1changes to active, the position is stored in sp and the robot
stops immediately.
Arguments
SearchL [ \Stop ] | [ \PStop ] | [ \SStop ] | [ \Sup ] Signal
[ \Flanks ] SearchPoint ToPoint Speed [ \V ] | [ \T ] Tool [ \WObj ]
[ \Corr ]
[ \Stop ] (Stiff Stop) Data type: switch
The robot movement is stopped as quickly as possible, without keeping the TCP
on the path (hard stop), when the value of the search signal changes to active.
However, the robot is moved a small distance before it stops and is not moved
back to the searched position, i.e. to the position where the signal changed.
The robot movement is stopped as quickly as possible, while keeping the TCP
on the path (soft stop), when the value of the search signal changes to active.
However, the robot is moved a distance before it stops and is not moved back to
the searched position, i.e. to the position where the signal changed.
The robot movement is stopped as quickly as possible, while keeping the TCP
close to or on the path (smooth stop), when the value of the search signal changes
to active. However, the robot is moved only a small distance before it stops and
is not moved back to the searched position, i.e. to the position where the signal
changed. SStop is faster then PStop. But when the robot is running faster than 100
mm/s it stops in the direction of the tangent of the movement which causes it to
marginally slide off the path.
If the argument \Stop, \PStop, \SStop or \Sup is omitted, the movement continues
(flying search) to the position specified in the ToPoint argument (same as with
argument \Sup).
The positive and the negative edge of the signal is valid for a search hit.
If the argument \Flanks is omitted, only the positive edge of the signal is valid for
a search hit and a signal supervision will be activated at the beginning of a search
process. This means that if the signal has the positive value already at the
beginning of a search process, the robot movement is stopped as quickly as
possible, while keeping the TCP on the path (soft stop). A user recovery error
(ERR_SIGSUPSEARCH) will be generated and can be handled in the error
handler.
The position of the TCP and external axes when the search signal has been
triggered. The position is specified in the outermost coordinate system, taking the
specified tool, work object and active ProgDisp/ExtOffs coordinate system into
consideration.
The destination point of the robot and external axes. It is defined as a named
position or stored directly in the instruction (marked with an * in the instruction).
SearchL always uses a stop point as zone data for the destination.
The speed data that applies to movements. Speed data defines the velocity of the
tool centre point, the external axes and of the tool reorientation.
This argument is used to specify the velocity of the TCP in mm/s directly in the
instruction. It is then substituted for the corresponding velocity specified in the
speed data.
This argument is used to specify the total time in seconds during which the robot
moves. It is then substituted for the corresponding speed data.
The tool in use when the robot moves. The tool centre point is the point that is
moved to the specified destination position.
The work object (coordinate system) to which the robot position in the
instruction is related.
This argument can be omitted, and if it is, the position is related to the world
coordinate system. If, on the other hand, a stationary TCP or coordinated
external axes are used, this argument must be specified for a linear movement
relative to the work object to be performed.
Program execution
See the instruction MoveL for information about linear movement.
The movement always ends with a stop point, i.e. the robot stops at the destination
point.
If a flying search is used, i.e. the \Sup argument is specified, the robot movement
always continues to the programmed destination point. If a search is made using the
switch \Stop, \PStop or \SStop, the robot movement stops when the first signal is
detected.
The SearchL instruction stores the position of the TCP when the value of the digital
signal changes to the requested one, as illustrated in Figure 18.
Figure 18 Flank-triggered signal detection (the position is stored when the signal is changed the
first time only).
Examples
SearchL \Sup, sen1\Flanks, sp, p10, v100, probe;
The TCP of the probe is moved linearly towards the position p10. When the value
of the signal do1changes to active or passive, the position is stored in sp. If the
value of the signal changes twice, program execution stops after the search
process is finished.
At the beginning of the search process, a check on the signal do1will be done and
if the signal already has a positive value, the program execution stops.
Otherwise the TCP of tool1 is moved linearly towards the position p10. When the
value of the signal do1changes to active, the position is stored in sp. The robot is
moved back to this point using an accurately defined stop point. Using program
displacement, the robot then moves relative to the searched position, sp.
Limitations
Zone data for the positioning instruction that precedes SearchL must be used carefully.
The start of the search, i.e. when the I/O signal is ready to react, is not, in this case, the
programmed destination point of the previous positioning instruction, but a point along
the real robot path. Figure 19 to Figure 21 illustrate examples of things that may go
wrong when zone data other than fine is used.
Figure 19 A match is made on the wrong side of the object because the wrong zone data was
used.
Figure 20 No match detected because the wrong zone data was used.
Figure 21 No match detected because the wrong zone data was used.
Error handling
An error is reported during a search when:
Errors can be handled in different ways depending on the selected running mode:
Instruction backward
During backward execution, the instruction just carries out the movement
without any signal supervision.
Example
VAR num fk;
.
MoveL p10, v100, fine, tool1;
SearchL \Stop, sen1, sp, p20, v100, tool1;
.
ERROR
IF ERRNO=ERR_WHLSEARCH THEN
MoveL p10, v100, fine, tool1;
RETRY;
ELSEIF ERRNO=ERR_SIGSUPSEARCH THEN
TPWrite “The signal of the SearchL instruction is already high!”;
TPReadFK fk,”Try again after manual reset of signal ?”,”YES”,””,””,””,”NO”;
IF fk = 1 THEN
MoveL p10, v100, fine, tool1;
RETRY;
ELSE
Stop;
ENDIF
ENDIF
If the signal is already active at the beginning of the search process, a user dialog
will be activated (TPReadFK ...;). Reset the signal and push YES on the user
dialog and the robot moves back to p10 and tries once more. Otherwise program
execution will stop.
If the signal is passive at the beginning of the search process, the robot searches
from position p10 to p20. If no signal detection occurs, the robot moves back to
p10 and tries once more.
Syntax
SearchL
[ ’\’ Stop ’,’ ] | [ ’\’ PStop ’,’] | [ ’\’ SStop ’,’] | [ ’\’ Sup ’,’ ]
[ Signal ’:=’ ] < variable (VAR) of signaldi >
[‘\’ Flanks] ’,’
[ SearchPoint ’:=’ ] < var or pers (INOUT) of robtarget > ’,’
[ ToPoint ’:=’ ] < expression (IN) of robtarget > ’,’
[ Speed ’:=’ ] < expression (IN) of speeddata >
[ ’\’ V ’:=’ < expression (IN) of num > ]
| [ ’\’ T ’:=’ < expression (IN) of num > ] ’,’
[ Tool ’:=’ ] < persistent (PERS) of tooldata >
[ ’\’ WObj ’:=’ < persistent (PERS) of wobjdata > ]
[ ’\’ Corr ]’;’
Related information
Described in:
Circular searches Instructions - SearchC
Writes to a corrections entry Instructions - CorrWrite
Linear movement Motion and I/O Principles -
Positioning during Program
Execution
Definition of velocity Data Types - speeddata
Definition of tools Data Types - tooldata
Definition of work objects Data Types - wobjdata
Using error handlers RAPID Summary - Error Recovery
Motion in general Motion and I/O Principles
Examples
Set do15;
Set weldon;
Arguments
Set Signal
Signal Data type: signaldo
Program execution
The true value depends on the configuration of the signal. If the signal is inverted in
the system parameters, this instruction causes the physical channel to be set to zero.
Syntax
Set
[ Signal ’:=’ ] < variable (VAR) of signaldo > ’;’
Related information
Described in:
Setting a digital output signal to zero Instructions - Reset
Input/Output instructions RAPID Summary -
Input and Output Signals
Input/Output functionality in general Motion and I/O Principles -
I/O Principles
Configuration of I/O System Parameters
Example
SetAO ao2, 5.5;
Arguments
SetAO Signal Value
Signal Data type: signalao
Program execution
The programmed value is scaled (in accordance with the system parameters) before it
is sent on the physical channel. See Figure 22.
MAX SIGNAL
MAX PROGRAM
MIN SIGNAL
Example
SetAO weldcurr, curr_outp;
The signal weldcurr is set to the same value as the current value of the variable
curr_outp.
Syntax
SetAO
[ Signal ’:=’ ] < variable (VAR) of signalao > ’,’
[ Value ’:=’ ] < expression (IN) of num > ’;’
Related information
Described in:
Input/Output instructions RAPID Summary -
Input and Output Signals
Input/Output functionality in general Motion and I/O Principles -
I/O Principles
Configuration of I/O System Parameters
Examples
SetDO do15, 1;
The signal weld is set to high with a delay of 0.2 s. Program execution, however,
continues with the next instruction.
Arguments
SetDO [ \SDelay ] Signal Value
[ \SDelay ] (Signal Delay) Data type: num
Delays the change for the amount of time given in seconds (0.1 - 32s).
Program execution continues directly with the next instruction. After the given
time-delay, the signal is changed without the rest of the program execution being
affected.
Program execution
The true value depends on the configuration of the signal. If the signal is inverted in the
system parameters, the value of the physical channel is the opposite.
Syntax
SetDO
[ ’\’ SDelay ’:=’ < expression (IN) of num > ’,’ ]
[ Signal ’:=’ ] < variable (VAR) of signaldo > ’,’
[ Value ’:=’ ] < expression (IN) of dionum > ’;’
Related information
Described in:
Input/Output instructions RAPID Summary -
Input and Output Signals
Input/Output functionality in general Motion and I/O Principles -
I/O Principles
Configuration of I/O User’s Guide - System Parameters
Example
SetGO go2, 12;
The signal go2 is set to 12. If go2 comprises 4 signals, e.g. outputs 6-9, outputs
6 and 7 are set to zero, while outputs 8 and 9 are set to one.
The signal go2 is set to 10. If go2 comprises 4 signals, e.g. outputs 6-9, outputs
6 and 8 are set to zero, while outputs 7 and 9 are set to one, with a delay of 0.4 s.
Program execution, however, continues with the next instruction.
Arguments
SetGO [ \SDelay ] Signal Value
[ \SDelay ] (Signal Delay) Data type: num
Delays the change for the period of time stated in seconds (0.1 - 32s).
Program execution continues directly with the next instruction. After the
specified time delay, the value of the signals is changed without the rest of the
program execution being affected.
Program execution
The programmed value is converted to an unsigned binary number. This binary number
is sent on the signal group, with the result that individual signals in the group are set to
0 or 1. Due to internal delays, the value of the signal may be undefined for a short
period of time.
Syntax
SetDO
[ ’\’ SDelay ’:=’ < expression (IN) of num > ’,’ ]
[ Signal ’:=’ ] < variable (VAR) of signalgo > ’,’
[ Value ’:=’ ] < expression (IN) of num > ’;’
Related information
Described in:
Other input/output instructions RAPID Summary -
Input and Output Signals
Input/Output functionality in general Motion and I/O Principles -
I/O Principles
Configuration of I/O (system parameters) System Parameters
SingArea is also used to define linear and circular interpolation for robots with less
than six axes.
Examples
SingArea \Wrist;
The orientation of the tool may be changed slightly in order to pass a singular
point (axes 4 and 6 in line).
Robots with less than six axes may not be able to reach an interpolated tool ori-
entation. By using SingArea \Wrist, the robot can achieve the movement but the
orientation of the tool will be slightly changed.
SingArea \Off;
The tool orientation is not allowed to differ from the programmed orientation. If
a singular point is passed, one or more axes may perform a sweeping movement,
resulting in a reduction in velocity.
Robots with less than six axes may not be able to reach a programmed tool ori-
entation. As a result the robot will stop.
Arguments
SingArea [ \Wrist] | [ \Off]
[ \Wrist ] Data type: switch
The tool orientation is allowed to differ somewhat in order to avoid wrist singu-
larity. Used when axes 4 and 6 are parallel (axis 5 at 0 degrees). Also used for
linear and circular interpolation of robots with less than six axes where the tool
orientation is allowed to differ.
The tool orientation is not allowed to differ. Used when no singular points are
passed, or when the orientation is not permitted to be changed.
If none of the arguments are specified, program execution automatically uses the
robot’s default argument. For robots with six axes the default argument is \Off.
Program execution
If the arguments \Wrist is specified, the orientation is joint-interpolated to avoid singu-
lar points. In this way, the TCP follows the correct path, but the orientation of the tool
deviates somewhat. This will also happen when a singular point is not passed.
The specified interpolation applies to all subsequent movements until a new SingArea
instruction is executed.
By default, program execution automatically uses the /Off argument for robots with six
axes. Robots with less than six axes may use either the /Off argument (IRB640) or the
/Wrist argument by default. This is automatically set in event routine SYS_RESET.
- at a cold start-up
- when a new program is loaded
- when starting program executing from the beginning.
Syntax
SingArea
[ ’\’ Wrist ] | [ ’\’ Off ] ’;’
Related information
Described in:
Singularity Motion Principles- Singularity
Interpolation Motion Principles - Positioning during
Program Execution
Example
SoftAct 3, 20;
SoftAct 1, 90 \Ramp:=150;
Activation of the soft servo on robot axis 1, with softness value 90% and ramp
factor 150%.
Activation of soft servo on axis 1 for the mechanical unit orbit1, with softness
value 40% and ramp factor 120%.
Arguments
SoftAct [\MechUnit] Axis Softness [\Ramp ]
[\MechUnit] (Mechanical Unit Data type: mecunit
The name of the mechanical unit. If this argument is omitted, it means activation
of the soft servo for specified robot axis.
Ramp factor in percent (>= 100%). The ramp factor is used to control the
engagement of the soft servo. A factor 100% denotes the normal value; with
greater values the soft servo is engaged more slowly (longer ramp). The default
value for ramp factor is 100 %.
Program execution
Softness is activated at the value specified for the current axis. The softness value is
valid for all movements, until a new softness value is programmed for the current axis,
or until the soft servo is deactivated by an instruction.
Limitations
Soft servo for any robot or external axis is always deactivated when there is a power
failure. This limitation can be handled in the user program when restarting after a
power failure.
The same axis must not be activated twice, unless there is a moving instruction in
between. Thus, the following program sequence should be avoided, otherwise there
will be a jerk in the robot movement:
SoftAct n , x ;
SoftAct n , y ;
(n = robot axis n, x and y softness values)
Syntax
SoftAct
[’\’MechUnit ’:=’ < variable (VAR) of mecunit> ’,’]
[Axis ’:=’ ] < expression (IN) of num> ’,’
[Softness ’:=’ ] < expression (IN) of num>
[ ’\’Ramp ’:=’ < expression (IN) of num> ]’;’
Related information
Described in:
Behaviour with the soft servo engaged Motion and I/O Principles- Positioning
during program execution
Example
SoftDeact;
SoftDeact \Ramp:=150;
Deactivating the soft servo on all axes, with ramp factor 150%.
Arguments
SoftDeact [\Ramp ]
Ramp factor in percent (>= 100%). The ramp factor is used to control the deac-
tivating of the soft servo. A factor 100% denotes the normal value; with greater
values the soft servo is deactivated more slowly (longer ramp). The default value
for ramp factor is 100 %.
Program execution
The soft servo is deactivated for all robot and external axes.
Syntax
SoftDeact
[ ’\’Ramp ’:=’ < expression (IN) of num> ]’;’
Related information
Described in:
Activating the soft servo Instructions - SoftAct
The stored data is intended for debugging RAPID programs, specifically for multi-
tasking systems (only necessary to have SpyStart - SpyStop in one program task).
Example
SpyStart "HOME:/spy.log";
Starts recording the execution time data in the file spy.log on the HOME: disk.
Arguments
SpyStart File
File Data type: string
The file path and the file name to the file that will contain the execution data.
Program execution
The specified file is opened for writing and the execution time data begins to be
recorded in the file.
Limitations
Avoid using the floppy disk (option) for recording since writing to the floppy is very
time consuming.
Never use the spy function in production programs because the function increases the
cycle time and consumes memory on the mass memory device in use.
Error handling
If the file in the SpyStart instruction can’t be opened then the system variable ERRNO
is set to ERR_FILEOPEN (see “Data types - errnum”). This error can then be handled
in the error handler.
File format
TASK INSTR IN CODE OUT
----- SYSTEM TRAP----- means that the system is doing something else than execu-
tion of RAPID instructions.
If procedure call to some NOSTEPIN procedure (module) the output list shows only
the name of the called procedure. This is repeated for every executed instruction in the
NOSTEPIN routine.
Syntax
SpyStart
[File’:=’]<expression (IN) of string>’;’
Related information
Described in:
Stop recording of execution data Instructions - SpyStop
The data, which can be useful for optimising the execution cycle time, is stored in a
file for later analysis.
Example
SpyStop;
Stops recording the execution time data in the file specified by the previous
SpyStart instruction.
Program execution
The execution data recording is stopped and the file specified by the previous SpyStart
instruction is closed.
If no SpyStart instruction has been executed before, the SpyStop instruction is ignored.
Examples
IF debug = TRUE SpyStart "HOME:/spy.log";
produce_sheets;
IF debug = TRUE SpyStop;
If the debug flag is true, start recording execution data in the file spy.log on the
HOME: disk, perform actual production; stop recording, and close the file
spy.log.
Limitations
Avoid using the floppy disk (option) for recording since writing to the floppy is very
time consuming.
Never use the spy function in production programs because the function increases the
cycle time and consumes memory on the mass memory device in use.
Syntax
SpyStop’;’
Related information
Described in:
Start recording of execution data Instructions - SpyStart
The loaded program module will be added to the modules already existing in the pro-
gram memory.
Static mode
Table 3: How different operations affect a static loaded program or system modules
Dynamic mode
Table 4: How different operations affect a dynamic loaded program or system modules
Both static and dynamic loaded modules can be unloaded by the instruction UnLoad.
Example
VAR loadsession load1;
! Wait until loading and linking of new program module PART_B is ready
WaitLoad load1;
Starts the loading of program module PART_B.MOD from diskhome into the pro-
gram memory with instruction StartLoad. In parallel with the loading, the pro-
gram executes routine_a in module PART_A.MOD. Then instruction WaitLoad
waits until the loading and linking is finished. The module is loaded in dynamic
mode.
Variable load1 holds the identity of the load session, updated by StartLoad and
referenced by WaitLoad.
To save linking time, the instruction UnLoad and WaitLoad can be combined in
the instruction WaitLoad by using the option argument \UnLoadPath.
Arguments
StartLoad [\Dynamic] FilePath [\File] LoadNo
[\Dynamic] Data type: switch
The file path and the file name to the file that will be loaded into the program
memory. The file name shall be excluded when the argument \File is used.
When the file name is excluded in the argument FilePath, then it must be defined
with this argument.
This is a reference to the load session that should be used in the instruction Wait-
Load to connect the loaded program module to the program task.
Program execution
Execution of StartLoad will only order the loading and then proceed directly with the
next instruction, without waiting for the loading to be completed.
The instruction WaitLoad will then wait at first for the loading to be completed, if it is
not already finished, and then it will be linked and initialised. The initialisation of the
loaded module sets all variables at module level to their init values.
Unsolved references will be accepted if the system parameter for Tasks/BindRef is set
to NO. However, when the program is started or the teach pendant function Program
Window/File/Check Program is used, no check for unsolved references will be done if
BindRef = NO. There will be a run time error on execution of an unsolved reference.
Another way to use references to instructions that are not in the task from the begin-
ning, is to use Late Binding. This makes it possible to specify the routine to call with a
string expression, quoted between two %%. In this case the BindRef parameter could
be set to YES (default behaviour). The Late Binding way is preferable.
To obtain a good program structure, that is easy to understand and maintain, all loading
and unloading of program modules should be done from the main module, which is
always present in the program memory during execution.
Examples
StartLoad \Dynamic, “HOME:/DOORDIR/DOOR1.MOD”, load1;
Loads the program module DOOR1.MOD from the HOME: in the directory
DOORDIR into the program memory. The program module is loaded in dynamic
mode.
Same as the two examples above but the module is loaded in static mode.
is the same as
Limitations
It is not allowed to load a system module or a program module that contains a main rou-
tine.
Syntax
StartLoad
[‘\’Dynamic ‘,’]
[FilePath ’:=’] <expression (IN) of string>
[’\’File ’:=’ <expression (IN) of string> ] ’,’
[LoadNo ’:=’] <variable (VAR) of loadsession> ’;’
Related information
Described in:
Connect the loaded module to the task Instructions - WaitLoad
Load session Data Types - loadsession
Load a program module Instructions - Load
Unload a program module Instructions - UnLoad
Accept unsolved references System Parameters - Controller/Task/
BindRef
Example
StopMove;
WaitDI ready_input, 1;
StartMove;
The robot starts to move again when the input ready_input is set.
Program execution
Any processes associated with the stopped movement are restarted at the same time as
motion resumes.
Error handling
If the robot is too far from the path (more than 10 mm or 20 degrees) to perform a start
of the interrupted movement, the system variable ERRNO is set to ERR_PATHDIST.
This error can then be handled in the error handler.
Syntax
StartMove’;’
Related information
Described in:
Stopping movements Instructions - StopMove
More examples Instructions - StorePath
Program execution can also be stopped using the instruction EXIT. This, however,
should only be done if a task is complete, or if a fatal error occurs, since program
execution cannot be restarted with EXIT.
Example
TPWrite “The line to the host computer is broken”;
Stop;
Program execution stops after a message has been written on the teach pendant.
Arguments
Stop [ \NoRegain ]
[ \NoRegain ] Data type: switch
Specifies for the next program start in manual mode, whether or not the robot and
external axes should regain to the stop position. In automatic mode the robot and
external axes always regain to the stop position.
If the argument NoRegain is set, the robot and external axes will not regain to the
stop position (if they have been jogged away from it).
If the argument is omitted and if the robot or external axes have been jogged
away from the stop position, the robot displays a question on the teach pendant.
The user can then answer, whether or not the robot should regain to the stop
position.
Program execution
The instruction stops program execution as soon as the robot and external axes reach
the programmed destination point for the movement it is performing at the time.
Program execution can then be restarted from the next instruction.
Example
MoveL p1, v500, fine, tool1;
TPWrite “Jog the robot to the position for pallet corner 1”;
Stop \NoRegain;
p1_read := CRobT();
MoveL p2, v500, z50, tool1;
Program execution stops with the robot at p1. The operator jogs the robot to
p1_read. For the next program start, the robot does not regain to p1, so the
position p1_read can be stored in the program.
Limitations
The movement instruction which precedes this instruction should be terminated with a
stop point, in order to be able to restart in this instruction following a power failure.
Syntax
Stop
[ ’\’ NoRegain ]’;’
Related information
Described in:
Stopping after a fatal error Instructions - EXIT
Terminating program execution Instructions - EXIT
Only stopping robot movements Instructions - StopMove
This instruction can, for example, be used in a trap routine to stop the robot temporarily
when an interrupt occurs.
Example
StopMove;
WaitDI ready_input, 1;
StartMove;
Program execution
The movements of the robot and external axes stop without the brakes being engaged.
Any processes associated with the movement in progress are stopped at the same time
as the movement is stopped.
Program execution continues without waiting for the robot and external axes to stop
(standing still).
Examples
VAR intnum intno1;
...
CONNECT intno1 WITH go_to_home_pos;
ISignalDI di1,1,intno1;
TRAP go_to_home_pos
VAR robtarget p10;
StopMove;
StorePath;
p10:=CRobT();
MoveL home,v500,fine,tool1;
WaitDI di1,0;
Move L p10,v500,fine,tool1;
RestoPath;
StartMove;
ENDTRAP
When the input di1 is set to 1, an interrupt is activated which in turn activates the
interrupt routine go_to_home_pos. The current movement is stopped
immediately and the robot moves instead to the home position. When di1 is set
to 0, the robot returns to the position at which the interrupt occurred and
continues to move along the programmed path.
TRAP go_to_home_pos ()
VAR robtarget p10;
StorePath;
p10:=CRobT();
MoveL home,v500,fine,tool1;
WaitDI di1,0;
Move L p10,v500,fine,tool1;
RestoPath;
StartMove;
ENDTRAP
Similar to the previous example, but the robot does not move to the home position
until the current movement instruction is finished.
Syntax
StopMove’;’
Related information
Described in:
Continuing a movement Instructions - StartMove
Interrupts RAPID Summary - Interrupts
Basic Characteristics- Interrupts
This instruction can be used to go to a service position or to clean the gun, for example,
when an error occurs.
Example
StorePath;
Program execution
The current movement path of the robot and external axes is saved. After this, another
movement can be started in a trap routine or an error handler. When the reason for the
error or interrupt has been rectified, the saved movement path can be restarted.
Example
TRAP machine_ready
VAR robtarget p1;
StorePath;
p1 := CRobT();
MoveL p100, v100, fine, tool1;
...
MoveL p1, v100, fine, tool1;
RestoPath;
StartMove;
ENDTRAP
When an interrupt occurs that activates the trap routine machine_ready, the
movement path which the robot is executing at the time is stopped at the end of
the instruction (ToPoint) and stored. After this, the robot remedies the interrupt
by, for example, replacing a part in the machine and the normal movement is
restarted.
Limitations
Only the movement path data is stored with the instruction StorePath.
If the user wants to order movements on the new path level, the actual stop position
must be stored directly after StorePath and before RestoPath make a movement to the
stored stop position on the path.
Syntax
StorePath‘;’
Related information
Described in:
Restoring a path Instructions - RestoPath
More examples Instructions - RestoPath
If there are not too many alternatives, the IF..ELSE instruction can also be used.
Example
TEST reg1
CASE 1,2,3 :
routine1;
CASE 4 :
routine2;
DEFAULT :
TPWrite "Illegal choice";
Stop;
ENDTEST
Different instructions are executed depending on the value of reg1. If the value
is 1-3 routine1 is executed. If the value is 4, routine2 is executed. Otherwise, an
error message is printed and execution stops.
Arguments
TEST Test data {CASE Test value {, Test value} : ...}
[ DEFAULT: ...] ENDTEST
Test data Data type: All
The data or expression with which the test value will be compared.
The value which the test data must have for the associated instructions to be exe-
cuted.
Program execution
The test data is compared with the test values in the first CASE condition. If the com-
parison is true, the associated instructions are executed. After that, program execution
continues with the instruction following ENDTEST.
If the first CASE condition is not satisfied, other CASE conditions are tested, and so
on. If none of the conditions are satisfied, the instructions associated with DEFAULT
are executed (if this is present).
Syntax
(EBNF)
TEST <expression>
{( CASE <test value> { ’,’ <test value> } ’:’
<instruction list> ) | <CSE> }
[ DEFAULT ’:’ <instruction list> ]
ENDTEST
Related information
Described in:
Expressions Basic Characteristics - Expressions
A test signal continuously mirrors some specified motion data stream, for example,
torque reference for some specified axis. The actual value at a certain time can be read
in RAPID with the function TestSignRead.
Example
TestSignDefine 1, resolver_angle, Orbit, 2, 0,1;
Test signal resolver_angle connected to channel 1, will give the value of the
resolver angle for external robot Orbit axis 2, sampled at 100 ms rate.
Arguments
TestSignDefine Channel SignalId MechUnit Axis SampleTime
Channel Data type: num
For sample time < 0.004 s, the function TestSignRead returns the mean value of
the latest available internal samples as shown in the table below.
Program execution
The definition of test signal is activated and the robot system starts the sampling of the
test signal.
Error handling
If there is an error in the parameter MechUnit, the system parameter ERRNO is set to
ERR_UNIT_PAR. If there is an error in the parameter Axis, ERRNO is set to
ERR_AXIS_PAR.
Syntax
TestSignDefine
[ Channel ’:=’ ] < expression (IN) of num> ’,’
[ SignalId ’:=’ ] < expression (IN) of testsignal> ’,’
[ MechUnit ’:=’ ] < variable (VAR) of mecunit> ’,’
[Axis ’:=’ ] < expression (IN) of num> ’,’
[ SampleTime ’:=’ ] < expression (IN) of num > ’;’
Related information
Described in:
Test signal Data Types - testsignal
Read test signal Functions - TestSignRead
Reset test signals Instructions - TestSignReset
Example
TestSignReset;
Program execution
The definitions of all test signals are deactivated and the robot system stops the sam-
pling of any test signals.
Syntax
TestReset’;’
Related information
Described in:
Define test signal Instructions - TestSignDefine
Read test signal Functions - TestSignRead
Example
TPErase;
TPWrite "Execution started";
Program execution
The teach pendant display is completely cleared of all text. The next time text is writ-
ten, it will be entered on the uppermost line of the display.
Syntax
TPErase;
Related information
Described in:
Writing on the teach pendant RAPID Summary - Communication
Example
TPReadFK reg1, “More ?”, stEmpty, stEmpty, stEmpty, “Yes”, “No”;
The text More ? is written on the teach pendant display and the function keys 4
and 5 are activated by means of the text strings Yes and No respectively (see
Figure 23). Program execution waits until one of the function keys 4 or 5 is
pressed. In other words, reg1 will be assigned 4 or 5 depending on which of the
keys is depressed.
More?
Yes No
Figure 23 The operator can input information via the function keys.
Arguments
TPReadFK Answer Text FK1 FK2 FK3 FK4 FK5 [\MaxTime]
[\DIBreak] [\BreakFlag]
Answer Data type: num
The variable for which, depending on which key is pressed, the numeric value
1..5 is returned. If the function key 1 is pressed, 1 is returned, and so on.
The text to be written as a prompt for the appropriate function key (a maximum
of 7 characters). FK1 is the left-most key.
Function keys without prompts are specified by the predefined string constant
stEmpty with value empty string (“”).
The maximum amount of time [s] that program execution waits. If no function key
is depressed within this time, the program continues to execute in the error handler
unless the BreakFlag is used (see below). The constant ERR_TP_MAXTIME can
be used to test whether or not the maximum time has elapsed.
The digital signal that may interrupt the operator dialog. If no function key is
depressed when the signal is set to 1 (or is already 1), the program continues to
execute in the error handler, unless the BreakFlag is used (see below). The
constant ERR_TP_DIBREAK can be used to test whether or not this has occurred.
A variable that will hold the error code if maxtime or dibreak is used. If this
optional variable is omitted, the error handler will be executed. The constants
ERR_TP_MAXTIME and ERR_TP_ DIBREAK can be used to select the reason.
Program execution
The information text is always written on a new line. If the display is full of text, this
body of text is moved up one line first. Strings longer than the width of the teach pendant
(40 characters) are split into two lines.
Prompts are written above the appropriate function keys. Keys without prompts are
deactivated.
Program execution waits until one of the activated function keys is depressed.
• New TP request from other program task will not take focus (new put in queue)
• New TP request from TRAP in the same program task will take focus (old put in queue)
• Program stop take focus (old put in queue)
• New TP request in program stop state takes focus (old put in queue)
Example
VAR errnum errvar;
...
TPReadFK reg1, “Go to service position?”, stEmpty, stEmpty, stEmpty, “Yes”, “No”
\MaxTime:= 600
\DIBreak:= di5\BreakFlag:= errvar;
IF reg1 = 4 or OR errvar = ERR_TP_DIBREAK THEN
MoveL service, v500, fine, tool1;
Stop;
ENDIF
IF errvar = ERR_TP_MAXTIME EXIT;
The robot is moved to the service position if the forth function key (“Yes”) is
pressed, or if the input 5 is activated. If no answer is given within 10 minutes, the
execution is terminated.
Error handling
If there is a timeout (parameter \MaxTime) before an input from the operator, the sys-
tem variable ERRNO is set to ERR_TP_MAXTIME and the execution continues in the
error handler.
If digital input is set (parameter \DIBreak) before an input from the operator, the sys-
tem variable ERRNO is set to ERR_TP_DIBREAK and the execution continues in the
error handler.
Predefined data
CONST string stEmpty := “”;
The predefined constant stEmpty should be used for Function Keys without prompts.
Using stEmpty instead of “”saves about 80 bytes for every Function Key without
prompts.
Syntax
TPReadFK
[Answer’:=’] <var or pers (INOUT) of num>’,’
[Text’:=’] <expression (IN) of string>’,’
[FK1 ’:=’] <expression (IN) of string>’,’
[FK2 ’:=’] <expression (IN) of string>’,’
[FK3 ’:=’] <expression (IN) of string>’,’
[FK4 ’:=’] <expression (IN) of string>’,’
[FK5 ’:=’] <expression (IN) of string>
[’\’MaxTime ’:=’ <expression (IN) of num>]
[’\’DIBreak ’:=’ <variable (VAR) of signaldi>]
[’\’BreakFlag ’:=’ <var or pers (INOUT) of errnum>]’;’
Related information
Described in:
Writing to and reading from RAPID Summary - Communication
the teach pendant
Replying via the teach pendant Running Production
Example
TPReadNum reg1, “How many units should be produced?“;
The text How many units should be produced? is written on the teach pendant
display. Program execution waits until a number has been input from the numeric
keyboard on the teach pendant. That number is stored in reg1.
Arguments
TPReadNum Answer String [\MaxTime] [\DIBreak]
[\BreakFlag]
Answer Data type: num
The variable for which the number input via the teach pendant is returned.
The digital signal that may interrupt the operator dialog. If no number is input
when the signal is set to 1 (or is already 1), the program continues to execute in
the error handler unless the BreakFlag is used (see below). The constant
ERR_TP_DIBREAK can be used to test whether or not this has occurred.
A variable that will hold the error code if maxtime or dibreak is used. If this
optional variable is omitted, the error handler will be executed.The constants
ERR_TP_MAXTIME and ERR_TP_ DIBREAK can be used to select the
reason.
Program execution
The information text is always written on a new line. If the display is full of text, this
body of text is moved up one line first. Strings longer than the width of the teach
pendant (40 characters) are split into two lines.
Program execution waits until a number is typed on the numeric keyboard (followed by
Enter or OK).
Example
TPReadNum reg1, “How many units should be produced?“;
FOR i FROM 1 TO reg1 DO
produce_part;
ENDFOR
The text How many units should be produced? is written on the teach pendant
display. The routine produce_part is then repeated the number of times that is
input via the teach pendant.
Error handling
If there is a timeout (parameter \MaxTime) before an input from the operator, the system
variable ERRNO is set to ERR_TP_MAXTIME and the execution continues in the
error handler.
If a digital input is set (parameter \DIBreak) before an input from the operator, the sys-
tem variable ERRNO is set to ERR_TP_DIBREAK and the execution continues in the
error handler.
Syntax
TPReadNum
[Answer’:=’] <var or pers (INOUT) of num>’,’
[String’:=’] <expression (IN) of string>
[’\’MaxTime ’:=’ <expression (IN) of num>]
[’\’DIBreak ’:=’ <variable (VAR) of signaldi>]
[’\’BreakFlag ’:=’ <var or pers (INOUT) of errnum>] ’;’
Related information
Described in:
Writing to and reading from RAPID Summary - Communication
the teach pendant
Entering a number on the teach pendant Production Running
Examples of how to use the arguments Instructions - TPReadFK
MaxTime, DIBreak and BreakFlag
Examples
TPShow TP_PROGRAM;
The Production Window will be active if the system is in AUTO mode and the
Program Window will be active if the system is in MAN mode after execution of
this instruction.
TPShow TP_LATEST;
The latest used Teach Pendant Window before the current Teach Pendant
Window will be active after execution of this instruction.
Arguments
TPShow Window
Window Data type: tpnum
Predefined data
CONST tpnum TP_PROGRAM := 1;
CONST tpnum TP_LATEST := 2;
CONST tpnum TP_SCREENVIEWER := 3;
Program execution
The selected Teach Pendant Window will be activated.
Syntax
TPShow
[Window’:=’] <expression (IN) of tpnum> ‘;’
Related information
Described in:
Communicating using RAPID Summary - Communication
the teach pendant
Teach Pendant Window number Data Types - tpnum
Examples
TPWrite "Execution started";
If, for example, the answer to No of produced parts=5, enter 5 instead of reg1 on
the teach pendant.
Arguments
TPWrite String [\Num] | [\Bool] | [\Pos] | [\Orient]
String Data type: string
The data whose numeric value is to be written after the text string.
The data whose logical value is to be written after the text string.
Program execution
Text written on the teach pendant always begins on a new line. When the display is full
of text, this text is moved up one line first. Strings that are longer than the width of the
teach pendant (40 characters) are divided up into two lines.
If one of the arguments \Num, \Bool, \Pos or \Orient is used, its value is first converted
to a text string before it is added to the first string. The conversion from value to text
string takes place as follows:
The value is converted to a string with standard RAPID format. This means in principle
6 significant digits. If the decimal part is less than 0.000005 or greater than 0.999995,
the number is rounded to an integer.
Limitations
The arguments \Num, \Bool, \Pos and \Orient are mutually exclusive and thus cannot
be used simultaneously in the same instruction.
Syntax
TPWrite
[String’:=’] <expression (IN) of string>
[’\’Num’:=’ <expression (IN) of num> ]
| [’\’Bool’:=’ <expression (IN) of bool> ]
| [’\’Pos’:=’ <expression (IN) of pos> ]
| [’\’Orient’:=’ <expression (IN) of orient> ]’;’
Related information
Described in:
Clearing and reading RAPID Summary - Communication
the teach pendant
One or more (max. 6) events can be defined using the instructions TriggIO,
TriggEquip, or TriggInt, and afterwards these definitions are referred to in the
instruction TriggC.
Examples
VAR triggdata gunon;
The digital output signal gun is set when the robot’s TCP passes the midpoint of
the corner path of the point p1.
Circle point p2
Arguments
TriggC [\Conc] CirPoint ToPoint Speed [ \T ] Trigg_1
[ \T2 ] [ \T3 ] [ \T4] [ \T5] [ \T6] Zone [ \Inpos]
Tool [ \WObj ] [ \Corr ]
[ \Conc ] (Concurrent) Data type: switch
RestoPath, movement instructions with the argument \Conc are not permitted.
If this argument is omitted and the ToPoint is not a stop point, the subsequent
instruction is executed some time before the robot has reached the programmed
zone.
The circle point of the robot. See the instruction MoveC for a more detailed
description of circular movement. The circle point is defined as a named position
or stored directly in the instruction (marked with an * in the instruction).
The destination point of the robot and external axes. It is defined as a named
position or stored directly in the instruction (marked with an * in the instruction).
The speed data that applies to movements. Speed data defines the velocity of the
tool centre point, the external axes and of the tool reorientation.
This argument is used to specify the total time in seconds during which the robot
moves. It is then substituted for the corresponding speed data.
Variable that refers to trigger conditions and trigger activity, defined earlier in the
program using the instructions TriggIO, TriggEquip or TriggInt.
Variable that refers to trigger conditions and trigger activity, defined earlier in the
program using the instructions TriggIO, TriggEquip or TriggInt.
Variable that refers to trigger conditions and trigger activity, defined earlier in the
program using the instructions TriggIO, TriggEquip or TriggInt.
Variable that refers to trigger conditions and trigger activity, defined earlier in the
program using the instructions TriggIO, TriggEquip or TriggInt.
Variable that refers to trigger conditions and trigger activity, defined earlier in the
program using the instructions TriggIO, TriggEquip or TriggInt.
Variable that refers to trigger conditions and trigger activity, defined earlier in the
program using the instructions TriggIO, TriggEquip or TriggInt.
Zone data for the movement. Zone data describes the size of the generated corner
path.
This argument is used to specify the convergence criteria for the position of the
robot’s TCP in the stop point. The stop point data substitutes the zone specified
in the Zone parameter.
The tool in use when the robot moves. The tool centre point is the point that is
moved to the specified destination position.
The work object (coordinate system) to which the robot position in the
instruction is related.
This argument can be omitted, and if it is, the position is related to the world
coordinate system. If, on the other hand, a stationary TCP or coordinated
external axes are used, this argument must be specified for a linear movement
relative to the work object to be performed.
Program execution
See the instruction MoveC for information about circular movement.
As the trigger conditions are fulfilled when the robot is positioned closer and closer to
the end point, the defined trigger activities are carried out. The trigger conditions are
fulfilled either at a certain distance before the end point of the instruction, or at a
certain distance after the start point of the instruction, or at a certain point in time
(limited to a short time) before the end point of the instruction.
During stepping execution forwards, the I/O activities are carried out but the interrupt
routines are not run. During stepping execution backwards, no trigger activities at all
are carried out.
Examples
VAR intnum intno1;
VAR triggdata trigg1;
...
CONNECT intno1 WITH trap1;
TriggInt trigg1, 0.1 \Time, intno1;
...
TriggC p1, p2, v500, trigg1, fine, gun1;
TriggC p3, p4, v500, trigg1, fine, gun1;
...
IDelete intno1;
The interrupt routine trap1 is run when the work point is at a position
0.1 s before the point p2 or p4 respectively.
Limitations
If the current start point deviates from the usual, so that the total positioning length of
the instruction TriggC is shorter than usual, it may happen that several or all of the
trigger conditions are fulfilled immediately and at the same position. In such cases, the
sequence in which the trigger activities are carried out will be undefined. The program
logic in the user program may not be based on a normal sequence of trigger activities
for an “incomplete movement”.
The instruction TriggC should never be started from the beginning with the robot in
position after the circle point. Otherwise the robot will not take the programmed path
(positioning around the circular path in another direction compared with that
programmed).
Syntax
TriggC
[’\’ Conc ’,’]
[ CirPoint ’:=’ ] < expression (IN) of robtarget > ’,’
[ ToPoint ’:=’ ] < expression (IN) of robtarget > ’,’
[ Speed ’:=’ ] < expression (IN) of speeddata >
[ ’\’ T ’:=’ < expression (IN) of num > ] ’,’
[Trigg_1 ’:=’ ] < variable (VAR) of triggdata >
[ ’\’ T2 ’:=’ < variable (VAR) of triggdata > ]
[ ’\’ T3 ’:=’ < variable (VAR) of triggdata > ]
[ ’\’ T4 ’:=’ < variable (VAR) of triggdata > ]
[ ’\’ T5 ’:=’ < variable (VAR) of triggdata > ]
[ ’\’ T6 ’:=’ < variable (VAR) of triggdata > ] ‘,’
[Zone ’:=’ ] < expression (IN) of zonedata >
[ ’\’ Inpos ’:=’ < expression (IN) of stoppointdata > ]‘,’
[ Tool ’:=’ ] < persistent (PERS) of tooldata >
[ ’\’ WObj ’:=’ < persistent (PERS) of wobjdata > ]
[ ’\’ Corr ]’;’
Related information
Described in:
Linear movement with triggers Instructions - TriggL
Joint movement with triggers Instructions - TriggJ
Definition of triggers Instructions - TriggIO, TriggEquip
TriggInt
Writes to a corrections entry Instructions - CorrWrite
Circular movement Motion Principles - Positioning during
Program Execution
Definition of velocity Data Types - speeddata
Definition of zone data Data Types - zonedata
Definition of stop point data Data Types - stoppointdata
Definition of tools Data Types - tooldata
Definition of work objects Data Types - wobjdata
Motion in general Motion Principles
The data defined is used for implementation in one or more subsequent TriggL, TriggC
or TriggJ instructions.
Examples
VAR triggdata gunon;
The tool gun1 opens in point p2, when the TCP is 10 mm before the point p1. To
reach this, the digital output signal gun is set to the value 1, when TCP is 0.1 s
before the point p2. The gun is full open when TCP reach point p2.
Start point TriggL p1, v500, gunon, z50, gun1; End point p1
10 mm
Arguments
TriggEquip TriggData Distance [ \Start ] EquipLag
[ \DOp ] | [ \GOp ] | [\AOp ] | [\ProcID ] SetValue [ \Inhib ]
TriggData Data type: triggdata
Variable for storing the triggdata returned from this instruction. These triggdata
are then used in the subsequent TriggL, TriggC or TriggJ instructions.
Defines the position on the path where the I/O equipment event shall occur.
Specified as the distance in mm (positive value) from the end point of the
movement path (applicable if the argument \ Start is not set).
Used when the distance for the argument Distance starts at the movement start
point instead of the end point.
Negative argument value means that the I/O signal is set by the robot system at
specified time after that the TCP physical has passed the specified distance in
relation to the movement start or end point.
Distance Distance
\Start
+ - + -
EquipLag
The name of the signal, when a digital output signal shall be changed.
The name of the signal, when a group of digital output signals shall be changed.
The name of the signal, when a analog output signal shall be changed.
(The identity of the IPM process to receive the event. The selector is specified in
the argument SetValue.)
Desired value of output signal (within the allowed range for the current signal).
The name of a persistent variable flag for inhibit the setting of the signal at
runtime.
If this optional argument is used and the actual value of the specified flag is
TRUE at the position-time for setting of the signal then the specified signal
(DOp, GOp or AOp) will be set to 0 in stead of specified value.
Program execution
When running the instruction TriggEquip, the trigger condition is stored in the
specified variable for the argument TriggData.
Afterwards, when one of the instructions TriggL, TriggC or TriggJ is executed, the
following are applicable, with regard to the definitions in TriggEquip:
The position-time related event will be generated when the start point (end point) is
passed, if the specified distance from the end point (start point) is not within the length
of movement of the current instruction (Trigg...). With use of argument EquipLag with
negative time (delay), the I/O signal can be set after the end point.
Examples
VAR triggdata glueflow;
The analog output signal glue is set to the value 5.3 when the TCP passes a point
located 1 mm after the start point p1 with compensation for equipment lag 0.05 s.
...
TriggL p3, v500, glueflow, z50, tool1;
The analog output signal glue is set once more to the value 5.3 when the TCP
passes a point located 1 mm after the start point p2.
Limitations
I/O events with distance (without the argument \Time) is intended for flying points
(corner path). I/O events with distance, using stop points, results in worse accuracy than
specified below.
Regarding the accuracy for I/O events with distance and using flying points, the
following is applicable when setting a digital output at a specified distance from the
start point or end point in the instruction TriggL or TriggC:
- Accuracy specified below is valid for positive EquipLag parameter < 60 ms,
equivalent to the lag in the robot servo (without changing the system parameter
Event Preset Time).
- Accuracy specified below is valid for positive EquipLag parameter <
configured Event Preset Time (system parameter).
- Accuracy specified below is not valid for positive EquipLag parameter >
configured Event Preset Time (system parameter). In this case, an approximate
method is used in which the dynamic limitations of the robot are not taken into
consideration. SingArea \Wrist must be used in order to achieve an acceptable
accuracy.
- Accuracy specified below is valid for negative EquipLag.
I/O events with time (with the argument \Time) is intended for stop points. I/O events
with time, using flying points, results in worse accuracy than specified below.
I/O events with time can only be specified from the end point of the movement. This
time cannot exceed the current braking time of the robot, which is max. approx. 0.5 s
(typical values at speed 500 mm/s for IRB2400 150 ms and for IRB6400 250 ms). If
the specified time is greater that the current braking time, the event will be generated
anyhow, but not until braking is started (later than specified). However, the whole of
the movement time for the current movement can be utilised during small and fast
movements.
Typical absolute accuracy values for set of digital outputs +/- 5 ms.
Typical repeat accuracy values for set of digital outputs +/- 2 ms.
Syntax
TriggEquip
[ TriggData ’:=’ ] < variable (VAR) of triggdata> ‘,’
[ Distance ’:=’ ] < expression (IN) of num>
[ ’\’ Start ] ‘,’
[ EquipLag ’:=’ ] < expression (IN) of num>
[ ’\’ DOp ’:=’ < variable (VAR) of signaldo> ]
| [ ’\’ GOp ’:=’ < variable (VAR) of signalgo> ]
| [ ’\’ AOp ’:=’ < variable (VAR) of signalao> ]
| [ ’\’ ProcID ’:=’ < expression (IN) of num> ] ‘,’
[ SetValue ’:=’ ] < expression (IN) of num>
[ ’\’ Inhibit ’:=’ < persistent (PERS) of bool> ] ‘,’
Related information
Described in:
Use of triggers Instructions - TriggL, TriggC, TriggJ
Definition of other triggs Instruction - TriggIO, TriggInt
More examples Data Types - triggdata
Set of I/O Instructions - SetDO, SetGO, SetAO
Configuration of Event preset time User‘s guide System Parameters -
Manipulator
The data defined is used for implementation in one or more subsequent TriggL, TriggC
or TriggJ instructions.
Examples
VAR intnum intno1;
VAR triggdata trigg1;
...
CONNECT intno1 WITH trap1;
TriggInt trigg1, 5, intno1;
...
TriggL p1, v500, trigg1, z50, gun1;
TriggL p2, v500, trigg1, z50, gun1;
...
IDelete intno1;
Start point TriggL p1, v500, trigg1, z50, gun1; End point p1 or p2
5 mm
Arguments
TriggInt TriggData Distance [ \Start ] | [ \Time ]
Interrupt
TriggData Data type: triggdata
Variable for storing the triggdata returned from this instruction. These triggdata
are then used in the subsequent TriggL, TriggC or TriggJ instructions.
Defines the position on the path where the interrupt shall be generated.
Specified as the distance in mm (positive value) from the end point of the
movement path (applicable if the argument \ Start or \Time is not set).
Used when the distance for the argument Distance starts at the movement start
point instead of the end point.
Used when the value specified for the argument Distance is in fact a time in
seconds (positive value) instead of a distance.
Position related interrupts in time can only be used for short times (< 0.5 s) before
the robot reaches the end point of the instruction. See the section entitled
Limitations for more details.
Program execution
When running the instruction TriggInt, data is stored in a specified variable for the
argument TriggData and the interrupt that is specified in the variable for the argument
Interrupt is activated.
Afterwards, when one of the instructions TriggL, TriggC or TriggJ is executed, the
following are applicable, with regard to the definitions in TriggInt:
The position related interrupt will be generated when the start point (end point) is
passed, if the specified distance from the end point (start point) is not within the length
of movement of the current instruction (Trigg...).
Examples
This example describes programming of the instructions that interact to generate
position related interrupts:
IDelete intno2;
Limitations
Interrupt events with distance (without the argument \Time) is intended for flying points
(corner path). Interrupt events with distance, using stop points, results in worse
accuracy than specified below.
Interrupt events with time (with the argument \Time) is intended for stop points.
Interrupt events with time, using flying points, results in worse accuracy than specified
below.
I/O events with time can only be specified from the end point of the movement. This
time cannot exceed the current braking time of the robot, which is max. approx. 0.5 s
(typical values at speed 500 mm/s for IRB2400 150 ms and for IRB6400 250 ms). If
the specified time is greater that the current braking time, the event will be generated
anyhow, but not until braking is started (later than specified). However, the whole of
the movement time for the current movement can be utilised during small and fast
movements.
To obtain the best accuracy when setting an output at a fixed position along the robot’s
path, use the instructions TriggIO or TriggEquip in preference to the instructions
TriggInt with SetDO/SetGO/SetAO in an interrupt routine.
Syntax
TriggInt
[ TriggData ’:=’ ] < variable (VAR) of triggdata> ‘,’
[ Distance ’:=’ ] < expression (IN) of num>
[ ’\’ Start ] | [ ’\’ Time ] ’,’
[ Interrupt ’:=’ ] < variable (VAR) of intnum> ’;’
Related information
Described in:
Use of triggers Instructions - TriggL, TriggC, TriggJ
Definition of position fix I/O Instruction - TriggIO, TriggEquip
More examples Data Types - triggdata
Interrupts Basic Characteristics - Interrupts
To obtain a fixed position I/O event, TriggIO compensates for the lag in the control
system (lag between robot and servo) but not for any lag in the external equipment. For
compensation of both lags use TriggEquip.
The data defined is used for implementation in one or more subsequent TriggL, TriggC
or TriggJ instructions.
Examples
VAR triggdata gunon;
The digital output signal gun is set to the value 1 when the TCP is 10 mm before
the point p1.
Start point TriggL p1, v500, gunon, z50, gun1; End point p1
10 mm
Arguments
TriggIO TriggData Distance [ \Start ] | [ \Time ]
[ \DOp ] | [ \GOp ] | [\AOp ] | [\ProcID ] SetValue
[ \DODelay ]
TriggData Data type: triggdata
Variable for storing the triggdata returned from this instruction. These triggdata
are then used in the subsequent TriggL, TriggC or TriggJ instructions.
Defines the position on the path where the I/O event shall occur.
Specified as the distance in mm (positive value) from the end point of the
movement path (applicable if the argument \ Start or \Time is not set).
Used when the distance for the argument Distance starts at the movement start
point instead of the end point.
Used when the value specified for the argument Distance is in fact a time in
seconds (positive value) instead of a distance.
Fixed position I/O in time can only be used for short times (< 0.5 s) before the
robot reaches the end point of the instruction. See the section entitled Limitations
for more details.
The name of the signal, when a digital output signal shall be changed.
The name of the signal, when a group of digital output signals shall be changed.
The name of the signal, when a analog output signal shall be changed.
(The identity of the IPM process to receive the event. The selector is specified in
the argument SetValue.)
Desired value of output signal (within the allowed range for the current signal).
Time delay in seconds (positive value) for a digital output signal or group of
digital output signals.
Only used to delay setting digital output signals, after the robot has reached the
specified position. There will be no delay if the argument is omitted.
Program execution
When running the instruction TriggIO, the trigger condition is stored in a specified
variable for the argument TriggData.
Afterwards, when one of the instructions TriggL, TriggC or TriggJ is executed, the
following are applicable, with regard to the definitions in TriggIO:
The fixed position I/O will be generated when the start point (end point) is passed, if
the specified distance from the end point (start point) is not within the length of
movement of the current instruction (Trigg...).
Examples
VAR triggdata glueflow;
The analog output signal glue is set to the value 5.3 when the work point passes
a point located 1 mm after the start point p1.
...
TriggL p3, v500, glueflow, z50, tool1;
The analog output signal glue is set once more to the value 5.3 when the work
point passes a point located 1 mm after the start point p2.
Limitations
I/O events with distance (without the argument \Time) is intended for flying points
(corner path). I/O events with distance, using stop points, results in worse accuracy than
specified below.
I/O events with time (with the argument \Time) is intended for stop points. I/O events
with time, using flying points, results in worse accuracy than specified below.
I/O events with time can only be specified from the end point of the movement. This
time cannot exceed the current braking time of the robot, which is max. approx. 0.5 s
(typical values at speed 500 mm/s for IRB2400 150 ms and for IRB6400 250 ms). If
the specified time is greater that the current braking time, the event will be generated
anyhow, but not until braking is started (later than specified). However, the whole of
the movement time for the current movement can be utilised during small and fast
movements.
Typical absolute accuracy values for set of digital outputs +/- 5 ms.
Typical repeat accuracy values for set of digital outputs +/- 2 ms.
Syntax
TriggIO
[ TriggData ’:=’ ] < variable (VAR) of triggdata> ‘,’
[ Distance ’:=’ ] < expression (IN) of num>
[ ’\’ Start ] | [ ’\’ Time ]
[ ’\’ DOp ’:=’ < variable (VAR) of signaldo> ]
| [ ’\’ GOp ’:=’ < variable (VAR) of signalgo> ]
| [ ’\’ AOp ’:=’ < variable (VAR) of signalao> ]
| [ ’\’ ProcID ’:=’ < expression (IN) of num> ] ‘,’
[ SetValue ’:=’ ] < expression (IN) of num>
[ ’\’ DODelay ’:=’ < expression (IN) of num> ] ‘;’
Related information
Described in:
Use of triggers Instructions - TriggL, TriggC, TriggJ
Definition of position-time I/O event Instruction - TriggEquip
Definition of position related interrupts Instruction - TriggInt
More examples Data Types - triggdata
Set of I/O Instructions - SetDO, SetGO, SetAO
One or more (max. 6) events can be defined using the instructions TriggIO,
TriggEquip, or TriggInt, and afterwards these definitions are referred to in the instruc-
tion TriggJ.
Examples
VAR triggdata gunon;
The digital output signal gun is set when the robot’s TCP passes the midpoint of
the corner path of the point p1.
Arguments
TriggJ [\Conc] ToPoint Speed [ \T ] Trigg_1 [ \T2 ] [ \T3 ]
[ \T4 ] [ \T5 ] [ \T6 ] Zone [ \Inpos ] Tool [ \WObj ]
[ \Conc ] (Concurrent) Data type: switch
Subsequent logical instructions are executed while the robot is moving. This
argument is used to shorten the cycle time when, for example, communicating
with external equipment, if synchronisation is not required. It can also be used
to tune the execution of the robot path, to avoid warning 50024 Corner path
failure or error 40082 Deceleration limit.
If this argument is omitted, the subsequent instruction is only executed after the
robot has reached the specified stop point or 100 ms before the specified zone.
The destination point of the robot and external axes. It is defined as a named
position or stored directly in the instruction (marked with an * in the instruction).
The speed data that applies to movements. Speed data defines the velocity of the
tool centre point, the external axes and of the tool reorientation.
This argument is used to specify the total time in seconds during which the robot
moves. It is then substituted for the corresponding speed data.
Variable that refers to trigger conditions and trigger activity, defined earlier in the
program using the instructions TriggIO, TriggEquip or TriggInt.
Variable that refers to trigger conditions and trigger activity, defined earlier in the
program using the instructions TriggIO, TriggEquip or TriggInt.
Variable that refers to trigger conditions and trigger activity, defined earlier in the
program using the instructions TriggIO, TriggEquip or TriggInt.
Variable that refers to trigger conditions and trigger activity, defined earlier in the
program using the instructions TriggIO, TriggEquip or TriggInt.
Variable that refers to trigger conditions and trigger activity, defined earlier in the
program using the instructions TriggIO, TriggEquip or TriggInt.
Variable that refers to trigger conditions and trigger activity, defined earlier in the
program using the instructions TriggIO, TriggEquip or TriggInt.
Zone data for the movement. Zone data describes the size of the generated corner
path.
This argument is used to specify the convergence criteria for the position of the
robot’s TCP in the stop point. The stop point data substitutes the zone specified
in the Zone parameter.
The tool in use when the robot moves. The tool centre point is the point that is
moved to the specified destination position.
The work object (coordinate system) to which the robot position in the instruc-
tion is related.
This argument can be omitted, and if it is, the position is related to the world
coordinate system. If, on the other hand, a stationary TCP or coordinated exter-
nal axes are used, this argument must be specified for a linear movement relative
to the work object to be performed.
Program execution
See the instruction MoveJ for information about joint movement.
As the trigger conditions are fulfilled when the robot is positioned closer and closer to
the end point, the defined trigger activities are carried out. The trigger conditions are
fulfilled either at a certain distance before the end point of the instruction, or at a cer-
tain distance after the start point of the instruction, or at a certain point in time (limited
to a short time) before the end point of the instruction.
During stepping execution forwards, the I/O activities are carried out but the interrupt
routines are not run. During stepping execution backwards, no trigger activities at all
are carried out.
Examples
VAR intnum intno1;
VAR triggdata trigg1;
...
CONNECT intno1 WITH trap1;
TriggInt trigg1, 0.1 \Time, intno1;
...
TriggJ p1, v500, trigg1, fine, gun1;
TriggJ p2, v500, trigg1, fine, gun1;
...
IDelete intno1;
The interrupt routine trap1 is run when the work point is at a position
Limitations
If the current start point deviates from the usual, so that the total positioning length of
the instruction TriggJ is shorter than usual (e.g. at the start of TriggJ with the robot posi-
tion at the end point), it may happen that several or all of the trigger conditions are ful-
filled immediately and at the same position. In such cases, the sequence in which the
trigger activities are carried will be undefined. The program logic in the user program
may not be based on a normal sequence of trigger activities for an “incomplete move-
ment”.
Syntax
TriggJ
[’\’ Conc ’,’]
[ ToPoint ’:=’ ] < expression (IN) of robtarget > ’,’
[ Speed ’:=’ ] < expression (IN) of speeddata >
[ ’\’ T ’:=’ < expression (IN) of num > ] ’,’
[Trigg_1 ’:=’ ] < variable (VAR) of triggdata >
[ ’\’ T2 ’:=’ < variable (VAR) of triggdata > ]
[ ’\’ T3 ’:=’ < variable (VAR) of triggdata > ]
[ ’\’ T4 ’:=’ < variable (VAR) of triggdata > ]
[ ’\’ T5 ’:=’ < variable (VAR) of triggdata > ]
[ ’\’ T6 ’:=’ < variable (VAR) of triggdata > ] ‘,’
[Zone ’:=’ ] < expression (IN) of zonedata >
[ ’\’ Inpos ’:=’ < expression (IN) of stoppointdata > ]‘,’
[ Tool ’:=’ ] < persistent (PERS) of tooldata >
[ ’\’ WObj ’:=’ < persistent (PERS) of wobjdata > ] ’;’
Related information
Described in:
Linear movement with triggs Instructions - TriggL
Circular movement with triggers Instructions - TriggC
Definition of triggers Instructions - TriggIO, TriggEquip or
TriggInt
Joint movement Motion Principles - Positioning during
Program Execution
Definition of velocity Data Types - speeddata
Definition of zone data Data Types - zonedata
Definition of stop point data Data Types - stoppointdata
Definition of tools Data Types - tooldata
Definition of work objects Data Types - wobjdata
Motion in general Motion Principles
One or more (max. 6) events can be defined using the instructions TriggIO,
TriggEquip, or TriggInt, and afterwards these definitions are referred to in the
instruction TriggL.
Examples
VAR triggdata gunon;
The digital output signal gun is set when the robot’s TCP passes the midpoint of
the corner path of the point p1.
Start point p1 TriggL p2, v500, gunon, fine, gun1; End point p2
Arguments
TriggL [\Conc] ToPoint Speed [ \T ] Trigg_1 [ \T2 ] [ \T3 ]
[ \T4 ] [ \T5 ] [ \T6 ] Zone [ \Inpos ] Tool [ \WObj ] [ \Corr ]
[ \Conc ] (Concurrent) Data type: switch
If this argument is omitted and the ToPoint is not a stop point, the subsequent
instruction is executed some time before the robot has reached the programmed
zone.
The destination point of the robot and external axes. It is defined as a named
position or stored directly in the instruction (marked with an * in the instruction).
The speed data that applies to movements. Speed data defines the velocity of the
tool centre point, the external axes and of the tool reorientation.
This argument is used to specify the total time in seconds during which the robot
moves. It is then substituted for the corresponding speed data.
Variable that refers to trigger conditions and trigger activity, defined earlier in the
program using the instructions TriggIO, TriggEquip or TriggInt.
Variable that refers to trigger conditions and trigger activity, defined earlier in the
program using the instructions TriggIO, TriggEquip or TriggInt.
Variable that refers to trigger conditions and trigger activity, defined earlier in the
program using the instructions TriggIO, TriggEquip or TriggInt.
Variable that refers to trigger conditions and trigger activity, defined earlier in the
program using the instructions TriggIO, TriggEquip or TriggInt.
Variable that refers to trigger conditions and trigger activity, defined earlier in the
program using the instructions TriggIO, TriggEquip or TriggInt.
Variable that refers to trigger conditions and trigger activity, defined earlier in the
program using the instructions TriggIO, TriggEquip or TriggInt.
Zone data for the movement. Zone data describes the size of the generated corner
path.
This argument is used to specify the convergence criteria for the position of the
robot’s TCP in the stop point. The stop point data substitutes the zone specified
in the Zone parameter.
The tool in use when the robot moves. The tool centre point is the point that is
moved to the specified destination position.
The work object (coordinate system) to which the robot position in the
instruction is related.
This argument can be omitted, and if it is, the position is related to the world
coordinate system. If, on the other hand, a stationary TCP or coordinated
external axes are used, this argument must be specified for a linear movement
relative to the work object to be performed.
Program execution
See the instruction MoveL for information about linear movement.
As the trigger conditions are fulfilled when the robot is positioned closer and closer to
the end point, the defined trigger activities are carried out. The trigger conditions are
fulfilled either at a certain distance before the end point of the instruction, or at a
certain distance after the start point of the instruction, or at a certain point in time
(limited to a short time) before the end point of the instruction.
During stepping execution forwards, the I/O activities are carried out but the interrupt
routines are not run. During stepping execution backwards, no trigger activities at all
are carried out.
Examples
VAR intnum intno1;
VAR triggdata trigg1;
...
CONNECT intno1 WITH trap1;
TriggInt trigg1, 0.1 \Time, intno1;
...
TriggL p1, v500, trigg1, fine, gun1;
TriggL p2, v500, trigg1, fine, gun1;
...
IDelete intno1;
The interrupt routine trap1 is run when the work point is at a position
0.1 s before the point p1 or p2 respectively.
Limitations
If the current start point deviates from the usual, so that the total positioning length of the
instruction TriggL is shorter than usual (e.g. at the start of TriggL with the robot position
at the end point), it may happen that several or all of the trigger conditions are fulfilled
immediately and at the same position. In such cases, the sequence in which the trigger
activities are carried out will be undefined. The program logic in the user program may
not be based on a normal sequence of trigger activities for an “incomplete movement”.
Syntax
TriggL
[’\’ Conc ’,’]
[ ToPoint ’:=’ ] < expression (IN) of robtarget > ’,’
[ Speed ’:=’ ] < expression (IN) of speeddata >
[ ’\’ T ’:=’ < expression (IN) of num > ] ’,’
[Trigg_1 ’:=’ ] < variable (VAR) of triggdata >
[ ’\’ T2 ’:=’ < variable (VAR) of triggdata > ]
[ ’\’ T3 ’:=’ < variable (VAR) of triggdata > ]
[ ’\’ T4 ’:=’ < variable (VAR) of triggdata > ]
[ ’\’ T5 ’:=’ < variable (VAR) of triggdata > ]
[ ’\’ T6 ’:=’ < variable (VAR) of triggdata > ] ‘,’
[Zone ’:=’ ] < expression (IN) of zonedata >
[ ’\’ Inpos ’:=’ < expression (IN) of stoppointdata > ]‘,’
[ Tool ’:=’ ] < persistent (PERS) of tooldata >
[ ’\’ WObj ’:=’ < persistent (PERS) of wobjdata > ]
[ ’\’ Corr ]’;’
Related information
Described in:
Circular movement with triggers Instructions - TriggC
Joint movement with triggers Instructions - TriggJ
Definition of triggers Instructions - TriggIO, TriggEquip or
TriggInt
Writes to a corrections entry Instructions - CorrWrite
Linear movement Motion Principles - Positioning during
Program Execution
Definition of velocity Data Types - speeddata
Definition of zone data Data Types - zonedata
Definition of stop point data Data Types - stoppointdata
Definition of tools Data Types - tooldata
Definition of work objects Data Types - wobjdata
Motion in general Motion Principles
Example
reg2 := reg3/reg4;
.
ERROR
IF ERRNO = ERR_DIVZERO THEN
reg2:=0;
TRYNEXT;
ENDIF
Program execution
Program execution continues with the instruction subsequent to the instruction that
caused the error.
Limitations
The instruction can only exist in a routine’s error handler.
Syntax
TRYNEXT’;’
Related information
Described in:
Error handlers Basic Characteristics-
Error Recovery
Example
TuneReset;
Program execution
The tuning values for all axes are reset to 100%.
The default servo tuning values for all axes are automatically set by executing
instruction TuneReset
- at a cold start-up
- when a new program is loaded
- when starting program execution from the beginning.
Syntax
TuneReset ’;’
Related information
Described in:
Tuning servos Instructions - TuneServo
Incorrect use of the TuneServo can cause oscillating movements or torques that
can damage the robot. You must bear this in mind and be careful when using the
TuneServo.
Avoid doing TuneServo commands at the same time as the robot is moving. It can
result in momentary high CPU loads causing error indication and stops.
Note. To obtain optimal tuning it is essential that the correct load data is used.
Check on this before using TuneServo.
Generally, optimal tuning values often differ between different robots. Optimal tuning
may also change with time.
For robots running at lower speeds, TuneServo can be used to improve the path
accuracy by:
- Tuning tune_kv and tune_ti (see the tune types description below).
- Tuning friction compensation parameters (see below).
- Decreasing path resolution can improve the path. Note: a value of path
resolution which is too low will cause CPU load problems.
- The accuracy of straight lines can be improved by decreasing acceleration using
AccSet. Example: AccSet 20, 10.
Description
Tune_df
There is always an optimum tuning value that can vary depending on position and
movement length. This optimum value can be found by changing the tuning in small
steps (1 - 2%) on the axes that are involved in this unwanted behavior. Normally the
optimal tuning will be found in the range 70% - 130%. Too low or too high tuning
values have a negative effect and will impair movements considerably.
When the tuning value at the start point of a long movement differs considerably from
the tuning value at the end point, it can be advantageous in some cases to use an
intermediate point with a corner zone to define where the tuning value will change.
IRB 6400, in a press service application (extended and flexible load), axes 4 - 6:
Reduce the tuning value for the current wrist axis until the movement is acceptable. A
change in the movement will not be noticeable until the optimum value is approached.
A low value will impair the movement considerably. Typical tuning value 25%.
IRB 6400, upper parts of working area. Axis 1 can often be optimised with a tuning
value of 85% - 95%.
IRB 6400, short movement (< 80 mm). Axis 1 can often be optimised with a tuning
value of 94% - 98%.
IRB 2400, with track motion. In some cases axes 2 - 3 can be optimised with a tuning
value of 110% - 130%. The movement along the track can require a different tuning
value compared with movement at right angles to the track.
Tune_dg
Tune_dg can reduce overshoots on rare occasions. Normally it should not be used.
Tuning of tune_dg can be performed with large steps in tune value (e.g. 50%, 100%,
200%, 400%).
Tune_dh
Tune_dh can be used for reducing vibrations and overshoots (e.g. large flexible load).
Tune value must always be lower than 100. Tune_dh increases path deviation and
normally also increases cycle time.
Example:
IRB6400 with large flexible load which vibrates when the robot has stopped. Use
tune_dh with tune value 15.
Tune_dh should only be executed for one axis. All axes in the same mechanical
unit automatically get the same tune_value.
Tune_di
A higher tune value than 100 can reduce overshoot (but increases path deviation at high
speed).
Tune_di should only be executed for one axis. All axes in the same mechanical unit
automatically get the same tune_value.
Tune_dk, Tune_dl
Only for ABB internal use. Do not use these tune types. Incorrect use can cause
oscillating movements or torques that can damage the robot.
These tune types affect position control gain (kp), speed control gain (kv) and speed
control integration time (ti) for external axes. These are used for adapting external axes
to different load inertias. Basic tuning of external axes can also be simplified by using
these tune types.
For robot axes, these tune types have another significance and can be used for reducing
path errors at low speeds (< 500 mm/s).
Recommended values: tune_kv 100 - 180%, tune_ti 50 - 100%. Tune_kp should not be
used for robot axes. Values of tune_kv/tune_ti which are too high or too low will cause
vibrations or oscillations. Be careful if trying to exceed these recommended values.
Make changes in small steps and avoid oscillating motors.
Always tune one axis at a time. Change the tuning values in small steps. Try to
improve the path where this specific axis changes its direction of movement or where
it accelerates or decelerates.
Never use these tune types at high speeds or when the required path accuracy is fulfilled.
These tune types can be used to reduce robot path errors caused by friction and backlash
at low speeds (10 - 200 mm/s). These path errors appear when a robot axis changes
direction of movement. Activate friction compensation for an axis by setting the system
parameter Friction ffw on to TRUE (topic: Manipulator, type: Control parameters).
The friction model is a constant level with opposite sign of the axis speed direction.
Friction ffw level (Nm) is the absolute friction level at (low) speeds and is greater than
Friction ffw ramp (rad/s) (see figure).
Tune_fric_lev overrides the value of the system parameter Friction ffw level.
Tuning Friction ffw level (using tune_fric_lev) for each robot axis can improve the
robots path accuracy considerably in the speed range 20 - 100 mm/s. For larger robots
(especially the IRB6400 family) the effect will however be minimal as other sources of
tracking errors dominate these robots.
Tune_fric_ramp overrides the value of the system parameter Friction ffw ramp. In most
cases there is no need to tune the Friction ffw ramp. The default setting will be
appropriate.
Tune one axis at a time. Change the tuning value in small steps and find the level that
minimises the robot path error at positions on the path where this specific axis changes
direction of movement. Repeat the same procedure for the next axis etc.
The final tuning values can be transferred to the system parameters. Example:
Set Friction ffw level = 1.5 and tune value = 100% (default value) which is
equivalent.
Arguments
TuneServo MecUnit Axis TuneValue [\Type]
MecUnit (Mechanical Unit) Data type: mecunit
The number of the current axis for the mechanical unit (1 - 6).
Example
TuneServo MHA160R1, 1, 110 \Type:= TUNE_KP;
Activating of tuning type TUNE_KP with the tuning value 110% on axis 1 in the
mechanical unit MHA160R1.
Program execution
The specified tuning type and tuning value are activated for the specified axis. This
value is applicable for all movements until a new value is programmed for the current
axis, or until the tuning types and values for all axes are reset using the instruction
TuneReset.
The default servo tuning values for all axes are automatically set by executing
instruction TuneReset
- at a cold start-up
- when a new program is loaded
- when starting program execution from the beginning.
Limitations
Any active servo tuning are always set to default values at power fail.
This limitation can be handled in the user program at restart after power failure.
Syntax
TuneServo
[MecUnit ’:=’ ] < variable (VAR) of mecunit> ’,’
[Axis ’:=’ ] < expression (IN) of num> ’,’
[TuneValue ’:=’ ] < expression (IN) of num>
[’\’ Type ’:=’ <expression (IN) of tunetype>]’;’
Related information
Described in:
Other motion settings Summary Rapid - Motion Settings
Types of servo tuning Data Types - tunetype
Reset of all servo tunings Instructions - TuneReset
Tuning of external axes System parameters - Manipulator
Friction compensation System parameters - Manipulator
The program module must previously have been loaded into the program memory
using the instruction Load or StartLoad - WaitLoad.
Example
UnLoad diskhome \File:="PART_A.MOD";
UnLoad the program module PART_A.MOD from the program memory, that pre-
viously was loaded into the program memory with Load. (See instructions
Load). diskhome is a predefined string constant "HOME:".
Arguments
UnLoad [\Save] FilePath [\File]
[\Save] Data type: switch
If this argument is used, the program module is saved before the unloading starts.
The program module will be saved at the original place specified in the Load or
StartLoad instruction.
The file path and the file name to the file that will be unloaded from the program
memory. The file path and the file name must be the same as in the previously
executed Load or StartLoad instruction. The file name shall be excluded when
the argument \File is used.
When the file name is excluded in the argument FilePath, then it must be defined
with this argument. The file name must be the same as in the previously executed
Load or StartLoad instruction.
Program execution
To be able to execute an UnLoad instruction in the program, a Load or StartLoad -
WaitLoad instruction with the same file path and name must have been executed earlier
in the program.
The program execution waits for the program module to finish unloading before the
execution proceeds with the next instruction.
After that the program module is unloaded and the rest of the program modules will be
linked.
Examples
UnLoad "HOME:/DOORDIR/DOOR1.MOD";
UnLoad the program module DOOR1.MOD from the program memory, that pre-
viously was loaded into the program memory with Load. (See instructions
Load).
Limitations
It is not allowed to unload a program module that is executing.
TRAP routines, system I/O events and other program tasks cannot execute during the
unloading.
Program stop during execution of UnLoad instruction results in guard stop with motors
off and error message "20025 Stop order timeout" on the Teach Pendant.
Error handling
If the file in the UnLoad instruction cannot be unloaded because of ongoing execution
within the module or wrong path (module not loaded with Load or StartLoad), the sys-
tem variable ERRNO is set to ERR_UNLOAD. This error can then be handled in the
error handler.
Syntax
UnLoad
[’\’Save ’,’]
[FilePath’:=’]<expression (IN) of string>
[’\’File’:=’ <expression (IN) of string>]’;’
Related information
Described in:
Load a program module Instructions - Load
Instructions - StartLoad-WaitLoad
Accept unresolved references System Parameters - Controller
System Parameters - Tasks
System Parameters - BindRef
Example
WaitDI di4, 1;
Program execution continues only after the di4 input has been set.
WaitDI grip_status, 0;
Program execution continues only after the grip_status input has been reset.
Arguments
WaitDI Signal Value [\MaxTime] [\TimeFlag]
Signal Data type: signaldi
The output parameter that contains the value TRUE if the maximum permitted
waiting time runs out before the condition is met. If this parameter is included in
the instruction, it is not considered to be an error if the max. time runs out.
This argument is ignored if the MaxTime argument is not included in the instruc-
tion.
Program Running
If the value of the signal is correct, when the instruction is executed, the program sim-
ply continues with the following instruction.
If the signal value is not correct, the robot enters a waiting state and when the signal
changes to the correct value, the program continues. The change is detected with an
interrupt, which gives a fast response (not polled).
When the robot is waiting, the time is supervised, and if it exceeds the max time value,
the program will continue if a Time Flag is specified, or raise an error if it’s not. If a
Time Flag is specified, this will be set to true if the time is exceeded, otherwise it will
be set to false.
Syntax
WaitDI
[ Signal ’:=’ ] < variable (VAR) of signaldi > ’,’
[ Value ’:=’ ] < expression (IN) of dionum >
[’\’MaxTime ’:=’<expression (IN) of num>]
[’\’TimeFlag’:=’<variable (VAR) of bool>] ’;’
Related information
Described in:
Waiting until a condition is satisfied Instructions - WaitUntil
Waiting for a specified period of time Instructions - WaitTime
Example
WaitDO do4, 1;
Program execution continues only after the do4 output has been set.
WaitDO grip_status, 0;
Program execution continues only after the grip_status output has been reset.
Arguments
WaitDO Signal Value [\MaxTime] [\TimeFlag]
Signal Data type: signaldo
The output parameter that contains the value TRUE if the maximum permitted
waiting time runs out before the condition is met. If this parameter is included in
the instruction, it is not considered to be an error if the max. time runs out.
This argument is ignored if the MaxTime argument is not included in the instruc-
tion.
Program Running
If the value of the signal is correct, when the instruction is executed, the program sim-
ply continues with the following instruction.
If the signal value is not correct, the robot enters a waiting state and when the signal
changes to the correct value, the program continues. The change is detected with an
interrupt, which gives a fast response (not polled).
When the robot is waiting, the time is supervised, and if it exceeds the max time value,
the program will continue if a Time Flag is specified, or raise an error if its not. If a
Time Flag is specified, this will be set to true if the time is exceeded, otherwise it will
be set to false.
Syntax
WaitDO
[ Signal ’:=’ ] < variable (VAR) of signaldo > ’,’
[ Value ’:=’ ] < expression (IN) of dionum >
[’\’MaxTime ’:=’<expression (IN) of num>]
[’\’TimeFlag’:=’<variable (VAR) of bool>] ’;’
Related information
Described in:
Waiting until a condition is satisfied Instructions - WaitUntil
Waiting for a specified period of time Instructions - WaitTime
The loaded module must be connected to the program task with the instruction Wait-
Load before any of its symbols/routines can be used.
The loaded program module will be added to the modules already existing in the pro-
gram memory.
This instruction can also be combined with the function to unload some other program
module, in order to minimise the number of links (1 instead of 2).
Example
VAR loadsession load1;
...
StartLoad "HOME:/PART_A.MOD", load1;
MoveL p10, v1000, z50, tool1 \WObj:=wobj1;
MoveL p20, v1000, z50, tool1 \WObj:=wobj1;
MoveL p30, v1000, z50, tool1 \WObj:=wobj1;
MoveL p40, v1000, z50, tool1 \WObj:=wobj1;
WaitLoad load1;
%"routine_x"%;
UnLoad "HOME:/PART_A.MOD";
Load the program module PART_A.MOD from HOME: into the program mem-
ory. In parallel, move the robot. Then connect the new program module to the
program task and call the routine routine_x in the module PART_A.
Arguments
WaitLoad [\UnloadPath] [\UnloadFile] LoadNo
[\UnloadPath] Data type: string
The file path and the file name to the file that will be unloaded from the program
memory. The file name should be excluded when the argument \UnloadFile is
used.
When the file name is excluded in the argument \UnloadPath, then it must be
defined with this argument.
Program execution
The instruction WaitLoad will first wait for the loading to be completed, if it is not
already done, and then it will be linked and initialised. The initialisation of the loaded
module sets all variables at module level to their init values.
Unsolved references will be accepted, if the system parameter for Tasks/BindRef is set
to NO. However, when the program is started or the teach pendant function Program
Window/File/Check Program is used, no check for unsolved references will be done if
BindRef = NO. There will be a run time error on execution of an unsolved reference.
Another way to use references to instructions, that are not in the task from the begin-
ning, is to use Late Binding. This makes it possible to specify the routine to call with a
string expression, quoted between two %%. In this case the BindRef parameter could
be set to YES (default behaviour). The Late Binding way is preferable.
To obtain a good program structure, that is easy to understand and maintain, all loading
and unloading of program modules should be done from the main module, which is
always present in the program memory during execution.
Examples
StartLoad "HOME:/DOORDIR/DOOR2.MOD", load1;
...
WaitLoad \UnloadPath:="HOME:/DOORDIR/DOOR1.MOD", load1;
Is the same as the instructions below but the robot can do some other work during
the loading time and also do it faster (only one link).
Error handling
If the file specified in the StartLoad instruction cannot be found, the system variable
ERRNO is set to ERR_FILNOTFND at execution of WaitLoad.
If argument LoadNo refers to an unknown load session, the system variable ERRNO
is set to ERR_UNKPROC.
If the module is already loaded into the program memory, the system variable ERRNO
is set to ERR_LOADED.
The following errors can only occur when the argument \UnloadPath is used in the
instruction WaitLoad:
Syntax
WaitLoad
[ [ ’\’ UnloadPath ’:=’ <expression (IN) of string> ]
[ ’\’ UnloadFile ’:=’ <expression (IN) of string> ] ’,’ ]
[ LoadNo ’:=’ ] <variable (VAR) of loadsession> ’;’
Related information
Load a program module during execution Instructions - StartLoad
Load session Data Types - loadsession
Load a program module Instructions - Load
Unload a program module Instructions - UnLoad
Accept unsolved references System Parameters - Controller/Task/
BindRef
Example
WaitTime 0.5;
Arguments
WaitTime [\InPos] Time
[\InPos] Data type: switch
If this argument is used, the robot and external axes must have come to a
standstill before the waiting time starts to be counted.
Program execution
Program execution temporarily stops for the given amount of time. Interrupt handling
and other similar functions, nevertheless, are still active.
Example
WaitTime \InPos,0;
Program execution waits until the robot and the external axes have come to a
standstill.
Limitations
If the argument \Inpos is used, the movement instruction which precedes this
instruction should be terminated with a stop point, in order to be able to restart in this
instruction following a power failure.
Syntax
WaitTime
[’\’InPos’,’]
[Time ’:=’] <expression (IN) of num>’;’
Related information
Described in:
Waiting until a condition is met Instructions - WaitUntil
Waiting until an I/O is set/reset Instruction - WaitDI
Example
WaitUntil di4 = 1;
Program execution continues only after the di4 input has been set.
Arguments
WaitUntil [\InPos] Cond [\MaxTime] [\TimeFlag]
[\InPos] Data type: switch
If this argument is used, the robot and external axes must have stopped moving
before the condition starts being evaluated.
The output parameter that contains the value TRUE if the maximum permitted
waiting time runs out before the condition is met. If this parameter is included in
the instruction, it is not considered to be an error if the max. time runs out. This
argument is ignored if the MaxTime argument is not included in the instruction.
Program execution
If the programmed condition is not met on execution of a WaitUntil instruction, the
condition is checked again every 100 ms.
When the robot is waiting, the time is supervised, and if it exceeds the max time value,
the program will continue if a TimeFlag is specified, or raise an error if it’s not. If a
TimeFlag is specified, this will be set to TRUE if the time is exceeded, otherwise it will
be set to false.
Examples
VAR bool timeout;
WaitUntil start_input = 1 AND grip_status = 1\MaxTime := 60
\TimeFlag := timeout;
IF timeout THEN
TPWrite "No start order received within expected time";
ELSE
start_next_cycle;
ENDIF
If the two input conditions are not met within 60 seconds, an error message will
be written on the display of the teach pendant.
Program execution waits until the robot has come to a standstill and the di4 input
has been set.
Limitation
If the argument \Inpos is used, the movement instruction which precedes this instruc-
tion should be terminated with a stop point, in order to be able to restart in this instruc-
tion following a power failure.
Syntax
WaitUntil
[’\’InPos’,’]
[Cond ’:=’] <expression (IN) of bool>
[’\’MaxTime ’:=’<expression (IN) of num>]
[’\’TimeFlag’:=’<variable (VAR) of bool>] ’;’
Related information
Described in:
Waiting until an input is set/reset Instructions - WaitDI
Waiting a given amount of time Instructions - WaitTime
Expressions Basic Characteristics - Expressions
Example
VelSet 50, 800;
All the programmed velocities are decreased to 50% of the value in the instruc-
tion. The TCP velocity is not, however, permitted to exceed 800 mm/s.
Arguments
VelSet Override Max
Override Data type: num
Program execution
The programmed velocity of all subsequent positioning instructions is affected until a
new VelSet instruction is executed.
- All velocity components (TCP, orientation, rotating and linear external axes) in
speeddata.
- The programmed velocity override in the positioning instruction (the
argument \V).
- Timed movements.
The default values for Override and Max are 100% and 5000 mm/s respectively. These
values are automatically set
- at a cold start-up
- when a new program is loaded
- when starting program executing from the beginning.
Example
VelSet 50, 800;
MoveL p1, v1000, z10, tool1;
MoveL p2, v2000, z10, tool1;
MoveL p3, v1000\T:=5, z10, tool1;
The speed is 500 mm/s to point p1 and 800 mm/s to p2. It takes 10 seconds to
move from p2 to p3.
Limitations
The maximum speed is not taken into consideration when the time is specified in the
positioning instruction.
Syntax
VelSet
[ Override ’:=’ ] < expression (IN) of num > ’,’
[ Max ’:=’ ] < expression (IN) of num > ’;’
Related information
Described in:
Definition of velocity Data Types - speeddata
Positioning instructions RAPID Summary - Motion
Example
WHILE reg1 < reg2 DO
...
reg1 := reg1 +1;
ENDWHILE
Repeats the instructions in the WHILE loop as long as reg1 < reg2.
Arguments
WHILE Condition DO ... ENDWHILE
Condition Data type: bool
The condition that must be met for the instructions in the WHILE loop to be exe-
cuted.
Program execution
7. The condition is calculated. If the condition is not met, the WHILE loop terminates
and program execution continues with the instruction following ENDWHILE.
8. The instructions in the WHILE loop are executed.
9. The WHILE loop is repeated, starting from point 1.
Syntax
(EBNF)
WHILE <conditional expression> DO
<instruction list>
ENDWHILE
Related information
Described in:
Expressions Basic Characteristics - Expressions
Examples
Write logfile, "Execution started";
The text Execution started is written to the file with reference name logfile.
The text No of produced parts=5, for example, is written to the file with the
reference name logfile (assuming that the contents of reg1 is 5).
Arguments
Write IODevice String [\Num] | [\Bool] | [\Pos] | [\Orient]
[\NoNewLine]
IODevice Data type: iodev
The data whose numeric values are to be written after the text string.
The data whose logical values are to be written after the text string.
Omits the line-feed character that normally indicates the end of the text.
Program execution
The text string is written to a specified file or serial channel. If the argument
\NoNewLine is not used, a line-feed character (LF) is also written.
If one of the arguments \Num, \Bool, \Pos or \Orient is used, its value is first converted
to a text string before being added to the first string. The conversion from value to text
string takes place as follows:
The value is converted to a string with standard RAPID format. This means in principle
6 significant digits. If the decimal part is less than 0.000005 or greater than 0.999995,
the number is rounded to an integer.
Example
VAR iodev printer;
.
Open "sio1:", printer\Write;
WHILE DInput(stopprod)=0 DO
produce_part;
Write printer, "Produced part="\Num:=reg1\NoNewLine;
Write printer, " "\NoNewLine;
Write printer, CTime();
ENDWHILE
Close printer;
A line, including the number of the produced part and the time, is output to a
printer each cycle. The printer is connected to serial channel sio1:. The printed
message could look like this:
Limitations
The arguments \Num, \Bool, \Pos and \Orient are mutually exclusive and thus cannot
be used simultaneously in the same instruction.
This instruction can only be used for files or serial channels that have been opened for
writing.
Error handling
If an error occurs during writing, the system variable ERRNO is set to
ERR_FILEACC. This error can then be handled in the error handler.
Syntax
Write
[IODevice’:=’] <variable (VAR) of iodev>’,’
[String’:=’] <expression (IN) of string>
[’\’Num’:=’ <expression (IN) of num> ]
| [’\’Bool’:=’ <expression (IN) of bool> ]
| [’\’Pos’:=’ <expression (IN) of pos> ]
| [’\’Orient’:=’ <expression (IN) of orient> ]
[’\’NoNewLine]’;’
Related information
Described in:
Opening a file or serial channel RAPID Summary - Communication
Example
VAR iodev channel2;
VAR orient quat1 := [1, 0, 0, 0];
...
Open "sio1:", channel2 \Bin;
WriteAnyBin channel2, quat1;
Arguments
WriteAnyBin IODevice Data
IODevice Data type: iodev
Program execution
As many bytes as required for the specified data are written to the specified binary
serial channel or file.
Limitations
This instruction can only be used for serial channels or files that have been opened for
binary writing.
The data to be written by this instruction must have a value data type of atomic, string,
or record data type. Semi-value and non-value data types cannot be used.
Error handling
If an error occurs during writing, the system variable ERRNO is set to ERR_FILEACC.
This error can then be handled in the error handler.
Example
VAR iodev channel;
VAR num input;
VAR robtarget cur_robt;
Close channel;
Syntax
WriteAnyBin
[IODevice’:=’] <variable (VAR) of iodev>’,’
[Data’:=’] <var or pers (INOUT) of ANYTYPE>’;’
Related information
Described in:
Opening (etc.) of serial channels RAPID Summary - Communication
or files
Read data from a binary serial channel Functions - ReadAnyBin
or file
Example
WriteBin channel2, text_buffer, 10;
10 characters from the text_buffer list are written to the channel referred to by
channel2.
Arguments
WriteBin IODevice Buffer NChar
IODevice Data type: iodev
Program execution
The specified number of numbers (characters) in the list is written to the serial channel.
Limitations
This instruction can only be used for serial channels that have been opened for binary
reading and writing.
Error handling
If an error occurs during writing, the system variable ERRNO is set to
ERR_FILEACC. This error can then be handled in the error handler.
Example
VAR iodev channel;
VAR num out_buffer{20};
VAR num input;
VAR num nchar;
Open "sio1:", channel\Bin;
out_buffer{1} := 5; ( enq )
WriteBin channel, out_buffer, 1;
input := ReadBin (channel \Time:= 0.1);
The text string Hello world (with associated control characters) is written to a
serial channel. The function StrToByte is used in the same cases to convert a
string into a byte (num) data.
Syntax
WriteBin
[IODevice’:=’] <variable (VAR) of iodev>’,’
[Buffer’:=’] <array {*} (IN) of num>’,’
[NChar’:=’] <expression (IN) of num>’;’
Related information
Described in:
Opening (etc.) of serial channels RAPID Summary - Communication
Convert a string to a byte data Functions - StrToByte
Byte data Data Types - byte
Example
WriteStrBin channel2, "Hello World\0A";
Arguments
WriteStrBin IODevice Str
IODevice Data type: iodev
Program execution
The text string is written to the specified serial channel or file.
Limitations
This instruction can only be used for serial channels or files that have been opened for
binary reading and writing.
Error handling
If an error occurs during writing, the system variable ERRNO is set to
ERR_FILEACC. This error can then be handled in the error handler.
Example
VAR iodev channel;
VAR num input;
Open "sio1:", channel\Bin;
Close channel;
The text string Hello world (with associated control characters in hexadecimal)
is written to a binary serial channel.
Syntax
WriteStrBin
[IODevice’:=’] <variable (VAR) of iodev>’,’
[Str’:=’] <expression (IN) of string>’;’
Related information
Described in:
Opening (etc.) of serial channels RAPID Summary - Communication
Example
.
corner2
Z
Y Box
corner1
X Min. 10 mm
World Coordinate System
Define a straight box with coordinates parallel to the axes of the world coordinate
system and defined by the opposite corners corner1 and corner2.
Arguments
WZBoxDef [\Inside] | [\Outside] Shape LowPoint HighPoint
\Inside Data type: switch
Variable for storage of the defined volume (private data for the system).
Program execution
The definition of the box is stored in the variable of type shapedata (argument Shape),
for future use in WZLimSup or WZDOSet instructions.
Limitations
The LowPoint and HighPoint positions must be valid for opposite corners (with
different x, y and z coordinate values).
If the robot is used to point out the LowPoint or HighPoint, work object wobj0 must be
active (use of component trans in robtarget e.g. p1.trans as argument).
Syntax
WZBoxDef
[’\’Inside] | [’\’Outside] ’,’
[Shape’:=’]<variable (VAR) of shapedata>’,’
[LowPoint’:=’]<expression (IN) of pos>’,’
[HighPoint’:=’]<expression (IN) of pos>’;’
Related information
Described in:
World Zones Motion and I/O Principles -
World Zones
World zone shape Data Types - shapedata
Define sphere-shaped world zone Instructions - WZSphDef
Define cylinder-shaped world zone Instructions - WZCylDef
Activate world zone limit supervision Instructions - WZLimSup
Activate world zone digital output set Instructions - WZDOSet
Example
R2 (min. 5 mm)
H2 (min. 10 mm)
Z
Y
C2
Define a cylinder with the centre of the bottom circle in C2, radius R2 and height
H2.
Arguments
WZCylDef [\Inside] | [\Outside] Shape CentrePoint Radius Height
\Inside Data type: switch
Variable for storage of the defined volume (private data for the system).
Position (x,y,z) in mm defining the centre of one circular end of the cylinder.
Program execution
The definition of the cylinder is stored in the variable of type shapedata (argument
Shape), for future use in WZLimSup or WZDOSet instructions.
Limitations
If the robot is used to point out the CentrePoint, work object wobj0 must be active (use
of component trans in robtarget e.g. p1.trans as argument).
Syntax
WZCylDef
[’\’Inside] | [’\’Outside]’,’
[Shape’:=’]<variable (VAR) of shapedata>’,’
[CentrePoint’:=’]<expression (IN) of pos>’,’
[Radius’:=’]<expression (IN) of num>’,’
[Height’:=’]<expression (IN) of num>’;’
Related information
Described in:
World Zones Motion and I/O Principles -
World Zones
World zone shape Data Types - shapedata
Define box-shaped world zone Instructions - WZBoxDef
Define sphere-shaped world zone Instructions - WZSphDef
Activate world zone limit supervision Instructions - WZLimSup
Activate world zone digital output set Instructions - WZDOSet
Example
VAR wztemporary wzone;
...
PROC ...
WZLimSup \Temp, wzone, volume;
MoveL p_pick, v500, z40, tool1;
WZDisable wzone;
MoveL p_place, v200, z30, tool1;
ENDPROC
When moving to p_pick, the position of the robot’s TCP is checked so that it will
not go inside the specified volume wzone. This supervision is not performed
when going to p_place.
Arguments
WZDisable WorldZone
WorldZone Data type: wztemporary
Program execution
The temporary world zone is deactivated. This means that the supervision of the
robot’s TCP, relative to the corresponding volume, is temporarily stopped. It can be re-
activated via the WZEnable instruction.
Limitations
Only a temporary world zone can be deactivated. A stationary world zone is always
active.
Syntax
WZDisable
[WorldZone’:=’]<variable or persistent (INOUT) of wztemporary>’;’
Related information
Described in:
World Zones Motion and I/O Principles -
World Zones
World zone shape Data Types - shapedata
Temporary world zone data Data Types - wztemporary
Activate world zone limit supervision Instructions - WZLimSup
Activate world zone set digital output Instructions - WZDOSet
Activate world zone Instructions - WZEnable
Erase world zone Instructions - WZFree
After this instruction is executed, when the robot’s TCP is inside the defined world
zone or is approaching close to it, a digital output signal is set to the specified value.
Example
VAR wztemporary service;
PROC zone_output()
VAR shapedata volume;
CONST pos p_service:=[500,500,700];
...
WZSphDef \Inside, volume, p_service, 50;
WZDOSet \Temp, service \Inside, volume, do_service, 1;
ENDPROC
Definition of temporary world zone service in the application program, that sets
the signal do_service, when the robot’s TCP is inside the defined sphere during
program execution or when jogging.
Arguments
WZDOSet [\Temp] | [\Stat] WorldZone [\Inside] | [\Before] Shape
Signal SetValue
\Temp (Temporary) Data type: switch
Variable or persistent variable, that will be updated with the identity (numeric
value) of the world zone.
The digital output signal will be set when the robot’s TCP is inside the defined
volume.
The digital output signal will be set before the robot’s TCP reaches the defined
volume (as soon as possible before the volume).
If a stationary worldzone is used, the signal must be write protected for access
from the user (RAPID, TP). Set Access = System for the signal in System
Parameters.
Desired value of the signal (0 or 1) when the robot’s TCP is inside the volume or
just before it enters the volume.
When outside or just outside the volume, the signal is set to the opposite value.
Program execution
The defined world zone is activated. From this moment, the robot’s TCP position is
supervised and the output will be set, when the robot’s TCP position is inside the
volume (\Inside) or comes close to the border of the volume (\Before).
Example
VAR wztemporary home;
VAR wztemporary service;
PERS wztemporary equip1:=[0];
PROC main()
...
! Definition of all temporary world zones
zone_output;
...
! equip1 in robot work area
WZEnable equip1;
...
! equip1 out of robot work area
WZDisable equip1;
...
! No use for equip1 any more
WZFree equip1;
...
ENDPROC
PROC zone_output()
VAR shapedata volume;
CONST pos p_home:=[800,0,800];
CONST pos p_service:=[800,800,800];
CONST pos p_equip1:=[-800,-800,0];
...
WZSphDef \Inside, volume, p_home, 50;
WZDOSet \Temp, home \Inside, volume, do_home, 1;
WZSphDef \Inside, volume, p_service, 50;
WZDOSet \Temp, service \Inside, volume, do_service, 1;
WZCylDef \Inside, volume, p_equip1, 300, 1000;
WZLimSup \Temp, equip1, volume;
! equip1 not in robot work area
WZDisable equip1;
ENDPROC
Also, definition of a temporary world zone equip1, which is active only in the
part of the robot program when equip1 is inside the working area for the robot.
At that time the robot stops before entering the equip1 volume, both during
program execution and manual jogging. equip1 can be disabled or enabled from
other program tasks by using the persistent variable equip1 value.
Limitations
A world zone cannot be redefined by using the same variable in the argument
WorldZone.
A stationary world zone cannot be deactivated, activated again or erased in the RAPID
program.
Syntax
WZDOSet
(’\’Temp) | (’\’Stat) ’,’
[WorldZone’:=’]<variable or persistent (INOUT) of wztemporary>
(’\’Inside) | (’\’Before) ’,’
[Shape’:=’]<variable (VAR) of shapedata>’,’
[Signal’:=’]<variable (VAR) of signaldo>’,’
[SetValue’:=’]<expression (IN) of dionum>’;’
Related information
Described in:
World Zones Motion and I/O Principles -
World Zones
World zone shape Data Types - shapedata
Temporary world zone Data Types - wztemporary
Stationary world zone Data Types - wzstationary
Define straight box-shaped world zone Instructions - WZBoxDef
Define sphere-shaped world zone Instructions - WZSphDef
Define cylinder-shaped world zone Instructions - WZCylDef
Activate world zone limit supervision Instructions - WZLimSup
Signal access mode User’s Guide - System Parameters
I/O Signals
Example
VAR wztemporary wzone;
...
PROC ...
WZLimSup \Temp, wzone, volume;
MoveL p_pick, v500, z40, tool1;
WZDisable wzone;
MoveL p_place, v200, z30, tool1;
WZEnable wzone;
MoveL p_home, v200, z30, tool1;
ENDPROC
When moving to p_pick, the position of the robot’s TCP is checked so that it will
not go inside the specified volume wzone. This supervision is not performed
when going to p_place, but is reactivated before going to p_home
Arguments
WZEnable WorldZone
WorldZone Data type: wztemporary
Program execution
The temporary world zone is re-activated.
Please note that a world zone is automatically activated when it is created. It need only
be re-activated when it has previously been deactivated by WZDisable.
Limitations
Only a temporary world zone can be deactivated and reactivated. A stationary world
zone is always active.
Syntax
WZEnable
[WorldZone’:=’]<variable or persistent (INOUT) of wztemporary>’;’
Related information
Described in:
World Zones Motion and I/O Principles -
World Zones
World zone shape Data Types - shapedata
Temporary world zone data Data Types - wztemporary
Activate world zone limit supervision Instructions - WZLimSup
Activate world zone set digital output Instructions - WZDOSet
Deactivate world zone Instructions - WZDisable
Erase world zone Instructions - WZFree
Example
VAR wztemporary wzone;
...
PROC ...
WZLimSup \Temp, wzone, volume;
MoveL p_pick, v500, z40, tool1;
WZDisable wzone;
MoveL p_place, v200, z30, tool1;
WZEnable wzone;
MoveL p_home, v200, z30, tool1;
WZFree wzone;
ENDPROC
When moving to p_pick, the position of the robot’s TCP is checked so that it will
not go inside a specified volume wzone. This supervision is not performed when
going to p_place, but is reactivated before going to p_home. When this position
is reached, the world zone definition is erased.
Arguments
WZFree WorldZone
WorldZone Data type: wztemporary
Program execution
The temporary world zone is first deactivated and then its definition is erased.
Once erased, a temporary world zone cannot be either re-activated nor deactivated.
Limitations
Only a temporary world zone can be deactivated, reactivated or erased. A stationary
world zone is always active.
Syntax
WZFree
[WorldZone’:=’]<variable or persistent (INOUT) of wztemporary>’;’
Related information
Described in:
World Zones Motion and I/O Principles -
World Zones
World zone shape Data Types - shapedata
Temporary world zone data Data Types - wztemporary
Activate world zone limit supervision Instructions - WZLimSup
Activate world zone set digital output Instructions - WZDOSet
Deactivate world zone Instructions - WZDisable
Activate world zone Instructions - WZEnable
After this instruction is executed, when the robot’s TCP reaches the defined world
zone, the movement is stopped both during program execution and when jogging.
Example
VAR wzstationary max_workarea;
...
PROC POWER_ON()
VAR shapedata volume;
...
WZBoxDef \Outside, volume, corner1, corner2;
WZLimSup \Stat, max_workarea, volume;
ENDPROC
Definition and activation of stationary world zone max_workarea, with the shape
of the area outside a box (temporarily stored in volume) and the action work-area
supervision. The robot stops with an error message before entering the area
outside the box.
Arguments
WZLimSup [\Temp] | [\Stat] WorldZone Shape
\Temp (Temporary) Data type: switch
Variable or persistent variable that will be updated with the identity (numeric
value) of the world zone.
Program execution
The defined world zone is activated. From this moment the robot’s TCP position is
supervised. If it reaches the defined area the movement is stopped.
Example
VAR wzstationary box1_invers;
VAR wzstationary box2;
PROC wzone_power_on()
VAR shapedata volume;
CONST pos box1_c1:=[500,-500,0];
CONST pos box1_c2:=[-500,500,500];
CONST pos box2_c1:=[500,-500,0];
CONST pos box2_c2:=[200,-200,300];
...
WZBoxDef \Outside, volume, box1_c1, box1_c2;
WZLimSup \Stat, box1_invers, volume;
WZBoxDef \Inside, volume, box2_c1, box2_c2;
WZLimSup \Stat, box2, volume;
ENDPROC
Limitation of work area for the robot with the following stationary world zones:
If this routine is connected to the system event POWER ON, these world zones
will always be active in the system, both for program movements and manual
jogging.
Limitations
A world zone cannot be redefined using the same variable in argument WorldZone.
A stationary world zone cannot be deactivated, activated again or erased in the RAPID
program.
Syntax
WZLimSup
[’\’Temp] | [’\Stat]’,’
[WorldZone’:=’]<variable or persistent (INOUT) of wztemporary>’,’
[Shape’:=’] <variable (VAR) of shapedata>’;’
Related information
Described in:
World Zones Motion and I/O Principles -
World Zones
World zone shape Data Types - shapedata
Temporary world zone Data Types - wztemporary
Stationary world zone Data Types - wzstationary
Define straight box-shaped world zone Instructions - WZBoxDef
Define sphere-shaped world zone Instructions - WZSphDef
Define cylinder-shaped world zone Instructions - WZCylDef
Activate world zone digital output set Instructions - WZDOSet
Example
Z
Y
C1
R1 (min. 5 mm)
X
World Coordinate System
Define a sphere named volume by its centre C1 and its radius R1.
Arguments
WZSphDef [\Inside] | [\Outside] Shape CentrePoint Radius
\Inside Data type: switch
Variable for storage of the defined volume (private data for the system).
Program execution
The definition of the sphere is stored in the variable of type shapedata (argument
Shape), for future use in WZLimSup or WZDOSet instructions.
Limitations
If the robot is used to point out the CentrePoint, work object wobj0 must be active (use
of component trans in robtarget e.g. p1.trans as argument).
Syntax
WZSphDef
[’\’Inside] | [’\’Outside]’,’
[Shape’:=’]<variable (VAR) of shapedata>’,’
[CentrePoint’:=’]<expression (IN) of pos>’,’
[Radius’:=’]<expression (IN) of num>’;’
Related information
Described in:
World Zones Motion and I/O Principles -
World Zones
World zone shape Data Types - shapedata
Define box-shaped world zone Instructions - WZBoxDef
Define cylinder-shaped world zone Instructions - WZCylDef
Activate world zone limit supervision Instructions - WZLimSup
Activate world zone digital output set Instructions - WZDOSet
Example
reg1 := Abs(reg2);
Arguments
Abs (Input)
Input Data type: num
Example
TPReadNum no_of_parts, "How many parts should be produced? ";
no_of_parts := Abs(no_of_parts);
The operator is asked to input the number of parts to be produced. To ensure that
the value is greater than zero, the value given by the operator is made positive.
Syntax
Abs ’(’
[ Input ’:=’ ] < expression (IN) of num > ’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Example
VAR num angle;
VAR num value;
.
.
angle := ACos(value);
Arguments
ACos (Value)
Value Data type: num
Syntax
Acos’(’
[Value ’:=’] <expression (IN) of num>
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Example
IF AOutput(ao4) > 5 THEN ...
If the current value of the signal ao4 is greater than 5, then ...
The current value is scaled (in accordance with the system parameters) before it is read
by the RAPID program. See Figure 35.
MAX SIGNAL
MAX PROGRAM
MIN SIGNAL
Arguments
AOutput (Signal)
Signal Data type: signalao
Syntax
AOutput ’(’
[ Signal ’:=’ ] < variable (VAR) of signalao > ’)’
Related information
Described in:
Input/Output instructions RAPID Summary -
Input and Output Signals
Input/Output functionality in general Motion and I/O Principles -
I/O Principles
Configuration of I/O User’s Guide - System Parameters
Example
VAR num angle;
VAR num value;
.
.
angle := ASin(value);
Arguments
ASin (Value)
Value Data type: num
Syntax
ASin’(’
[Value ’:=’] <expression (IN) of num>
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Example
VAR num angle;
VAR num value;
.
.
angle := ATan(value);
Arguments
ATan (Value)
Value Data type: num
Syntax
ATan’(’
[Value ’:=’] <expression (IN) of num>
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Arc tangent with a return value in the Functions - ATan2
range [-180, 180]
Example
VAR num angle;
VAR num x_value;
VAR num y_value;
.
.
angle := ATan2(y_value, x_value);
The value will be equal to ATan(y/x), but in the range [-180, 180], since the function
uses the sign of both arguments to determine the quadrant of the return value.
Arguments
ATan2 (Y X)
Y Data type: num
Syntax
ATan2’(’
[Y ’:=’] <expression (IN) of num> ’,’
[X ’:=’] <expression (IN) of num>
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Arc tangent with only one argument Functions - ATan
Example
VAR string con_data_buffer{5};
VAR byte data1 := 122;
con_data_buffer{1} := ByteToStr(data1);
The content of the array component con_data_buffer{1} will be "122" after the
ByteToStr ... function.
con_data_buffer{2} := ByteToStr(data1\Hex);
The content of the array component con_data_buffer{2} will be "7A" after the
ByteToStr ... function.
con_data_buffer{3} := ByteToStr(data1\Okt);
The content of the array component con_data_buffer{3} will be "172" after the
ByteToStr ... function.
con_data_buffer{4} := ByteToStr(data1\Bin);
con_data_buffer{5} := ByteToStr(data1\Char);
The content of the array component con_data_buffer{5} will be "z" after the
ByteToStr ... function.
(*) If non-writable ASCII char, the return format will be RAPID character code
format (e.g. “\07” for BEL control character).
Arguments
ByteToStr (BitData [\Hex] | [\Oct] | [\Bin] | [\Char])
BitData Data type: byte
If the optional switch argument is omitted, the data will be converted in decimal (Dec)
format.
Limitations
The range for a data type byte is 0 to 255 decimal.
Syntax
ByteToStr’(’
[BitData ’:=’] <expression (IN) of byte>
[’\’ Hex ] | [’\’ Okt] | [’\’ Bin] | [’\’ Char]
’)’ ’;’
Related information
Described in:
Convert a string to a byte data Instructions - StrToByte
Other bit (byte) functions RAPID Summary - Bit Functions
Other string functions RAPID Summary - String Functions
The input robtarget data should be specified in the same coordinate system as specified
in argument for Tool, WObj and at execution time active program displacement
(ProgDisp) and external axes offset (EOffs).
The returned jointtarget data is expressed in the calibration coordinate system.
Example
VAR jointtarget jointpos1;
CONST robtarget p1 := [...];
The angles in degrees for the axes of the robot on the arm side.
The values for the external axes, in mm for linear axes, in degrees for rotational axes.
Arguments
CalcJointT ( Rob_target Tool [\WObj] )
Rob_target Data type: robtarget
The position of the robot and external axes in the outermost coordinate system,
related to the specified tool and work object and at execution time active program
displacement (ProgDisp) and/or external axes offset (EOffs).
The work object (coordinate system) to which the robot position is related.
Program execution
The returned jointtarget is calculated from the input robtarget.
To calculate the robot joint angles, the specified Tool, WObj (including coordinated
user frame) and the ProgDisp active at execution time, are taken into consideration.
To calculate the external axis position at the execution time, active EOffs is taken into
consideration.
The calculation always selects the robot configuration according to the specified con-
figuration data in the input robtarget data. Instructions ConfL and ConfJ do not affect
this calculation principle. When wrist singularity is used, robot axis 4 will be set to 0
degrees.
If there is any active program displacement (ProgDisp) and/or external axis offset
(EOffs) at the time the robtarget is stored, then the same program displacement and/or
external axis offset must be active when CalcJointT is executed.
Syntax
CalcJointT’(’
[Rob_target ’:=’] <expression (IN) of robtarget> ‘,’
[Tool ’:=’ ] <persistent (PERS) of tooldata>
[’\’WObj ’:=’ <persistent (PERS) of wobjdata>] ’)’
Related information
Described in:
Calculate robtarget from jointtarget Functions - CalcRobT
Definition of position Data Types - robtarget
Definition of joint position Data Types - jointtarget
Definition of tools Data Types- tooldata
Definition of work objects Data Types - wobjdata
Coordinate systems Motion and I/O Principles - Coordi-
nate Systems
Program displacement coordinate system Instructions - PDispOn
External axis offset coordinate system Instructions - EOffsOn
This function returns a robtarget value with position (x, y, z), orientation (q1 ... q4),
robot axes configuration and external axes position.
The input jointtarget data should be specified in the calibration coordinate system.
The returned robtarget data is expressed in the outermost coordinate system, taking the
specified tool, work object and at execution time active program displacement
(ProgDisp) and external axis offset (EOffs) into consideration.
Example
VAR robtarget p1;
CONST jointtarget jointpos1 := [...];
The robot and external axis position is returned in data type robtarget and expressed in
the outermost coordinate system, taking the specified tool, work object and at execu-
tion time active program displacement (ProgDisp) and external axes offset (EOffs) into
consideration.
If there is no active ProgDisp, the robot position is expressed in the object coordinate
system.
If there are no active EOffs, the external axis position is expressed in the calibration
coordinate system.
Arguments
CalcRobT ( Joint_target Tool [\WObj] )
Joint_target Data type: jointtarget
The joint position for the robot axes and external axes related to the calibration
coordinate system.
The work object (coordinate system) to which the robot position returned by the
function is related.
Program execution
The returned robtarget is calculated from the input jointtarget.
To calculate the cartesian robot position, the specified Tool, WObj (including coordi-
nated user frame) and at the execution time active ProgDisp are taken into considera-
tion.
To calculate the external axes position, the EOffs active at execution time is taken into
consideration.
Syntax
CalcRobT’(’
[Joint_target ’:=’ ] <expression (IN) of jointtarget> ‘,’
[Tool ’:=’ ] <persistent (PERS) of tooldata>
[’\’WObj ’:=’ <persistent (PERS) of wobjdata>] ’)’
Related information
Described in:
Calculate jointtarget from robtarget Functions - CalcJointT
Definition of position Data Types - robtarget
Definition of joint position Data Types - jointtarget
Definition of tools Data Types- tooldata
Definition of work objects Data Types - wobjdata
Coordinate systems Motion and I/O Principles - Coordi-
nate Systems
Program displacement coordinate system Instructions - PDispOn
External axes offset coordinate system Instructions - EOffsOn
This function can be used to present the current date to the operator on the teach pen-
dant display or to paste the current date into a text file that the program writes to.
Example
VAR string date;
date := CDate();
Example
date := CDate();
TPWrite “The current date is: “+date;
Write logfile, date;
The current date is written to the teach pendant display and into a text file.
Syntax
CDate ’(’ ’)’
Related Information
Described in:
Time instructions RAPID Summary - System & Time
Setting the system clock User’s Guide - Service
Example
VAR jointtarget joints;
joints := CJointT();
The current angles of the axes for the robot and external axes are stored in joints.
The current angles in degrees for the axes of the robot on the arm side.
The current values for the external axes, in mm for linear axes, in degrees for rotational
axes.
Syntax
CJointT’(’’)’
Related information
Described in:
Definition of joint Data Types - jointtarget
Reading the current motor angle Functions - ReadMotor
Example
reg1:=ClkRead(clock1);
The clock clock1 is read and the time in seconds is stored in the variable reg1.
Argument
ClkRead (Clock)
Clock Data type: clock
Program execution
A clock can be read when it is stopped or running.
Once a clock is read it can be read again, started again, stopped, or reset.
Error handling
If the clock runs for 4,294,967 seconds (49 days 17 hours 2 minutes 47 seconds) it
becomes overflowed and the system variable ERRNO is set to ERR_OVERFLOW.
Syntax
ClkRead ’(’
[ Clock ’:=’ ] < variable (VAR) of clock > ’)’
Related Information
Described in:
Clock instructions RAPID Summary - System & Time
Clock overflow Data Types - clock
More examples Instructions - ClkStart
Example
VAR num angle;
VAR num value;
.
.
value := Cos(angle);
Arguments
Cos (Angle)
Angle Data type: num
Syntax
Cos’(’
[Angle ’:=’] <expression (IN) of num>
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
This function returns the x, y, and z values of the robot TCP as data of type pos. If the
complete robot position (robtarget) is to be read, use the function CRobT instead.
Example
VAR pos pos1;
The current position of the robot TCP is stored in variable pos1. The tool tool1
and work object wobj0 are used for calculating the position.
The current position (pos) of the robot with x, y, and z in the outermost coordinate sys-
tem, taking the specified tool, work object and active ProgDisp coordinate system into
consideration.
Arguments
CPos ([\Tool] [\WObj])
[\Tool] Data type: tooldata
The work object (coordinate system) to which the current robot position returned
by the function is related.
When programming, it is very sensible to always specify arguments \Tool and \WObj.
The function will always then return the wanted position, although some other tool or
work object has been activated manually.
Program execution
The coordinates returned represent the TCP position in the ProgDisp coordinate sys-
tem.
Example
VAR pos pos2;
VAR pos pos3;
VAR pos pos4;
The x, y, and z position of the robot is captured at two places within the program
using the CPos function. The tool grip3 and work object fixture are used for cal-
culating the position. The x, y and z distances travelled between these positions
are then calculated and stored in the pos variable pos4.
Syntax
CPos ’(’
[’\’Tool ’:=’ <persistent (PERS) of tooldata>]
[’\’WObj ’:=’ <persistent (PERS) of wobjdata>] ’)’
Related information
Described in:
Definition of position Data Types - pos
Definition of tools Data Types- tooldata
Definition of work objects Data Types - wobjdata
Coordinate systems Motion and I/O Principles - Coordi-
nate Systems
Reading the current robtarget Functions - CRobT
This function returns a robtarget value with position (x, y, z), orientation (q1 ... q4),
robot axes configuration and external axes position. If only the x, y, and z values of the
robot TCP (pos) are to be read, use the function CPos instead.
Example
VAR robtarget p1;
p1 := CRobT(\Tool:=tool1 \WObj:=wobj0);
The current position of the robot and external axes is stored in p1. The tool tool1
and work object wobj0 are used for calculating the position.
The current position of the robot and external axes in the outermost coordinate system,
taking the specified tool, work object and active ProgDisp/ExtOffs coordinate system
into consideration.
Arguments
CRobT ([\Tool] [\WObj])
[\Tool] Data type: tooldata
The work object (coordinate system) to which the current robot position returned
by the function is related.
When programming, it is very sensible to always specify arguments \Tool and \WObj.
The function will always then return the wanted position, although some other tool or
work object has been activated manually.
Program execution
The coordinates returned represent the TCP position in the ProgDisp coordinate sys-
tem. External axes are represented in the ExtOffs coordinate system.
Example
VAR robtarget p2;
The current position in the object coordinate system (without any ProgDisp or
ExtOffs) of the robot and external axes is stored in p2. The tool grip3 and work
object fixture are used for calculating the position.
Syntax
CRobT’(’
[’\’Tool ’:=’ <persistent (PERS) of tooldata>]
[’\’WObj ’:=’ <persistent (PERS) of wobjdata>] ’)’
Related information
Described in:
Definition of position Data Types - robtarget
Definition of tools Data Types- tooldata
Definition of work objects Data Types - wobjdata
Coordinate systems Motion and I/O Principles - Coordi-
nate Systems
ExtOffs coordinate system Instructions - EOffsOn
Reading the current pos (x, y, z only) Functions - CPos
This function can be used to present the current time to the operator on the teach pen-
dant display or to paste the current time into a text file that the program writes to.
Example
VAR string time;
time := CTime();
Example
time := CTime();
TPWrite “The current time is: “+time;
Write logfile, time;
The current time is written to the teach pendant display and written into a text
file.
Syntax
CTime ’(’ ’)’
Related Information
Described in:
Time and date instructions RAPID Summary - System & Time
Setting the system clock User’s Guide - System Parameters
Example
PERS tooldata temp_tool:= [ TRUE, [ [0, 0, 0], [1, 0, 0 ,0] ],
[0.001, [0, 0, 0.001], [1, 0, 0, 0], 0, 0, 0] ];
temp_tool := CTool();
This function returns a tooldata value holding the value of the current tool, i.e. the tool
last used in a movement instruction.
The value returned represents the TCP position and orientation in the wrist centre coor-
dinate system, see tooldata.
Syntax
CTool’(’’)’
Related information
Described in:
Definition of tools Data Types- tooldata
Coordinate systems Motion and I/O Principles - Coordi-
nate Systems
Example
PERS wobjdata temp_wobj;
temp_wobj := CWObj();
The value of the current work object is stored in the variable temp_wobj.
This function returns a wobjdata value holding the value of the current work object,
i.e. the work object last used in a movement instruction.
The value returned represents the work object position and orientation in the world
coordinate system, see wobjdata.
Syntax
CWObj’(’’)’
Related information
Described in:
Definition of work objects Data Types- wobjdata
Coordinate systems Motion and I/O Principles - Coordi-
nate Systems
Example
p3 p6
p5
p4
p1 p2
Three positions, p1- p3, related to an object in an original position, have been stored.
After a displacement of the object the same positions are searched for and stored as
p4-p6. From these six positions the displacement frame is calculated. Then the
calculated frame is used to displace all the stored positions in the program.
Arguments
DefDFrame (OldP1 OldP2 OldP3 NewP1 NewP2 NewP3)
OldP1 Data type: robtarget
The first original position.
Error handling
If it is not possible to calculate the frame because of bad accuracy in the positions, the
system variable ERRNO is set to ERR_FRAME. This error can then be handled in the
error handler.
Syntax
DefDFrame’(’
[OldP1 ’:=’] <expression (IN) of robtarget> ’,’
[OldP2 ’:=’] <expression (IN) of robtarget> ’,’
[OldP3 ’:=’] <expression (IN) of robtarget> ’,’
[NewP1 ’:=’] <expression (IN) of robtarget> ’,’
[NewP2 ’:=’] <expression (IN) of robtarget> ’,’
[NewP3 ’:=’] <expression (IN) of robtarget> ’)’
Related information
Described in:
Activation of displacement frame Instructions - PDispSet
Manual definition of displacement frame User’s Guide - Calibration
Example
y
z p3
z
x
p2
y
frame1
p1
object frame x
Three positions, p1- p3, related to the object coordinate system, are used to define the
new coordinate system, frame1. The first position, p1, is defining the origin of frame1,
the second position, p2, is defining the direction of the x-axis and the third position,
p3, is defining the location of the xy-plane. The defined frame1 may be used as a
displacement frame, as shown in the example below:
Arguments
DefFrame (NewP1 NewP2 NewP3 [\Origin])
NewP1 Data type: robtarget
The first position, which will define the origin of the new frame.
The second position, which will define the direction of the x-axis of the new
frame.
The third position, which will define the xy-plane of the new frame. The position
of point 3 will be on the positive y side, see the figure above.
Optional argument, which will define how the origin of the frame will be placed.
Origin = 1, means that the origin is placed in NewP1, i.e. the same as if this
argument is omitted. Origin = 2 means that the origin is placed in NewP2, see the
figure below.
z z y
New P3
x
y New P2
Origin = 3 means that the origin is placed on the line going through NewP1 and NewP2
and so that NewP3 will be placed on the y axis, see the figure below.
z y
z New P3
x
y New P2
Limitations
The three positions p1 - p3, defining the frame, must define a well shaped triangle. The
most well shaped triangle is the one with all sides of equal length.
p2
p3
θ
p1
The triangle is not considered to be well shaped if the angle θ a is too small. The angle
θ is too small if:
–4
cos Θ <1 – 10
The triangle p1, p2, p3 must not be too small, i.e. the positions cannot be too close. The
distances between the positions p1 - p2 and p1 - p3 must not be less than 0.1 mm.
Error handling
If the frame cannot be calculated because of the above limitations, the system variable
ERRNO is set to ERR_FRAME. This error can then be handled in the error handler.
Syntax
DefFrame’(’
[NewP1 ’:=’] <expression (IN) of robtarget> ’,’
[NewP2 ’:=’] <expression (IN) of robtarget> ’,’
[NewP3 ’:=’] <expression (IN) of robtarget>
[’\’Origin ’:=’ <expression (IN) of num> ]’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Activation of displacement frame Instructions - PDispSet
Example
PROC arrmul(VAR num array{*}, num factor)
ENDPROC
Arguments
Dim (ArrPar DimNo)
ArrPar (Array Parameter) Data type: Any type
Example
PROC add_matrix(VAR num array1{*,*,*}, num array2{*,*,*})
ENDPROC
Two matrices are added. If the size of the matrices differs, the program stops and
an error message appears.
This procedure can take any three-dimensional arrays of data type num as an
input.
Syntax
Dim ’(’
[ArrPar’:=’] <reference (REF) of any type> ’,’
[DimNo’:=’] <expression (IN) of num> ’)’
A REF parameter requires that the corresponding argument be either a constant, a vari-
able or an entire persistent. The argument could also be an IN parameter, a VAR param-
eter or an entire PERS parameter.
Related information
Described in:
Array parameters Basic Characteristics - Routines
Array declaration Basic Characteristics - Data
Example
y
p2
x
p1
z
The distance in space between the points p1 and p2 is calculated and stored in
the variable dist.
Arguments
Distance (Point1 Point2)
Point1 Data type: pos
Program execution
Calculation of the distance between the two points:
y
x2, y2, z2
x
x1,y1,z1
z
distance = ( x – x ) 2 + ( y – y )2 + ( z – z ) 2
1 2 1 2 1 2
Syntax
Distance’(’
[Point1 ’:=’] <expression (IN) of pos> ’,’
[Point2 ’:=’] <expression (IN) of pos>
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Definition of pos Data Type - pos
Example
B
θAB
A
B cos θAB A
The dot or scalar product of two vectors A and B is a scalar, which equals the products
of the magnitudes of A and B and the cosine of the angle between them.
A ⋅ B = A B cos θAB
The vectors are described by the data type pos and the dot product by the data type
num:
Arguments
DotProd (Vector1 Vector2)
Vector1 Data type: pos
Syntax
DotProd’(’
[Vector1 ’:=’] <expression (IN) of pos> ’,’
[Vector2 ’:=’] <expression (IN) of pos>
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Example
IF DOutput(do2) = 1 THEN . . .
Arguments
DOutput (Signal)
Signal Data type: signaldo
Program execution
The value read depends on the configuration of the signal. If the signal is inverted in
the system parameters, the value returned by this function is the opposite of the true
value of the physical channel.
Example
IF DOutput(auto_on) <> active THEN . . .
If the current value of the system signal auto_on is not active, then ..., i.e. if the
robot is in the manual operating mode, then ... Note that the signal must first be
defined as a system output in the system parameters.
Syntax
DOutput ’(’
[ Signal ’:=’ ] < variable (VAR) of signaldo > ’)’
Related information
Described in:
Input/Output instructions RAPID Summary -
Input and Output Signals
Input/Output functionality in general Motion and I/O Principles -
I/O Principles
Configuration of I/O User’s Guide - System Parameters
Example
VAR num anglex;
VAR num angley;
VAR num anglez;
VAR pose object;
.
.
anglex := EulerZYX(\X, object.rot);
angley := EulerZYX(\Y, object.rot);
anglez := EulerZYX(\Z, object.rot);
Arguments
EulerZYX ([\X] | [\Y] | [\Z] Rotation)
The arguments \X, \Y and \Z are mutually exclusive. If none of these are specified, a
run-time error is generated.
Syntax
EulerZYX’(’
['\'X ’,’] | ['\'Y ’,’] | ['\'Z ’,’]
[Rotation ’:=’] <expression (IN) of orient>
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Example
VAR num x;
VAR num value;
.
.
value:= Exp( x);
Arguments
Exp (Exponent)
Exponent Data type: num
Syntax
Exp’(’
[Exponent ’:=’] <expression (IN) of num>
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Example
Load "HOME:/notmymod.mod";
WHILE TRUE DO
! Call some routine in notmymod
notmymodrout;
IF FileTime("HOME:/notmymod.mod" \ModifyTime)
> ModTime("notmymod") THEN
UnLoad "HOME:notmymod.mod";
Load "HOME:notmymod.mod";
ENDIF
ENDWHILE
This program reloads a module if there is a newer at the source. It uses the
ModTime to retrieve the latest loading time for the specified module, and to com-
pare it to the FileTime\ModifyTime at the source. Then, if the source is newer, the
program unloads and loads the module again.
Arguments
FileTime ( Path [\ModifyTime] | [\AccessTime] | [\StatCTime] )
Path Data type: string
Program execution
This function returns a numeric that specifies the time since the last:
- Modification
- Access
- File status change
Example
This is a complete example that implements an alert service for maximum 10 files.
PROC alertFree()
IDelete timeint;
ENDPROC
Error handling
If the file does not exist, the system variable ERRNO is set to ERR_FILEACC. This
error can then be handled in the error handler.
Syntax
FileTime ’(’
[ Path ’:=’ ] < expression (IN) of string>
[ '\'ModifyTime] |
[ '\'AccessTime] |
[ '\'StatCTime] ’)’
Related information
Described in:
Last time a module was loaded Functions - ModTime
Example
IF GOutput(go2) = 5 THEN ...
The values of each signal in the group are read and interpreted as an unsigned binary
number. This binary number is then converted to an integer.
The value returned lies within a range that is dependent on the number of signals in the
group.
Arguments
GOutput (Signal)
Signal Data type: signalgo
Syntax
GOutput ’(’
[ Signal ’:=’ ] < variable (VAR) of signalgo > ’)’
Related information
Described in:
Input/Output instructions RAPID Summary -
Input and Output Signals
Input/Output functionality in general Motion and I/O Principles -
I/O Principles
Configuration of I/O User’s Guide - System Parameters
Example
hour := GetTime(\Hour);
Argument
GetTime ( [\WDay] | [\Hour] | [\Min] | [\Sec] )
[\WDay] Data type: switch
One of the arguments must be specified, otherwise program execution stops with an
error message.
Example
weekday := GetTime(\WDay);
hour := GetTime(\Hour);
IF weekday < 6 AND hour >6 AND hour < 16 THEN
production;
ELSE
maintenance;
ENDIF
If it is a weekday and the time is between 7:00 and 15:59 the robot performs pro-
duction. At all other times, the robot is in the maintenance mode.
Syntax
GetTime ’(’
[’\’ WDay ]
| [ ’\’ Hour ]
| [ ’\’ Min ]
| [ ’\’ Sec ] ’)’
Related Information
Described in:
Time and date instructions RAPID Summary - System & Time
Setting the system clock User’s Guide - System Parameters
IsPers Is Persistent
IsPers is used to test if a data object is a persistent variable or not.
Example
PROC procedure1 (INOUT num parameter1)
IF IsVar(parameter1) THEN
! For this call reference to a variable
...
ELSEIF IsPers(parameter1) THEN
! For this call reference to a persistent variable
...
ELSE
! Should not happen
EXIT;
ENDIF
ENDPROC
The procedure procedure1 will take different actions depending on whether the
actual parameter parameter1 is a variable or a persistent variable.
Arguments
IsPers (DatObj)
DatObj (Data Object) Data type: any type
Syntax
IsPers’(’
[ DatObj ’:=’ ] < var or pers (INOUT) of any type > ’)’
Related information
Described in:
Test if variable Function - IsVar
Types of parameters (access modes) RAPID Characteristics - Routines
IsVar Is Variable
IsVar is used to test whether a data object is a variable or not.
Example
PROC procedure1 (INOUT num parameter1)
IF IsVAR(parameter1) THEN
! For this call reference to a variable
...
ELSEIF IsPers(parameter1) THEN
! For this call reference to a persistent variable
...
ELSE
! Should not happen
EXIT;
ENDIF
ENDPROC
The procedure procedure1 will take different actions, depending on whether the
actual parameter parameter1 is a variable or a persistent variable.
Arguments
IsVar (DatObj)
DatObj (Data Object) Data type: any type
Syntax
IsVar’(’
[ DatObj ’:=’ ] < var or pers (INOUT) of any type > ’)’
Related information
Described in:
Test if persistent Function - IsPers
Types of parameters (access modes) RAPID Characteristics - Routines
Example
CONST robtarget p1;
VAR robtarget p2;
PERS wobjdata mirror;
.
.
p2 := MirPos(p1, mirror);
p1 is a robtarget storing a position of the robot and an orientation of the tool. This
position is mirrored in the xy-plane of the frame defined by mirror, relative to the
world coordinate system. The result is new robtarget data, which is stored in p2.
The new position which is the mirrored position of the input position.
Arguments
MirPos (Point MirPlane [\WObj] [\MirY])
Point Data type: robtarget
The input robot position. The orientation part of this position defines the current
orientation of the tool coordinate system.
The work object data defining the mirror plane. The mirror plane is the xy-plane
of the object frame defined in MirPlane. The location of the object frame is
defined relative to the user frame, also defined in MirPlane, which in turn is
defined relative to the world frame.
The work object data defining the object frame, and user frame, relative to which
the input position, Point, is defined. If this argument is left out, the position is
defined relative to the World coordinate system.
Note. If the position is created with a work object active, this work object must
be referred to in the argument.
If this switch is left out, which is the default rule, the tool frame will be mirrored
as regards the x-axis and the z-axis. If the switch is specified, the tool frame will
be mirrored as regards the y-axis and the z-axis.
Limitations
No recalculation is done of the robot configuration part of the input robtarget data.
Syntax
MirPos’(’
[ Point ’:=’ ] < expression (IN) of robtarget>’,’
[MirPlane ’:=’] <expression (IN) of wobjdata> ’,’
[’\’WObj ’:=’ <expression (IN) of wobjdata> ]
[’\’MirY ]’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Example
MODULE mymod
PROC printMyTime()
mytime := ModTime("mymod");
TPWrite "My time is "+NumToStr(mytime,0);
ENDPROC
Arguments
ModTime ( Object )
Object Data type: string
Program execution
This function return a numeric that specify the time when the module was loaded.
Example
This is a complete example that implements an “update if newer” service.
MODULE updmod
PROC callrout()
Load "HOME:/mymod.mod";
WHILE TRUE DO
! Call some routine in mymod
mymodrout;
IF FileTime("HOME:/mymod.mod" \ModifyTime)
> ModTime("mymod") THEN
UnLoad "HOME:/mymod.mod";
Load "HOME:/mymod.mod";
ENDIF
ENDWHILE
ENDPROC
ENDMODULE
This program reloads a module if there is a newer one at the source. It uses the
ModTime to retrieve the latest loading time for the specified module, and com-
pares it to the FileTime\ModifyTime at the source. Then, if the source is newer,
the program unloads and loads the module again.
Syntax
ModTime ’(’
[ Object ’:=’ ] < expression (IN) of string>’)’
Related information
Described in:
Retrieve time info. about a file Functions - FileTime
Description
An orientation must be normalised, i.e. the sum of the squares must
equal 1:
q 12 + q 22 + q 32 + q 42 = 1
2 2 2 2
ABS ( q 1 + q 2 + q 3 + q 4 – 1 ) = normerr
Example
We have a slightly unnormalised position ( 0.707170, 0, 0, 0.707170 )
2 2 2 2
ABS ( 0,707170 + 0 + 0 + 0,707170 – 1 ) = 0,0000894
Arguments
NOrient (Rotation)
Orient Data type: orient
Syntax
NOrient’(’
[Rotation ’:=’] <expression (IN) of orient>
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Example
VAR string str;
str := NumToStr(0.38521,3);
reg1 := 0.38521
The numeric value converted to a string with the specified number of decimals, with
exponent if so requested. The numeric value is rounded if necessary. The decimal point
is suppressed if no decimals are included.
Arguments
NumToStr (Val Dec [\Exp])
Val (Value) Data type: num
To use exponent.
Syntax
NumToStr’(’
[ Val ’:=’ ] <expression (IN) of num> ’,’
[ Dec ’:=’ ] <expression (IN) of num>
[ \Exp ]
’)’
Related information
Described in:
String functions RAPID Summary - String Functions
Definition of string Data Types - string
String values Basic Characteristics -
Basic Elements
Examples
MoveL Offs(p2, 0, 0, 10), v1000, z50, tool1;
The robot is moved to a point 10 mm from the position p2 (in the z-direction).
Arguments
Offs (Point XOffset YOffset ZOffset)
Point Data type: robtarget
Example
PROC pallet (num row, num column, num distance, PERS tooldata tool,
PERS wobjdata wobj)
ENDPROC
A routine for picking parts from a pallet is made. Each pallet is defined as a work
object (see Figure 36). The part to be picked (row and column) and the distance
between the parts are given as input parameters.
Incrementing the row and column index is performed outside the routine.
Columns
Y-axis
O O O O O O O O O O
O O O O O O O O O O
Rows O O O O O O O O O O
O O O O O O O O O O
X-axis
O O O O O O O O O O
Figure 36 The position and orientation of the pallet is specified by defining a work object.
Syntax
Offs ’(’
[Point ’:=’] <expression (IN) of robtarget> ’,’
[XOffset ’:=’] <expression (IN) of num> ’,’
[YOffset ’:=’] <expression (IN) of num> ’,’
[ZOffset ’:=’] <expression (IN) of num> ’)’
Related information
Described in:
Position data Data Types - robtarget
Example
TEST OpMode()
CASE OP_AUTO:
...
CASE OP_MAN_PROG:
...
CASE OP_MAN_TEST:
...
DEFAULT:
...
ENDTEST
Different program sections are executed depending on the current operating mode.
Syntax
OpMode’(’ ’)’
A function with a return value of the data type symnum.
Related information
Described in:
Different operating modes User’s Guide - Starting up
Reading running mode Functions - RunMode
Example
VAR num anglex;
VAR num angley;
VAR num anglez;
VAR pose object;
.
object.rot := OrientZYX(anglez, angley, anglex)
Arguments
OrientZYX (ZAngle YAngle XAngle)
ZAngle Data type: num
Syntax
OrientZYX’(’
[ZAngle ’:=’] <expression (IN) of num> ’,’
[YAngle ’:=’] <expression (IN) of num> ’,’
[XAngle ’:=’] <expression (IN) of num>
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Example
VAR robtarget p10;
VAR robtarget p11;
p10 := CRobT();
p11 := ORobT(p10);
The current positions of the robot and the external axes are stored in p10 and p11.
The values stored in p10 are related to the ProgDisp/ExtOffs coordinate system.
The values stored in p11 are related to the object coordinate system without any
offset on the external axes.
Arguments
ORobT (OrgPoint [\InPDisp] | [\InEOffs])
OrgPoint (Original Point) Data type: robtarget
Returns the TCP position in the ProgDisp coordinate system, i.e. removes exter-
nal axes offset only.
Returns the external axes in the offset coordinate system, i.e. removes program
displacement for the robot only.
Examples
p10 := ORobT(p10 \InEOffs );
The ORobT function will remove any program displacement that is active, leav-
ing the TCP position relative to the object coordinate system. The external axes
will remain in the offset coordinate system.
The ORobT function will remove any offset of the external axes. The TCP posi-
tion will remain in the ProgDisp coordinate system.
Syntax
ORobT ’(’
[ OrgPoint ’:=’ ] < expression (IN) of robtarget>
[’\’InPDisp] | [’\’InEOffs]’)’
Related information
Described in:
Definition of program displacement for Instructions - PDispOn, PDispSet
the robot
Definition of offset for external axes Instructions - EOffsOn, EOffsSet
Coordinate systems Motion and I/O Principles - Coordi-
nate Systems
Example
z1
Pose1
z0 Frame1
y1
x1
Frame0
y0 Pose2
x0
Arguments
PoseInv (Pose)
Pose Data type: pose
Syntax
PoseInv’(’
[Pose ’:=’] <expression (IN) of pose>
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Example
z1
pose1 y1 z2
z0 pose2
Frame1
x1 Frame2
Frame0
y0 y2
pose3 x2
x0
Arguments
PoseMult (Pose1 Pose2)
Pose1 Data type: pose
Syntax
PoseMult’(’
[Pose1 ’:=’] <expression (IN) of pose> ’,’
[Pose2 ’:=’] <expression (IN) of pose>
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Example
pos1
pos2 z1
z0
pose1 y1
Frame1
Frame0
y0 x1
x0
The value of the product of the pose and the original pos.
Arguments
PoseVect (Pose Pos)
Pose Data type: pose
Syntax
PoseVect’(’
[Pose ’:=’] <expression (IN) of pose> ’,’
[Pos ’:=’] <expression (IN) of pos>
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Example
VAR num x;
VAR num y
VAR num reg1;
.
reg1:= Pow(x, y);
Arguments
Pow (Base Exponent)
Base Data type: num
Limitations
The execution of the function xy will give an error if:
Syntax
Pow’(’
[Base ’:=’] <expression (IN) of num> ’,’
[Exponent ’:=’] <expression (IN) of num>
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
An optional parameter may not be used if it was not specified when calling the routine.
This function can be used to test if a parameter has been specified, in order to prevent
errors from occurring.
Example
PROC feeder (\switch on | \switch off)
ENDPROC
The output do1, which controls a feeder, is set or reset depending on the argu-
ment used when calling the routine.
TRUE = The parameter value or a switch has been defined when calling the routine.
Arguments
Present (OptPar)
OptPar (Optional Parameter) Data type: Any type
Example
PROC glue (\switch on, num glueflow, robtarget topoint, speeddata speed,
zonedata zone, PERS tooldata tool, \PERS wobjdata wobj)
ENDPROC
A glue routine is made. If the argument \on is specified when calling the routine,
a pulse is generated on the signal glue_on. The robot then sets an analog output
gluesignal, which controls the glue gun, and moves to the end position. As the
wobj parameter is optional, different MoveL instructions are used depending on
whether this argument is used or not.
Syntax
Present ’(’
[OptPar’:=’] <reference (REF) of any type> ’)’
Related information
Described in:
Routine parameters Basic Characteristics - Routines
This function works on both binary and character-based files or serial channels.
Example
VAR num character;
VAR iodev inchannel;
...
Open "sio1:", inchannel\Bin;
character := ReadBin(inchannel);
A byte (8 bits) is read from a specified file or serial channel. This byte is converted to
the corresponding positive numeric value and returned as a num data type.
If a file is empty (end of file), the number -1 is returned.
Arguments
ReadBin (IODevice [\Time])
IODevice Data type: iodev
The max. time for the reading operation (timeout) in seconds. If this argument is
not specified, the max. time is set to 60 seconds.
If this time runs out before the reading operation is finished, the error handler
will be called with the error code ERR_DEV_MAXTIME. If there is no error
handler, the execution will be stopped.
The timeout function is in use also during program stop and will be noticed in
the RAPID program at program start.
Program execution
Program execution waits until a byte (8 bits) can be read from the file or serial channel.
Example
VAR num bindata;
VAR iodev file;
Read the contents of a binary file myfile.bin from the beginning to the end and
displays the received binary data converted to chars on the teach pendant (one
char on each line).
Limitations
The function can only be used for files and serial channels that have been opened with
read access (\Read for character based files, \Bin or \Append \Bin for binary files).
Error handling
If an error occurs during reading, the system variable ERRNO is set to
ERR_FILEACC.
If time out before the read operation is finished, the system variable ERRNO is set to
ERR_DEV_MAXTIME.
Predefined data
The constant EOF_BIN can be used to stop reading at the end of the file.
Syntax
ReadBin’(’
[IODevice ’:=’] <variable (VAR) of iodev>
[’\’Time’:=’ <expression (IN) of num>]’)’
Related information
Described in:
Opening (etc.) files or serial channels RAPID Summary - Communication
Convert a byte to a string data Functions - ByteToStr
Example
VAR num motor_angle2;
motor_angle2 := ReadMotor(2);
The current motor angle of the second axis of the robot is stored in
motor_angle2.
The current motor angle in radians of the stated axis of the robot or external axes.
Arguments
ReadMotor [\MecUnit ] Axis
MecUnit (Mechanical Unit) Data type: mecunit
The name of the mechanical unit for which an axis is to be read. If this argument
is omitted, the axis for the robot is read. (Note, in this release only robot is per-
mitted for this argument).
Program execution
The motor angle returned represents the current position in radians for the motor and
independently of any calibration offset. The value is not related to a fix position of the
robot, only to the resolver internal zero position, i.e. normally the resolver zero posi-
tion closest to the calibration position (the difference between the resolver zero posi-
tion and the calibration position is the calibration offset value). The value represents
the full movement of each axis, although this may be several turns.
Example
VAR num motor_angle3;
The current motor angle of the third axis of the robot is stored in motor_angle3.
Syntax
ReadMotor’(’
[’\’MecUnit ’:=’ < variable (VAR) of mecunit>’,’]
[Axis ’:=’ ] < expression (IN) of num>
’)’
Related information
Described in:
Reading the current joint angle Functions - CJointT
Example
VAR iodev infile;
...
Open "HOME:/file.doc", infile\Read;
reg1 := ReadNum(infile);
Arguments
ReadNum (IODevice [\Delim] [\Time])
IODevice Data type: iodev
A string containing the delimiters to use when parsing a line in the file or serial
channel. By default (without \Delim), the file is read line by line and the line-feed
character (\0A) is the only delimiter considered by the parsing. When the \Delim
argument is used, any character in the specified string argument will be consid-
ered to determine the significant part of the line.
When using the argument \Delim, the control system always adds the characters
carriage return (\0D) and line-feed (\0A) to the delimiters specified by the user.
The max. time for the reading operation (timeout) in seconds. If this argument is
not specified, the max. time is set to 60 seconds.
If this time runs out before the read operation is finished, the error handler will
be called with the error code ERR_DEV_MAXTIME. If there is no error handler,
the execution will be stopped.
The timeout function is also in use during program stop and will be noticed in the
RAPID program at program start.
Program execution
Starting at the current file position, the function reads and discards any heading delim-
iters. A heading delimiter without the argument \Delim is a line-feed character. Heading
delimiters with the argument \Delim are any characters specified in the \Delim argu-
ment plus carriage return and line-feed characters. It then reads everything up to and
including the next delimiter character (will be discarded), but not more than 80 charac-
ters. If the significant part exceeds 80 characters, the remainder of the characters will
be read on the next reading.
The string that is read is then converted to a numeric value; e.g. “234.4” is converted
to the numeric value 234.4.
Example
reg1 := ReadNum(infile\Delim:="\09 ");
IF reg1 > EOF_NUM THEN
TPWrite "The file is empty";
...
Limitations
The function can only be used for character based files that have been opened for read-
ing.
Error handling
If an access error occurs during reading, the system variable ERRNO is set to
ERR_FILEACC.
If there is an attempt to read non-numeric data, the system variable ERRNO is set to
ERR_RCVDATA.
If time out before the read operation is finished, the system variable ERRNO is set to
ERR_DEV_MAXTIME.
Predefined data
The constant EOF_NUM can be used to stop reading, at the end of the file.
Syntax
ReadNum ’(’
[IODevice ’:=’]<variable (VAR) of iodev>
[‘\’Delim’:=’<expression (IN) of string>]
[’\’Time’:=’<expression (IN) of num>]’)’
Related information
Described in:
Opening (etc.) files or serial channels RAPID Summary - Communication
Example
VAR string text;
VAR iodev infile;
...
Open "HOME:/file.doc", infile\Read;
text := ReadStr(infile);
Arguments
ReadStr (IODevice [\Delim] [\RemoveCR] [\DiscardHeaders]
[\Time])
IODevice Data type: iodev
A string containing the delimiters to use when parsing a line in the file or serial
channel. By default the file is read line by line and the line-feed character (\0A)
is the only delimiter considered by the parsing. When the \Delim argument is
used, any character in the specified string argument plus by default line-feed
character will be considered to determine the significant part of the line.
A switch used to remove the trailing carriage return character when reading PC
files. In PC files, a new line is specified by carriage return and line feed (CRLF).
When reading a line in such files, the carriage return character is by default read
into the return string. When using this argument, the carriage return character will
be read from the file but not included in the return string.
This argument specifies whether the heading delimiters (specified in \Delim plus
default line-feed) are skipped or not before transferring data to the return string.
By default, if the first character at the current file position is a delimiter, it is read
but not transferred to the return string, the line parsing is stopped and the return
will be an empty string. If this argument is used, all delimiters included in the line
will be read from the file but discarded, and the return string will contain the data
starting at the first non-delimiter character in the line.
The max. time for the reading operation (timeout) in seconds. If this argument is
not specified, the max. time is set to 60 seconds.
If this time runs out before the read operation is finished, the error handler will
be called with the error code ERR_DEV_MAXTIME. If there is no error handler,
the execution will be stopped.
The timeout function is in use also during program stop and will be noticed in the
RAPID program at program start.
Program execution
Starting at the current file position, if the \DiscardHeaders argument is used, the func-
tion reads and discards any heading delimiters (line-feed characters and any character
specified in the \Delim argument). In all cases, it then reads everything up to the next
delimiter character, but not more than 80 characters. If the significant part exceeds 80
characters, the remainder of the characters will be read on the next reading. The delim-
iter that caused the parsing to stop is read from the file but not transferred to the return
string. If the last character in the string is a carriage return character and the \RemoveCR
argument is used, this character will be removed from the string.
Example
text := ReadStr(infile);
IF text = EOF THEN
TPWrite "The file is empty";
...
Before using the string read from the file, a check is performed to make sure that
the file is not empty.
Example
Consider a file containing:
<LF><SPACE><TAB>Hello<SPACE><SPACE>World<CR><LF>
text := ReadStr(infile);
text will be an empty string: the first character in the file is the default <LF>
delimiter.
text := ReadStr(infile\DiscardHeaders);
text := ReadStr(infile\RemoveCR\DiscardHeaders);
text will contain “Hello”: the first characters in the file that match either the
default <LF> delimiter or the character set defined by \Delim (space and tab) are
discarded. Data is then transferred up to the first delimiter that is read from the
file but not transferred into the string. A new invocation of the same statement
will return “World”.
Example
Consider a file containing:
<CR><LF>Hello<CR><LF>
text := ReadStr(infile);
text will contain the <CR> (\0d) character: <CR> and <LF> characters are read
from the file, but only <CR> is transferred to the string. A new invocation of the
same statement will return “Hello\0d”.
text := ReadStr(infile\RemoveCR);
text will contain an empty string: <CR> and <LF> characters are read from the
file; <CR> is transferred but removed from the string. A new invocation of the
same statement will return “Hello”.
text := ReadStr(infile\Delim:=”\0d”);
text will contain an empty string: <CR> is read from the file but not transferred
to the return string. A new invocation of the same instruction will return an empty
string again: <LF> is read from the file but not transferred to the return string.
text := ReadStr(infile\Delim:=”\0d”\DiscardHeaders);
text will contain “Hello”. A new invocation of the same instruction will return
“EOF” (end of file).
Limitations
The function can only be used for files or serial channels that have been opened for
reading in a character-based mode.
Error handling
If an error occurs during reading, the system variable ERRNO is set to
ERR_FILEACC.
If timeout before the read operation is finished, the system variable ERRNO is set to
ERR_DEV_MAXTIME.
Predefined data
The constant EOF can be used to check if the file was empty when trying to read from
the file or to stop reading at the end of the file.
Syntax
ReadStr ’(’
[IODevice ’:=’] <variable (VAR) of iodev>
[‘\’Delim’:=’<expression (IN) of string>]
[‘\’RemoveCR]
[‘\’DiscardHeaders]
[’\’Time’:=’ <expression (IN) of num>]’)’
Related information
Described in:
Opening (etc.) files or serial channels RAPID Summary - Communication
Example
VAR iodev channel2;
VAR string text;
...
Open “sio1:”, channel2 \Bin;
text := ReadStrBin (channel2, 10);
Text is assigned a 10 characters text string read from the serial channel referred
to by channel2.
The text string read from the specified serial channel or file. If the file is empty (end of
file), the string "EOF" is returned.
Arguments
ReadStrBin (IODevice NoOfChars [\Time])
IODevice Data type: iodev
The number of characters to be read from the binary serial channel or file.
The max. time for the reading operation (timeout) in seconds. If this argument is
not specified, the max. time is set to 60 seconds.
If this time runs out before the read operation is finished, the error handler will
be called with the error code ERR_DEV_MAXTIME. If there is no error han-
dler, the execution will be stopped.
The timeout function is in use also during program stop and will be noticed in
the RAPID program at program start.
Program execution
The function reads the specified number of characters from the binary serial channel or
file.
Example
text := ReadStrBin(infile,20);
IF text = EOF THEN
TPWrite "The file is empty";
Before using the string read from the file, a check is performed to make sure that
the file is not empty.
Limitations
The function can only be used for serial channels or files that have been opened for
reading in a binary mode.
Error handling
If an error occurs during reading, the system variable ERRNO is set to
ERR_FILEACC.
If timeout before the read operation is finished, the system variable ERRNO is set to
ERR_DEV_MAXTIME.
Predefined data
The constant EOF can be used to check if the file was empty, when trying to read from
the file or to stop reading at the end of the file.
Syntax
ReadStrBin ’(’
[IODevice ’:=’] <variable (VAR) of iodev>’,’
[NoOfChars ’:=’] <expression (IN) of num>
[’\’Time’:=’ <expression (IN) of num>]’)’
Related information
Described in:
Opening (etc.) serial channels RAPID Summary - Communication
or files
Write binary string Instructions - WriteStrBin
Example
MoveL RelTool (p1, 0, 0, 100), v100, fine, tool1;
The robot is moved to a position that is 100 mm from p1 in the direction of the
tool.
The new position with the addition of a displacement and/or a rotation, if any, relative
to the active tool.
Arguments
RelTool (Point Dx Dy Dz [\Rx] [\Ry] [\Rz])
Point Data type: robtarget
The input robot position. The orientation part of this position defines the current
orientation of the tool coordinate system.
The rotation in degrees around the x axis of the tool coordinate system.
The rotation in degrees around the y axis of the tool coordinate system.
The rotation in degrees around the z axis of the tool coordinate system.
In the event that two or three rotations are specified at the same time, these will be per-
formed first around the x-axis, then around the new y-axis, and then around the new
z-axis.
Syntax
RelTool’(’
[ Point ’:=’ ] < expression (IN) of robtarget>’,’
[Dx ’:=’] <expression (IN) of num> ’,’
[Dy ’:=’] <expression (IN) of num> ’,’
[Dz ’:=’] <expression (IN) of num>
[’\’Rx ’:=’ <expression (IN) of num> ]
[’\’Ry ’:=’ <expression (IN) of num> ]
[’\’Rz ’:=’ <expression (IN) of num> ]’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Positioning instructions RAPID Summary - Motion
Example
VAR num val;
val := Round(0.38521\Dec:=3);
val := Round(0.38521\Dec:=1);
val := Round(0.38521);
Arguments
Round ( Val [\Dec])
Val (Value) Data type: num
Number of decimals.
The number of decimals must not be negative or greater than the available pre-
cision for numeric values.
Syntax
Round’(’
[ Val ’:=’ ] <expression (IN) of num>
[ \Dec ’:=’ <expression (IN) of num> ]
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Truncating a value Functions - Trunc
Example
IF RunMode() = RUN_CONT_CYCLE THEN
..
ENDIF
Arguments
RunMode ( [ \Main] )
[ \Main ] Data type: switch
If this argument is omitted, the return value always mirrors the current running
mode for the program task which executes the function RunMode.
Syntax
RunMode ’(’ [’\’Main] ’)’
Related information
Described in:
Reading operating mode Functions - OpMode
Example
VAR num angle;
VAR num value;
.
.
value := Sin(angle);
Arguments
Sin (Angle)
Angle Data type: num
Syntax
Sin’(’
[Angle’:=’] <expression (IN) of num>
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Example
VAR num x_value;
VAR num y_value;
.
.
y_value := Sqrt( x_value);
Arguments
Sqrt (Value)
Value Data type: num
Syntax
Sqrt’(’
[Value’:=’] <expression (IN) of num>
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Example
VAR num found;
found := StrFind("Robotics",1,"aeiou");
found := StrFind("Robotics",1,"aeiou"\NotInSet);
The character position of the first character, at or past the specified position, that
belongs to the specified set. If no such character is found, String length +1 is returned.
Arguments
StrFind (Str ChPos Set [\NotInSet])
Str (String) Data type: string
Start character position. A runtime error is generated if the position is outside the
string.
Syntax
StrFind’(’
[ Str ’:=’ ] <expression (IN) of string> ’,’
[ ChPos ’:=’ ] <expression (IN) of num> ’,’
[ Set’:=’ ] <expression (IN) of string>
[’\’NotInSet ]
’)’
Related information
Described in:
String functions RAPID Summary - String Functions
Definition of string Data Types - string
String values Basic Characteristics -
Basic Elements
Example
VAR num len;
len := StrLen("Robotics");
Arguments
StrLen (Str)
Str (String) Data type: string
Syntax
StrLen’(’
[ Str ’:=’ ] <expression (IN) of string>
’)’
Related information
Described in:
String functions RAPID Summary - String Functions
Definition of string Data Types - string
String values Basic Characteristics -
Basic Elements
Example
VAR string str;
str := StrMap("Robotics","aeiou","AEIOU");
The string created by translating the characters in the specified string, as specified by
the "from" and "to" strings. Each character, from the specified string, that is found in
the "from" string is replaced by the character at the corresponding position in the "to"
string. Characters for which no mapping is defined are copied unchanged to the result-
ing string.
Arguments
StrMap ( Str FromMap ToMap)
Str (String) Data type: string
Syntax
StrMap’(’
[ Str ’:=’ ] <expression (IN) of string> ’,’
[ FromMap’:=’ ] <expression (IN) of string> ’,’
[ ToMap’:=’ ] <expression (IN) of string>
’)’
Related information
Described in:
String functions RAPID Summary - String Functions
Definition of string Data Types - string
String values Basic Characteristics -
Basic Elements
Example
VAR num found;
found := StrMatch("Robotics",1,"bo");
The character position of the first substring, at or past the specified position, that is
equal to the specified pattern string. If no such substring is found, string length +1 is
returned.
Arguments
StrMatch (Str ChPos Pattern)
Str (String) Data type: string
Start character position. A runtime error is generated if the position is outside the
string.
Syntax
StrMatch’(’
[ Str ’:=’ ] <expression (IN) of string> ’,’
[ ChPos ’:=’ ] <expression (IN) of num> ’,’
[ Pattern’:=’ ] <expression (IN) of string>
’)’
Related information
Described in:
String functions RAPID Summary - String Functions
Definition of string Data Types - string
String values Basic Characteristics -
Basic Elements
Example
VAR bool memb;
memb := StrMemb("Robotics",2,"aeiou");
The variable memb is given the value TRUE, as o is a member of the set "aeiou".
memb := StrMemb("Robotics",3,"aeiou");
The variable memb is given the value FALSE, as b is not a member of the set
"aeiou".
TRUE if the character at the specified position in the specified string belongs to the
specified set of characters.
Arguments
StrMemb (Str ChPos Set)
Str (String) Data type: string
Syntax
StrMemb’(’
[ Str ’:=’ ] <expression (IN) of string> ’,’
[ ChPos ’:=’ ] <expression (IN) of num> ’,’
[ Set’:=’ ] <expression (IN) of string>
’)’
Related information
Described in:
String functions RAPID Summary - String Functions
Definition of string Data Types - string
String values Basic Characteristics -
Basic Elements
Example
VAR bool le;
le := StrOrder("FIRST","SECOND",STR_UPPER);
The variable le is given the value TRUE, because "FIRST" comes before
"SECOND" in the character ordering sequence STR_UPPER.
TRUE if the first string comes before the second string (Str1 <= Str2) when characters
are ordered as specified.
Characters that are not included in the defined ordering are all assumed to follow the
present ones.
Arguments
StrOrder ( Str1 Str2 Order)
Str1 (String 1) Data type: string
Syntax
StrOrder’(’
[ Str1 ’:=’ ] <expression (IN) of string> ’,’
[ Str2 ’:=’ ] <expression (IN) of string> ’,’
[ Order ’:=’ ] <expression (IN) of string>
’)’
Related information
Described in:
String functions RAPID Summary - String Functions
Definition of string Data Types - string
String values Basic Characteristics -
Basic Elements
Example
VAR string part;
part := StrPart("Robotics",1,5);
The substring of the specified string, which has the specified length and starts at the
specified character position.
Arguments
StrPart (Str ChPos Len)
Str (String) Data type: string
Start character position. A runtime error is generated if the position is outside the
string.
Syntax
StrPart’(’
[ Str ’:=’ ] <expression (IN) of string> ’,’
[ ChPos ’:=’ ] <expression (IN) of num> ’,’
[ Len’:=’ ] <expression (IN) of num>
’)’
Related information
Described in:
String functions RAPID Summary - String Functions
Definition of string Data Types - string
String values Basic Characteristics -
Basic Elements
Example
VAR string con_data_buffer{5} := ["10", "AE", "176", "00001010", "A"];
VAR byte data_buffer{5};
data_buffer{1} := StrToByte(con_data_buffer{1});
The content of the array component data_buffer{1} will be 10 decimal after the
StrToByte ... function.
data_buffer{2} := StrToByte(con_data_buffer{2}\Hex);
The content of the array component data_buffer{2} will be 174 decimal after the
StrToByte ... function.
data_buffer{3} := StrToByte(con_data_buffer{3}\Okt);
The content of the array component data_buffer{3} will be 126 decimal after the
StrToByte ... function.
data_buffer{4} := StrToByte(con_data_buffer{4}\Bin);
The content of the array component data_buffer{4} will be 10 decimal after the
StrToByte ... function.
data_buffer{5} := StrToByte(con_data_buffer{5}\Char);
The content of the array component data_buffer{5} will be 65 decimal after the
StrToByte ... function.
Arguments
StrToByte (ConStr [\Hex] | [\Okt] | [\Bin] | [\Char])
ConStr (Convert String) Data type: string
If the optional switch argument is omitted, the string to be converted has decimal (Dec)
format.
Limitations
Depending on the format of the string to be converted, the following string data
is valid:
(*) RAPID character codes (e.g. "\07" for BEL control character) can be used as
arguments in ConStr.
Syntax
StrToByte’(’
[ConStr ’:=’] <expression (IN) of string>
[’\’ Hex ] | [’\’ Okt] | [’\’ Bin] | [’\’ Char]
’)’ ’;’
Related information
Described in:
Convert a byte to a string data Instructions - ByteToStr
Other bit (byte) functions RAPID Summary - Bit Functions
Other string functions RAPID Summary - String Functions
Example
VAR bool ok;
VAR num nval;
ok := StrToVal("3.85",nval);
The variable ok is given the value TRUE and nval is given the value 3.85.
Arguments
StrToVal ( Str Val )
Str (String) Data type: string
A string value containing literal data with format corresponding to the data type
used in argument Val. Valid format as for RAPID literal aggregates.
Name of the variable or persistent of any data type for storage of the result from
the conversion. The data is unchanged if the requested conversion failed.
Example
VAR string 15 := “[600, 500, 225.3]”;
VAR bool ok;
VAR pos pos15;
ok := StrToVal(str15,pos15);
The variable ok is given the value TRUE and the variable p15 is given the value
that are specified in the string str15.
Syntax
StrToVal’(’
[ Str ’:=’ ] <expression (IN) of string> ’,’
[ Val ’:=’ ] <var or pers (INOUT) of ANYTYPE>
’)’
Related information
Described in:
String functions RAPID Summary - String Functions
Definition of string Data Types - string
String values Basic Characteristics -
Basic Elements
Example
VAR num angle;
VAR num value;
.
.
value := Tan(angle);
Arguments
Tan (Angle)
Angle Data type: num
Syntax
Tan’(’
[Angle ’:=’] <expression (IN) of num>
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Arc tangent with return value in the
range [-180, 180] Functions - ATan2
Example of resources that can need protection from access at the same time:
Example
MAIN program task:
To avoid mixing up the lines, one from MAIN and one from BACK1, the use of the
TestAndSet function guarantees that all three lines from each task are not separated.
Arguments
TestAndSet Object
Object Data type: bool
User defined data object to be used as semaphore. The data object could be a VAR
or a PERS. If TestAndSet are used between different program tasks, the object
must be a PERS or an installed VAR (intertask objects).
Program execution
This function will in one indivisible step check the user defined variable and, if it is
unset, will set it and return TRUE, otherwise it will return FALSE.
Example
LOCAL VAR bool doit_inuse := FALSE;
...
PROC doit(...)
WaitUntil TestAndSet (doit_inuse);
....
doit_inuse := FALSE;
ENDPROC
Note in this case: If program execution is stopped in the routine doit and the
program pointer is moved to main, the variable doit_inuse will not be reset. To
avoid this, reset the variable doit_inuse to FALSE in the START event routine.
Syntax
TestAndSet ’(’
[ Object ’:=’ ] < variable or persistent (INOUT) of bool> ’)’
Related information
Described in:
Built-in and shared module User’s Guide - System parameters
Intertask objects RAPID Developer’s Manual -
RAPID Kernel Reference Manual -
Intertask objects
Examples
Program execution continues only after both the di1 input and the di2 input have
been set.
Arguments
TestDI (Signal)
Signal Data type: signaldi
Syntax
TestDI ’(’
[ Signal ’:=’ ] < variable (VAR) of signaldi > ’)’
Related information
Described in:
Reading the value of a digital input signal Functions - DInput
Input/Output instructions RAPID Summary -
Input and Output Signals
Example
VAR num val;
val := Trunc(0.38521\Dec:=3);
reg1 := 0.38521
val := Trunc(reg1\Dec:=1);
val := Trunc(0.38521);
Arguments
Trunc ( Val [\Dec] )
Val (Value) Data type: num
Number of decimals.
The number of decimals must not be negative or greater than the available pre-
cision for numeric values.
Syntax
Trunc’(’
[ Val ’:=’ ] <expression (IN) of num>
[ \Dec ’:=’ <expression (IN) of num> ]
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
Rounding a value Functions - Round
This function returns the momentary value or the mean value of the latest samples,
depending on channel specification in instruction TestSignDefine.
Example
CONST num speed_channel;
VAR num speed_value;
...
TestSignDefine speed_channel, speed, orbit, 1, 0;
...
! During some movements with orbit’s axis 1
speed_value := TestSignRead(speed_channel);
...
TestSignReset;
speed_value is assigned the mean value of the latest 8 samples generated each
0.5s of the test signal speed on channel speed_channel.
The channel speed_channel measures the speed of axis 1 on the mechanical unit
orbit.
The numeric value in SI units on the motor side for the specified channel according to
the definition in instruction TestSignDefine.
Arguments
TestSignRead (Channel)
Channel Data type: num
Program execution
Returns the momentary value or the mean value of the latest samples, depending on the
channel specification in the instruction TestSignDefine.
For predefined test signals with valid SI units for external manipulator axes, see data
type testsignal.
Example
CONST num torque_channel;
VAR num torque_value;
VAR intnum timer_int;
CONST jointtarget psync := [...];
...
CONNECT timer_int WITH TorqueTrap;
ITimer \Single, 0.05, timer_int;
TestSignDefine torque_channel, torque_ref, IRBP_K, 2, 0.001;
...
MoveAbsJ psync \NoEOffs, v5, fine, tool0;
...
IDelete timer_int;
TestSignReset;
TRAP TorqueTrap
IF (TestSignRead(torque_channel) > 6) THEN
TPWrite “Torque pos = “ + ValToStr(CJointT());
Stop;
EXIT;
ELSE
IDelete timer_int;
CONNECT timer_int WITH TorqueTrap;
ITimer \Single, 0.05, timer_int;
ENDIF
ENDTRAP
The joint position, when the torque reference for manipulator IRBP_K axis 2 is
for the first time greater than 6 Nm on the motor side during the slow movement
to position psync, is displayed on the Operators Window on the TP.
Syntax
TestSignRead’(’
[ Channel ’:=’] <expression (IN) of num>’)’
Related information
Described in:
Define test signal Instructions - TestSignDefine
Reset test signals Instructions - TestSignReset
Example
VAR string str;
VAR pos p := [100,200,300];
str := ValToStr(1.234567);
str := ValToStr(TRUE);
str := ValToStr(p);
The value is converted to a string with standard RAPID format. This means in principle
6 significant digits. If the decimal part is less than 0.000005 or greater than 0.999995,
the number is rounded to an integer.
Arguments
ValToStr ( Val )
Val (Value) Data type: ANYTYPE
Syntax
ValToStr’(’
[ Val ’:=’ ] <expression (IN) of ANYTYPE>
’)’
Related information
Described in:
String functions RAPID Summary - String Functions
Definition of string Data Types - string
String values Basic Characteristics -
Basic Elements
Example
z A
Az
y
Ay
x
Ax
A vector A can be written as the sum of its components in the three orthogonal direc-
tions:
A = Ax x + Ay y + Az z
The vector is described by the data type pos and the magnitude by the data type num:
Arguments
VectMagn (Vector)
Vector Data type: pos
Syntax
VectMagn’(’
[Vector ’:=’] <expression (IN) of pos>
’)’
Related information
Described in:
Mathematical instructions and functions RAPID Summary - Mathematics
A start 159
stop 161
Abs 517 Close 155, 163
absolute value 517 comment 165
acceleration reduction 135 common drive unit 137, 173
AccSet 135 Compact IF 205
ACos 519 condition 207
ActUnit 137 confdata 13
Add 139 ConfJ 167
AliasIO 141 ConfL 169
analog output CONNECT 171
set 365 corner path 81, 121
AOutput 521 Cos 547
arcus cosine 519 CPos 549
arcus sine 523 CRobT 537, 551
arcus tangent 525, 527 CTime 553
arithmetic 133 CTool 555
array CWobj 557
get size 567
ASin 523 D
assignment 133
ATan 525 date 541
ATan2 527 DeactUnit 173
Decr 175
B decrease velocity 477
decrement 175
bit manipulation 9 DefDFrame 559
bool 7 DefFrame 563
Break 145 digital output 573
byte 9 pulse 323
C reset 333
set 363, 367
C_MOTSET 95 Dim 567
C_PROGDISP 95 dionum 21
call 147 displace
CallByVar 149 position 599
CDate 541 displacement
circular movement 269, 275, 279 tool direction 637
CJointT 533, 543 displacement frame 559, 563
Clear 153 DotProd 571, 595, 683
ClkRead 545 DOutput 573
ClkReset 157
ClkStart 159 E
ClkStop 161 EOffsOff 177
clock 11 EOffsOn 179
read 545 EOffsSet 181
reset 157 erase teach pendant display 403
N quaternion 56
num 51 R
numeric value 51
RAISE 327
NumToStr 597
read
O clock 545
current date 541
o_jointtarget 53 current joint angles 533, 543
object coordinate system 113 current robot position 537, 551
Offs 599 current time 553, 585
offset 599 current tool data 555
Open current work object 557
file 307 digital output 573
serial channel 307 file 617, 623, 627, 633
operating mode function key 405
read 601 group of outputs 521, 583
OpMode 601 serial channel 617, 623, 627, 633
orient 55 ReadBin 617
OrientZYX 603 ReadMotor 621
ORobT 605 ReadNum 623
output ReadStr 627, 633
at a position 435 RelTool 527, 563, 601, 613, 637, 641
repeat 189, 479
P Reset 333
path resolution RestoPath 335
change 311 RETRY 337
PathResol 311 RETURN 339
payload 37 Rewind 341
robot position 59, 69
wait
a specific time 473
any condition 475
digital input 465
digital output 467
until the robot is in position 473
WaitDI 465
WaitDO 467
WaitTime 473
WaitUntil 475
WHILE 479
wobjdata 113
work object 113
Write 481
write
error message 183
on the teach pendant 413, 415
WriteBin 487
WriteStrBin 329, 485, 491
WZBoxDef 493
WZCylDef 495
WZDisable 499
WZDOSet 501
WZEnable 505
WZFree 507
WZLimSup 509
WZSphDef 513
wzstationary 117
wztemporary 119
Introduction
RAPID Summary
RAPID Overview
Basic Characteristics
Programming Off-line
Index, Glossary
The information in this document is subject to change without notice and should not be construed as a commitment
by ABB Robotics AB. ABB Robotics AB assumes no responsibility for any errors that may appear in this document.
In no event shall ABB Robotics AB be liable for incidental or consequential damages arising from use of this doc-
ument or of the software and hardware described in this document.
This document and parts thereof must not be reproduced or copied without ABB Robotics AB´s written permission,
and contents thereof must not be imparted to a third party nor be used for any unauthorized purpose. Contraven-
tion will be prosecuted.
Additional copies of this document may be obtained from ABB Robotics AB at its then current charge.
© ABB Robotics AB
ABB Robotics AB
S-721 68 Västerås
Sweden
RAPID Overview
CONTENTS
Page
5 Data................................................................................................................................... 4-21
5.1 Data scope............................................................................................................... 4-21
5.2 Variable declaration ................................................................................................ 4-22
5.3 Persistent declaration.............................................................................................. 4-23
5.4 Constant declaration ............................................................................................... 4-23
5.5 Initiating data.......................................................................................................... 4-24
5.6 Storage Class .......................................................................................................... 4-24
5.7 Syntax ..................................................................................................................... 4-25
6 Instructions ...................................................................................................................... 4-27
6.1 Syntax ..................................................................................................................... 4-27
7 Expressions ...................................................................................................................... 4-29
7.1 Arithmetic expressions ........................................................................................... 4-29
7.2 Logical expressions ................................................................................................ 4-30
7.3 String expressions................................................................................................... 4-30
7.4 Using data in expressions ....................................................................................... 4-31
7.5 Using aggregates in expressions............................................................................. 4-32
7.6 Using function calls in expressions ........................................................................ 4-32
7.7 Priority between operators...................................................................................... 4-33
7.8 Syntax ..................................................................................................................... 4-34
8 Error Recovery................................................................................................................ 4-37
8.1 Error handlers ......................................................................................................... 4-37
9 Interrupts ......................................................................................................................... 4-39
9.1 Interrupt manipulation ............................................................................................ 4-39
9.2 Trap routines ........................................................................................................... 4-40
10 Backward execution ...................................................................................................... 4-41
10.1 Backward handlers ............................................................................................... 4-41
10.2 Limitation of move instructions in the backward handler.................................... 4-42
11 Multitasking ................................................................................................................... 4-43
11.1 Synchronising the tasks ........................................................................................ 4-44
11.2 Intertask communication ...................................................................................... 4-45
11.3 Type of task........................................................................................................... 4-46
11.4 Priorities................................................................................................................ 4-47
11.5 Trust Level ............................................................................................................ 4-48
11.6 Task sizes .............................................................................................................. 4-48
11.7 Something to think about...................................................................................... 4-48
11.8 Programming scheme ........................................................................................... 4-49
5 Motion and I/O Principles .......................................................................... 5-1
1 Introduction
This is a reference manual containing a detailed explanation of the programming
language as well as all data types, instructions and functions. If you are program-
ming off-line, this manual will be particularly useful in this respect.
When you start to program the robot it is normally better to start with the User’s
Guide until you are familiar with the system.
The Product Manual describes how to install the robot, as well as maintenance pro-
cedures and troubleshooting. This manual also contains a Product Specification
which provides an overview of the characteristics and performance of the robot.
RAPID Overview Chapter 4: Basic Characteristics explains the inner details of the
language. You would not normally read this chapter unless you are an experienced
programmer.
RAPID Overview Chapter 5: Motion and I/O Principles describes the various coor-
dinate systems of the robot, its velocity and other motion characteristics during differ-
ent types of execution.
System DataTypes and Routines Chapters 1-3 describe all data types, instructions
and functions. They are described in alphabetical order for your convenience.
This manual describes all the data and programs provided with the robot on deliv-
ery. In addition to these, there are a number of predefined data and programs sup-
plied with the robot, either on diskette or, or sometimes already loaded.
RAPID Overview Chapter 7: Predefined Data and Programs describes what hap-
pens when these are loaded into the robot.
If you program off-line, you will find some tips in RAPID Overview Chapter 6: Pro-
gramming off-line.
To make things easier to locate and understand, RAPID Overview chapter 8 con-
tains an Index, Glossary and System DataTypes and Routines Chapter 4 contains an
index.
Typographic conventions
The commands located under any of the five menu keys at the top of the teach pen-
dant display are written in the form of Menu: Command. For example, to activate
the Print command in the File menu, you choose File: Print.
The names on the function keys and in the entry fields are specified in bold italic
typeface, e.g. Modpos.
Examples of programs are always displayed in the same way as they are output to a
diskette or printer. This differs from what is displayed on the teach pendant in the
following ways:
- Certain control words that are masked in the teach pendant display are
printed, e.g. words indicating the start and end of a routine.
- Data and routine declarations are printed in the formal form,
e.g. VAR num reg1;.
Syntax rules
Instructions and functions are described using both simplified syntax and formal
syntax. If you use the teach pendant to program, you generally only need to know
the simplified syntax, since the robot automatically makes sure that the correct syn-
tax is used.
Simplified syntax
Example:
Formal syntax
Example: TPWrite
[String’:=’] <expression (IN) of string>
[’\’Num’:=’ <expression (IN) of num> ] |
[’\’Bool’:=’ <expression (IN) of bool> ] |
[’\’Pos’:=’ <expression (IN) of pos> ] |
[’\’Orient’:=’ <expression (IN) of orient> ]’;’
The basic elements of the language and certain instructions are written using a special
syntax, EBNF. This is based on the same rules, but with some additions.
The instructions generally have a number of associated arguments which define what
is to take place in a specific instruction. For example, the instruction for resetting an
output contains an argument which defines which output is to be reset; e.g. Reset do5.
These arguments can be specified in one of the following ways:
There are three types of routines – procedures, functions and trap routines.
Information can also be stored in data, e.g. tool data (which contains all information on
a tool, such as its TCP and weight) and numerical data (which can be used, for example,
to count the number of parts to be processed). Data is grouped into different data types
which describe different types of information, such as tools, positions and loads. As
this data can be created and assigned arbitrary names, there is no limit (except that
imposed by memory) on the number of data. These data can exist either globally in the
program or locally within a routine.
- A constant represents a static value and can only be assigned a new value man-
ually.
- A variable can also be assigned a new value during program execution.
- A persistent can be described as a “persistent” variable. When a program is
saved the initialization value reflects the current value of the persistent.
- Routine parameters
- Arithmetic and logical expressions
- Automatic error handling
- Modular programs
- Multi tasking
- By calling another routine (procedure) and, when that routine has been
executed, continuing execution with the instruction following the routine call.
- By executing different instructions depending on whether or not a given
condition is satisfied.
- By repeating a sequence of instructions a number of times or until a given
condition is satisfied.
- By going to a label within the same routine.
- By stopping program execution.
3 Various Instructions
Various instructions are used to
3.2 Wait
The robot can be programmed to wait a given amount of time, or to wait until an arbi-
trary condition is satisfied; for example, to wait until an input is set.
3.3 Comments
Comments are only inserted into the program to increase its readability. Program exe-
cution is not affected by a comment.
4 Motion Settings
Some of the motion characteristics of the robot are determined using logical
instructions that apply to all movements:
The general motion settings are specified using a number of instructions, but can also
be read using the system variable C_MOTSET or C_PROGDISP.
Default values are automatically set (by executing the routine SYS_RESET in system
module BASE)
- at a cold start-up,
- when a new program is loaded,
- when the program is started from the beginning.
- Indicating that the robot’s TCP is a definite part of the working area.
- Delimiting the working area for the robot and preventing a collision with the
tool.
- Creating a working area common to two robots. The working area is then
available only to one robot at a time.
1. Only when the robot is equipped with the option “Advanced functions”
5 Motion
The robot movements are programmed as pose-to-pose movements, i.e. “move from
the current position to a new position”. The path between these two positions is then
automatically calculated by the robot.
The remaining motion characteristics are specified by defining data which are argu-
ments of the instruction:
Some of the motion characteristics of the robot are determined using logical instruc-
tions which apply to all movements (See Motion Settings on page 9):
Both the robot and the external axes are positioned using the same instructions. The
external axes are moved at a constant velocity, arriving at the end position at the same
time as the robot.
5.3 Searching
During the movement, the robot can search for the position of a work object, for exam-
ple. The searched position (indicated by a sensor signal) is stored and can be used later
to position the robot or to calculate a program displacement.
! Digital input
IF di1 = 1 THEN ...
! Analog input
IF ai1 > 5.2 THEN ...
7 Communication
There are four possible ways to communicate via serial channels:
- Messages can be output to the teach pendant display and the user can answer
questions, such as about the number of parts to be processed.
- Character-based information can be written to or read from text files in mass
memory. In this way, for example, production statistics can be stored and proc-
essed later in a PC. Information can also be printed directly on a printer con-
nected to the robot.
- Binary information can be transferred between the robot and a sensor, for exam-
ple.
- Binary information can be transferred between the robot and another computer,
for example, with a link protocol.
Each serial channel or file used must first be opened. On doing this, the channel/file
receives a descriptor that is then used as a reference when reading/writing. The teach
pendant can be used at all times and does not need to be opened.
Both text and the value of certain types of data can be printed.
8 Interrupts
Interrupts are used by the program to enable it to deal directly with an event, regardless
of which instruction is being run at the time.
The program is interrupted, for example, when a specific input is set to one. When this
occurs, the ordinary program is interrupted and a special trap routine is executed.
When this has been fully executed, program execution resumes from where it was
interrupted.
The interrupt identity (variable) is then used to order an interrupt, i.e. to specify the rea-
son for the interrupt. This may be one of the following events:
- All interrupts can be disabled. Any interrupts occurring during this time are
placed in a queue and then automatically generated when interrupts are enabled
again.
- Individual interrupts can be deactivated. Any interrupts occurring during this
time are disregarded.
9 Error Recovery
Many of the errors that occur when a program is being executed can be handled in the
program, which means that program execution does not have to be interrupted. These
errors are either of a type detected by the robot, such as division by zero, or of a type
that is detected by the program, such as errors that occur when an incorrect value is
read by a bar code reader.
If the routine does not have an error handler, a call will be made to the error handler in
the routine that called the routine in question. If there is no error handler there either,
a call will be made to the error handler in the routine that called that routine, and so on
until the internal error handler of the robot takes over and outputs an error message and
stops program execution.
In the error handler, errors can be handled using ordinary instructions. The system data
ERRNO can be used to determine the type of error that has occurred. A return from the
error handler can then take place in various ways.
In future releases, if the current routine does not have an error handler, the internal
error handler of the robot takes over directly. The internal error handler outputs an error
message and stops program execution with the program pointer at the faulty instruc-
tion.
So, a good rule already in this issue is as follows: if you want to call the error handler
of the routine that called the current routine (propagate the error), then:
The current time or date can be retrieved in a string. This string can then be displayed
to the operator on the teach pendant display or used to time and date-stamp log files.
It is also possible to retrieve components of the current system time as a numeric value.
This allows the robot program to perform an action at a certain time or on a certain day
of the week.
11 Mathematics
Mathematical instructions and functions are used to calculate and change the value of
data.
12 Spot Welding
The SpotWare package provides support for spot welding applications that are
equipped with a weld timer and on/off weld gun.
The SpotWare application provides fast and accurate positioning combined with gun
manipulation, process start and supervision of an external weld timer.
Communication with the welding equipment is carried out by means of digital inputs
and outputs. Some serial weld timer interfaces are also supported: Bosch PSS5000,
NADEX, ABB Timer. See separate documentation.
The tasks work with their own internal encapsulated variables and with persistents
which are fully transparent for all tasks.
For well defined entries, calls to user routines offer adaptations to the plant
environment. A number of predefined parameters are also available to shape the
behaviour of the SpotL/J instruction.
A program stop will only stop the motion task execution. The process and supervision
carry on their tasks until they come to a well defined process stop. For example, this
will finish the weld and open the gun, although the program has stopped.
The opening and closing of the gun are always executed by RAPID routines, even if
activated manually from the I/O window on the teach-pendant. These gun routines may
be changed from the simple on/off default functionality to a more complex like analog
gun control and they may contain additional gun supervision.
Since the process and supervision tasks are acting on I/O triggers, they will be executed
either by the trig that was sent by the motion (SpotL/J) or by manual activation (teach
pendant or external). This offers the possibility of performing a stand-alone weld
anywhere without programming a new position.
It is also possible to define new supervision events and to connect them to digital signal
triggers. By default, a state dependent weld power and water cooling signal control are
implemented.
Supported equipment:
- One weld timer monitoring with standard parallel (some serial) interface. The
weld timer may be of the type, program schedule or start signal triggered.
Both the robot’s joint movement and the spot weld process control are embedded in one
instruction, SpotJ.
13 Arc Welding
The ArcWare package supports most welding functions. Crater-filling and scraping
starts can, for example, be programmed. Using ArcWare, the whole welding process
can be controlled and monitored by the robot via a number of different digital and ana-
log inputs and outputs.
The weld settings for the actual weld phase are defined in weld data. The start and end
phase are defined in seam data.
Any weaving is defined in weave data, which is also identified by the arc welding
instruction.
Certain functions, such as a scraping start, are defined in the system parameters.
14 GlueWare
The GlueWare package provides support for gluing applications that are equipped with
one or two gluing guns.
The GlueWare application provides fast and accurate positioning combined with gun
manipulation, process start and stop.
Communication with the glueing equipment is carried out by means of digital and ana-
log outputs.
1. Only if the robot is equipped with the option “RAP Serial Link”.
1. Only when the robot is equipped with the option “Advanced functions”
17 Service Instructions
A number of instructions are available to test the robot system. See the chapter on
Troubleshooting Tools in the Product Manual for more information.
18 String Functions
String functions are used for operations with strings such as copying, concatenation,
comparison, searching, conversion, etc.
18.3 Conversion
Function Used to:
NumToStr Convert a numeric value to a string
ValToStr Convert a value to a string
StrToVal Convert a string to a value
StrMap Map a string
StrToByte Convert a string to a byte
ByteToStr Convert a byte to string data
19 Multitasking
Multitasking RAPID is a way to execute programs in (pseudo) parallel with the
normal execution. One parallel program can be placed in the background or foreground
of another program. It can also be on the same level as another program.
(See Basic Characteristics Multitasking.)
19.1 Basics
To use this function the robot must be configured with one extra TASK for each back-
ground program.
Up to 10 different tasks can be run in pseudo parallel. Each task consists of a set of
modules, in the same way as the normal program. All the modules are local in each
task.
Variables and constants are local in each task, but persistents are not. A persistent with
the same name and type is reachable in all tasks. If two persistents have the same name,
but their type or size (array dimension) differ, a runtime error will occur.
A task has its own trap handling and the event routines are triggered only on its own
task system states (e.g. Start/Stop/Restart....).
20 Syntax Summary
20.1 Instructions
Data := Value
AccSet Acc Ramp
ActUnit MecUnit
Add Name AddValue
ArcRefresh
ArcKill
Break
CallBy Var Name Number
Clear Name
ClkReset Clock
ClkStart Clock
ClkStop Clock
Close IODevice
! Comment
ConfJ [\On] | [\Off]
ConfL [\On] | [\Off]
CONNECT Interrupt WITH Trap routine
CorrClear
CorrCon Descr
CorrDiscon Descr
CorrWrite
CorrWrite Descr Data
CorrClear
DeactUnit MecUnit
Decr Name
DropWObj WObj
EOffsSet EAxOffs
ErrWrite [ \W ] Header Reason [ \RL2] [ \RL3] [ \RL4]
Exit
ExitCycle
FOR Loop counter FROM Start value TO End value
[STEP Step value] DO ... ENDFOR
GOTO Label
GripLoad Load
GetSysData DestObject [\ ObjectName ]
IDelete Interrupt
IF Condition ...
IF Condition THEN ...
{ELSEIF Condition THEN ...}
[ELSE ...]
ENDIF
Incr Name
IndAMove MecUnit Axis [ \ToAbsPos ] | [ \ToAbsNum ] Speed
[ \Ramp ]
InvertDO Signal
IODisable UnitName MaxTime
IOEnable UnitName MaxTime
ISignalDI [ \Single ] Signal TriggValue Interrupt
ISignalDO [ \Single ] Signal TriggValue Interrupt
ISleep Interrupt
ITimer [ \Single ] Time Interrupt
IVarValue VarNo Value, Interrupt
IWatch Interrupt ParIdType LoadIdType Tool [\PayLoad] [\WObj]
[\ConfAngle] [\SlowTest] [\Accuracy]
LoadId ParIdType LoadIdType Tool [\PayLoad] [\WObj]
[\ConfAngle] [\SlowTest] [\Accuracy]
MechUnitLoad MechUnit AxisNo Load
MoveAbsJ [ \Conc ] ToJointPos Speed [ \V ] | [ \T ] Zone [ \Z]
Tool [ \WObj ]
MoveC [ \Conc ] CirPoint ToPoint Speed [ \V ] | [ \T ] Zone [ \Z]
Tool [ \WObj ]
MoveCDO CirPoint ToPoint Speed [ \T ] Zone Tool [\WObj ]
Signal Value
SpcDiscon Descr
SpcDump
SpcRead
SpcStat
SpotJ
SpotML
Stop [ \NoRegain ]
TEST Test data {CASE Test value {, Test value} : ...}
[ DEFAULT: ...] ENDTEST
TestSignDefine Channel SignalId MechUnit Axis SampleTime
TestSignReset
TPReadFK Answer String FK1 FK2 FK3 FK4 FK5 [\MaxTime]
[\DIBreak] [\BreakFlag]
TPReadNum Answer String [\MaxTime] [\DIBreak] [\BreakFlag]
TPShow Window
TPWrite String [\Num] | [\Bool] | [\Pos] | [\Orient]
TriggC CirPoint ToPoint Speed [ \T ] Trigg_1 [ \T2 ] [ \T3 ]
[ \T4] Zone Tool [ \WObj ]
TriggEqip
TriggInt TriggData Distance [ \Start ] | [ \Time ] Interrupt
20.2 Functions
Abs (Input)
ACos (Value)
AOutput (Signal)
ArgName (Parameter)
ASin (Value)
ATan (Value)
ATan2 (Y X)
ByteToStr (ByteData [\Hex] | [\Okt] | [\Bin] | [\Char])
ClkRead (Clock)
CorrRead
Cos (Angle)
CPos ([Tool] [\WObj])
CRobT ([Tool] [\WObj])
DefDFrame (OldP1 OldP2 OldP3 NewP1 NewP2 NewP3)
DefFrame (NewP1 NewP2 NewP3 [\Origin])
Dim (ArrPar DimNo)
DOutput (Signal)
DotProd (Vector1 Vector2)
EulerZYX ([\X] | [\Y] | [\Z] Rotation)
Exp (Exponent)
GOutput (Signal)
GetTime ( [\WDay] | [\Hour] | [\Min] | [\Sec] )
IndInpos MecUnit Axis
IndSpeed MecUnit Axis [\InSpeed] | [\ZeroSpeed]
IsPers (DatObj)
IsVar (DatObj)
MirPos (Point MirPlane [\WObj] [\MirY])
ModTime ( Object )
NOrient (Rotation)
Sin (Angle)
Sqrt (Value)
StrFind (Str ChPos Set [\NotInSet])
StrLen (Str)
StrMap ( Str FromMap ToMap)
StrMatch (Str ChPos Pattern)
StrMemb (Str ChPos Set)
StrOrder ( Str1 Str2 Order)
StrPart (Str ChPos Len)
StrToByte (ConStr [\Hex] | [\Okt] | [\Bin] | [\Char])
StrToVal ( Str Val )
Tan (Angle)
TestDI (Signal)
TestAndSet Object
TestSignRead (Channel)
Trunc ( Val [\Dec] )
ValToStr ( Val )
VectMagn (Vector)
1 Basic Elements
1.1 Identifiers
Identifiers are used to name modules, routines, data and labels;
e.g. MODULE module_name
PROC routine_name()
VAR pos data_name;
label_name:
The first character in an identifier must be a letter. The other characters can be letters,
digits or underscores “_”.
The maximum length of any identifier is 16 characters, each of these characters being
significant. Identifiers that are the same except that they are typed in the upper case,
and vice versa, are considered the same.
Reserved words
The words listed below are reserved. They have a special meaning in the RAPID
language and thus must not be used as identifiers.
There are also a number of predefined names for data types, system data, instructions,
and functions, that must not be used as identifiers. See Chapters 7, 8, 9, 10 ,13, 14 and
15 in this manual.
1.6 Comments
Comments are used to make the program easier to understand. They do not affect the
meaning of the program in any way.
A comment starts with an exclamation mark “!” and ends with a new-line character. It
occupies an entire line and cannot occur between two modules;
e.g. ! comment
IF reg1 > 5 THEN
! comment
reg2 := 0;
ENDIF
1.7 Placeholders
Placeholders can be used to temporarily represent parts of a program that are “not yet
defined”. A program that contains placeholders is syntactically correct and may be
loaded into the program memory.
Placeholder Represents:
<TDN> data type definition
<DDN> data declaration
<RDN> routine declaration
<PAR> formal optional alternative parameter
<ALT> optional formal parameter
<DIM> formal (conformant) array dimension
<SMT> instruction
<VAR> data object (variable, persistent or parameter) reference
<EIT> else if clause of if instruction
<CSE> case clause of test instruction
<EXP> expression
<ARG> procedure call argument
<ID> identifier
1.9 Syntax
Identifiers
<identifier> ::=
<ident>
| <ID>
<ident> ::= <letter> {<letter> | <digit> | ’_’}
Numeric values
Logical values
String values
Comments
<comment> ::=
’!’ {<character> | <tab>} <newline>
Characters
2 Modules
The program is divided into program and system modules. The program can also be
divided into modules (see Figure 1).
Program memory
Program
Program data
Main routine
Main module
Routine1
Module1
Routine2
Module2
Routine3
Module3
Module4
Program data
Routine4
Routine5
System module1
Program data
Routine7
One of the modules contains the entry procedure, a global procedure called main. Exe-
cuting the program means, in actual fact, executing the main procedure. The program
can include many modules, but only one of these will have a main procedure.
A module may, for example, define the interface with external equipment or contain
geometrical data that is either generated from CAD systems or created on-line by dig-
itizing (teach programming).
Whereas small installations are often contained in one module, larger installations may
have a main module that references routines and/or data contained in one or several
other modules.
A module may not have the same name as another module or a global routine or data.
2.4 Syntax
Module declaration
(Note. If two or more attributes are used they must be in the above order, the
NOVIEW attribute can only be specified alone or together with the attribute
SYSMODULE.)
3 Routines
There are three types of routines (subprograms): procedures, functions and traps.
- Procedures do not return a value and are used in the context of instructions.
- Functions return a value of a specific type and are used in the context of
expressions.
- Trap routines provide a means of dealing with interrupts. A trap routine can be
associated with a specific interrupt and then, if that particular interrupt occurs
at a later stage, will automatically be executed. A trap routine can never be
explicitly called from the program.
The following scope rules apply to routines (see the example in Figure 2):
Module1 Module2
Routine c Routine f
Routine d Routine g
Routine e Routine h
A routine may not have the same name as another routine or data in the same module.
A global routine may not have the same name as a module or a global routine or global
data in another module.
3.2 Parameters
The parameter list of a routine declaration specifies the arguments (actual parameters)
that must/can be supplied when the routine is called.
There are four different types of parameters (in the access mode):
If an INOUT, VAR or PERS parameter is updated, this means, in actual fact, that the
argument itself is updated, i.e. it makes it possible to use arguments to return values to the
calling routine.
A parameter can be optional and may be omitted from the argument list of a routine
call. An optional parameter is denoted by a backslash “\” before the parameter.
The value of an optional parameter that is omitted in a routine call may not be
referenced. This means that routine calls must be checked for optional parameters
before an optional parameter is used.
Two or more optional parameters may be mutually exclusive (i.e. declared to exclude
each other), which means that only one of them may be present in a routine call. This
is indicated by a stroke “|” between the parameters in question.
The special type, switch, may (only) be assigned to optional parameters and provides a
means to use switch arguments, i.e. arguments that are only specified by names (not
values). A value cannot be transferred to a switch parameter. The only way to use a
switch parameter is to check for its presence using the predefined function, Present.
Arrays may be passed as arguments. The degree of an array argument must comply
with the degree of the corresponding formal parameter. The dimension of an array
parameter is “conformant” (marked with “*”). The actual dimension thus depends on
the dimension of the corresponding argument in a routine call. A routine can determine
the actual dimension of a parameter using the predefined function, Dim.
The execution of a trap routine is explicitly terminated using the RETURN instruction
or implicitly terminated when the end (ENDTRAP or ERROR) of that trap routine is
reached. Execution continues from the point where the interrupt occurred.
Module
Data declarations
Routine a
Routine declaration
Routine b
Data declarations
Routine c
Body (Instructions)
Routine d
Backward handler
Routine e
Error handler
Figure 3 A routine can contain declarations, data, a body, a backward handler and an error
handler.
Procedure declaration
Function declaration
A function can return any data type value, but not an array value.
Trap declaration
TRAP feeder_empty
wait_feeder;
RETURN;
ENDTRAP
See the Chapter Using function calls in expressions on page 32 for more details.
The procedure name may either be statically specified by using an identifier (early
binding) or evaluated during runtime from a string type expression (late binding). Even
though early binding should be considered to be the “normal” procedure call form, late
binding sometimes provides very efficient and compact code. Late binding is defined
by putting percent signs before and after the string that denotes the name of the
procedure.
Note that the late binding is available for procedure calls only, and not for function
calls. If a reference is made to an unknown procedure using late binding, the system
variable ERRNO is set to ERR_REFUNKPRC. If a reference is made to a procedure
call error (syntax, not procedure) using late binding, the system variable ERRNO is set
to ERR_CALLPROC.
3.6 Syntax
Routine declaration
Parameters
Procedure declaration
Function declaration
Procedure call
4 Data Types
There are two different kinds of data types:
- An atomic type is atomic in the sense that it is not defined based on any other
type and cannot be divided into parts or components, e.g. num.
- A record data type is a composite type with named, ordered components, e.g.
pos. A component may be of an atomic or record type.
A specific component of a record data can be accessed by using the name of that
component;
- Initialisation
- Assignment (:=)
- Equal to (=) and not equal to (<>) checks
- TEST instructions
- IN (access mode) parameters in routine calls
- Function (return) data types
The input data types (signalai, signaldi, signalgi) are of the data type semi value. These
data can be used in value-oriented operations, except initialisation and assignment.
In the description of a data type it is only specified when it is a semi value or a non-
value data type.
4.3 Syntax
<type definition>::=
[LOCAL] ( <record definition>
| <alias definition> )
| <comment>
| <TDN>
<record definition>::=
RECORD <identifier>
<record component list> ’;’
ENDRECORD
5 Data
There are three kinds of data: variables, persistents and constants.
A data declaration introduces data by associating a name (identifier) with a data type.
Except for predefined data and loop variables, all data used must be declared.
Data declared outside a routine is called program data. The following scope rules
apply to program data:
- The scope of predefined or global program data may include any module.
- The scope of local program data comprises the module in which it is contained.
- Within its scope, local program data hides any global data or routine with the
same name (including instructions and predefined routines and data).
Program data may not have the same name as other data or a routine in the same
module. Global program data may not have the same name as other global data or a
routine in another module. A persistent may not have the same name as another
persistent in the same program.
Data declared inside a routine is called routine data. Note that the parameters of a
routine are also handled as routine data. The following scope rules apply to routine
data:
Module1 Module2
Routine data may not have the same name as other data or a label in the same routine.
Variables of any type can be given an array (of degree 1, 2 or 3) format by adding
dimensional information to the declaration. A dimension is an integer value greater
than 0.
Variables with value types may be initialised (given an initial value). The expression
used to initialise a program variable must be constant. Note that the value of an
uninitialized variable may be used, but it is undefined, i.e. set to zero.
Persistents of any type can be given an array (of degree 1, 2 or 3) format by adding
dimensional information to the declaration. A dimension is an integer value greater
than 0.
Note that if the value of a persistent is updated, this automatically causes the
initialisation value of the persistent declaration to be updated.
It is possible to declare two persistents with the same name in different modules, if they
are local within the module (PERS LOCAL), without any error being generated by the
system (different data scope). But note the limitation that these two persistents always
have the same current value (use the same storage in the memory).
A constant of any type can be given an array (of degree 1, 2 or 3) format by adding
dimensional information to the declaration. A dimension is an integer value greater
than 0.
In the table below, you can see what is happening in various activities such as warm
start, new program, program start etc.
Table1
Start up Not run Run* Run Not run Not run Not run Not run Not run
routine
SYS_RESET
(with motion
settings)
* Generates an error when there is a semantic error in the actual task program.
Constants, persistents, and module variables are static, i.e. they have the same storage
during the lifetime of a task. This means that any value assigned to an persistent or a
module variable, always remains unchanged until the next assignment.
Routine variables are volatile. The memory needed to store the value of a volatile
variable is allocated first upon the call of the routine in which the declaration of the
variable is contained. The memory is later de-allocated at the point of the return to the
caller of the routine. This means that the value of a routine variable is always undefined
before the call of the routine and is always lost (becomes undefined) at the end of the
execution of the routine.
In a chain of recursive routine calls (a routine calling itself directly or indirectly) each
instance of the routine receives its own memory location for the “same” routine
variable - a number of instances of the same variable are created.
5.7 Syntax
Data declaration
Variable declaration
Persistent declaration
Constant declaration
6 Instructions
Instructions are executed in succession unless a program flow instruction or an inter-
rupt or error causes the execution to continue at some other place.
6.1 Syntax
<instruction list> ::= { <instruction> }
<instruction> ::=
[<instruction according to separate chapter in this manual>
| <SMT>
7 Expressions
An expression specifies the evaluation of a value. It can be used, for example:
Example: 2*pi*radius
1. The result receives the same type as the operand. If the operand has an alias
data type, the result receives the alias "base" type (num or pos).
3. Preserves integer (exact) representation as long as operands and result are kept
within the integer subdomain of the num type.
Table 3
a AND b a XOR b
a True False a True False
b b
True True False True False True
False False False False True False
a OR b NOT b
a True False
b b
True True True True False
False True False False True
Table 4
Example: 2*pi*radius
Arrays
An array element is referenced using the index number of the element. The index is an
integer value greater than 0 and may not violate the declared dimension. Index value 1
selects the first element. The number of elements in the index list must fit the declared
degree (1, 2 or 3) of the array.
Records
It must be possible to determine the data type of an aggregate the context. The data type
of each aggregate member must be equal to the type of the corresponding member of
the determined type.
Example: Sin(angle)
The arguments of a function call are used to transfer data to (and possibly from) the
called function. The data type of an argument must be equal to the type of the corre-
sponding parameter of the function. Optional arguments may be omitted but the order
of the (present) arguments must be the same as the order of the formal parameters. In
addition, two or more optional arguments may be declared to exclude each other, in
which case, only one of them may be present in the argument list.
An optional argument must be preceded by a backslash “\” and the formal parameter
name. A switch type argument is somewhat special; it may not include any argument
expression. Instead, such an argument can only be either "present" or "not present".
The parameter list of a function assigns an access mode to each parameter. The access
mode can be either in, inout, var or pers:
An operator with high priority is evaluated prior to an operator with low priority. Oper-
ators of the same priority are evaluated from left to right.
Example
7.8 Syntax
Expressions
<expression> ::=
<expr>
| <EXP>
<expr> ::= [ NOT ] <logical term> { ( OR | XOR ) <logical term> }
<logical term> ::= <relation> { AND <relation> }
<relation> ::= <simple expr> [ <relop> <simple expr> ]
<simple expr> ::= [ <addop> ] <term> { <addop> <term> }
<term> ::= <primary> { <mulop> <primary> }
<primary> ::=
<literal>
| <variable>
| <persistent>
| <constant>
| <parameter>
| <function call>
| <aggregate>
| ’(’ <expr> ’)’
Operators
Constant values
Data
<variable> ::=
<entire variable>
| <variable element>
| <variable component>
<entire variable> ::= <ident>
<variable element> ::= <entire variable> ’{’ <index list> ’}’
<index list> ::= <expr> { ’,’ <expr> }
<variable component> ::= <variable> ’.’ <component name>
<component name> ::= <ident>
<persistent> ::=
<entire persistent>
| <persistent element>
| <persistent component>
<constant> ::=
<entire constant>
| <constant element>
| <constant component>
Aggregates
Function calls
Special expressions
Parameters
<parameter> ::=
<entire parameter>
| <parameter element>
| <parameter component>
8 Error Recovery
An execution error is an abnormal situation, related to the execution of a specific piece
of a program. An error makes further execution impossible (or at least hazardous).
“Overflow” and “division by zero” are examples of errors. Errors are identified by their
unique error number and are always recognized by the robot. The occurrence of an
error causes suspension of the normal program execution and the control is passed to
an error handler. The concept of error handlers makes it possible to respond to and,
possibly, recover from errors that arise during program execution. If further execution
is not possible, the error handler can at least assure that the program is given a graceful
abortion.
The system variable ERRNO contains the error number of the (most recent) error and
can be used by the error handler to identify that error. After any necessary actions have
been taken, the error handler can:
- Resume execution, starting with the instruction in which the error occurred.
This is done using the RETRY instruction. If this instruction causes the same
error again, up to four error recoveries will take place; after that execution will
stop.
- Resume execution, starting with the instruction following the instruction in
which the error occurred. This is done using the TRYNEXT instruction.
- Return control to the caller of the routine using the RETURN instruction. If the
routine is a function, the RETURN instruction must specify an appropriate
return value.
- Propagate the error to the caller of the routine using the RAISE instruction.
When an error occurs in a routine that does not contain an error handler or when the
end of the error handler is reached (ENDFUNC, ENDPROC or ENDTRAP), the
system error handler is called. The system error handler just reports the error and stops
the execution.
In a chain of routine calls, each routine may have its own error handler. If an error
occurs in a routine with an error handler, and the error is explicitly propagated using
the RAISE instruction, the same error is raised again at the point of the call of the
routine - the error is propagated. When the top of the call chain (the entry routine of the
task) is reached without any error handler being found or when the end of any error
handler is reached within the call chain, the system error handler is called. The system
error handler just reports the error and stops the execution. Since a trap routine can only
be called by the system (as a response to an interrupt), any propagation of an error from
a trap routine is made to the system error handler.
Error recovery is not available for instructions in the backward handler. Such errors are
always propagated to the system error handler.
In addition to errors detected and raised by the robot, a program can explicitly raise
errors using the RAISE instruction. This facility can be used to recover from complex
situations. It can, for example, be used to escape from deeply-nested code positions.
Error numbers 1-90 may be used in the raise instruction. Explicitly-raised errors are
treated exactly like errors raised by the system.
Note that it is not possible to recover from or respond to errors that occur within an error
clause. Such errors are always propagated to the system error handler.
9 Interrupts
Interrupts are program-defined events, identified by interrupt numbers. An interrupt
occurs when an interrupt condition is true. Unlike errors, the occurrence of an interrupt
is not directly related to (synchronous with) a specific code position. The occurrence
of an interrupt causes suspension of the normal program execution and control is
passed to a trap routine.
Even though the robot immediately recognizes the occurrence of an interrupt (only
delayed by the speed of the hardware), its response – calling the corresponding trap
routine – can only take place at specific program positions, namely:
The raising of interrupts may be disabled and enabled. If interrupts are disabled, any
interrupt that occurs is queued and not raised until interrupts are enabled again. Note
that the interrupt queue may contain more than one waiting interrupt. Queued
interrupts are raised in FIFO order. Interrupts are always disabled during the execution
of a trap routine.
When running stepwise and when the program has been stopped, no interrupts will be
handled. Interrupts that are generated under these circumstances are not dealt with.
The maximum number of defined interrupts at any one time is limited to 70 per
program task. The total limitation set by the I/O CPU is 100 interrupts.
.PROC main()
Several interrupts may be connected to the same trap routine. The system variable
INTNO contains the interrupt number and can be used by a trap routine to identify an
interrupt. After the necessary action has been taken, a trap routine can be terminated
using the RETURN instruction or when the end (ENDTRAP or ERROR) of the trap
routine is reached. Execution continues from the place where the interrupt occurred.
10 Backward execution
A program can be executed backwards one instruction at a time. The following general
restrictions are valid for backward execution:
- The instructions IF, FOR, WHILE and TEST cannot be executed backwards.
- It is not possible to step backwards out of a routine when reaching the beginning
of the routine.
The backward handler is really a part of the procedure and the scope of any routine data
also comprises the backward handler of the procedure.
PROC MoveTo ()
.. MoveL p1,v500,z10,tool1;
MoveTo; MoveC p2,p3,v500,z10,tool1;
.. MoveL p4,v500,z10,tool1;
BACKWARD
MoveL p4,v500,z10,tool1;
MoveC p2,p3,v500,z10,tool1;
MoveL p1,v500,z10,tool1;
ENDPROC
When the procedure is called during backwards execution, the following occurs:
PROC MoveTo ()
.. MoveL p1,v500,z10,tool1;
MoveTo; MoveC p2,p3,v500,z10,tool1;
.. MoveL p4,v500,z10,tool1;
BACKWARD
MoveL p4,v500,z10,tool1;
MoveC p2,p3,v500,z10,tool1;
MoveL p1,v500,z10,tool1;
ENDPROC
Instructions in the backward or error handler of a routine may not be executed
backwards. Backward execution cannot be nested, i.e. two instructions in a call chain
may not simultaneously be executed backwards.
PROC MoveTo ()
MoveL p1,v500,z10,tool1;
MoveC p2,p3,v500,z10,tool1; Mirror plane
MoveL p4,v500,z10,tool1;
BACKWARD
MoveL p4,v500,z10,tool1;
MoveC p2,p3,v500,z10,tool1;
MoveL p1,v500,z10,tool1;
ENDPROC
Note that the order of CirPoint p2 and ToPoint p3 in the MoveC should be the same.
By move instructions is meant all instructions that result in some movement of the
robot or external axes such as MoveL, SearchC, TriggJ, ArcC, PaintL ...
Any departures from this programming limitation in the backward handler can
result in faulty backward movement. Linear movement can result in circular
movement and vice versa, for some part of the backward path.
11 Multitasking
The events in a robot cell are often in parallel, so why are the programs not in parallel?
Multitasking RAPID is a way to execute programs in (pseudo) parallel with the nor-
mal execution. The execution is started at power on and will continue for ever, unless
an error occurs in that program. One parallel program can be placed in the background
or foreground of another program. It can also be on the same level as another program.
To use this function the robot must be configured with one extra TASK for each back-
ground program.
Up to 10 different tasks can be run in pseudo parallel. Each task consists of a set of
modules, in the same way as the normal program. All the modules are local in each
task.
Variables and constants are local in each task, but persistents are not. A persistent with
the same name and type is reachable in all tasks. If two persistents have the same name,
but their type or size (array dimension) differ, a runtime error will occur.
A task has its own trap handling and the event routines are triggered only on its own
task system states (e.g. Start/Stop/Restart....).
- Do not mix up parallel programs with a PLC. The response time is the same as
the interrupt response time for one task. This is true, of course, when the task is
not in the background of another busy program
- There is only one physical Teach Pendent, so be careful that a TPWrite request
is not mixed in the Operator Window for all tasks.
- When running a Wait instruction in manual mode, a simulation box will come
up after 3 seconds. This will only occur in the main task.
- Move instructions can only be executed in the main task (the task bind to pro-
gram instance 0, see User’s guide - System parameters).
- The execution of a task will halt during the time that some other tasks are
accessing the file system, that is if the operator chooses to save or open a pro-
gram, or if the program in a task uses the load/erase/read/write instructions.
- The Teach Pendent cannot access other tasks than the main task. So, the devel-
opment of RAPID programs for other tasks can only be done if the code is
loaded into the main task, or off-line.
This is the easiest way to do it, but the performance will be the slowest.
Persistents are then used together with the instructions WaitUntil, IF, WHILE or GOTO.
If the instruction WaitUntil is used, it will poll internally every 100 ms. Do not poll
more frequently in other implementations.
Example
TASK 0
MODULE module1
PERS bool startsync:=FALSE;
PROC main()
startsync:= TRUE;
.
ENDPROC
ENDMODULE
TASK 1
MODULE module2
PERS bool startsync:=FALSE;
PROC main()
WaitUntil startsync;
.
ENDPROC
ENDMODULE
Example
TASK 0
MODULE module1
PROC main()
SetDO do1,1;
.
ENDPROC
ENDMODULE
TASK 1
MODULE module2
VAR intnum isiint1;
PROC main()
WHILE TRUE DO
WaitTime 200;
ENDWHILE
IDelete isiint1;
ENDPROC
TRAP isi_trap
ENDTRAP
ENDMODULE
A persistent variable is global in all tasks. The persistent variable must be of the same
type and size (array dimension) in all tasks that declared it. Otherwise a runtime error
will occur.
All declarations must specify an init value to the persistent variable, but only the first
module loaded with the declaration will use it.
Example
TASK 0
MODULE module1
PERS bool startsync:=FALSE;
PERS string stringtosend:=””;
PROC main()
stringtosend:=”this is a test”;
startsync:= TRUE
ENDPROC
ENDMODULE
TASK 1
MODULE module2
PERS bool startsync:=FALSE;
PERS string stringtosend:=””;
PROC main()
WaitUntil startsync;
!read string
IF stringtosend = “this is a test” THEN
ENDPROC
ENDMODULE
It is also possible to set the task to type NORMAL, then it will behave in the same was
as task 0 (the main task, controlling the robot movement). The teach pendent can only
be used to start task 0, so the only way to start other NORMAL tasks is to use Com-
municationWare.
11.4 Priorities
The way to run the tasks as default is to run all tasks at the same level in a round rob-
bin way (one basic step on each instance). But it is possible to change the priority of
one task by putting the task in the background of another. Then the background will
only execute when the foreground is waiting for some events, or has stopped the exe-
cution (idle). A robot program with move instructions will be in an idle state most of
the time.
The example below describes some situations where the system has 10 tasks (see
Figure 5)
chain 1 chain 2
task 0
task 4
task 5 task 6
task 7
chain 4
chain 3
task 8 task 9
SysFail - This is the default behaivour, all other NORMAL tasks (eg the MAIN task)
will also stop, and the system is set to state SYS_FAIL. All jogg and program start
orders will be rejected. Only a new warm start reset the system. This should be used
when the task has some security supervisions.
SysHalt - All NORMAL tasks will be stopped (normaly only the main task). The sys-
tem is forced to “motors off”. When taking up the system to “motors on” it is possible
to jogg the robot, but a new attempt to start the program will be rejected. A new warm
start will reset the system.
SysStop - All NORMAL tasks will be stopped (eg the main task), but it is restartable.
Jogging is also possible.
The value of a persistent variable will be stored in a separate part of the system, and not
affect the memory area above. See System parameters - AveragePers.
- Always use the interrupt mechanism or loops with delays in supervision tasks.
Otherwise the teach pendent will never get any time to interact with the user.
And if the supervision task is in foreground, it will never allow another task in
background to execute.
2. Specify all modules that should be preloaded to this new task, also under
system parameters (controller/task-modules).
3. Create the modules that should be in the task from the TeachPendant (in the
MAIN task) or off-line.
4. Test and debug the modules in the MAIN task, until the functionallity is
satified. Note: this could only be done in motors on state.
Iteration phase
In many cases an iteration with point 3 and 5 is enough. It’s only when the program has
to be tested in the MAIN task and execution of the RAPID code in two task at the same
time could confuse the user, all point should be used. Note: if a STATIC task is used
it has to be forced to reload the new changed module and restarted from the beginning.
If all point below is used it will take care of that for you.
1. Change the task type to NORMAL to inhibit the task. A NORMAL task will
not start when the system restart and if it’s not the MAIN task not it will be
affected by the start button at the teach pendant.
3. Load the moulde(s) to the MAIN task, test, change and save the module(s).
Note: Don’t save the task, save each module according to the system
parameters.
Finish phase
1 Coordinate Systems
Several TCPs (tools) may be defined, but only one may be active at any one time.
When a position is recorded, it is the position of the TCP that is recorded. This is also
the point that moves along a given path, at a given velocity.
If the robot is holding a work object and working on a stationary tool, a stationary TCP
is used. If that tool is active, the programmed path and speed are related to the work
object. See Stationary TCPs on page 8.
The coordinate system defined depends on what the robot has to do. When no
coordinate system is defined, the robot’s positions are defined in the base coordinate
system.
In a simple application, programming can be done in the base coordinate system; here
the z-axis is coincident with axis 1 of the robot (see Figure 1).
Z
Y
- The origin is situated at the intersection of axis 1 and the base mounting surface.
- The xy plane is the same as the base mounting surface.
- The x-axis points forwards.
- The y-axis points to the left (from the perspective of the robot).
- The z-axis points upwards.
If the robot is floor-mounted, programming in the base coordinate system is easy. If,
however, the robot is mounted upside down (suspended), programming in the base
coordinate system is more difficult because the directions of the axes are not the same
as the principal directions in the working space. In such cases, it is useful to define a
world coordinate system. The world coordinate system will be coincident with the base
coordinate system, if it is not specifically defined.
Sometimes, several robots work within the same working space at a plant. A common
world coordinate system is used in this case to enable the robot programs to
communicate with one another. It can also be advantageous to use this type of system
when the positions are to be related to a fixed point in the workshop. See the example
in Figure 2.
Y
Z
Z
Y
X
Base coordinate system robot 1
x
Figure 2 Two robots (one of which is suspended) with a common world coordinate system.
A robot can work with different fixtures or working surfaces having different positions
and orientations. A user coordinate system can be defined for each fixture. If all
positions are stored in object coordinates, you will not need to reprogram if a fixture
must be moved or turned. By moving/turning the user coordinate system as much as
the fixture has been moved/turned, all programmed positions will follow the fixture
and no reprogramming will be required.
The user coordinate system is defined based on the world coordinate system (see Figure 3).
Z
User coordinate system 1
X
Z
User coordinate system 2
Z
Y z
X
Base coordinate system
y
x
Figure 3 Two user coordinate systems describe the position of two different fixtures.
The user coordinate system is used to get different coordinate systems for different fixtures
or working surfaces. A fixture, however, may include several work objects that are to be
processed or handled by the robot. Thus, it often helps to define a coordinate system for each
object in order to make it easier to adjust the program if the object is moved or if a new
object, the same as the previous one, is to be programmed at a different location. A
coordinate system referenced to an object is called an object coordinate system. This
coordinate system is also very suited to off-line programming since the positions specified
can usually be taken directly from a drawing of the work object. The object coordinate
system can also be used when jogging the robot.
The object coordinate system is defined based on the user coordinate system (see Figure 4).
z
z
z Object coordinate system 1
y
User coordinate system y x
y
x
x Object coordinate system 2
x
Figure 4 Two object coordinate systems describe the position of two different work objects
located in the same fixture.
The programmed positions are always defined relative to an object coordinate system.
If a fixture is moved/turned, this can be compensated for by moving/turning the user
coordinate system. Neither the programmed positions nor the defined object coordinate
systems need to be changed. If the work object is moved/turned, this can be
compensated for by moving/turning the object coordinate system.
If the user coordinate system is movable, that is, coordinated external axes are used,
then the object coordinate system moves with the user coordinate system. This makes
it possible to move the robot in relation to the object even when the workbench is being
manipulated.
Sometimes, the same path is to be performed at several places on the same object. To
avoid having to re-program all positions each time, a coordinate system, known as the
displacement coordinate system, is defined. This coordinate system can also be used in
conjunction with searches, to compensate for differences in the positions of the
individual parts.
The displacement coordinate system is defined based on the object coordinate system
(see Figure 5).
y New position
y
Original position
x
x
Object coordinate system
If a work object is placed on an external mechanical unit, that is moved whilst the robot
is executing a path defined in the object coordinate system, a movable user coordinate
system can be defined. The position and orientation of the user coordinate system will,
in this case, be dependent on the axes rotations of the external unit. The programmed
path and speed will thus be related to the work object (see Figure 6) and there is no
need to consider the fact that the object is moved by the external unit.
z
User coordinate system
y
x
joint 2 joint 3
joint 1
x
Figure 6 A user coordinate system, defined to follow the movements of a 3-axis external mechan-
ical unit.
A movable coordinate system can also be defined for the base of the robot. This is of
interest for the installation when the robot is mounted on a track or a gantry, for
example. The position and orientation of the base coordinate system will, as for the
moveable user coordinate system, be dependent on the movements of the external unit.
The programmed path and speed will be related to the object coordinate system (Figure
7) and there is no need to think about the fact that the robot base is moved by an external
unit. A coordinated user coordinate system and a coordinated base coordinate system
can both be defined at the same time.
World coordinate
system
Track
Figure 7 Coordinated interpolation with a track moving the base coordinate system of the robot.
To be able to calculate the user and the base coordinate systems when involved units
are moved, the robot must be aware of:
- The calibration positions of the user and the base coordinate systems
- The relations between the angles of the external axes and the translation/rotation
of the user and the base coordinate systems.
In a simple application, the wrist coordinate system can be used to define the
orientation of the tool; here the z-axis is coincident with axis 6 of the robot
(see Figure 8).
z
x
Figure 8 The wrist coordinate system.
The wrist coordinate system cannot be changed and is always the same as the mounting
flange of the robot in the following respects:
- The origin is situated at the centre of the mounting flange (on the mounting surface).
- The x-axis points in the opposite direction, towards the control hole of the
mounting flange.
- The z-axis points outwards, at right angles to the mounting flange.
The tool mounted on the mounting flange of the robot often requires its own coordinate
system to enable definition of its TCP, which is the origin of the tool coordinate system.
The tool coordinate system can also be used to get appropriate motion directions when
jogging the robot.
If a tool is damaged or replaced, all you have to do is redefine the tool coordinate
system. The program does not normally have to be changed.
The TCP (origin) is selected as the point on the tool that must be correctly positioned,
e.g. the muzzle on a glue gun. The tool coordinate axes are defined as those natural for
the tool in question.
Top
x
Top
x
z
Figure 9 Tool coordinate system, as usually defined for an arc-welding gun (left) and
a spot welding gun (right).
The tool coordinate system is defined based on the wrist coordinate system
(see Figure 10).
x z
Figure 10 The tool coordinate system is defined relative to the wrist coordinate system,
here for a gripper.
If the robot is holding a work object and working on a stationary tool, a stationary TCP
is used. If that tool is active, the programmed path and speed are related to the work
object held by the robot.
This means that the coordinate systems will be reversed, as in Figure 11.
Z
Object coordinate system
Y Z
X
Y
X
Tool coordinate system
Z
Y z
X
x
Figure 11 If a stationary TCP is used, the object coordinate system is usually based on the wrist
coordinate system.
In the example in Figure 11, neither the user coordinate system nor program
displacement is used. It is, however, possible to use them and, if they are used, they
will be related to each other as shown in Figure 12.
y
z
Object coordinate system z
x
y
y
z User coordinate system
Displacement coordinate system
x
x
y
x
Figure 12 Program displacement can also be used together with stationary TCPs.
2.1 General
During program execution, positioning instructions in the robot program control all
movements. The main task of the positioning instructions is to provide the following
information on how to perform movements:
- The destination point of the movement (defined as the position of the tool
centre point, the orientation of the tool, the configuration of the robot and the
position of the external axes).
- The interpolation method used to reach the destination point, e.g. joint
interpolation, linear interpolation or circle interpolation.
- The velocity of the robot and external axes.
- The zone data (defines how the robot and the external axes are to pass the
destination point).
- The coordinate systems (tool, user and object) used for the movement.
As an alternative to defining the velocity of the robot and the external axes, the time
for the movement can be programmed. This should, however, be avoided if the
weaving function is used. Instead the velocities of the orientation and external axes
should be used to limit the speed, when small or no TCP-movements are made.
When path accuracy is not too important, this type of motion is used to move the tool
quickly from one position to another. Joint interpolation also allows an axis to move from
any location to another within its working space, in a single movement.
All axes move from the start point to the destination point at constant axis velocity (see
Figure 13).
Destination point
Joint interpolated
Start point path
Figure 13 Joint interpolation is often the fastest way to move between two points as the robot
axes follow the closest path between the start point and the destination point (from the
perspective of the axis angles).
The velocity of the tool centre point is expressed in mm/s (in the object coordinate
system). As interpolation takes place axis-by-axis, the velocity will not be exactly the
programmed value.
During interpolation, the velocity of the limiting axis, i.e. the axis that travels fastest
relative to its maximum velocity in order to carry out the movement, is determined.
Then, the velocities of the remaining axes are calculated so that all axes reach the
destination point at the same time.
All axes are coordinated in order to obtain a path that is independent of the velocity.
Acceleration is automatically optimised to the max performance of the robot.
During linear interpolation, the TCP travels along a straight line between the start and
destination points (see Figure 14).
e
To obtain a linear path in the object coordinate system, the robot axes must follow a
non-linear path in the axis space. The more non-linear the configuration of the robot is,
the more accelerations and decelerations are required to make the tool move in a
straight line and to obtain the desired tool orientation. If the configuration is extremely
non-linear (e.g. in the proximity of wrist and arm singularities), one or more of the axes
will require more torque than the motors can give. In this case, the velocity of all axes
will automatically be reduced.
The orientation of the tool remains constant during the entire movement unless a
reorientation has been programmed. If the tool is reorientated, it is rotated at constant
velocity.
5-12 RAPID Overview
Motion and I/O Principles Positioning during Program Execution
A maximum rotational velocity (in degrees per second) can be specified when rotating
the tool. If this is set to a low value, reorientation will be smooth, irrespective of the
velocity defined for the tool centre point. If it is a high value, the reorientation velocity
is only limited by the maximum motor speeds. As long as no motor exceeds the limit for
the torque, the defined velocity will be maintained. If, on the other hand, one of the
motors exceeds the current limit, the velocity of the entire movement (with respect to
both the position and the orientation) will be reduced.
All axes are coordinated in order to obtain a path that is independent of the velocity.
Acceleration is optimised automatically.
A circular path is defined using three programmed positions that define a circle
segment. The first point to be programmed is the start of the circle segment. The next
point is a support point (circle point) used to define the curvature of the circle, and the
third point denotes the end of the circle (see Figure 15).
The three programmed points should be dispersed at regular intervals along the arc of
the circle to make this as accurate as possible.
The orientation defined for the support point is used to select between the short and the
long twist for the orientation from start to destination point.
If the programmed orientation is the same relative to the circle at the start and the
destination points, and the orientation at the support is close to the same orientation
relative to the circle, the orientation of the tool will remain constant relative to the path.
Circle point
Destination point
Start point
Figure 15 Circular interpolation with a short twist for part of a circle (circle segment) with a
start point, circle point and destination point.
However, if the orientation at the support point is programmed closer to the orientation
rotated 180°, the alternative twist is selected (see Figure 16).
Circle point
Destination point
Start point
Figure 16 Circular interpolation with a long twist for orientation is achieved by defining the
orientation in the circle point in the opposite direction compared to the start point.
As long as all motor torques do not exceed the maximum permitted values, the tool will
move at the programmed velocity along the arc of the circle. If the torque of any of the
motors is insufficient, the velocity will automatically be reduced at those parts of the
circular path where the motor performance is insufficient.
All axes are coordinated in order to obtain a path that is independent of the velocity.
Acceleration is optimised automatically.
2.2.4 SingArea\Wrist
In the SingArea\Wrist case the orientation in the circle support point will be the same
as programmed. However, the tool will not have a constant direction relative to the
circle plane as for normal circular interpolation. If the circle path passes a singularity,
the orientation in the programmed positions sometimes must be modified to avoid big
wrist movements, which can occur if a complete wrist reconfiguration is generated
when the circle is executed (joints 4 and 6 moved 180 degrees each).
Fly-by points are used to get continuous movements past programmed positions. In this
way, positions can be passed at high speed without having to reduce the speed
unnecessarily. A fly-by point generates a corner path (parabola path) past the programmed
position, which generally means that the programmed position is never reached. The
beginning and end of this corner path are defined by a zone around the programmed
position (see Figure 17).
Corner path
Figure 17 A fly-by point generates a corner path to pass the programmed position.
All axes are coordinated in order to obtain a path that is independent of the velocity.
Acceleration is optimised automatically.
The size of the corner paths (zones) for the TCP movement is expressed in mm (see
Figure 18). Since the interpolation is performed axis-by-axis, the size of the zones (in
mm) must be recalculated in axis angles (radians). This calculation has an error factor
(normally max. 10%), which means that the true zone will deviate somewhat from the
one programmed.
If different speeds have been programmed before or after the position, the transition
from one speed to the other will be smooth and take place within the corner path
without affecting the actual path.
Programmed Zone
fly-by point
Start point
Destination point
Corner path
Figure 18 During joint interpolation, a corner path is generated in order to pass a fly-by point.
The size of the corner paths (zones) for the TCP movement is expressed in mm (see
Figure 19).
Programmed Zone
corner position
Start point
Corner path
Destination point
Figure 19 During linear interpolation, a corner path is generated in order to pass a fly-by point.
If different speeds have been programmed before or after the corner position, the
transition will be smooth and take place within the corner path without affecting the
actual path.
If the tool is to carry out a process (such as arc-welding, gluing or water cutting) along
the corner path, the size of the zone can be adjusted to get the desired path. If the shape
of the parabolic corner path does not match the object geometry, the programmed
positions can be placed closer together, making it possible to approximate the desired
path using two or more smaller parabolic paths.
Zones can be defined for tool orientations, just as zones can be defined for tool
positions. The orientation zone is usually set larger than the position zone. In this case,
the reorientation will start interpolating towards the orientation of the next position
before the corner path starts. The reorientation will then be smoother and it will
probably not be necessary to reduce the velocity to perform the reorientation.
The tool will be reorientated so that the orientation at the end of the zone will be the
same as if a stop point had been programmed (see Figure 20a-c).
Figure 20a Three positions with different tool orientations are programmed as above.
Figure 20b If all positions were stop points, program execution would look like this.
The orientation zone for the tool movement is normally expressed in mm. In this way,
you can determine directly where on the path the orientation zone begins and ends. If
the tool is not moved, the size of the zone is expressed in angle of rotation degrees
instead of TCP-mm.
If different reorientation velocities are programmed before and after the fly-by point,
and if the reorientation velocities limit the movement, the transition from one velocity
to the other will take place smoothly within the corner path.
Zones can also be defined for external axes, in the same manner as for orientation. If
the external axis zone is set to be larger than the TCP zone, the interpolation of the
external axes towards the destination of the next programmed position, will be started
before the TCP corner path starts. This can be used for smoothing external axes
movements in the same way as the orientation zone is used för the smoothing of the
wrist movements.
Corner paths are also generated when one interpolation method is exchanged for
another. The interpolation method used in the actual corner paths is chosen in such a
way as to make the transition from one method to another as smooth as possible. If the
corner path zones for orientation and position are not the same size, more than one
interpolation method may be used in the corner path (see Figure 21).
p2 p3
Sing Area\Wrist
interpolation
Position zone Orientation zone
Figure 21 Interpolation when changing from one interpolation method to another. Linear
interpolation has been programmed between p1 and p2; joint interpolation between
p2 and p3; and Sing Area\Wrist interpolation between p3 and p4.
When there is a change of coordinate system in a corner path, e.g. a new TCP or a new
work object, joint interpolation of the corner path is used. This is also applicable when
changing from coordinated operation to non-coordinated operation, or vice versa.
If programmed positions are located close to each other, it is not unusual for the
programmed zones to overlap. To get a well-defined path and to achieve optimum
velocity at all times, the robot reduces the size of the zone to half the distance from one
overlapping programmed position to the other (see Figure 22). The same zone radius is
always used for inputs to or outputs from a programmed position, in order to obtain
symmetrical corner paths.
Generated
path
p4
p2
p1
Programmed
position zones p3
Corner zones as
calculated by the robot
Figure 22 Interpolation with overlapping position zones. The zones around p2 and p3 are larger
than half the distance from p2 to p3. Thus, the robot reduces the size of the zones to
make them equal to half the distance from p2 to p3, thereby generating symmetrical
corner paths within the zones.
Both position and orientation corner path zones can overlap. As soon as one of these
corner path zones overlap, that zone is reduced (see Figure 23).
Programmed
orientation zone
Generated path
p4
Generated
orientation zone
p2
p1
Position zones p3
Orientation zone
Figure 23 Interpolation with overlapping orientation zones. The orientation zone at p2 is larger
than half the distance from p2 to p3 and is thus reduced to half the distance from p2
to p3. The position zones do not overlap and are consequently not reduced; the
orientation zone at p3 is not reduced either.
Occasionally, if the next movement is not planned in time, programmed fly-by points
can give rise to a stop point. This may happen when:
A special set of instructions handles the independent axes. Four different move
instructions specify the movement of the axis. For instance, the IndCMove instruction
starts the axis for continuous movement. The axis then keeps moving at a constant
speed (regardless of what the robot does) until a new independent-instruction is
executed.
To change back to normal mode a reset instruction, IndReset, is used. The reset
instruction can also set a new reference for the measurement system - a type of new
synchronization of the axis. Once the axis is changed back to normal mode it is possible
to run it as a normal axis.
If a new Ind_Move instruction is executed before the last one is finished, the new
instruction immediately overrides the old one.
If a program execution is stopped when an independent axis is moving, that axis will
stop. When the program is restarted the independent axis starts automatically. No active
coordination between independent and other axes in normal mode takes place.
If a loss of voltage occurs when an axis is in independent mode, the program cannot be
restarted. An error message is then displayed, and the program must be started from the
beginning.
Note that a mechanical unit may not be deactivated when one of its axes is in
independent mode.
Independent axis
reaches final position
IndAMove WaitTime 10 MoveL MoveL
10 s
Independent axis
speed
2.4.3 Jogging
Axes in independent mode cannot be jogged. If an attempt is made to execute the axis
manually, the axis does not move and an error message is displayed. Execute an
IndReset instruction or move the program pointer to main, in order to leave the
independent mode.
The logical working range is the range used by RAPID instructions and read in the
jogging window.
After synchronization (updated revolution counter), the physical and logical working
range coincide. By using the IndReset instruction the logical working area can be
moved, see Figure 25.
Figure 25 The logical working range can be moved, using the instruction IndReset.
The resolution of positions is decreased when moving away from logical position 0.
Low resolution together with stiff tuned controller can result in unacceptable torque,
noise and controller instability. Check the controller tuning and axis performance close
to the working range limit at installation. Also check if the position resolution and path
performance are acceptable.
In manual mode with reduced speed, the speed is reduced to the same level as if the axis
was running as non-independent. Note that the IndSpeed\InSpeed function will not be
TRUE if the axis speed is reduced.
The VelSet instruction and speed correction in percentage via the production window,
are active for independent movement. Note that correction via the production window
inhibits TRUE value from the IndSpeed\InSpeed function.
In independent mode, the lowest value of acceleration and deceleration, specified in the
configuration file, is used both for acceleration and deceleration. This value can be
reduced by the ramp value in the instruction (1 - 100%). The AccSet instruction does
not affect axes in independent mode.
Only robot axis 6 can be used as an independent axis. Normally the IndReset instruction
is used only for this axis. However, the IndReset instruction can also be used for axis 4
on IRB 2400 and 4400 models. If IndReset is used for robot axis 4, then axis 6 must not
be in the independent mode.
If axis 6 is used as an independent axis, singularity problems may occur because the
normal 6-axes coordinate transform function is still used. If a problem occurs, execute
the same program with axis 6 in normal mode. Modify the points or use SingArea\Wrist
or MoveJ instructions.
The axis 6 is also internally active in the path performance calculation. A result of this
is that an internal movement of axis 6 can reduce the speed of the other axes in the
system.
The independent working range for axis 6 is defined with axis 4 and 5 in home
position. If axis 4 or 5 is out of home position the working range for axis 6 is moved
due to the gear coupling. However, the position read from teach pendant for axis 6 is
compensated with the positions of axis 4 and 5 via the gear coupling.
The relationship between the position deviation and the force, is defined by a
parameter called softness. The higher the softness parameter, the larger the position
deviation required to obtain the same force.
The softness parameter is set in the program and it is possible to change the softness
values anywhere in the program. Different softness values can be set for different joints
and it is also possible to mix joints having normal servo with joints having soft servo.
Activation and deactivation of soft servo as well as changing of softness values can be
made when the robot is moving. When this is done, a tuning will be made between the
different servo modes and between different softness values to achieve smooth
transitions. The tuning time can be set from the program with the parameter ramp. With
ramp = 1, the transitions will take 0.5 seconds, and in the general case the transition
time will be ramp x 0.5 in seconds.
Note that deactivation of soft servo should not be done when there is a force between
the robot and the work object.
With high softness values there is a risk that the servo position deviations may be so
big that the axes will move outside the working range of the robot.
1. For a normal stop the robot will stop on the path, which makes a restart easy.
2. For a stiff stop the robot will stop in a shorter time than for the normal stop, but the
deceleration path will not follow the programmed path. This stop method is, for
example, used for search stop when it is important to stop the motion as soon as
possible.
3. For a quick-stop the mechanical brakes are used to achieve a deceleration distance,
which is as short as specified for safety reasons. The path deviation will usually be
bigger for a quick-stop than for a stiff stop.
After a stop (any of the types above) a restart can always be made on the interrupted
path. If the robot has stopped outside the programmed path, the restart will begin with
a return to the position on the path, where the robot should have stopped.
A logical instruction is any instruction that does not generate a robot movement or
an external axis movement, e.g. an I/O instruction.
p1
Execution of SetDO
MoveL p1, v1000, fine, tool1;
SetDO do1, on;
MoveL p2, v1000, z30, tool1;
Figure 26 A logical instruction after a stop point is not executed until the destination position
has been reached.
Execution of SetDO
DT
p1
Position zone
MoveL p1, v1000, z30, tool1;
SetDO do1, on;
MoveL p2, v1000, z30, tool1; Orientation zone
Figure 27 A logical instruction following a fly-by point is executed before reaching the largest zone.
Execution
of SetDO
Position zone
DT
p2
p1
Figure 28 A logical instruction following a fly-by point is executed before reaching the largest zone.
The time at which they are executed (DT) comprises the following time components:
- The time it takes for the robot to plan the next move: approx. 0.1 seconds.
- The robot delay (servo lag) in seconds: 0 - 1.0 seconds depending on the
velocity and the actual deceleration performance of the robot.
- Execute one or more logical instructions at the same time as the robot moves in order
to reduce the cycle time (e.g. used when communicating via serial channels).
When a positioning instruction with the argument \Conc is executed, the following
logical instructions are also executed (in sequence):
- If the robot is not moving, or if the previous positioning instruction ended with a
stop point, the logical instructions are executed as soon as the current positioning
instruction starts (at the same time as the movement). See Figure 29.
- If the previous positioning instruction ends at a fly-by point, the logical
instructions are executed at a given time (DT) before reaching the largest zone
(for position, orientation or external axes). See Figure 30.
Execution of SetDO
p2
p1
Figure 29 In the case of concurrent program execution after a stop point, a positioning
instruction and subsequent logical instructions are started at the same time.
Execution
of SetDO
Largest zone
DT
p2
p1
Figure 30 In the case of concurrent program execution after a fly-by point, the logical
instructions start executing before the positioning instructions with the argument
\Conc are started.
Instructions which indirectly affect movements, such as ConfL and SingArea, are
executed in the same way as other logical instructions. They do not, however, affect
the movements ordered by previous positioning instructions.
If several positioning instructions with the argument \Conc and several logical
instructions in a long sequence are mixed, the following applies:
- Logical instructions are executed directly, in the order they were programmed.
This takes place at the same time as the movement (see Figure 31) which means
that logical instructions are executed at an earlier stage on the path than they
were programmed.
Execution of
SetDO and SetAO
Largest zone
DT
p2
p1
Figure 31 If several positioning instructions with the argument \Conc are programmed in
sequence, all connected logical instructions are executed at the same time as the first
position is executed.
With a so-called positions event, a trig signal will be generated when the robot passes
a predefined position on the path. With a time event, a signal will be generated in a
predefined time before the robot stops at a stop position. Moreover, the control system
also handles weave events, which generate pulses at predefined phase angles of a
weave motion.
All the position synchronised signals can be achieved both before (look ahead time)
and after (delay time) the time that the robot passes the predefined position. The
position is defined by a programmed position and can be tuned as a path distance before
the programmed position.
Typical repeat accuracy for a set of digital outputs on the path is +/- 2ms.
In the event of a power failure and restart in a Trigg instruction, all trigg events will be
generated once again on the remaining movement path for the trigg instruction.
4 Robot Configuration
If, for example, a position is located approximately in the middle of a work cell, some robots
can get to that position from above and below when using different axis 1 directions (see
Figure 32).
Figure 32 Two different arm configurations used to attain the same position and orientation. The
configuration on the right side is attained by rotating the arm backward. Axis 1 is
rotated 180 degrees.
Some robots may also get to that position from above and below while using the same axis
1 direction. This is possible for robot types with extended axis 3 working range (see Figure
33).
ABB
ABB
Figure 33 IRB140 with two different arm configurations used to attain same position and
orientation. The Axis 1 angle is the same for both configurations.The configuration on
the right side is attained by rotating the lower arm forward and the upper arm
backward.
This can also be achieved by turning the front part of the robot upper arm (axis 4) upside
down while rotating axes 5 and 6 to the desired position and orientation (see Figure 34).
axis 6
axis 4
axis 5
Figure 34 Two different wrist configurations used to attain the same position and orientation.
In the configuration in which the front part of the upper arm points upwards (lower),
axis 4 has been rotated 180 degrees, axis 5 through 180 degrees and axis 6 through
180 degrees in order to attain the configuration in which the front part of the upper
arm points downwards (upper).
The way of specifying robot configuration differs for different kinds of robot types (see
Data Types and System Data - confdata, for a complete description). However, for
most robot types this includes defining the appropriate quarter revolutions of axes 1, 4
and 6.
1 0
2 3
Figure 35 Quarter revolution for a positive joint angle: int joint – -------------- .
angle
π⁄2
-3 -4
-2 -1
Figure 36 Quarter revolution for a negative joint angle: int joint – -------------- – 1
angle
.
π⁄2
Configuration check
Usually you want the robot to attain the same configuration during program execution as
the one you programmed. To do this, you can make the robot check the configuration
and, if the correct configuration is not attained, program execution will stop. If the
configuration is not checked, the robot may unexpectedly start to move its arms and
wrists which, in turn, may cause it to collide with peripheral equipment.
During linear movement, the robot always moves to the closest possible configuration.
If, however, the configuration check is active, program execution stops as soon as any
one of the axes deviates more than the specified number of degrees.
robot always moves to the programmed axis configuration. If the programmed position
and orientation can not be achieved, program execution stops before starting the
movement. If the configuration check is not active, the robot moves to the specified
position and orientation with the closest configuration.
The correct configuration in the destination position can be found by positioning the
robot near it and reading the configuration on the teach pendant.
The kinematic model of the master robot models the position and orientation of the tool
of the robot relative to its base as function of the robot joint angles.
The kinematic parameters specifying the arm-lengths, offsets and joint attitudes, are
predefined in the configuration file for each robot type.
length_of_upper_arm length_of_wrist
joint 5 Z6
joint 4 joint 6
offset_of_joint_3
Z joint 3
X6
length_of_lower_arm
offset_of_joint_2
joint 2
height_of_foot joint 1
A calibration procedure supports the definition of the base frame of the master robot
relative to the world frame.
Z6
X6
Z
Y
World frame
Coordination with an external robot also requires a kinematic model for the external
robot. A number of predefined classes of 2 and 3 dimensional mechanical structures are
supported.
Z2
length_of_lower_arm
Z0 offset_of_upper_arm
attitude_of_joint1
joint 2
X2
joint 1 turn_table
offset_of_joint1_x
attitude_of_joint
height_of_foot
X0
Figure 39 Kinematic structure of an ORBIT 160B robot using predefined model
Calibration procedures to define the base frame relative to the world frame are supplied
for each class of structures.
Z0
Z2
Body C
X2
Body B
Body A
X0
External robot base frame
World frame
Y0
Y2
X0
y1
X2
x1 x2
Figure 41 Reference points on turntable for base frame calibration of an ORBIT_160B robot in
the home position using predefined model
Z2
d1
d2
Z0 a1 = 0
Y2 turn_table a2 = 0
alfa1 = 0
X0 alfa2
Figure 42 Kinematic structure of an ORBIT 160B robot using general kinematics model
A calibration procedure supports the definition of the base frame of the external robot
relative to the world frame.
Z2
Z0
Y2
X0
External robot base frame
World frame
Y0
X0
x1
y1
x2 Y2
X2
Figure 44 Reference points on turntable for base frame calibration of an ORBIT_160B robot in
the home position (joints = 0 degrees)
6.1 Introduction
The collision detection may trig if the data for the loads mounted on the robot are not
correct. This includes load data for tools, payloads and arm loads. If the tool data or
payload data are not known, the load identification functionality can be used to
define it. Arm load data cannot be identified.
When the collision detection is triggered, the motor torques are reversed and the
mechanical brakes applied in order to stop the robot. The robot then backs up a short
distance along the path in order to remove any residual forces which may be present
if a collision or jam occurred. After this, the robot stops again and remains in the
motors on state. A typical collision is illustrated in the figure below.
The motion supervision is only active when at least one axis (including external axes)
is in motion. When all axes are standing still, the function is deactivated. This is to
avoid unnecessary trigging due to external process forces.
There is a RAPID instruction called MotionSup which turns the function on and off
and modifies the supervision level. This is useful in applications where external
process forces act on the robot in certain parts of the cycle. The MotionSup
instruction is described in more detail in the RAPID Reference Manual.
The tune values are set in percent of the basic tuning where 100% corresponds to the
basic values. Increasing the percentage gives a less sensitive system and decreasing
gives the opposite effect. It is important to note that if tune values are set in the
system parameters and in the RAPID instruction both values are taken into
consideration. Example: If the tune value in the system parameters is set to 150% and
the tune value is set to 200% in the RAPID instruction the resulting tune level will
be 300%.
collision
detected robot
time of
collision stopped residual forces
removed
motor
speed
time
speed
reversed
motor
torque
time
torque
reversed
There is a maximum level to which the total collision detection tune level can be
changed. This value is set by default to 300% but it can be modified via the system
parameter motion_sup_max_level which is only available if the system is installed
in Service mode.
The digital output MotSupTrigg goes high when the collision detection triggers. It
stays high until the error code is acknowledged, either from the teach pendant or
through the digital input AckErrDialog.
The digital outputs are described in more detail in the User’s Guide under System
Parameters: IO Signals.
6.5 Limitations
The motion supervision is only available for the robot axes. It is not available for
track motions, orbit stations, or any other external manipulators.
The collision detection is deactivated when at least one axis is run in independent
joint mode. This is also the case even when it is an external axis which is run as an
independent joint.
The collision detection may trigger when the robot is used in soft servo mode.
Therefore, it is advisable to turn the collision detection off when the robot is in soft
servo mode.
If the RAPID instruction MotionSup is used to turn off the collision detection, this
will only take effect once the robot starts to move. As a result, the digital output
MotSupOn may temporarily be high at program start before the robot starts to move.
The distance the robot backs up after a collision is proportional to the speed of the
motion before the collision. If repeated low speed collisions occur, the robot may not
back up sufficiently to relieve the stress of the collision. As a result, it may not be
possible to jog the robot without the supervision triggering. In this case use the jog
menu to turn off the collision detection temporarily and jog the robot away from the
obstacle.
In the event of a stiff collision during program execution, it may take a few seconds
before the robot starts to back up.
If the robot is mounted on a track the collision detection should be set to off when the
track is moving. If it is not turned off the collision detection may trigger when the
track moves, even if there is no collision.
5 Singularities
Some positions in the robot working space can be attained using an infinite number
of robot configurations to position and orient the tool. These positions, known as
singular points (singularities), constitute a problem when calculating the robot arm
angles based on the position and orientation of the tool.
Generally speaking, a robot has two types of singularities: arm singularities and wrist
singularities. Arm singularities are all configurations where the wrist centre (the
intersection of axes 4, 5, and 6) ends up directly above axis 1 (see Figure 33).
Wrist singularities are configurations where axis 4 and axis 6 are on the same line,
i.e. axis 5 has an angle equal to 0 (see Figure 34).
Z base
X base
Figure 33 Arm singularity occurs where the wrist centre and axis 1 intersect.
Axis 6 parallel
to axis 4
The robot has the wrist singularity and the arm singularity. There is also a third kind
of singularity. This singularity occurs at robot positions where the wrist centre and the
rotation centres of axes 2 and 3 are all in a straight line (see figure below).
B
AB
When executing a linear or circular path close to a singularity, the velocities in some
joints (1 and 6/4 and 6) may be very high. In order not to exceed the maximum joint
velocities, the linear path velocity is reduced.
The high joint velocities may be reduced by using the mode (Sing Area\Wrist) when the
wrist axes are interpolated in joint angles, while still maintaining the linear path of the
robot tool. An orientation error compared to the full linear interpolation is however
introduced.
Note that the robot configuration changes dramatically when the robot passes close to
a singularity with linear or circular interpolation. In order to avoid the reconfiguration,
the first position on the other side of the singularity should be programmed with an
orientation that makes the reconfiguration unnecessary.
Also, it should be noted that the robot must not be in its singularity when only external
joints are moved. This may cause robot joints to make unnecessary movements.
During linear interpolation, the robot can pass singular points but at a decreased speed.
8 World Zones
- When two robots share a part of their respective work areas. The possibility of
the two robots colliding can be safely eliminated by the supervision of these
signals.
- When external equipment is located inside the robot’s work area. A forbidden
work area can be created to prevent the robot colliding with this equipment.
- Indication that the robot is at a position where it is permissible to start program
execution from a PLC.
Y
Sphere
Z
Radius
TCP
Cylinder
Radius
z Box
Height
A World Zone can be defined to be inside or outside the shape of the Box, Sphere or
the Cylinder.
Not supervised
The movement of the tool centre
point is supervised and not any other
points on the robot.
TCP
The TCP is always supervised
irrespective of the mode of operation,
for example, program execution and
jogging.
If the robot is holding a work object and working on a stationary tool, a stationary TCP
is used. If that tool is active, the tool will not move and if it is inside a World Zone then
it is always inside.
8.5 Actions
8.5.1 Set a digital output when the tcp is inside a World Zone.
This action sets a digital output when the tcp is inside a World Zone. It is useful to indicate
that the robot has stopped in a specified area.
Time between checks World Zone
against World Zones
Movement of TCP
8.5.2 Set a digital output before the tcp reaches a World Zone.
This action sets a digital output before the tcp reaches a World Zone. It can be used to
stop the robot just inside a World Zone
Stop Time for Robot World Zone
Movement of TCP
8.5.3 Stop the robot before the tcp reaches a World Zone.
A World Zone can be defined to be outside the work area. The robot will then stop with
the Tool Centre Point just outside the World Zone, when heading towards the Zone
Stop Time for Robot
Time between checks
against World Zones
Movement of TCP
When the robot has been moved into a World Zone defined as an outside work area,
for example, by releasing the brakes and manually pushing, then the only ways to get
out of the Zone are by jogging or by manual pushing with the brakes released.
2 50 mm 100 mm 200 mm
3 75 mm 150 mm 300 mm
If the same digital output is used for more than one World Zone, the distance between
the Zones must exceed the minimum size, as shown in the table above, to avoid an
incorrect status for the output.
Temporary World Zones will survive a power failure but will be erased when a new
program is loaded or when a program is started from the main program.
The digital outputs for the World Zones will be updated first at Motors on.
9 I/O Principles
The robot generally has one or more I/O boards. Each of the boards has several dig-
ital and/or analog channels which must be connected to logical signals before they
can be used. This is carried out in the system parameters and has usually already been
done using standard names before the robot is delivered. Logical names must always
be used during programming.
A physical channel can be connected to several logical names, but can also have no
logical connections (see Figure 48).
IN1 do1
IN2 feeder
.
.
.
.
IN16
I/O board
OUT1 gripper
OUT2 do2
.
. feeder2
.
.
OUT16 do16
Figure 48 To be able to use an I/O board, its channels must be given logical names. In the above
example, the physical output 2 is connected to two different logical names. IN16, on
the other hand, has no logical name and thus cannot be used.
When the power supply to the robot is switched on, all signals are set to zero. They
are not, however, affected by emergency stops or similar events.
An output can be set to one or zero from within the program. This can also be done using
a delay or in the form of a pulse. If a pulse or a delayed change is ordered for an output,
program execution continues. The change is then carried out without affecting the rest of
the program execution. If, on the other hand, a new change is ordered for the same output
before the given time elapses, the first change is not carried out (see Figure 49).
Signal value
Time
0 0.5 1
Figure 49 The instruction SetDO is not carried out at all because a new command is given before
the time delay has elapsed.
Ex:
If a function is connected to a signal called do1 and you make a program like:
SetDO do1,1;
SetDO do1,0;
The signal will first go to High and then Low in a few milliseconds. In this case you
may loose the interrupt. To be sure that you will get the interrupt, make sure that the
output is set before resetting it.
Ex:
SetDO do1,1;
WaitDO do1 ,1;
SetDO do1,0;
In this way you will never loose any interrupt.
- di2=di1
- di3=di2
- do4=di2
If di1 changes, di2, di3 and do4 will be changed to the corresponding value.
- do8=do7
- do8=di5
If do7 is set to 1, do8 will also be set to 1. If di5 is then set to 0, do8 will also be
changed (in spite of the fact that do7 is still 1).
9.5 Limitations
A maximum of 10 signals can be pulsed at the same time and a maximum of 20 sig-
nals can be delayed at the same time.
1 Programming Off-line
RAPID programs can easily be created, maintained and stored in an ordinary office
computer. All information can be read and changed directly using a normal text editor.
This chapter explains the working procedure for doing this. In addition to off-line
programming, you can use the computer tool, QuickTeach.
1.2 Editing
When a program is created or changed in a word-processor, all information will be
handled in the form of text. This means that information about data and routines will
differ somewhat from what is displayed on the teach pendant.
Note that the value of a stored position is only displayed as an *on the teach pendant,
whereas the text file will contain the actual position value (x, y, z, etc.).
In order to minimise the risk of errors in the syntax (faulty programs), you should use
a template. A template can take the form of a program that was created previously on
the robot or using QuickTeach. These programs can be read directly to a word-
processor without having to be converted.
• Save the file on diskette and try to open it in the robot. If there are any syntactical
errors, the program will not be accepted and an error message will be displayed. To
obtain information about the type of error, the robot stores a log called
PGMCPL1.LOG on the internal RAM disk. Copy this log to a diskette using the
robot’s File Manager. Open the log in a word-processor and you will be able to read
which lines were incorrect and receive a description of the error.
• Open the file in QuickTeach or ProgramMaker.
• Use a RAPID syntax check program for the PC.
When the program is syntactically correct, it can be checked and edited in the robot.
To make sure that all references to routines and data are correct, use the command File:
Check Program. If the program has been changed in the robot, it can be stored on
diskette again and processed or stored in a PC.
1.4 Examples
The following shows examples of what routines look like in text format.
%%%
VERSION: 1
LANGUAGE: ENGLISH
%%%
MODULE main
VAR intnum process_int ;
! Demo of RAPID program
PROC main()
MoveL p1, v200, fine, gun1;
ENDPROC
TRAP InvertDo12
! Trap routine for TriggInt
TEST INTNO
CASE process_int:
InvertDO do12;
DEFAULT:
TPWrite “Unknown trap , number=”\Num:=INTNO;
ENDTEST
ENDTRAP
- They can be taken from the instruction pick list and programmed as normal
instructions.
- The complete routine will be run during step-by-step execution.
• Create a new system module where you can place your routines that will function as
instructions. Alternatively, you can place them in the USER system module.
• Create a routine in this system module with the name that you want your new
instruction to be called. The arguments of the instruction are defined in the form of
routine parameters. Note that the name of the parameters will be displayed in the
window during programming and should therefore be given names that the user will
understand.
• Place the routine in one of the Most Common pick lists.
• If the instruction is to behave in a certain way during backward program execution,
this can be done in the form of a backward handler. If there is no such handler, it will
not be possible to get past the instruction during backward program execution (see
Chapter 13 in this manual - Basic Characteristics). A backward handler can be
entered using the command Routine: Add Backward Handler from the Program
Routines window.
• Test the routine thoroughly so that it works with different types of input data
(arguments).
• Change the module attribute to NOSTEPIN. The complete routine will then be run
during step-by-step execution. This attribute, however, must be entered off-line.
Example: To make the gripper easier to handle, two new instructions are made,
GripOpen and GripClose. The output signal’s name is given to the instruction’s
argument, e.g. GripOpen gripper1.
If this data is used, initial programming is made easier. It is, however, usually better to
give your own names to the data you use, since this makes the program easier for you
to read.
1.1 Contents
User comprises five numerical data (registers), one work object data, one clock and
two symbolic values for digital signals.
User is a system module, which means that it is always present in the memory of the
robot regardless of which program is loaded.
Warning: If the Module is deleted, the CallByVar instruction will not work.
Glossary
Argument The parts of an instruction that can be changed, i.e.
everything except the name of the instruction.
Automatic mode The applicable mode when the operating mode selector is
set to .
Component One part of a record.
Configuration The position of the robot axes at a particular location.
Constant Data that can only be changed manually.
Corner path The path generated when passing a fly-by point.
Declaration The part of a routine or data that defines its properties.
Dialog/Dialog box Any dialog boxes appearing on the display of the teach pen-
dant must always be terminated (usually by pressing OK or
Cancel) before they can be exited.
Error handler A separate part of a routine where an error can be taken care
of. Normal execution can then be restarted automatically.
Expression A sequence of data and associated operands; e.g. reg1+5 or
reg1>5.
Fly-by point A point which the robot only passes in the vicinity of –
without stopping. The distance to that point depends on the
size of the programmed zone.
Function A routine that returns a value.
Group of signals A number of digital signals that are grouped together and
handled as one signal.
Interrupt An event that temporarily interrupts program execution and
executes a trap routine.
I/O Electrical inputs and outputs.
Main routine The routine that usually starts when the Start key is pressed.
Manual mode The applicable mode when the operating mode switch is set
to .
Mechanical unit A group of external axes.
Module A group of routines and data, i.e. a part of the program.
Motors On/Off The state of the robot, i.e. whether or not the power supply
to the motors is switched on.
Operator’s panel The panel located on the front of the control system.
Orientation The direction of an end effector, for example.
Parameter The input data of a routine, sent with the routine call. It cor-
responds to the argument of an instruction.
Persistent A variable, the value of which is persistent.
Procedure A routine which, when called, can independently form an
instruction.
Program The set of instructions and data which define the task of the
robot. Programs do not, however, contain system modules.
Program data Data that can be accessed in a complete module or in the
complete program.
Program module A module included in the robot’s program and which is
transferred when copying the program to a diskette, for
example.
Record A compound data type.
Routine A subprogram.
Routine data Local data that can only be used in a routine.
Start point The instruction that will be executed first when starting pro-
gram execution.
Stop point A point at which the robot stops before it continues on to the
next point.
System module A module that is always present in the program memory.
When a new program is read, the system modules remain in
the program memory.
System parameters The settings which define the robot equipment and proper-
ties; configuration data in other words.
Tool Centre Point (TCP) The point, generally at the tip of a tool, that moves along the
programmed path at the programmed velocity.
Trap routine The routine that defines what is to be done when a specific
interrupt occurs.
Variable Data that can be changed from within a program, but which
loses its value (returns to its initial value) when a program is
started from the beginning.
Window The robot is programmed and operated by means of a num-
ber of different windows, such as the Program window and
the Service window. A window can always be exited by
choosing another window.
Zone The spherical space that surrounds a fly-by point. As soon
as the robot enters this zone, it starts to move to the next
position.