Map-Change-Driven Closed-Loop Replanning for UAV Navigation in Unknown Indoor Environments
Highlights
- A map-change-driven replanning (MCR) strategy is developed to adaptively trigger trajectory replanning based on ESDF structural variations and goal drift in unknown indoor environments.
- The proposed closed-loop Autonomous Unmanned Aerial Vehicle (UAV) navigation system achieves higher safety and lower replanning frequency than conventional time-based replanning strategies in cluttered scenarios.
- Linking replanning decisions to real-time map evolution enables more stable and resource-efficient autonomous flight under partial observability.
- The presented framework demonstrates a practical system-level solution for indoor UAV exploration and inspection tasks under realistic operational constraints.
Abstract
1. Introduction
- 1.
- A hierarchical exploration–planning–control framework is proposed, enabling coordinated operation of environment mapping, target generation, and trajectory optimization.
- 2.
- A map-change-driven closed-loop replanning mechanism (MCR) is introduced, which adaptively triggers replanning based on environmental structural changes and goal updates, improving both safety and computational efficiency.
- 3.
- A systematic experimental evaluation is conducted in an indoor warehouse simulation environment, demonstrating the performance advantages of the proposed approach over traditional methods across multiple metrics.
2. Related Work
2.1. Indoor Environment Mapping and Representation
2.2. Exploration Strategies and Goal Generation
2.3. Local Planning and Online Replanning Mechanisms
3. Method
3.1. System Overview
- 1.
- A two-dimensional occupancy grid map is obtained by vertically projecting the three-dimensional distance field, which is used for frontier detection and topological structure analysis.
- 2.
- The full three-dimensional ESDF voxel representation is retained to constrain local trajectory optimization and to evaluate flight safety margins.
3.2. Map Construction and Environment Representation
3.3. Hierarchical Goal-Guided Exploration Strategy
3.3.1. Two-Dimensional Frontier Extraction and Region Clustering
3.3.2. Candidate Goal Generation
- (1)
- Frontier Centroid Initialization
- (2)
- ESDF-Guided Refinement of the Feasible Space
- (3)
- Reachability Constraint Enforcement and Height Alignment
3.3.3. Hierarchical Goal Evaluation and Optimal Goal Selection
- (1)
- Information Gain
- (2)
- Trajectory Cost
- (3)
- Composite Scoring and Optimal Goal Selection
- (4)
- Goal Stability Assessment and MCR Triggering
3.4. Map-Change-Driven Closed-Loop Replanning Mechanism (MCR)
4. Experiment and Result
4.1. Simulation Platform and Environment Setup
4.2. Baseline Methods and Evaluation Metrics
4.2.1. Baseline Methods
- (1)
- Single-Shot Planning (SSP)
- (2)
- Time-Based Replanning (TBR)
- (3)
- Map-Change-Driven Closed-Loop Replanning (MCR)
4.2.2. Evaluation Index System
- (1)
- Success Rate (SR)
- (2)
- Average Path Length (APL)
- (3)
- Completion Time (CT)
- (4)
- Collision Count (CC) and Minimum Clearance (MC)
- (5)
- Replanning Frequency (RF)
- (6)
- Tracking Error (TE)
4.3. Experimental Results and Analysis
4.3.1. Task Reliability
4.3.2. Trajectory Quality


4.3.3. Safety Performance



4.3.4. Computational Load

4.4. Results Discussion

4.5. Practical Deployment Considerations
5. Conclusions
Author Contributions
Funding
Data Availability Statement
Conflicts of Interest
References
- Chang, Y.; Cheng, Y.; Manzoor, U.; Murray, J. A review of UAV autonomous navigation in GPS-denied environments. Robot. Auton. Syst. 2023, 170, 104533. [Google Scholar] [CrossRef]
- Haider, Z.; Sreenan, C.J.; Brown, K.N.; O’Mahony, A. Indoor Autonomous Multi-UAVs: A Review of Current Research, Enabling Technologies and Open Challenges. IEEE Access 2025, 13, 212231–212265. [Google Scholar] [CrossRef]
- Wu, H.; Wang, W.; Wang, T.; Suzuki, S. Model-Free UAV Navigation in Unknown Complex Environments Using Vision-Based Reinforcement Learning. Drones 2025, 9, 566. [Google Scholar] [CrossRef]
- Zhang, X.; Wang, J.; Wang, S.; Wang, M.; Wang, T.; Feng, Z.; Zhu, S.; Zheng, E. FAEM: Fast Autonomous Exploration for UAV in Large-Scale Unknown Environments Using LiDAR-Based Mapping. Drones 2025, 9, 423. [Google Scholar] [CrossRef]
- Ye, Y.; Wang, X.; Gou, G.; Zhang, H.; Li, H.; Sui, H. Autonomous Exploration-Oriented UAV Approach for Real-Time Spatial Mapping in Unknown Environments. Drones 2025, 9, 844. [Google Scholar] [CrossRef]
- Ren, Y.; Zhu, F.; Lu, G.; Cai, Y.; Yin, L.; Kong, F.; Lin, J.; Chen, N.; Zhang, F. Safety-assured high-speed navigation for MAVs. Sci. Robot. 2025, 10, eado6187. [Google Scholar] [CrossRef]
- Zhou, Y.; Yan, L.; Han, Y.; Xie, H.; Zhao, Y. A Survey on the Key Technologies of UAV Motion Planning. Drones 2025, 9, 194. [Google Scholar] [CrossRef]
- Liu, H.; Dong, W.; Zhang, Z.; Wang, C.; Li, R.; Gao, Y. Optimization-based local planner for a nonholonomic autonomous mobile robot in semi-structured environments. Robot. Auton. Syst. 2024, 171, 104565. [Google Scholar] [CrossRef]
- Sun, W.; Sun, P.; Ding, W.; Zhao, J.; Li, Y. Gradient-based autonomous obstacle avoidance trajectory planning for B-spline UAVs. Sci. Rep. 2024, 14, 14458. [Google Scholar] [CrossRef]
- Oh, T.; Won, Y.-J.; Lee, S. TA-RRT*: Adaptive Sampling-Based Path Planning Using Terrain Analysis. Appl. Sci. 2025, 15, 2287. [Google Scholar] [CrossRef]
- Kovryzhenko, Y.; Li, N.; Taheri, E. A Control System Design and Implementation for Autonomous Quadrotors with Real-Time Re-Planning Capability. Robotics 2024, 13, 136. [Google Scholar] [CrossRef]
- Zhang, X.; Gao, Y.; Fang, Y.; Wang, J.; Yuan, J. FGIP: A frontier-guided informative planner for UAV exploration and reconstruction. IEEE Trans. Ind. Inform. 2024, 20, 6155–6166. [Google Scholar] [CrossRef]
- Lindqvist, B.; Patel, A.; Löfgren, K.; Nikolakopoulos, G. A Tree-Based Next-Best-Trajectory Method for 3-D UAV Exploration. IEEE Trans. Robot. 2024, 40, 3496–3513. [Google Scholar] [CrossRef]
- Popović, M.; Ott, J.; Rückin, J.; Kochenderfer, M.J. Learning-based methods for adaptive informative path planning. Robot. Auton. Syst. 2024, 179, 104727. [Google Scholar] [CrossRef]
- Venu, S.; Gurusamy, M. A comprehensive review of path planning algorithms for autonomous navigation. Results Eng. 2025, 28, 107750. [Google Scholar] [CrossRef]
- Qin, T.; Li, P.; Shen, S. VINS-Mono: A robust and versatile monocular visual–inertial state estimator. IEEE Trans. Robot. 2018, 34, 1004–1020. [Google Scholar] [CrossRef]
- Lu, Y.; Xue, Z.; Xia, G.-S.; Zhang, L. A survey on vision-based UAV navigation. Geo-Spat. Inf. Sci. 2018, 21, 21–32. [Google Scholar] [CrossRef]
- Schmid, L.; Abate, M.; Chang, Y.; Carlone, L. Khronos: A unified approach for spatio-temporal metric-semantic SLAM in dynamic environments. In Proceedings of the Robotics: Science and Systems (RSS), Delft, The Netherlands, 15–19 July 2024. [Google Scholar]
- Tian, Y.; Chang, Y.; Herrera Arias, F.; Nieto-Granda, C.; How, J.P.; Carlone, L. Kimera-Multi: Robust, Distributed, Dense Metric-Semantic SLAM for Multi-Robot Systems. IEEE Trans. Robot. 2022, 38, 2022–2038. [Google Scholar] [CrossRef]
- Wang, J.; Wang, P.; Long, X.; Theobalt, C.; Komura, T.; Liu, L.; Wang, W. NeuRIS: Neural Reconstruction of Indoor Scenes Using Normal Priors. Int. J. Comput. Vis. 2022, 130, 2565–2582. [Google Scholar]
- McCormac, J.; Handa, A.; Davison, A.; Leutenegger, S. SemanticFusion: Dense 3D semantic mapping with convolutional neural networks. In Proceedings of the 2017 IEEE International Conference on Robotics and Automation (ICRA), Singapore, 29 May–3 June 2017; IEEE: New York, NY, USA, 2017. [Google Scholar]
- Wu, Y.; Chen, N.; Fan, G.; Yang, D.; Rao, L.; Cheng, S.; Song, X.; Ma, Y. NAVS: A neural attention-based visual SLAM for autonomous navigation in unknown 3D environments. Neural Process. Lett. 2024, 56, 61. [Google Scholar] [CrossRef]
- Xu, Z.; Jin, H.; Han, X.; Shen, H.; Shimada, K. Intent prediction-driven model predictive control for UAV planning and navigation in dynamic environments. IEEE Robot. Autom. Lett. 2025, 10, 4946–4953. [Google Scholar] [CrossRef]
- Whelan, T.; Leutenegger, S.; Salas-Moreno, R.; Glocker, B.; Davison, A. ElasticFusion: Dense SLAM without a pose graph. In Proceedings of the Robotics: Science and Systems (RSS), Rome, Italy, 13–17 July 2015. [Google Scholar]
- Loquercio, A.; Kaufmann, E.; Ranftl, R.; Müller, M.; Koltun, V.; Scaramuzza, D. Learning high-speed flight in the wild. Sci. Robot. 2021, 6, eabg5810. [Google Scholar] [CrossRef] [PubMed]
- Thomas, H.; Zhang, J.; Barfoot, T.D. The Foreseeable Future: Self-Supervised Learning to Predict Dynamic Scenes for Indoor Navigation. IEEE Trans. Robot. 2023, 39, 4581–4599. [Google Scholar] [CrossRef]
- Meng, W.; Zhang, X.; Zhou, L.; Guo, H.; Hu, X. Advances in UAV Path Planning: A Comprehensive Review of Methods, Challenges, and Future Directions. Drones 2025, 9, 376. [Google Scholar] [CrossRef]
- Cecchin, L.; Saccani, D.; Fagiano, L. G-BEAM: Graph-based exploration and mapping for autonomous vehicles. In Proceedings of the IEEE Conference on Control Technology and Applications (CCTA), San Diego, CA, USA, 9–11 August 2021; IEEE: New York, NY, USA, 2021. [Google Scholar]
- Zhang, H.; Wang, S.; Liu, Y.; Ji, P.; Yu, R.; Chao, T. EFP: Efficient Frontier-Based Autonomous UAV Exploration Strategy for Unknown Environments. IEEE Robot. Autom. Lett. 2024, 9, 2941–2948. [Google Scholar] [CrossRef]
- Huang, W.; Chen, H.; Huang, J.; Zheng, Z. Autonomous exploration of unknown environments using a mobile robot. In Proceedings of the Chinese Control Conference (CCC), Chongqing, China, 28–30 July 2025; IEEE: New York, NY, USA, 2025. [Google Scholar]
- Dang, T.; Mascarich, F.; Khattak, S.; Papachristos, C.; Alexis, K. Graph-based path planning for autonomous robotic exploration in subterranean environments. In Proceedings of the 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Macau, China, 3–8 November 2019; IEEE: New York, NY, USA, 2019. [Google Scholar]
- Wiman, E.; Widén, L.; Tiger, M.; Heintz, F. Autonomous 3D Exploration in Large-Scale Environments with Dynamic Obstacles. In Proceedings of the 2024 IEEE International Conference on Robotics and Automation (ICRA), Yokohama, Japan, 13–17 May 2024; IEEE: New York, NY, USA, 2024. [Google Scholar]
- Takemura, R.; Aoki, N.; Ishigami, G. Energy-and-perception-aware planning and navigation framework for unmanned aerial vehicles. Adv. Mech. Eng. 2023, 15, 16878132231169688. [Google Scholar] [CrossRef]
- Lin, J.; Shi, C.; Jin, J.; Li, S.; Chen, D. A hybrid trajectory optimization solution applied to UAVs based on point cloud information and bio-inspired evolutionary algorithm. Appl. Soft Comput. 2026, 189, 114470. [Google Scholar] [CrossRef]
- Esrafilian, O.; Bayerlein, H.; Gesbert, D. Model-aided deep reinforcement learning for sample-efficient UAV trajectory design in IoT networks. In Proceedings of the IEEE Global Communications Conference (GLOBECOM), Madrid, Spain, 7–11 December 2021; IEEE: New York, NY, USA, 2021. [Google Scholar]
- Han, L.; Gao, F.; Zhou, B.; Shen, S. FIESTA: Fast Incremental Euclidean Distance Fields for Online Motion Planning of Aerial Robots. In Proceedings of the 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Macau, China, 3–8 November 2019; IEEE: New York, NY, USA, 2019; pp. 4423–4430. [Google Scholar]
- Bes, J.; Dendarieta, J.; Riazuelo, L.; Montano, L. DWA-3D: A reactive planner for robust and efficient autonomous UAV navigation in confined environments. Robot. Auton. Syst. 2026, 195, 105196. [Google Scholar] [CrossRef]
- Sun, P.; Sun, W.; Ding, W.; Li, Y.; Zhao, J. Optimized real-time path planning for micro UAVs in dynamic environments aided by reciprocal velocity obstacle algorithm. PLoS ONE 2025, 20, e0336098. [Google Scholar] [CrossRef]
- Alonso-Mora, J.; Beardsley, P.; Siegwart, R. Cooperative collision avoidance for nonholonomic robots. IEEE Trans. Robot. 2018, 34, 404–420. [Google Scholar] [CrossRef]
- Xia, X.; Zhu, H.; Zhu, X.; Yao, W. Risk Assessment and Motion Planning for MAVs in Dynamic Uncertain Environments. Drones 2024, 8, 497. [Google Scholar] [CrossRef]



| Mean Values over 10 Trials (±Standard Deviation) | |||
|---|---|---|---|
| Metric | Fixed-Interval (TBR) | Single-Shot Planning (SSP) | Proposed MCR |
| Success Rate, SR [%] | 85.0 ± 6.8 | 70.0 ± 15.3 | 96.0 ± 3.2 |
| Avg. Path Length, APL [m] | 28.7 ± 2.1 | 31.4 ± 2.6 | 26.1 ± 1.6 |
| Completion Time, CT [s] | 72.3 ± 5.8 | 78.6 ± 64 | 64.8 ± 4.6 |
| Collision Count, CC [–] | 1.6 ± 0.9 | 4.2 ± 1.3 | 0.0 ± 0.0 |
| Min. Clearance, MC [m] | 0.23 ± 0.04 | 0.19 ± 0.05 | 0.31 ± 0.04 |
| Replanning Frequency, RF [times/run] | 14.6 ± 2.3 | 0 | 6.1 ± 1.2 |
| Tracking Error, TE [m RMSE] | 0.11 ± 0.02 | 0.14 ± 0.03 | 0.08 ± 0.01 |
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content. |
© 2026 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license.
Share and Cite
Chen, M.; Lu, Q.; Liu, X. Map-Change-Driven Closed-Loop Replanning for UAV Navigation in Unknown Indoor Environments. Drones 2026, 10, 168. https://doi.org/10.3390/drones10030168
Chen M, Lu Q, Liu X. Map-Change-Driven Closed-Loop Replanning for UAV Navigation in Unknown Indoor Environments. Drones. 2026; 10(3):168. https://doi.org/10.3390/drones10030168
Chicago/Turabian StyleChen, Mo, Qiang Lu, and Xiongding Liu. 2026. "Map-Change-Driven Closed-Loop Replanning for UAV Navigation in Unknown Indoor Environments" Drones 10, no. 3: 168. https://doi.org/10.3390/drones10030168
APA StyleChen, M., Lu, Q., & Liu, X. (2026). Map-Change-Driven Closed-Loop Replanning for UAV Navigation in Unknown Indoor Environments. Drones, 10(3), 168. https://doi.org/10.3390/drones10030168

