SCAN MATCHING AND RADAR POSE ESTIMATOR FOR AN AUTONOMOUS VEHICLE BASED ON HYPER-LOCAL SUBMAPS

A scan matching and radar pose estimator for determining a final radar pose for an autonomous vehicle includes an automated driving controller that is instructed to determine a hyper-local submap based on a predefined number of consecutive aggregated filtered data point cloud scans and associated pose estimates. The automated driving controller determines an initial estimated pose by aligning a latest aggregated filtered data point cloud scan with the most recent hyper-local submap based on an iterative closest point (ICP) alignment algorithm. The automated driving controller determines a pose graph based on the most recent hyper-local submap and neighboring radar point cloud scans, and executes a multi-view non-linear ICP algorithm to adjust initial estimated poses corresponding to the neighboring radar point cloud scans in a moving window fashion to determine a locally adjusted pose.