The present invention relates to methods and systems of a steering system, and more particularly to methods and system for forecasting or predicting system states and controlling aspects of a vehicle and/or steering system based on the predicted system states.
Electrical power steering (EPS) systems use an electric motor as an actuator to provide assist to a driver while steering a vehicle. In today's market, automotive technology is evolving fast to embrace semi-autonomous and autonomous technologies by developing feasible ADAS (Advanced Driver Assistance Systems) solutions. Instead of directly assisting the driver (by reducing steering efforts), EPS can also accept a position command from another control system to achieve directional control of a vehicle in certain conditions.
An embodiment of a method of controlling one or more components of a vehicle includes receiving a reference steering command and one or more measurement signals related to a steering system of a vehicle, and estimating, by a processing device, a state of the steering system based on the one or more measurement signals, the steering system including at least a handwheel and a steering motor. The method also includes determining a maximum state achievable by the steering system at one or more times subsequent to receiving the one or more measurement signals, and controlling, by a control module, the steering system based on the steering reference command and the maximum state.
An embodiment of a control system includes a processing device configured to estimate a state of a steering system of a vehicle based on measurement signals relating to the steering system and the vehicle, the measurement signals associated with an initial time interval, the steering system including at least a handwheel and a steering motor, and determine a maximum state achievable by the steering system at one or more subsequent time intervals. The system also includes a control module configured to control at least one of the steering system and the vehicle based on the maximum state.
These and other advantages and features will become more apparent from the following description taken in conjunction with the drawings.
The subject matter which is regarded as the invention is particularly pointed out and distinctly claimed in the claims at the conclusion of the specification. The foregoing and other features, and advantages of the invention are apparent from the following detailed description taken in conjunction with the accompanying drawings in which:
The following description is merely exemplary in nature and is not intended to limit the present disclosure, application, or uses. It should be understood that throughout the drawings, corresponding reference numerals indicate like or corresponding parts and features.
Referring now to
As shown in
A control module 40 controls the operation of the steering system 12 based on one or more of the sensor signals and further based on the steering control systems and methods of the present disclosure. The control module may be used as part of an EPS system to provide steering assist torque and/or may be used as a driver assistance system that can control steering of the vehicle (e.g., for parking assist, emergency steering control and/or autonomous or semi-autonomous steering control). An example of a driver assistance system is an ADAS (Advanced Driver Assistance Systems) system that, instead of or in addition to directly assisting the driver (by reducing steering efforts), can also accept a position command from another control system to achieve directional control of a vehicle in certain conditions.
Generally speaking, the steering control systems and methods of the present disclosure can be used to provide directional control of a vehicle (either autonomously, semi-autonomously or by providing torque or steering assist) based on forecasting or predicting future system states. Such predictions can be used to assist in achieving a desired heading (or tire position) within a required time under various conditions. For example, a steering control system can provide steering control and/or assistance in functions such as automated driving and/or automatic parking assist (APA).
Aspects of embodiments described herein may be performed by any suitable control system and/or processing device, such as the motor assist unit 18 and/or the control module 40. In one embodiment, the control module 40 is or is included as part of an autonomous driving system.
Referring now to
The control module 40 may primarily include sub-modules such as a System Output Capability module 60, a reference command conditioning module 62 and a servo control module that outputs motor torque commands to an EPS or other steering control system. The control module may also incorporate additional sub-modules such as those shown in
In the example of
The control module 40 also includes a system output capability module 60 that can estimate current system states and/or forecast future system states, and can estimate current system capabilities and/or forecast future system capabilities. The system capability estimations can include maximum states (e.g., maximum handwheel position, maximum motor torque, etc.), and can provide information as to whether a commanded state can be achieved and the amount of time required to achieve the commanded state. The system output capability module 60 uses EPS signals (e.g., motor velocity and motor position), vehicle signals (e.g., vehicle speed) and/or motor capability data to estimate and/or forecast system states.
A system state may be one or more of various states related to, e.g., handwheel position and motor parameters (e.g., torque, motor angular speed, etc.). For example, the output capability module 60 can function as a handwheel position forecasting module that performs a handwheel position forecasting function. In another example, the module can estimate a maximum motor torque, e.g., the maximum amount of torque that can be generated by a motor. In yet another example, the module 60 can estimate an amount of motor torque that can be achieved within a selected time interval (i.e., time step), and/or can estimate an amount of time required to achieve a selected handwheel position.
The vehicle control module 58 is used to generate a steering reference command (e.g., a motor torque command, a reference steering angle or a reference handwheel position) based on information from perception module 52 and the localization module 50, however the state specified by the steering reference command may not be reached in the required time due to the limited ability of the steering motor. The output capability module 60 is able to forecast system states (e.g., the maximum steering angle or motor torque) that can be achieved by or within a selected time interval, e.g., within a calibrate-able time into the future. The output from the output capability module 60 may be used to condition control signals and can also be used to define the slew rate of the reference handwheel angle. For example, the output capability module 60 performs a handwheel position forecasting function and is configured to generate a predicted handwheel position in the clockwise direction and a predicted handwheel position in the counterclockwise direction, which can be used as maximums to limit the reference handwheel position and/or other control commands. The system output capability can be input to a reference command conditioning module 62 that conditions or limits the reference command to stay within system capability limits.
The maximum motor torque (shown as Max Motor Torque I) can be input to a low pass filter (LPF) 82, which models and further limits the maximum torque based on the dynamic behavior of the motor and motor control.
As shown above, the motor envelope model 80 estimates the maximum torque and limits the motor torque command, based on factors including motor velocity, thermal limit, and voltage.
It is noted that the motor envelope model can be configured to account for fewer factors or different factors than those discussed in conjunction with
As discussed above, the system state estimation and/or forecasting method may include estimating and/or predicting a rack load, which can then be applied to a mass model of the steering system for estimation and/or prediction of system states. The estimated or predicted rack load can be determined using a number of techniques. One technique includes estimating rack force based on motor measurements (motor angle, motor speed) using a state observer that provides estimates of the internal state of the system, such as an EPS observer.
Referring to
Referring to
M
z
=K
ψΨ,
where Mz is the aligning torque, Kψ is the torsional stiffness of the tire, and Ψ is the yaw angle of the wheel plane, and
with
Ψdef: Torsional deflection of the tire.
Ψdeflux: Maximum possible deflection of the tire.
Mz max: Maximum Torque that can be generated by the tire.
with
Xrel: Tire relaxation length.
ω: Tire rotational velocity.
r: Tire rolling radius.
An example of the static tire model is described in U.S. patent application Ser. No. 14/486,392 entitled “Providing Assist Torque without Hand Wheel Torque Sensor for Zero to Low Speed,” filed on Sep. 15, 2014, the entirety of which is incorporated herein by reference. The above equations are implemented in steering wheel coordinates (HW rad, HW rad/s), rather than tire steering coordinates (tire rad, tire rad/s).
In addition, as shown in FIG., motor velocity 96, motor angle 90 and a constant 102 (Ψdefin) are input to the static tire model 92 to generate a static rack force value 104.
Referring to
The motor angle value 90 is input to a tire relaxation dynamics module 120, which converts the motor angle to a tire angle using road wheel angle measurements and steer arm length measurements. This predicted road-wheel angle is passed through a vehicle speed dependent low pass filter. Steer arm length can be found using measurements done on a vehicle. The road wheel angle is applied to a tire relaxation dynamics module 122 and then to a bicycle model 124, which receives the road wheel angle and a vehicle speed value, and calculates force functions and values (alpha) related to tire slip between the tires and the road. At block 126, outputs from the bicycle model 124, the steer arm length and vehicle speed are used to calculate a rolling rack force 128.
Standard force and moment balance equations can be used at the front and rear axles of the bicycle model 124. The nonlinear rolling tire model is used to represent the lateral force vs slip angle relationship.
The following equations may be used in the rolling tire model:
m({dot over (V)}+rU)=Fcf+Fcr
I
zz
{dot over (r)}=a·F
cf
−b·F
cr
where:
V=Lateral speed of center of gravity (CG) of vehicle
U=Longitudinal speed of CG of vehicle
r=Yaw Rate of CG of vehicle
a=Distance of front axle from CG of vehicle
b=Distance of rear axle from CG of vehicle
Izz=Moment of Inertia about z axis
Fcf=Tire force of front axle
Fcr=Tire force of rear axle
m=Mass of vehicle.
Fcf and Fcr may be determined by a look-up table with the inputs of vehicle speed and slip angle. The higher vehicle speed will lead to a lower lateral force.
The relationship between slip angle and lateral force may be represented by
where ∝f and ∝r are slip angles of front and rear axles respectively, and δ is the steer angle (tire angle). The axle forces and pneumatic trail are expressed as:
F
cf
=F
cf(∝f)
F
cr
=F
cr(∝r)
Rack Force: Frack=(tm−tp)·Fcf/SA
In one embodiment, the static rack force 104 and the rolling rack force 128 are blended based on vehicle speed to generate a blended rack force 130. For example, the static rack force and the rolling rack force can be weighted based on vehicle speed, and/or a threshold speed can be applied to determine which force is output.
Data including the blended rack force and the maximum motor torque (which may be generated using the motor envelope model) can be applied to a mass model of an EPS or other control system. The mass model may be a one-mass model (e.g., a one degree of freedom mass-spring-damping system), a two-mass model, or other formulation. There may be various formulations of EPS or control system dynamics, such as a three-mass model or even a ten-mass model. The parameters of a multi-body EPS system model may be derived using system identification methods.
In one embodiment, the system capability estimation and/or forecasting function is called every calibrate-able time period Δtupdate. Then, this function predicts the system response at time ΔtForecasting by iteratively calculating system response in steps of sample time. Hence, the predicted response at time Δtupdate+ΔtForecasting is estimated at current time step, say Δtupdate. The iterative calculation may be achieved by an iteration technique such as a ‘for-loop’ technique, which may be executed in an embedded coder/controller. Since the algorithm is coded as an iterative algorithm in a ‘for-loop’, once it is called, ‘for loop’ will be executed for calibrate-able times to predict future system states such as predicted handwheel positions and limits at one or more calibrate-able times ΔtForecasting into the future. In other embodiments, if system capability is estimated immediately (e.g., at the current time zero or the next following time stamp Δtupdate.
The system state (e.g., handwheel position) may be estimated using the model for a current time, or used to predict future system states. For example, if a range of future states is to be predicted, an iterative algorithm may be used to estimate system states for a series of time steps. Examples of algorithms that may be used for prediction include iterative methods such as Runge-Kutta method or Euler method.
For example, a control system generates a reference handwheel position command 164. Based on the current handwheel position, the handwheel position at a future time or times (e.g. one time step at 0.01 seconds after the current time, or multiple time step iterations) is calculated according to embodiments discussed herein and used to generate the limits 160 and 162. The reference command 164 in this example exceeds the control system capability, which indicates that it cannot be achieved. In contrast, a second handwheel reference command 166 is within the system capability, which indicates that it can be achieved. Due to the estimated control system capability, it can be determined whether a reference position command can be achieved, e.g., by applying the limits and the reference position command to the reference command conditioning module 62 shown in
In one embodiment, system states and capabilities can be calculated immediately (e.g., at a current time step or an immediately following time step) and/or at future time steps. For example, the method can include forecasting handwheel position in the future, and can also include estimating the maximum achievable motor torque or handwheel velocity immediately.
In the following example, future system state predictions such as predicted handwheel positions are generated using the Runge-Kutta algorithm to solve a set of ordinary differential equations (ODEs) to predict the range of handwheel position in the future. The algorithm is coded as an iterative algorithm such as a ‘for-loop’ algorithm.
Execution of the Runge-Kutta algorithm is discussed as follows in a general sense. When the algorithm is used for EPS control, the dynamic system includes the motor envelope model, rack load model, and mass model. Consider solving a general ordinary differential equation with initial condition:
{dot over (y)}=f(t,y),y(t0)=y0
where y is a function of time t and {dot over (y)} is the derivative of y with respect to t. The Runge-Kutta is used to obtain an approximated solution, which is a sequence for n=0, 1, 2, 3 . . . , as follows:
where
h is a time interval or time value, k1 (or K1) is the increment based on the slope at the beginning of the interval y, k2 (or K2) is the increment based on the slope at the midpoint of the interval y+0.5*h*K1. K3 (or K3) is also the increment based on the slope at the midpoint of the interval y+0.5*h*K2, and k4 (or K4) is the increment based on the slope at the end of the interval y+h*K3
In one embodiment, yn is a set of variables including handwheel position, handwheel velocity, rack position and rack velocity.
The following is an example of a method for forecasting or predicting a system state, which incorporates a one-mass model of an EPS assist mechanism and an EPS observer for estimating rack load. The one mass model may be a one degree of freedom mass-spring-damping system where the handwheel is represented as the mass. In this example, the rack load is estimated for a current or immediately following time stamp.
The equation of motion for the one-mass EPS model of an assist mechanism can be expressed as:
J
A{umlaut over (θ)}A=TM−TF−Tb−TR,
where JA is the inertia of the assist mechanism (AM), {umlaut over (θ)}A is the angular acceleration of the AM, TM is the motor torque acting on the AM, TF is the torque due to friction, Tb is the torsion bar torque, and TR is the torque on the AM generated by the rack load. TM and Tb can be measured, and TF can be modeled. The combination of TM, TF and Tb can be combined as a measured torque T, where T=TM−TF−Tb. In addition, {dot over (θ)}A can be measured. Then, an observer can estimate TR using the measured T and {dot over (θ)}A.
The equation for the EPS observer can be expressed as follows:
T
R=[01]xe
where xe is a system state. The values Ā and
An example of the calculation of handwheel velocity limits is shown as follows:
Upper Limit=Estimated maximum handwheel velocity state
Lower Limit=Estimated minimum handwheel velocity state
For example, as shown in
Estimated maximum motor torque can be provided immediately from the motor torque envelope model. The estimated maximum motor torque may also be estimated for future time steps, e.g., by solving a set of ODEs as discussed above. Motor torque commands can be limited based on the maximum motor torque.
In another example, the vehicle control module 58 outputs a steering reference command representing a motor torque command rather than a reference handwheel position. The system output capability module 60 calculates a motor torque limit and sends it to the module 62, and a motor torque command is limited. An example of a limiter is shown in
The system state estimations and/or forecasts can be used by or in conjunction with a vehicle control system to limit or condition a reference command (e.g., a handwheel position reference command or motor torque command) to ensure that the reference command stays within system capabilities.
It is noted that the system capability can be output to the reference condition module 62 (or other suitable limiting device) for a single time step or for multiple time step iterations. This can be useful, e.g., when predicting the EPS system capability for several time step iterations is computationally expensive.
Embodiments described herein provide a number of benefits and technical effects. Embodiments provide effective techniques for forecasting or predicting steering system and steering control and/or assist system states, which can be used to affect motor control and/or vehicle control.
With advances in motor control and other technologies, EPS systems have much higher bandwidth than before. However, the time response of an EPS system is still greatly affected by inertia and stiffness of the system. Furthermore, the instantaneous tire stiffness can change as a function of conditions such as surface friction, payload, slip angle, etc. This would also affect directional control of a vehicle. Previous position control algorithms can use a rate limiter to limit the rate of change of a position reference input. However, these rate limits are just simple calibrations and are not fully representative of limitations of an EPS system in a given scenario. Embodiments described herein provide functions such as forecasting a maximum angle that can be achieved in a calibrate-able time into the future, which can be used to condition the reference position.
While the invention has been described in detail in connection with only a limited number of embodiments, it should be readily understood that the invention is not limited to such disclosed embodiments. Rather, the invention can be modified to incorporate any number of variations, alterations, substitutions or equivalent arrangements not heretofore described, but which are commensurate with the spirit and scope of the invention. Additionally, while various embodiments of the invention have been described, it is to be understood that aspects of the invention may include only some of the described embodiments. Accordingly, the invention is not to be seen as limited by the foregoing description.
This patent application claims priority to U.S. Provisional Patent Application Ser. No. 62/327,085, filed Apr. 25, 2016 which is incorporated herein by reference in its entirety.
Number | Date | Country | |
---|---|---|---|
62327085 | Apr 2016 | US |