Finished the code for the obstacle avoidance. There are issues with the animation and the time management for the pause and play