Cleaned up some of the code and changed the value of wheel diameter to one measured.