Download AdeptMotion VME Developer`s Guide

Transcript
Chapter 7 - SPEC Program: Robot Specifications and Tuning
Sample scale factor calculations are shown below.
Example 1:
Linear motion achieved via the use of a lead-screw drive. The lead screw requires 2
revolutions per inch of travel. The encoder (800 lines per revolution) is mounted directly
to the back of the motor shaft and the lead screw is directly coupled (no gearing) to the
joint.
2 motor revs 800 × 4 counts
1 inch
251.9685 counts
------------------------------ × ----------------------------------- × --------------------- = --------------------------------------inch
motor revs
25.4 mm
mm
Example 2:
A jointed arm robot has a joint that rotates. The joint is driven through a harmonic drive
with a gear reduction ratio of 45 to 1. The encoder is mounted directly to the back of the
motor shaft and has 1000 lines per revolution.
45 motor rev 1000 × 4 counts 1 joint rev
500.0000 counts
------------------------------- × -------------------------------------- × ---------------------------- = --------------------------------------1 joint rev
motor rev
360 degrees
degree
Example 3:
A gantry mechanism contains five joints, and the last two contain multiple motor-to-joint
coupling. It is known that if joint 5 is held stationary and joint 4 is moved 1 degree, then
both motors 4 and 5 will move 400 counts. Also, if joint 4 is held stationary and joint 5 is
moved 1 degree, then motor 4 will not move, and motor 5 will move -1200 counts. The
scale factors are therefore as follows:
Joint 4 to motor 4 scale factor (counts/degree) = 400
Joint 5 to motor 4 scale factor (counts/degree) = 0
Joint 4 to motor 5 scale factor (counts/degree) = 400
Joint 5 to motor 5 scale factor (counts/degree) = -1200
Encoder Counts Per Zero Index
The “Encoder counts per zero index” parameter is defined as the number of encoder
counts between each zero-index on the encoder. Since there is normally only one index per
rotation of an encoder, it is usually the same as the number of counts per revolution (or
four times the number of lines per revolution).
Some linear encoders have only one zero-index in the entire range of motion. In such a
case, the number of encoder counts per zero-index should be set to any value greater than
the number of counts in the encoder from end to end. Zero-index checking will still
function: any stray index pulse will cause an *Unexpected zero index* error and failure to
detect the single index at the correct encoder count will cause a *No zero index* error.
Other encoders have no zero-index at all. In that case, set the number of encoder counts
per zero index to 0.
104
AdeptMotion VME Developer’s Guide, Rev B