FR-SLAM: A SLAM Improvement Method Based on Floor Plan Registration