code for the trinity college firefighting robot competition