Path Planning and Control of a Quadrotor UAV Based on an Improved APF Using Parallel Search

Control and path planning are two essential and challenging issues in quadrotor unmanned aerial vehicle (UAV). In this paper, an approach for moving around the nearest obstacle is integrated into an artificial potential field (APF) to avoid the trap of local minimum of APF. The advantage of this approach is that it can help the UAV successfully escape from the local minimum without collision with any obstacles. Moreover, the UAV may encounter the problem of unreachable target when there are too many obstacles near its target. To address the problem, a parallel search algorithm is proposed, which requires UAV to simultaneously detect obstacles between current point and target point when it moves around the nearest obstacle to approach the target. Then, to achieve tracking of the planned path, the desired attitude states are calculated. Considering the external disturbance acting on the quadrotor, a nonlinear disturbance observer (NDO) is developed to guarantee observation error to exponentially converge to zero. Furthermore, a backstepping controller synthesized with the NDO is designed to eliminate tracking errors of attitude. Finally, comparative simulations are carried out to illustrate the effectiveness of the proposed path planning algorithm and controller.