Background of the Invention
Two basic approaches have been employed for the longitudinal control of vehicles in automated guideway transit systems. The approach, termed "vehicle following", allows communication between successive vehicles so that the motion of a given vehicle is controlled in accordance with the motion of a preceding vehicle. This approach contrasts with "point-following" which assigns a vehicle to a cell (or slot), the cells being propagated along the guideway network at predetermined velocities and spacings. In point-following, propulsion commands are generated to maintain the vehicle's location within the assigned cells.
Several investigators have studied the feasibility of the vehicle following approach by using a linear, time-invariant regulator to control perturbations from a nominal operating condition. Levine and Athans in "On the Optimal Error Regulation of a String of Moving Vehicles", IEEE Transactions, Vol. AC-11, No. 3, July 1966, use a linear optimal regulator to design a system where each vehicle generates propulsion commands based on information from all other vehicles in a string. In another article, "On the Optimal and Suboptimal Position and Velocity Control of a String of High Speed Moving Trains", M.I.T. Electronic Systems Laboratory, Report PB 173640, November 1966, Athans, et al reduce the complexity of this technique by applying the optimization procedure of Levine and Athans to smaller overlapping strings. Finally, Cunningham and Hinman in "An Approach to Velocity Spacing Regulation and the Merging Problem in Automated Transportation", Joint Transportation Engineering Conference, Chicago, Ill., October 1970, reduce the scheme to one in which vehicle control is based only on vehicle state and the state of the immediately preceding vehicle. This strategy is pursued by Brown in "Design of Car-Following Type Control Systems with Finite Bandwidth Plants", Proceedings of the Seventh Annual Princeton Conference on Information Sciences and Systems, March 1973 while Fenton in "Fundamental Studies in the Automatic Longitudinal Control of Vehicle", DOT-TST-76-79, July 1975, deals with the design and testing of hardware systems. In "Vehicle-Follower Longitudinal Control for Automated Transit Vehicles", ASME Journal of Dynamic Systems, Measurement, and Control, Volume 99, Number 4, December 1977, Caudill and Garrard Study the effects of spacing policy and system nonlinearities upon string stability for vehicles operating under vehicle following.
The above studies of vehicle following have focused on the regulation of vehicle speeds and spacings during perturbations about normal values. It has been shown that suitable control can be obtained using properly designed, constant-gain linear regulator laws. However, in general, a control capability must exist to perform transient manuevers such as overtaking a slower moving vehicle, switching from an open-loop velocity command mode to the regulation mode, merging vehicles both on the main line and from stations, and generating gaps in vehicle flows during such merging operations. This was first recognized by Stupp et al in "Vehicle-Follower Control with Variable-Gains for Short Headway Automated Guideway Transit Systems", ASME Journal of Dynamic Systems, Measurement, and Control, Volume 99, September 1977.
In Stupp where it was shown that at time headways of less than approximately five seconds, a fundamental kinematic constraint arises which creates bounds on vehicle motion. This constraint dictates a minimum allowable spacing between vehicles which is a function of trailing vehicle state, preceding vehicle state, and the future maneuver capability of each vehicle. As a result, the bandwidth requirement for the closed loop regulator at short headways is inconsistent with the large initial values of vehicle motion, i.e., the system response to these initial conditions typically leads to violation of comfort criteria and the kinematically required spacing.
Summary of the Invention
The state-constrained approach of the present invention incorporates the kinematic constraint function (an inequality constraint on the state variables) into the control law. The kinematic constraint (our performance criterion for transient phenomena) and a quadratic performance index (the criterion for steady-state perturbational phenomena) may be combined into an optimal control problem. The solution to such a problem, however, is complex and requires considerable computation. According to the invention, a less complex approximate solution is employed that is easier to implement. The approximate solution is conceptually based, but differs and expands upon, a procedure derived by Sardis in "Design of Approximately Optimal Feedback Controller for Systems with Bounded States"[IEEE Transactions on Automatic Control, Volume AC-12, Number 4, August 1967.
The application of the state-constrained technique of the present invention to the vehicle following problem assumes that when the states of the trailing and preceding vehicle are such that violation of the kinematic constraint is not imminent (spacing is sufficiently large) the trailing vehicle may accelerate at its full capability. When the kinematic constraint is being violated (spacing is too small) the vehicle is commanded to brake at its full service (nominal) capability. The essence of the invention is that when vehicle spacing is equal to the kinematically required spacing a control is introduced which tends to maintain the desired spacing. However, the computation and information requirements for computing the appropriate control is extensive and hence, the control law is simplified to produce a practical controller.
The first simplification is to eliminate the logical switching involved in following the actual kinematic constraint. This simplification of the controller requires some modification of the kinematic constraint but has little impact on performance. But even with such simplification the informational requirements for precisely maintaining the kinematically required spacing include preceding vehicle velocity, acceleration, and jerk. To overcome this drawback, the present invention employs several suboptimal controllers for simplifying the kinematic constraint such that the resulting control will satisfy the actual kinematic constraint but will require less computation and information. The final result is an easily instrumentable controller requiring preceding vehicle information in the form of spacing and its derivatives (i.e., relative velocity and acceleration) only. Moreover, the control law is suitable for all of the possible transient maneuvers previously listed and assures that all possible nominal vehicle maneuvers are safely executed within service (as opposed to emergency) limits on acceleration and jerk. Additional objectives met by this invention are as follows.
According to the kinematic constraint, the trailing vehicle must maintain a spacing such that if the preceding vehicle should perform a minimum-time deceleration maneuver, the trailing vehicle may react with its full service braking capability and avoid collision. The invention achieves this object in near optimal fashion. That is, the spacing between vehicles is maintained at the minimum distance necessary to permit safe and comfortable operation during any nonemergency maneuver of a preceding vehicle.
String stability is also an object of the present invention. A string of vehicles must be controlled without a magnification of disturbances along the string. In order to determine the appropriate gains and delays, z transform analysis and computer simulation studies are used to assure a string stable design.
It is also an object of the present invention to provide either a constant headway or constant K-factor design with a corresponding reduction in velocity error gain as these values increase. This feature results in reducing the required control bandwidth and relaxing data rate and time delay requirements.
The state constraints inherent in the present vehicle following strategy are expressed as part of the control scheme. The resulting controller is a nonlinear function of states which constitutes an improved way of effecting transitions between modes of operation normally designed into a vehicle following system. It is an object of the invention to continuously follow the constraints with one controller rather than switching between a plurality of controllers depending on whether the constraints are active or inactive. Consequently, another object of the invention is to provide a general formulation and systematic approach which may be applied to various situations such as the merging and injecting of vehicles onto a guideway.
The present invention achieves many of the objectives discussed in a report prepared by the inventor for the Department of Transportation. The report, "A State-Constrained Approach to Vehicle-Follower Control for Short-Headway AGT Systems", APL/JHU CP 058/TPR 038 (August 1977), discusses various features ancillary to the invention. The present invention, in addition, improves on the system set forth in the report in several significant ways. An uplink information error .epsilon..sub.w which represents the discrepancy between the actual spacing and the desired spacing of vehicles includes factors not previously considered, in order to permit closer following within constraints. The newly defined .epsilon..sub.w function translates into lower gain, lower sample rate, and longer allowable delay in the implementing circuitry. Cost and complexity are thus reduced while output is enhanced. Also, a value u.sub.w determined in the former systems with an on-board vehicle controller as a function of vehicle velocity and acceleration is, according to the present invention, determined (together with .epsilon..sub.w) by a wayside computer and transmitted to the on-board controller in a signal carrying both .epsilon..sub.w and u.sub.w . A filter in the on-board controller appropriately channels the signal components. This improvement results in decreased complexity.
In addition to the above-mentioned report, the inventor has written an article, published in December, 1978 in Transactions of the ASME Journal of Dynamic Systems, Measurement and Control (Volume 100, page 291 et seq) entitled "A State-Constrained Approach to Vehicle Follower Control for Short Headway Automated Transit Systems" which provides background for the present invention.
Brief Description of the Drawings
FIG. 1 shows two vehicles and the variables considered in determining their spatial relationship.
FIG. 2 is a diagram showing the implementation of the control law employed by the present invention.
FIG. 3 is a diagram showing elements which generate a variable .epsilon..sub.w used in controlling relative vehicle position in a 3-second headway embodiment of the invention.
FIG. 4 shows a diagram implementing the control law of a 0.5-second headway embodiment of the invention.
Description of a Preferred Embodiment of the Invention:
Referring to FIG. 1, a preceding vehicle P is followed by a trailing vehicle T on a guideway G. The state of vehicle P is defined by its position x.sub.p, its velocity v.sub.p, and its acceleration a.sub.p. Similarly, the state of trailing vehicle T is defined by its position x.sub.t, its velocity v.sub.t, and its acceleration a.sub.t. The distance, or separation, between the two vehicles is indicated by S. The optimal separation between the two vehicles is referred to as S.sub.min, while an approximate value used to achieve a practical, implementable control system is referred to as S'.sub.min. The difference between the actual separation and the approximated optimal separation is referred to as .epsilon.. The purpose of the present invention is to drive the value of .epsilon. to zero for various constant headways (h seconds). In particular, embodiments having a 0.5 second headway which is generally characteristic of a personal rapid transit system and a 3 second headway which is characteristic of a group rapid transit system are set forth.
Referring to FIG. 2, an implementation of the basic control law (particularly adaptable to a 3 second headway) of the present invention is set forth. Signals corresponding to x.sub.p and x.sub.t are shown entering a subtractor 2 together with the length of the preceding vehicle L to yield the actual separation S between the vehicles P and T. Given particular jerk and acceleration restraints, namely, 2 mm/sec.sup.3 and 1.5 mm/sec.sup.2, respectively, a discrepancy value .epsilon..sub.w (based on wayside information) is defined, according to the invention, as:
The implementation of this definition is shown where the signal corresponding to the spacing S enters a summer 4 while at the same time entering a differentiator-gain element referred to in conventional notation with a (5.3-h)d/dt in a block 6. The output of block 6 is added to the spacing S in summer 4 the output of which enters another summer 8. Element 10 also receives the output from block 6 as an input and scales it by a factor 0.33/(5.3-h). The output of gain element 10 is multiplied by a calculated, estimated value of the velocity of the trailing vehicle, v.sub.t in a product (.pi.) element 12. The output of product element 12 enters summer 8 together with the output of summer 4 to yield .epsilon..sub.w as previously defined. It should be noted that the scaling values and constants employed depend on the selected jerk and acceleration limits and headway, and can be varied depending on those limits.
The configuration set forth in FIG. 2 is referred to as "smart" in that control looping for the system is effected, for the most part, on board the vehicle T. Specifically, .epsilon..sub.w enters a combiner 14 which produces a refined .epsilon.. .epsilon. is, in part, a function of acceleration a.sub.c and velocity v.sub.c commands. (These commands a.sub.c and v.sub.c are used to change the state of the trailing vehicle T in such a way as to decrease the absolute value of .epsilon..) .epsilon. from combiner 14 enters a limiter 16 wherein the value for .epsilon. is limited to a value of one when it is either less than minus .DELTA. or greater than plus .DELTA., .DELTA. being a settable limit. The output of limiter 16 enters a jerk factor element 18. When .epsilon. is not equal to zero a jerk command J.sub.c is generated which is converted through an integrator 20 into an acceleration command a.sub.c. Through another integrator 22, the acceleration command a.sub.c provides a velocity command v.sub.c which is intended to affect the state of the trailing vehicle T. The acceleration command a.sub.c is fed back through a gain element g and is then entered into combiner 14. Also, the velocity command v.sub.c is fed back through a gain element h, where h is the desired headway and is also entered into the combiner 14. Accordingly, .epsilon. is then defined as:
A second control variable u.sub.w is provided to maintain .epsilon. at zero. u.sub.w corresponds to a scaled derivative of .epsilon..sub.w as suggested in FIG. 2 by a differentiator 24. u.sub.w enters a summer 26 together with a scaled acceleration command, namely, a.sub.c scaled by headway, h, divided by g. The output from summer 26 is u (i.e., a measure of change in .epsilon.) which enters a subtractor 28 and a product (.pi.) element 30 simultaneously. The other input to the product element 30 is a switching device 32 which has as its input the output from the limiter 16. In operation, when .epsilon. is zero, the output from the switch 32 is zero causing the output from product element 30 to be zero. The element u passes unaltered to and through the subtractor 28 to a summer element 34 where it is added to the jerk signal stimulated by element 18. When .epsilon. changes from zero, u, a measure of change in .epsilon., causes a jerk change command to exit subtractor 28 and force .epsilon. to a zero level. When .epsilon. is very large, the output from limiter 16 is 1 or -1. According to switch 32, the value of u entering 30 will be multiplied by 1 and will thus enter the subtractor as a negative input. u is also entered into subtractor 28 as a positive input. When .epsilon. is very large, the value of u is not considered in generating the jerk command, the output from subtractor 28 being zero. A dual mode operation depending on the value of .epsilon. is thus achieved. When the spacing S is far from its optimum (.epsilon. is large in magnitude), the system operates in accordance with the imposed jerk limit so as to null .epsilon.. As S approaches its optimum and kinematic constraints may be violated (.epsilon. is small in magnitude), the system assumes its other mode. The selective signal from element 32 effects this dual modality.
Once generated, the velocity command v.sub.c enters a vehicle propulsion system 36 of vehicle T. The command is integrated into the vehicle T to either increase or decrease its speed. The new speed of the trailing vehicle T is measured by sensor and is indicated as v.sub.t. v.sub.t is then either integrated in a filter 38 which provides a position output x.sub.t or x.sub.t may be measured directly by sensors. x.sub.t enters a state estimator 40 which produces estimated position and velocity values x.sub.t and v.sub.t for the trailing vehicle T. The value of x.sub.t is fed back to subtractor 2 where a new value for the spacing S can be determined.
In accordance with the present invention, two configurations are suggested depending on the desired headway. For a system having a 3-second headway, the value for u.sub.w is obtained by simply differentiating .epsilon..sub.w : ##EQU1##
In effectuating this configuration, the arrangement of FIG. 3 is employed. Interposed between x.sub.t and .epsilon..sub.w in this 3-second headway embodiment is a wayside computer 100 which includes the state estimator 102 and a wayside control 104. The state estimator 102 is a conventional Kalman filter which receives as inputs the position of the trailing vehicle x.sub.t and the position of the preceding vehicle x.sub.p as they are sensed by either the respective vehicles or wayside equipment. The signals are downlinked at a rate determined by a switch T.sub.D. The state estimator 102 generates velocity estimates v.sub.p and v.sub.t and position estimates x.sub.p and x.sub.t which provide more precise values for the state variables. The estimated values enter the wayside control 104 which uplinks .epsilon..sub.w, which is equal to
to the vehicle T at a sampling interval T.sub.u. In accordance with this embodiment, the control variable u is calculated on-board the vehicle T by differentiating .epsilon..sub.w, as shown by block 24 of FIG. 2 which represents a differentiator in this embodiment. With the 3 second headway, only .epsilon..sub.w need be computed and transmitted. No explicit acceleration estimates are required. However, the differentiation of .epsilon..sub.w to derive u.sub.w requires noise filtering and thus degrades performance. Although satisfactory where headway h is 3 seconds this degradation proves unacceptable as h=0.5 seconds.
In effectuating the 0.5-second headway, the configuration shown in FIG. 4 provides numerous advantages. First, the value u.sub.w is defined as:
where () represents estimated value of the respective quantities. The uplink command (u.sub.w +.epsilon..sub.w), or u.sub.c, then becomes (1/g s+1).epsilon..sub.w where S is the conventional LaPlace notation representing differentiation. Onboard the trailing vehicle T, .epsilon..sub.w can be readily retrieved as: ##EQU2## where u.sub.w =u.sub.c -.epsilon..sub.w. This configuration obviates on-board differentiation and for proper initialization and requires only one piece of information, i.e., u.sub.c, for uplink.
Referring to FIG. 4, a position measurement signal x.sub.t is derived from the vehicle propulsion system 36 and downlinked at a sampling interval T.sub.D. The sampled x.sub.t signal enters a state estimator 200 which differs from the state estimator 102 of FIG. 3 but also interpolates states between samples and reduces noise. In addition to the sampled x.sub.t signal, estimated velocity v.sub.c and acceleration a.sub.c commands are fed into the state estimator 200. The state estimator 200 is basically a Kalman filter which produces an estimated desired position x.sub.t, velocity v.sub.t, and acceleration a.sub.t output. The estimated outputs of the trailing vehicle T enter a wayside control 202 of computer 203 together with the estimated position x.sub.p, velocity v.sub.p, and acceleration a.sub.p states of the preceding vehicle P derived from the sensed x.sub.p processed through a state estimator 204. From the estimated states for vehicles P and vehicle T, the wayside control 202 generates the aforementioned uplink command u.sub.c as well as estimated velocity v.sub.c and acceleration a.sub.c commands. The estimated commands v.sub.c and a.sub.c are obtained via a duplicate on-board control computation from on-board controller 205 and are used in generating inputs to the state estimator 200.
The wayside control 202 also generates an .epsilon..sub.w signal and a u.sub.w signal based on the estimated state inputs for the trailing vehicle T and preceding vehicle P. The two signals are combined into a single signal (.epsilon..sub.w +u.sub.w) for uplink transmission. The uplink transmission is sampled at an interval T.sub.u. Between intervals the previous (.epsilon..sub.w +u.sub.w) signal is stored in a zero order hold element 206. A filter 208 includes a first exponential function gain element 210 which multiplies the (.epsilon..sub.w +u.sub.w) signal by 1-e .sup.-gT v where T.sub.v is the onboard computation interval. The output of gain element 210 enters a summer 212 the output from which is .epsilon..sub.w. The .epsilon..sub.w output is fed back to summer 212 after being delayed by an interval T.sub.v in element 214 and passing through a second exponential gain element 216 which multiplies the .epsilon..sub.w signal by e.sup.-gT v. When combined, the inputs to summer 212 yield .epsilon..sub.w which can then be provided to combiner 220 (shown in FIG. 2 as 14) and to an element 222 which subtracts .epsilon..sub.w from the signal (.epsilon..sub.w +u.sub.w) to produce u.sub.w. As indicated in FIG. 4, u.sub.w enters the summer 222 (shown also in FIG. 2). The FIG. 4 embodiment, as previously discussed, by employing the subtractor element 222 rather than a differentiator as in FIG. 3, avoids noise and enhances performance in the 0.5 second headway embodiment. Except for being defined in digital terms, the remainder of the control in FIG. 4 functions similarly to that described with respect to FIG. 2, i.e., delays and summations being used rather than differentiation and integration filtering, resulting in enhanced 0.5 second headway operation.
Various modifications, adaptations and alterations to the present invention are of course possible in light of the above teachings. It should therefore be understood at this time that within the scope of the appended claims, the invention may be practiced otherwise than was specifically described hereinabove.