Galil Motion Control
Mountain View, Calif.
Couplings between motors and loads in most motioncontrol systems are not sufficiently rigid. When a controller commands the motor to move a load, compliance in the coupling lets the motor and load oscillate or seek slightly different positions. This action produces a small error commonly called backlash.
Designers faced with the problem usually install a feedback sensor on the motor or the load to let the controller compensate for such errors. Placing the feedback sensor on the motor provides stable and accurate control of motor position. Backlash, however, prevents the load from reaching the exact same position. Alternatively, placing the sensor on the load closes the loop around the backlash, but the dynamic behavior of backlash adds delay to the loop’s response time still making the system unstable.
THE BEST OF BOTH
The search for a feedback-control method that corrects for complete motion trajectories and does it quickly led to developing a continuous dual-loop configuration. This system employs two sensors, one on the motor and the other on the load, and a control loop for each. The outer loop closes on the load sensor while the inner loop feeds from the motor sensor. A compensation filter consisting of PID functions is divided between the two loops. The functions P and I apply to the outer loop, and D works in the inner loop.
A version of this continuous-loop method has been around for several years and has proved successful for improving system stability. To stabilize the control system, it needs a damping signal proportional to the motor velocity. But in applications where the motor velocity is derived and not measured, any load velocity out of phase with the motor comes from the load sensor. Therefore it may not effectively damp the system. On the other hand, a sensor on the motor ensures that the derived signal is the motor velocity, and therefore improves the system stability.
Though the continuous-loop method stabilizes systems with backlash, the improvement is not always sufficient. For example, systems with relatively large backlash have comparatively low gain with slow response and long settling time. A one-second response time for moving the motor to the correct position is unacceptable.
An improved method recently developed at Galil is called the general dual loop. The structure of the dual loop is preserved, but PID functions are divided differently. The I function executes in the outer loop and PD handles the inner loop and stabilizes systems with backlash more effectively.
These dual-loop systems handle two position errors, the motor position error measured by the motor encoder, and the load position error measured by the load encoder. Filtering can be applied to either one. Since the motor position error represents the motor state, using that error in the control algorithm improves the loop stability. When all three operations are based on the motor sensor, the motor moves to the position where the motor error is zero, but the load sees a position error from the backlash. Thus, the filters must be divided between the two errors to gain stability and accuracy.
The standard dual loop executes the D operation on the motor error and the PI operations on the load error. But the improved dual loop goes a step further. It performs both P and D operations on the motor error to improve loop stability, and applies the I to the load encoder. The integration forces the motor to move when the load accumulates a position error, thereby assuring load accuracy.
The transfer function of any closed loop such as the one shown in the figure, Basic feedback- control system, is
In a range of low frequencies where the open-loop gain is high, the transfer function is approximately
|; GH >>1|
This simplified result suggests that a closed loop acts like the reciprocal of its feedback. This principle may be applied to the two dual loops. In the standard continuous dual loop the feedback in the inner loop is a derivative function D, therefore the whole inner loop acts as an integrator, the reciprocal of the derivative. The resulting system is shown in the figure, Standard dual-loop control.
In the Improved dual-loop control, however, the feedback loop includes the PD terms which implies that the inner loop acts as a lowpass filter. The P and D terms may be programmed to select the filter frequency a sufficiently high to make the inner loop act as a constant in the effective frequency range.
A test system was assembled to examine the effects of the two designs. One system was built with a backlash of 10° between the motor and the load. Three control methods were analyzed, a single loop based on a load sensor, a standard dual loop, and an improved dual loop. The test results summarized in How the loops stack up show the best PID parameters for each case. To compare the control methods objectively, the measured time t was based on the resulting bandwidth and the time needed for the system to precisely move one motor turn.
The single loop operating a 2-Hz bandwidth would not stabilize with an integrator, therefore it never reached final position. The standard dual loop increased the PID parameter to allow a settling time of 520 msec and a bandwidth of 70 Hz. The improved dual loop permitted even higher PID parameters and a settling time of only 142 msec with a bandwidth of 280 Hz.