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.
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.
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.
Referring now to the drawings, and more particularly to
As illustrated in
Now, additionally referring to
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
Now, additionally referring to
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:
Rate control has an advantage relative to human operator modeling and is very applicable for several reasons:
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
In
In
As illustrated in
Blocks 102 and 104 correspond to planner 12 of
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
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.
Number | Name | Date | Kind |
---|---|---|---|
4758959 | Thoone et al. | Jul 1988 | A |
5163530 | Nakamura et al. | Nov 1992 | A |
5358317 | Cikanek | Oct 1994 | A |
5475591 | Suzuki et al. | Dec 1995 | A |
5684691 | Orbach et al. | Nov 1997 | A |
5704200 | Chmielewski et al. | Jan 1998 | A |
5863105 | Sano | Jan 1999 | A |
5875108 | Hoffberg et al. | Feb 1999 | A |
5899288 | Schubert et al. | May 1999 | A |
5901246 | Hoffberg et al. | May 1999 | A |
5940814 | Jiang et al. | Aug 1999 | A |
5968103 | Rocke | Oct 1999 | A |
5974352 | Shull | Oct 1999 | A |
5983161 | Lemelson et al. | Nov 1999 | A |
6038505 | Probst et al. | Mar 2000 | A |
6041320 | Qin et al. | Mar 2000 | A |
6064933 | Rocke | May 2000 | A |
6070118 | Ohta et al. | May 2000 | A |
6081750 | Hoffberg et al. | Jun 2000 | A |
6125314 | Graf et al. | Sep 2000 | A |
6188945 | Graf et al. | Feb 2001 | B1 |
6208981 | Graf et al. | Mar 2001 | B1 |
6223117 | Labuhn et al. | Apr 2001 | B1 |
6226389 | Lemelson et al. | May 2001 | B1 |
6233515 | Engelman et al. | May 2001 | B1 |
6317686 | Ran | Nov 2001 | B1 |
6321153 | Rocke et al. | Nov 2001 | B1 |
6353785 | Shuman et al. | Mar 2002 | B1 |
6385519 | Rocke | May 2002 | B2 |
6430506 | Mon et al. | Aug 2002 | B1 |
6442463 | Qiu et al. | Aug 2002 | B1 |
6480768 | Torii | Nov 2002 | B1 |
6487477 | Woestman et al. | Nov 2002 | B1 |
6487500 | Lemelson et al. | Nov 2002 | B2 |
6553130 | Lemelson et al. | Apr 2003 | B1 |
6584382 | Karem | Jun 2003 | B2 |
6615126 | Potter et al. | Sep 2003 | B1 |
6735515 | Bechtolsheim et al. | May 2004 | B2 |
6813562 | Altan et al. | Nov 2004 | B2 |
6836719 | Andersson et al. | Dec 2004 | B2 |
6906639 | Lemelson et al. | Jun 2005 | B2 |
6925425 | Remboski et al. | Aug 2005 | B2 |
7039551 | Shu et al. | May 2006 | B2 |
7124027 | Ernst et al. | Oct 2006 | B1 |
7178819 | Scherl et al. | Feb 2007 | B2 |
7263419 | Wheals et al. | Aug 2007 | B2 |
7359770 | Cole | Apr 2008 | B2 |
7389178 | Raz et al. | Jun 2008 | B2 |
7561054 | Raz et al. | Jul 2009 | B2 |
7769512 | Norris et al. | Aug 2010 | B2 |
20020120371 | Leivian et al. | Aug 2002 | A1 |
20030065432 | Shuman et al. | Apr 2003 | A1 |
20030135290 | Yao et al. | Jul 2003 | A1 |
20030171869 | Potter et al. | Sep 2003 | A1 |
20030217021 | Jacobson | Nov 2003 | A1 |
20040158371 | Iggulden et al. | Aug 2004 | A1 |
20050149240 | Tseng et al. | Jul 2005 | A1 |
20050197994 | Fujii et al. | Sep 2005 | A1 |
20050273240 | Brown et al. | Dec 2005 | A1 |
20060080022 | Hrovat et al. | Apr 2006 | A1 |
20060200258 | Hoffberg et al. | Sep 2006 | A1 |
20060253240 | Rao et al. | Nov 2006 | A1 |
20070005212 | Xu et al. | Jan 2007 | A1 |
20070083318 | Parikh | Apr 2007 | A1 |
20080086248 | Lu et al. | Apr 2008 | A1 |
20080195293 | Norris et al. | Aug 2008 | A1 |
Number | Date | Country | |
---|---|---|---|
20080195569 A1 | Aug 2008 | US |