https://123dok.com/document/7q0wg7ly-hierarchical-updating-approach-simultaneous-localization-mapping-mobile-robots.html