Manual Scorbot ER VII
Manual Scorbot ER VII
7UGTIU"/CPWCN
4PF"'FKVKQP
%CVCNQI"%"322239""4GX0%
WARNING
The SCORBOT-ER VII is dangerous
and can cause severe injury.
USE WITH EXTREME CAUTION.
Set up a protective screen or guard rail
around the robot to
KEEP PEOPLE AWAY
from its working range.
Copyright 1996, 1998 by Eshed Robotec (1982) Limited.
February 1996, reprinted December 1998 (PDF)
Catalog # 100017 Rev.C
ISBN 965-291-033-3
All rights reserved.
This book is designed to provide inIormation about the 6&25%27(59,,.
Every eIIort has been made to make this book as complete and accurate as
possible. However, no warranty oI suitability, purpose, or Iitness is made or
implied. Eshed Robotec (1982) Ltd. is not liable or responsible to any person or
entity Ior loss or damage in connection with or stemming Irom the use oI
&RQWUROOHU$, $&/, $76, the 6&25%27(59,, robot, and/or the inIormation
contained in this publication.
Eshed Robotec (1982) Ltd. bears no responsibility Ior errors which may appear in
this publication and retains the right to make changes to the hardware, soItware
and manual without prior notice.
SCORBOT is a registered trademark, and $&/ is a trademark, oI Eshed Robotec
(1982) Ltd.
Read this manual thoroughly beIore attempting to install or operate the robot. II
you have any problems during installation or operation, call your agent Ior
assistance.
Save the original carton and all packing material. You may need them later Ior
shipment.
Table of Contents
CHAPTER 1 General Information 1-1
Unpacking Instructions . . . . . . . . . . . . . . . . . . . . 1-1
Handling Instructions . . . . . . . . . . . . . . . . . . . . . 1-2
Repacking for Shipment . . . . . . . . . . . . . . . . . . . 1-2
Acceptance Inspection . . . . . . . . . . . . . . . . . . . . 1-3
Safety Precautions . . . . . . . . . . . . . . . . . . . . . . 1-4
Robot . . . . . . . . . . . . . . . . . . . . . . . . . . 1-4
Controller . . . . . . . . . . . . . . . . . . . . . . . . 1-5
Warnings . . . . . . . . . . . . . . . . . . . . . . . . . . . 1-5
Robot . . . . . . . . . . . . . . . . . . . . . . . . . . 1-6
Controller . . . . . . . . . . . . . . . . . . . . . . . . 1-6
CHAPTER 2 The Robot Arm 2-1
Specifications . . . . . . . . . . . . . . . . . . . . . . . . 2-2
Structure . . . . . . . . . . . . . . . . . . . . . . . . . . . 2-3
Work Envelope . . . . . . . . . . . . . . . . . . . . . . . . 2-4
Drive System . . . . . . . . . . . . . . . . . . . . . . . . . 2-5
Position and Limit Devices . . . . . . . . . . . . . . . . . . 2-6
Encoders . . . . . . . . . . . . . . . . . . . . . . . . . 2-6
Microswitches . . . . . . . . . . . . . . . . . . . . . . 2-7
Limit Switches . . . . . . . . . . . . . . . . . . . . 2-7
Home Switches . . . . . . . . . . . . . . . . . . . 2-8
Hard Stops . . . . . . . . . . . . . . . . . . . . . 2-8
Gripper . . . . . . . . . . . . . . . . . . . . . . . . . . . . 2-8
Cables and Pin Assignments . . . . . . . . . . . . . . . . 2-9
CHAPTER 3 The Controller 3-1
Specifications . . . . . . . . . . . . . . . . . . . . . . . . 3-2
Controller Functions . . . . . . . . . . . . . . . . . . . . . 3-4
Power On/Off Switch and LED . . . . . . . . . . . . . 3-4
Motors and User Power Supply Switch and LED . . . . 3-4
Emergency Switch and Lamp . . . . . . . . . . . . . . 3-5
User Power Supply Terminals . . . . . . . . . . . . . . 3-5
Input and Output Terminals and LEDs . . . . . . . . . 3-6
Inputs . . . . . . . . . . . . . . . . . . . . . . . . 3-6
Outputs . . . . . . . . . . . . . . . . . . . . . . . 3-7
Relay Outputs 1-4 . . . . . . . . . . . . . . . . 3-7
Open Collector Outputs 5-16 . . . . . . . . . . 3-7
Input and Output LEDs . . . . . . . . . . . . . . . 3-8
Controller Components . . . . . . . . . . . . . . . . . . . 3-9
Controller-Computer RS232 Cable . . . . . . . . . . . . . 3-10
Users Manual SCORBOT-ER VII vii
9602
CHAPTER 4 Installation 4-1
Preparations . . . . . . . . . . . . . . . . . . . . . . . . . 4-1
Cable Connections . . . . . . . . . . . . . . . . . . . . . . 4-2
Peripheral Axes . . . . . . . . . . . . . . . . . . . . . . . 4-4
Power On . . . . . . . . . . . . . . . . . . . . . . . . . . 4-4
Controller Configuration . . . . . . . . . . . . . . . . . . . 4-5
Homing the Robot . . . . . . . . . . . . . . . . . . . . . . 4-7
Gripper Installation . . . . . . . . . . . . . . . . . . . . . . 4-8
DC Servo Electric Gripper . . . . . . . . . . . . . . . . 4-8
Pneumatic Gripper . . . . . . . . . . . . . . . . . . . . 4-10
CHAPTER 5 Operating Methods 5-1
Software . . . . . . . . . . . . . . . . . . . . . . . . . . . 5-1
ACL . . . . . . . . . . . . . . . . . . . . . . . . . . . 5-1
ATS . . . . . . . . . . . . . . . . . . . . . . . . . . . 5-1
ACLoff-line . . . . . . . . . . . . . . . . . . . . . . . . 5-2
SCORBASE . . . . . . . . . . . . . . . . . . . . . . . 5-2
Teach Pendant . . . . . . . . . . . . . . . . . . . . . . . . 5-3
Keypad Functions . . . . . . . . . . . . . . . . . . . . 5-3
The Display Panel . . . . . . . . . . . . . . . . . . . . 5-7
CHAPTER 6 Operating the Robot 6-1
DIRECT Mode . . . . . . . . . . . . . . . . . . . . . . . . 6-1
Manual Mode . . . . . . . . . . . . . . . . . . . . . . . . . 6-1
Using this Manual . . . . . . . . . . . . . . . . . . . . . . 6-2
Activating the Sytem . . . . . . . . . . . . . . . . . . . . . 6-2
Homing the Robot and Peripheral Axes . . . . . . . . . . . 6-3
Coordinate Systems . . . . . . . . . . . . . . . . . . . . . 6-5
Cartesian (XYZ) Coordinates . . . . . . . . . . . . . . 6-5
Joint Coordinates . . . . . . . . . . . . . . . . . . . . 6-5
Servo Control . . . . . . . . . . . . . . . . . . . . . . . . 6-7
Axis Control Groups . . . . . . . . . . . . . . . . . . . . . 6-8
Moving the Axes . . . . . . . . . . . . . . . . . . . . . . . 6-9
XYZ and Joint Movements . . . . . . . . . . . . . . . . 6-9
Activating the Gripper . . . . . . . . . . . . . . . . . . 6-11
Setting the Speed . . . . . . . . . . . . . . . . . . . . . . 6-12
Defining and Recording Positions . . . . . . . . . . . . . . 6-13
Relative Positions . . . . . . . . . . . . . . . . . . . . 6-15
Listing Positions . . . . . . . . . . . . . . . . . . . . . 6-16
Deleting Positions . . . . . . . . . . . . . . . . . . . . 6-16
Moving to Recorded Position . . . . . . . . . . . . . . . . 6-17
Linear Movement . . . . . . . . . . . . . . . . . . . . 6-18
Circular Movement . . . . . . . . . . . . . . . . . . . . 6-18
viii SCORBOT-ER VII Users Manual
9602
CHAPTER 7 Programming with ACL 7-1
EDIT Mode . . . . . . . . . . . . . . . . . . . . . . . . . . 7-1
Help . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 7-1
Creating a Program . . . . . . . . . . . . . . . . . . . . . 7-2
Writing a Program . . . . . . . . . . . . . . . . . . . . . . 7-2
Running a Program . . . . . . . . . . . . . . . . . . . . . 7-3
Program Loop . . . . . . . . . . . . . . . . . . . . . . . . 7-3
Displaying Program Lines . . . . . . . . . . . . . . . . . . 7-4
Halting Program Execution . . . . . . . . . . . . . . . . . . 7-4
Suspend the Program . . . . . . . . . . . . . . . . . . 7-4
Abort the Program . . . . . . . . . . . . . . . . . . . . 7-5
Stop the Program . . . . . . . . . . . . . . . . . . . . 7-5
Delaying Program Execution . . . . . . . . . . . . . . . . . 7-6
Variable Programming . . . . . . . . . . . . . . . . . . . . 7-6
Mathematical and Logical Functions . . . . . . . . . . 7-7
Iteration Functions . . . . . . . . . . . . . . . . . . . . 7-8
Conditional Functions . . . . . . . . . . . . . . . . . . 7-9
Input and Output Programming . . . . . . . . . . . . . . . 7-10
Displaying Input/Output Status . . . . . . . . . . . . . 7-10
Inputs . . . . . . . . . . . . . . . . . . . . . . . . . . 7-10
Outputs . . . . . . . . . . . . . . . . . . . . . . . . . 7-11
Activating Output-Driven Devices . . . . . . . . . . 7-11
Pneumatic End Effectors or Devices . . . . . . 7-11
Warning Light . . . . . . . . . . . . . . . . . . 7-11
Sample Program: INOUT . . . . . . . . . . . . . . . . . . 7-12
Program Directory . . . . . . . . . . . . . . . . . . . . . . 7-14
Multi-Tasking . . . . . . . . . . . . . . . . . . . . . . . . . 7-14
Displaying Program Status . . . . . . . . . . . . . . . 7-15
Activating a Program from Another Program . . . . . . . . 7-15
Simultaneous Execution . . . . . . . . . . . . . . . . . 7-15
Program Interrupt . . . . . . . . . . . . . . . . . . . . 7-16
Saving a Program (Backup) to Disk . . . . . . . . . . . . . 7-16
Downloading a Program (Restore) to Controller . . . . . . . 7-17
CHAPTER 8 Maintenance 8-1
Maintenance . . . . . . . . . . . . . . . . . . . . . . . . . 8-1
Troubleshooting . . . . . . . . . . . . . . . . . . . . . . . 8-2
Robot Arm Calibration Parameters . . . . . . . . . . . 8-2
General System Check . . . . . . . . . . . . . . . . . 8-3
Diagnostic Procedures . . . . . . . . . . . . . . . . . . 8-3
Error Messages . . . . . . . . . . . . . . . . . . . . . 8-13
Adjustments and Repairs . . . . . . . . . . . . . . . . . . 8-15
Opening the Controller Cover . . . . . . . . . . . . . . 8-15
Changing the Voltage Setting . . . . . . . . . . . . . . 8-15
Replacing Fuses . . . . . . . . . . . . . . . . . . . . . 8-16
Logic Power Supply Fuse . . . . . . . . . . . . . . 8-16
Power Transformer Fuse . . . . . . . . . . . . . . 8-16
User Power Supply Fuse . . . . . . . . . . . . . . 8-17
Driver Card Fuses . . . . . . . . . . . . . . . . . . 8-17
Users Manual SCORBOT-ER VII ix
9602
Changing the I/O Logic Mode . . . . . . . . . . . . . . 8-18
Replacing or Adding a Driver Card . . . . . . . . . . . 8-19
Adjusting Driver Card Current Limit . . . . . . . . . . . 8-20
Driver Card Jumper Configuration . . . . . . . . . . . . 8-20
Installing the Auxiliary RS232 Communication Card . . 8-21
APPENDIX A Theory of Control A-1
Servo Control . . . . . . . . . . . . . . . . . . . . . . . . A-1
Open Loop Control . . . . . . . . . . . . . . . . . . . A-1
Closed-Loop Control . . . . . . . . . . . . . . . . . . . A-1
Digital Control . . . . . . . . . . . . . . . . . . . . . . . . A-2
Transient and Steady State Responses . . . . . . . . . . . A-4
Controller-A Control Process . . . . . . . . . . . . . . . . . A-6
Trajectory Control . . . . . . . . . . . . . . . . . . . . . . A-7
Paraboloid . . . . . . . . . . . . . . . . . . . . . . . . A-7
Trapezoid . . . . . . . . . . . . . . . . . . . . . . . . A-7
Path Control . . . . . . . . . . . . . . . . . . . . . . . . . A-7
Point-to-Point Control . . . . . . . . . . . . . . . . . . A-7
Continuous Path Control . . . . . . . . . . . . . . . . . A-8
The Control Parameters . . . . . . . . . . . . . . . . . . . A-9
Proportional Control . . . . . . . . . . . . . . . . . . . A-9
Differential Control . . . . . . . . . . . . . . . . . . . A-10
Integral Control . . . . . . . . . . . . . . . . . . . . A-10
ProportionalIntegralDifferential Control . . . . . . . A-11
Offset . . . . . . . . . . . . . . . . . . . . . . . . . A-11
Changing Parameter Values . . . . . . . . . . . . . . A-12
x SCORBOT-ER VII Users Manual
9602
CHAPTER 1
General Information
Read this chapter carefully before you unpack the robot and controller.
This chapter contains instructions for unpacking and handling the
SCORBOT-ER VII and Controller-A.
This chapter also includes important safety guidelines and warnings.
Unpacking Instructions
The robot arm and the controller are packed in two separate cartons. Save the
original packing materials and shipping carton. You may need them later for
shipment or storage.
To protect the robot during shipment, a metal plate holds the gripper-mounting
flange to the robot base. The plate is fixed to the flange with three bolts and to the
base with two bolts. See Figure 1-1. Use the hex wrench supplied with the robot
to detach these bolts.
Save these bolts and the
plate. You will need
them should you repack
the robot for shipment.
More important, you
will need three of these
bolts to attach the
gripper to the flange.
Figure 1-1: SCORBOT-ER VII Packing
Users Manual SCORBOT-ER VII 1 - 1
9602
The controller package contains two ATS diskettes. Each diskette includes a
parameter file named PAR7.CBU which is uniquely associated with the robot you
have received. One diskette is write-protected.
Store the protected disk together with the computer print-out of the robots
parameter file.
Handling Instructions
Lift and carry the robot arm only by
grasping the body or the base.
See Figure 1-2.
Do not lift and/or carry the robot arm
by its upper arm or forearm.
Lift and carry the controller by
grasping it on and under the left and
right side panels.
Do not grasp the controller on either
its front or back panel, and avoid
handling near the power switch.
Repacking for Shipment
Be sure all parts are back in place before packing the robot/controller.
When repacking the robot for shipment, bolt the flange and base to the metal
plate. Failure to do so may cause irreversible damage to the arm, particularly to
the harmonic drive transmissions. Also be sure to secure the cables around the
foam spool.
The robot and controller should be repacked in their original packaging for
transport.
If the original carton is not available, wrap the robot/controller in plastic or heavy
paper. Put the wrapped robot/controller in a strong cardboard box at least 15 cm
(about 6 inches) longer in all three dimensions than the robot. Fill the box equally
around the unit with resilient packing material (shredded paper, bubble pack,
expanded foam chunks).
Seal the carton with sealing or strapping tape. Do not use cellophane or masking
tape.
Figure 1-2: Robot Arm Parts
1 - 2 SCORBOT-ER VII Users Manual
9602
Acceptance Inspection
After removing the robot arm and controller from their shipping cartons, examine
them for signs of shipping damage. If any damage is evident, do not install or
operate the system. Notify your freight carrier and begin appropriate claims
procedures.
The following is a list of the standard components in the SCORBOT-ER VII
package. Make sure you have received all the items listed on the shipments
packing list. If anything is missing, contact your supplier.
SCORBOT-ER VII Standard Package (Catalog # 404)
Item Description
SCORBOT-ER VII Robot Arm
Includes: power cable 100/110/220VAC; RS232 cable;
4 driver cards (for 8 axes); bolts for mounting robot;
set of hex wrenches.
ACL Controller-A
Gripper Options: Pneumatic or Electric DC Servo
Software
ATS (Advanced Terminal Software): 2 diskettes; one
is write-protected; includes ACLoff-line software.
SCORBASE Level 5 Software: 1 diskette
Documentation
SCORBOT-ER VII Users Manual
ACL Reference Guide
ATS Reference Guide
SCORBASE Level 5 (ACL Version) Reference Guide
ACLoff-line Users Manual
The following table is a sampling of the optional accessories which are
compatible for use with the SCORBOT-ER VII system.
For a complete list of the accessories, devices, software and documentation for
integration and use with the SCORBOT-ER VII sytem, contact your agent.
Optional Components for SCORBOT-ER VII System
Item Cat. # Notes
Teach Pendant for Controller-A 1703
Driver Card for Peripheral Axes:
Card with two 2A fuses
Card with one 2A fuse and one 4A fuse
Card with two 4A fuses
45018
45019
45020
Each card drives 2 axes;
If ordered with controller,
card is factory-installed.
Auxiliary RS232 Communication Card
Cable with 8 connectors for auxiliary card
45012
40024
If ordered with controller,
card is factory-installed.
SCORBASE Levels 1-3 software 9004
Users Manual SCORBOT-ER VII 1 - 3
9602
Optional Components for SCORBOT-ER VII System
Item Cat. # Notes
DC Motor Kits:
Motor with 5.9:1gear ratio
Motor with 19.5:1 gear ratio
Motor with 65.5:1 gear ratio
Motor with 127:1 gear ratio
1210
1212
1211
1206
12VDC, Includes encoder and
connector cable.
Rotary Table (black) 1005 12VDC, 350mm plate
Proximity Sensor for Rotary Table 1209
Conveyor Belt (gray) 1006 12VDC, 20-slot encoder
Proximity Sensor for Conveyor 1203
Experiment Table 1201
48" Linear Slidebase
72" Linear Slidebase
1001
1002
12VDC
1.0M Linear Slidebase
1.5M Linear Slidebase
1008
1007
24VDC
Gripper attachment for round/square parts 616 For #613
DC Servo Gripper
Pneumatic Gripper
613
614
Vacuum Gripper (1 suction cup)
Vacuum Gripper (3 suction cups)
601
602
Requires #1204 and #1208
Air Brush Paint Gun 603
Syringe Dispenser 604
Utilities Control Box 1204
Includes solenoid value, air
regulator, fittings, power
supply.
Air Supply Adapter Kit 1208
Includes 2 quick connectors
and air hose.
I/O Interface Box for Controller-A 1215
Safety Precautions
This manual provides complete details for proper installation and operation of the
SCORBOT-ER VII and Controller-A. Do not install or operate the robot or
controller until you have thoroughly studied this Users Manual. Be sure you
fheed the safety guidelines for both the robot and the controller.
Robot
1. Make sure the robot base is properly and securely bolted in place.
2. Make sure the robot arm has ample space in which to operate freely.
1 - 4 SCORBOT-ER VII Users Manual
9602
3. Make sure a guardrail, rope or safety screen has been set up around the
SCORBOT-ER VII operating area to protect both the operator and bystanders.
4. Do not enter the robots safety range or touch the robot when the system is in
operation. Before approaching the robot, make sure the motor switch on the
controller front panel has been shut off.
5. Make sure loose hair and clothing is tied back when you work with the robot.
Controller
1. The power cable must have a ground connection. If your power outlet does not
have a safety ground, do not connect the controller. Failure to connect the power
cable to a grounded outlet could result in electrical shock.
1. Turn off the controllers motor switch before you enter the robots operating area.
2. Turn off the controllers power switch before you connect any inputs or outputs
to the controller.
3. Turn off the controllers power switch and disconnect the controller power cable
from the AC power outlet before you open the controller cover or remove any
fuses. The power cable must be disconnected to remove possible shock hazard.
4. Never open the controller cover during robot operation.
Be sure you know how to immediately abort all running programs and stop all
axes of motion:
Where exposed to large amounts of dust, dirt, salt, iron powder, or similar
substances.
Where the power line contains voltage spikes, or near any equipment which
generates large electrical noises.
Robot
Do not overload the robot arm. The combined weight of the workload and
gripper may not exceed 2kg (4.4 lb). It is recommended that the workload be
grasped at its center of gravity.
Do not use physical force to move or stop any part of the robot arm.
Do not drive the robot arm into any object or physical obstacle.
Do not leave a loaded arm extended for more than a few minutes.
Do not leave any of the axes under mechanical strain for any length of time.
Especially, do not leave the gripper grasping an object indefinitely.
Since the SCORBOT-ER VII motors are rated 12VDC nominal, while the
controller motor drivers supply 24VDC, do not drive axes continuously in one
direction at maximum speeds. Specifically, when using the ACL command:
SET ANOUT[n]=DAC, make sure the DAC value is in the range 2500.
Controller
Before you plug the controller into the AC outlet, make sure its voltage
requirement (as seen on the tag at the back of the controller) matches your
voltage supply.
If the voltage setting does not match your supply, do not connect the
controller; contact your agent.
Do not connect accessories to the driver cards for axes 1 through 6 (cards
with black brackets). Irreversible damage will occur.
Never connect voltage from a power supply directly to any open collector
outputs (terminals 516). The open collector ouputs must always be
connected to a load. Never connect a load to voltage exceeding 24VDC.
Never drive a current of more than 0.5A through the open collector outputs
(terminals 516).
1 - 6 SCORBOT-ER VII Users Manual
9602
CHAPTER 2
The Robot Arm
This chapter details the specifications and components of the
SCORBOT-ER VII robot arm.
Figure 2-1: SCORBOT-ER VII Robot Arm
Users Manual SCORBOT-ER VII 2 - 1
9602
Specifications
The following table details the robot arm specifications.
SCORBOT-ER VII Specifications
Mechanical Structure Vertical articulated
Number of Axes 5 axes plus gripper
Axis Movement
Axis 1: Base rotation
Axis 2: Shoulder rotation
Axis 3: Elbow rotation
Axis 4: Wrist pitch
Axis 5: Wrist roll
250; 310 user programmable
170
225
180
360
Maximum Operating Radius 690 (27.2") at flange
End Effector options Pneumatic and DCServo
Hard Home
Fixed position on each axis,
found by means of microswitches
Feedback
Optical incremental encoder on each axis;
96-slot disk
Actuators 12VDC servo motors
Transmission Harmonic drives; timing belts and pulleys
Maximum Payload 2 kg (4.4 lb.), including gripper
Position Repeatability 0.2 mm (0.008")
Weight 30 kg (66 lbs)
Maximum Path Velocity 1000 mm/sec (39.4"/sec)
Ambient Operating Temperature 240C (36104F)
2 - 2 SCORBOT-ER VII Users Manual
9602
Structure
The SCORBOT-ER VII is a vertical articulated robot, with five revolute joints.
With gripper attached, the robot has six degrees of freedom. This design permits
the end effector to be positioned and oriented arbitrarily within a large work space.
Figures 2-2 and 2-3 identify the joints and links of the mechanical arm.
The movements of the joints are described in the following table:
Axis No. Joint Name Motion Motor No.
1 Base Rotates the body. 1
2 Shoulder Raises and lowers the upper arm. 2
3 Elbow Raises and lowers the forearm. 3
4 Wrist Pitch Raises and lowers the end effector 4
5 Wrist Roll Rotates the end effector 5
Figure 2-2: Robot Arm Links
Figure 2-3: Robot Arm Joints
Users Manual SCORBOT-ER VII 2 - 3
9602
Work Envelope
The length of the links and the degree of rotation of the joints determine the
robots work envelope. Figure 2-4 shows the dimensions and reach of the
SCORBOT-ER VII.
The base of the robot is normally fixed to a stationary work surface. It may,
however, be attached to a slidebase, resulting in an extended working range.
Figure 2-4: Operating Range With Gripper Attached
2 - 4 SCORBOT-ER VII Users Manual
9602
Drive System
The main elements of the SCORBOT-ER VII drive system are motors,
Harmonic drive gears, and
pulleys and timing belts, as
shown in Figures 2-5 and 2-6.
Brush-commutated, DC
permanent magnet motors drive
the five axes. Figure 2-7 shows
the location of the motors. The
direction of motor revolution is
determined by the polarity of the
operating voltage: positive DC
voltage turns the motor in one
direction, while negative DC
voltage turns it in the opposite
direction. Each motor is fitted with an encoder for closed-loop control.
Motor Specifications
Motor Axes 1, 2, 3 Motor Axes 4, 5
Motor Constant 3.01 ozin / W 1.94 ozin / W
Peak Torque (Stall) 41.3 ozin 15.6 ozin
No Load Speed 6151 rpm 5592 rpm
Motor Friction Torque 0.60 ozin 0.50 ozin
Motor Weight 10.1 oz 8.98 oz
Axes 1 through 4 are driven by a two-stage transmission, as shown in Figure 2-5. The
roll axis (axis 5) is driven directly by a Harmonic drive gear.
Figure 2-5: Drive System
Figure 2-6: Transmissions Figure 2-7: Motor Locations
Users Manual SCORBOT-ER VII 2 - 5
9602
Position and Limit Devices
The SCORBOT-ER VII uses encoders, microswitches and hard stops to position
the robot arm and limit its motion.
Encoders
The location and movement of each SCORBOT-ER VII axis is measured by an
electro-optical incremental encoder which is attached to the shaft of the motor
which drives the axis, as shown in Figure 2-8.
When the robot axis moves, the encoder
generates a series of alternating high and low
electrical digital signals, which can be
understood by the controller. The controller reads
these signals and determines the extent and
direction of axis movement.
The encoder used on the SCORBOT-ER VII
contains a single light emitting diode (LED) as
its light source. Opposite the LED is a light
detector integrated circuit. This IC contains
several sets of photodetectors and the circuitry
for producing a digital signal.
A perforated, rotating disk is located between the
emitter and detector IC. The SCORBOT-ER VII
encoders have 96 slots, as shown in Figure 2-9. As
the encoder disk rotates between the emitter and detectors, the light beam is
interrupted by the pattern of bars and windows on the disk, resulting in a
series of pulses received by the detectors.
The photodetectors are arranged so that, alternately, some detect light while
others do not. The photodiode outputs are then fed through the signal processing
Figure 2-8: Encoder
Figure 2-9: Encoder Disk Figure 2-10: Encoder Output Signals
2 - 6 SCORBOT-ER VII Users Manual
9602
circuitry, resulting in the signals A, A, B and B. Comparators receive these
signals and produce the final digital outputs for channels A and B. The output of
channel A is in quadrature with that of channel B (90 out of phase), as shown in
Figure 2-10.
When the disk rotation is counterclockwise (as viewed from the encoder end of
the motor), channel A will lead channel B. When the disk rotation is clockwise,
channel B will lead channel A.
Microswitches
Microswitches, shown in Figure 2-11, are used in the
SCORBOT-ER VII to limit robot motion (limit
switches) and to home the robot (home switches).
Limit Switches
Limit switches prevent the joints from moving
beyond their functional limits. When the robot
control software fails to stop the axis at the end of
its working range, the limit switch serves to halt its
movement.
Each of axes 1 through 4 has two limit switches
one at each end of the axis working range. These
switches are mounted on a disk which is attached to
the robots frame and are normally depressed. Figure 2-12 shows the
microswitches on axis 3.
The Harmonic drive output shaft moves relative to the microswitch disk. As the
joint moves, the limit switch reaches a notch on the Harmonic drive output shaft,
which releases the activating button and thus activates the switch.
When the limit switch is activated, it causes a control error, resulting in the
activation of COFF, and an impact
protection message. CON must be
activated and the robot arm must be
manually moved (using keyboard or
teach pendant) away from the impact
condition.
Axis 5 (roll) has no limit switches; it
can rotate endlessly. When a gripper is
attached to axis 5, its movements are
controlled and limited by means of
software (encoder) only.
Figure 2-11: Microswitch
Figure 2-12: Microswitches on Axis
Users Manual SCORBOT-ER VII 2 - 7
9602
Home Switches
The SCORBOT-ER VII also has a microswitch on each axis to identify the fixed
reference, or home, position. The home switch is mounted on the same disk as the
limit switches, and is activated by the stopping screw on the Harmonic drive
output shaft.
During the homing procedure, the robot joints are moved one at a time. Each axis
is moved until its home switch is activated. The axis is then moved slightly until
the switch shuts offat that point the joint is at home.
When all joints are at home, the robot is at home. This is the point of reference
for robot operation. Whenever the system is turned on, the robot should be sent to
this position, by means of a software homing routine.
Hard Stops
When the software limits and/or the limit switches fail to halt the movement of
the robot arm, it is possible that the momentum of the robot arm will drive it until
it reaches its mechanical limit. The SCORBOT-ER VII has a stopping screw on
the Harmonic drive output shaft for this purpose.
If the stopping screw hits the microswitch disk, the impact protection processes
detect an error, thus activating COFF.
CON must be activated and the robot arm must be manually moved away from
the impact condition.
Gripper
The SCORBOT-ER VII can be equipped
with either a pneumatic gripper driven by
output signals, or by an electric servo gripper
driven by a DC motor and controlled as axis
number 6, shown in Figure 2-13.
These grippers have parallel finger motion.
The non-servo DC gripper (cat.#608) is no
longer available for the SCORBOT-ER VII.
Figure 2-13: DC Servo Gripper
2 - 8 SCORBOT-ER VII Users Manual
9602
Cables and Pin Assignments
The robot cable contains six cables with D9 connectors, for connecting to axis
driver card ports at the back of the controller. Each cable is labeled for a specific
axis. The robot cable wiring and pin assignments are given in the table below.
Refer also to Figure 2-14.
SCORBOT-ER VII Cables and Connector Pin Assignments
Axis #
(Robot Cable #)
D9 Connector
Pin #
Wire
Color
Connector
to Robot
PCB
Function
1
3 Red
Telephone
+5V
4 Blue Home switch
5 Black Common
6 Green Encoder channel B
8 White Encoder channel B
9 Red
Molex
Motor 1 +
1 Black Motor 1
2
3 Red
Telephone
+5V
4 Blue Home switch
5 Black Common
6 Green Encoder channel B
8 White Encoder channel B
9 Orange
Molex
Motor 2 +
1 Brown Motor 2
3
3 Red
Telephone
+5V
4 Blue Home switch
5 Black Common
6 Green Encoder channel B
8 White Encoder channel B
9 Violet
Molex
Motor 3 +
1 Yellow Motor 3
4
3 Red
Telephone
+5V
4 Blue Home switch
5 Black Common
6 Green Encoder channel B
8 White Encoder channel B
9 Blue
Molex
Motor 4 +
1 Light Blue Motor 4
Users Manual SCORBOT-ER VII 2 - 9
9602
SCORBOT-ER VII Cables and Connector Pin Assignments
Axis #
(Robot Cable #)
D9 Connector
Pin #
Wire
Color
Connector
to Robot
PCB
Function
5
3 Red
Telephone
+5V
4 Blue Home switch
5 Black Common
6 Green Encoder channel B
8 White Encoder channel B
9 Pink
Molex
Motor 5 +
1 Gray Motor 5
6
3 Red
Telephone
+5V
4 Blue Home switch
5 Black Common
6 Green Encoder channel B
8 White Encoder channel B
9 Green
Molex
Motor 6 +
1 White Motor 6
Figure 2-14: Robot Wiring
2 - 10 SCORBOT-ER VII Users Manual
9602
CHAPTER 3
The Controller
This chapter details the specifications and functions of Controller-A, which controls
the SCORBOT-ER VII robotic system.
Figure 3-1: Controller-A
Users Manual SCORBOT-ER VII 3 - 1
9602
Specifications
Item Controller-A Specification Notes
Type of Control
Stand-alone
Real-time
Multi-tasking
PID (proportional, integral, differential)
PWM (pulse width modulation)
Terminal or PC required
only for programming
stage.
Number of
Servo Axes
Standard: 8
Maximum: 11
Groups of Control
11 axes can be divided into 3 groups:
Group A
Group B
Group C (independent axes)
Each group has
independent control.
Axis interpolation in
groups A and B.
Axis Drivers
PWM (pulse width modulation)
20 KHz
Path Control
PTP (point to point), CP (continuous path)
Joint
Linear
Circular
User-defined path
10 ms control cycle.
Software controlled
acceleration/deceleration.
PID parameters.
Trajectory Control
Paraboloid
Trapezoid
Open Loop (not for user)
Speed Control
Speed
Travel time
Speed programmed as a
percentage of range.
Control Parameters
Servo control
Speed, velocity profile, smoothing
Axis position error
Gripper operation
Thermic, impact, limit protection
Homing
Encoder interface
Cartesian calculations
Power Requirements 100/110/220V AC, 50/60Hz, 500W max. 5%
Internal Power
Supplies
Motors: +24VDC, 18A
User: +12VDC, 2A
Weight 19 kg (42 lbs)
Dimensions
490mm (19.3") L
445mm (17.5") W
150mm (5.9") H
Ambient Operating
Temperature
240C (36104F)
CPU Motorola 68020
EPROM 384KB
3 - 2 SCORBOT-ER VII Users Manual
9602
Item Controller-A Specification Notes
RAM
System: 64KB
User: 128KB
Communication RS232 serial port
Inputs
16 inputs (with indicator LEDs);
NPN (default) and PNP logic modes.
TTL, 12V or 24V logic
Outputs
12 open collector outputs (with indicator LEDs);
NPN (default) and PNP logic modes.
4 relay outputs (with indicator LEDs)
Programming
Languages
ACL: Advanced Control Language
Using any terminal
Using PC with ATS
SCORBASE Level 5 Software Using PC
Position Recording
Absolute
Relative
Cartesian
Joint
Using: ACL,
SCORBASE,
Teach Pendant
No. of program
lines/positions
12800 lines or 6375 positions (or any combination)
No. of programs in
user RAM
Hundreds; depends on length of programs.
Multi-tasking Maximum simultaneous execution: 20 user tasks
Positioning System Incremental optical encoders
Coordinate System
XYZ coordinates
Joint coordinates
LED Indicators
Main power
Inputs/Outputs
Servo Power
Emergency
On front panel
Axis power On rear panel
Safety Features
Emergency switch
Motor power switch
On front panel
Adjustable current limit
Automatic fuse
On all axes
Thermic, impact and limit software protection
Connectors
Inputs/Outputs
User power supply
Terminals on front panel
Axis drivers
RS232 channel
Teach Pendant
Robot
Auxiliary RS232 channels (optional)
On rear panel:
D9 connectors
D25 connector
D25 connector
D50 connector
D37 connector
Teach Pendant
30 multi-function keys
2 line LCD display; 16 characters per line
Full control features
Users Manual SCORBOT-ER VII 3 - 3
9602
Controller Functions
The front panel of the controller contains switches, LEDs and connection
terminals for operator use. Refer to Figure 3-2.
Power On/Off Switch and LED
The controllers power switch, which is located on the side of the controller,
connects and disconnects AC power to the controller.
The yellow power LED on the controllers front panel lights up when the power
switch is turned on. It indicates that power is being supplied to the controller.
Motors and User Power Supply Switch and LED
This switch connects and and disconnects DC voltage to all the connected motors
and to the user power supply. A green LED embedded in the switch lights up
when the switch is on.
The motors switch is turned off in the following circumstances:
To disconnect power to the motors, user power supply, and inputs without
turning off the controller.
Motor power is disconnected; all motor movement stops; the green motors
LED shuts off. All the green LEDs on the rear panel shut off.
The controllers CPU is reset and the following appears on the screen:
---- RAM TEST COMPLETE.
---- ROM TEST COMPLETE.
SYSTEM READY!
>_
The robot must be homed before work can resume following an Emergency.
User Power Supply Terminals
The user power supply allows external devices in the users applications to
receive power from the controller. The controller user power supply has four
terminals:
When the input is operating in NPN mode, short the input by connecting it to
a ground connector.
When the input is operating in PNP mode, short the input by connecting it to
the user power supply.
Figure 3-3: Input Terminals
3 - 6 SCORBOT-ER VII Users Manual
9602
Outputs
The controllers outputs allow the robotic system to transmit signals to external
devices in the robots environment. The controller has 4 relay outputs and 12
open collector outputs.
Relay Outputs 1-4
Outputs 1 to 4, shown in Figure 3-4,
include relays in their final stage. Each
relay includes three contact points:
Common Tab (COM)
Normally Closed Tab (NC)
Normally Open Tab (NO)
Maximum voltage allowed: 24VDC
Maximum current allowed: 4A
Figure 3-5 shows the ON and OFF states
of a relay output.
Open Collector Outputs 5-16
Outputs 5 to 16, shown in Figure 3-6,
include a transistor with an open collector
in their final stage. These outputs must be
connected to a load.
Never connect open collector outputs
directly to a power supply or ground.
When using an inductive load, such as a
solenoid or relay, connect a protection diode across the load. You may connect an
open collector output directly to an input.
Open collector outputs can be operated in either of two modes:
Cable connections
Connect the cables D37 connector to the auxiliary RS232 port on the
controller.
The auxiliary card may have a cable with either two or eight D25 connectors.
Connect the cables D25 connectors to the corresponding COM ports on the
other controllers or computers. (If any of these COM ports requires a D9
connector, use a standard D25-D9 adapter to connect the RS232 cable).
To install an auxiliary RS232 communication card in your controller, follow the
instructions described in the section, Adjustments and Repairs, in Chapter 8.
6. If you will be using a teach pendant, connect it to the Teach Pendant port (D25
connector) on the controller.
7. If you will be operating additional axes by means of the controller, connect them
at this time. Refer to the following section, Peripheral Axes.
8. When you have completed all cable connections, tighten all retaining screws on
all the connectors.
Figure 4-3: Controller Rear Panel
Users Manual SCORBOT-ER VII 4 - 3
9602
9. Make sure the controllers power switch is off. Then plug the controllers power
cable into AC power supply outlet.
10. You may now perform the Power On, Configuration and Homing
procedures according to the instructions which appear later in this chapter.
Peripheral Axes
Do not connect peripheral devices to the axis driver connectors labeled 1, 2, 3,
4, 5 and 6, which are reserved for the SCORBOT-ER VII robot axes and electric
gripper. Doing so will cause irreversible damage.
Use only axis driver connectors 7 and 8 (and 9 through 11 where available) for
connecting peripheral devices.
For information on installing additional driver cards, refer to the section,
Adjustments and Repairs, in Chapter 8.
For instructions on configuring Controller-A for use with peripheral devices,
refer to the ATS Reference Guide.
Do not connect accessories which require high current to axis 8 or 10.
Accessories which require high current (such as the linear slidebase) must be
connected to axis 7, 9 or 11.
Power On
1. Once you have made all the required hardware connections, you can power on the
controller.
Program editor.
Backup manager.
Print manager.
ATS is described fully in the ATS Reference Guide.
ACLoff-line
ACLoff-line is a preprocessor software utility, which lets you access and use
your own text editor to create and edit ACL programs even when the controller is
not connected or not communicating with your computer.
After communication is established, the Downloader utility lets you transfer your
program to the controller. The Downloader detects the preprocessor directives,
and replaces them with a string or block of ACL program code.
ACLoff-line also enables activation of ATS, Advanced Terminal Software, for
on-line programming and system operation.
ACLoff-line is described fully in the ACLoff-line Users Manual.
SCORBASE
SCORBASE is a robotic control software package which can be used with
Controller-A. Its menu-driven structure and off-line capabilities facilitate robotic
programming and operation.
SCORBASE is supplied on diskette and operates on any PC system.
SCORBASE communicates with ACL, the controllers internal language, by
means of an RS232 channel.
Levels 1, 2 and 3 of the SCORBASE software can be ordered separately, and are
recommended for those who wish to learn robotic programming from the most
basic stages.
SCORBASE is described fully in the SCORBASE Level 5 Reference Guide.
5 - 2 SCORBOT-ER VII Users Manual
9602
Teach Pendant
The teach pendant is an optional device.
The teach pendant (TP) is a hand-held terminal, used for controlling the robot and
axis connected to Controller-A. The teach pendant is most practical for moving
the axes, recording positions, sending the axes to recorded positions, and
activating programs. Other
functions can also be executed from
the teach pendant.
The teach pendants display panel is
a 2-line, 32 character liquid crystal
display (LCD). It shows the current
status of the controller, the current
user command, and system
messages.
The teach pendant has 30 function
keys. These functions are described
in this chapter. Many of the
command keys on the teach pendant
are ACL commands; these
commands are described fully in the
ACL Reference Guide.
Keypad Functions
The teach pendants keypad has 30
color-coded keys. Most of the keys
are multi-functional; for example,
some keys include both an axis
drive command and a numeric
function. The controller recognizes
the keys from the order in which they are pressed. Thus, the numeric function will
be active only if a function such as SPEED, RUN, or MOVE has been keyed in
first; otherwise, the axis drive command will be active.
Following are descriptions of the teach pendants keys and instructions for
activating them. Bulleted items indicate the different functions of multi-functional
keys.
Figure 5-1: Teach Pendant
Users Manual SCORBOT-ER VII 5 - 3
9602
Accepts and/or executes the command which has been entered.
Starts execution of a program following a Run command.
A toggle key. Switches the command mode between Joints and Cartesian (XYZ).
When used following a numeric function, this key acts as a backspace function; it
cancels the last numeric entry and moves the cursor one position to the left.
The numeric keys are operative if one of the following functions has been
activated: Speed, Run, Record Position, Go Position, Group Select.
5 - 4 SCORBOT-ER VII Users Manual
9602
In Joint mode: the Base/X keys move the base axis in two directions.
In XYZ mode: the Base/X keys move the TCP (tip of gripper) along the X-axis;
Y and Z coordinates do not change.
In Joint mode: the Shoulder/Y keys move the shoulder axis in two directions.
In XYZ mode: the Shoulder/Y keys move the the TCP (tip of gripper) along the
Y-axis; X and Z coordinates do not change.
In Joint mode: the Elbow/Z keys move the elbow axis in two directions.
In XYZ mode, the Elbow/Z keys move the TCP (tip of gripper) along the Z-axis;
X and Y coordinates do not change.
In Joint mode: the Pitch keys move the TCP (tip of gripper) up or down, without
moving the other axes.
In XYZ mode: the Pitch keys move three axes (shoulder, elbow and pitch) in
order to change the pitch angle without changing the position of the TCP (tip of
gripper).
In both Joint and XYZ modes: the Roll keys move the roll axis in two directions.
A toggle key. Opens and closes the electrical gripper.
Users Manual SCORBOT-ER VII 5 - 5
9602
Sets the speed of manual axis movement of the current axis control group; that is,
group A, B, or C. The speed is defined as a percentage (1-100) of maximum
speed.
Press Speed. The current speed is displayed.
Press Enter to accept the displayed default speed. Or use the numerical keys
to enter a different speed, and press Enter.
Defines and records a position.
Only numerical position names, of up to five digits, can be entered from the TP.
The position is defined for the currently active group, and receives the current
values of the axes in that group.
Press Record Position. Then press up to five digits for the position name.
Then press Enter to record the position coordinates.
If you use a position name which has already been defined, the new coordinates
will overwrite the existing ones.
This command is also used to record positions in a vector. The vector must first be
attached to the teach pendant by means of the ACL command ATTACH.
Moves the axes to a target position.
Press Go Position. Then use the numeric keys to enter the position name.
Then press Enter to execute the move.
In Joint mode: robot movement is by joints.
In XYZ mode: robot movement is linear.
To send the axes to their home position, enter the following commands:
Go Position 0 sends all the axes of group A to their HOME position.
Go Position 00 sends all the axes of group B to their HOME position.
number
number
number
5 - 6 SCORBOT-ER VII Users Manual
9602
Executes a program.
Press Run. Then press the programs identity number on the numerical keys. The
program name will be displayed in brackets. Then press Enter to begin program
execution.
The controller automatically assigns an ID number to each user program. The
ACL command DIR lists the programs and their assigned (IDENTITY) number.
Aborts execution of all running programs. Stops movement of the robot and all
peripheral axes.
The Display Panel
The LCD panel shows the current status of the controller, the current user
command, and system messages.
A resident note shows the coordinates system currently active: JOINTS or XYZ.
Another resident note shows the currently active group: A, B, or the number of
one of the independent axes in control group C.
number
Users Manual SCORBOT-ER VII 5 - 7
9602
This page intentionally left blank.
5 - 8 SCORBOT-ER VII Users Manual
9602
CHAPTER 6
Operating the Robot
This chapter introduces you to the basic commands for operating the
SCORBOT-ER VII robot by means of both the ACL software and the teach
pendant.
DIRECT Mode
This chapter describes the operation of the robotic system when it is functioning
in the DIRECT mode. When the system is in DIRECT mode, the user has direct
control of the axes, and the controller executes commands as soon as they are
entered by the user.
When in DIRECT mode, the screen prompt appears like this: >_
When the system is operating in EDIT mode, commands are entered into a user
program, which can be saved and executed at a later time. Program editing
procedures are described in Chapter 7.
Manual Mode
Manual mode is available when the system is in DIRECT mode. The Manual
mode enables direct control of the robot axes when a teach pendant is not
connected.
When using the keyboard to perform some of the procedures described in this
chapter, the system must be in Manual mode.
To activate Manual mode, hold the <Alt> key and press the character M:
<Alt> + m
The system will respond in one of the following ways:
MANUAL MODE! MANUAL MODE!
>_ >_
JOINT MODE XYZ MODE
The systems response indicates the currently active coordinate system.
Users Manual SCORBOT-ER VII 6 - 1
9602
To exit Manual mode, the same command is used.
Press: <Alt> + m
EXIT MANUAL MODE...
>_
Using this Manual
To familiarize yourself with the system, you should read through this chapter
(and the following ones) and practice entering the commands described in each
section.
All operations described in this chapter can be performed from the keyboard. The
steps for using the keyboard are indicated by the heading PC. The teach pendant
is optional. The operations which can also be performed from the teach pendant
are indicated by the heading TP.
This manual uses the following typographical conventions:
Descriptions of PC operation show user entries in bold, lowercase text. System
responses are shown in capital letters. (The actual screen display may be
different.) For example:
home <Enter>
WAIT!! HOMING...
The system is not case-sensitive. You may use either uppercase and lowercase
characters to enter commands and data.
Descriptions of TP operation show the teach pendant keys which the user must
press. System responses are shown in boxed capital letters. For example:
CONTROL ENABLED
A JOINTS
Activating the Sytem
Activate the system and load the ATS software, as described in the section,
Power On, in Chapter 4.
6 - 2 SCORBOT-ER VII Users Manual
9602
Homing the Robot and Peripheral Axes
The location of the robot axes is monitored by encoders which track the amount
of movement relative to an initialhomeposition. To obtain repeatable robot
performance, this reference position must be identical each time the robot is used.
Thus, whenever the system is activated, the homing program, which is internally
programmed into the controller, must be executed.
During the homing procedure, the robot joints move and search for their home
positions, one at a time. Each axis is moved until the microswitch which is
mounted on the joint sends a specific signal to the controller, indicating the axis is
at home.
Before you begin the homing procedure, make sure the robot has ample space in
which to move freely and extend its arm.
TP
Press:
This instructs the controller to execute Program 0, the robot homing routine. The
display panel on the teach pendant will show:
HOMING. . .
When the Home search is successfully completed, the display panel will show:
HOMING COMPLETE
If the robot is unable to find a home position in one or more of the axes, you will
see a message such as:
HOME FAIL [4]
To stop the homing while the operation is in progress, press the Abort key.
The peripheral axes are homed by means of the TP command Run 00.
PC
To home the robot axes (Group A), use the ACL command HOME.
Type: home <Enter>
WAIT!! HOMING...
If all axes reach their home postion, a message is displayed:
HOMING COMPLETE (ROBOT)
Users Manual SCORBOT-ER VII 6 - 3
9602
If the homing process is not completed, an error message identifying the failure is
displayed:
*** HOME FAILURE AXIS 4
To stop the homing while the operation is in progress, use the abort commands:
Type: A <Enter>
or press: <Ctrl>+A
To home peripheral axes, each axis must be homed individually; for example:
Type: home 7 <Enter>
home 8 <Enter>
home 9 <Enter>
To home an axis, such as a slidebase, which uses a hard stop rather than a
microswitch, use the ACL command HHOME.
Type: hhome 8 <Enter>
6 - 4 SCORBOT-ER VII Users Manual
9602
Coordinate Systems
The SCORBOT-ER VII can be operated and programmed in two different
coordinate systems: Joint and Cartesian (XYZ) coordinates.
Cartesian (XYZ) Coordinates
The Cartesian, or XYZ,
coordinate system is a geometric
system used to specify the
position of the robots TCP (tool
center point=tip of gripper) by
defining its distance, in linear
units, from the point of origin
(the center bottom of its base)
along three linear axes, as shown
in Figure 6-1.
To complete the position
definition, the pitch and roll are
specified in angular units.
When robot motion is executed
in XYZ mode, all or some of the
axes move in order to move the
TCP along an X, Y or Z axis.
Joint Coordinates
Joint coordinates specify the location of each axis in encoder counts. When the
axes move, the optical encoders generate a series of alternating high and low
electrical signals. The number of signals is proportional to the amount of axis
motion; the controller counts the signals and determines how far an axis has
moved. Similarly, a robot movement or position can be defined as a specific
number of encoder counts for each axis, relative to the home position, or another
coordinate.
When robot motion is executed in Joint mode, individual axes move according to
the command.
If any peripheral devices are connected to the robotic system, the position of their
axes is always stated in encoder counts.
Figure 6-1: Cartesian Coordinates
Users Manual SCORBOT-ER VII 6 - 5
9602
TP
To toggle between the two coordinate systems:
Press:
A JOINTS
Press
again:
A XYZ
The display reflects the currently active coordinate system. Manual movement of
the axes will be executed according to the currently active coordinate system.
PC
To select a coordinate system from the keyboard, you must first activate Manual
mode.
To activate the Joint coordinate system:
Press: j
JOINT MODE
To activate the XYZ coordinate system:
Press: x
XYZ MODE
6 - 6 SCORBOT-ER VII Users Manual
9602
Servo Control
The controller must be in the servo control (CON) state for the axes to execute
movement commands.
Activating the Home routine will activate CON.
Certain events, such as impact, overheating (thermic error), or activation of the
Emergency switch, will automatically switch off the servo control state (COFF).
CON must be activated to resume motion and servo control.
While the controller is in the COFF state, you cannot operate the axes.
TP
To toggle servo control on and off:
Press:
CONTROL ENABLED
Press
again:
CONTROL DISABLED
When Control On/Off is activated from the teach pendant, the CONTROL
ENABLED/CONTROL DISABLED message also appears on the computer
screen.
PC
If Manual mode is active you can enable and disable control from the keyboard.
Press: c
CONTROL ENABLED
Press: f
CONTROL DISABLED
The commands C and F enable and disable control of all axes which are
connected to the controller.
Users Manual SCORBOT-ER VII 6 - 7
9602
If Manual mode is not active, you can use the ACL commands CON and COFF.
Type: con <Enter> Enables control of all axes.
Type: coff <Enter> Disables control of all axes.
The format can be altered to enable and disable control of specific groups of axes;
for example:
cona Enables control of robot axes (Group A).
coffb Disables control of peripheral axes (Group B).
con 9 Enables control of axis 9 (Group C).
Axis Control Groups
By default, the controller assumes the five robot axes (Group A) are under servo
control. The Group Select key allows you to switch control to peripheral axes
(Group B), or to an independent axis (Group C).
TP
To select the axis control group:
Press:
_
B JOINTS
Press
again:
AXIS . .
When selecting an independent (Group C) axis, you must also key in the axis
number followed by Enter.
Continue pressing this key until the desired axis group is displayed.
PC
ACL does not have a command for selecting the axis control group. The specific
format of each command indicates the axis control group.
6 - 8 SCORBOT-ER VII Users Manual
9602
Moving the Axes
XYZ and Joint Movements
When the coordinate system is set to the XYZ mode:
Movement commands to the pitch or roll axis will change the orientation (of
the gripper or tool) while maintaining a constant TCP position.
When the coordinate system is set to the Joint mode, movement commands cause
the robot to move one joint. Peripheral axes always move according to Joint
coordinates.
TP
When in XYZ mode, the controller recognizes the Cartesian functions of the
teach pendant keys.
When in Joint mode, the controller recognizes the joint functions (shaded in
diagram) of the teach pendant keys.
The teach pendant offers the easiest method for
moving the robot arm. You simply press an axis
movement key, and the robot moves. When you
release the key, movement stops.
Before you press the keys shown below, make
sure JOINTS, Group A, and Control On are
active. Move the axes of the robot, in both
directions.
Press:
Press:
Press:
Press:
Press:
Users Manual SCORBOT-ER VII 6 - 9
9602
Before you press the keys shown below, make sure XYZ appears on the teach
pendant display. Watch how the keys now affect the movement of the TCP.
Press:
Press:
Press:
PC
To directly control movement of the robot axes from the keyboard, Manual mode
and Control On must first be activated. The keys listed below are then used to
move the robot.
The axes will move as long as the activating key is depressed, until a fixed stop is
reached. The gripper will either open completely or close completely.
In Joint mode, the keys produce the following movements:
Press: 1, Q
2, W
3, E
4, R
5, T
6, Y
Move axis 1 (base)
Move axis 2 (shoulder)
Move axis 3 (elbow)
Move axis 4 (wrist pitch)
Move axis 5 (wrist roll)
Closes/Opens electrical gripper (axis 6)
In XYZ mode the following changes in manual movement occur:
Press: 1, Q
2, W
3, E
4, R
TCP moves along X+ and X axes.
TCP moves along Y+ and Y axes.
TCP moves along Z+ and Z axes.
Pitch moves; TCP maintains position.
All other movements are the same as in Joint mode.
In XYZ mode, moving the robot to positions at the maximum range of reach may
result in jerky movements. Use Joint mode to reach these positions.
While moving the arm, you may alternate between XYZ and Joint modes as often
as required.
If peripheral axes are connected, the following keys are also used:
Press: 7, U
8, I
9, O
0, P
, [
Move axis 7
Move axis 8
Move axis 9
Move axis 10
Move axis 11
6 - 10 SCORBOT-ER VII Users Manual
9602
Activating the Gripper
In response to the commands to open and close, the electrical gripper goes
completely from one state to the other.
TP:
Press:
The Open/Close key toggles the gripper between its open and closed states.
If the gripper was open it will now close, and vice versa. Repeat the command.
PC:
When Manual mode is active, the following keys activate the gripper.
Press: Y Opens the gripper.
Press: 6 Closes the gripper.
When Manual mode is not active, the ACL commands OPEN and CLOSE are
used.
Type: open <Enter>
Type: close <Enter>
Pneumatic grippers or devices are controlled by means of ACL output commands.
To activate a pneumatic gripper or end effector from the teach pendant, ACL
output commands must be written to two program (one for opening the gripper
and one for closing it). Each program can then be called from the teach pendant,
resulting in activation of the pneumatic gripper or device.
For more information, refer to the section on I/O programming in Chapter 7.
Users Manual SCORBOT-ER VII 6 - 11
9602
Setting the Speed
TP
The speed of the robot during Go Position movements controlled from the teach
pendant is defined as a percentage of maximum speed. Speed defined as 100
gives the robot maximum speed, while a speed of 1 is the minimum. When the
system is first turned on, the default speed is set at 50, approximately half the
robots maximum speed.
The speed of the robot during manual movements controlled from the teach
pendant is relative to the speed setting, and much slower than Go Position
movements.
Use the teach pendant to set the robots speed to a speed of 30%, for example:
Press:
All Go Position movement commands will be executed at a speed of 30, until a
different speed is entered.
PC
When Manual mode is active, use the key S to set the speed of manual movement.
Press: s
SPEED.._
You are prompted for a speed valuea percentage of the maximum speed.
Type a number between 1100, and press <Enter>.
When Manual mode is not active, the ACL command SPEED is used to define
the speed at which movements are executed. For example:
speed 50 Sets speed movements of Group A axes to 50% of
maximum speed.
speedb 20 Sets speed of movements of peripheral axes (Group B) to
20% of maximum speed.
6 - 12 SCORBOT-ER VII Users Manual
9602
Defining and Recording Positions
Defining a position reserves space in controller memory, and assigns it a name.
Recording a position writes coordinate values to the allocated space in controller
memory.
Two types of position names are possible:
The first line shows the joint coordinates; defined in encoder counts.
The second line shows the Cartesian (XYZ) coordinates. X, Y and Z are
defined in tenths of millimeters; P (Pitch) and R (Roll) are defined in tenths of
degrees. For example:
Z: 6011 Z = 601.1mm
P:-636 P =63.6
Deleting Positions
PC
To delete positions, use the ACL command DELP.
Type: delp A99 <Enter>
DO YOU REALLY WANT TO DELETE THAT POINT? (YES/NO)>_
Type: yes <Enter>.
A99 DELETED.
To prevent accidental deletion of a position, you are required to respond by
entering the entire word yes, followed by <Enter>. Entering any other other
character, including Y, is regarded as no.
6 - 16 SCORBOT-ER VII Users Manual
9602
Moving to Recorded Position
Once a position has been recorded, you can easily send the robot (or other devices
connected to the controller) to that position. Depending on the currently active
coordinate system, the movement of the robot (Group A) will be either point to
point (in Joint mode) or along a linear or curved path (in XYZ mode).
TP
Assuming the robot is at position 13, send the robot back to position 12.
Press:
DONE
Use the command Go Position 0 to send all the axes of group A to the home
position.
PC
Use the ACL command MOVE to send the robot to a position.
Assuming the robot is at home, send the robot to position A31.
Type: move A31 <Enter>
In this command the robot moves at the current speed setting.
The MOVE command may contain a duration parameter, which is defined in
hundredths of a second. To send the robot to position A32 in 10 seconds:
Type: move A32 1000 <Enter>
You can use the PC to move to positions recorded by the TP.
Alternately, you can use the TP to move to positions recorded by means of the
PC, providing the positions are defined by numerical names. For example:
Type move 13 <Enter>
Users Manual SCORBOT-ER VII 6 - 17
9602
Linear Movement
To move the TCP in a straight path, use the ACL command MOVEL.
For example, send the robot from the home position to position A33.
Type: move 0 <Enter>
Type: movel A33 <Enter>
Circular Movement
To move the TCP along a curved path, use the ACL command MOVEC, use the
ACL command MOVEC.
You must specify two positions for MOVEC. Otherwise there are infinite
possibilities for defining the curve. For example, send the robot from the home
position to position A31, via position A32.
Be careful when using this command. For the first attempt, set the speed to a low
setting, such as 20.
Type: move 0 <Enter>
Type: speed 20 <Enter>
Type: movec A31 A32 <Enter>
Reset the speed to 50 when you have completed the movement.
6 - 18 SCORBOT-ER VII Users Manual
9602
CHAPTER 7
Programming with ACL
This chapter serves as a tutorial to help you become familiar with program
editing. To learn how to write and edit a program, you should follow, in
sequence, the procedures described in this chapter.
This chapter introduces you to the basic commands for programming the
SCORBOT-ER VII. Many more commands and formats are available in the
ACL language. Refer to the ACL Reference Guide for complete lists and
descriptions of editing functions and ACL commands.
For additional instruction in the procedures introduced in this chapter, the ACL
Laboratory Manual (catalog #100039) is recommended.
EDIT Mode
So far you have learned to operate the robot in the DIRECT mode, in which all
commands are executed the moment you press <Enter>.
To write programs which will be executed by the robotic system, you will use the
EDIT mode.
Whenever the EDIT mode is active, the screen shows the current program line
number and a prompt, such as this: 143:?_
The controller assigns the line numbers; they are not user definable.
Help
Quick, on-line help is available while you are working with ACL.
Simply enter the command HELP.
A list of DIRECT mode commands are displayed when in DIRECT mode;
a list of EDIT mode commands are displayed when in EDIT.
Enter the command DO HELP when in DIRECT mode in order to display the
EDIT mode commands.
Users Manual SCORBOT-ER VII 7 - 1
9206
Creating a Program
To create a program, activate the EDIT mode by using the command EDIT,
followed by the name you want to call the program. Program names are limited to
five characters; for example:
Type: edit aaa <Enter>
AAA NEW PROGRAM
DO YOU WANT TO CREATE THAT PROGRAM (Y/N)>
Type: y <Enter>
PROGRAM AAA
*********************
25:?_
At the ?_ prompt, you can begin entering program command lines.
Writing a Program
To write a program which will send the robot to each of the positions recorded
earlier, enter the following command lines:
Type: moved A31 <Enter>
moved A32 <Enter>
moved A33 <Enter>
exit
AAA IS VALID
Although the command MOVE may be used in EDIT mode, the command
MOVED is preferable. MOVED ensures that the robot will accurately reach the
target position before continuing to the next command.
The commands MOVEL and MOVEC are also available in EDIT mode. As with
the MOVE command, it is preferable to use the command format with the D
suffix; that is, MOVELD and MOVECD.
The EXIT command is used to end the current editing session and return the
system to DIRECT mode.
7 - 2 SCORBOT-ER VII Users Manual
9206
Running a Program
When the > prompt is displayed, it indicates the system is in DIRECT mode. To
check the program you have just created, do the following:
Make sure control is enabled (CON) and the robot is at its home position.
Type: run aaa <Enter>
DONE
The robot moves to positions A31, A32 and A33, and then stops.
Program Loop
You will now edit the program and add command lines which will cause the
program to run in a loop.
Program loops are created by using the companion commands, LABEL and
GOTO.
Private variables are defined and manipulated in the EDIT mode and
recognized only by the specific program in which they are defined.
Global variables can be defined and manipulated in both the EDIT and
DIRECT modes, and can be used in any program.
7 - 6 SCORBOT-ER VII Users Manual
9206
The command DEFINE is used to define a private variable. Up to twelve
variables can be defined in one command. For example:
Type: define pv <Enter> Defines PV as a private variable.
define va vb vc <Enter> Defines VA, VB and VC as private
variables.
The command GLOBAL is used to define a global variable. Up to twelve
variables can be defined in one command. For example:
global gv <Enter> Defines GV as a global variable.
global gva gvb gvc <Enter> Defines GVA, GVB and GVC as
global variables.
Variable names must begin with an alphabetical character and may have up to 5
characters.
The commands DIM[n] and DIMG[n] are used to define arrays of private and
global variable arrays, respectively; n defines the dimension (number of elements)
in the array.
Mathematical and Logical Functions
The SET command performs mathematical and logical operations on variables.
The command format may be one of the following:
set var1=var2
set var1=oper var2
set var1=var2 oper var3
Where: var1 is a variable;
var2 and var3 can be either a variable or a constant.
oper is: Arithmetic operator: + * /
Algebraic operator: ABS, EXP, LOG, MOD
Trigonometrical operator: COS, SIN, TAN, ATAN
Logical (Boolean) operator: AND, OR, NOT
The simplest format assigns a variable the value of a constant or another variable.
For example:
set var = 1
set var1 = var2
The value of a variable can be the result of an operation performed on another
variable. For example:
set var1 = abs var2 If the value of var2 is -1, var1 is set
to 1.
Users Manual SCORBOT-ER VII 7 - 7
9206
The value of a variable can be the result of a mathematical operation performed
on either two other variables or another variable and a constant. For example:
set var1 = var2 + 1 The value of var1 is greater by 1
than the value of var2.
set vara = varb * varc The value of vara is the result of
varb multiplied by varc.
set var = var + 100 The result of an operation can equal
the same variable, thereby changing
its value. The value of var now
equals the previous value of var plus
1000.
Iteration Functions
Many applications require task iteration, or repetition. Variables can be used to
produce program loops which repeat a command or commands, thereby avoiding
the need for redundant command lines within a program
The command format FOR var1 = var2 TO var3 enables a program routine
to be executed repeatedly. Var1 must be a variable; var2 and var3 may be either
variables or constants. For example, enter the following commands to create
program LOOP:
edit loop
for var=1 to 10
println "LOOP"
endfor
exit
The variable is a counter, which is set initially to 1 and increased by one each
time the loop is performed. When the counter value reaches the final value (10 in
this example), the loop is performed for the last time.
The ENDFOR command is required to mark the end of the loop.
The PRINTLN command causes comments (text within quotation marks) to be
displayed on the screen during program execution. Thus, when you run program
LOOP, the word LOOP will be displayed 10 times.
By altering the PRINTLN command line you can cause the system to report
which loop has been completed. Bring the cursor to the ENDFOR command line.
Enter the command DEL; this will delete the preceding command line. Then enter
a new command line:
println "LOOP " var
Make sure you have included a space following the text LOOP.
7 - 8 SCORBOT-ER VII Users Manual
9206
The PRINTLN command causes the current value of a variable to be displayed on
the screen during program execution. Thus, when you run program LOOP, the
following will now appear on the screen.
LOOP 1
LOOP 2
LOOP 3
. . . and so on, until LOOP 10 is displayed.
In the section on input/output programming later in this chapter, you will see
additional examples of program loops which enable the system to check and
respond to the state of the controllers 16 inputs.
Conditional Functions
Many applications require the program to flow according to certain conditions.
The command format IF var1 oper var2 checks the relation between var1 and
var2. Var1 must be a variable; var2 may be either a variable or a constant. Oper is
one of the following comparison operators: > < + >= <= <>
When the IF statement is true, the program executes the next line(s), until it
reaches an ENDIF command, which marks the end of the conditional routine.
if var1=var2
goto 1
endif
The IF statement may, however, be followed by another conditional statement.
The next line may be an alternative condition (ORIF) or an additional condition
(ANDIF).
if var1=var2
orif var3>10
goto 2
endif
At least one of the two conditions
must be true in order for the
program to jump to label 2
if var1=var2
andif var3>10
goto 2
endif
Both conditions must be true in
order for the program to jump to
label 2.
The conditional routine may also contain a routine to be executed when the IF
condition is false. The beginning of such a routine begins with the command
ELSE.
if var1=var2
goto 2
else
goto 1
endif
If the condition is not true, the
program will jump to label 1.
Users Manual SCORBOT-ER VII 7 - 9
9206
Input and Output Programming
The state of the controllers 16 inputs and 16 outputs is determined by means of two
system variables, IN[n] and OUT[n]; n specifies the I/O index; that is, 116.
The value of the variable indicates whether the input or output is on or off; when
the value of the variable is 1, the input or output is ON; when the value is 0, the
input or output is OFF.
Displaying Input/Output Status
The I/O LEDs on the front panel of the controller turn on and off to reflect the
status of the inputs and outputs. If you are not close enough to see the controller
panel, you may want another means to check the I/O status.
In DIRECT mode, use the following commands to display the status of all 16
inputs and outputs, respectively:
Type: show din <Enter> Shows status of the inputs.
Type: show dout <Enter> Shows status of the outputs.
The display will indicate the I/O status in the following manner:
1>16: 0 1 0 1 0 0 0 0 0 1 0 0 1 1 0 0
O.K.
When editing a program, use the command PRINTLN to display the status of a
specific input or output during program execution. For example:
println in[5] When this command is encountered during program
execution, either 1 or 0 will be displayed (that is, the
value of variable IN[5]), depending on the state of input
5;
Inputs
Conditional commands, such as IF and WAIT, are used to read and respond to the
state of the inputs. For example, you can use the following routine in a program:
if in[3]=1
move A31
else
move A32
endif
If input 3 is ON, then
Move to position A31.
If input 3 is NOT ON (off), then
Move to position A32.
End of conditional routine.
7 - 10 SCORBOT-ER VII Users Manual
9206
Outputs
As with inputs, conditional commands can read and respond to the state of the
outputs. Commands can also be used to alter the state of outputs.
To change the state of an outputin both DIRECT and EDIT modesuse the
SET command. For example:
set out[6]=1 <Enter> Turns ON input 6.
set out[8]=0 <Enter> Turns OFF input 8.
Activating Output-Driven Devices
Pneumatic End Effectors or Devices
As mentioned in Chapter 6, pneumatic end effectors or devices are connected to
controller outputs and controlled by means of ACL output commands.
Assuming a pneumatic gripper is connected to controller (relay) output 2, use the
following command format
set out[2]=1 <Enter> Turn on output 2 to open the gripper.
set out[2]=0 <Enter> Turn off output 2 to close the gripper.
In order to activate the pneumatic gripper from the teach pendant, you need to
create two programs (named OGRIP and CGRIP, for example) which can be called
from the teach pendant by means of the Run key. Each program contains one of the
commands shown above.
The asterisk * precedes a user comment within a program; the comment is not
displayed during program execution.
The second IF command starts a routine which checks and responds to the the
state of input 16. If input 16 is on, output 16 will not light; the program will
go to label 2 and terminate.
Validity: If the program is valid no message appears. Not valid will appear
if the program contains a logic error, such as a FOR command without an
ENDFOR command.
The teach pendant, and any peripheral devices or accesssories which will be
used, are properly connected to the controller.
The fan in the front panel rotates and draws air into the controller.
The fan in the rear panel, within the supply unit, extracts air from the
controller.
All inputs are scanned. If an input is on, the corresponding output is also
turned on.
To simulate the activation of an input when no device is connected, short the
input manually by means of a wire or an unraveled paper clip.
When the input is operating in NPN mode, short the input by connecting it
to a ground connector.
When the input is operating in PNP mode, short the input by connecting it
to the user power supply.
If you want to check the homing microswitches, use the command LSON before
entering the TEST command. Use command SHOW DIN to see the results.
Diagnostic Procedures
1. Controller does not turn on. The yellow power LED does not light up. Fans do
not rotate.
Make sure the AC power supply matches the controllers voltage requirement,
as seen on the tag at the back of the controller. If the voltage supply and
controller voltage setting do not match, change the voltage setting, as
described later in this chapter.
Make sure the power cable is connected to both the proper power source and
the controller.
Check for a blown logic power supply fuse. Using an ohmeter, measure the
resistance of the fuses. If resistance is close to 0, the fuse is functioning.
Users Manual SCORBOT-ER VII 8 - 3
9602
2. Controllers motors switch does not turn on. Motors green LED does not light up.
Check for a blown power transformer fuse. Using an ohmeter, measure the
resistance of the fuses. If resistance is close to 0, the fuse is functioning.
3. No communication between the controller and the computer/terminal.
Message appears on screen "Controller Not Responding".
Make sure the RS232 cable between the controller RS232 port and the
computer COM port is properly connected.
Make sure you have loaded ATS with the proper /C switch.
If teach pendant also does not function, make sure the flat cable is properly
connected between the communication card (PC700) and connector J8 on the
main board. Refer to Figure 8-5.
Make sure the hardware and software configuration are compatible with the
user RAM ICs:
Hardware: Refer to Figure 8-1. Make sure all four jumpers for configuring
user RAM (W1, W1A, W2, W2A) are set for 128K RAM. The two lower
pins must be shorted.
Software: Make sure the controller is configured for 128K memory by
entering the command: CONFIG ?
Remove the user RAM ICs (U4, U10, U16, U21) and reinsert them.
If problem persists, remove the driver cards and again turn the controller
power switch off and on again.
Make sure you have performed all steps in Item 5 and Item 6.
If the driver card LED for this axis is not lit, check the corresponding fuse on
the axis driver card. (Refer to Figure 8-3.)
Turn off the controller and open the cover.
8 - 6 SCORBOT-ER VII Users Manual
9602
Check the fuse on the top of
the driver card for the faulty
axis. If the fuse has blown,
replace it.
(Earlier models of Controller-A
have semi-automatic fuses on
the driver cards; simply press
the switch on those fuses to
reset.)
Try to identify the faulty axis. If many or all axes are faulty, look for an
electrical noise source in your environment.
Make sure the gripper cable is securtely connected to the axis 6 port at the
rear of the controller.
Discconnect gripper cable from the robot forearm and check for voltage
(1.5V-2.0V) by connecting pins 1 and 6 while entering CLOSE/OPEN
commands. (Pins 1 and 6 are, respectively, the pins immediately to the right
and left of the notch on the connector). If voltage exists, the problem is in the
gripper. Check the cable and the motor.
Check for excessive friction. Try raising the value of the current limit of the
gripper driver axis, as explained later in this chapter. If raising the current
limit above 0.5A enables gripper motion, make adjustments to reduce friction.
Be sure to reset the current limit for the gripper axis to 0.5A.
Users Manual SCORBOT-ER VII 8 - 9
9602
14. Electric servo gripper opens and closes but does not react properly to JAW
command.
The problem is probably in the feedback. Check the encoder, the wiring, and
the driver card. Follow the procedures in Item 8 and Item 9.
15. Gripper opens and closes too freely; weak gripping force; or the gripper motor
rotates endlessly.
Loose screws.
Poor lubrication.
Make sure motors switch is on and make sure user power supply is +12VDC.
If not, none of the inputs will be operative.
If the status of the input does not change, check the flat cable connections
between:
Display card and main board (J11).
I/O card and main board (J10).
If the input LED also does not light up, refer to Item 18.
If, when checking the homeswitches (LSON) , the input LED lights up and
home is found (only the input is not functioning), replace the main board.
(Alternately, check U99, U100, U101, U102, U88, U93, U98.)
8 - 10 SCORBOT-ER VII Users Manual
9602
18. I/O display LEDs do not light up.
If the input or output functions, but not the LED, replace the LED or the
display card PC7300.
For Outputs 1-4, check whether the relays have been switched (LED is lit):
In output OFF, NC is shorted to COM, NO is disconnected from COM.
In output ON, NO is shorted to COM, NC is disconnected from COM.
Refer to Figure 8-6. If outputs have not been switched, check the flat cable
connection between the I/O card and the main board (J10).
Open Collector Outputs
For Outputs 5-16, check whether the load and voltage source have been properly
connected. (If the supply has been connected directly to the output terminal,
the output transistor will blow out immediately).
Refer to Figure 8-5. Check the flat cable connection between the I/O card and
the main board (J10).
(Alternately check the ICs which drive the open collector outputs signals:
U76, U77, U78.)
20. Pneumatic gripper or end effector does not respond.
Check the relay output to which the gripper is connected according to the
instructions in Item 19.
21. User programs are not saved in the BBAM. Response to ACL command DIR is
Directory is Empty.
Check the voltage level of the backup battery on the main board. (See
Figure 8-1.) A good battery produces 3.4V--3.7V. Battery should backup
RAM as long as the Vcc supply to U4, U10, U16 and U21 is 2V or higher.
Replace battery if necessary.
Make sure the battery is properly and securely set in its socket.
Using a small tool, push the red switch (2) on the transformer housing to the
opposite side.
Manually push the switch (3) on the logic power supply to the proper setting.
Replacing Fuses
Warning! Before you begin to check or remove fuses, turn off the controllers
power switch, and disconnect the power cable from the AC power source.
Logic Power Supply Fuse
One 4A (220/110V) fuse inside the logic power supply.
The logic power supply is an IBM/PC type power supply. It will not wake up if
it is not loaded, and it is protected against short load. Therefore, when searching
for a blown fuse, be sure you are trying to operate the logic power supply under
loaded conditions.
To replace this fuse:
Disconnect the cable from the logic power supply to the main board (J9).
Remove the power supply from the controller by unscrewing the four screws
on the rear panel of the controller.
Open the power supply and change the fuse, which is mounted in a standard
fuse holder.
Power Transformer Fuse
One 2.5A (SB) fuse (220V) or 4A (SB) fuse (110V), on the side of the
transformer housing. Feeds AC power to the transformer, from which the motors
and users power supplies are produced.
To replace this fuse:
Using a screwdriver, push down on the fuse holder cover while turning it
counterclockwise.
Reinsert the fuse holder, and retighten it clockwise, until it is securely in place.
8 - 16 SCORBOT-ER VII Users Manual
9602
User Power Supply Fuse
One 2A (12VDC) fuse on the power supply card PC7500 inside the transformer
housing. Protects the users power supply.
To replace this fuse you must open the transformer housing.
Warning! The large motors capacitor may be loaded with an electrical charge
even after you have disconnected power. Be careful not to touch or short it.
Driver Card Fuses
Each driver card has two slow blow (SB) fuses (one fuse per axis). See
Figures 8-3 and 8-8.
The first three driver cards, for axes 1 through 6, have a 4A fuse for each axis.
The fourth driver card, for peripheral axes 7 and 8, has a 4A fuse for the top
axis (axes 7) and a 2A fuse for the lower axis (axis 8).
Additional driver cards, for axes 9 through 11, are the same as the fourth
driver card, with a 4A fuse for the top axis and a 2A fuse for the lower axis.
Remove the driver card from the controller before you replace any of its fuses. To
replace a driver card fuse, simply grasp it and extract it from its holder. You may
need to use a tweezers. Insert the new fuse into the holder, and make sure it is
firmly in place.
(Driver cards in earlier models of Controller-A have two semi-automatic fuses
(one fuse per axis). These fuses should not need to be replaced, only reset.
However, if you do replace such a fuse, solder it only when in the open state.)
Users Manual SCORBOT-ER VII 8 - 17
9602
Changing the I/O Logic Mode
The I/O logic mode can be set individually for each input and open collector
output terminal by means of jumpers on the I/O card PC7400A, as shown in
Figure 8-7.
The jumpers are marked I1 to I16 and O5 to O16. Note that the relay outputs do
not require jumpers.
Use tweezers or a fine-tip pliers to lift off the jumpers and reset them. You do not
need to remove the I/O card from the controller.
NPN Logic
Shorting the two pins on the left sets the corresponding terminal to negative
(NPN) logic. All inputs and outputs area factory configured for operation in
negative (NPN) logic mode.
ON = low voltage or ground
OFF = high voltage
PNP Logic
Shorting the two pins on the right sets the corresponding terminal to positive
(PNP) logic.
ON = high voltage
OFF = low voltage or ground
Figure 8-7: I/O Card - Logic Jumpers
8 - 18 SCORBOT-ER VII Users Manual
9602
Replacing or Adding a Driver Card
Refer to Figure 8-8.
(Skip Steps 4 and 5 when adding a driver card.)
1. Turn off the controller and disconnect the power cable from the power outlet.
2. Remove the cover of the controller.
3. Remove the long bracket which extends across the driver cards:
Remove the screw which holds the long bracket to the transformer cover (see
Figure 8-6).
Using pliers to grip the self-locking washer from inside the controller frame,
remove the screw that fastens the bracket to the side of the controller.
Remove the screws and washers which hold the long bracket to each driver
card.
4. Note the location of each driver cards (you will replace them later in these same
positions). Remove the screw at the top of each driver card bracket to detach the
driver card from the connector slot.
5. Holding the card with two hands, lift it out very carefully.
Figure 8-8: Axis Driver Card
Users Manual SCORBOT-ER VII 8 - 19
9602
6. Before inserting the new driver card, make sure none of the 64 pins in the male
DIN connector is bent. Then, make sure the driver card is directly above the
female DIN connector on the main board, and that the metal bracket fits the rear
panel. Firmly but gently press the driver card into the driver card slot.
7. Reattach the long bracket to the transformer housing and the controller frame.
Reattach each driver card to the long bracket and its connector slot. Retighten all
the screws.
8. Check and adjust the current limit, according to the instructions in the following
section.
Adjusting Driver Card Current Limit
Refer to Figure 8-8.
1. Turn off the controller.
2. Connect the common probe of the voltmeter to the middle point in TP (marked
GND in Figure 8-8).
3. Turn on the controller.
4. Using a small screwdriver, rotate POT 1 (for upper axis) or POT 2 (for lower axis).
Rotating clockwise reduces the level of the current limit;
Rotating counterclockwise increases the level of the current limit.
Watch the voltmeter reading; the voltmeter reading reflects the amperage of the
current limit level. Adjust the current limit as follows:
Robot Axes Driver Cards
Current
Limit
SCORBOT-ER VII Upper Axis (Axes 1, 2, 3)
SCORBOT-ER VII Lower Axis (Axes 4, 5, 6)
-6.3 V
-4.0 V
Peripheral Axes Driver Cards
Peripheral Device Upper Axis (Axes 7, 9, 11)
Peripheral Device Lower Axis (Axes 8, 10)
-4.0 V
-2.25 V
Driver Card Jumper Configuration
Note the configuration of the two jumpers, W2 and W3, on the driver card, shown
in Figure 8-8.
The jumpers must be mounted in the upper position when connecting the
SCORBOT-ER VII.
(Conversely, the jumpers must be in the lower position when connecting a
SCORBOT-ER Vplus robot and peripheral axes to the controller.)
8 - 20 SCORBOT-ER VII Users Manual
9602
Installing the Auxiliary RS232 Communication Card
An auxiliary (multiport) RS232 communication card may be installed in the
controller to provide additional RS232 communication channels. The cable
leading from the card may have either two or eight D25 connectors. Refer to Figures
4-3 and 8-9.
1. First, make sure Pins 1 and 2 are shorted on the cards Jumper JP1 (1).
Jumper JP1 allows the software to determine whether or not the communication
card has been installed in the controller.
Default factory setting: Pin 1 and pin 2 shorted.
2. Turn off the controller.
3. Remove the cover of the controller.
4. Remove the blank bracket at the back of the controller on the slot (J7) for the
auxiliary RS232 card.
5. Before inserting the auxiliary RS232 card, first check that none of the 64 pins in
the male DIN connector is bent. Then, make sure the card is directly above the
female DIN connector (J7) on the main board, and that the metal bracket fits the
rear panel. Firmly but gently press the card into the slot.
6. Tighten the bracket screw.
7. Make the cable connections:
Connect the D37 connector from the multiport connector cable to the
auxiliary RS232 port on the controller.
Use the ACL command CONFIG, as described in the ACL Reference Manual.
10. Reload the contents of the controller, including all parameters, which you backed
up to disk. From the ATS Backup Manager menu, select the options Restore
ALL and RESTORE from disk (F5).
8 - 22 SCORBOT-ER VII Users Manual
9602
APPENDIX A
Theory of Control
The function of the controller is to instruct the movements of the robot arm or
other devices in the robotic system, to monitor these movements, and to make
adjustments automatically in order to correct any errors.
Servo Control
Open Loop Control
In open-loop (non-servo) control, the system does not check whether the actual
output (position or velocity) equals the desired output.
In open-loop control systems the controller output signal (U
r
) is determined only
by the input signal (r). If the system response is incorrectly predicted, or if the
output signal is affected by other factors, deviations from the desired state will
occur. Since no feedback exists, the system is unable to correct output errors.
In open loop robotic control, power is applied to the motors according to a
predefined program. The path and speed cannot be precisely predicted, since they
are determined by the torque and load on the motors, and other environmental
factors.
Closed-Loop Control
In closed-loop control, the control system measures the output signal (C),
compares it with the input (desired) signal (r), and corrects any errors.
Figure A-1 compares schematic diagrams of open-loop and closed-loop control
systems.
In servo control systems, a feedback device, commonly an optical encoder,
measures the output (C) (the amount, speed and direction of motor rotation),
converts it to an output signal (U
b
), and transmits it to the comparator.
A comparator () connects the input and feedback signals, produces an error
signal equal to the algebraic difference of its two input signals. The comparator
outputthe error signalis generally denoted as U
e
.
Users Manual SCORBOT-ER VII A - 1
9602
The error signal is the most important value in the closed-loop system. The
system aims to reduce U
e
to the smallest possible value. When U
e
= 0, the output
signal (the actual state) is equal to the input signal (the desired state).
Digital Control
Unlike analog control systems, in which all signals within the controller are
continous analog signals, digital control systems are those in which some of the
signals within the controller are discrete digital signals, due to the presence of
microprocessors.
In digital control systems, the controller must be capable of converting between
analog and digital signals. For the microprocessor to read an analog signal, the
signal must first pass through an Analog to Digital Converter. The ADC
samplesthat is, readsthe signal at periodic intervals and stores the value for
the processor to read. For the microprocessor to transmit an analog signal, it must
send the discrete values of the signal to a Digital to Analog Converter. The DAC
holds the output continuously until given a new value.
Controllers use microprocessors to calculate the state (position, velocity, etc.)
error (e) for each motor and the control signal (U
c
) which is sent to the motors to
correct the error. The control signal is converted to an analog signal by a DAC
and then amplified before driving the motor.
Figure A-1: Open-Loop and Closed-Loop Control
A - 2 SCORBOT-ER VII Users Manual
9602
The feedback device measures the actual state and produces an analog signal. The
feedback signal is converted by a ADC so that the processor can read it to
compute e.
A digital control system can be programmed to compute any number of control
equations. The processors control program is a continuous loop whose basic steps
are as follows:
1. Read desired state from memory.
2. Read actual state from feedback device.
3. Calculate the state error (e).
4. Calculate control signal from control equation.
5. Go back to step 1.
The main difference between digital and analog controllers is the time delay
caused by the processors computations. This time delay is, in effect, the
sampling time of the DAC and of the output control signal it produces. If the
processor can complete a loop within a few milliseconds, the sampling time will
be rapid, and the digital controller will produce an output similar to the equivalent
analog controller.
On the other hand, if the processor is slow to make the computations, the
controller will be unaware of fast changes in the feedback signal and the control
signal will be based on old measurements. The greater the delay, the more the
response will oscillate, eventually becoming unstable.
Figure A-2: Analog and Digital Signals
Users Manual SCORBOT-ER VII A - 3
9602
Transient and Steady State Responses
When the desired input signal (r) changes suddenly, the system will react in two
phases, as shown in Figure A-3. The initial reaction to a change in the input
signal is called the transient response. The second part of the reaction is known as
the steady state response. Once the input signal (r) has remained constant for
some time, and the error between the input and output signals has stabilized, the
system is said to be in steady state. The transition from transient to steady state is
not a cleanly defined break.
This constant error, known as the steady state error, should be reduced as much as
possible by the control system.
Increasing the amplitude of the controller output signal (that is, increasing the
controller gain) can reduce the steady state error and enable a more rapid
approach to the steady state value. The greater the controller gain, the faster the
system reacts.
However, excessive gain may lead to a phenomenon called overshoota rise in
the controlled value to a point above the desired value, followed by a drop below
the desired value, repeated several times before stabilization. This, in effect,
causes the actual value to oscillate around the desired value. Further increase of
the controller gain may lead to instability of the entire system that is,
uncontrollable oscillation.
A control system is damped when it reaches steady state without overshoot. A
critically damped response is the fastest approach to steady state without
overshooting; an overdamped response is a slow approach to steady state.
Figure A-4 shows different transient responses.
Figure A-3: Transient and Steady States
A - 4 SCORBOT-ER VII Users Manual
9602
Figure A-4: Transient State Responses
Figure A-5: Controller-A Control Loop
Users Manual SCORBOT-ER VII A - 5
9602
Controller-A Control Process
The basic steps of the Controller-A control loop are described below. Refer to
Figure A-5. The entire control cycle takes 10ms.
The processor calculates the command position and speed once per cycle. It
outputs a digital value to the DAC unit in the range of 5000.
The analog unit creates a series of pulses, resulting in an average voltage value
proportional to the DAC input.
The power unit drives the motor by switching 24V to it at 20KHz , according to
the input pulse. The motor cannot react to this high frequency of switching and is
therefore affected by only the average value of the voltage.
This method of controlling the time during which current flows through the
motor, rather than controlling the value of the current, is known as PWM (Pulse
Width Modulation) control. Refer to Figure A-6.
Once per cycle the processor reads the encoders count and calculates the motors
position and speed (rate of encoder counts). The processor then compares the
actual (output) position and speed values with the desired (input) ones,
determines the error values and takes the necessary action to cancel them.
Figure A-6: Controller-A Control Signals
A - 6 SCORBOT-ER VII Users Manual
9602
Trajectory Control
For better path performance (that is, to accurately reach the desired state and
avoid overshoots), trajectory control profiles, may be programmed into the
control system. Controller-A offers two profiles: paraboloid and trapezoid. Refer
to Figure A-7.
Paraboloid
The paraboloid profile causes the motors to accelerate slowly until maximum
speed is reached, then decelerate at the same rate.
Trapezoid
The trapezoid profile causes the motors to accelerate and decelerate quickly at the
start and end of movement, with a constant speed along the path.
Path Control
It is desirable that the path and speed of a robot between taught points be
predictable. Ideally, the path between consecutive points is traversed at a constant
velocity with defined acceleration and deceleration segments.
Along the path, motion of all joints should be proportional, so that all the joints
start and finish moving at the same time. The method of coordinating the
movement of the joints so that all joints reach the desired location simultaneously
is termed joint interpolation.
Point-to-Point Control
Point-to-point control (PTP) involves the positioning of the robots end effector at
given points, without defining the exact path of the end effector between any two
points.
Figure A-7: Trajectory Control Profiles
Users Manual SCORBOT-ER VII A - 7
9602
Point-to-point control is suitable for applications which require an exact and static
position of the end effector at the points where operations will be performed.
In principle, point-to-point control can be used to guide the robot through a large
array of positions, thus resulting in a complex path. In order to obtain such a path,
points must be defined and recorded in a very close sequence. The number of
positions will be limited, however, by the capacity of the control system to
maintain positions in memory.
Continuous Path Control
Continuous path control (CP) involves the movement of the end effector between
two points along a path defined by a mathematical formula. This method of
control is suitable for applications in which the end effector executes operations
along a precise trajectory.
During program execution, the control system calculates and plans the path, and
instructs the robot motors to move accordingly.
When continuous path control is required, the processor divides the path into
short segments, and interpolates the motion of the joints as frequently as possible.
Three type of CP control are possible.
Joint Control: Each axis moves according to the trajectory profile. The
gripper path is not defined; only the start and end points are defined.
All axes start and stop movement at same time.
Linear Path Control: The axes are coordinated in order to move the TCP
(tool center point; tip of the gripper) in a straight line according to the
trajectory profile.
Circular Path Control: The axes are coordinated in order to move the TCP
along a circular path according to the trajectory profile.
A - 8 SCORBOT-ER VII Users Manual
9602
The Control Parameters
In the robotic system controller by Controller-A, as in common in closed-loop
systems, the controlled value (C) is measured by an optical encoder. The encoder
signals serve as feedback to the controller, enabling it to correct any deviations
from the desired value.
Since control systems cannot react immediately to the input signal, there will
always be a lag between the generation of an error signal and the actual correction
of the controlled value.
The PID (proportional, integral, differential) control parameters allow the
controller to adapt to various conditions of operation, such as overcoming
nonlinear functions in the system.
Proportional Control
The proportional parameter is the gain of the control system. Its value determines
the reaction time to position errors.
When a position error exists (that is, the actual motor position is off by a certain
amount of encoder counts), the processor multiplies the error by the proportional
parameter and adds the product to the DAC value, thereby reducing the error.
The proportional parameter is the parameter in the PID control system which acts
most quickly in reducing the position error, especially during motion. It is also
the first parameter to respond to position errors when the robot has stopped at a
target position.
The greater the proportional parameter, the faster the sytem responds and reduces
the error. But, using too great a value for the proportional parameter will cause
the axis to oscillate.
The main disadvantage of proportional control is that it cannot completely cancel
the error, because once it has reduced the error it cannot generate enough power
to overcome friction in the system and propel the axis to its target position.
Even in steady state, under load, the controlled value (output signal) will always
be different from the desired value (input signal). The steady state error can be
reduced by increasing the gain, but this will increase the oscillation and reduce
stability.
Users Manual SCORBOT-ER VII A - 9
9602
Differential Control
In differential control, the controller output (C) is a function of the rate at which
the error (U
e
) changes. The faster the rate of change of the error, the greater the
controller output (C). In other words, the controller is sensitive to the slope of the
error signal.
The differential parameter is responsible for reducing the speed error. The control
system calculates the actual speed once per cycle and compares it to the desired
value. While the robot is accelerating (during the first part of path) the differential
acts as a driving factor.
While the robot is decelerating (during the second, and last, part of path), the
differential acts as a braking factor. A good differential setting will result in a
clean and smooth motion along the entire path. Lack of the differential will cause
overshoot at the end of path. High differential values will cause small vibrations
along the path.
In this control method, the controller predicts the value of the error in accordance
with the error signal slope, and causes the correction to take place in advance.
However, if the error is constant and unchanging, differential control will not be
able to reduce the error to zero.
Integral Control
In integral control, all the state errors which have been recorded each cycle are
totalled and their sum is multiplied by the integral parameter value.
In integral control, the controller output (C) reduces the error signal (U
e
) to zero
at a rate proportional to the size and duration of the error. In other words, the
greater the error, the greater the controller output; and, the longer the duration of
the error, the greater the controller output.
The main advantage of integral control is that the steady state error is always
reduced to zero since its value increases each cycle, thus strengthening the control
systems ability to react and reduce the error. However, using too great a value
for the integral parameter may cause overshoots, while too small a value may
prevent the cancellation of a steady state error.
Unlike the proportional parameter, the integral parameter takes effect more
slowly and is less noticeable during motion. However, when the axis comes to a
complete stop and the proportional parameter can no longer reduce the steady
state error, the integral parameter takes over and can cancel the error completely.
A - 10 SCORBOT-ER VII Users Manual
9602
ProportionalIntegralDifferential Control
The PID control method enables optimal exploitation of all three types of
controlproportion, integral and differential. In this manner, it creates an output
response which follows the input signal closely, without gaps or lags, in both
slow and rapid processes, including those in which the load is in a constant state
of change. In summary, the PID control parameters serve the following functions: