Old code used for RoboCup RCJ rescue sim competitions. (which granted us first place in Iran Open 2022)