Vehicle and method for collision avoidance assistance

Patent metadata

Field	Value
Publication number	US-10643473-B2
Application number	US-201715689684-A
Country	US
Kind code	B2
Filing date	Aug 29, 2017
Priority date	Apr 11, 2017
Publication date	May 5, 2020
Grant date	May 5, 2020

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.

First claim

What is claimed is:

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

Assignees

• Hyundai Motor Co Ltd
• Kia Motors Corp

Inventors

• Yang Junho
• Yang Donghun

Classifications

• B60W30/18036

  Reversing · CPC title

• B60W2554/4044

  Direction of movement, e.g. backwards · CPC title

• B60W30/0953

  the prediction being responsive to vehicle dynamic parameters · CPC title

• B60W2554/4029

  Pedestrians · CPC title

• B60W2554/4042

  Longitudinal speed · CPC title