Hierarchical Linear/Constant Time SLAM Using Particle Filters for Dense Maps