Obstacles avoidance

• Status: Supported
• Description: Robot will try to drive around the obstacle on the way to the target point