Vehicle and method for collision avoidance assistance

• US 10,643,473 B2
• Filed: 08/29/2017
• Issued: 05/05/2020
• Est. Priority Date: 04/11/2017
• Status: Active Grant

• Current Assignee: Hyundai Motor Company (Hyundai Motor Group), Kia Motors Corporation (Kia Corp.)
• Original Assignee: Hyundai Motor Company (Hyundai Motor Group)
• Inventors: Yang, Junho, Yang, DongHun
• Primary Examiner(s): Holwerda, Stephen
• Application Number:
  US15/689,684
• Publication Number:
  US 20180293893A1
• Time in Patent Office: 980 Days
• CPC Class Codes: B60T 2201/022 Collision avoidance systems
• CPC Class Codes: B60W 2050/143 Alarm means
• CPC Class Codes: B60W 2420/403 Image sensing, e.g. optical camera
• CPC Class Codes: B60W 2520/10 Longitudinal speed
• CPC Class Codes: B60W 2554/4029 Pedestrians
• CPC Class Codes: B60W 2554/4042 Longitudinal speed
• CPC Class Codes: B60W 2554/4044 Direction of movement, e.g. backwards
• CPC Class Codes: B60W 2554/801 Lateral distance
• CPC Class Codes: B60W 2554/805 Azimuth angle
• CPC Class Codes: B60W 30/09 Taking automatic action to avoid collision, e.g. braking and steering
• CPC Class Codes: B60W 30/0953 the prediction being responsive to vehicle dynamic parameters
• CPC Class Codes: B60W 30/0956 the prediction being responsive to traffic or environmental parameters
• CPC Class Codes: B60W 30/18036 Reversing
• CPC Class Codes: B60W 50/14 Means for informing the driver, warning the driver or prompting a driver intervention
• CPC Class Codes: G01S 2013/9317 Driving backwards
• CPC Class Codes: G06T 2207/30252 Vehicle exterior; Vicinity of vehicle
• CPC Class Codes: G08G 1/163 involving continuous checking
• CPC Class Codes: G08G 1/165 for passive traffic, e.g. including static obstacles, trees
• CPC Class Codes: G08G 1/166 for active traffic, e.g. moving vehicles, pedestrians, bikes
• CPC Class Codes: G08G 1/168 Driving aids for parking, e.g. acoustic or visual feedback on parking space

Abstract

A vehicle for collision avoidance assistance may include: a camera to obtain an image of an object behind the vehicle, and obtain coordinates of a feature point spaced apart from the object, a controller, and a notification unit to output a collision warning. In particular, the controller sets an estimated value of a vector indicating a state of the vehicle based on coordinates of the vehicle, coordinates of the object, and the coordinates of the feature point, determine a predicted value of the estimated value of the vector based on a result of differentiating the estimated value of the vector with respect to time, correct the predicted value, determine the estimated value of the vector, and calculate a distance between the camera and the object to transmit a collision warning signal to the notification unit.

Claims

1. A vehicle comprising:

a camera configured to obtain an image of an object behind the vehicle, and obtain coordinates of at least one feature point spaced a predetermined distance from the object;

a controller configured to;

establish an estimated value of a vector indicating a state of the vehicle based on coordinates of the vehicle, coordinates of the object, and the coordinates of the at least one feature point,

determine a differential value of the estimated value of the vector based on a backing up speed of the vehicle, a yaw, a distance of an axle of a wheel, and a steering angle,

determine a predicted value of the estimated value of the vector based on the differential value of the estimated value of the vector,

correct the predicted value of the estimated value of the vector based on the coordinates of the object and the coordinates of the at least one feature point obtained by the camera,

determine the estimated value of the vector based on the corrected predicted value of the estimated value of the vector,

calculate a distance between the camera and the object based on the determined estimated value of the vector,

determine the predicted value of the estimated value of the vector and a predicted value of a covariance matrix indicating the state of the vehicle based on the determined differential value, and

transmit a collision warning signal based on the calculated distance; and

a notification unit configured to output a collision warning based on the transmitted collision warning signal.

2. The vehicle according to claim 1, wherein the camera is configured to obtain coordinates of a road on which the object is located and coordinates of at least one feature point spaced a predetermined distance from the coordinates of the road.

3. The vehicle according to claim 1, wherein the controller is configured to establish a first coordinate system with a center which is the same as a center of the axle of the wheel of the vehicle at a position at which the camera starts sensing the object behind the vehicle when the vehicle moves backward, establish a second coordinate system with a center, and establish a third coordinate system relative to the first coordinate system and based on a position of the camera, and

wherein the center of the second coordinate system is established at a position where the center of the wheel is located close to the object with a predetermined distance after the vehicle moves backward.

4. The vehicle according to claim 3, wherein the controller is configured to determine the coordinates of the object and the coordinates of the at least one feature point with respect to the first coordinate system of the vehicle.

5. The vehicle according to claim 3, wherein the controller is configured to determine a roll, a pitch, and a yaw of the vehicle with respect to the first coordinate system of the vehicle.

6. The vehicle according to claim 1, wherein the controller is configured to:

determine a measured value of a position vector of the object based on the coordinates of the object obtained by the camera,

determine a measured value of a position vector of the at least one feature point based on the coordinates of the at least one feature point obtained by the camera, and

determine a measured value of a height of a road on which the object is located based on an average value of height components of the coordinates of the at least one feature point obtained by the camera.

7. The vehicle according to claim 6, wherein the controller is configured to determine the measured value of the position vector of the object with respect to a third coordinate system of the vehicle.

8. The vehicle according to claim 6, wherein the controller is configured to determine the measured value of the position vector of the at least one feature point with respect to a third coordinate system of the vehicle.

9. The vehicle according to claim 6, wherein the controller is configured to determine the measured value of the height of the road on which the object is located based on the average value of the height components of the coordinates of the at least one feature point with respect to a first coordinate system of the vehicle.

10. The vehicle according to claim 6, wherein the controller is configured to correct an error of the predicted value of the estimated value of the vector and an error of the predicted value of the covariance matrix indicating the state of the vehicle based on the measured value of the position vector of the object, the measured value of the position vector of the at least one feature point, and the measured value of the height of the road on which the object is located.

11. The vehicle according to claim 3, wherein the controller is configured to determine the coordinates of the object with respect to the second coordinate system, based on the determined estimated value of the vector.

12. The vehicle according to claim 11, wherein the controller is configured to determine the coordinates of the object with respect to the third coordinate system based on the coordinates of the object determined with respect to the second coordinate system and coordinates of the camera.

13. The vehicle according to claim 12, wherein the controller is configured to calculate the distance between the camera and the object from an inner product of the coordinates of the object determined with respect to the third coordinate system.

14. The vehicle according to claim 1, wherein the controller is configured to transmit the collision warning signal when the calculated distance between the camera and the object is less than a predetermined value.

15. The vehicle according to claim 1, wherein the controller is configured to transmit a control signal for decreasing a backing up speed of the vehicle when the calculated distance between the camera and the object is less than a predetermined value.

16. The vehicle according to claim 1, wherein the camera is a rear camera configured to obtain coordinates of at least four feature points spaced a predetermined distance apart from the object, and

the controller is configured to:

determine the estimated value of the vector indicating the state of the vehicle based on the coordinates of the vehicle, the coordinates of the object, and the coordinates of the at least four feature points,

determine the predicted value of the estimated value of the vector with respect to time,

correct the predicted value of the estimated value of the vector based on the coordinates of the object and the coordinates of the at least four feature point obtained by the rear camera,

determine the estimated value of the vector based on the corrected predicted value of the estimated value of the vector,

calculate a distance between the rear camera and the object based on the determined estimated value of the vector, and

transmit the collision warning signal on the basis of the calculated distance.

17. A method of controlling a vehicle, comprising:

obtaining, by a rear camera, an image of an object behind a vehicle which is backing up by photographing the object;

obtaining, by the camera, coordinates of at least one feature point spaced a predetermined distance from the object;

establishing, by a controller, an estimated value of a vector representing a state of the vehicle based on coordinates of the vehicle, coordinates of the object, and the coordinates of the at least one feature point;

determining a differential value of the estimated value of the vector based on a backing up speed of the vehicle, a yaw, a distance of an axle of a wheel, and a steering angle;

determining, by the controller, a predicted value of the estimated value of the vector and a predicted value of a covariance matrix indicating the state of the vehicle based on the differential value of the estimated value of the vector;

correcting, by the controller, the predicted value of the estimated value of the vector based on the coordinates of the object and the coordinates of the at least one feature point obtained by the rear camera;

determining, by the controller, the estimated value of the vector based on the corrected predicted value of the estimated value of the vector based, and calculating a distance between the rear camera and the object based on the determined estimated value of the vector; and

transmitting, by the controller, a collision warning signal when the calculated distance is less than a predetermined value; and

outputting, by a notification unit, a collision warning based on the transmitted collision warning signal.