US6675094B2 — Path prediction system and method

Claim 1

Independent Claim 202 words

A system for detecting objects in a predicted path of a vehicle moving on a highway lane, comprising: a forward looking sensor for providing range, angle and velocity data for objects within a field of view in front of said vehicle; measuring systems for providing velocity and yaw rate data for said vehicle; and a processing system responsive to said forward looking sensor and said measuring systems to calculate an estimated path of said vehicle based on its velocity and yaw rate while said vehicle traverses the highway lane, and to calculate estimated paths for each of said objects sensed within the field of view in front of said vehicle, and to determine a lateral distance of each object sensed within the field of view in front of said vehicle from the predicted path of said vehicle while said vehicle traverses the highway lane, and classifying each object sensed within the field of view in front of said vehicle as either in or out of the highway lane of said vehicles, wherein the predicted path of said vehicle is generated by correlating the estimated path of said vehicle and said objects and fusing the paths of said objects as a weighted average.

Claim 2

Independent Claim 202 words

A system for detecting objects in a predicted path of a vehicle moving on a highway lane, comprising: a forward looking sensor for providing range, angle and velocity data for objects within a field of view in front of said vehicle; measuring systems for providing velocity and yaw rate data for said vehicle; and a processing system responsive to said forward looking sensor and said measuring systems to calculate an estimated path of said vehicle based on its velocity and yaw rate while said vehicle traverses the highway lane, and to calculate estimated paths for each of said objects sensed within the field of view in front of said vehicle, and to determine a lateral distance of each object sensed within the field of view in front of said vehicle from the predicted path of said vehicle while said vehicle traverses the highway lane, and classifying each object sensed within the field of view in front of said vehicle as either in or out of the highway lane of said vehicles, wherein the predicted path of said vehicle is generated by correlating the estimated path of said vehicle and said objects and fusing the paths of said objects as a weighted average.

Claim 3

Dependent Claim 18 words

The object detecting system in accordance with claim 1 wherein said forward looking sensor comprises a radar system.

Claim 4

Dependent Claim 18 words

The object detecting system in accordance with claim 1 wherein said yaw rate measuring system comprises a gyrocompass.

Claim 5

Dependent Claim 218 words

In a system for use in a vehicle, said system including a forward looking sensor for providing range, angle and velocity data for objects within a field of view in front of said vehicle, measuring systems for providing velocity and yaw rate data for said vehicle, and a processing system responsive to said forward looking sensor and said measuring systems, a method for detecting objects in a predicted path of said vehicle while moving on a highway lane, said method comprising the steps of: a. calculating an estimated path of said vehicle based on its velocity and yaw rate while said vehicle traverses the highway lane; b. calculating estimated paths for each of said objects sensed within the field of view in front of said vehicle; c. determining a lateral distance of each object sensed within the field of view in front of said vehicle from the predicted path of said vehicle; and d. classifying each object sensed within the field of view in front of said vehicle as either in or out of the highway lane of said vehicle while said vehicle traverses the highway lane, wherein the predicted path of said vehicle is generated by correlating the estimated path of said vehicle and said objects and fusing the paths of said objects as a weighted average.

Claim 6

Dependent Claim 218 words

In a system for use in a vehicle, said system including a forward looking sensor for providing range, angle and velocity data for objects within a field of view in front of said vehicle, measuring systems for providing velocity and yaw rate data for said vehicle, and a processing system responsive to said forward looking sensor and said measuring systems, a method for detecting objects in a predicted path of said vehicle while moving on a highway lane, said method comprising the steps of: a. calculating an estimated path of said vehicle based on its velocity and yaw rate while said vehicle traverses the highway lane; b. calculating estimated paths for each of said objects sensed within the field of view in front of said vehicle; c. determining a lateral distance of each object sensed within the field of view in front of said vehicle from the predicted path of said vehicle; and d. classifying each object sensed within the field of view in front of said vehicle as either in or out of the highway lane of said vehicle while said vehicle traverses the highway lane, wherein the predicted path of said vehicle is generated by correlating the estimated path of said vehicle and said objects and fusing the paths of said objects as a weighted average.

Claim 7

Dependent Claim 19 words

The method in accordance with claim 4 wherein said method is repeated between 10 and 20 times per second.

Claim 8

Dependent Claim 228 words

In a system for use in a host vehicle, said system including a forward looking radar system for providing range, angle and velocity data for targets within a field of view in front of said vehicle, measuring systems for providing velocity and yaw rate data for said vehicle, and a processing system responsive to said forward looking radar system and said measuring systems, a method for detecting targets in a predicted path of said host vehicle while moving on a highway lane, said method comprising: (a) calculating a host vehicle path estimate from said velocity and yaw rate data for said host vehicle while said host vehicle traverses the highway lane; (b) propagating target position histories with said host vehicle path estimate; (c) propagating target positions forward with longitudinal and lateral target position state vectors; (d) calculating polynomial curve fits for host vehicle and target position state vectors; (e) generating said predicted path by correlating said estimated path of said host vehicle and target paths and then fusing the target paths as a weighted average; (f) comparing target cross range positions to said predicted path of said host vehicle on the highway lane and classifying targets as in-lane or out-of-lane with respect to the highway lane of said host vehicle; (g) receiving updated data from said forward looking radar system; and (h) repeating steps a through g continuously.

Claim 9

Dependent Claim 228 words

In a system for use in a host vehicle, said system including a forward looking radar system for providing range, angle and velocity data for targets within a field of view in front of said vehicle, measuring systems for providing velocity and yaw rate data for said vehicle, and a processing system responsive to said forward looking radar system and said measuring systems, a method for detecting targets in a predicted path of said host vehicle while moving on a highway lane, said method comprising: (a) calculating a host vehicle path estimate from said velocity and yaw rate data for said host vehicle while said host vehicle traverses the highway lane; (b) propagating target position histories with said host vehicle path estimate; (c) propagating target positions forward with longitudinal and lateral target position state vectors; (d) calculating polynomial curve fits for host vehicle and target position state vectors; (e) generating said predicted path by correlating said estimated path of said host vehicle and target paths and then fusing the target paths as a weighted average; (f) comparing target cross range positions to said predicted path of said host vehicle on the highway lane and classifying targets as in-lane or out-of-lane with respect to the highway lane of said host vehicle; (g) receiving updated data from said forward looking radar system; and (h) repeating steps a through g continuously.

Claim 10

Dependent Claim 33 words

The method in accordance with claim 6 wherein calculating a host vehicle path estimate includes applying a 2-state Kalman filter to track curvature parameters and propagate a host position vector forward in range.

Claim 11

Dependent Claim 60 words

The method in accordance with claim 6 wherein propagating target position histories includes calculating a previous position of the target relative to a longitudinal axis of said host vehicle, filling a vector of history points, and dropping one or more points included in the vector of history points as a value of the longitudinal position state vector drops below zero.

Claim 12

Dependent Claim 42 words

The method in accordance with claim 6 wherein calculating a the polynomial curve fit for said host vehicle and target position state vectors includes applying a 2 nd order polynomial curve fit to target history data and host vehicle curvature rate data.

Claim 13

Dependent Claim 73 words

The method in accordance with claim 9 wherein said polynomial curve has a form x=c 0 +c 1 ·y+c 2 ·y 2 , where x is a lateral direction and y is a longitudinal direction, and where c 0 , c 1 , and C 2 are the 0 th , 1 st , and 2 nd order polynomial coefficients, respectively, that specify a shape of the curve in a cross range dimension.

Claim 14

Dependent Claim 35 words

The method in accordance with claim 6 wherein calculating a polynomial curve fit for said target position state vectors includes propagating data forward from target position and velocity estimates in the longitudinal and lateral dimensions.

Claim 15

Dependent Claim 74 words

The method in accordance with claim 11 wherein said polynomial curve has the a form x=c 0 +c 1 ·y+c 2 ·y 2 , where x is the lateral direction and y is the longitudinal direction, and where c 0 , c 1 , and C 2 are the 0 th , 1 st , and 2 nd order polynomial coefficients, respectively, that specify a shape of the curve in a cross range dimension.

Claim 16

Dependent Claim 116 words

The method in accordance with claim 12 wherein generating said predicted path by correlating host vehicle and target paths and then fusing the target paths as a weighted average further comprises: adjusting fusion weights depending on the resolution of an accepted alternate path hypothesis, or using the host vehicle derived path if an alternate path hypothesis has been rejected and there is only a single target, or adjusting fusion weights depending on the resolution of an rejected alternate path hypothesis where there is more than one target, or applying default, range-based fusion weights where no alternate path hypothesis has been rejected; computing the weighted average of the target paths; and extracting the coefficients of said polynomial.

Claim 17

Dependent Claim 23 words

The method in accordance with claim 6 wherein generating said predicted path includes testing for a highway lane change by said host vehicle.

Claim 18

Dependent Claim 39 words

The method in accordance with claim 14 wherein generating said predicted path includes comparing the unfiltered yaw rate measurement of said host vehicle to a previously updated path heading coefficient multiplied by twice the velocity of said host vehicle.

Claim 19

Dependent Claim 73 words

The method in accordance with claim 15 wherein a highway lane change by said host vehicle is confirmed by: comparing the integrated yaw rate to each target heading coefficient to see if it is equal and opposite; confirming that the majority of targets are moving in the opposite direction of said host vehicle; and noting that said opposite direction motion has occurred at two consecutive data updates from said forward looking radar system.

Claim 20

Dependent Claim 18 words

The method in accordance with claim 6 wherein generating said predicted path includes calculating default target fusion weights.

Claim 21

Dependent Claim 52 words

The method in accordance with claim 17 wherein said default target fusion weights are assigned a value of one for the range between said host vehicle and the present position of said target, and monotonically decreasing values beyond said target to the end of the range of said forward looking radar system.

Claim 22

Dependent Claim 36 words

The method in accordance with claim 6 wherein comparing target cross range positions to said predicted path includes comparing the target positions to within one-half highway lane width of the predicted path to determine in-lane classification.

Claim 23

Dependent Claim 60 words

The method in accordance with claim 6 wherein generating said predicted path by correlating host vehicle and target paths and then fusing the target paths as a weighted average further comprises the process of setting an alternate path hypothesis when the target furthest in range deviates from the predicted path, said alternate path hypothesis continuing to follow the predicted path.

Annuity Stage	Window Opens	Payment Deadline	Surcharge Period Until	Estimated Fee	Status
3.5 Years (Year 4)	2007-01-05	2007-07-07	2008-01-06	$2000.00	Window Closed / Lapsed
7.5 Years (Year 8)	2011-01-05	2011-07-07	2012-01-06	$3760.00	Window Closed / Lapsed
11.5 Years (Year 12)	2015-01-05	2015-07-07	2016-01-06	$7700.00	Window Closed / Lapsed

Path prediction system and method

Abstract

Inventors

Bibliographic Details

Claims Analysis

References Cited (Backward Citations)

USPTO Annuity & Maintenance Windows

Assigned Categories & Tags

Assign Category Tag