Rick found some messd up math in the autonomous code so we fixed it