×

System and method of lane path estimation using sensor fusion

  • US 8,775,063 B2
  • Filed: 01/18/2010
  • Issued: 07/08/2014
  • Est. Priority Date: 01/26/2009
  • Status: Active Grant
First Claim
Patent Images

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.

View all claims
  • 4 Assignments
Timeline View
Assignment View
    ×
    ×