ROS2 and Gazebo: 2.5D Navigation