Cleaned up a little bit and fixed odometry errors.
Cleaned up a little bit and fixed odometry errors.

SquadCollaborativeRobotics/ArduinoCode,SquadCollaborativeRobotics/ArduinoCode,SquadCollaborativeRobotics/ArduinoCode