Assignment for Robotics class.
The node can be found inside the stage_challenge folder.
To run the code you'll need to:
Access the stage_ros2 github and install it. Run:
ros2 launch stage_ros2 stage.launch.py world:=cave enforce_prefixes:=false one_tf_tree:=true
And in another terminal:
ros2 run stage_challenge challenge_node.py