https://www.researchgate.net/publication/292885252_Competing_in_the_DARPA_virtual_robotics_challenge_as_the_SARBOT_team