14.01.2015 Views

Gemini GV6K and Gemini GT6K Programmer's Guide

Gemini GV6K and Gemini GT6K Programmer's Guide

Gemini GV6K and Gemini GT6K Programmer's Guide

SHOW MORE
SHOW LESS

You also want an ePaper? Increase the reach of your titles

YUMPU automatically turns print PDFs into web optimized ePapers that Google loves.

Master Position Prediction<br />

Master Position Prediction is a technique used to compensate for the fact a follower's position<br />

comm<strong>and</strong> cannot be calculated <strong>and</strong> implemented infinitely fast.<br />

The master position prediction mode is enabled by default (FPPEN1) in the Following<br />

algorithm, but can be turned off as desired with the FPPENØ comm<strong>and</strong>.<br />

The Gem6K measures master position once per position sampling period (2 ms), <strong>and</strong><br />

calculates a corresponding follower position comm<strong>and</strong>. This calculation <strong>and</strong> achieving the<br />

subsequent follower comm<strong>and</strong>ed position requires 2 sample periods (4 ms).<br />

If master position prediction mode is disabled (FPPENØ), waiting 2 sample periods results in<br />

a follower position lag. That is, by the time the follower reaches the position that corresponds<br />

to the sampled master position, 2 sample periods have gone by, <strong>and</strong> the master may be at a<br />

new position. Measured in time, the lag is 2 sample periods. Measured in position, the lag is<br />

2 sample periods ∗ current follower velocity.<br />

For example, suppose the follower is traveling at a speed of 25000 counts per second. If<br />

master position prediction mode is disabled (FPPENØ), the follower will lag the master by<br />

100 counts (25000 counts/sec ∗ 4 ms = 100 counts).<br />

By measuring the change in master position over sequential sample periods, the master's<br />

present velocity is calculated. The present master velocity <strong>and</strong> position are used to predict<br />

future master position. If master position prediction mode is enabled (FPPEN1, the predicted<br />

future master position is used to determine the follower's position comm<strong>and</strong>. In this case the<br />

follower has no velocity-dependent phase delay. The follower's velocity for a given sample<br />

will always be the velocity required to move from its current position to the next calculated<br />

position comm<strong>and</strong>.<br />

If the master motion is fairly smooth <strong>and</strong> velocity is not very slow, the measurement of its recent<br />

velocity will be very accurate, <strong>and</strong> a good way of predicting future position. But the master<br />

motion may be rough, or the measurements may be inaccurate if there is no filtering (see Master<br />

Position Filtering below). In this case, the predicted master position <strong>and</strong> the corresponding<br />

follower position comm<strong>and</strong> will have some error, which may vary in sign <strong>and</strong> magnitude from<br />

one sample to the next. This r<strong>and</strong>om variation in follower position comm<strong>and</strong> error results in<br />

rough motion. The problem is particularly pronounced if there is vibration on the master.<br />

It may be desirable to disable the master position prediction mode (FPPENØ) when maximum<br />

follower smoothness is important <strong>and</strong> minor phase delays can be accommodated.<br />

If master filtering is enabled (FFILT_Ø), then the prediction algorithm would be used on the<br />

filtered master position, resulting in a smoother follower position comm<strong>and</strong>. However, due to<br />

the delay introduced by the filtering, the prediction algorithm would not compensate for the<br />

total delay in the follower's tracking comm<strong>and</strong>. (See also Master Position Filtering below.)<br />

Following Status (TFSF, TFS, <strong>and</strong> FS) bit 17 indicates the status of where or not the master<br />

position prediction mode is enabled.<br />

Master Position Filtering<br />

The follower axis' position comm<strong>and</strong> is calculated at each position sample period (2 ms). This<br />

calculation is a function of the master position <strong>and</strong> the master velocity estimated from the<br />

change in master position over 2 position sample periods.<br />

The Master Position Filter feature allows you to apply a low-pass filter to the measurement of<br />

master position. Master position filtering is used in these situations:<br />

• Measurement of master position is contaminated by either electrical noise (when analog<br />

input is the master) or mechanical vibration.<br />

• Measurement noise is minimal, but the motion that occurs on the master input is<br />

oscillatory. In this case, using the filter can prevent the oscillatory signal from<br />

propagating into the follower axis (i.e., ensuring smoother motion on the follower axis).<br />

Chapter 7. Multi-Tasking 187

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!