Heuristic-Based Laser Scan Matching forOutdoor 6D SLAM (2005)