Updated control scheme for drive team.
Working code 2/13