Robotics code for the FIRST Robotics Competition