Open Access
ARTICLE
Path Planning for Substation UAV Inspection Based on 3D Point Cloud Mapping
1 School of Artificial Intelligence and Big Data, Hefei University, Hefei, China
2 Institute of Intelligent Machines, Chinese Academy of Sciences, Hefei, China
* Corresponding Author: Le Zou. Email:
Computers, Materials & Continua 2026, 87(2), 94 https://doi.org/10.32604/cmc.2026.075459
Received 01 November 2025; Accepted 23 January 2026; Issue published 12 March 2026
Abstract
With the increasing complexity of substation inspection tasks, achieving efficient and safe path planning for Unmanned Aerial Vehicles in densely populated and structurally complex three-dimensional (3D) environments remains a critical challenge. To address this problem, this paper proposes an improved path planning algorithm—Random Geometric Graph (RGG)-guided Rapidly-exploring Random Tree (R-RRT)—based on the classical Rapidly-exploring Random Tree (RRT) framework. First, a refined 3D occupancy grid map is constructed from Light Detection and Ranging point cloud data through ground filtering, noise removal, coordinate transformation, and obstacle inflation using spherical structuring elements. During the planning stage, a dynamic goal-biasing strategy is introduced to adaptively adjust the sampling direction, the sampling distribution is optimized using a pre-generated RGG, and collision detection is accelerated via a K-Dimensional Tree structure. After initial trajectory generation, redundant nodes are eliminated via greedy pruning, and a curvature-minimizing gradient-based optimization method is applied to smooth the trajectory. Experimental results conducted in a simulated substation environment demonstrate that, compared with mainstream path planning algorithms, the proposed R-RRT achieves superior performance in terms of path length, planning time, and trajectory smoothness. Comprehensive analysis shows that the proposed method significantly enhances trajectory quality, planning efficiency, and operational safety, validating its applicability and advantages for high-precision 3D path planning in complex substation inspection scenarios.Keywords
In recent years, with the rapid advancement of Unmanned Aerial Vehicle (UAV) technology and multi-modal remote sensing systems, UAVs have been widely applied in fields such as smart agriculture, urban traffic monitoring, emergency response, and logistics delivery [1–4], demonstrating strong adaptability in both industrial and civilian applications. In the power industry, UAVs have become a key technology for replacing traditional manual inspection due to their advantages of low cost, high precision, and high operational efficiency [5,6].
Substations, serving as essential hubs for power generation, transmission, and distribution, play a critical role in ensuring grid reliability [7]. However, substations are characterized by densely arranged equipment, limited space, and complex internal structures. Traditional manual inspection methods are labor-intensive, pose safety risks, and exhibit low efficiency, making it difficult to meet the requirements of modern smart grids [8]. UAV-based automated inspection systems, equipped with multiple sensors such as Light Detection and Ranging (LiDAR), thermal imagers, and high-definition cameras, can efficiently perceive and collect data from power facilities [9]. Nevertheless, achieving high-precision and low-risk autonomous navigation in complex three-dimensional (3D) environments remains a major technical challenge—particularly in the path planning stage, which demands high real-time performance, accuracy, and obstacle avoidance capabilities from the algorithm.
It is worth noting that path planning systems can be broadly categorized into two paradigms: those relying on a priori maps and those based on Simultaneous Localization and Mapping (SLAM). SLAM-based systems excel in unknown or dynamically changing environments by concurrently building a map and localizing within it, offering great flexibility. Recent surveys have shown that modern SLAM solutions increasingly rely on multi-sensor fusion—such as LiDAR, IMU, and camera integration—to improve robustness and mapping accuracy in complex environments [10]. However, for structured and relatively static industrial sites like substations, where high-precision, stable maps can be pre-acquired and safety is paramount, the use of a priori maps presents distinct advantages. This approach decouples the computationally intensive mapping process from the online planning task, allowing the planning algorithm to utilize a consistent, optimized environmental model. This eliminates the potential for cumulative errors and map inconsistencies inherent in real-time SLAM, thereby providing a more reliable and deterministic foundation for generating safe inspection paths. Consequently, this work focuses on the path planning challenge given a high-fidelity pre-existing map, a common and practical scenario in scheduled industrial inspections.
The core of UAV path planning lies in constructing a high-precision 3D environmental model and generating feasible, safe, and smooth flight trajectories. Currently, various mapping approaches have been proposed, including octree-based [11], probabilistic occupancy grid-based [12], and point cloud map-based [13] methods, each with distinct advantages. Octree maps are widely adopted due to their sparse representation and global mapping capability. The Robocentric Occupancy Grid Map (ROG-Map) proposed by Ren et al. integrates multi-resolution occupancy probabilities and an adaptive sliding window mechanism to achieve efficient map updates and accurate perception representation in complex outdoor environments [12]. However, a trade-off between detailed modeling and real-time performance still exists, limiting their adaptability to highly dynamic scenarios.
In contrast, point cloud-based mapping approaches have gained increasing attention. By directly utilizing raw 3D spatial data obtained from LiDAR or vision sensors, this method offers independence from grid assumptions, retains rich geometric details, and allows flexible resolution adjustment. For example, the Efficient Point Cloud-Based Exploration and Mapping (EPIC) framework integrates topological structures with lightweight point clouds, enabling rapid mapping and high-quality trajectory generation in large-scale environments [14]. Additionally, Zhao et al. proposed an improved Rapidly-exploring Random Tree Star (RRT*) algorithm based on point cloud maps to enhance UAV path search in complex 3D spaces using adaptive sampling and expansion strategies, thereby significantly improving planning efficiency and path quality [15]. In substation environments characterized by dense equipment and complex spatial layouts, point cloud maps provide superior realism and detail preservation, making them the preferred solution for environmental modeling.
This paper adopts a point cloud-based mapping framework. The input is a pre-scanned, high-density LiDAR point cloud of the substation. The methodology involves processing this raw point cloud into a 3D occupancy grid map through steps including ground filtering, noise removal, and obstacle inflation. This hybrid approach leverages the geometric fidelity of point clouds for accurate obstacle representation while converting it into a voxelized occupancy grid to enable efficient, deterministic collision checking during the planning phase—a critical requirement for real-time performance in dense environments. This choice is justified as it strikes an optimal balance for the substation inspection task: it maintains the environmental detail necessary for safe navigation around complex apparatus while providing the computational structure needed for fast and reliable path planning.
The compact structure and dense obstacles of substations introduce significant spatial complexity, imposing higher requirements on UAV path planning algorithms in terms of environmental modeling accuracy, obstacle avoidance, and computational efficiency. The first category includes graph search-based algorithms such as A* search algorithm (A*) [16] and Dijkstra [17], which ensure global optimality but perform poorly in dynamic environments. The second category comprises sampling-based algorithms such as Rapidly-exploring Random Tree (RRT) [18] and Probabilistic Roadmap (PRM) [19], which are effective in high-dimensional spaces but often generate non-smooth or directionally random paths. The third category involves optimization-based methods, including Artificial Potential Field (APF) [20] and Gradient Descent (GD) [21], which produce smooth trajectories but are susceptible to local minima and may fail to guarantee global feasibility.
The RRT algorithm has been widely used for global path planning due to its scalability and efficiency in high-dimensional environments. Its improved version, RRT* [22], enhances path quality by optimizing parent node selection to ensure local path optimality, gradually refining the overall tree structure. However, most existing research remains limited to two-dimensional applications, while challenges persist in extending these algorithms to complex 3D environments such as substations, where densely packed obstacles and narrow spaces increase planning difficulty.
In recent years, several enhanced RRT-based algorithms have been developed to address these issues. The Bidirectional Adaptive Multi-objective RRT* (Bi-AM-RRT*) improves planning efficiency and search performance in dynamic environments through adaptive node expansion metrics [23]. The algorithm that employs a K-Dimensional Tree (KD-Tree) to accelerate searches in dense environments with point cloud data is termed the KD-Tree-based RRT (BTO-RRT) [24]. The Alternative Paths and Triangular Sampling RRT* (ATS-RRT*) optimizes convergence speed and path quality via alternative paths and triangular area sampling strategies [25]. The Continuous Bidirectional Quick-RRT* (CBQ-RRT*) algorithm further enhances search efficiency and path smoothness through continuous bidirectional reconnection [26]. Given our focus on static environments with prior maps, it should be noted that these approaches still face difficulties in the specific context of dense and static substation environments—such as maintaining sufficient obstacle clearance, avoiding deadlocks in narrow spatial searches, and ensuring smooth, continuous paths suitable for automated inspection.
Apart from classical and improved sampling-based methods, the field of path planning has also shown growing interest in data-driven approaches, particularly deep learning techniques. A survey focusing on mobile robots has systematically summarized the applications of Deep Reinforcement Learning (DRL) in SLAM and autonomous navigation, providing a reference for related technology trends [27]. Such methods are capable of learning navigation policies directly from sensor inputs to address path planning challenges in complex 3D obstacle-ridden environments. In addressing path planning with complex constraints, research has applied DRL to generate 3D UAV paths that satisfy specific connectivity requirements [28]. Concurrently, to meet the real-time demands of online planning, work has been done to improve response efficiency in unknown environments by dynamically adjusting the iterative process of classical Q-learning [29]. However, for structured and safety-critical tasks such as substation inspection, these methods still face fundamental challenges. Firstly, they heavily rely on large-scale, high-quality training data. Yet, substations feature complex layouts, diverse equipment, and safety constraints, making it difficult to construct comprehensively covered, annotated datasets. Secondly, the decision-making process of deep learning models lacks interpretability, making it difficult to provide the formal safety assurances required for industrial-grade applications. The robustness of their performance is also hard to guarantee in environmental configurations not covered by the training set. Therefore, this paper focuses on industrial inspection scenarios with known high-precision prior maps and adopts a deterministic, geometry-based planning approach. Within highly structured environments, the proposed method achieves efficient search and obstacle avoidance through rigorous geometric computations and deterministic logic, thereby avoiding the uncertainties inherent in data-driven methods and providing a verifiable, reproducible, and reliable solution for automated inspection.
To address the aforementioned challenges, this study first develops a 3D occupancy grid mapping framework specifically designed for substation environments. The framework systematically processes LiDAR point cloud data for ground filtering, noise removal, and safety-aware obstacle expansion using spherical structuring elements, providing a reliable spatial representation for UAV navigation in equipment-dense environments.
At the path planning level, an improved algorithm termed the Random Geometric Graph (RGG)-guided Rapidly-exploring Random Tree (R-RRT) is proposed, which integrates multiple strategies with the following key enhancements: (1) dynamic goal-biasing strategy: adaptively adjusts sampling probability based on the history of successful expansions, effectively balancing global exploration and local convergence; (2) RGG-guided sampling: optimizes the growth direction of the random tree, significantly reducing invalid node generation; (3) KD-Tree-based fast collision detection: enhances real-time performance in complex environments; (4) two-stage path optimization: employs greedy pruning to remove redundant nodes and gradient-based smoothing to improve trajectory quality.
2 Construction of Navigation Grid Maps for Substation Inspection
This section presents a complete technical solution for constructing navigation grid maps specifically tailored for substation environments. The framework systematically integrates three core components: (1) point cloud acquisition and preprocessing, involving LiDAR data collection with ground point filtering and noise removal; (2) 3D voxel space and occupancy map generation, converting processed point clouds into discrete voxel grids through coordinate mapping; and (3) equipment safety expansion, incorporating UAV physical dimensions and safety margins using morphological dilation. This pipeline transforms raw point cloud data into a navigable environment model for UAV path planning.
2.1 Map Data Acquisition and Preprocessing
The data acquisition phase employs LiDAR and 3D scanners to capture 3D point clouds of the substation environment. This study designs a point cloud preprocessing pipeline that systematically integrates data acquisition, hierarchical ground filtering, and statistically-based noise removal methods to address environmental modeling requirements in substation inspection.
2.1.1 Ground Point Cloud Filtering
To address the challenge of mixed terrain and equipment in substation environments, a hierarchical ground-non-ground separation framework is designed. The approach integrates filtering algorithms based on complementary principles: a height threshold method for fast coarse segmentation, followed by a RANdom SAmple Consensus (RANSAC) plane fitting strategy for robust refinement. This two-stage workflow ensures both computational efficiency and segmentation accuracy.
• Height Threshold Method: A height threshold
where
• Plane Fitting Method: Since height thresholding alone is insufficient when ground surfaces exhibit slight slopes or undulations, a RANSAC-based plane fitting algorithm is employed to model the ground surface robustly in the presence of outliers. The ground plane is expressed as:
The Euclidean distance between each point and the estimated plane is computed as:
where
Given the relatively flat terrain and limited sensor noise in typical substation environments, this study experimentally selects
To mitigate noise introduced by sensor measurement errors and environmental interference, this study adopts a statistical filtering method based on local spatial consistency. The method assumes that points belonging to real object surfaces exhibit strong local density and geometric continuity, whereas noise points lack such structural support and therefore appear spatially isolated.
• Statistical Filtering: Noise identification is performed by inspecting the neighborhood characteristics of each point. The neighborhood
Based on this definition, the denoised point cloud is obtained as:
where
The radius parameter is set to
The threshold for neighbor count is determined through empirical analysis. Since isolated noise points typically exhibit fewer than 8–15 neighbors, this study sets
Therefore, the denoising filter defined by Eqs. (4) and (5) effectively removes spatially isolated points based on the chosen parameters
2.2 3D Voxel Space and Occupancy Map Construction
To transform the continuous 3D point cloud space into a discrete representation suitable for path planning, a structured voxel grid space is constructed. The dimensions of this space are determined by the spatial distribution range of valid point cloud data. Assuming the grid map has a uniform resolution R in all three dimensions, the required number of voxels
where
The mapping relationship from point cloud coordinates to voxel coordinates is defined by:
where
This mapping, formulated in Eq. (7), performs a translation and scaling transformation: first, subtract the minimum value
2.3 Equipment Dilation in Substation Environment
To ensure the flight safety of UAVs in complex substation environments, both the physical size of the UAV and a sufficient safety margin must be considered. This study employs a 3D morphological dilation algorithm to expand the safety boundaries of equipment point clouds. The core of this process is to construct a reasonable dilation radius calculation model that comprehensively considers the UAV’s physical radius
where
In this work, the UAV used has a maximum diagonal dimension of approximately
This design ensures that during flight, the UAV not only avoids physical contact with obstacles but also maintains an adequate buffer zone to account for operational uncertainties, thereby meeting the safety requirements for inspection operations in dense substation environments.
To uniformly expand the safety area in 3D space, a spherical structuring element is used for dilation, mathematically expressed as:
where K is the spherical structuring element (kernel),
The targets of the dilation operation are all obstacles in the original occupancy map. By traversing the voxel grid map
where O is the set of all obstacle voxels,
For each obstacle voxel
where
The search range for the dilation operation in Eq. (11) is limited to a cubic neighborhood centered on
This operation evaluates, for each candidate position
The dilation process handles obstacles sequentially, but the final result correctly merges multiple expansions through the maximum operation in Eq. (11), ultimately generating the dilated map that includes safety margins.
During the dilation process, neighborhood searches may extend beyond the map boundaries. To prevent out-of-bounds access, a boundary constraint function is introduced:
where
The constraint function defined in Eq. (13) achieves constraint through two-level truncation: first using
3 Path Planning for UAV Inspection Based on Grid Map
Building upon the 3D occupancy grid map constructed in Section 2, which provides a structured environmental representation for collision detection and navigation, an improved RRT algorithm named R-RRT is proposed for UAV inspection path planning. By integrating random geometric graph-guided sampling with multi-stage path optimization strategies, the proposed algorithm significantly enhances the planning performance of traditional RRT in complex substation environments.
Fig. 1 illustrates the overall workflow of the proposed UAV inspection path planning framework. The planning process is initialized with the voxelized grid map, which encodes obstacle information from 3D point cloud data. During the path search process, the algorithm introduces a dynamic goal-biasing strategy that adaptively adjusts the target sampling probability according to the search progress. This strategy enhances exploration in the early search stage to cover the global space, while reinforcing goal-directed guidance in the later stage to accelerate path convergence, effectively balancing global search capability and local convergence speed.

Figure 1: Flowchart of the proposed UAV inspection path planning framework.
Secondly, to avoid the waste of numerous invalid sampling points in traditional random sampling, a sampling mechanism based on RGG is designed. In the initialization phase, a large number of uniformly distributed spatial sampling points are pre-generated. During the planning phase, optimal sampling points are selected from the RGG for tree expansion by combining current node direction information. This approach reduces invalid sampling and improves both sampling efficiency and path quality.
For collision detection, the algorithm constructs a KD-Tree-based data structure to accelerate path validity verification. During each path expansion, obstacle avoidance detection is performed only on key connecting segments through nearest-neighbor search, significantly reducing the computational complexity of collision detection.
Finally, to generate smooth trajectories suitable for actual flight, path post-processing optimization is performed after the search completion. Specifically, this includes: employing a greedy pruning strategy to remove redundant nodes in the path, and using the gradient descent method for path smoothing under safety constraints, thereby obtaining more continuous trajectories with smaller curvature that are executable by UAVs.
3.1 Dynamic Goal Biasing Strategy
Goal biasing is a crucial mechanism in sampling-based path planning algorithms. Its main idea is to select the goal point as a candidate node with a certain probability during the random sampling process, thereby accelerating the convergence of the search tree toward the goal region. In the traditional RRT algorithm, this goal biasing probability is fixed (typically between 5% and 10%), which limits adaptability in complex or dynamic environments. A fixed probability may lead to insufficient exploration in the early stage or slow convergence in the later stage.
To overcome this limitation, this paper proposes a novel mechanism for dynamic goal biasing that utilizes feedback from successful tree extensions. This mechanism adaptively adjusts the sampling probability
Here,
This adaptive mechanism enables the algorithm to maintain strong exploratory behavior in the initial phase and achieve faster convergence in the later phase, thus improving the overall planning efficiency. Moreover, it enhances the algorithm’s adaptability in dynamic and complex environments by continuously balancing global exploration and local refinement. The detailed procedure is shown in Algorithm 1.

Algorithm 1 illustrates the adaptive goal-biased sampling mechanism. The sampling probability dynamically increases with the number of successful extensions, ensuring an optimal trade-off between exploration and exploitation throughout the planning process. Computationally, this strategy introduces minimal overhead: updating
3.2 Incorporating RGG to Optimize Sampling
RGG is an effective tool in graph theory, widely used to optimize the sampling process in path planning algorithms. In the traditional RRT algorithm, sampling points are usually completely random. The distribution of sampling points may concentrate in certain areas while neglecting others, leading to a large number of invalid nodes, especially inside obstacles or redundant regions. This results in low search efficiency and poor path quality. To address this issue, this paper proposes an optimized sampling strategy based on RGG.
In this improved strategy, we pre-generate an RGG on the map, consisting of 1000 uniformly distributed sampling points. These points not only cover various regions of the map but also avoid the node redundancy and over-concentration problems that may appear in the traditional RRT algorithm. Then, during the sampling phase of path planning, the algorithm selects the goal point with a certain probability (using the goal_bias strategy). If the goal is not selected, the algorithm chooses a sample point from the RGG that aligns with the current target direction via the function selectBestRGG. This approach ensures that the sampling points guide the search tree to grow towards the target region as much as possible. The corresponding pseudocode is provided in Algorithm 2.

To improve search efficiency, we also integrate a KD-Tree structure (rggKDTree) to quickly retrieve and select the optimal candidate sampling points. The use of KD-Tree enables near-optimal fast search in high-dimensional space, effectively reducing invalid sampling and redundant computations. Computationally, the RGG-guided sampling involves two phases with distinct complexity profiles: the offline preprocessing requires
3.3 Fast Collision Checking Optimization Based on KD-Tree
Collision checking is a critical component in 3D UAV path planning, as it directly affects both the feasibility of the generated path and the real-time responsiveness of the planning system. In the standard RRT algorithm, each path extension typically involves a voxel-by-voxel traversal to evaluate collisions along the entire candidate segment. This approach, while accurate in dense 3D environments reconstructed from point clouds, requires examining a large number of voxel units at each step, resulting in significant computational overhead and reduced efficiency, especially under real-time constraints.
To address this limitation, we propose a fast local collision checking strategy based on a KD-Tree structure, integrated into the improved R-RRT framework. This method constructs and dynamically maintains a KD-Tree to organize the nodes in the current search tree, enabling efficient nearest-neighbor queries in high-dimensional space. During each expansion, instead of checking the entire path globally, the algorithm performs collision detection only on the straight-line segment between the newly generated node and its nearest neighbor in the tree. This significantly reduces the number of voxel checks and accelerates the overall planning process.
More specifically, the search begins by initializing the search tree with the start node
This process is summarized in Algorithm 3, where the RRT tree and KD-Tree are initialized, and iterative sampling, extension, and collision checking are performed. If a feasible path is found, it is extracted by backtracking from the final node; otherwise, an empty path and infinite cost are returned.
The proposed KD-Tree-based local collision checking strategy is designed to accelerate the collision detection process compared to traditional voxel-by-voxel methods, with the aim of enhancing overall planning efficiency in dense 3D environments like substations. Its effectiveness will be quantitatively evaluated in the following experimental section.

The algorithm outlines the complete R-RRT planning process with KD-Tree acceleration. Computationally, the collision checking module operates in two stages with distinct complexity characteristics: offline construction of a KD-Tree from the obstacle map containing
3.4 Path Post-processing and Gradient Optimization
The paths generated by the traditional RRT algorithm are typically a series of discrete and discontinuous points, suffering from issues such as excessive redundant nodes, severe path zigzags, and poor trackability, making them difficult to directly apply in practical UAV systems. To improve the executability and energy efficiency of the paths, this paper proposes a two-stage path optimization mechanism: Greedy Pruning and Gradient-Based Smoothing.
Path Pruning Optimization: Redundant nodes in the original path are recursively removed. Specifically, starting from the initial point, the algorithm checks whether the current node can directly connect to the
Gradient-Based Smoothing: We design a gradient descent-based path optimization method. The core idea is to minimize either the curvature variation or the jerk of the path as the objective function, while satisfying obstacle avoidance and dynamic constraints, locally adjusting the path points. By setting soft constraints (e.g., maximum offset radius) and hard constraints (e.g., no entry into obstacle regions), the algorithm gradually approaches a continuous, differentiable, and smooth trajectory, suitable for UAV control systems.
The optimization process can be expressed by the following objective function:
where
The optimization reduces the “zigzagging” in the path, resulting in a more coherent and smooth trajectory, which benefits UAV flight control and attitude maintenance.
The path optimization is subject to the following obstacle avoidance constraints:
where
The gradient-based smoothing process, governed by the objective function in Eq. (15) and the constraints in Eq. (16), is applied to enhance path continuity and safety. Computationally, the two-stage post-processing demonstrates efficiency in both time and space: for a path with
4 Simulation Experiments and Result Analysis
To verify the effectiveness of the proposed method, simulation tests were conducted using specific case studies. All experiments were conducted on a computational platform equipped with an AMD Ryzen 9 7945HX processor, an NVIDIA GeForce RTX 4060 GPU with 8 GB of VRAM, and 16 GB of DDR5 RAM. Algorithm implementation and testing were performed in MATLAB R2022b.
The point cloud data used in the experiments are shown in Fig. 2, including the raw input point cloud and the pre-processed point cloud. Fig. 3 presents the grid maps before and after obstacle inflation, where the

Figure 2: Point cloud data used in the experiments: (a) raw input point cloud; (b) pre-processed point cloud.

Figure 3: Experimental environment modeling results: (a) initial voxel grid; (b) inflated voxel grid.
4.1 Computational Complexity Analysis
This section provides a comprehensive theoretical complexity analysis of all path planning algorithms evaluated in this study, including the proposed R-RRT and the baseline algorithms (A*, RRT*, Bi-AM-RRT*, BTO-RRT, and CBQ-RRT*). The analysis examines both time and space complexity, as these factors jointly determine the practicality of algorithms in resource-constrained UAV systems. Let
Table 1 demonstrates that the proposed R-RRT achieves a time complexity of

The comparison reveals a key design insight: while algorithms like RRT* and Bi-AM-RRT* suffer from the
To comprehensively evaluate the path planning performance of the proposed R-RRT algorithm, experimental scenarios are designed from two perspectives: local path optimization and global path generation. All tests were conducted on a voxel grid map with a resolution of
Intra-Region Path Planning: The positions of the starting and target observation points are listed in Table 2. Fig. 4 shows the path planning results for the A*, RRT*, Bi-AM-RRT*, BTO-RRT, CBQ-RRT*, and the proposed R-RRT algorithms. Table 3 provides a comparative performance analysis of the six algorithms.


Figure 4: Path planning algorithms comparison in intra-regional scenarios: (a) three-dimensional view of path planning algorithms; (b) overhead plan view of path planning algorithms.

Inter-Region Path Planning: The positions of starting, main transformer, and gantry observation points are given in Table 4. Fig. 5 shows the path planning results for the A*, RRT*, Bi-AM-RRT*, BTO-RRT, CBQ-RRT*, and the proposed R-RRT algorithms. Table 5 presents the performance comparison results of the six algorithms.


Figure 5: Path planning algorithms comparison in inter-regional scenarios: (a) three-dimensional view of path planning algorithms; (b) overhead plan view of path planning algorithms.

Figs. 4 and 5 present typical path planning results of six algorithms: A* [16], RRT* [22], the proposed R-RRT, Bi-AM-RRT* [23], BTO-RRT [24], and CBQ-RRT* [26] in the complex 3D substation environment. The path morphologies generated by these algorithms reflect their distinctive search strategy characteristics and environmental adaptability under complex obstacle distributions.
The A* algorithm demonstrates strong goal-directedness, enabling rapid approach toward the target in open areas. However, due to the inflexibility of its heuristic function in obstacle-dense regions, the path exhibits noticeable detours and sharp turns, resulting in high overall tortuosity and insufficient path smoothness.
The RRT* algorithm, expanding through random sampling, shows good obstacle avoidance capability. Nevertheless, the lack of adaptive guidance leads to “up-floating” or oscillatory paths during the search process, with relatively long path lengths and poor smoothness, which is unfavorable for stable UAV flight in complex 3D spaces.
The Bi-AM-RRT* algorithm, under the effect of bidirectional search and adaptive sampling, produces generally smoother paths. However, it still suffers from local oscillations in obstacle-intensive areas and has limited turning control capability. The BTO-RRT algorithm excels in search efficiency, achieving the shortest planning time, but its paths are longer with more frequent turns, and smoothness is slightly less smooth than R-RRT. Similarly, CBQ-RRT*, with its dual-tree and smoothing operations, enhances connectivity and smoothness to some extent; however, its paths can still show unnecessary spatial deviations and do not consistently converge to the shortest possible trajectory.
In contrast, the proposed R-RRT algorithm introduces RGG-guided sampling and a KD-tree structure into the traditional RRT framework, significantly enhancing sampling space representativeness and search efficiency. Meanwhile, the dynamic goal-biasing strategy based on successful expansion feedback maintains global exploration capability during the initial search phase and progressively strengthens convergence toward the goal direction in later stages, achieving a balance between global search and local optimality. In the post-processing phase, R-RRT employs a two-stage path optimization strategy comprising greedy pruning and gradient descent smoothing, effectively reducing redundant nodes and sharp turning points, thereby improving path continuity and flight executability.
Visually from the figures, the paths generated by R-RRT are more compact and smooth overall, capable of quickly returning to the main direction after obstacle avoidance, with minimal spatial fluctuations, gentle turning angles, and almost no sharp turns. Compared to A*, RRT*, and other algorithms, R-RRT demonstrates superior path controllability and spatial adaptability in complex obstacle environments, better meeting the requirements for smooth and executable paths in substation environments for UAVs.
The two sets of experimental data in Tables 3 and 5 quantitatively compare the performance of the six algorithms in terms of search efficiency, path quality, and smoothness metrics.
In terms of search time, BTO-RRT achieved the shortest planning time of 0.0629 s in the first experiment, while R-RRT recorded competitive times of 0.0698 and 0.0873 s in the two experiments, respectively, ranking among the fastest. Notably, in the second experiment, R-RRT’s planning time surpassed all other compared algorithms, demonstrating its stable and efficient real-time planning capability across different scenarios. Overall, while BTO-RRT was the fastest in a single trial, R-RRT achieved a superior balance between computational speed and path quality, without significantly sacrificing path optimality for extreme speed.
Regarding path length, the R-RRT algorithm achieved the shortest paths in both experiments at 323.8981 and 579.3565 m, significantly outperforming the other algorithms. This indicates that its improved sampling mechanism and goal-biasing strategy effectively reduce redundant search and enable rapid generation of near-optimal feasible paths.
In terms of path point count and turning characteristics, R-RRT generated the fewest path points (13 and 25) and significantly reduced the number of turns. Its maximum turning angles were only
In summary, R-RRT performs best in terms of path length, smoothness, and turning control, while BTO-RRT holds an advantage in computational efficiency. Bi-AM-RRT* shows slight improvement in path smoothness but lacks the search stability of R-RRT. Although CBQ-RRT* aims to enhance path smoothness, it still falls short in path optimality and geometric simplicity. Overall, R-RRT achieves dual excellence in both planning quality and search efficiency in complex 3D scenarios.
Integrating the qualitative and quantitative results, the improved R-RRT algorithm demonstrates outstanding path planning performance in complex 3D substation environments. By introducing RGG and KD-tree structures to enhance search efficiency, combining a dynamic goal-biasing mechanism to strengthen goal-directedness, and employing a two-stage path smoothing optimization strategy to significantly improve path continuity, R-RRT outperforms A*, RRT*, Bi-AM-RRT*, BTO-RRT, and CBQ-RRT* in path length, smoothness, and spatial adaptability. The algorithm not only generates shorter and smoother feasible paths but also exhibits clear advantages in search stability and environmental adaptability, validating the effectiveness and practical value of R-RRT for UAV path planning tasks in complex 3D spaces.
To enhance the path planning performance of the RRT algorithm in dense three-dimensional environments, this paper proposes an R-RRT. The method builds upon a 3D occupancy grid map that integrates ground filtering and obstacle inflation, achieving performance improvements through the following mechanisms: First, a dynamic goal-biasing strategy is designed to adaptively adjust the sampling probability distribution based on the historical expansion success rate, effectively balancing global exploration and local convergence. Second, an RGG-guided sampling mechanism is introduced to optimize the growth direction of the random tree through a predefined spatial topological structure, significantly improving path search efficiency and reducing the generation of invalid nodes. To address the issue of redundant turning points in initial paths, a two-stage optimization strategy is proposed: initially removing redundant nodes using a greedy pruning algorithm, followed by trajectory smoothing via a gradient descent method, ensuring the generated paths meet the practical flight requirements of UAVs. Experimental results demonstrate that in typical three-dimensional substation scenarios, R-RRT outperforms mainstream comparative algorithms in key metrics including path length, planning time, and trajectory smoothness.
It should be noted that R-RRT is primarily optimized for static environments with high-fidelity prior maps, and its performance may be limited in the following scenarios: sudden or moving obstacles may exceed the algorithm’s current real-time replanning capability, leading to suboptimal or unsafe paths; frequent updates to environmental maps may cause planning delays or reduced path feasibility; measurement noise may degrade the accuracy of the occupancy grid, potentially resulting in collision risks or overly conservative path planning. To address these challenges, future research will focus on three main directions: (1) integrating a real-time replanning module with dynamic obstacle prediction; (2) enhancing environmental adaptability through incremental map updating and multi-sensor fusion; and (3) improving computational efficiency in highly complex scenarios via parallel computing and adaptive sampling. These enhancements will extend the applicability of the method to semi-dynamic industrial inspection tasks.
Acknowledgement: Not applicable.
Funding Statement: Funding for this research was provided by the Program for Scientific Research Innovation Team in Colleges and Universities of Anhui Province (No. 2022AH010095) and the Hefei Key Technology R&D “Champion-Based Selection” Project (No. 2023SGJ011).
Author Contributions: The authors confirm their contributions to this paper as follows: study conception by Yanping Chen and Zhengxin Zhan; research methodology design by Xiaohui Yan; software development by Zhengxin Zhan; validation by Le Zou; formal analysis by Hailei Wang; investigation by Yucheng Zhong; resources provision by Hailei Wang; data curation by Zhengxin Zhan; original draft preparation by Yanping Chen and Zhengxin Zhan; review and editing by Le Zou; visualization by Yucheng Zhong; supervision by Xiaohui Yan and Le Zou; project administration by Hailei Wang; funding acquisition by Yanping Chen. All authors reviewed and approved the final version of the manuscript.
Availability of Data and Materials: Not applicable.
Ethics Approval: Not applicable.
Conflicts of Interest: The authors declare no conflicts of interest.
References
1. Bouzid Y, Siguerdidjane H, Bestaoui Y. Flight control boosters for three-dimensional trajectory tracking of quadrotor: theory and experiment. Proc Inst Mech Eng Part I J Syst Control Eng. 2018;232(6):709–27. doi:10.1177/0959651818757159. [Google Scholar] [CrossRef]
2. Mukhamediev RI, Yakunin K, Aubakirov M, Assanov I, Kuchin Y, Symagulov A, et al. Coverage path planning optimization of heterogeneous UAVs group for precision agriculture. IEEE Access. 2023;11:5789–803. doi:10.1109/ACCESS.2023.3235207. [Google Scholar] [CrossRef]
3. Khan NA, Jhanjhi NZ, Brohi SN, Usmani RSA, Nayyar A. Smart traffic monitoring system using unmanned aerial vehicles (UAVs). Comput Commun. 2020;157(4):434–43. doi:10.1016/j.comcom.2020.04.049. [Google Scholar] [CrossRef]
4. Dissanayaka D, Wanasinghe TR, De Silva O, Jayasiri A, Mann GKI. Review of navigation methods for UAV-based parcel delivery. IEEE Trans Autom Sci Eng. 2024;21(1):1068–82. doi:10.1109/TASE.2022.3232025. [Google Scholar] [CrossRef]
5. Du Q, Dong W, Su W, Wang Q. UAV inspection technology and application of transmission line. In: Proceedings of the 2022 IEEE 5th International Conference on Information Systems and Computer Aided Education (ICISCAE); 2022 Sep 23–25; Dalian, China. Piscataway, NJ, USA: IEEE; 2022. p. 594–7. doi:10.1109/ICISCAE55891.2022.9927674. [Google Scholar] [CrossRef]
6. Luo Y, Yu X, Yang D, Zhou B. A survey of intelligent transmission line inspection based on unmanned aerial vehicle. Artif Intell Rev. 2023;56(1):173–201. doi:10.1007/s10462-022-10189-2. [Google Scholar] [CrossRef]
7. Gaspar J, Cruz T, Lam CT, Simões P. Smart substation communications and cybersecurity: a comprehensive survey. IEEE Commun Surv Tutor. 2023;25(4):2456–93. doi:10.1109/COMST.2023.3305468. [Google Scholar] [CrossRef]
8. Yang X, Ye X, Cao J, Yan R, Guo X, Huang J. High-altitude inspection technology of substation based on fusion of unmanned aerial vehicle and multiple sensors. Sens Mater. 2022;34(8):3191–212. doi:10.18494/SAM3933. [Google Scholar] [CrossRef]
9. Guan H, Sun X, Su Y, Hu T, Wang H, Wang H, et al. UAV-lidar aids automatic intelligent powerline inspection. Int J Electr Power Energy Syst. 2021;130:106987. doi:10.1016/j.ijepes.2021.106987. [Google Scholar] [CrossRef]
10. Fan Z, Zhang L, Wang X, Shen Y, Deng F. LiDAR, IMU, and camera fusion for simultaneous localization and mapping: a systematic review. Artif Intell Rev. 2025;58(6):1–59. doi:10.1007/s10462-025-11187-w. [Google Scholar] [CrossRef]
11. Hornung A, Wurm KM, Bennewitz M, Stachniss C, Burgard W. OctoMap: an efficient probabilistic 3D mapping framework based on octrees. Auton Robot. 2013;34(3):189–206. doi:10.1007/s10514-012-9321-0. [Google Scholar] [CrossRef]
12. Ren Y, Cai Y, Zhu F, Liang S, Zhang F. ROG-Map: an efficient robocentric occupancy grid map for large-scene and high-resolution lidar-based motion planning. In: Proceedings of the 2024 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS); 2024 Oct 14–18; Abu Dhabi, United Arab Emirates. Piscataway, NJ, USA: IEEE; 2024. p. 8119–25. doi:10.1109/iros58592.2024.10802303. [Google Scholar] [CrossRef]
13. Peng CC, Wang CY. Design of constrained dynamic path planning algorithms in large-scale 3D point cloud maps for UAVs. J Comput Sci. 2023;67(2):101944. doi:10.1016/j.jocs.2023.101944. [Google Scholar] [CrossRef]
14. Geng S, Ning Z, Zhang F, Zhou B. EPIC: a lightweight lidar-based UAV exploration framework for large-scale scenarios. IEEE Robot Autom Lett. 2025;10(5):5090–7. doi:10.1109/LRA.2025.3555878. [Google Scholar] [CrossRef]
15. Zhao W, Wang H, Liu YJ, Liu L. An improved RRT* drone three-dimensional path-planning algorithm based on point cloud maps. Proc Inst Mech Eng Part I J Syst Control Eng. 2024;37:09596518241291182. doi:10.1177/09596518241291182. [Google Scholar] [CrossRef]
16. Hart PE, Nilsson NJ, Raphael B. A formal basis for the heuristic determination of minimum cost paths. IEEE Trans Syst Sci Cybern. 1968;4(2):100–7. doi:10.1109/tssc.1968.300136. [Google Scholar] [CrossRef]
17. Alshammrei S, Boubaker S, Kolsi L. Improved Dijkstra algorithm for mobile robot path planning and obstacle avoidance. Comput Mater Contin. 2022;72(3):5939–54. doi:10.32604/cmc.2022.028165. [Google Scholar] [CrossRef]
18. LaValle SM, Kuffner JJ Jr. Randomized kinodynamic planning. Int J Robot Res. 2001;20(5):378–400. doi:10.1177/02783640122067453. [Google Scholar] [CrossRef]
19. Kavraki LE, Svestka P, Latombe JC, Overmars MH. Probabilistic roadmaps for path planning in high-dimensional configuration spaces. IEEE Trans Robot Autom. 2002;12(4):566–80. doi:10.1109/70.508439. [Google Scholar] [CrossRef]
20. Khatib O. Real-time obstacle avoidance for manipulators and mobile robots. Int J Robot Res. 1986;5(1):90–8. doi:10.1177/027836498600500106. [Google Scholar] [CrossRef]
21. Pore E, Patle BK, Thorat S. Multi-drone path planning using gradient descent and potential fields for warehouse applications. In: Proceedings of the 2024 International Automatic Control Conference (CACS); 2024 Oct 31–Nov 3; Taoyuan, Taiwan. Piscataway, NJ, USA: IEEE; 2024. p. 1–6. doi:10.1109/CACS63404.2024.10773359. [Google Scholar] [CrossRef]
22. Chen L, Shan Y, Tian W, Li B, Cao D. A fast and efficient double-tree RRT*-like sampling-based planner applying on mobile robotic systems. IEEE-ASME Trans Mechatron. 2018;23(6):2568–78. doi:10.1109/tmech.2018.2821767. [Google Scholar] [CrossRef]
23. Zhang Y, Wang H, Yin M, Wang J, Hua C. Bi-AM-RRT*: a fast and efficient sampling-based motion planning algorithm in dynamic environments. IEEE Trans Intell Veh. 2023;9(1):1282–93. doi:10.1109/tiv.2023.3307283. [Google Scholar] [CrossRef]
24. Zheng Z, Bewley TR, Kuester F. Point cloud-based target-oriented 3D path planning for UAVs. In: Proceedings of the 2020 International Conference on Unmanned Aircraft Systems (ICUAS); 2020 Sep 1–4; Athens, Greece. Piscataway, NJ, USA: IEEE; 2020. p. 1–8. doi:10.1109/icuas48674.2020.9213894. [Google Scholar] [CrossRef]
25. Zhang ZW, Jia YW, Su QQ, Chen XT, Fu BP. ATS-RRT*: an improved RRT* algorithm based on alternative paths and triangular area sampling. Adv Robot. 2023;37(10):605–20. doi:10.1080/01691864.2023.2174817. [Google Scholar] [CrossRef]
26. Ye L, Li J, Li P. Improving path planning for mobile robots in complex orchard environments: the continuous bidirectional Quick-RRT* algorithm. Front Plant Sci. 2024;15:1337638. doi:10.3389/fpls.2024.1337638. [Google Scholar] [PubMed] [CrossRef]
27. Waga A, Benhlima S, Bekri A, Abdouni J, Saber FZ. A survey on autonomous navigation for mobile robots: from traditional techniques to deep learning and large language models. J King Saud Univ Comput Inf Sci. 2025;37(7):198. doi:10.1007/s44443-025-00216-x. [Google Scholar] [CrossRef]
28. Xie H, Yang D, Xiao L, Lyu J. Connectivity-aware 3D UAV path design with deep reinforcement learning. IEEE Trans Veh Technol. 2021;70(12):13022–34. doi:10.1109/TVT.2021.3121747. [Google Scholar] [CrossRef]
29. Rocha LGS, Caldas KAQ, Terra MH, Ramos F, Vivaldini KCT. Dynamic Q-planning for online UAV path planning in unknown and complex environments. Int J Intell Robot Appl. 2025;9(4):1654–74. doi:10.1007/s41315-025-00457-z. [Google Scholar] [CrossRef]
Cite This Article
Copyright © 2026 The Author(s). Published by Tech Science Press.This work is licensed under a Creative Commons Attribution 4.0 International License , which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.


Submit a Paper
Propose a Special lssue
View Full Text
Download PDF
Downloads
Citation Tools