Fixed robot crashing bug (turned out to be initializing the LED ring more than once), created a test mode for the new wheel pod.
Fixed a few gear tooth issues and added conversion to speed.