Obstacle-aware Adaptive Informative Path Planning for UAV-based Target Search

TL;DR

Proposes OA-IPP, a Gaussian Process-based adaptive path planning algorithm for UAV target search in cluttered environments, outperforming state-of-the-art methods.

cs.RO 🔴 Advanced 2019-02-27 73 citations 62 views
Ajith Anil Meera Marija Popovic Alexander Millane Roland Siegwart
UAV path planning informative exploration obstacle avoidance Bayesian optimization target search

Key Findings

Methodology

The proposed OA-IPP framework integrates a layered planning strategy that couples continuous 3D path optimization with obstacle awareness and information gain maximization. It models the environment using Euclidean Signed Distance Fields (ESDF) for obstacle detection, and employs Gaussian Processes (GP) with Matérn 3/2 kernels to probabilistically map target occupancy over the terrain. Sensor performance, such as YOLO-based human detection, is modeled as altitude-dependent, enabling adaptive measurement strategies. Path control points are parameterized via polynomial splines, optimized through CMA-ES for global search. The algorithm incorporates a multi-objective function balancing information gain, collision risk, and flight time, with adaptive replanning triggered based on real-time data. This design allows the UAV to navigate complex urban environments efficiently, focusing on promising regions while avoiding obstacles, and re-observing targets for improved accuracy.

Key Results

  • In simulation, OA-IPP achieved 100% detection of 7 targets within 150 seconds, with an average root square error (RSE) of 0.15, outperforming baseline coverage and random strategies by approximately 30%. The method maintained stable performance across environments with varying obstacle densities, with errors below 0.2 and consistent uncertainty reduction.
  • In complex urban scenarios with high obstacle density, the algorithm successfully generated collision-free, efficient paths that adaptively focused on target-rich areas. The final maps showed significant uncertainty reduction and high detection confidence, validating the robustness of the layered optimization approach.
  • Realistic urban SaR simulation demonstrated successful detection of all targets, with the map uncertainty decreasing steadily during the mission. The approach proved capable of handling sensor noise, false positives, and environment complexity, confirming its practical viability.

Significance

This work addresses critical challenges in autonomous UAV target search within cluttered, uncertain environments. By integrating probabilistic mapping, obstacle-aware path planning, and adaptive exploration strategies, it significantly enhances search efficiency, safety, and robustness. The approach bridges the gap between theoretical models and real-world applications, enabling UAVs to operate reliably in urban, natural, and disaster scenarios. Its ability to perform real-time, adaptive re-planning under resource constraints marks a substantial advancement in autonomous robotics, with broad implications for search and rescue, surveillance, and environmental monitoring. The framework sets a new standard for intelligent, safe, and efficient UAV navigation in complex environments.

Technical Contribution

The paper's key technical contributions include: (1) the development of a continuous-space, obstacle-aware path planning framework that leverages GP-based target occupancy modeling; (2) the integration of Bayesian Optimization with an Upper Confidence Bound (UCB) acquisition function for layered exploration-exploitation balancing; (3) the formulation of a multi-objective path optimization combining information gain, collision risk, and flight time, solved via CMA-ES; (4) a dynamic re-planning mechanism that updates paths based on real-time sensor data, enabling target re-observation and robustness against false detections; (5) extensive simulation validation demonstrating superior performance over existing methods across diverse environments. These innovations collectively advance the state-of-the-art in autonomous informative path planning.

Novelty

This research introduces the first integration of Bayesian Optimization-based layered exploration with obstacle-aware continuous path planning for UAV target search. Unlike prior work that either focused on static coverage or discrete grid-based methods, this approach dynamically balances exploration and exploitation in a continuous 3D space, explicitly considering obstacle avoidance and sensor performance variability. The combination of GP-based probabilistic mapping, adaptive re-planning, and multi-objective optimization within a unified framework represents a significant leap forward, enabling robust, efficient, and safe target search in highly cluttered environments. Its novelty lies in the seamless coupling of these components, providing a comprehensive solution that addresses longstanding challenges in autonomous UAV navigation.

Limitations

  • The current framework assumes a static, known environment, limiting its applicability in dynamic or unknown scenarios where obstacles or targets may move unexpectedly.
  • Sensor performance models, such as YOLO detection accuracy, are based on empirical data and may not generalize well to different sensors or environmental conditions, potentially affecting robustness.
  • Computational complexity remains high, especially in large-scale or highly cluttered environments, which may hinder real-time deployment without hardware acceleration or algorithmic simplification.

Future Work

Future research will focus on extending the framework to dynamic environments with moving obstacles and targets, incorporating online environment mapping and prediction. Multi-UAV collaboration strategies will be developed to enable large-area, multi-target search with coordinated path planning. Additionally, integrating deep learning-based sensor models could improve detection robustness under diverse conditions. Efforts to optimize computational efficiency, including GPU acceleration and hierarchical planning, will be pursued to facilitate real-time deployment on embedded platforms. These advancements aim to broaden the applicability of the approach to real-world, large-scale scenarios such as disaster response and urban surveillance.

AI Executive Summary

Autonomous target search in cluttered environments remains a formidable challenge for unmanned aerial vehicles (UAVs). Traditional path planning methods, such as grid-based coverage or simple greedy strategies, often struggle to balance the competing demands of information maximization, obstacle avoidance, and resource constraints. These approaches tend to either oversample safe but uninformative regions or risk collision in complex urban landscapes, limiting their effectiveness in real-world applications like search and rescue (SaR).

Recognizing these limitations, this work introduces the Obstacle-aware Adaptive Informative Path Planning (OA-IPP) algorithm, a novel framework that combines probabilistic modeling, multi-objective optimization, and adaptive re-planning. At its core, the method models the environment using Euclidean Signed Distance Fields (ESDF) for obstacle detection and Gaussian Processes (GP) for continuous target occupancy mapping. This probabilistic map captures spatial correlations and uncertainties, enabling the UAV to make informed decisions about where to explore next.

The path planning process is driven by a layered optimization strategy. The first layer employs Bayesian Optimization (BO) with an Upper Confidence Bound (UCB) acquisition function to identify promising regions that balance exploration and exploitation. This layer considers sensor performance variability, such as altitude-dependent detection accuracy of YOLO, to prioritize measurement locations that maximize information gain while maintaining sensor reliability. The second layer optimizes the UAV's trajectory using CMA-ES, ensuring smooth, collision-free paths that adhere to flight time constraints.

Simulation results demonstrate the effectiveness of OA-IPP in diverse scenarios. In a simulated urban SaR environment with multiple obstacles and targets, the algorithm successfully detected all targets within the allocated time, achieving a 30% reduction in localization error compared to baseline methods. Its robustness against environmental complexity, false positives, and sensor noise underscores its practical potential. Moreover, the real-time re-planning capability allows the UAV to adapt dynamically, re-focusing on areas of interest as new information becomes available.

This research significantly advances autonomous UAV navigation by integrating probabilistic environmental understanding with adaptive, obstacle-aware path optimization. Its ability to efficiently operate in cluttered, uncertain environments opens new avenues for applications in disaster response, urban monitoring, and border security. Future work will extend the framework to dynamic environments, multi-UAV systems, and incorporate deep learning for enhanced perception, aiming to realize fully autonomous, scalable search solutions in complex real-world scenarios.

Deep Analysis

Background

Over the past decade, UAVs have transitioned from remote-controlled devices to autonomous agents capable of complex tasks such as terrain mapping, target detection, and environmental monitoring. Early approaches relied heavily on pre-defined coverage patterns, like lawnmower or spiral paths, which worked well in open, obstacle-free environments. However, these methods lacked adaptability in cluttered urban or natural terrains, where obstacles and dynamic elements pose significant challenges.


Recent advances introduced probabilistic mapping techniques, notably Gaussian Processes (GP), enabling UAVs to build continuous, uncertainty-aware models of target occupancy and terrain features. Simultaneously, obstacle-aware path planning algorithms, such as RRT* and CHOMP, improved safety and efficiency but often operated on discrete grids or simplified models, limiting scalability and resolution.


Despite these developments, existing methods generally treat exploration and obstacle avoidance as separate modules, leading to suboptimal performance in resource-constrained scenarios. The integration of Bayesian optimization with continuous path planning remains underexplored, especially in the context of real-time, adaptive target search. This gap motivates the development of unified frameworks that can dynamically balance information gain, safety, and resource management, particularly for urban search and rescue missions where environment complexity and uncertainty are high.

Core Problem

The core challenge addressed in this research is enabling UAVs to perform efficient, safe, and adaptive target search in cluttered environments with limited flight time and uncertain sensor data. Traditional methods either focus on systematic coverage, risking inefficiency, or on reactive obstacle avoidance, risking missed targets. The fundamental bottleneck is the lack of a unified, probabilistic framework that can simultaneously model environment obstacles, target occupancy, sensor uncertainties, and optimize the UAV's trajectory in real-time.


Specifically, the problem involves: (1) constructing an accurate, probabilistic map of the environment and target locations; (2) planning smooth, collision-free paths that maximize information gain; (3) dynamically re-planning based on new sensor data; and (4) balancing exploration of unknown regions with exploitation of promising areas. Achieving this within strict resource constraints, such as battery life and computational limits, makes the problem particularly challenging. Addressing these issues requires integrating environment modeling, sensor performance considerations, and multi-objective optimization into a cohesive, real-time capable framework.

Innovation

The primary innovations of this work include:

  • �� A continuous-space, obstacle-aware path planning framework that leverages Euclidean Signed Distance Fields (ESDF) for real-time obstacle detection and avoidance.
  • �� Probabilistic target occupancy mapping using Gaussian Processes (GP) with Matérn kernels, capturing spatial correlations and uncertainties, enabling informed exploration.
  • �� A layered optimization strategy that combines Bayesian Optimization (BO) with Upper Confidence Bound (UCB) acquisition functions for adaptive exploration-exploitation balancing, considering sensor performance variability.
  • �� Multi-objective path optimization integrating information gain, collision risk, and flight time, solved via CMA-ES, ensuring smooth, safe, and efficient trajectories.
  • �� A dynamic re-planning mechanism that updates paths based on real-time sensor measurements, supporting target re-observation and robustness against false positives.
  • �� Extensive simulation validation demonstrating superior performance over existing methods across various environmental complexities, including urban scenarios with high obstacle density.

Methodology

  • �� Environment modeling: Use ESDF to represent obstacles, enabling fast collision checks. Obstacles are simplified as geometric shapes, with a signed distance function providing safety margins.
  • �� Target mapping: Employ Gaussian Processes with Matérn 3/2 kernel to model target occupancy over the terrain. Hyperparameters are learned via maximum likelihood, and the map is updated sequentially with sensor measurements.
  • �� Sensor modeling: Simulate altitude-dependent detection performance of YOLO, incorporating detection probability curves into the planning process.
  • �� Path parameterization: Use polynomial splines connecting control waypoints, ensuring smooth, dynamically feasible trajectories.
  • �� Initial path generation: Apply greedy search (COARSEGREEDYSEARCH) to select promising waypoints based on current map and sensor data.
  • �� Global optimization: Use CMA-ES to refine the initial path, optimizing for maximum information gain while avoiding obstacles.
  • �� Replanning: During flight, continuously update the environment map with new measurements, and re-optimize the path if resource limits permit, enabling target re-observation and adaptive focus.

Experiments

  • �� Setup: Simulate urban search and rescue scenarios in RotorS, with environment dimensions of 30×30×26 meters, including obstacles and 7 human targets.
  • �� Sensor configuration: Downward-facing camera with YOLO Tiny 2.0 detector, detection threshold 0.05, frequency 0.15Hz, FoV (45°, 60°).
  • �� Baselines: Compare against lawnmower coverage and random waypoint strategies, each with 25 trials, flight time budget of 150 seconds.
  • �� Metrics: Root Square Error (RSE) for map accuracy, detection success rate, and GP posterior covariance trace for uncertainty.
  • �� Hyperparameters: Path speed 5m/s, acceleration 3m/s², Bayesian optimization parameters tuned for sensor performance.
  • �� Variations: Test environments with different obstacle densities and heights to evaluate robustness and scalability.

Results

  • �� OA-IPP reduced RSE by approximately 30% compared to baseline methods, achieving an average error of 0.15 within 150 seconds, successfully detecting all targets.
  • �� The method maintained stable performance across environments with high obstacle density, with errors below 0.2 and consistent uncertainty reduction.
  • �� Adaptive re-planning enabled the UAV to focus on promising regions, improving target re-observation and detection accuracy, even in the presence of false positives.
  • �� In urban simulations, the generated paths effectively avoided obstacles, with trajectories validated in complex scenarios, demonstrating practical applicability.

Applications

  • �� Search and rescue: Rapid localization of victims in urban or forest environments, especially where obstacles and uncertainties are prevalent.
  • �� Urban monitoring: Autonomous patrols for infrastructure inspection, crowd monitoring, or security surveillance.
  • �� Border security: Continuous monitoring of sensitive regions with obstacle-rich terrains.
  • �� The framework can be extended to multi-UAV systems for large-scale, coordinated search missions, significantly enhancing operational efficiency.

Limitations & Outlook

  • �� Assumes environment is known and static; dynamic obstacles or environment changes are not yet supported.
  • �� Sensor models are based on empirical data, which may not generalize across different sensors or environmental conditions.
  • �� Computational demands are high, especially in large or highly cluttered environments, necessitating further optimization for real-time deployment.

Plain Language Accessible to non-experts

想象你在一个巨大的仓库里玩捉迷藏,你要找到藏起来的小伙伴。仓库里有很多货架和箱子,你不能直接穿过去,因为会撞到东西。你需要用一只神奇的“眼睛”来扫描环境,看看哪里可能藏着小伙伴。这只眼睛在不同的高度效果不同——在低一点的地方看得更清楚,但视野也更窄;在高一点的地方看得更远,但细节变少。你会用这些信息,规划一条既安全又快的路线,绕过障碍,尽量多地扫描环境。每次你走一段路,就会用“眼睛”重新扫描,更新你的地图,找到更多线索。你还会不断调整路线,优先去那些可能藏有小伙伴的地方。这个过程就像无人机在城市中搜索目标一样——它用聪明的“眼睛”和“脑袋”不断学习和调整,最终能在复杂的环境中找到目标,既快又准,像个真正的侦探一样厉害!

Abstract

Target search with unmanned aerial vehicles (UAVs) is relevant problem to many scenarios, e.g., search and rescue (SaR). However, a key challenge is planning paths for maximal search efficiency given flight time constraints. To address this, we propose the Obstacle-aware Adaptive Informative Path Planning (OA-IPP) algorithm for target search in cluttered environments using UAVs. Our approach leverages a layered planning strategy using a Gaussian Process (GP)-based model of target occupancy to generate informative paths in continuous 3D space. Within this framework, we introduce an adaptive replanning scheme which allows us to trade off between information gain, field coverage, sensor performance, and collision avoidance for efficient target detection. Extensive simulations show that our OA-IPP method performs better than state-of-the-art planners, and we demonstrate its application in a realistic urban SaR scenario.

cs.RO

References (20)

Multiresolution mapping and informative path planning for UAV-based terrain monitoring

Marija Popovic, Teresa Vidal-Calleja, Gregory Hitz et al.

2017 70 citations ⭐ Influential View Analysis →

A statistical method for global optimization

D. Dennis, Susan John

1992 362 citations ⭐ Influential

You Only Look Once: Unified, Real-Time Object Detection

J. Redmon, S. Divvala, Ross B. Girshick et al.

2015 47700 citations ⭐ Influential View Analysis →

Bayesian Optimisation for informative continuous path planning

Román Marchant, F. Ramos

2014 155 citations ⭐ Influential

A survey on coverage path planning for robotics

Enric Galceran, M. Carreras

2013 1606 citations

Border patrol and surveillance missions using multiple unmanned air vehicles

A. Girard, A. Howell, J. Hedrick

2004 313 citations

The CMA Evolution Strategy: A Comparing Review

N. Hansen

2006 2335 citations

RotorS—A Modular Gazebo MAV Simulator Framework

Fadri Furrer, M. Burri, Markus Achtelik et al.

2016 519 citations

Active target search from UAVs in urban environments

Christopher Geyer

2008 35 citations

SARSOP: Efficient Point-Based POMDP Planning by Approximating Optimally Reachable Belief Spaces

H. Kurniawati, David Hsu, Wee Sun Lee

2008 1055 citations

Modeling and decision making in spatio-temporal processes for environmental surveillance

Amarjeet Singh, F. Ramos, H. Durrant-Whyte et al.

2010 98 citations

An introduction to Gaussian processes for the Kalman filter expert

S. Reece, S. Roberts

2010 85 citations

Supporting Search and Rescue Operations with UAVs

S. Waharte, A. Trigoni

2010 529 citations

A Tutorial on Bayesian Optimization of Expensive Cost Functions, with Application to Active User Modeling and Hierarchical Reinforcement Learning

E. Brochu, Vlad M. Cora, Nando de Freitas

2010 2695 citations View Analysis →

Branch and bound for informative path planning

J. Binney, G. Sukhatme

2012 156 citations

Optimizing waypoints for monitoring spatiotemporal phenomena

J. Binney, Andreas Krause, G. Sukhatme

2013 127 citations

Autonomous exploration and simultaneous object search using aerial robots

Tung Dang, C. Papachristos, K. Alexis

2018 63 citations

Unmanned aerial systems for photogrammetry and remote sensing: A review

I. Colomina, P. Molina

2014 2769 citations

Sampling-based robotic information gathering algorithms

Geoffrey A. Hollinger, G. Sukhatme

2014 379 citations

Are unmanned aircraft systems (UASs) the future of wildlife monitoring? A review of accomplishments and challenges

Julie Linchant, Jonathan Lisein, Jean Semeki et al.

2015 460 citations

Cited By (20)

Deep Reinforcement Learning With Dynamic Graphs for Adaptive Informative Path Planning

2024 46 citations ⭐ Influential View Analysis →

An Informative Planning Framework for Target Tracking and Active Mapping in Dynamic Environments With ASVs

2025 5 citations ⭐ Influential View Analysis →

Adaptive Path Planning for UAVs for Multi-Resolution Semantic Segmentation

2022 48 citations ⭐ Influential View Analysis →

Reclaiming saliency: Rhythmic precision-modulated action and perception

2022 9 citations ⭐ Influential View Analysis →

Multiagent coverage search based on Voronoi and sparse heteroscedastic Gaussian process

2022 8 citations

Reinforcement Learning for Agile Active Target Sensing with a UAV

2022 3 citations View Analysis →

Cost Aware Asynchronous Multi-Agent Active Search

Approximation Algorithms for Robot Tours in Random Fields with Guaranteed Estimation Accuracy

2022 2 citations View Analysis →

Aerial View Localization with Reinforcement Learning: Towards Emulating Search-and-Rescue

2022 6 citations View Analysis →

Informative Path Planning Algorithm for the Exploration of Unknown 2D Environments

2023

Robust Q‐learning‐based multi‐objective sheep flock optimizer with a Cauchy operator for effective path planning in unmanned aerial vehicles

2023 4 citations

Multi-Agent Distributed Online Collaborative Target Search Based on Clustering Expectation Detection

2024 1 citations

Star-Searcher: A Complete and Efficient Aerial System for Autonomous Target Search in Complex Unknown Environments

2024 42 citations View Analysis →

Set-membership target search and tracking within an unknown cluttered area using cooperating UAVs equipped with vision systems

2024 1 citations View Analysis →

UAV path planning techniques: a survey

2024 52 citations

Joint Response and Background Learning for UAV Visual Tracking

2024 8 citations

Optimizing Search and Rescue UAV Connectivity in Challenging Terrain Through Multi Q-Learning

2024 6 citations View Analysis →

GOMAA-Geo: GOal Modality Agnostic Active Geo-localization

2024 15 citations View Analysis →

POAM: Probabilistic Online Attentive Mapping for Efficient Robotic Information Gathering

2024 7 citations View Analysis →

MD-RadioMap: Multi-Drone Radio Map Building via Single-Anchor Ultra-Wideband Localization Network

2023 3 citations