Team 6's robot program for RBE2001 A14