https://github.com/ros-planning/navigation2/blob/foxy-devel/nav2_system_tests/src/system/tester_node.py