mit-acl / faster C++ 1.3K 199 3D Trajectory Planner in Unknown Environments uav autonomous-navigation path-planning trajectory-optimization