Mitsubishi LabNotes v0.6
Mitsubishi LabNotes v0.6
Mitsubishi RV-2AJ
Industrial Robot Programming
and Calibration
Lab Notes
Joerg Wolf
Paul Robinson Version 0.6 Nov 2005
Table of Contents
page
1. Introduction....................................................................................... 3
1.1 Safety ............................................................................................ 3
1.2 Operational rules ........................................................................... 3
3. Introduction to MELFA-BASIC.......................................................... 8
3.1 Instruction Reference........................................................................ 8
3.2 Example programs: ....................................................................... 8
3.2.1 Placing of an object .................................................................... 8
3.2.2 Subroutines ................................................................................ 9
3.2.3 External input.............................................................................. 9
3.2.4 Palletising ................................................................................. 10
3.3 Variables......................................................................................... 10
References: ............................................................................................. 12
1.1 Safety
The following safety rules must ALWAYS be obeyed. Failure to do so may result in
exclusion from the laboratory.
1. NEVER enter the robot work space when servo power is on!
i.e., the green LED (light emitting diode) at the “SVO ON” switch is on.
2. Always make sure there is no one in the work cell before starting a program.
4. Always keep one hand at the emergency stop and observe the robot during
its full operational cycle
5. Always write “OVRD 20” as the first line in any robot program. This limits the
maximum speed
6. Never load the robot with more than 2 kg. If the arm is operated at full stretch
limit the maximum load to 0.5 kg.
2. Operation modes
Figure 2.
Make sure the emergency stop buttons of both the teach pendant
and controller are pulled out.
Switch on the Controller. (Power up takes approx. 20 seconds)
The robot can be now moved in joint-space (Ө1 to Ө5) or Cartesian-space (XYZ).
For Cartesian-space operation press the XYZ button once (top row 3rd across).
The buttons labelled –X,+X,-Y,+Y,-Z,+Z can now be used to move the robot.
The buttons labelled -A,+A are to rotate the robot’s end-effector around the end
effector Z axis. .
The buttons labelled,-B,+B are to rotate the robot’s end-effector around the end
effector …… axis?
Pressing the XYZ button at any time displays the position of the end-effector.
To open and close the hand keep the dead-man’s handle pressed, release the
“STEP/MOVE” button and keep the “HAND” button pressed instead.
To open the hand press “+C” to close it “-C”
Automatic Operation is used to run programs that are stored in the robot controller
memory. The program will cycle, i.e. run continuously once started.
Use the RoboExplorer to select your MELFA-BASIC file from the hard disk. A MELFA-
BASIC file should have the extension “.MB4”. An example file can be found with this
manual: TEST.MB4.
Drag the MELFA-BASIC file across onto the RV-2AJ robot icon, see Figure 3.
Drag the MELFA-Position file across to the left onto the MELFA-BASIC file that has
just been downloaded.
Teach points (TP’s) define target positions for the robot. A Teach point for the RV-2AJ
robot consists of 5 values, namely:
1. Cartesian X position
2. Cartesian Y position
3. Cartesian Z position
4. A – wrist rotation A
5. B – wrist rotation B
Hence the Mitsubishi RV-2AJ robot has only 5 degrees of freedom. We know that in
general to both position (x,y,z) and orientate (roll, pitch, yaw) an object in space
requires SIX degrees of freedom. Therefore this robot, in common with many other
industrial robots, has reduced functionality. In practice this does not seriously limit it’s
the range of its application.
• Switch the robot into “Teach pendant mode” and drive the arm to the desired
target position.
• Once the robot is in its target position open “Tools/TP Editor” from the menu on
the PC software.
• Press the right mouse button and choose the option “ New Teach Point”
• Right click on the newly created teach-point and select the option “ Learn
Robot’s Position”
• The teach-point can be renamed using the option “ Edit Teach Point”. The
first letter of the name of the new TP position should be a “P”. e.g. “P1”, “P10” ,
“PSAVE”
• Right mouse-click the option save. The Teach Point file is saved to the hard
drive. A teach point file must have the extension “.POS”
A teach point file can only be downloaded to a robot after the corresponding MELFA-
BASIC file (.MB4) has been downloaded. To download a teach point file drag the file
onto the MELFA-BASIC file in the robot (right hand side of the screen). By dragging
the teach point file onto the MELFA-BASIC program in the robot rather than onto the
robot itself you indicate that the teach points belong to a particular program in the
robot. A progress bar should flash during the download similar to downloading a
program.
As shown in the program Pr1 a good program should consider the following:
- use as few teach-points as possible
- Always use an approach point before going to the target point,
to ensure you are not hitting the target from the wrong direction
- use delays to let the robot settle
- set the speed limit appropriately
When using the interpolation move MVS, the robot sometimes cannot create an
interpolation path and returns with an out of range error. Use MOV instead of MVS
when moving between approach points.
*PLACE
MVS P10,-50
….HOPEN 1…….. ‘incomplete subroutine
RETURN
*LOOP
WAIT M_IN ( 8 ) = 0 ‘Waits for the input signal bit 8 to turn OFF
GOSUB *PUTSOMEWHERE
GOTO *LOOP
3.3 Variables
Variables can be of different types. The most useful variable type is a position.
A position variable should start with “P”. The position variables P1…P99 are defined,
therefore a DEF POS command is not required for these.
Position variables can be modified. Suppose a teach-point P1 is stored in memory.
To increase the x-component 10 mm use:
P1.X = P1.X + 10
To change P1, rotating around the end-effector’s y-axis 0.07 radians use:
P1.B = P1.B - 0.07
When an error occurs the controller will beep. To recover from an error press the reset
button on the teach pendant or on the robot controller. If the emergency stop button
was pushed, it must be pulled out before pressing reset.
In some cases an error a code will appear on the screen. Common error codes are
listed below:
Code Meaning
L2800 – position data is inadequate. *
L2803
L2600 – position is out of range *
L2603
H0060 Emergency Stop on controller was pushed
H0070 Emergency Stop on T/B was pushed
H5000 The T/B Enable key was validated in the automatic mode.
H1010 Collision
C1350 Overload (possibly Collision)
C4340 Variable not defined (you forgot DEF POS or you forgot to
download the teach-point file)
• The target position is outside the robots workspace (joint reaches the limit
while trying to reach the target position). Try adjusting the target position
slightly. A fraction of a millimetre can be enough.
• the teach point file (.POS) is corrupt.
Edit the .POS file with MS Notepad (not RoboExplorer!) and confirm that the
last bracket of each position is (6,0) and not (0,0)
• An interpolation or inverse kinematics error can occur if you use MVS (move
linear) commands and a calculated target position rather than a learned
teach-point. Also avoid angles at exactly -/+180.0°.
Joint Limit
J1 -150° to +150°
J2 - 60° to +120°
J3 -110° to +120°
J5 - 90° to + 90°
J6 -200° to +200°
Z > 44 mm To prevent the end effector from hitting the work surface
(table)
X > - 220 mm To prevent the robot from reaching behind