Code used for FireCheetah and the Abingdon firefighting robot compotition.