Search-Based Path Planning with Homotopy Class Constraints in 3D