Dead Reckoning is hard

So after a lot of hard time spent in debugging we finally narrowed the dead reckoning navigation problem down to one of the formulas used to determine distance travel. With that fixed we have been able to let the vehicle drive itself around the engineering building for a bit. This is definately a step in the right direction. Hopefully after we correct a small heading problem it should be able to run laps by itself in the engineering building.