merge drone pathfinding improvements from xspeedpl/develop