Landmark based radar SLAM using graph optimization
Least-Squares Fitting of Two 3-D Point Sets