The present invention relates to a driver assisting safety system, particularly to an active safety assistance system for pre-adjusting speed and a control method using the same.
Advanced driver assistance systems (ADAS), used to assist drivers in controlling vehicle-driving systems, provides drivers with some pieces of information, such as working states of vehicles and environmental information outside vehicles. The ADAS use radars, lidars, satellite navigation, and computer vision to detect their surroundings to generate related information, and transforms the related information into suitable navigation paths, obstacles, and related signs to avoid obstacles or maintain a safe distance from obstacles (e.g., vehicles at the front, back, left, and right sides). Thus, drivers can early take appropriate measures according to road conditions to avoid traffic accidents and reduce the fatigue of drivers when the driver is driving a long way.
The vehicle starts a traffic jam assist (TJA) system to control a steering wheel, a brake, and a throttle when the vehicle advances at medium-low speed. In the market, the TJA system is divided into two types. One type is a longitudinal-controlling adaptive cruise control (ACC) system and the other type is a longitudinal-controlling and lateral-controlling integrated system (e.g., the level 2 of driving automation of society of automation engineers) that combines an ACC system with a lane keeping system (LKS). However, following a front vehicle at close range has an opportunity to influence lane detection due to the existence of the front vehicle when the vehicle speed is decreased to a specific value, such as less than 20 kilometers per hour. Thus, lanes are unstably recognized. Even if the vehicle is installed with an ACC system, an autonomous emergency braking (AEB) system, and a lane following system (LFS), lanes are difficultly recognized, causing the more difficulty for the control system.
To overcome the abovementioned problems, the present invention provides an active safety assistance system for pre-adjusting speed and a control method using the same.
The primary objective of the present invention is to provide an active safety assistance system for pre-adjusting speed and a control method using the same, which predict the trajectories of a front vehicle and neighboring vehicles in left and right lanes. After the other-vehicle trajectory of one other vehicle is fitted to a lane, an intention that the other vehicle advances in the same lane, turns in the same lane, or switches over to another lane can be estimated to determine whether the other vehicle influences the movement of a host vehicle.
Another objective of the present invention is to provide an active safety assistance system for pre-adjusting speed and a control method using the same, which fit the other-vehicle trajectory to the trajectory of the host vehicle to find from other vehicles a target vehicle that influences the movement of the host vehicle, calculate control parameters of the host vehicle according to a distance between the host vehicle and the target vehicle, and the speed and the future trajectory of the host vehicle, and cooperates with the state data of the host vehicle to calculate a target speed that a driver feels comfortable.
Further objective of the present invention is to provide an active safety assistance system for pre-adjusting speed and a control method using the same, which make lateral and longitudinal decisions and control a steering-wheel angle, a brake force, and a throttle pedal according to a vehicle-following distance, a look-ahead distance from a front vehicle, a distance to collision, and time to collision, such that the host vehicle advances at target speed that the driver feels comfortable to achieve driving safety.
To achieve the abovementioned objectives, the present invention provides an active safety assistance system for pre-adjusting speed installed on an on-board system of a host vehicle. The active safety assistance system comprises: 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 the same lane, turn in the 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.
In an embodiment of the present invention, 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, the moving-state information of the host vehicle, a lane line-detecting result, and a lane-line model.
In an embodiment of the present invention, 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
to obtain a future trajectory of the at least one other vehicle, wherein xi,t represents the other-vehicle information of the i-th other vehicle at previous time t− and P(t) is a quadratic function of time t.
In an embodiment of the present invention, 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 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.
In an embodiment of the present invention, 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, and 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.
In an embodiment of the present invention, 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.
In an embodiment of the present invention, the vehicle movement-limiting module is configured to calculate a vehicle speed and an acceleration 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, lest the host vehicle be overturned when passing through a curve.
The present invention also provides 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 comprises: 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 the same lane, turn in the 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 the movement of the host vehicle according to the fitted result and the 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.
Below, the embodiments are described in detail in cooperation with the drawings to make easily understood the technical contents, characteristics and accomplishments of the present invention.
The present invention provides an active safety assistance system for pre-adjusting speed and a control method using the same. Refer to
v
k
=T
k(uk),k∈L,F,M (1)
TL, TF, and TM 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. uL, uF, and uM 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. vL, vF, and vM 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.
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 xi,t represents the other-vehicle information of the i-th front vehicle at previous time t− 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.
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. LL and LR ∈=vL respectively represent functions of left and right lane lines and xi,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
L(xl,0)≥0&LR(xl,0)≥0 (2)
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
L(xi,t
Formula (3) substitutes future time t+ into the moving-trajectory function Pi to calculate the future moving-trajectory xi,t+=Pl(t+) of the i-th other vehicle. Using the functions of left and right lane lines LL and LR, 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 Mt+∈vM of the host vehicle based on future time t+ and the trajectory xi,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
Vset represents a cruising-vehicle speed (kph) set by the driver, Vcft=√{square root over (ay,limit*R)}, R represents the radius (m) of curvature, and ay,limit represents a limited lateral acceleration (m/s2).
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. Vflow=max(
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 Vout is set to the future vehicle speed Vint 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 Vout is directly used as the target speed Vdes and the target speed Vdes 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 Vout is directly used as the target speed Vdes and the target speed Vdes 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 Vout is the speed Vtarget of the target vehicle determined by the intention-analyzing module 20. That is to say, the output vehicle speed Vout 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 Vdes [determined by formula (4)] to obtain a lower one of the higher one and the target speed Vdes. 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 Vout is directly used as the target speed Vdes and the target speed Vdes is determined according to formula (4). This way, the speed pre-adjusting module 30 calculates and obtains the target speed Vdes as a comfortable speed Vcft 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.
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, tr 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.
In order to calculate the steering-wheel angle for lateral limitation, the sideslip angle βv=tan−1(Vy/Vx) of a vehicle body is calculated. Then, the error βe=sin−1(lr·kc)−β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, βv represents the sideslip angle of the vehicle body, δf represents the steering angle of the front wheel, lf represents a wheelbase between the center of gravity of a vehicle and a front wheel, lr represents a wheelbase between the center of gravity of a vehicle and a back wheel, βe represents the error of the sideslip angle, Vy represents the lateral speed of the host vehicle, and Vx represents the longitudinal speed of the host vehicle.
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.
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 vh is larger than vt,
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. tr represents response time, typically 0.8˜1.2 seconds. dmin represents a static distance, such as 2 meters. μ represents the friction coefficient, typically 0.7˜0.8. g represents gravity.
The longitudinal integrated decision of Step S410 in
If the answer is yes in Step S610, the process proceeds to Step S613. In Step S613, the process determines whether TTC′≥0 and t1≥TTC>t2. 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.
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 (t2−t1) 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.
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.
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.