The team, though mainly Sujitt, spent many hours writing the code for the final competition. In this code, there are many functions which allow for the robot to complete each task throughout the course. There are also various fail-safes for the robot in the code in case something went wrong during a run, the robot would have a chance to fix it by itself. The entire final code can be found below.