Python code for FIRST Robotics