Obstacle avoidance method of three-dimensional obstacle spherical cap

Focusing on obstacle avoidance in three-dimensional space for unmanned aerial vehicle (UAV), the direct obstacle avoidance method in dynamic space based on three-dimensional velocity obstacle spherical cap is proposed, which quantifies the influence of threatening obstacles through velocity obstacle spherical cap parameters. In addition, the obstacle avoidance schemes of any point on the critical curve during the multi-obstacles avoidance are given. Through prediction, the insertion point for the obstacle avoidance can be obtained and the flight path can be re-planned. Taking the Pythagorean Hodograph (PH) curve trajectory re-planning as an example, the three-dimensional direct obstacle avoidance method in dynamic space is tested. Simulation results show that the proposed method can realize the online obstacle avoidance trajectory re-planning, which increases the flexibility of obstacle avoidance greatly.