# Difference between revisions of "Tutorials/Arduino Projects/Mobile Robotics/BoeBot/Navigating Simple Maze"

(→The Plan) |
(→Distance Traveled vs Time) |
||

Line 15: | Line 15: | ||

=== Distance Traveled vs Time === | === Distance Traveled vs Time === | ||

− | Since we are looking for the seconds per inch, we are just looking for the inverse of inches per second. In either case to find the relationship, you need to know the distance traveled and the time to travel of at least one sample to calculate the relationship. Since we already know that we can control the time that the robot will run for, it is a very simple matter to just program it drive for | + | Since we are looking for the seconds per inch, we are just looking for the inverse of inches per second. In either case to find the relationship, you need to know the distance traveled and the time to travel of at least one sample to calculate the relationship. Since we already know that we can control the time that the robot will run for, it is a very simple matter to just program it drive for 5 seconds, then just measure the distance traveled. You can either write your own program to drive straight forward at speed 15 for 5 seconds or you can use the following code. |

{| | {| | ||

|- | |- | ||

|<syntaxhighlight lang="ROBOTC"> | |<syntaxhighlight lang="ROBOTC"> | ||

− | + | #pragma config(CircuitBoardType, typeCktBoardUNO) | |

+ | #pragma config(PluginCircuitBoard, typeShieldParallaxBoeBot) | ||

+ | #pragma config(UART_Usage, UART0, uartSystemCommPort, baudRate200000, IOPins, dgtl1, dgtl0) | ||

+ | #pragma config(Motor, servo_10, leftServo, tmotorServoContinuousRotation, openLoop, IOPins, dgtl10, None) | ||

+ | #pragma config(Motor, servo_11, rightServo, tmotorServoContinuousRotation, openLoop, reversed, IOPins, dgtl11, None) | ||

+ | //*!!Code automatically generated by 'ROBOTC' configuration wizard !!*// | ||

+ | |||

+ | task main() | ||

+ | { | ||

+ | wait1Msec(1000); //pause code execution for 2000ms (2 seconds) | ||

+ | |||

+ | motor[leftServo] = 15; | ||

+ | motor[rightServo] = 15; | ||

+ | wait1Msec(5000); | ||

+ | motor[leftServo] = 0; | ||

+ | motor[rightServo] = 0; | ||

+ | }</syntaxhighlight> | ||

|- | |- | ||

|} | |} | ||

Line 28: | Line 44: | ||

[[image:BoeBot_Speed_Calculation_Setup.jpg|thumb|c|center|400px|setup to measure the distance traveled]] | [[image:BoeBot_Speed_Calculation_Setup.jpg|thumb|c|center|400px|setup to measure the distance traveled]] | ||

− | If you take the average distance traveled and divide by the time ( | + | If you take the average distance traveled and divide by the time (5 seconds) and you will get the distance per second. This can be useful if you know how long your have been traveling, however we want to find how long we need to travel to go some distance. To find this relationship, we take the time (5 seconds) and divide it by the number of inches traveled. |

Now that we have this ratio, we can take some distance, say 9 inches, and calculate the time needed to travel that distance by multiplying the desired distance by the ratio. | Now that we have this ratio, we can take some distance, say 9 inches, and calculate the time needed to travel that distance by multiplying the desired distance by the ratio. |

## Revision as of 19:21, 18 June 2012

## objective

Now that we have a grasp of how to make the robot move, we can use that understanding to complete a task. For this section we are going to make the robot navigate a very simple maze. Even though we are calling it a maze, we will be telling the robot exactly where to go so you don't need to worry about how to make the robot know where to go.

## The Plan

The first step in programing a robot to follow a path is to plan the path the robot will take to navigate the maze. Since this maze has just one path, the planing has already been done. The path the robot will take is

However to follow this path we will need to find out how long it takes for the robot to turn 90° to the left and right at speed 15, and how long it takes the robot to travel 1 in. at speed 15. Getting the time to travel 1 in. is the simplest so we will start with that, then move on to finding the time to make the turns.

### Distance Traveled vs Time

Since we are looking for the seconds per inch, we are just looking for the inverse of inches per second. In either case to find the relationship, you need to know the distance traveled and the time to travel of at least one sample to calculate the relationship. Since we already know that we can control the time that the robot will run for, it is a very simple matter to just program it drive for 5 seconds, then just measure the distance traveled. You can either write your own program to drive straight forward at speed 15 for 5 seconds or you can use the following code.

#pragma config(CircuitBoardType, typeCktBoardUNO) #pragma config(PluginCircuitBoard, typeShieldParallaxBoeBot) #pragma config(UART_Usage, UART0, uartSystemCommPort, baudRate200000, IOPins, dgtl1, dgtl0) #pragma config(Motor, servo_10, leftServo, tmotorServoContinuousRotation, openLoop, IOPins, dgtl10, None) #pragma config(Motor, servo_11, rightServo, tmotorServoContinuousRotation, openLoop, reversed, IOPins, dgtl11, None) //*!!Code automatically generated by 'ROBOTC' configuration wizard !!*// task main() { wait1Msec(1000); //pause code execution for 2000ms (2 seconds) motor[leftServo] = 15; motor[rightServo] = 15; wait1Msec(5000); motor[leftServo] = 0; motor[rightServo] = 0; } |

Now download the program to the robot and set it up so that the point where the wheel touches the driving surface is next to a yard/meter stick. now just turn it on, wait for the robot to stop and record the distance traveled. We recommend that you do this 2 more times to get an average value.

If you take the average distance traveled and divide by the time (5 seconds) and you will get the distance per second. This can be useful if you know how long your have been traveling, however we want to find how long we need to travel to go some distance. To find this relationship, we take the time (5 seconds) and divide it by the number of inches traveled.

Now that we have this ratio, we can take some distance, say 9 inches, and calculate the time needed to travel that distance by multiplying the desired distance by the ratio.

### Adjusting Turning Time

While the process of calculating the time for driving straight for some distance is fairly simple, the physics involved with turning make it a little more complicated. Since we only need to make 90° turns, we will just create a program to make a left point turn and adjust he timing until the turn is sufficiently close to 90°. then we just repeat the process for a right point turn. From our testing, the following code should get you close to an 90° turn.