FIELD OF THE INVENTION
The present invention relates to a method of speed control, and, more particularly to a human perception model for use in the speed control of a vehicle.
BACKGROUND OF THE INVENTION
Automatic control of complex machinery, such as moving vehicles exists, for example, the control systems for aircraft autopilots. Just as a man-machine interface is required for the man to control the machinery an automation of the control system is largely specific to the particular machinery that is to be controlled. For example, pilots, even after extensive training on a particular aircraft, do not qualify for piloting a similar aircraft, without extensive training on the alternate aircraft.
Agricultural machinery has become more expensive and complex to operate. Traditionally, human machine control has been limited to open-loop control design methods, where the human operator is assumed to receive appropriate feedback and perform adequate compensation to ensure that the machines function as required and to maintain stable operation. Design methods have included using an expert operator and fine-tuning the control with non-parametric feedback from the operator in terms of verbal cues. These approaches do not always translate to the best quantitative design or overall human-machine synergy.
Assuming that an individual expert operator is the only method of ensuring qualitative response presents several problems. One problem with this assumption is that humans are not the same, with varying perceptions, experience, reaction time, response characteristics and expectations from the machine. The result may be a perceived lack in the qualitative aspects of the human machine interface for some operators. The task of designing optimal human-machine system performance without a consistent operator becomes a daunting one, as there are no methods for settling appropriate constraints. Additionally, expert operators are themselves different in terms of level of efficiency, aggressiveness and sensitivity. Expert operators adapt very quickly to machine designs, including inadequate ones. The result is that qualitative design change effectiveness is not guaranteed since they are applied based on an operator's continuously adapting perception of the machine performance.
What is needed is an operator model that provides the ability to address design issue variables including response fidelity, accuracy and noise from sensory information, response time, and control set points based on aggressiveness and mission requirements.
SUMMARY OF THE INVENTION
The present invention provides a human perception model for the speed control of a vehicle.
The invention comprises, in one form thereof, a human perception model for a speed control method including the steps of obtaining a steering angle, a velocity error and a distance error. The method further includes the steps of applying the steering angle, inputting a measure of operator aggressiveness and defuzzifying an output. The applying step includes applying the steering angle, the velocity error and the distance error to fuzzy logic membership functions to produce an output that is applied to a velocity rule base. The inputting step inputs a measure of operator aggressiveness to the velocity rule base. The defuzzifying step defuzzifies an output from the velocity rule base to produce a speed signal.
BRIEF DESCRIPTION OF THE DRAWINGS
FIG. 1 is a schematic illustration of the use of fuzzy logic in an embodiment of the method of the present invention;
FIG. 2 schematically illustrates an embodiment of a human perception model of the present invention for the speed control of a vehicle;
FIG. 3 illustrates a path of the vehicle of FIG. 2 along a preferred path;
FIG. 4 illustrates a front angle error of the vehicle of FIG. 2 relative to a preferred course;
FIG. 5 schematically illustrates a rule used by the performance model of the present invention;
FIG. 6 illustrates the application of several rules used by the performance model of the present invention;
FIG. 7 illustrates even more certainty by the including of rules in the performance model of the present invention;
FIG. 8 is a schematic illustration of a human performance model of the present invention;
FIG. 9 schematically illustrates a vehicle utilizing the performance model of FIG. 8; and
FIG. 10A-C schematically illustrates another embodiment of a fuzzy control system of the present invention.
DETAILED DESCRIPTION OF THE INVENTION
Referring now to the drawings, and more particularly to FIGS. 1 and 2, there are shown schematic illustrations of an approach used in an embodiment of a method of the present invention. The goal is to approximate human operator performance characteristics, which is undertaken by the use of a fuzzy logic controller structure. The design of the virtual operator proceeds in the following sequence and includes the fuzzification of the input variables, the application of the variables to a fuzzy inference and rule base construction and the defuzzification of the output variables. The fuzzification step converts control inputs into a linguistic format using membership functions. The membership functions are based on the outputs from an error interpreter. The input variables to the model include several performance related measurable items. To reduce computational effort, linear approximations are implemented. A fuzzy membership function for the various linguistic variables are chosen to be pi-type or trapezoidal in nature.
As illustrated in FIG. 1, measured variables having numeric values are fuzzified into a linguistic format. A fuzzy-inference of these fuzzified variables is made by the application of a rule base resulting in command variables having a fuzzy format. These command variables are then defuzzified by converting the command variables to a numeric value that is interfaced with the control system of the vehicle plant. The vehicle responds causing a change in the location of the vehicle, which creates new measured variables based on the new location, and the method continues.
Now, additionally referring to FIGS. 3 and 4, the approach used for the operator model applies fuzzy logic to perception based modeling. This human model is developed for the purpose of a speed control function. When provided a path or segment, such as segments BC and CD, as shown in FIG. 3, it can be modeled as linear segments, arcs or clothoids and provides illustrations of the errors related to the control objective of following the path parallel to the trajectory at a minimum distance. The problem becomes multi-objective when the vehicle:
- (1) Has initial conditions where the vehicle is outside of a given distance from the road or its heading varies from the path heading by a large degree.
- (2) Deviates from the path by a large amount and similar error conditions arise either from obstacles or high speeds with dynamic changes resulting from such things as lateral slip.
- (3) The current steering angle of the vehicle may result in a roll over based on the vehicle speed or potential for severe lateral slip.
As a result three errors are used as inputs to the operator model. The operator model is dependent on the errors, but independent of the method used to detect the errors or the set points. The three inputs are the distance error, the velocity error and the steering angle. For ease of reference herein, the steering angle will be referred to as an error even though it may otherwise not be thought of as such.
When a vehicle is traveling from B′ to C′ the distance from C to C′ is larger than the distance from B to B′ indicating that the vehicle is departing from the desired path of ABCDE. Further, the vehicle will depart farther at D-D′. This illustrates that the control system would undertake a correction to reduce the difference and control the speed in so doing. It can be seen in FIG. 4 that the speed may need to be increased in the solution since the location of D′ is farther from the referenced sector line than C-C′. Again the present invention uses the distance error, the velocity error and the steering angle as inputs in determining the necessary correction in speed of the vehicle.
Now, additionally referring to FIGS. 5-9, the operator model of the present invention is dependent on the errors, but independent of the method used to detect the errors or the set points. The errors are selected based on driver behavior and the difference between the current speed and the set point, the distance from the vehicle to the road and the current steering angle. Steering angle is included to help modulate the speed control to help reduce effects of lateral slip and reduce the risk of roll over.
The controller is constructed as a rate controller, controlling the rate of speed correction given a particular error. The rules involved that are used by methods of the present invention may include the following rules:
- If the error is large, increase the rate of correction.
- If the error is small, reduce the rate of correction.
- If the error is acceptable, take no corrective action.
Rate control has an advantage relative to human operator modeling and is very applicable for several reasons:
- (1) It will work on a variety of platforms, independent of vehicle geometry, with little modification and will work independent of set points. It is dependent on a max rate of turn and sampling rates.
- (2) It effectively models how most operator controls work, such as joysticks.
- (3) It emulates how human operators control vehicle speed while maintaining a consistent steering control throughout a turn.
- (4) The effects of discontinuities are reduced as each control action is discretely based on the current errors.
The control strategy for the system demonstrates the multi-objective nature of the controller. Like a human, certain errors can be disregarded depending on where the vehicle is located relative to where it has to go. For example, if the vehicle is far away from the path, the intent is to approach the path as soon as possible. If the vehicle continues to depart from the path then the speed should approach zero. If the steering angle is large, the speed should decrease to mitigate lateral slip and potential roll over. The decisions have to be made around the optimal/mission speed set points. Using the method known as fuzzy relation control strategy (FRCS) the rule base is minimized in this control strategy.
The operator model addresses the fidelity of the response, accuracy and noise from sensory information, response time, control set points based on aggressiveness and mission requirements, output scaling is based on operator aggressiveness, and operator experience, perception and judgment. The model addresses these elements through the use of applied gains and changes to the membership function linguistic variables.
The membership functions of the fuzzy system represent how the model interprets error information. Trapezoidal membership functions, such as those shown in FIGS. 5-7 represent regions where the operator is certain of an interpretation, or error classification. Trapezoids are used in FIGS. 5-7 to provide a visual illustration of the membership functions. For a human operator it is almost impossible to measure error exactly, even more so for an inexperienced operator. A regional approach to error classification is most applicable to the present invention. For example, a human operator cannot determine that the vehicle is traveling exactly at 5 meters/second unless he uses some direct measurement of the speed. However, depending on the situation, he can determine he is traveling very fast and away from the path. What is uncertain is where very fast changes to a fast classification or where the transition region between classifications of errors occurs. These transitions are illustrated as angled portions of the trapezoids. A triangular, or a Gaussian distribution with a small standard deviation, membership function by itself is inappropriate in this approach. However, continuing with the regional approach, experience/judgment can be incorporated and represented in two ways. The first is an increase in the number of linguistic variables, or perception granularity, depending on the fidelity required for adequate control. The second aspect is that smaller transition regions between the linguistic variable error classifiers improve system performance. Inexperience and errors in interpreting the information are represented in this model by linguistic variables with extended transition regions such as that shown in FIGS. 5 and 6 and/or by shifting the regions covered by the linguistic variables. This model lends itself very well to interpreting the inexact common noisy data from sensors as well as describing how humans make control decisions with uncertain information. The model uses a common sense rule base that remains unchanged, except in the event of improved perception granularity, where additional rules using the same control strategy would have to be applied. The response fidelity, perception, operator experience, accuracy, noise from sensory information and judgments are represented and are modifiable. Control set points can be changed without effecting the controller operations using gains based on the operator level of aggressiveness and mission requirements. An output can also be scaled based on operator aggressiveness as the current system provides a signal between one and minus one. The output component of the rules within the rule base can also be modified to provide a more aggressive output.
In FIGS. 5-7 the region of certainty under all situations is illustrated by the shaded box. As the situation changes it shifts away from the region of certainty there is a decreasing likelihood that the rule is going to be effective, as illustrated by the sloped lines. In FIG. 6 as more rules are introduced, as compared to FIG. 5, there is less possibility of an uncertain circumstance. Further, more experience and/or a larger knowledge base, there is more interpretation and response granularity, that yields smaller, less fuzzy transition regions between the rules, as illustrated in FIG. 7.
FIG. 8 schematically illustrates a performance model 10 including a planner portion 12, an error interpreter 14, and a human decision-making model 16. A reference signal 18, as well as set points from planner 12, are utilized by error interpreter 14 to generate errors such as distance error, velocity error and it also utilizes current steering angle information. Error interpreter 14 generates errors 20 that are used by human decision-making model 16 to produce a control signal 22. Control signal 22 in this instance relates to the speed of the vehicle.
In FIG. 9 performance model 10 feeds control system 24 a control signal 22. Control system 24 provides input into dynamic model 26. Dynamic model 26 may include other inputs 28 other than speed information, such as steering information that may be input on other inputs 28. An output signal from dynamic model 26 is generated and a feedback reference signal 30, which feeds back to reference signal 18, indicates the position, velocity, acceleration and orientation of the vehicle.
As illustrated in FIG. 2, a method 100 obtains information from an operator that include a required path 102 and set points necessary to alter the vehicle speed at 104. A distance error 106, a velocity error 108, a steering angle 110 and operator experience/perception 112 all serve as inputs to fuzzification portion 114. Fuzzification portion 114 utilizes velocity membership functions to interpret the inputs to generate output information for use in velocity rule base 118. Operator aggressiveness 116 is also input into rule base 118, the output thereof is provided to velocity defuzzifier 120 that results in an input signal to a vehicle control unit 122. Vehicle control unit 122 also has an operator reaction time input in order to calculate an output signal to control vehicle 126. The position, velocity, acceleration and orientation of vehicle 126 is sensed and fed back as a reference by a feedback loop 128.
Blocks 102 and 104 correspond to planner 12 of FIG. 4. The distance error 106, velocity error 108 and steering angle 110 are utilized as inputs to an error interpreter 14. Operator experience/perception 112, operator aggressiveness 116 and operator reaction time 124 are set by a gain control as described previously. Distance error 106 and velocity error 108 are determined from mathematical combinations of the information from feedback loop 128 and from the required path 102 and set points 104.
Human perception provides an inexact estimation of error. Exact error measurements are not possible by a human; however, humans can readily determine if an error is acceptable, close or far away from an objective based upon experience. Boundaries between error classifications are where the uncertainty occurs. The trapezoidal representation incorporates the imprecise classification in their transitional sloped areas. The flat areas at the top of the trapezoids represent a region of certainty.
The membership function parameters used in block 114 are tuned to minimize the maximum distance variation from a given trajectory at an optimal or near optimal speed. The tuned membership functions for example can have three linguistic variables in an attempt to minimize computational effort. When additional granularity in the membership functions is needed it can be introduced if necessary. For example, using variables of “too fast”, “too slow” and “acceptable speed” easily illustrates the linguistic variables that are common to a human operator and are utilized by method 100.
The rule base is derived based on heuristic knowledge. A hierarchal technique is used based on the importance of the inputs relative to their linguistic variable regions. The hierarchy is drawn from the controller objects. The object for the fuzzy logic controller is to provide a speed signal to bring the vehicle to a desired path. In order to incorporate the information, a fuzzy relations control strategy (FRCS) is utilized. The error values are then fuzzy relations control variables (FRCVs). The FRCS applies to an approach with a control strategy that is incorporated into the fuzzy relations between the controller input variables. The FRCS is developed because the problem is multi-objective, where the current object depends on the state of the system and it results in a different control strategy. The control strategy is to minimize the distance from a trajectory in as short a time as possible, to avoid lateral slip and to avoid roll over the vehicle. The current steering angle of the vehicle incorporated as block 110 is input into fuzzification portion 114 to classify the steering angle. If the vehicle distance is far from a required path and the primary objective is to approach the required path as quickly as possible without spending excessive control energy, the vehicle speed may be an acceptable value that is higher than an acceptable value when the vehicle closely approaches the required path. As such, the definition of acceptable speed is different when the vehicle is a far distance from the required path than it is when the vehicle is a short distance from the path.
The FRCS employed in forming the rule base includes a complete set of control rules for all speed conditions. The size of the rule base is generally reduced by approximately 98% by ignoring the extra rules irrelevant to the control strategy.
Defuzzifying the output of rule base method 118 occurs at step 120 to derive a non-fuzzy or crisp value that best represents the fuzzy value of the linguistic output variable. One method that can be utilized is known as the center of area technique to result in a discrete numeric output.
Now, additionally referring to FIGS. 10A-C, there is illustrated another embodiment of the present invention including inputs to both steering and velocity fuzzy control rule bases that result in vehicle control signals that are interpreted and applied to each of four drive motors and a steering motor. The vehicle schematically illustrated has four drive wheels that are independently speed controlled and a steering motor that is used to guide the steering mechanism of the vehicle. Inputs, in addition to those discussed above, are used in this fuzzy rule base system, such as vibration amplitude, vibration frequency and the roll, pitch and yaw of the vehicle. Although shown in a schematic form apart from vehicle 126 it is to be understood that the elements depicted in FIGS. 10A and 10B are normally functionally located on vehicle 126. The model can also be used apart from a vehicle for simulation purposes.
The human perception model for speed control results in a qualitative optimization of the man-machine interface and a synergy between the operator and the machine. Additionally, it allows for a stability analysis for a wide range of operator behaviors since the gains of the inputs can be set to alter the experience and aggressiveness of the operator. The model allows for an optimization of the machine/control system to minimize energy consumption of the machine components based on a wide variety of operator behavior patterns. The human perception model results in an understanding of differences between operators, including varying efficiencies. This advantageously allows virtual rapid prototyping of control systems. The present invention leads to the development of autonomous, operator assisted, tele-operation, operator augmentation algorithms and human-machine interfaces. Additionally, the human operator model allows for understanding in determining of feed back requirements for drive-by-wire systems. Yet still further, the human perception model allows for development of sophisticated individual and personalizable operator controls and system response characteristics, thereby improving operator/machine synergy.
Having described the preferred embodiment, it will become apparent that various modifications can be made without departing from the scope of the invention as defined in the accompanying claims.