ACTIVE SAFETY ASSISTANCE SYSTEM FOR PRE-ADJUSTING SPEED AND CONTROL METHOD USING THE SAME
20210179092 · 2021-06-17
Inventors
- YING-REN CHEN (LUGANG, TW)
- SHUN-YOU LIN (LUGANG, TW)
- SIANG-MIN SIAO (LUGANG, TW)
- LI-YOU HSU (LUGANG, TW)
Cpc classification
B60W30/0956
PERFORMING OPERATIONS; TRANSPORTING
B60W2554/4045
PERFORMING OPERATIONS; TRANSPORTING
B60W10/18
PERFORMING OPERATIONS; TRANSPORTING
G08G1/166
PHYSICS
B60W30/18163
PERFORMING OPERATIONS; TRANSPORTING
B60W30/09
PERFORMING OPERATIONS; TRANSPORTING
B60W30/16
PERFORMING OPERATIONS; TRANSPORTING
B60W10/04
PERFORMING OPERATIONS; TRANSPORTING
G08G1/167
PHYSICS
B60W2554/804
PERFORMING OPERATIONS; TRANSPORTING
B60W10/20
PERFORMING OPERATIONS; TRANSPORTING
International classification
B60W30/09
PERFORMING OPERATIONS; TRANSPORTING
B60W10/04
PERFORMING OPERATIONS; TRANSPORTING
B60W10/18
PERFORMING OPERATIONS; TRANSPORTING
B60W10/20
PERFORMING OPERATIONS; TRANSPORTING
B60W30/095
PERFORMING OPERATIONS; TRANSPORTING
Abstract
An active safety assistance system for pre-adjusting speed and a control method using the same detect whether there is one other vehicle around a host vehicle. The trajectory of the other vehicle neighboring the host vehicle is estimated when the other vehicle exists. After fitting the other-vehicle trajectory to a lane to determine the intention of the other vehicle, the method determines whether the other vehicle is used as a target vehicle that influences the movement of the host vehicle and calculates a control parameter according to the fitted result and the intention of the other vehicle. The method calculates a target speed and a steering-wheel angle of the host vehicle and controls a steering wheel, a throttle pedal and a brake force of the host vehicle according to the trajectory, the control parameter, and the target speed of the host vehicle.
Claims
1. An active safety assistance system for pre-adjusting speed, installed on an on-board system of a host vehicle, comprising: an other-vehicle trajectory estimation module configured to calculate a deviation amount of the host vehicle with respect to a lane center according to a plurality of environment-sensing data and estimate an other-vehicle trajectory of at least one other vehicle when the other-vehicle trajectory estimation module detects the at least one other vehicle around the host vehicle; an intention-analyzing module coupled to the other-vehicle trajectory estimation module and configured to fit the other-vehicle trajectory to at least one lane to determine that the at least one other vehicle intends to advance in a same lane, turn in a same lane or switch over to another lane, fit the other-vehicle trajectory to a dynamic trajectory of the host vehicle to generate a fitted result, and determine whether the at least one other vehicle is used as at least one target vehicle that influences movement of the host vehicle according to the fitted result and an intention of the at least one other vehicle, and the intention-analyzing module calculates at least one control parameter for fixing distance, fixing speed, or pre-adjusting speed of the host vehicle when the at least one target vehicle exists; a speed pre-adjusting module coupled to the intention-analyzing module and configured to receive the at least one control parameter and use the at least one control parameter to cooperate with the deviation amount, a speed, a lateral acceleration, and a plurality of state data of the host vehicle to calculate a target speed of the host vehicle; and a target-following decision-making module coupled to the intention-analyzing module and the speed pre-adjusting module and configured to make decisions for a steering wheel, a throttle pedal and a brake force of the host vehicle according to an intention of the at least one target vehicle, the dynamic trajectory, the at least one control parameter, and the target speed.
2. The active safety assistance system for pre-adjusting speed according to claim 1, wherein the at least one other vehicle comprises a front vehicle and neighboring vehicles in left and right lanes.
3. The active safety assistance system for pre-adjusting speed according to claim 1, wherein the plurality of environment-sensing data comprise a vehicle-width recognition result, longitudinal and lateral relative speeds, and a relative distance of the at least one other vehicle, moving-state information of the host vehicle, a lane line-detecting result, and a lane-line model.
4. The active safety assistance system for pre-adjusting speed according to claim 3, wherein the other-vehicle trajectory estimation module substitutes the plurality of environment-sensing data into a four-dimensional Euclidean coordinate transforming formula, combines time and space, and uses a representative formula of
5. The active safety assistance system for pre-adjusting speed according to claim 3, wherein the other-vehicle trajectory estimation module combines time and space to generate a combined result, and the intention-analyzing module uses the combined result to determine that the at least one other vehicle drives at an inside of a lane where the host vehicle presently drives, left of an outside of a lane where the host vehicle presently drives, or right of an outside of a lane where the host vehicle presently drives, thereby performing a lane-fitting process.
6. The active safety assistance system for pre-adjusting speed according to claim 1, wherein the plurality of state data comprise a vehicle-following distance that the host vehicle follows the at least one other vehicle, an average speed of vehicles driving in neighboring lanes, and a road curvature, the speed pre-adjusting module determines whether a distance between the host vehicle and the at least one other vehicle is within a safe range to adjust the speed of the host vehicle and obtain the target speed according to the vehicle-following distance, the average speed of vehicles driving in neighboring lanes, the road curvature, the speed and the lateral acceleration of the host vehicle, and the intention of the at least one other vehicle determined by the intention-analyzing module, and the speed pre-adjusting module calculates a comfortable speed as the target speed when there is no vehicle around the host vehicle.
7. The active safety assistance system for pre-adjusting speed according to claim 1, wherein the target-following decision-making module comprises a lateral integrated decision-making module, a longitudinal integrated decision-making module, and a vehicle movement-limiting module, the lateral integrated decision-making module is configured to control the steering wheel, and the longitudinal integrated decision-making module is configured to control the throttle pedal and the brake force.
8. The active safety assistance system for pre-adjusting speed according to claim 7, wherein the lateral integrated decision-making module is configured to determine whether a lane line of the at least one lane exists, the lateral integrated decision-making module makes a decision for the host vehicle following a front vehicle or advancing along the lane line according to a result for detecting the front vehicle and makes a decision for the host vehicle driving at a center of the at least one lane when the lane line of the at least one lane exists, and the lateral integrated decision-making module makes a decision for the host vehicle following the front vehicle when the lateral integrated decision-making module fails to detect the lane line.
9. The active safety assistance system for pre-adjusting speed according to claim 7, wherein the longitudinal integrated decision-making module is configured to calculate a distance to collision and time to collision for the host vehicle and the at least one other vehicle, thereby making a decision for braking, accelerating, or decelerating.
10. The active safety assistance system for pre-adjusting speed according to claim 7, wherein the vehicle movement-limiting module is configured to calculate a vehicle speed for longitudinal limitation and a steering-wheel angle for lateral limitation according to decisions made by the lateral integrated decision-making module and the longitudinal integrated decision-making module.
11. A control method using an active safety assistance system for pre-adjusting speed, which is applied to an on-board system of a host vehicle, and when the control method detects at least one other vehicle around the host vehicle, the control method comprising: using an other-vehicle trajectory estimation module to calculate a deviation amount of the host vehicle with respect to a lane center according to a plurality of environment-sensing data and estimate an other-vehicle trajectory of the at least one other vehicle; using an intention-analyzing module to fit the other-vehicle trajectory to at least one lane to determine that the at least one other vehicle intends to advance in a same lane, turn in a same lane or switch over to another lane, fit the other-vehicle trajectory to a dynamic trajectory of the host vehicle to generate a fitted result, and determine whether the at least one other vehicle is used as at least one target vehicle that influences movement of the host vehicle according to the fitted result and an intention of the at least one other vehicle, and using the intention-analyzing module to calculate at least one control parameter for fixing distance, fixing speed, or pre-adjusting speed of the host vehicle when the at least one target vehicle exists; using a speed pre-adjusting module to receive the at least one control parameter and use the at least one control parameter to cooperate with the deviation amount, a speed, a lateral acceleration, and a plurality of state data of the host vehicle to calculate a target speed of the host vehicle; and using a target-following decision-making module to make decisions for a steering wheel, a throttle pedal and a brake force of the host vehicle according to an intention of the at least one target vehicle, the dynamic trajectory, the at least one control parameter, and the target speed.
12. The control method according to claim 11, wherein the at least one other vehicle comprises a front vehicle and neighboring vehicles in left and right lanes.
13. The control method according to claim 11, wherein the plurality of environment-sensing data comprise a vehicle-width recognition result, longitudinal and lateral relative speeds, and a relative distance of the at least one other vehicle, moving-state information of the host vehicle, a lane line-detecting result, and a lane-line model.
14. The control method according to claim 13, wherein the other-vehicle trajectory estimation module substitutes the plurality of environment-sensing data into a four-dimensional Euclidean coordinate transforming formula, combines time and space, and uses a representative formula of
15. The control method according to claim 13, wherein the other-vehicle trajectory estimation module combines time and space to generate a combined result, and the intention-analyzing module uses the combined result to determine that the at least one other vehicle drives at an inside of a lane where the host vehicle presently drives, left of an outside of a lane where the host vehicle presently drives, or right of an outside of a lane where the host vehicle presently drives, thereby performing a lane-fitting process.
16. The control method according to claim 11, wherein the plurality of state data comprise a vehicle-following distance that the host vehicle follows the at least one other vehicle, an average speed of vehicles driving in neighboring lanes, and a road curvature, the speed pre-adjusting module determines whether a distance between the host vehicle and the at least one other vehicle is within a safe range to adjust the speed of the host vehicle and obtain the target speed according to the vehicle-following distance, the average speed of vehicles driving in neighboring lanes, the road curvature, the speed and the lateral acceleration of the host vehicle, and the intention of the at least one other vehicle determined by the intention-analyzing module, and the speed pre-adjusting module calculates a comfortable speed as the target speed when there is no vehicle around the host vehicle.
17. The control method according to claim 11, wherein the target-following decision-making module comprises a lateral integrated decision-making module, a longitudinal integrated decision-making module, and a vehicle movement-limiting module, the lateral integrated decision-making module is configured to control the steering wheel, and the longitudinal integrated decision-making module is configured to control the throttle pedal and the brake force.
18. The control method according to claim 17, wherein the lateral integrated decision-making module is configured to determine whether a lane line of the at least one lane exists, the lateral integrated decision-making module makes a decision for the host vehicle following a front vehicle or advancing along the lane line according to a result for detecting the front vehicle and makes a decision for the host vehicle driving at a center of the at least one lane when the lane line of the at least one lane exists, and the lateral integrated decision-making module makes a decision for the host vehicle following the front vehicle when the lateral integrated decision-making module fails to detect the lane line.
19. The control method according to claim 17, wherein the longitudinal integrated decision-making module is configured to calculate a distance to collision and time to collision for the host vehicle and the at least one other vehicle, thereby making a decision for braking, accelerating, or decelerating.
20. The control method according to claim 17, wherein the vehicle movement-limiting module is configured to calculate a vehicle speed for longitudinal limitation and a steering-wheel angle for lateral limitation according to decisions made by the lateral integrated decision-making module and the longitudinal integrated decision-making module.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0017]
[0018]
[0019]
[0020]
[0021]
[0022]
[0023]
[0024]
DETAILED DESCRIPTION OF THE INVENTION
[0025] The present invention provides an active safety assistance system for pre-adjusting speed and a control method using the same. Refer to
[0026]
v.sub.k=T.sub.k(u.sub.k),k∈L,F,M (1)
[0027] T.sub.L, T.sub.F, and T.sub.M respectively represent a lane line, fusion information (as the other-vehicle information), and the dynamic trajectory of the host vehicle coordinate transforming function from their own space to the host vehicle space. u.sub.L, u.sub.F, and u.sub.M respectively represent a lane line, fusion information (as the other-vehicle information), and the dynamic-trajectory information (including time) of the host vehicle in their own space. v.sub.L, v.sub.F, and v.sub.M are respectively a lane line, fusion information (as the other-vehicle information), and the dynamic-trajectory information of the host vehicle in the host vehicle-coordinate system.
[0028] In Step S104, the other-vehicle trajectory estimation module 10 uses a representative formula of
to obtain the future trajectory of the front vehicle, wherein x.sub.i,t represents the other-vehicle information of the i-th front vehicle at previous time t.sup.− and P(t) is a quadratic function of time t. The representative formula is used to calculate the optimal moving-trajectory function of the other vehicle. As a result, the other-vehicle trajectory estimation module 10 outputs the future trajectory of the other vehicle.
[0029] The vehicle-coordinate system in Step S102 is used for fitting a lane in Step S202. After the other-vehicle trajectory estimation module 10 combines time and space according to formula (1), the process proceeds to Step S202. In Step S202, the intention-analyzing module 20 cooperates with formula (1) to determine that the other vehicle drives at the inside of a lane where the host vehicle presently drives, the left of the outside of a lane where the host vehicle presently drives, or the right of the outside of a lane where the host vehicle presently drives, thereby performing a lane-fitting process. L.sub.L and L.sub.R ∈=v.sub.L respectively represent functions of left and right lane lines and x.sub.i,0 represents the position of the i-th other vehicle. According to formula (2), the present invention determines that the other vehicle drives at the inside of a lane where the host vehicle presently drives, the left of the outside of a lane where the host vehicle presently drives, or the right of the outside of a lane where the host vehicle presently drives.
L.sub.L(x.sub.l,0)≥0&L.sub.R(x.sub.l,0)≥0 (2)
[0030] After obtaining the information according to formulas (1) and (2), the intention of the other vehicle is analyzed according to formula (3) in Step S204.
L.sub.L(x.sub.i,t.sub.
Formula (3) substitutes future time t.sup.+ into the moving-trajectory function P.sub.i to calculate the future moving-trajectory x.sub.i,t+=P.sub.l(t.sup.+) of the i-th other vehicle. Using the functions of left and right lane lines L.sub.L and L.sub.R, formula (3) determines that the i-th other vehicle will advance in the same lane, turn in the same lane, switch over to a lane where the host vehicle drives, or switch over from a lane where the host vehicle drives to another lane. Thus, in Step S206, the intention and the trajectory of the other vehicle are outputted. In addition, the intention and the trajectory of the other vehicle are obtained in Step S204. However, there may be many other vehicles. Thus, in Step S205, the trajectories of the host vehicle and the other vehicles are fitted to each other step by step. According to the trajectory M.sub.t+∈v.sub.M of the host vehicle based on future time t.sup.+ and the trajectory x.sub.i,1+ of the other vehicle, the other vehicle that may collide with the host vehicle in the future is used as a target vehicle. For example, a neighboring vehicle that will switch over to a lane where the host vehicle drives is used as the target vehicle. Afterwards, in Step S207, the intention and the trajectory of the target vehicle are outputted. In Step S208, the operation process of the intention-analyzing module 20 is ended. If the fitted results represent that all the other vehicles do not influence the movement of the host vehicle, the target vehicle does not exist. Besides, the at least one control parameter of the host vehicle calculated by the intention-analyzing module 20 is also the control parameter of the speed pre-adjusting module 30. Since the trajectory includes positions and speeds, the moving position and the speed thereof of the front vehicle or the target vehicle are obtained after obtaining the trajectory and the intention of the front vehicle or the target vehicle through the operation process of
[0031]
V.sub.set represents a cruising-vehicle speed (kph) set by the driver, V.sub.cft=√{square root over (a.sub.y,limit*R)}, R represents the radius (m) of curvature, and a.sub.y,limit represents a limited lateral acceleration (m/s.sup.2).
wherein θ represents the inclined angle of a road, k represents the curvature of a road, g represents the gravity acceleration, and μ represents the longitudinal friction coefficient. V.sub.flow=max(
[0032] In Step S303, the process determines whether one (e.g., the target vehicle) of neighboring vehicles in left and right neighboring lanes intends to switch over to a lane where the host vehicle drives. If the answer is yes, the process proceeds to Step S304. In Step S304, the process determines whether a distance between the neighboring vehicle and the host vehicle is within a safe range, such as within 2 meters. If the answer is yes, the process proceeds to Step S305. In Step S305, the output vehicle speed V.sub.out is set to the future vehicle speed V.sub.int of the neighboring vehicle estimated by the other-vehicle trajectory estimation module 10. If the answer is no, the process proceeds to Step S306. In Step S306, the output vehicle speed V.sub.out is directly used as the target speed V.sub.des and the target speed V.sub.des is determined according to formula (4). When the process determines that one of neighboring vehicles in left and right neighboring lanes does not intend to switch over to a lane where the host vehicle drives in Step S303, the process proceeds to Step S307. In Step S307, the process determines whether there is a front vehicle. If the answer is no, the process proceeds to Step S310. In Step S310, the output vehicle speed V.sub.out is directly used as the target speed V.sub.des and the target speed V.sub.des is determined according to formula (4). If the answer is yes, the process proceeds to Step S308. In Step S308, the process determines whether a distance between the front vehicle and the host vehicle is within a safe range. If the answer is yes, the process proceeds to Step S309. In Step S309, the output vehicle speed V.sub.out is the speed V.sub.target of the target vehicle determined by the intention-analyzing module 20. That is to say, the output vehicle speed V.sub.out is equal to the speed of the front vehicle. If the distance between the front vehicle and the host vehicle is not within the safe range, the host vehicle needs to decelerate or avoid collisions. Thus, the process needs to determine whether neighboring vehicles drive in left and right neighboring lanes. In Step S311, the process proceeds to Step S312 when the neighboring vehicles drive in left and right neighboring lanes. In Step S312, the process compares a higher one of the average speeds of the vehicles driving in left and right lanes with the target speed V.sub.des [determined by formula (4)] to obtain a lower one of the higher one and the target speed V.sub.des. The process proceeds to Step S310 when the neighboring vehicles do not drive in left and right neighboring lanes. In Step S310, the output vehicle speed V.sub.out is directly used as the target speed V.sub.des and the target speed V.sub.des is determined according to formula (4). This way, the speed pre-adjusting module 30 calculates and obtains the target speed V.sub.des as a comfortable speed V.sub.cft that the driver feels comfortable according to the vehicle-following distance that the host vehicle follows the other vehicle, the average speed of vehicles driving in neighboring lanes, the road curvature, the speed and the limited lateral acceleration of the host vehicle, and the intention of the other vehicle determined by the intention-analyzing module 20.
[0033]
[0034] Furthermore, the vehicle movement-limiting module 406 calculates a vehicle speed for longitudinal limitation in order to obtain an ideal vehicle speed in passing through a curve. The vehicle movement-limiting module 406 calculates a steering-wheel angle for lateral limitation in order to avoid the great variation of the steering-wheel angle. The formula (5) of calculating the ideal vehicle speed is expressed as follows:
Wherein, θ represents the inclined angle of a road, k represents the curvature of a road, g represents the gravity acceleration, μ represents the longitudinal friction coefficient, a represents an acceleration, d represents a safe distance, t.sub.r represents response time, and V represents a longitudinal vehicle speed. If θ=0, cos θ≈0 and sin θ═0,
which is the maximum vehicle speed in passing through a curve, namely the ideal vehicle speed.
[0035] In order to calculate the steering-wheel angle for lateral limitation, the sideslip angle β.sub.v=tan.sup.−1(V.sub.y/V.sub.x) of a vehicle body is calculated. Then, the error β.sub.e=sin.sup.−1(l.sub.r.Math.k.sub.c)−β.sub.v of the sideslip angle is calculated. The limited steering angle
of a front wheel is calculated by limiting the error of the sideslip angle. Finally, the steering angle of the front wheel is multiplied by a gear ratio to obtain the limited steering-wheel angle. Wherein, β.sub.v represents the sideslip angle of the vehicle body, δ.sub.f represents the steering angle of the front wheel, l.sub.f represents a wheelbase between the center of gravity of a vehicle and a front wheel, l.sub.r represents a wheelbase between the center of gravity of a vehicle and a back wheel, β.sub.e represents the error of the sideslip angle, V.sub.y represents the lateral speed of the host vehicle, and V.sub.x represents the longitudinal speed of the host vehicle.
[0036] In the lateral integrated decision, the process determines whether the front vehicle influences lane-line detection. When following a vehicle at low speed and a distance between two vehicles is shorter, the front vehicle influences lane-line detection such that lane lines are shielded or unstably detected. When the front vehicle influences lane-line detection, the lateral integrated decision makes a decision for using the CFS to follow the front vehicle and correspondingly adjust the steering-wheel angle. Accordingly, the lateral integrated decision performs vehicle-width recognition on the front vehicle, such that the host vehicle follows the middle of the width of the front vehicle. If the front vehicle does not influence lane-line detection, the LFS is performed such that the host vehicle drives at the center of the lane and maintains uniform distances from left and right lane lines. In addition, the lateral integrated decision determines the movement (e.g., advancing in the same lane, turning in the same lane, or switching over to another lane) of the front vehicle to makes a correct lateral decision according to the estimated intention and trajectory of the other vehicle. For example, the moving trajectories of a vehicle in turning and switching over to another lane are similar. If the lateral integrated decision makes a decision for following the front vehicle, the host vehicle switches over to another lane when the front vehicle switches over to another lane. As a result, the lateral integrated decision performs a lane-center control mode or an out-of-control mode (i.e., the control of the host vehicle is returned to the driver without using lateral control since lane lines are not recognized) instead of performing a vehicle-following control mode, lest the host vehicle and the front vehicle simultaneously switch over to another lane.
[0037]
A distance between a collision point C3 and the target vehicle is expressed by
A distance between a collision point C4 and the front vehicle is expressed by
For dangerous levels, C4>C3>C2>C1. If v.sub.h is larger than v.sub.t,
represents time to collision. The time to collision represents how much time the host vehicle will collide with the front vehicle.
represents average time to collision. t.sub.r represents response time, typically 0.8˜1.2 seconds. d.sub.min represents a static distance, such as 2 meters. μ represents the friction coefficient, typically 0.7˜0.8. g represents gravity.
[0038]
[0039] The longitudinal integrated decision of Step S410 in
[0040]
[0041] If the answer is yes in Step S610, the process proceeds to Step S613. In Step S613, the process determines whether TTC′≥0 and t.sub.1≥TTC>t.sub.2. If the answer is no, the process proceeds to Step S614. In Step S614, the process determines whether the AEB system has already been started. The following process is described as mentioned. If the answer is yes in Step S613, the process proceeds to Step S617 and Step S611 without performing Step S614. In Step S617, the process determines whether the ACC system has already been started. In Step S611, a system warning is outputted to remind the driver that the host vehicle is too close to the front vehicle. The following process is also described as mentioned.
[0042] If the answer is no in Step S621, the process proceeds to Step S622. In Step S622, the process determines whether the AEB system has already been started. If the answer is yes, the process proceeds to Step S624 and Step S623, respectively. In Step S624, a system warning is outputted to remind the driver that the host vehicle is too close to the front vehicle. In Step S623, the AEB system is performed to decelerate. If the answer is no in Step S622, the process proceeds to Step S625, In Step S625, the process determines whether the ACC system has already been started. If the answer is yes, the process proceeds to Step S627 and Step S628, respectively. In Step S627, the ACC system is performed to brake with the maximum force. In Step S628, a system warning is outputted to remind the driver that the host vehicle is too close to the front vehicle. If the answer is no, the process proceeds to Step S626. In such a case, the distance between the host vehicle and the front vehicle is less than the safe distance, the acting time (t.sub.2−t.sub.1) is not reserved, and the AEB system and the ACC system do not start. Thus, the host vehicle is driven by the driver. Accordingly, in Step S626, the system outputs a warning to remind the driver that a dangerous collision will occurs and all advanced driver assistance systems (ADAS) shunt down.
[0043]
[0044] In conclusion, the active safety assistance system for pre-adjusting speed and the control method using the same of the present invention, applied to the on-board system of the host vehicle, detect the future trajectories and speeds of the other vehicles at the front and in left and right neighboring lanes in driving, fit the future trajectories of the other vehicles to the future trajectory of the host vehicle, analyze the intention (e.g., advancing in the lane, turning in the same lane, or switching over to another lane) of the other vehicle to determine whether the invention influences the movement of the host vehicle, determine how to control the lateral and longitudinal movement of the host vehicle, pre-adjust the vehicle speed to a target value that the driver feels comfortable during the overall control process, and cooperate with the driver assistance system to maintain a safe distance from the other vehicle, thereby avoiding collisions.
[0045] The embodiments described above are only to exemplify the present invention but not to limit the scope of the present invention. Therefore, any equivalent modification or variation according to the shapes, structures, features, or spirit disclosed by the present invention is to be also included within the scope of the present invention.