Though millimeter radar can accurately provide longitude range and velocity information of vehicle ahead, it can not recognize lateral position and road state, which makes it easy to loss targets when vehicle ahead turns or changes its lane. To solve this problem, a new fusion framework for robust vehicle tracking is proposed, in which lane information achieved from image is integrated with radar-filtered information. With the selected road shape model and the intensity feature of lane image, an optimization algorithm was established to maximize likelihood function evaluating how well the image gradient data on an assumed lane marking supports a given set of template parameters. Simulation results validate the proposed method can improve vehicle’s pose tracking accuracy significantly.
展开▼