Project

How to Build a Robot - Avoiding Obstacles

November 18, 2015 by Travis Fagerness

Part five of a series of articles on building a robot that can follow lines or walls and avoid obstacles!

Part five of a series of articles on building a robot that can follow lines or walls and avoid obstacles!

Related Articles

How to Build a Robot:

Part 1: Design and Schematic

Part 2: PCB Design

Part 3: Testing Hardware

Part 4: Line Follower

Part 6: Wall-Following Robot

Overview

I thought it would be neat to create a robot that was easy to put together with a single soldering iron and was also affordable. I made up the following requirements for my robot:

  • Many kits are expensive, so it must be relatively inexpensive.
  • It must be easily put together without special equipment.
  • It must be easily programmable without a complicated IDE or programmer.
  • It must be powerful enough for expandability.
  • It should run off a simple power source.
  • It should be able to follow a line or a wall, and avoid obstacles.

In this article, I'll talk about how to program the robot to avoid obstacles.

Avoiding Obstacles

The approach I'm going to take is if an obstacles is detected in the path of the robot, the robot will back up and try a new direction. This allows the robot to explore areas without getting stuck or damaging itself. The sensor that is used in this robot only gives a binary output. In other words, something is either in the way or it isn't. The sensor also has a pretty wide angle of reception, so objects that are slightly off to the side may also be detected. This limits the complexity of the algorithm that can be used. If you had a sensor that could actually measure the distance to an object reliably, you could calculate if you have enough turn radius to get out of the way without going backwards.

The algorithm I decided on will tell the robot to back up for 1 second if an obstacle is detected. It will then randomly turn left or right in an attempt to avoid the obstacle. While turning left or right, it continues to check for obstacles in the way. If it detects obstacles, it will stop turning and repeat the reverse/turn cycle until free of the obstacle.

Programming

The following sketch performs the logic:

  1. Start the robot driver and wait 5 seconds. This gives you time to put the robot where you want it before it starts moving.
  2. Move forward.
  3. If the middle sensor is activated, reverse for 1 second.
  4. Randomly choose left or right.
  5. Turn for up to 1 second as long as the middle sensor is not activated.
  6. If the middle sensor is activated, go to step 3.
  7. If the sensor is not activated, go to step 2.
#include "robot.h"

void setup()
{
  Serial.begin(38400);
  Serial.println("Boot");
  rbt_init();  
  delay(5000);
  rbt_move(FWD,100);
}

uint16_t lleft,lmid,lright;
boolean wleft,wmid,wright;
uint16_t avoid_count=0;
void loop()                     
{
  rbt_sns(&lleft,&lmid,&lright,&wleft,&wmid,&wright);
  /*reverse if something is in the way and try to change direction*/
  if(wmid)
  {
    rbt_move(REV,100);
    delay(1000);
    /*choose a direction at random to avoid an obstacle*/
    if(random(10)>5)
    {
      rbt_move(LEFT,100);
      avoid_count=1000;
      while(avoid_count){
        delay(1);
        rbt_sns(&lleft,&lmid,&lright,&wleft,&wmid,&wright);
        if(wmid) break;
      }
    }
    else
    {
      rbt_move(RIGHT,100);
      avoid_count=1000;
      while(avoid_count){
        avoid_count--;
        rbt_sns(&lleft,&lmid,&lright,&wleft,&wmid,&wright);
        if(wmid) break;
      }
    }
    rbt_move(FWD,100);
  }
}

Avoiding Obstacles!

Conclusion

In this article I showed how you might use a sensor to avoid obstacle with a robot. Obstacle avoidance is important in autonomous vehicles to avoid damaging the environment or the robot itself. One important addition to this robot would be sensors in the rear in order to avoid obstacles when in reverse. In the next article, I'll make the follow a wall by taking advantage of the side sensor!

Next Article in Series: How to Build a Wall-Following Robot

Obstacle_Avoidance_Robot.zip

2 Comments
  • N
    nmsr1196 November 28, 2015

    Very nice project.  What type of sensor did you use? I could not see it clearly in the video. I did not see a link to the “Robot.h” library.

    Like. Reply
  • N
    nmsr1196 December 01, 2015

    Can you provide a download link for the “Robot.h” library?

    Like. Reply