METHOD AND DEVICE FOR LATE-TIME INTERFERENCE DETECTION FOR VEHICLES, COMPUTER-READY STORAGE MEDIUM
Patent Information
- Authority / Receiving Office
- DE · DE
- Patent Type
- Patents
- Current Assignee / Owner
- ROBERT BOSCH GMBH
- Filing Date
- 2024-09-16
- Publication Date
- 2026-07-08
AI Technical Summary
Current autonomous driving systems lack accurate and reliable means to detect lateral interference, such as crosswinds or poor road conditions, which can cause vehicles to deviate from lanes, posing safety risks.
A method and apparatus for real-time lateral interference detection using existing sensors in ADAS systems, pre-calibrating the relationship between vehicle speed, steering torque, and yaw rate to estimate and compare actual vs. estimated yaw rates or steering torques, issuing warnings or taking control measures when thresholds are exceeded.
Provides accurate and reliable detection of lateral interference, enabling timely driver intervention to prevent lane deviations and potential hazards, without requiring additional components.
Description
Technical Field
[0001] This invention relates to a method for real-time lateral interference detection for vehicles equipped with driver assistance systems. Specifically, this invention involves a method for real-time lateral interference detection in vehicles equipped with Advanced Driver Assistance Systems (ADAS). The present invention also involves an apparatus for performing the method of real-time lateral interference detection in vehicles with driver assistance systems, as well as a vehicle comprising such an apparatus. Additionally, the present invention involves a computer-readable storage medium containing a computer program that implements the method of real-time lateral interference detection in vehicles with driver assistance systems.Background Art
[0002] With the advancement of science and technology, the driver assistance / autonomous driving functions of vehicles are becoming increasingly powerful. Currently, the automotive industry generally classifies autonomous driving functions into levels L1-L5. For the currently achievable levels L2, L3, and L4, the vehicle's autonomous driving system needs to control the vehicle's lateral dynamic motion. However, if the driving conditions are extremely adverse, the autonomous driving system may not be able to control the vehicle's lateral dynamic motion, and at this point, the driver needs to take over control of the vehicle.
[0003] Specifically, during the driver assistance / autonomous driving (DA / AD) period of the autonomous driving system, there may be significant lateral interference with the vehicle's lateral control, such as poor road conditions or strong crosswinds. In such cases, if the driver does not intervene, the vehicle may be significantly affected and deviate from the lane, posing potential dangers.
[0004] Currently, there are no means to detect the lateral interference experienced by the vehicle. Weather forecasts are considered the only method to detect crosswinds. However, this method is very crude and cannot guarantee accuracy and reliability. Moreover, crosswinds are just one of the factors that can cause lateral interference. Other factors, such as poor road conditions during rain or snow, can also cause lateral interference. These lateral interferences severely affect the usability of the autonomous driving system.
[0005] US 2021 / 197812 A1 discloses an autonomous vehicle configured to request takeover by the driver in critical driving conditions.
[0006] Although existing lane departure monitoring can somewhat prevent danger, once an alert is issued due to lane departure, it usually indicates a severe incident, and the vehicle will rapidly deviate from the lane. If the driver cannot take over control of the vehicle in time, it is highly likely that a dangerous situation will occur. Therefore, detecting the lateral interference experienced by the vehicle as early as possible before it deviates from the lane can better prevent danger.Summary of the Invention
[0007] Given the aforementioned issues, the present invention aims to provide a method and apparatus for lateral interference detection in a vehicle equipped with a driver assistance system. The present invention is intended to offer relatively accurate and reliable information regarding whether the vehicle is experiencing lateral interference to the autonomous driving system, thereby promptly alerting the driver to take over control of the vehicle, and thus better avoiding potential hazards.
[0008] According to one aspect of the present invention, a method for real-time lateral interference detection in a vehicle equipped with a driver assistance system is provided, the method comprising pre-calibrating a desired yaw rate induced by a steering torque applied by the vehicle's Electric Power Steering (EPS) at different vehicle speeds to obtain the relationship between the desired yaw rate and the vehicle speed and the steering torque applied by the EPS, and the method at least comprising the following steps: obtaining the vehicle speed v at time t and the steering torque T EPS applied by the EPS at time t; calculating the estimated yaw rate W EPS of the vehicle at time t based on the obtained vehicle speed v at time t, the steering torque T EPS at time t, and the relationship between the desired yaw rate and the vehicle speed and the steering torque applied by the EPS; obtaining the actual yaw rate W s of the vehicle at time t+Δt, where Δt represents a preset time delay for the yaw rate to be generated after the EPS applies the torque; comparing the estimated yaw rate W EPS with the actual yaw rate W s , and if the absolute value of the difference between the estimated yaw rate W EPS and the actual yaw rate W s is greater than a threshold W th , determining that the lateral interference experienced by the vehicle has reached a preset level requiring the driver to take over vehicle control.
[0009] According to another aspect of the present invention, a method for real-time lateral interference detection in a vehicle equipped with a driver assistance system is provided, the method comprising pre-calibrating a desired yaw rate induced by a steering torque applied by the vehicle's Electric Power Steering (EPS) at different vehicle speeds to obtain the relationship between the desired yaw rate and the vehicle speed and the steering torque applied by the EPS, and the method at least comprising the following steps: obtaining the actual steering torque T EPS applied by the EPS at time t; obtaining the vehicle speed v at time t+Δt and the actual yaw rate W s at time t+Δt, where Δt represents a preset time delay for the yaw rate to be generated after the EPS applies the torque; calculating the estimated steering torque T EXP applied by the EPS at time t based on the vehicle speed v at time t+Δt, the actual yaw rate W s at time t+Δt, and the relationship between the desired yaw rate and the vehicle speed and the steering torque applied by the EPS; and comparing the estimated steering torque T EXP with the actual steering torque T EPS , and if the absolute value of the difference between the estimated steering torque T EXP and the actual steering torque T EPS is greater than a threshold T th , determining that the lateral interference experienced by the vehicle has reached a preset level requiring the driver to take over vehicle control.
[0010] According to another aspect of the present invention, an apparatus for real-time lateral interference detection in a vehicle equipped with a driver assistance system is provided, comprising: a storage module configured to pre-store the relationship between the vehicle speed and a steering torque applied by the Electric Power Steering (EPS) and the desired yaw rate induced by the steering torque; an obtaining module configured to obtain the vehicle speed v at time t, the steering torque T EPS applied by the EPS at time t, and the actual yaw rate W s of the vehicle at time t+Δt, where Δt represents a preset time delay for the yaw rate to be generated after the EPS applies the torque; a calculating module configured to calculate the estimated yaw rate W EPS of the vehicle at time t based on the obtained vehicle speed v at time t, the steering torque T EPS at time t, and the relationship between the desired yaw rate and the vehicle speed and the steering torque applied by the EPS; a decision module configured to compare the estimated yaw rate W EPS with the actual yaw rate W s , and if the absolute value of the difference between the estimated yaw rate W EPS and the actual yaw rate W s is greater than a threshold W th , determining that the lateral interference experienced by the vehicle has reached a preset level requiring the driver to take over vehicle control.
[0011] According to another aspect of the present invention, an apparatus for real-time lateral interference detection in a vehicle equipped with a driver assistance system is provided, comprising: a storage module configured to pre-store the relationship between the vehicle speed and a steering torque applied by the Electric Power Steering (EPS) and the desired yaw rate induced by the steering torque; an obtaining module configured to obtain the actual steering torque T EPS applied by the EPS at time t, the vehicle speed v at time t+Δt, and the actual yaw rate W s at time t+Δt, where Δt represents a preset time delay for the yaw rate to be generated after the EPS applies the torque; a calculating module configured to calculate the estimated steering torque T EXP applied by the EPS at time t based on the vehicle speed v at time t+Δt, the actual yaw rate W s at time t+Δt, and the relationship between the desired yaw rate and the vehicle speed and the steering torque applied by the EPS; and a decision module configured to compare the estimated steering torque T EXP with the actual steering torque T EPS , and if the absolute value of the difference between the estimated steering torque T EXP and the actual steering torque T EPS is greater than a threshold T th , determine that the lateral interference experienced by the vehicle has reached a preset level requiring the driver to take over vehicle control.
[0012] According to another aspect of the present invention, a computer-readable storage medium is provided, on which a computer program is stored. When the computer program is executed by a processor, it implements a method for real-time lateral interference detection for a vehicle equipped with a driver assistance system according to the present invention.
[0013] The lateral interference detection method and apparatus of the present invention can provide relatively accurate and reliable information regarding whether the vehicle is experiencing lateral interference to an autonomous driving system. Furthermore, the technical solution of the present invention is based on existing sensors in the ADAS system and generally does not require the additional installation of other components. Therefore, the present invention can achieve lateral interference detection for an autonomous driving system at a relatively low cost.Description of Accompanying Drawings
[0014] In the following, examples of the present disclosure will be described in more detail with reference to the accompanying drawings, wherein: FIG. 1 exemplarily illustrates a flowchart of a real-time lateral interference detection method according to one example of the present disclosure. FIG. 2 exemplarily illustrates a flowchart of a real-time lateral interference detection method according to another example of the present disclosure.
[0015] Other objectives and features of the examples herein will become apparent from the detailed description provided below in conjunction with the accompanying drawings. However, it should be understood that the drawings are designed merely for illustrative purposes and are not intended to limit the scope of the present disclosure.Specific Embodiments
[0016] The vehicle in the present disclosure is equipped with a driver assistance system, particularly an Advanced Driver Assistance System (ADAS). The vehicle is at least equipped with a yaw rate sensor, a steering torque sensor, and a vehicle speed sensor, and these sensors can be located at any suitable position within the vehicle. Although not mentioned herein, other sensors besides the aforementioned ones may also be possible if needed.
[0017] The principles of the real-time lateral interference detection method of the present disclosure are described in detail below. 1) In the absence of lateral interference, the vehicle's yaw rate (W EPS ) induced by Electric Power Steering (EPS) is a function of the vehicle speed v and the steering torque T EPS applied by the EPS, as represented by the following formula (1): W EPS = f v , T EPS where W EPS represents the yaw rate induced by the EPS; v represents the vehicle speed; T EPS represents the steering torque applied by the EPS. Therefore, if the vehicle speed remains constant, the vehicle's yaw rate is solely related to the steering torque of the EPS. 2) In the presence of lateral interference, there can be two scenarios: 2.1) The vehicle experiences lateral interference without the EPS applying steering torque: In this case, the vehicle only has a yaw rate induced by the lateral interference and no steering torque applied by the EPS. In such a case, in the prior art, the EPS is only activated to apply active steering torque to the vehicle when the vehicle deviates from the lane and the ADAS system attempts to control the vehicle to return it to the lane. 2.2) The vehicle experiences lateral interference while the EPS is applying steering torque: In this case, the vehicle's yaw rate includes both the yaw rate induced by the lateral interference and the yaw rate induced by the steering torque applied by the EPS.
[0018] The real-time lateral interference detection scheme of the present disclosure is described in detail below. a) The desired yaw rate induced by the steering torque applied by the EPS at different vehicle speeds is pre-calibrated. The calibration process is preferably conducted during the vehicle's R&D phase or before the vehicle leaves the factory. The desired calibration results can be tabulated to show the relationship between the desired yaw rate, vehicle speed, and the steering torque applied by the EPS. An exemplary table is as follows: Table 1 Yaw Rate Calibration Table V1V2V3......VnT1W11W12W13......W1nT2W21W22W23......W2n......TmWm1Wm2Wm3......Wmn where W11 represents the desired yaw rate when the vehicle speed is V1 and the torque applied by the EPS is T1. Similarly, Wmn is the desired yaw rate when the vehicle speed is Vn and the torque applied by the EPS is Tm. Of course, it is also possible to calibrate the desired yaw rate induced by the EPS at different vehicle speeds after the vehicle is manufactured. b) During vehicle operation: i) The torque applied by the EPS T EPS is detected by the torque sensor of the EPS; ii) The vehicle speed v is obtained by the vehicle speed sensor. iii) The actual yaw rate of the vehicle W s is detected by the yaw rate sensor. The estimated yaw rate WEPS is calculated based on the torque TEPS detected by the torque sensor of the EPS, the vehicle speed v obtained by the vehicle speed sensor, and Table 1. Preferably, the estimated yaw rate WEPS is calculated by interpolation, although other methods such as fitting methods are also possible. c) The calculated estimated yaw rate WEPS is compared with the actual yaw rate Ws detected by the yaw rate sensor. If the difference between the two exceeds the threshold Wth, it can be considered that the lateral interference experienced by the vehicle has reached a level requiring the driver to take over vehicle control. The above comparison can be represented by the following inequality:WEPS−Ws>Wth where the threshold Wth can be set based on experience and the level of vehicle autonomous driving safety. d) When the EPS applies steering torque, the corresponding yaw rate WEPS may occur after a very short time. Therefore, when making the above comparison, it is preferable to consider the time delay (Δt), so the above inequality (2) is adjusted to the following inequality: WEPSt−WSt+Δt>Wth where t represents time; Δt represents the time delay, which can be preset based on experience or experiments. In other words, if the absolute value of the estimated yaw rate WEPS calculated from the torque TEPS detected by the torque sensor of the EPS at time t and the vehicle speed v obtained by the vehicle speed sensor at time t minus the actual yaw rate Ws detected by the yaw rate sensor at time t+Δt is greater than the threshold, it can be considered that the lateral interference experienced by the vehicle has reached a level requiring the driver to take over vehicle control. e) This scheme can also be implemented using different formulas, for example, by the following formulas. i) Based on Table 1, using the vehicle speed v and the actual yaw rate W s , the estimated steering torque T EXP applied by the EPS is calculated, preferably by interpolation. ii) The calculated estimated steering torque T EXP is compared with the actual steering torque T EPS detected by the torque sensor of the EPS. If the following inequality is satisfied, it can be considered that the lateral interference experienced by the vehicle has reached a level requiring the driver to take over vehicle control. T EPS − T EXP > T th
[0019] As mentioned above, when making the above comparison, considering the time delay (Δt) between the steering torque T EPS applied by the EPS and the vehicle's yaw rate, the above formula (4) is expressed as the following formula: T EXP t − T EPS t − Δt > T th where t represents time; Δt represents the time delay for the yaw rate to be generated after the EPS applies the torque, which can be preset based on experience or experiments.
[0020] In other words, if the absolute value of the estimated torque T EXP calculated from the vehicle speed v obtained by the vehicle speed sensor at time t and the actual yaw rate W s detected by the yaw rate sensor at time t minus the actual torque T EPS detected by the torque sensor of the EPS at time t-Δt is greater than the threshold, it can be considered that the lateral interference experienced by the vehicle has reached a level requiring the driver to take over vehicle control.
[0021] Of course, in cases where the vehicle speed is relatively high and does not change significantly, the effect of the time delay (Δt) can be ignored. For example, when the vehicle speed is higher than a predetermined value and the acceleration / deceleration is lower than a preset value, the effect of the time delay (Δt) can be ignored. That is, the above formula (5) can be replaced by the following formula. T EXP t − T EPS t > T th
[0022] The steps of the method according to the present disclosure are illustratively described below with reference to the accompanying drawings.
[0023] FIG. 1 illustrates a flowchart of a real-time lateral interference detection method according to one example of the present disclosure.
[0024] In step S100, lateral interference detection begins.
[0025] In step S110, the actual steering torque T EPS applied by the Electric Power Steering (EPS) at time t is detected by the vehicle's torque sensor, and the vehicle speed v at time t is obtained by the vehicle's speed sensor.
[0026] In step S120, the estimated yaw rate W EPS is calculated using the actual steering torque T EPS at time t, the vehicle speed v at time t, and Table 1 through interpolation.
[0027] In step S130, the actual yaw rate W s at time t+Δt is detected by the yaw rate sensor.
[0028] In step S140, the estimated yaw rate W EPS calculated in step S120 is compared with the actual yaw rate W s detected in step S130. If the absolute value of the difference between the estimated yaw rate W EPS and the actual yaw rate W s is less than the threshold W th , the process returns to step S100. If the absolute value of the difference between the estimated yaw rate W EPS and the actual yaw rate W s is greater than the threshold W th , the process advances to step S150.
[0029] In step S150, it is determined that the lateral interference experienced by the vehicle has reached a level requiring the driver to take over vehicle control, and preferably, a warning signal is issued. Preferably, the warning signal includes voice signals, steering wheel vibrations, cursor flashing on the display, etc. Optionally, if the driver does not take over vehicle control after a certain period of alerting, the vehicle may take measures such as automatic deceleration or automatic braking to minimize the risk of an accident.
[0030] Below, a flowchart of a real-time lateral interference detection method according to another example of the present invention is illustratively described in conjunction with FIG. 2.
[0031] In step S200, lateral interference detection begins.
[0032] In step S210, the actual steering torque T EPS applied by the EPS at time t is detected by the torque sensor.
[0033] In step S220, the vehicle speed v at time t+Δt is obtained by the vehicle's speed sensor, and the actual yaw rate W s at time t+Δt is detected by the yaw rate sensor.
[0034] In step S230, the estimated steering torque T EXP at time t applied by the EPS is calculated through interpolation using the vehicle speed v at time t+Δt and the actual yaw rate W s at time t+Δt. The reason for calculating the estimated steering torque T EXP at time t using the vehicle speed v at time t+Δt and the actual yaw rate W s at time t+Δt through interpolation is to account for the time delay Δt between the steering torque applied by the EPS and the vehicle's yaw rate.
[0035] In step S240, the estimated steering torque T EXP at time t calculated in step S230 is compared with the actual steering torque T EPS at time t detected in step S210. If the absolute value of the difference between the actual steering torque T EPS and the estimated steering torque T EXP is less than the threshold T th , the process returns to step S200. If the absolute value of the difference between the actual steering torque T EPS and the estimated steering torque T EXP is greater than the threshold T th , the process advances to step S250.
[0036] In step S250, it is determined that the lateral interference experienced by the vehicle has reached a level requiring the driver to take over vehicle control, and preferably, a warning signal is issued. Preferably, the warning signal includes voice signals, steering wheel vibrations, cursor flashing on the display, etc. Optionally, if the driver does not take over vehicle control after a certain period of alerting, the vehicle may take measures such as automatic deceleration or automatic braking to minimize the risk of an accident.
[0037] In the above examples, when the vehicle speed is higher than a predetermined value and the acceleration or deceleration is lower than a preset value, the effect of the time delay Δt can be ignored, i.e., Δt can be considered equal to 0.
[0038] Furthermore, the steps of the above method are not necessarily in chronological order. For example, in the first example, step S130 can be performed in parallel with step S110, and when ignoring the effect of the time delay Δt, i.e., assuming Δt equals 0, step S130 can be performed simultaneously with step S110. Similarly, steps S210 and S220 in the second example can also be performed in parallel.
[0039] Therefore, although the features of the examples have been shown and described herein, it is understood that those skilled in the art can make various omissions, substitutions, and changes in the form and details of the methods shown and their operations, and the sequence of the steps of the above methods is merely exemplary. Adjustments to the steps of the method of the present invention are possible within the scope defined by the appended claims.
Claims
1. A method for real-time lateral interference detection in a vehicle equipped with a driver assistance system, the method comprising pre-calibrating a desired yaw rate induced by a steering torque applied by the vehicle's Electric Power Steering (EPS) at different vehicle speeds to obtain the relationship between the desired yaw rate and the vehicle speed and the steering torque applied by the EPS, and the method at least comprising the following steps: obtaining the vehicle speed v at time t and the steering torque TEPS applied by the EPS at time t; calculating the estimated yaw rate WEPS of the vehicle at time t based on the obtained vehicle speed v at time t, the steering torque TEPS at time t, and the relationship between the desired yaw rate and the vehicle speed and the steering torque applied by the EPS; obtaining the actual yaw rate Ws of the vehicle at time t+Δt, where Δt represents a preset time delay for the yaw rate to be generated after the EPS applies the torque; comparing the estimated yaw rate WEPS with the actual yaw rate Ws, and if the absolute value of the difference between the estimated yaw rate WEPS and the actual yaw rate Ws is greater than a threshold Wth, determining that the lateral interference experienced by the vehicle has reached a preset level requiring the driver to take over vehicle control.
2. A method for real-time lateral interference detection in a vehicle equipped with a driver assistance system, the method comprising pre-calibrating a desired yaw rate induced by a steering torque applied by the vehicle's Electric Power Steering (EPS) at different vehicle speeds to obtain the relationship between the desired yaw rate and the vehicle speed and the steering torque applied by the EPS, and the method at least comprising the following steps: obtaining the actual steering torque TEPS applied by the EPS at time t; obtaining the vehicle speed v at time t+Δt and the actual yaw rate Ws at time t+Δt, where Δt represents a preset time delay for the yaw rate to be generated after the EPS applies the torque; calculating the estimated steering torque TEXP applied by the EPS at time t based on the vehicle speed v at time t+Δt, the actual yaw rate Ws at time t+Δt, and the relationship between the desired yaw rate and the vehicle speed and the steering torque applied by the EPS; and comparing the estimated steering torque TEXP with the actual steering torque TEPS, and if the absolute value of the difference between the estimated steering torque TEXP and the actual steering torque TEPS is greater than a threshold Tth, determining that the lateral interference experienced by the vehicle has reached a preset level requiring the driver to take over vehicle control.
3. The method according to Claim 1 or 2, characterized in that: the relationship between the desired yaw rate and the vehicle speed and the steering torque applied by the EPS is tabulated.
4. The method according to Claim 1 or 2, characterized in that: the calculation is performed using an interpolation method.
5. The method according to Claim 1 or 2, characterized in that: when the vehicle speed is higher than a predetermined value and the acceleration or deceleration is lower than a preset value, Δt equals 0.
6. The method according to Claim 1 or 2, characterized in that: the driver is alerted to take over vehicle control through voice signals, steering wheel vibrations, or cursor flashing on a display.
7. The method according to Claim 6, characterized in that: if the driver does not take over vehicle control within a preset time after being alerted, the vehicle can perform automatic deceleration or automatic braking.
8. An apparatus for real-time lateral interference detection in a vehicle equipped with a driver assistance system, comprising: a storage module configured to pre-store the relationship between the vehicle speed and a steering torque applied by the Electric Power Steering (EPS) and the desired yaw rate induced by the steering torque; an obtaining module configured to obtain the vehicle speed v at time t, the steering torque TEPS applied by the EPS at time t, and the actual yaw rate Ws of the vehicle at time t+Δt, where Δt represents a preset time delay for the yaw rate to be generated after the EPS applies the torque; a calculating module configured to calculate the estimated yaw rate WEPS of the vehicle at time t based on the obtained vehicle speed v at time t, the steering torque TEPS at time t, and the relationship between the desired yaw rate and the vehicle speed and the steering torque applied by the EPS; a decision module configured to compare the estimated yaw rate WEPS with the actual yaw rate Ws, and if the absolute value of the difference between the estimated yaw rate WEPS and the actual yaw rate Ws is greater than a threshold Wth, determining that the lateral interference experienced by the vehicle has reached a preset level requiring the driver to take over vehicle control.
9. An apparatus for real-time lateral interference detection in a vehicle equipped with a driver assistance system, comprising: a storage module configured to pre-store the relationship between the vehicle speed and a steering torque applied by the Electric Power Steering (EPS) and the desired yaw rate induced by the steering torque; an obtaining module configured to obtain the actual steering torque TEPS applied by the EPS at time t, the vehicle speed v at time t+Δt, and the actual yaw rate Ws at time t+Δt, where Δt represents a preset time delay for the yaw rate to be generated after the EPS applies the torque; a calculating module configured to calculate the estimated steering torque TEXP applied by the EPS at time t based on the vehicle speed v at time t+Δt, the actual yaw rate Ws at time t+Δt, and the relationship between the desired yaw rate and the vehicle speed and the steering torque applied by the EPS; and a decision module configured to compare the estimated steering torque TEXP with the actual steering torque TEPS, and if the absolute value of the difference between the estimated steering torque TEXP and the actual steering torque TEPS is greater than a threshold Tth, determine that the lateral interference experienced by the vehicle has reached a preset level requiring the driver to take over vehicle control.
10. A computer-readable storage medium storing a computer program, which when executed by a processor, implements the method according to any one of Claims 1-7.