Optimal autonomous multirotor motion planning in an obstructed environment