pathfinding add cloest cube