OkayPlan: Obstacle Kinematics Augmented Dynamic Real-time Path Planning via Particle Swarm Optimization

Jinghao Xin,Jinwoo Kim,Shengjia Chu,Ning Li

DOI: https://doi.org/10.1016/j.oceaneng.2024.117841

2024-04-12

Abstract:Existing Global Path Planning (GPP) algorithms predominantly presume planning in static environments. This assumption immensely limits their applications to Unmanned Surface Vehicles (USVs) that typically navigate in dynamic environments. To address this limitation, we present OkayPlan, a GPP algorithm capable of generating safe and short paths in dynamic scenarios at a real-time executing speed (125 Hz on a desktop-class computer). Specifically, we approach the challenge of dynamic obstacle avoidance by formulating the path planning problem as an Obstacle Kinematics Augmented Optimization Problem (OKAOP), which can be efficiently resolved through a PSO-based optimizer at a real-time speed. Meanwhile, a Dynamic Prioritized Initialization (DPI) mechanism that adaptively initializes potential solutions for the optimization problem is established to further ameliorate the solution quality. Additionally, a relaxation strategy that facilitates the autonomous tuning of OkayPlan's hyperparameters in dynamic environments is devised. Comprehensive experiments, including comparative evaluations, ablation studies, and \textcolor{black}{applications to 3D physical simulation platforms}, have been conducted to substantiate the efficacy of our approach. Results indicate that OkayPlan outstrips existing methods in terms of path safety, length optimality, and computational efficiency, establishing it as a potent GPP technique for dynamic environments. The video and code associated with this paper are accessible at

Robotics

What problem does this paper attempt to address?

The problem that this paper attempts to solve is to provide efficient, real - time and safe global path planning (GPP) for unmanned surface vessels (USVs) in dynamic environments. Most existing GPP algorithms assume that the environment is static, which greatly limits their applications in dynamic environments, such as the marine environment where USVs usually need to navigate. The existence of dynamic obstacles makes the method of relying solely on local path planning (LPP) for obstacle avoidance have potential safety hazards, especially when USVs' operations are more complicated under the influence of factors such as under - control, nonlinear dynamics, environmental interference and uncertainty. Therefore, the paper proposes a new GPP algorithm - OkayPlan, aiming to solve the following key problems:

1. **Consideration of dynamic obstacle motion**: Existing GPP algorithms fail to fully consider the motion of dynamic obstacles and only rely on LPP to handle the avoidance of dynamic obstacles, which is unreasonable when USVs face challenges such as under - control, nonlinear dynamics, environmental interference and uncertainty. OkayPlan incorporates the motion of dynamic obstacles into the planning process by introducing the Obstacle Kinematics - Augmented Optimization Problem (OKAOP), thus generating safer paths.

2. **Real - time planning implementation**: Many existing GPP algorithms cannot achieve efficient real - time planning, which is a major drawback for USVs operating in dynamic marine environments. OkayPlan can achieve real - time planning at a frequency of up to 125 Hz, significantly improving the planning speed.

3. **Optimization of path length**: Given the limited energy resources of USVs, finding shorter paths can significantly extend their operating range. OkayPlan not only improves the safety of paths but also optimizes the path length, making it more practical in dynamic environments.

To achieve the above goals, the paper proposes the following key techniques:

- **Obstacle Kinematics - Augmented Optimization Problem (OKAOP)**: Represent the instantaneous velocity of dynamic obstacles as line segments and integrate them into the configuration space to predict the future trajectories of obstacles and assist path planning.
- **Dynamic Priority Initialization mechanism (DPI)**: Adaptively initialize the particles of Particle Swarm Optimization (PSO) according to different stages of navigation, avoid searching from scratch, and improve the planning quality and convergence speed.
- **Relaxation strategy**: By introducing relaxation parameters, alleviate the impact of randomness on hyper - parameter tuning in dynamic environments, enabling the algorithm to better adapt to environmental changes.

These techniques work together to enable OkayPlan to generate safer and shorter paths in dynamic environments and achieve efficient real - time planning.