How to Build a Robot - Avoiding Obstacles - LEKULE

Breaking

2 Oct 2016

How to Build a Robot - Avoiding Obstacles

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);
  }
}
                  

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!


No comments: