Obstacle avoidance compiling, though not working
mode added