improved obstacle avoidace