I changed the motor driver to a l298 to provide more amps to my motors than the l293d did. (l298 picture below)
I am back from testing my AGV some more. Here is some video of it going around a retention pond in a parking lot. The first gps point was a little off and it came close to the grass but it wasnt too bad. Almost ready for Sparkfun's contest lol.