Changed DriveStraightForward to use Switch Case logic for each of it's states.