Drl Robot Navigation Ir Sim, Source code in robot_nav/utils.