Obstacle Avoidance

The video shows the obstacle avoidance algorithm. When the program starts, NAO assumes the initial pose (stands up) and wants to reach the yellow marker that you can see on the floor. The sonar sensor detect an obstacle on its way, thus NAO changes its path to avoid the obstacle and after that returns on his way. When it has reached the target point, it goes to the crouch position again.