Obstacle avoidance code

Hello,

You can refer to these experiments as well: