Robot vision system for obstacle avoidance planning