Added code from VEX Team A.