This document describes 2 gantry control configurations which can be implemented with the controller. Due to the inherent flexibility in the controller architecture, more complicated algorithms can be easily attained.
The term “gantry” defines a system with 2 motors controlling a single linear axis. Each motor/bearing system is separated a finite distance orthogonal to the direction of the axis. Small rotational motion about the center of the gantry (due to differential motion of the 2 motor/bearing systems) is usually undesirable and will lead to mechanical binding if the rotational motion is excessive.
This rotational motion is treated as a separate axis for one of the gantry configurations described here. Alternatively, it may be set to zero within the gantry algorithm for linear motion. Frequently, gantries also incorporate a transverse axis, which allows X-Y placement of the supported payload. Consequently, a transverse axis may result in a dynamic center of mass for the gantry axis. In this situation, the gantry axis motion at high acceleration rates induces significant moments (twisting) about the yaw axis. These moments depend on the linear acceleration rate and the transverse position of the crossaxis mass. A gantry configuration with 2 motors and a minimum of 2 encoders has the inherent advantage of providing 2 control loops which can actively resist moments (twisting) about the yaw axis.
The most common mechanical systems use either linear motors, or rotary motors with ballscrews (or belts). These provide motion on either an air-bearing or linear slide-supported stage. In addition, the gantry may use either a single encoder or 2 encoders for position information of the 2 motor/bearing systems. Typically, linear encoders are co-located with each motor/bearing system.
Standard Gantry Configuration
The term “Standard Gantry” applies to a control scheme where separate PIDs directly control each motor. The Standard Gantry has the convenient feature of providing a separate yaw axis for gantry alignment, and it also allows observing yaw position error during linear motion.
The standard gantry configuration results in a control loop that controls each motor the same as if they were separate (non-gantry) motors. The standard gantry configuration provides the convenience of commanding the motion in linear and yaw components, thereby simplifying programming and lab testing.
A goal of the gantry system is to move both separate motor systems together so that negligible “crabbing” occurs (wherein one motor leads or lags the other). Since each side of the gantry receives the same linear command position (with zero yaw command), a lagging motor/encoder provides a greater error signal to that respective control loop. Due to the mechanical coupling of the gantry beam (or transverse axis), motion from one motor/bearing system can appear as a disturbance on the other motor/bearing system (particularly within the same bandwidth, since they have identical or similar control elements). This coupling of disturbances can reduce system performance.
Standard Gantry with Yaw Axis
Refer to Figure 1. The same linear command position (X) is issued to each motor’s PID control. The feedback from each motor is compared directly with the sum of the linear command (X) and yaw command positions. Note that for the first motor, the junction of the linear and yaw commands uses a positive yaw contribution, while for the second motor, the yaw contribution is subtracted from the linear command position.
Standard Gantry without Yaw Axis
Refer to Figure 2. The same linear command position (X) is issued to each motor’s PID control and the feedback from each motor is compared directly with that command position.
The synthesis of the linear and yaw actual positions is shown in Figure 3, which reveals the MPI architectural implementation of the standard gantry. Linear actual position (X axis) is one-half of the sum of the positions of encoders 0 and 1. Yaw actual position is one-half of the difference of encoders 0 and 1. These actual positions are visible through the axis object, as are the command positions.
The axes use these synthesized actual positions to calculate the position errors and feed them to the respective filters, which control the two motors.
From this diagram, you can see that the output of PID/PIV0 is unaffected by the actual position value of encoder 1, and that conversely, the output of PID/PIV1 is unaffected but the actual position value of encoder 0. This results from the fact that 0.5 (-ActPos1 + ActPos1) enters Filter, and 0.5(-ActPos0 + ActPos0) enters Filter . Using this observation, it is clear that this implementation is equivalent to the Figure 1 representation of the gantry configurations.
Figure 3’s implementation of the gantry configuration can be summarized by the following equations:
The following examples illustrate the use of these equations by the gantry configuration:
Rotary Error Only
Assuming only rotary position error with the following command positions and encoder values (defined as
The Gantry configuration will report to the following actual positions and generate the following position
errors for the filters:
As a result, the PID or PIV filters in the filter objects will receive the following error signals after they have
Given these filter error inputs, Filter ) will command a Motor X0 (left) DAC output that will move the left motor from +50 back to 0, and Filter 1 will command a Motor X1 (right) DAC output that will move the rotary axis to its command position of 0.
Linear and Rotary Error
Assuming both linear and rotary position error with the following command positions and encoder values
(defined as encoder counts):
Given these filter error inputs, Filter 0 will command a Motor X0 (left) DAC output that will move the left motor from 150 back to 0, and Filter 1 will command a Motor X1 (right) DAC output that will move the right motor from 50 back to 0. The effect is to reduce both the linear and rotary axis position errors and move the linear and rotary axes to their command positions of 0. Note that both the X (linear) and Yaw (rotary) position errors are observable at -100 and -50 counts, respectively.
To see how to configure a gantry, please see gantry.c.
Simple, Single Encoder Gantry
The Single Encoder gantry configuration is similar to the Standard Gantry configuration, except that in a Single Encoder gantry, there is only one closed-loop control loop surrounding the “Master” motor/bearing system, while the second “Slave” motor/bearing system operates in open loop mode (no feedback). There are 2 types of Single Encoder gantries:
Note that for both configurations, the mechanical gantry must be very stiff to resist yaw rotation, and a separate yaw axis is not visible to the control system.
The single encoder gantry configuration is very similar to a single motor/encoder control loop which provides linear motion to a gantry that is completely restrained in yaw by mechanical means. Generally, this scheme is best applied to conveyor belt and other low performance applications.
Single Encoder Gantry with 1 Drive
In the single drive configuration, the PID output of the “Master” drives a single amplifier, which powers both motors. This configuration reduces costs, because a single, higher power drive is typically less expensive than 2 lower power drives.
Single Encoder Gantry with 2 Drives
In dual drive configuration, the PID output of the “Master” drives 2 amplifiers, each of which powers a
|| | Copyright © 2001-2010 Motion Engineering|