Introduction: Maze Solving Robot



Additional information at : http://patrickmccabemakes.com/hardware/Maze_Solvin...


In this instructable I will be showing you how to build a maze solving robot. This is actually my 3rd attempt at making one. The first was a complete failure. The second was alright at finding the end of the maze, but it could not go back and drive the quickest path. This is my current and 3rd one. It is able to find the end of the maze and then, when put back at the start, drive the shortest path to the end of the maze without going down any dead ends. What surprises me is that it really does not mess up.

This was just a short introduction, everything else from theory, building, and programming will be explained in later steps.

Parts list:


General Parts:

  • 3 1in Spacers (Home Depot)
  • Bolts and nuts that fit the spacers (Home Depot)
  • Hook up wire ( I use 22 gauge)
  • Solder
  • .100" Female and Male headers
  • Velcro


Tools:

  • Soldering Iron
  • Philips Screw driver
  • Wire Strippers
  • Something to cut the wire with

Step 1: The Theory Part 1

What are the steps In maze solving?
There are basically 2 steps. The first is to drive through the maze and find the end of it. The second is to optimize that path so your robot can travel back through the maze, but do it perfectly with out going down any dead ends.

How does the robot find the end of the maze?
I use a technique called the left hand on the wall. Imagine you are in a maze and you keep your left hand on a the edge of the wall at all times. Doing this would eventually get you out of a non-looping maze. This instructable will only deal with mazes that do not loop back on themselves.

This left hand on wall algorithm can be simplified into these simple conditions:
- If you can turn left then go ahead and turn left,
- else if you can continue driving straight then drive straight,
- else if you can turn right then turn right.
- If you are at a dead end then turn around.

The robot has to make these decisions when at an intersection. An intersection is any point on the maze where you have the opportunity to turn. If the robot comes across an opportunity to turn and does not turn then this is consider going straight. Each move taken at an intersection or when turning around has to be stored.

L = left turn
R= right turn
S= going straight past a turn
B= turning around

So let us apply this method to a simple maze and see if you can follow it. View the photos to see this method in action.
The red circle will be the robot.  

As you can see in the photos for this example, the final path is LBLLBSR.

Step 2: The Theory Part 2

Ok so now you have a path. In this case it is "LBLLBSR", but how does the robot change that into the correct path? Well lets take a look at what the correct path would be. Look at the photos for the correct path.

Final correct path = SRR

So we need our path to go from LBLLBSR to the right path that is SRR. To start off we look at where we went wrong. A "B" indicates the robot turned around meaning it went down the wrong path. To optimize the path we have to get rid of the "B" by using some substitution. 
 

Step 3: The Theory Part 3

Lets look at the first 3 moves in the path "LBLLBSR". These moves are "LBL".
That move looks like the photo.

Instead of turning left then turning around and turning left again, the robot should have gone straight. So we can say that LBL = S.

This substitution is what the robot uses to optimize the path. That is one example but here is the whole list:

LBR = B
LBS = R
RBL = B
SBL = R
SBS = B
LBL = S

You may not come across all of these when maze solving, but they are required when optimizing the path. Some even put "B" back into the path. This is required to further optimize the path correctly. You can figure out why for yourself or just trust me.

Lets optimize our path now that we know how to:
Path = LBLLBSR
LBL = S so our new path would be: SLBSR
We also know LBS = R so our new path would be: SRR
As you can see we got the path that we were looking for.

My robot optimizes the path as it travels. The path is stored in an array and every time it goes to store a new move, it checks to see if the previous move was a "B", if it was then it optimizes the path. You need to know at least 3 moves to optimize the path: The move before and after the turn around (and the turn around itself).
 

Step 4: The Theory Part 4

Here is another example.

Using the left hand on the wall algorithm, here is the path the robot would take:
LLLBLLLRBLLBSRSRS

Now here is the process of shortening that path:
LL(LBL = S)LL(RBL = B)(LBS = R)RSRS

The new path would be:
LLSLLBRRSRS

Continue shortening it until all the “B”s are gone:
LLSL(LBR = B)RSRS

The new path would be:
LLSLBRSRS

Continue shortening it:
LLS(LBR = B)SRS

The new path would be:
LLSBSRS

Continue shortening it:
LL(SBS = B)RS

The new path would be:
LLBRS

Continue shortening it:
L(LBR = B)S

The new path would be:
LBS

The final path is:

LBS = R 

Step 5: The Design

I first want to say that your robot does not have to built in the same manner mine is. The biggest thing I see is that I designed and laser cut a chassis for my robot. I will post the AutoCAD file, but this is about all I can do. So if you are not able to laser cut the design, do not worry. As long as you have some Arduino, the same sensors, and motors then you should be able to get my code to work on your robot with minor changes. Recently I was just helping some one online who made a copy of mine without laser cut parts. The code ran on his robot with little tweaking. 

You can see in the photos the design I made and the parts I used a laser cutter to make. The parts are made from acrylic that is .08" thick. This can be found at The Home Depot.

In the third photo you can see the bottom deck in my 2 deck chassis design. The bottom deck has mounting holes in the rear to bolt the motors on, holes in the front to bolt the ball caster on, a hole to bolt the Arduino on, and 2 tabs in the front where the sensor bolts onto. The bottom deck also has 3 mounting holes that allow it to be connected to the top deck using bolts and spacers.

The top deck has a single, large hole to run wires from the battery pack that is velcroed on top to the electronics on the bottom deck. It also has 3 holes that allow it to be connected to the bottom deck. 

It is a simple, compact design that allows for a simple assembly with minimal wiring.

You will see in the next steps how and where the parts fit on.

Step 6: Attaching the Motors

In this step I simply attached my motors to the top side of the bottom deck using 2 #2 bolts for each one. You can see that I have a little bit of wire attached to each motor, this is because the motors were removed from my previous maze robot. Then attach the wheels by simply pressing them onto the motor shaft. You have to line the "D" shaped shaft up with hole in the center of the wheel.

Step 7: The Arduino

The first thing you should do in this step is follow the instructions to assemble your RBBB. Those instructions are available here. You will need to snip part of the board off like it says you can do at the bottom of the instructions because you will not be needing it.  "If you dont’ need the power jack or regulator just snip them both off. The easiest way to cut the board is with a large pair of tin snips, but hack saws, jewelers saws and band saws also work well." Do not solder any headers onto the board besides the ones used for the FTDI programming port. 

Next solder a 9 pin strip of female headers on the left side of the board from pins labeled "5v" to "A0". This will mate with the sensor plug later. Solder a 4 pin strip of female headers on the right side of the board from pins labeled "D5" to "D8". These pins will be used to control the motor controller. Finally solder a 2 pin strip of female headers on the front right of the board on the GND and 5V pins. These will supply power to the motor controller.

You can ignore the fact that the motor controller and top deck in the photos. We will get to those.





Step 8: The Motor Controller

I designed a PCB for my motor controller. I have uploaded the Eagle files for you. I used the Dorkbot service to have them made.

If you do not use a PCB, you can always make this simple circuit on some prototype board. 

Now to wire the motor controller up. I have a labeled diagram in the photos. Looking at the last photo, I have the motor on the bottom of the picture connected to the what I have labeled as "M1-A" and "M1-B". These are the outputs of the motor controller for the first motor. I have the motor in the top of the last photo connected to what I have labeled as "M2-A" and "M2-B". These are the outputs of the motor controller for the second motor. 

Now time for the inputs of the motor controller. The Arduino digital output 7 gets wired to what I have labeled as "In 1A". This is the first input of the first motor. The Arduino digital output 6 gets wired to what I have labeled as "In 1B". This is the second input of the first motor. The Arduino digital output 5 gets wired to what I have labeled as "In 2A". This is the first input of the second motor. The Arduino digital output 8 gets wired to what I have labeled as "In 2B". This is the second input of the second motor.

Finally Power and ground get connected to the Arduino's 5v and Gnd pins at the front of the board. In the picture I have the wires attached but not plugged in yet.

As you can see I also went ahead and used some of the #2 nuts and bolts to bolt down the ball caster and Arduino.

Step 9: The Sensor

The sensor comes as an array of 8 sensors. There are 2 on the end that can be removed and need to be removed. I used a pair of side cutters to do this. A 9 pin strip of female headers has to be soldered on to the sensor from "GND" to pin "6" of the sensor. I then plugged in a strip of male headers.

These sensors put out an analog voltage based on how much IR light is being reflected back. We can use these to detect the white and black areas on the maze. The sensor outputs a low voltage near 0V if the sensor detects a white surface. The sensor outputs a voltage near VIN if it detects a dark surface. 




Step 10: Attach the Top Deck

Bolt the top deck on using the 1in spacers and some bolts and nuts. Use velcro to attached the battery pack to the top deck. Run the leads from the battery pack through the hole in the top deck to the bottom deck. This battery pack already has a built in power switch. 

I found it easiest to leave the screw out of the battery pack. The screw prevents the battery pack from opening, but it has clips that do a good job of keeping it closed without the screw. This allows the batteries to easily be changed by sliding the battery pack open. That means you do not necessarily have to  lift the battery pack off the velcro to change the batteries.

Step 11: Attach and Wire the Sensor

The sensor array bolts onto the front of the robot using #2 bolts. The pin on the far left of the sensor is GND and gets wired to GND on the Arduino. The second most left pin is Vcc and it gets wired to the 5V pin on the Arduino. The pins labeled 6-1 on the analog sensor get wired to the Arduino analog pins from 5-0. So pin 6 on the sensor gets wired to the Arduino analog pin 5, pin 5 of the sensor gets wired to the Arduino analog pin 4, etc. 

Step 12: Attach Power

The last thing to do is wire the battery pack to the Arduino. This is done by soldering the wires to the power pins at the rear of the Arduino RBBB. The battery pack has a built in power switch so that is why we can simply solder the power leads straight to the back of the Arduino RBBB. The robot is now complete.

Step 13: The Program

I had fun writing this program. Basically there are a few functions that take care of the whole maze solving process. The left hand on the wall function holds the logic to read the sensors and navigate the maze following those rules I outlined earlier. The turning functions are programmed in a fashion so that the robot continues to turn until it sees the black line in which case it then drives forward. There is also a function programmed with a little line following capabilities. It is no PID line following, but does allow the robot to stay on course. This function also controls the robot's speed.

The more detailed function is that of shortening the path. A letter is stored at every intersection that indicates the direction the robot took. If the previous letter was a "B", indicating a wrong turn, the function that shortens the path is run to substitute letters in place of those 3 letter sequences outlined earlier.

Finally there is a function that replays the shortest path that the robot calculated when the robot is picked up and then placed back down on the black line. The robot can detect when it is placed back down and then runs the shortest calculated path.

You can download the code below.

Comments

author
vikash2504 made it!(author)2017-03-24

Can anyone send me the code for the maze solving robot.plzzz

author
CesarH36 made it!(author)2017-05-02

just change the last words of the code after downloading, change from Maze_Robot_V3.tmp to Maze_Robot_V3.pde.

that will open it in arduino

author
Roystan+Castelino made it!(author)2017-04-19

your code is downloading as .tmp file. cannot open! please send me the code.

author
ManojB47 made it!(author)2017-04-13

pls send me the code link

author
subham.kumar.1671 made it!(author)2017-03-15

Hi sir, i want to ask that u have used a polulo booster in your final version ,than why u set the voltage to 6 volt.

you wanted that or is it necessary?

Can i convert the output of voltage booster to 9 volt and than give it to motors.

Sir, please reply , i want to make this.

Thanks a lot.

author
fathan21 made it!(author)2017-03-04

Nice instructables
I hv a question
Which pair of sensor is better wheater ir led+photodiode or Led+LDR ?

author
DarwynnM made it!(author)2016-11-21

I made this robot but it does not do that most important thing. It doesnt even move. I have posted so many times under this project and received no help. I made sure i followed the steps identically.

image1.JPGimage2.JPGimage3.JPGimage4.JPG
author
nadeemem made it!(author)2015-09-18

if there are white lines and black background instead of black lines and white background where i have to make changes in program..

author
HarryR8 made it!(author)2016-09-09

have u got the solution of this question of your's?? if yes please tell me.

thank you.

author
DarwynnM made it!(author)2016-11-21

Any luck i built this thing exactly like he did and it cuts on but doesnt even move

author
DarwynnM made it!(author)2016-11-01

Do not bother trying to use DorkBot beause i have tried 25 times creating an account and getting approved so that they can print me a circuit board using the files patrickmccb provided. Oh and his files are Eagle files in which most manufactors wont except as he failed to mention. You will have to manually convert these files into Gerber files in order for manufactors to service you. Just download Eagle Cam Software and look at this Yourube Video "

https://www.youtube.com/watch?v=oXWwHbusicM

"

author
DarwynnM made it!(author)2016-09-30

Where do we get those clear square plastic platforms you have in the image. I do not see this on the things to get list.

author
DarwynnM made it!(author)2016-11-01

Home Deport.

author
DarwynnM made it!(author)2016-09-30

Can the arduino Nano be used in place of the ATMEGA328???

author
DarwynnM made it!(author)2016-11-01

The Nano houses the AT3MEGA on the board it can be detached.

author
DarwynnM made it!(author)2016-10-05

Does the chassis material have to be clear. Our 3d Printer does not print acrylic. Only colored material, atleast that is what my instructor tells me

author
DarwynnM made it!(author)2016-11-01

Answering my own questions smh:

Yes, it needs to be clear acrylic. Also the machine that is used does not support the file format patrikmccb has provided. You would have to convert it to a different file depending on the machine.

author
LuisO3 made it!(author)2016-10-27

can you give me the size of the case pls... i need it for do the design on my 3D print. tanks a lot

author
HarryR8 made it!(author)2016-09-08

What kind of changes do i need to make in my program if i want my robot to follow white line???

thank you.

author
khetu made it!(author)2016-10-04

Oppsite of black line

author
khetu made it!(author)2016-10-03

sir,i have ardino uno and moter driver can i make these type of bot using these parts

author
PranavB22 made it!(author)2016-09-24

Can any one share the code of maze solver?? Pls

author
shyam+sivakumar made it!(author)2016-09-08

hey i want to make this bot solve a maze thats not for streight lines but for curved lines. what all changes will be there?

author
Petr%C5%A028 made it!(author)2016-04-28

To be honest the code is written pretty .. ehm .. *not-so-nice-words* ... BUT when I will find the part about optimizing to ideal route it will surely be helpful and I thank you for that.
....
we are doing a school project where we have similar robot and we are navigating it through complete mess of loops, dead ends, loops and dead end loops and .. did I mention loops?

author
L%C3%AAQ10 made it!(author)2016-04-24

Please! You can for mo know: What software to read file "pde" :((

author
patrickmccb made it!(author)2016-04-24

https://www.arduino.cc/en/Main/Software

author
prince-bhogal made it!(author)2016-02-11

hello,mr.admin,i want to make this project,can you plz provide me the proper circuit of this line maze solver robot working over arudino and its master programing as soon as possible,it will be great help admin

author
BahadirG made it!(author)2016-01-20

Mr Patric, I like your project. I want to make it but haven't analogsensor. can I use Digital sensor QTR-8RC

author
RoboKriti made it!(author)2016-01-04

Dear Patrick,

Nice work !!!

I'm trying to make this robot but getting problem with related to algo i think there is some error in code. can you send me the modified code so ill complete my project.

WP_20160104_001.jpgWP_20160104_002.jpg
author
AayushG9 made it!(author)2015-12-29

I made this robot but with slightly different parts, (used uno and 12v motor).

The problem is that my bot is not running fine. While debugging and viewing the output of rightcenter sensor the reading is constant at 1023 and does not change regardless of what I do.

I think the sensor is faulty.

author
AayushG9 made it!(author)2015-12-29

I made this robot but with slightly different parts, (used uno and 12v motor).

The problem is that my bot is not running fine. While debugging and viewing the output of rightcenter sensor the reading is constant at 1023 and does not change regardless of what I do.

I think the sensor is faulty.

author
WilliumS made it!(author)2015-12-22

very helpful post..thanks !

author
noahplank made it!(author)2015-11-09

Got code?

author
Ashraf+kamel made it!(author)2015-10-21

i want to know how would i convert the long path "LLLBSR....."

into the direct path in coding

and thanks for this great post

author
majenko made it!(author)2015-10-11

Now make it so you can place the robot on any point of the maze after it has found the end and it works out where in the maze it is (drives around until it finds a bit it recognizes) then drives straight to the exit once it has got its bearings.

author
shubh_20 made it!(author)2015-09-21

well, the instructions were pretty useful but i am facing a problem with this.

what should i do if a maze have a single solution(exit) but multiple paths. my bot used two different paths when i used right and left in different runs.

and definitely the both the paths are of different lengths hence not traversing the shortest one.

author
BharatY1 made it!(author)2015-09-12

i wanted use arudino cc intstead of arduino RBB

will it work if i use external IR sensors

author
Comfort_Cube made it!(author)2015-09-12

Hey man. I think I found a way to solve (some) looping mazes as well. If the robot has turned left/right (depending on the rule) more than 4 times in a row (which would be the case in a loop), then switch the rule. If it was left-hand rule, switch to right-hand rule and vice versa. This would enable certain looping mazes to be solved.

author
Hector+AlbertoD made it!(author)2015-09-06

Please someone mail me the code, please i cant get it dominguezfernandez94@gmail.com please i will apreciate that

author
atlantageek made it!(author)2015-08-31

Could you repost the code.

author
AjayD made it!(author)2015-04-04

Sir,I had tried working Hard to make this BOT and it turned out pretty well.It took more than a month and a half to make it.Finally made it.I just made minute changes in the code.The results were actually amazing.....here is the link of the vid.....Sorry about the middle finger in the video.Those were for my friends they thought that I couldn't make it.....Would soon write Instructable on it....Thank you for this....

https://drive.google.com/open?id=0B-f1xWTJwulda2Qw...

2015-03-26.jpg20150405_011618.jpg20150405_011629.jpg
author
suyashbansal26 made it!(author)2015-08-05

BTW Ajay, where did you find those sensor arrays?

author
atlantageek made it!(author)2015-08-31

pololu.com qtr-8ra I think is the model number for the analog sensors.

author
patrickmccb made it!(author)2015-04-04

Nice job!

author
g.knightz made it!(author)2015-03-20

brilliant work you have done.. can this project use only 5 sensor.. help is needed..

author
g.knightz made it!(author)2015-03-20

urgent help... can i use arduino mega, and digital line sensor instead of analog line sensor, also can i use 12v dcmotor for for this project .. i provide link of component that i want to use and need your advice does it can be use..

http://cytron.com.my/p-mdd10a

http://cytron.com.my/p-lss05

author
frafi1 made it!(author)2011-10-25

hi. I dont get the exact parts which you used. firstly, can i use a arduino uno instead of the one which you used?

can i use regular DC motors? (http://www.rhydolabz.com/index.php?main_page=product_info&cPath=121&products_id=815)

and can i use a motor driver (http://www.rhydolabz.com/index.php?main_page=product_info&cPath=108&products_id=858)

if yes, could you please guide me through the process, it would be of great help.
thanks

author
sadam+khan made it!(author)2015-03-10

dear can you send me its complete codes ?

author
patrickmccb made it!(author)2011-10-30

That motor driver will work, but you do not want that motor. That motor operates at 12 volts. You would have to get a 12v battery pack and regulate it down to 5v for the other parts. I would find a 5v motor.

author
sadam+khan made it!(author)2015-03-10

need its complete codding please .

About This Instructable

237,009views

242favorites

License:

More by patrickmccb:Maze Solving RobotPong
Add instructable to: