allmyslam1 / ros_x_habitat

A bridge betwwen the ROS ecosystem and AI Habitat.

ros_x_habitat

A ROS package to bridge AI Habitat with the ROS ecosystem.

Outline

1. Motivation
2. System Architecture
3. Installation
4. Examples
5. Cite Our Work
6. License
7. Acknowledgments
8. References

Motivation

The package allows roboticists to

• Navigate an AI Habitat agent within photorealistic scenes simulated by Habitat Sim through ROS;
• Connecting a ROS-based planner with Habitat Sim;
• Connecting an AI Habitat agent with a ROS-bridged simulator (Gazebo for example) through ROS.
• Leverage Habitat Sim's photorealistic and physically-realistic simulation capability through ROS.

System Architecture

ros_x_habitat exists as a collection of ROS nodes, topics and services. For simplicity, we have omitted components not essential to the interface's operation:

Installation

1. Install Ubuntu 20.04 + ROS Noetic.
2. Install Anaconda.
3. Install Habitat Sim version 0.2.0.
   • Here we show how to install it from conda. First download the code base, then reset the head to version 0.2.0, create a conda environment and install dependent packages:

     conda create -n rosxhab python=3.6 cmake=3.14.0
     conda activate rosxhab
     cd <path to Habitat Sim's root directory>
     pip install -r requirements.txt
     conda install habitat-sim=0.2.0 withbullet -c conda-forge -c aihabitat
     

   • If installing from conda doesn't work, you can also try building from source with Bullet Physics and CUDA support (if you have an NVIDIA card).
4. Install Habitat Lab version 0.2.0 in the same conda environment following the official instructions. Note that
   • In addition to the core of Habitat Lab, also install habitat_baselines and other required packages.
   • The requirements.txt provided in the official repo does not seem to cover the entire set of packages required to set up Habitat Lab. We had to install these pacakges manually:

     pip install Cython==0.29.30
     pip install pkgconfig==1.5.5
     

5. Install the following ROS packages:
   • ros-noetic-depthimage-to-laserscan
   • ros-noetic-laser-scan-matcher
   • ros-noetic-rtabmap-ros
   • ros-noetic-joy
   • ros-noetic-turtlebot3-gazebo
   • ros-noetic-turtlebot3-bringup
6. Clone the repo to the src/ directory under your catkin workspace.
7. Compile the package by calling catkin_make.
8. Install Python pacakges required by this repo:

   pip install -r requirements.txt
   

Examples

Here we outline steps to reproduce experiments from our paper.

Environment Setup

To set up your bash environment before you run any experiment, do the following:

1. Activate your conda environment (if you are running any script/node from this codebase).
2. Export the repo's directory to $PYTHONPATH:

   export PYTHONPATH=$PYTHONPATH:<path to the root directory of this repo>
   

   In fact for convenience, you can create a command in your $HOME/.bashrc:

   alias erosxhab="export PYTHONPATH=$PYTHONPATH:<path to the root directory of this repo>"
   

3. Source ROS-related environment variables. Similarly we can create a command to do this:

   alias sros="source /opt/ros/noetic/setup.bash && source <path to catkin_ws/devel>/setup.sh"
   

Navigating Habitat Agent in Habitat Sim without ROS (+/-Physics, -ROS)

We can attempt to reproduce experiments from the Habitat v1 paper by evaluating a Habitat agent's performance in a MatterPort3D test scenario. Note that unlike what the authors did in the paper, we used

• Agents: Habitat v2's RGBD agent since the v1 agents are no longer compatible with Habitat v2;
• Test episodes and scenes: MatterPort3D test episodes only. To get episode definitions, download from here; to download the scene assets, please follow instructions from here;
• Also we evaluated the agent in physics-enabled Habitat Sim v2.

To run an evaluation, follow these steps:

1. Create directory data/ under the project's root directory. Then create the following directories:
   • data/checkpoints/v2/,
   • data/datasets/pointnav/mp3d/v1/,
   • data/objects/,
   • data/scene_datasets/mp3d/.
2. Extract the v2 agents (.pth files) to data/checkpoints/v2/. Extract the MP3D episode definitions to data/datasets/pointnav/mp3d/v1/ (then under v1/ you should see directory test/, train/, etc). Extract the MP3D scene files to data/scene_datasets/mp3d/.
3. Select an experiment configuration file from configs/. Our configurations are coded by numbers:
   • Setting 2: -Physics, -ROS;
   • Setting 4: +Physics, -ROS.
4. Select from seeds/ a seed file or create one of your own for your experiment. The seed is used for initializing the Habitat agent.
5. Run the following command to evaluate the agent over the test episodes while producing top-down maps and box plots to visualize metrics:

   python src/scripts/eval_and_vis_habitat.py \
   --input-type rgbd \
   --model-path data/checkpoints/v2/gibson-rgbd-best.pth \
   --task-config <path to config file> \
   --episode-id <ID of last episode evaluated; -1 to evaluate from start> \
   --seed-file-path <path to seed file> \
   --log-dir <path to dir storing evaluation logs> \
   --make-maps \
   --map-dir <path to dir storing top-down maps> \
   --make-plots \
   --plot-dir <path to dir storing metric plots>
   

Navigating Habitat Agent in Habitat Sim with ROS (+/-Physics, +ROS)

Under this mode we run a Habitat Agent still inside Habitat Sim but through our interface.

1. Select an experiment configuration file from configs/. Our configurations are coded by numbers:
   • Setting 3: -Physics, +ROS;
   • Setting 5: +Physics, +ROS.
2. Select a seed file (as above).
3. Run:

   python src/scripts/eval_habitat_ros.py \
   --input-type rgbd \
   --model-path data/checkpoints/v2/gibson-rgbd-best.pth \
   --task-config configs/setting_5_configs/pointnav_rgbd-mp3d_with_physics.yaml \
   --episode-id <ID of last episode evaluated; -1 to evaluate from start> \
   --seed-file-path <seed file path> \
   --log-dir= <log dir path>
   

Navigating Habitat Agent in Gazebo

Here we demonstrate steps to posit a Habitat agent embodied on a TurtleBot in a Gazebo-simulated environment, and render sensor data with RViz.

1. Define the model for the TurtleBot (here we use "Waffle"):

   export TURTLEBOT3_MODEL="waffle" 
   

2. Launch Gazebo and RViz:

   roslaunch turtlebot3_gazebo turtlebot3_house.launch
   roslaunch turtlebot3_gazebo turtlebot3_gazebo_rviz.launch 
   

3. Launch the agent node:

   python src/nodes/habitat_agent_node.py \
   --node-name agent_node \
   --input-type rgbd \
   --model-path data/checkpoints/v2/gibson-rgbd-best.pth 
   

   Then reset the agent in a separate window:

   rosservice call /ros_x_habitat/agent_node/reset_agent "{reset: 0, seed: 0}" 
   

4. Launch the converter nodes:

   python src/nodes/habitat_agent_to_gazebo.py
   python src/nodes/gazebo_to_habitat_agent.py \
   --pointgoal-location <coordinates>
   

5. In RViz, subscribe to topic /camera/depth/image_raw and /camera/rgb/image_raw to render observations from the RGB and the depth sensor.

Navigating ROS Agent in Habitat Sim

Here we outline steps to control a ROS agent with RGBD sensors via a joystick in a Habitat Sim-simulated scene.

1. Repeat Step 1 and 2 from here to download MP3D scene assets and episode definitions.
2. Download Habitat's test object assets into data/objects/ by running this command from Habitat Sim (more instructions from here):

   python -m habitat_sim.utils.datasets_download --uids habitat_example_objects --data-path <path to ros_x_habitat/data/objects/>
   

3. Start roscore.
4. Select a configuration file from configs/roam_configs/. Here we select pointnav_rgbd_roam_mp3d_test_scenes.yaml since we only have downloaded the MP3D test scenes. You might want to change VIDEO_DIR to some directory of your liking.
5. Run this command:

   python src/scripts/roam_with_joy.py --hab-env-config-path <config file path> --episode-id <ID of episode to roam inside> --scene-id <path to the episode's scene file, e.g. data/scene_datasets/mp3d/2t7WUuJeko7/2t7WUuJeko7.glb> --video-frame-period <number of continuous steps for each frame recorded>
   

We will soon update steps to run a planner from rtabmap_ros in Habitat Sim.

Tested Platforms

The experiments were run on a desktop with i7-10700K CPU, 64 GB of RAM, and an NVIDIA RTX 3070 GPU. We also tested the experiments on a desktop with 32 GB of RAM and an NVIDIA GT1030 GPU.

Cite Our Work

If you are interested in using ros_x_habitat for your own research, please cite our (Arxiv preprint) paper:

@misc{chen2021rosxhabitat,
      title={ROS-X-Habitat: Bridging the ROS Ecosystem with Embodied AI}, 
      author={Guanxiong Chen and Haoyu Yang and Ian M. Mitchell},
      year={2021},
      eprint={2109.07703},
      archivePrefix={arXiv},
      primaryClass={cs.RO}
}

License

This work is under the Creative Commons CC BY 4.0 License.

Acknowledgments

We would like to thank Bruce Cui from the Department of Mechanical Engineering at UBC for his initial work on ros_x_habitat. Also, we would like to appreciate the AI Habitat team from Facebook AI Research, including Prof. Dhruv Batra, Alex Clegg, Prof. Manolis Savva, and Erik Wijmans for their generous support throughout our development process.

References

1. Habitat: A Platform for Embodied AI Research. Manolis Savva, Abhishek Kadian, Oleksandr Maksymets, Yili Zhao, Erik Wijmans, Bhavana Jain, Julian Straub, Jia Liu, Vladlen Koltun, Jitendra Malik, Devi Parikh, Dhruv Batra. IEEE/CVF International Conference on Computer Vision (ICCV), 2019.
2. Habitat 2.0: Training Home Assistants to Rearrange their Habitat. Andrew Szot, Alex Clegg, Eric Undersander, Erik Wijmans, Yili Zhao, John Turner, Noah Maestre, Mustafa Mukadam, Devendra Chaplot, Oleksandr Maksymets, Aaron Gokaslan, Vladimir Vondrus, Sameer Dharur, Franziska Meier, Wojciech Galuba, Angel Chang, Zsolt Kira, Vladlen Koltun, Jitendra Malik, Manolis Savva, Dhruv Batra. arXiv preprint arXiv:2106.14405, 2021.
3. ROS-X-Habitat: Bridging the ROS Ecosystem with Embodied AI. Guanxiong Chen, Haoyu Yang, Ian Mitchell. arXiv preprint arXiv:2109.07703, 2021.