Collision detection system and method of estimating miss distance employing curve fitting

• US 6,615,138 B1
• Filed: 05/30/2002
• Issued: 09/02/2003
• Est. Priority Date: 05/30/2002
• Status: Expired due to Term

• Current Assignee: Samsung Electronics Co. Ltd.
• Original Assignee: Delphi Technologies, Inc. (BorgWarner Incorporated)
• Inventors: Punater, Sandeep D., Schiffmann, Jan K.
• Primary Examiner(s): Marc-Coleman, Marthe Y.
• Application Number:
  US10/159,959
• Time in Patent Office: 460 Days
• Field of Search: 701/301, 701/302, 342/70, 342/455, 342/457, 342/71, 342/72, 340/917, 340/903
• US Class Current: 701/301
• CPC Class Codes: G01S 13/505 using Doppler effect for determining closest range to a target or corresponding time, e.g. miss-distance indicator
• CPC Class Codes: G01S 13/931 of land vehicles
• CPC Class Codes: G01S 2013/93271 in the front of the vehicles

Abstract

A collision detection system and method of estimating a miss distance of an object are provided. The collision detection system includes a sensor for sensing an object within a field of view and measuring range and range rate of the sensed object. The collision detection system further includes a controller for computing a mathematical square of the range and computing a mathematical square of the product of range and range rate. The controller estimates a miss distance of the object as a function of the computed squared range and the squared product of range and range rate.

Claims

1. A collision detection system comprising:

a sensor for sensing an object in a field of view and measuring range to the object and further determining range rate of the object; and

a controller for computing the product of range and range rate for each of a plurality of measurements, said controller further estimating a miss distance of the object as a function of the range and the product of range and range rate.

2. The collision detection system as defined in claim 1, wherein the controller further computes a mathematical square of the range and computes a mathematical square of the product of range and range rate for each of the plurality of measurements, said controller estimating the miss distance of the object as a function of the computed squared range and the squared product of range and range rate.

3. The collision detection system as defined in claim 2, wherein the controller further computes a curve based on the computed squared range and the squared product of range and range rate for the plurality of measurements, wherein the estimated miss distance is determined based on the curve.

4. The collision detection system as defined in claim 3, wherein the estimated miss distance is determined based on the curve when the squared product of range and range rate is equal to zero.

5. The collision detection system as defined in claim 1, wherein the controller estimates the miss distance absent an azimuth angle measurement of the object.

6. The collision detection system as defined in claim 1, wherein the sensor comprises a radar sensor, wherein the range rate is determined based on a radar Doppler effect.

7. The collision detection system as defined in claim 1, wherein the sensor comprises a plurality of sensors.

8. The collision detection system as defined in claim 1, wherein the estimated miss distance is the expected distance to the object at the closest point of approach.

9. The collision detection system as defined in claim 1, wherein the controller compares the miss distance to a threshold and generates a collision output signal as a function of the comparison.

10. A vehicle collision detection system comprising:

a sensor located on a vehicle for sensing an object in a field of view and measuring range to the object relative to the vehicle and further determining range rate of the object relative to the vehicle; and

a controller for computing a mathematical square of the range and computing a mathematical square of the product of range and range rate for each of a plurality of measurements, said controller further estimating a miss distance of the object relative to the vehicle as a function of the computed squared range and the squared product of range and range rate.

11. The vehicle collision detection system as defined in claim 10, wherein the controller further computes a curve based on the plurality of computed squared range and the squared product of range and range rate, wherein the estimated miss distance is determined based on the curve.

12. The vehicle collision detection system as defined in claim 11, wherein the estimated miss distance is determined based on the curve when the squared product of range and range rate is equal to zero.

13. The vehicle collision detection system as defined in claim 10, wherein the controller estimates the miss distance absent an azimuth angle measurement of the object.

14. The vehicle collision detection system as defined in claim 10, wherein the estimated miss distance is the expected distance between the object and the vehicle at the closest point of approach.

15. A method of estimating a miss distance of an object, said method comprising the steps of:

sensing the presence of an object;

tracking the object;

measuring range to the object for each of a plurality of measurements;

determining range rate of the object for each of the plurality of measurements;

computing the product of range and range rate for each of the plurality of measurements; and

estimating a miss distance of the object as a function of the range and the product of range and range rate.

16. The method as defined in claim 15 further comprising the steps of:

computing a mathematical square of range for each of the plurality of measurements; and

computing a mathematical square of the product of range and range rate for each of the plurality of measurements, wherein the miss distance is estimated as a function of the computed squared range and the squared product of range and range rate.

17. The method as defined in claim 16 further comprising the step of defining a curve based on the computed squared range and the squared product of range and range rate for the plurality of measurements.

18. The method as defined in claim 17, wherein the step of estimating the miss distance comprises estimating the miss distance based on the curve when the squared product of range and range rate is equal to zero.

19. The method as defined in claim 18 further comprising the step of plotting values of the computed squared range versus the squared product of range and range rate, wherein the curve is generated based on the plotted values.

20. The method as defined in claim 19 further comprising the step of estimating speed of the object as a function of slope of the curve.

21. The method as defined in claim 19, wherein the curve is generated based on a least-squares fit line of the plotted measurements.

22. The method as defined in claim, 15 wherein the step of estimating the miss distance is performed absent an azimuth angle measurement of the object.

23. The method as defined in claim 15, wherein the method estimates the miss distance of an object relative to a vehicle.

24. The method as defined in claim 23, wherein the estimated miss distance is the expected distance to the object at the closest point of approach to the vehicle.

25. The method as defined in claim 15 further comprising the step of comparing the miss distance to a threshold and generating a collision output signal as a function of the comparison.

26. A method of estimating a miss distance of an object relative to a vehicle, said method comprising the steps of:

sensing the presence of an object relative to a vehicle;

tracking the object;

measuring range to the object for each of a plurality of measurements;

determining range rate of the object for each of the plurality of measurements;

computing a mathematical square of the range for each of the plurality of measurements;

computing a mathematical square of the product of range and range rate for each of the plurality of measurements; and

estimating a miss distance of the object relative to the vehicle as a function of the computed squared range and the squared product of range and range rate.

27. The method as defined in claim 26, wherein the step of estimating the miss distance is performed absent an azimuth angle measurement of the object relative to the vehicle.

28. The method as defined in claim 26 further comprising the step of comparing the miss distance to a threshold and generating a collision output signal as a function of the comparison.

29. The method as defined in claim 26 further comprising the step of defining a curve based on the computed squared range and the squared product of range and range rate for each of the plurality of measurements, wherein the step of estimating the miss distance comprises estimating the miss distance based on the curve when the squared product of range and range rate is equal to zero.

30. The method as defined in claim 29, wherein the curve is generated based on a least-squares fit line in relation to the plurality of measurements.