Code for my entry into the April robotics competition at work