Pre-alert of LCC's steering torque limit exceed
09688308 ยท 2017-06-27
Assignee
Inventors
Cpc classification
B62D6/00
PERFORMING OPERATIONS; TRANSPORTING
B62D6/002
PERFORMING OPERATIONS; TRANSPORTING
B62D15/029
PERFORMING OPERATIONS; TRANSPORTING
B60W10/20
PERFORMING OPERATIONS; TRANSPORTING
International classification
B62D15/02
PERFORMING OPERATIONS; TRANSPORTING
B60W10/20
PERFORMING OPERATIONS; TRANSPORTING
B62D6/00
PERFORMING OPERATIONS; TRANSPORTING
Abstract
A method for providing a warning to a vehicle driver when a lane keeping and/or lane centering system will be unable to negotiate a tight curve at the present vehicle speed prior to the vehicle reaching the curve. The method obtains lane information at a predetermined number of sample times in the future and generates a desired path for the vehicle. The method also obtains vehicle motion information and determines steering angles for the vehicle for the vehicle to track the desired path based on the desired path and vehicle motion. The method determines the steering torque for each of the steering angles and determines whether any of the steering torques exceed the predetermine torque limit. The method issues an alert if any of the steering torques do exceed the predetermined torque limit prior to the lane keeping system being required to provide that torque to steer the vehicle.
Claims
1. A method for determining whether a vehicle steering torque exceeds a predetermined maximum steering torque limit in advance while a vehicle is being controlled by a lane keeping system, said method comprising: obtaining lane information concerning a lane that the vehicle is traveling in at a predetermined number of sample times in the future; generating a desired path for the vehicle to maintain the vehicle in the lane; obtaining vehicle motion information required to maintain the vehicle on the desired path at each of the sample times; determining steering angles for the vehicle that are necessary for the vehicle to track the desired path at each of the sample times based on the desired path and the vehicle motion information; determining the vehicle steering torque required to steer the vehicle for each of the steering angles; determining whether any of the steering torques exceeds the predetermined maximum steering torque limit; and issuing an alert if any of the steering torques does exceed the predetermined maximum steering torque limit prior to the lane keeping system being required to command that torque to steer the vehicle.
2. The method according to claim 1 wherein generating a desired path includes using a polynomial equation.
3. The method according to claim 2 wherein the polynomial equation is:
4. The method according to claim 1 wherein obtaining vehicle motion information includes obtaining vehicle longitudinal speed v, vehicle lateral speed v.sub.y, vehicle yaw rate w, vehicle lateral acceleration a.sub.y and vehicle yaw acceleration {dot over (w)}.
5. The method according to claim 4 wherein obtaining vehicle motion information can be directly determined from desired path parameters and using the equations:
v.sub.y={dot over (y)}v.sub.x
{dot over (y)}dy/dt=yv.sub.x
y=5a.sub.5x.sup.4+4a.sub.4x.sup.3+3a.sub.3x.sup.2+2a.sub.2x+a.sub.1
a.sub.y=d.sup.2y/dt.sup.2=yv.sub.x.sup.2+ya.sub.x
y=20a.sub.5x.sup.3+12a.sub.4x.sup.2+6a.sub.3x+2a.sub.2
w=y
{dot over (w)}=d(y)/dt=yv.sub.x.
6. The method according to claim 1 wherein determining steering angles for the vehicle includes using the equation:
7. The method according to claim 1 wherein determining the vehicle steering torque includes using the equation:
8. The method according to claim 7 wherein the variables c and d are solved using a least-square method.
9. The method according to claim 1 wherein generating a desired path includes generating a vehicle lateral distance and a vehicle heading angle.
10. A method for determining whether a vehicle steering torque exceeds a predetermined maximum steering torque limit while a vehicle is being controlled by a lane keeping system, said method comprising: obtaining lane information concerning a lane that the vehicle is traveling in at a predetermined number of sample times in the future; generating a desired path for the vehicle to maintain the vehicle in the lane including determining vehicle lateral distance and vehicle heading angle at each sample time; obtaining vehicle motion information required to maintain the vehicle on the desired path at each of the sample times including obtaining vehicle longitudinal speed, vehicle lateral speed, vehicle yaw rate, vehicle lateral acceleration and vehicle yaw acceleration; determining steering angles for the vehicle that are necessary for the vehicle to track the desired path at each of the sample times based on the desired path and the vehicle motion information; determining the vehicle steering torque required to steer the vehicle for each of the steering angles; determining whether any of the steering torques exceeds the predetermined maximum steering torque limit; and issuing an alert if any of the steering torques does exceed the predetermined maximum steering torque limit prior to the lane keeping system being required to command that torque to steer the vehicle.
11. The method according to claim 10 wherein determining steering angles for the vehicle includes using the equation:
12. The method according to claim 10 wherein determining the vehicle steering torque includes using the equation:
13. The method according to claim 12 wherein the variables c and d are solved using a least-square method.
14. An alert system for determining whether a vehicle steering torque exceeds a predetermined maximum steering torque limit while a vehicle is being controlled by lane keeping system, said alert system comprising: means for obtaining lane information concerning a lane that the vehicle is traveling in at a predetermined number of sample times in the future; means for determining a desired path for the vehicle to maintain the vehicle in the lane; means for obtaining vehicle motion information required to maintain the vehicle on a desired path at each of the sample times; means for determining steering angles for the vehicle that are necessary for the vehicle to track the desired path at each of the sample times based on the desired path and the vehicle motion information; means for determining the vehicle steering torque required to steer the vehicle for each of the steering angles; means for determining whether any of the steering torques exceeds the predetermined maximum steering torque limit; and means for issuing an alert if any of the steering torques does exceed the predetermined maximum steering torque limit prior to the lane keeping system being required to command that torque to steer the vehicle.
15. The alert system according to claim 14 wherein the means for generating a desired path uses a polynomial equation.
16. The alert system according to claim 15 wherein the polynomial equation is:
17. The alert system according to claim 14 wherein the means for obtaining vehicle motion information obtains vehicle longitudinal speed v, vehicle lateral speed v.sub.y, vehicle yaw rate w, vehicle lateral acceleration a.sub.y and vehicle yaw acceleration {dot over (w)}.
18. The alert system according to claim 14 wherein the means for determining steering angles for the vehicle uses the equation:
19. The alert system according to claim 14 wherein the means for determining the vehicle steering torque uses the equation:
20. The alert system according to claim 19 wherein the variables c and d are solved using a least-square method.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1)
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
DETAILED DESCRIPTION OF THE EMBODIMENTS
(10) The following discussion of the embodiments of the invention directed to a system and method for providing an early driver alert when a lane centering and/or lane keeping system is unable to negotiate a tight curve is merely exemplary in nature, and is in no way intended to limit the invention or its applications or uses.
(11) The following description includes a discussion of the relationship between vehicle steering angle and vehicle steering torque.
(12) The steering system 10 includes an electric power steering (EPS) system 24 having an electric steering motor 26 mounted to the axle 20 that provides electric steering assist in response to the vehicle driver turning the steering wheel 12 in a manner that is well understood in the art. In other words, when the vehicle driver turns the steering wheel 12, the EPS system 24 turns the wheels 14 and 16 the amount commanded by the vehicle driver so that the turning of the wheels 14 and 16 on the roadway is easier. The vehicle system 10 may also include an active front steering (AFS) system 28 including an electric motor 30 mounted to the steering column 18. AFS systems are well known to those skilled in the art that provide additional steering, or corrective steering, in various types of vehicle stability control systems in connection with the vehicle driver turning the steering wheel 12, where the AFS system 28 decouples the steering wheel 12 from the wheels 14 and 16.
(13) The steering system 10 also includes an EPS electronic control unit (ECU) 32, which in one embodiment is configured to provide overall EPS system control. The ECU 32 also includes a lane centering and/or lane keeping system 34 for providing adaptive lane keeping and lane centering control in an autonomous or semi-autonomous vehicle consistent with the discussion herein. As understood by one of ordinary skill in the art, the EPS system 24 electrically assists a driver in the steering of the vehicle by applying a variable motor torque command T.sub.M to the steering motor 26 and, as needed, a torque overlay command (TOC) that alters the value of the motor torque command T.sub.M during an EPS-assisted steering maneuver.
(14) A steering angle sensor 36 mounted to the steering column 18 measures the rotation of the steering wheel 12 and the steering column 18 and provides a steering angle signal .sub.s indicative of same. A torque sensor 38 mounted to the steering column 18 measures the torque on the steering column 18 and provides a torque signal T.sub.s indicative of same. The ECU 32 is in electrical communication with the angle sensor 34 and the torque sensor 38 such that the steering angle signal .sub.s and the steering torque signal T.sub.s are made available to the ECU 32. The ECU 32 processes a set of vehicle performance values, including the steering angle signal .sub.s and the steering torque signal T.sub.s, and continuously monitors vehicle parameters, such as, but not limited to, the speed of the vehicle, the vehicle yaw rate, vehicle lateral and longitudinal acceleration, etc. In addition, the ECU 32 may be configured to receive data from various lane detection sensors, which are generally mounted to the exterior of the vehicle. In many systems, the lane detection sensors include lane detection cameras mounted to various locations on the vehicle, such as the front windshield of the vehicle, under the vehicle side mirrors, etc., which are configured to sense lane markings affixed to the roadway. The lane markings generally indicate the boundaries defining the geometry of the lane, including the lane center. One of ordinary skill in the art would understand that processors and ECUs other than ECU 32 may be used by the lane control system 34 to monitor and determine the center of the lane.
(15)
(16) The present invention proposes an early warning alert to the vehicle driver in advance of when the lane centering/lane keeping system 34 is unable to maintain the vehicle 52 in the lane 56 as a result of vehicle speed and curve radius due to a maximum steering torque limit on the system 34. By providing a warning in advance to the driver that the lane centering/lane keeping steering control may have to make adjustments in speed to maintain the lane centering, the driver will be able to take over the vehicle control if desired to maintain the vehicle speed. Current systems often employ a lane departure warning (LDW) that alerts the vehicle driver when the vehicle 52 is outside of the lane boundary. However, this alert may not be early enough for the driver to take over the steering control to maintain the vehicle 52 in the lane 56. Typically for highway speeds, the vehicle 52 can get out of the lane 56 in a fraction of a second. Thus, an early driver warning is important to reduce the chance of road accidents.
(17)
(18) The present invention can be interpreted as an inverse problem of determining the vehicle future path given the steering angle . The present invention determines the steering angle , and then the steering torque required to provide the steering angle from the desired path.
(19) The first step in the process is to capture the lane data within some preview distance from of the current location of the vehicle 52, for example, three seconds of travel distance, using the various sensing systems on the vehicle 52, such as the camera 54, GPS, map database, etc.
(20) The next step in the process is to generate the desired path at the block 82 using the lane data. For example, the desired path can be represented by the polynomial equation:
(21)
where x is the longitudinal distance from the vehicle center, y is the lateral distance from the vehicle center, v.sub.x is the vehicle longitudinal speed, L is the lane width and T is the time of the path generation distance. The coefficients or parameters a.sub.1, a.sub.2, . . . , a.sub.5 are obtained from the lane geometry data measured by the lane sensing system, which is typically a forward looking camera.
(22) Once the desired vehicle path is determined, i.e., all of the parameters a.sub.1, a.sub.2, . . . , a.sub.5 in equation (1) are determined, the next step in the process is to determine the vehicle state predictions or vehicle motion along that path at the block 84. Particularly, based on the desired path obtained by equation (1), the future vehicle motion represented by the vehicle longitudinal speed v.sub.x, the vehicle lateral speed v.sub.y, the vehicle yaw rate w, the vehicle lateral acceleration a.sub.y, and the vehicle yaw acceleration {dot over (w)} can be calculated at each time step from the path as:
v.sub.y={dot over (y)}v.sub.x,(4)
where:
{dot over (y)}dy/dt=yv.sub.x.(5)
From the desired path:
y=5a.sub.5x.sup.4+4a.sub.4x.sup.3+3a.sub.3x.sup.2+2a.sub.2x+a.sub.1,(6)
a.sub.y=d.sup.2y/dt.sup.2=yv.sub.x.sup.2+ya.sub.x,(7)
y=20a.sub.5x.sup.3+12a.sub.4x.sup.2+6a.sub.3x+2a.sub.2,(8)
w=y,(9)
{dot over (w)}=d(y)/dt=yv.sub.x.(10)
(23) For the vehicle 52 to follow the desired path obtained by equation (1), the vehicle 52 should maintain the vehicle longitudinal speed v.sub.x, the vehicle lateral speed v.sub.y, the vehicle yaw rate w, the vehicle lateral acceleration a.sub.y, and the vehicle yaw acceleration {dot over (w)} obtained from equations (4), (7), (9) and (10), respectively.
(24) Once the future vehicle motion is determined at each time step based on the parameters referred to above, the algorithm then calculates the expected steering angle from the desired vehicle path and the vehicle dynamics at those time steps.
(25)
where m is the vehicle mass, I is vehicle inertia, C.sub.f and C.sub.r are front and rear cornering stiffness, respectively, a is the distance from the vehicle center to the front axle and b is the distance from the vehicle center to the rear axle.
(26) Once the steering angle is determined for each point in time, the steering torque associated with each steering angle to maintain the vehicle on the desired path needs to be determined to determine whether any of the torques exceed the maximum torque allowable by the lane keeping/lane centering system 34. The steering torque can be determined by any suitable technique known to those skilled in the art. For example, the following equations can be used to provide that calculation.
(27)
where the steering angle is measured by a sensor, .sub.driver is the driver's steering input torque that is assumed to be zero during the modeling process, .sub.EPS is a known EPS motor torque command, .sub.SAT is a steering self-aligning torque that can be estimated from a dynamic equation or empirical data set, discussed in detail below, n and m are the system orders and can be, for example, 2 and 3, respectively, z.sup.1 represents a one-step delay, z.sup.2 represents a two-step delay, etc. in the response of the steering system of the vehicle 52, and D is a pure time delay in the number of sample times.
(28) Depending on the accuracy of the model, the system orders n and m can be increased. The values c.sub.0, . . . , c.sub.n and d.sub.1, . . . , d.sub.m are unknown, where the object is to find the unknown parameters c.sub.0, . . . , c.sub.n and d.sub.1, . . . , d.sub.m in equation (12). In one embodiment, training methods employing an auto-regressive moving average model can be employed to obtain the unknown parameters during vehicle testing, as will be discussed below.
(29) Equation (12) models the steering system with a system delay and the history of the past steering angle and torque data. The model does not require prior knowledge of tire and steering dynamics. The parameters c.sub.0, . . . , c.sub.n and d.sub.1, . . . , d.sub.m are obtained during vehicle testing using measured steering angle and steering torque data, and then provided in tables during vehicle operation so that the steering torque can be calculated from equation (12) using the known steering angle . It is noted that equation (12) is one technique for determining the steering torque based on the steering angle . However, other techniques may be known in the art for determining the steering torque based on the steering angle that may be applicable to the invention discussed above.
(30)
(31) Once the lane centering system 34 is engaged, the algorithm captures the lane data required at box 112 to provide the lane centering and generates the desired vehicle path at box 114 as discussed above. The vehicle path is then predicted at box 116 and the vehicle motion is then determined at box 118 as discussed above at the block 84. The algorithm then calculates the steering angle from the predicted vehicle motion at box 120 in the manner discussed above at the block 86. The algorithm then obtains the steering dynamics at box 122 to calculate the steering torque based on the calculated steering angle and then calculates the steering torque at box 124. The algorithm calculates the steering angle and the steering torque for all of the sample times. The algorithm determines whether any of the steering torques exceed the predetermined maximum torque limit at decision diamond 126, and if not, does not issue a driver alert at box 128, but if any do exceed the limit, issues the driver alert at box 130.
(32) The need for determining the vehicle steering torque r based on the steering angle is a common problem in most automatic steering control situations. In known systems, the steering angle sensor 36 measures the steering wheel angle , but sensors are not available to directly measure the road wheel angle, and thus road wheel angles are typically estimated by a steering model. Known steering models that can be used to convert the vehicle steering angle to the vehicle steering torque , such as Paceka's steering model, shown by equations (14)-(17) below, where variables in these equations can be found in
(33)
(34) Equation (12) can be used for these applications other than the driver alert process discussed above. Equation (12) provides a generalized high order steering model that can provide more accuracy and performance with limited computing power. If high accuracy is not required, then equation (12) can reduce the complexity for faster operation. As will be discussed in further detail below, equation (12) provides a balance and accuracy in computing power.
(35)
(36)
and where K.sub.1, K.sub.2, and K.sub.3 are known constants from tire characteristics as a function of front and rear tire stiffness C.sub.f and C.sub.r, m is vehicle mass, w is the vehicle yaw rate, L.sub.p is pneumatic trail, and L.sub.m is mechanical trail. All of these parameters are known and considered constant for small slip angle as employed in lane centering/lane keeping systems. The mechanical trail L.sub.m is purely a function of steering geometry and can be determined from the road wheel caster angle.
(37) Determining the self-aligning torque .sub.SAT using an empirical data set can be performed as follows. The empirical based estimation technique uses pre-collected data sets and models the torque .sub.SAT as a two-dimensional look-up table, .sub.SAT=f(speed, steering angle). To estimate the torque .sub.SAT from the empirical data, a vehicle is driven with a known initial steering angle, such as 10, 20, 30, etc., and pre-specified vehicle speed, such as 10 mph, 20 mph, 30 mph, etc. Next, a steering torque is applied to the vehicle steering system and the steering torque is increased until the steering wheel 12 goes to a steady state. The steering torque that keeps the steering wheel 12 at the initial steering angle is the self-aligning torque .sub.SAT. Note that current steering systems have a capacity to generate a steering torque from a computer command. The above steps are repeated at various steering wheel angles and vehicle speeds, and a complete look-up table is populated.
(38) At box 164, an off-line steering model is employed to provide an angle to torque estimation, where the model orders n and m are selected for the particular application. The off-line steering model can be equation (12) rewritten as:
(39)
where k is the current time step and k1 is the previous time step.
(40) The pure time delay D in equation (22) can be found by a separate test procedure, such as by a step response test, i.e., send a step torque command to the steering system and measure the time difference between the time that the torque command was sent and the time that the steering system starts moving.
(41) The algorithm then applies known steering torque commands and measures the steering angle at each time step, such as every 10 ms. For the example where m=3 and n=2, the process collects at least five data sets to solve for the parameters c.sub.0, c.sub.1, c.sub.2, d.sub.1 and d.sub.2. The algorithm then applies a least-square method to solve equation (22) to obtain these parameters.
(42) The algorithm then considers speed variations in the off-line model at box 166. Steering dynamics vary depending on the vehicle speed. For improved accuracy in the torque conversion, three speed variations are offered for the steering model including low speed L, medium speed M and high speed H. Equation (12) is rewritten below for each of these speeds. The variables c.sub.0, . . . , c.sub.n and d.sub.1, . . . , d.sub.m are determined for each speed as above.
(43)
(44) The pure time delay D is not a function of the vehicle speed, and will remain the same in all speed variations.
(45)
(46) Returning to
.sup.T(k)=[(k1)(k2) . . . (km)(kD1) . . . (kDn)](26)
{circumflex over ()}.sup.T(k)=[d.sub.1 . . . d.sub.mc.sub.0 . . . c.sub.n].(27)
(47) As above, the steering and torque values (k), (k1), . . . , (kD), (kD1), . . . are measured data and the parameters c.sub.0, . . . , c.sub.n and d.sub.1, . . . , d.sub.m are calculated using the least-square process. The angle {circumflex over ()}(k1) is the parameter set that is solved at the previous time step. This parameter set will be updated to the angle {circumflex over ()}(k) with the new measured data set (k). The updated equation is given by:
(48)
where is a forgetting factor set between 0 to 1 and is tunable.
(49) The process applies the updated equation for all speed variation steering models (low, medium, and high speed) during operation of the vehicle.
(50) As will be well understood by those skilled in the art, the several and various steps and processes discussed herein to describe the invention may be referring to operations performed by a computer, a processor or other electronic calculating device that manipulate and/or transform data using electrical phenomenon. Those computers and electronic devices may employ various volatile and/or non-volatile memories including non-transitory computer-readable medium with an executable program stored thereon including various code or executable instructions able to be performed by the computer or processor, where the memory and/or computer-readable medium may include all forms and types of memory and other computer-readable media.
(51) The foregoing discussion discloses and describes merely exemplary embodiments of the present invention. One skilled in the art will readily recognize from such discussion and from the accompanying drawings and claims that various changes, modifications and variations can be made therein without departing from the spirit and scope of the invention as defined in the following claims.