now pathfinding from the closest free point of the robot