Quad-Rotor Avoidance Trajectory Generation for Convex Polyhedron Obstacles

This study investigates a method for generating obstacle avoidance trajectories for arbitrary convex polyhedrons. We propose a formulation that converts discrete conditions into continuous equation forms to avoid convex polyhedron obstacles. The condition that the evaluation point be located outside of the convex polyhedron can be transformed into a constraint in the continuous equation form and incorporated into the optimization calculation to generate avoidance trajectories. Avoidance trajectory generation using the Legendre pseudospectral method is performed for convex polyhedral obstacles of various shapes. The results show that the proposed method successfully generates avoidance trajectories for arbitrary convex polyhedral obstacles.