Robot Wall avoidance