System and method of lane path estimation using sensor fusion
First Claim
1. Method for estimating a projected path of travel for a vehicle on a road, the method comprising:
- monitoring a plurality of sensor inputs;
determining in a processor a road geometry in front of the vehicle based upon the monitored sensor inputs, the road geometry in front of the vehicle comprisinga road curvature determined by fusing radar based curvature, map based curvature, camera based curvature and yaw rate based curvature, the radar based curvature determined bytracking one or more target vehicles in front of the vehicle to obtain a tracked trail for each target vehicle,comparing each tracked trail to a curvature threshold, andgenerating a sample mean curvature based on each tracked trail that exceeds the curvature threshold, anda tangent at the vehicle position;
determining a vehicle position in relation to the road geometry based upon the monitored sensor inputs comprisingdetermining a vehicle orientation in relation to the road geometry based upon the monitored sensor inputs and the road curvature, anddetermining a vehicle lateral position in relation to the road geometry based upon the monitored sensor inputs and the road curvature;
determining a plurality of particle points in front of the vehicle representing a potential path of travel from the road geometry and the vehicle position; and
utilizing iteratively determined ones of the plurality of particle points to navigate the vehicle including omitting ones of the plurality of particle points passed by the vehicle.
4 Assignments
0 Petitions
Accused Products
Abstract
A method for estimating a projected path of travel for a vehicle on a road includes monitoring a plurality of sensor inputs, determining a road geometry in front of the vehicle based upon the monitored sensor inputs, determining a vehicle position in relation to the road geometry based upon the monitored sensor inputs, determining a plurality of particle points in front of the vehicle representing a potential path of travel from the road geometry and the vehicle position, and utilizing iteratively determined ones of the plurality of particle points to navigate the vehicle including omitting ones of the plurality of particle points passed by the vehicle.
-
Citations
18 Claims
-
1. Method for estimating a projected path of travel for a vehicle on a road, the method comprising:
-
monitoring a plurality of sensor inputs; determining in a processor a road geometry in front of the vehicle based upon the monitored sensor inputs, the road geometry in front of the vehicle comprising a road curvature determined by fusing radar based curvature, map based curvature, camera based curvature and yaw rate based curvature, the radar based curvature determined by tracking one or more target vehicles in front of the vehicle to obtain a tracked trail for each target vehicle, comparing each tracked trail to a curvature threshold, and generating a sample mean curvature based on each tracked trail that exceeds the curvature threshold, and a tangent at the vehicle position; determining a vehicle position in relation to the road geometry based upon the monitored sensor inputs comprising determining a vehicle orientation in relation to the road geometry based upon the monitored sensor inputs and the road curvature, and determining a vehicle lateral position in relation to the road geometry based upon the monitored sensor inputs and the road curvature; determining a plurality of particle points in front of the vehicle representing a potential path of travel from the road geometry and the vehicle position; and utilizing iteratively determined ones of the plurality of particle points to navigate the vehicle including omitting ones of the plurality of particle points passed by the vehicle. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14)
-
-
15. Method for estimating a projected path of travel for a vehicle on a road, the method comprising:
-
monitoring a plurality of sensor inputs describing a road geometry in front of the vehicle; determining in a processor a set of particle points for each of the sensor inputs, comprising; determining the road geometry in front of the vehicle based upon the respective sensor input, the road geometry in front of the vehicle comprising a road curvature determined by fusing radar based curvature, map based curvature, camera based curvature and yaw rate based curvature, the radar based curvature determined by tracking one or more target vehicles in front of the vehicle to obtain a tracked trail for each target vehicle, comparing each tracked trail to a curvature threshold, and generating a sample mean curvature based on each tracked trail that exceeds the curvature threshold, and a tangent at the vehicle position; determining a vehicle position in relation to the road geometry based upon the respective sensor input comprising determining a vehicle orientation in relation to the road geometry based upon the monitored sensor input and the road curvature, and determining a vehicle lateral position in relation to the road geometry based upon the monitored sensor inputs and the road curvature; and utilizing the road geometry and the vehicle position to determine the set of particle points for the respective sensor input representing a potential path of travel; fusing the sets of particle points for each of the sensor inputs into a set of fused particle points; and utilizing iterative determinations of the set of fused particle points to operate the vehicle, wherein utilizing iterative determinations comprises omitting individual particle points of the sets of fused particle points passed by the vehicle. - View Dependent Claims (16, 17, 18)
-
Specification