Updated DriveControl,java & unit test