1. Field of the Invention
The present invention relates to a technology to prevent a vehicle from rolling over in a curved lane, particularly to a system and method, which can more accurately predict rollover of a vehicle moving on a curved lane via estimating the height of the gravity center of the vehicle.
2. Description of the Related Art
Automobiles have been indispensable for most families, and traffic accidents also fast increase with the rapid popularization of automobiles. Most of traffic accidents can be attributed to that the drivers are heedless of the road conditions. For example, the drivers do no decelerate in curved lanes and cause the vehicles to rush out of the curved lanes or roll over in the curved lanes.
Some GPS- or image recognition-based curve rollover prevention systems have been developed to promote driving safety, which can warn the driver with sounds when there is a curved lane ahead of the vehicle. The conventional curve rollover prevention systems do provide warning signals to prevent from vehicular rollover. However, they do not take in consideration the dynamic factors of the vehicle moving on a curved lane, such as the speed and lateral acceleration of the vehicle. Therefore, a drop exists between the reality and the estimation in the conventional curve rollover prevention systems. Nevertheless, measurement of dynamic parameters of a vehicle, such as the height variation of the gravity center of a vehicle and the rollover angle of the vehicle, is a difficult problem hard to surmount in developing a curve rollover prevention system. While moving on a curved lane, a vehicle would tilt slightly with its gravity center varied. The shift of the gravity center is very likely to influence the prediction of rollover speed.
Accordingly, the present invention proposes a system and method for preventing a vehicle from rolling over in a curved lane to overcome the abovementioned problems.
The primary objective of the present invention is to provide a system and method for preventing a vehicle from rolling over in a curved lane, which uses the vehicular status sensing module and the road images captured by the image capture devices to estimate the rollover angle and the variation of the gravity center of the vehicle moving on a curved lane, whereby the critical rollover speed of the vehicle can be more accurately predicted.
Another objective of the present invention is to provide a system and method for preventing a vehicle from rolling over in a curved lane, which uses an extended Kalman filter to predict the future dynamic variation for the vehicle running toward the road ahead.
A further objective of the present invention is to provide a system and method for preventing a vehicle from rolling over in a curved lane, which predicts the rollover speed and rollover index of a vehicle and reminds the driver to decelerate or take appropriate actions to prevent from vehicular rollover.
To achieve the abovementioned objectives, the present invention proposes a method to prevent a vehicle from rolling over in a curved lane, which comprises steps: using at least two image capture devices to capture at least one image of the road before the vehicle, and using the road image to calculate the curvature and banking of the curved lane; using the road image to estimate the variation of the turning angle of the steering wheel of the vehicle, and using the turning angle information and a plurality of types of vehicular dynamic information to estimate the rollover angle and lateral acceleration of the vehicle moving on the curved lane; working out the height of the gravity center and critical rollover speed of the vehicle moving on the curved lane according to the rollover angle, the lateral acceleration and the dynamic information of the vehicle; using the height of the gravity center, the rollover angle and the lateral acceleration to define a vehicular rollover index, substituting the values of various parameters to the vehicular rollover index, and sending out a warning signal or a control signal if the vehicular rollover index exceeds a preset value.
The present invention also proposes a system for preventing a vehicle from rolling over in a curved lane, which is installed in a vehicle, and which comprises at least two image capture devices capturing images of the road before the vehicle; a vehicular status sensing module detecting the vehicular dynamic information, such as the speed, tilt angle, and acceleration of the vehicle; and a processor connected with the image capture devices and the vehicular status sensing module, using the road images to calculate the road information, and using the road information and the vehicular dynamic information to compute the height of the gravity center and critical rollover speed of the vehicle moving on the curved lane, using the height of the gravity center and the critical rollover speed to define a vehicular rollover index, and sending out a warning signal or a control signal if the vehicular rollover index exceeds a preset value.
Below, embodiments are described in detail to make easily understood the objectives, technical contents, characteristics and accomplishments of the present invention.
The present invention proposes a system and method for preventing a vehicle from rolling over in a curved lane. The system of the present invention is installed in a vehicle. The method of the present invention uses an image processing technology to process the images of the road before the vehicle to obtain the road information, and uses the road information and the vehicular dynamic information, including the speed and acceleration of the vehicle to predict other types of dynamic information of the vehicle moving on the curved lane, compute the height of the gravity center and critical rollover speed of the vehicle moving on the curved lane, and reminds the driver to decelerate or take appropriate actions to prevent the vehicle from rolling over in the curved lane.
Refer to
The vehicular status sensing module 12 includes a wheel speed sensor 122, a gyroscope 124 and an acceleration sensor 126. The wheel speed sensor 122 is installed in a wheel to detect the rotation speed of the wheel. The gyroscope 124 detects the variation of the posture of the vehicle. The acceleration sensor 126 detects the acceleration of the vehicle.
The system for preventing a vehicle from rolling over in a curved lane further comprises a buzzer 16 and an accelerator and brake controller 18. If the vehicular rollover index exceeds the preset value while the vehicle is moving on a curved lane, the buzzer 16 emits warning sounds. Alternatively, the processor 14 outputs a control signal to enable the accelerator and brake controller 18 to control the accelerator and the brake and regulate the speed of the vehicle. Thereby, the vehicle runs in the curved lane in a lower speed.
Refer to
wherein u is the coordinate in the horizontal axis of the image plane, and wherein v is the coordinate in the vertical axis of the image plane, and wherein eu, is a fundamental magnitude of the focal length of the image capture device 10 in the u direction, which has been transformed to the image coordinate system, and wherein ev is a fundamental magnitude of the focal length of the image capture device 10 in the v direction, which has been transformed to the image coordinate system, and wherein the fundamental magnitudes are measured by pixels, and wherein H is the height of the image capture device 10 installed in the vehicle, and wherein k, m and b are parameters of the traffic lane model, and wherein mθ is the tilt angle of the image capture device 10. The tilt angle of the image capture device 10 is an included angle between the physical traffic lane and the central line of the mage capture device 10. If the physical traffic lane is uphill or inclined, the processor would compute a curvature outside the tolerance.
In Step S10, u, v, eu, ev, H, and mo obtained from road images respectively captured at different time points are used to calculate the values of the parameters k, m and b. Substitute k, m and b into a traffic lane model expressed by Equation (2):
x=k·y
2
+m·y+b (2)
whereby is obtained a curve of the traffic lane model. The curvature can be calculated from the curve.
In Step S12, use the road images to calculate the variation of the turning angle of the steering wheel of the vehicle moving on the curved lane. Refer to
{circumflex over (θ)}=57.3L/R+Kay
{circumflex over (σ)}=steering_ratio×{circumflex over (θ)} (3)
wherein {circumflex over (σ)} is the steering angle of the steering wheel; K is the gradient of insufficient turning, which is required by the lateral slide effect generated by high speed; ay is the lateral acceleration, steering_ratio is the gear ratio of the steering wheel angle to the tuning angle of the front wheel.
In Step S14, substitute the curvature of the curved lane, the banking of the curved lane, the variation of the turning angle of the steering wheel and a plurality of types of the vehicular dynamic information into the extended Kalman filter (EKF) to predict the rollover angle and lateral acceleration of the vehicle moving on the curved lane. The extended Kalman filter includes the following equations.
{circumflex over (x)}(k−1) and P(k−1) are the last estimated values. Next, update the time, and predict the system state of the next time point according to Equation (4):
{circumflex over (x)}
k
=f({circumflex over (x)}k-1,uk-1,0)
P
k
=A
k
P
k-1
A
k
T
+W
k
Q
k-1
W
k
T (4)
Next, undertake measurement and update Equation (4) according to Equation (5):
K
k
=P
k
H
k
T(HkPkHkT+vkRkvkT)−1
{circumflex over (x)}
k
={circumflex over (x)}
−
k
+K
k(zk−h({circumflex over (x)}−k,0))
P
k=(I−KkHk)P−k (5)
wherein xk and uk are respectively the system state and the input vector, Pk is the error covariance, Kk is the Kalman gain, zk is the measurement vector, vk is the Jacobians matrix of measurement, and Rk is the covariance matrix of measurement noise. After the calculation of Equation (5) is completed, input the new values to Equation (4) to update Equation (4). Equation (4) is repeatedly updated via repeating the abovementioned process.
EKF can be used to analyze various models, including the roll model, the longitudinal model, the yaw model and the lateral model. Refer to
The longitudinal model can be expressed by Equation (7):
The yaw model can be expressed by Equation (8):
The lateral model can be expressed by Equation (9):
wherein Fx1 is the longitudinal component vector of the front wheel axis, Fy1 is the lateral component vector of the front wheel axis, Fx2 is the longitudinal component vector of the rear wheel axis, Fy2 is the lateral component vector of the rear wheel axis. The rollover angle θ and the lateral acceleration ay of a vehicle moving on a curved lane can be worked out from the abovementioned models.
In Step S16, use the rollover angle, the lateral acceleration and the vehicular dynamic information to calculate the height of the gravity center and critical rollover speed of the vehicle moving on the curved lane. Refer to
wherein λ=Ixx{umlaut over (φ)}+½KE2 sin φ+½CE2·sin {dot over (φ)}. Equation (10) is derived from Equation (11) (the vehicle model):
In Equations (10) and (11), Ixx is the rotation inertia, m is the weight of the vehicle, h′R is the predicted height of the gravity center, θ is the rollover angle of the vehicle, C is the damping coefficient, K is the stiffness coefficient, E is the wheel tread.
After the new height of the gravity center is worked out, calculate the critical rollover speed. Suppose that the vehicle runs in the curved lane at a constant speed. Thus is established Equation (12):
wherein hr is the height of the gravity center with respect to the ground, and l=½ of the wheel tread. Thus, the allowed maximum speed (i.e. the critical speed) is expressed by Equation (13):
In Step S18, use the height of the gravity center, the rollover angle and the lateral acceleration to define a vehicular rollover index. Refer to
In Step S20, substitute the resultant values of the abovementioned calculations into the vehicular rollover index; the system sends out a warning signal or a control signal if the vehicular rollover index exceeds a preset value. For example, it is supposed that the vehicle will roll over when the vehicular rollover index RI equals 1 or −1. Thus, while RI>0.6, the warning signal enables the buzzer to emit warning sounds to remind the driver to decelerate. In another embodiment, the control signal directly controls the accelerator and brake to regulate the speed of the vehicle. In yet another embodiment, different indicators respectively indicate different vehicular states. For example, the green light indicates the vehicle is running at a safe speed; the yellow light indicates that the vehicle needs deceleration; the red light indicates that the vehicle needs further deceleration.
In conclusion, the present invention proposes a system and method for preventing a vehicle from rolling over in a curved lane, which uses the image-based road information, the extended Kalman filter, and the gravity-center-height algorithm to estimate the vehicular dynamic information of the road ahead, including the rollover angle, the lateral acceleration, and the new height of the gravity center of the tilted vehicle and then precisely works out the danger index (the vehicular rollover index) and the allowed maximum speed (the critical rollover speed), and which warns the driver to prevent from rollover if the vehicular rollover index reaches the preset value.
The embodiments described above are only to exemplify the present invention but not to limit the scope of the present invention. Any equivalent modification or variation according to the characteristic or spirit of the present invention is to be also included within the scope of the present invention.
Number | Date | Country | Kind |
---|---|---|---|
101134111 | Sep 2012 | TW | national |