Final code for FRC Team 3925's robot TazBot (unofficially BadwinBot)