Giter VIP home page Giter VIP logo

tsdf-plusplus's Introduction

TSDF++: A Multi-Object Formulation for Dynamic Object Tracking and Reconstruction

TSDF++ is a novel multi-object TSDF formulation that can encode multiple object surfaces at each voxel. In a multiple dynamic object tracking and reconstruction scenario, a TSDF++ map representation allows maintaining accurate reconstruction of surfaces even while they become temporarily occluded by other objects moving in their proximity. At the same time, the representation allows maintaining a single volume for the entire scene and all the objects therein, thus solving the fundamental challenge of scalability with respect to the number of objects in the scene and removing the need for an explicit occlusion handling strategy.

Citing

When using TSDF++ in your research, please cite the following publication:

Margarita Grinvald, Federico Tombari, Roland Siegwart, and Juan Nieto, TSDF++: A Multi-Object Formulation for Dynamic Object Tracking and Reconstruction, in 2021 IEEE International Conference on Robotics and Automation (ICRA), 2021. [Paper] [Video]

@INPROCEEDINGS{grinvald2021tsdf,
  author={Grinvald, Margarita and Tombari, Federico and Siegwart, Roland and Nieto, Juan},
  booktitle={2021 IEEE International Conference on Robotics and Automation (ICRA)}, 
  title={{TSDF++: A Multi-Object Formulation for Dynamic Object Tracking and Reconstruction}}, 
  year={2021},
  volume={},
  number={},
  pages={14192-14198},
  doi={10.1109/ICRA48506.2021.9560923}}

Installation

The installation has been tested on Ubuntu 16.04 and Ubutnu 20.04.

Requirements

Install dependencies

Install ROS following the instructions at the ROS installation page. The full install (ros-kinetic-desktop-full, ros-melodic-desktop-full) are recommended.

Make sure to source your ROS setup.bash script by following the instructions on the ROS installation page.

Installation on Ubuntu

In your terminal, define the installed ROS version and name of the catkin workspace to use:

export ROS_VERSION=kinetic # (Ubuntu 16.04: kinetic, Ubuntu 18.04: melodic)
export CATKIN_WS=~/catkin_ws

If you don't have a catkin workspace yet, create a new one:

mkdir -p $CATKIN_WS/src && cd $CATKIN_WS
catkin init
catkin config --extend /opt/ros/$ROS_VERSION --merge-devel 
catkin config --cmake-args -DCMAKE_CXX_STANDARD=14 -DCMAKE_BUILD_TYPE=Release
wstool init src

Clone the tsdf-plusplus repository over HTTPS (no Github account required) and automatically fetch dependencies:

cd $CATKIN_WS/src
git clone https://github.com/ethz-asl/tsdf-plusplus.git
wstool merge -t . tsdf-plusplus/tsdf_plusplus_https.rosinstall
wstool update

Alternatively, clone over SSH (Github account required):

cd $CATKIN_WS/src
git clone [email protected]:ethz-asl/tsdf-plusplus.git
wstool merge -t . tsdf-plusplus/tsdf_plusplus_ssh.rosinstall
wstool update

Build and source the TSDF++ packages:

catkin build tsdf_plusplus_ros rgbd_segmentation mask_rcnn_ros cloud_segmentation
source ../devel/setup.bash # (bash shell: ../devel/setup.bash,  zsh shell: ../devel/setup.zsh)

Troubleshooting

Compilation freeze

By default catkin build on a computer with N CPU cores will run N make jobs simultaneously. If compilation seems to hang forever, it might be running low on RAM. Try limiting the number of maximum parallel build jobs through the -jN flag to a value way lower than your CPU count, i.e.

catkin build tsdf_plusplus_ros rgbd_segmentation mask_rcnn_ros cloud_segmentation -j4

If it still freezes at compilation time, you can go as far as limiting the maximum number of parallel build jobs and max load to 1 through the -lN flag:

catkin build tsdf_plusplus_ros rgbd_segmentation mask_rcnn_ros cloud_segmentation -j1 -l1

License

The code is available under the MIT license.

tsdf-plusplus's People

Contributors

margaritag avatar

Stargazers

 avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar

Watchers

 avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar  avatar

tsdf-plusplus's Issues

librgbd_segmentation.so error when compiling this project

Hi, everyone, when compile this project in ubuntu 18.04, i met this problem : ~/catkin_ws/devel/lib/librgbd_segmentation.so:undefined reference to‘cv::_OutputArray::_OutputArray(cv::Mat&)’, is there any advice on how to solve this problem ?

How to run tsdf_plusplus in freiburg3

Do I need to launch tsdf_plusplus_pipeline.launch and freiburg.launch in mask_rcnn_ros? If not, can you provide specific launch instructions? Thank you very much.

Issue on Object Tracking

Hi, I am trying to use this mapping framework with iTHOR simulator. Currently mapping framework is used with ground truth pose and ground truth pointclouds which are obtained via 3D reprojection of image pixels with ground truth depth information. I run into this issue during my experiments. TSDF++ doesn't fusing previous observations if an object is tracked.

Experiment Setup

  1. Robot initially starts with this view and after 0.2 meters left movement, the mesh is generated using /tsdf_plusplus_ros/generate_mesh ROS servise.

1

  1. Then, robot crouches and after 0.2 meters left movement, another mesh is generated. The view of ther crouch action is as follows:

2

Please note that during this experiment, all objects are stationary. Therefore, ICP part in object tracking is commented out. (Line 408-409 in controller.cc.

Generated Meshes

Whole scene

The following screenshots are the meshes generated after each step of the experiment.

Mesh 1
image

Mesh 2
image

As it can be seen, in the second mesh, some parts of the objects is not fused with previous observations, e.g. top part of the first sofa.

Only sofa

In this part, I only published the point cloud of the initial sofa in the environment.

Mesh 1
image

Mesh 2
image

Only sofa without object tracking

In this part, I only published the point cloud of the initial sofa in the environment. Additionally, I disabled the object tracking by commenting out the line 425 in controller.cc (map_->transformLayer(segment->object_id_, T_O_S);).

Mesh 1
image

Mesh 2
image

In this part, second mesh also contains the previous observations. Could you please help me? Thanks in advance.

ROS Noetic compilation

When compiling for ROS Noetic on Ubuntu 20.04, I encountered the error

CMake Error at /usr/lib/x86_64-linux-gnu/cmake/Boost-1.71.0/BoostConfig.cmake:117 (find_package):
Could not find a package configuration file provided by "boost_signals"
(requested version 1.71.0) with any of the following names:

boost_signalsConfig.cmake
boost_signals-config.cmake

Add the installation prefix of "boost_signals" to CMAKE_PREFIX_PATH or set
"boost_signals_DIR" to a directory containing one of the above files. If
"boost_signals" provides a separate development package or SDK, be sure it
has been installed.
Call Stack (most recent call first):
/usr/lib/x86_64-linux-gnu/cmake/Boost-1.71.0/BoostConfig.cmake:182 (boost_find_component)
/usr/share/cmake-3.16/Modules/FindBoost.cmake:443 (find_package)
CMakeLists.txt:6 (find_package)

This was solved by simply removing signals from src/pcl_catkin/geometry2/tf2/CMakeLists.txt (see this for context).

Thanks for the amazing work!

Compilation error: ‘struct std::atomic<bool>’ has no member named ‘set’

Hi, I am trying to build this seemingly wonderful package and can't seem to get over that error message... Does anybody knows what I am supposed to do to fix it ? Thanks in advance.

Errors     << tsdf_plusplus:make /d/qserdel/ros_ws/voxbloxpp_ws/logs/tsdf_plusplus/build.make.004.log                                                                                                     
/d/qserdel/ros_ws/voxbloxpp_ws/src/tsdf-plusplus/tsdf_plusplus/src/core/map.cc: In member function ‘void Map::transformLayer(const ObjectID&, const Transformation&)’:
/d/qserdel/ros_ws/voxbloxpp_ws/src/tsdf-plusplus/tsdf_plusplus/src/core/map.cc:235:25: error: ‘struct std::atomic<bool>’ has no member named ‘set’
  235 |     mo_block->updated().set();
      |                         ^~~
/d/qserdel/ros_ws/voxbloxpp_ws/src/tsdf-plusplus/tsdf_plusplus/src/core/map.cc:322:27: error: ‘struct std::atomic<bool>’ has no member named ‘set’
  322 |       mo_block->updated().set();
      |                           ^~~
/d/qserdel/ros_ws/voxbloxpp_ws/src/tsdf-plusplus/tsdf_plusplus/src/core/map.cc: In member function ‘void Map::removeObject(const ObjectID&)’:
/d/qserdel/ros_ws/voxbloxpp_ws/src/tsdf-plusplus/tsdf_plusplus/src/core/map.cc:356:25: error: ‘struct std::atomic<bool>’ has no member named ‘set’
  356 |     mo_block->updated().set();
      |                         ^~~
/d/qserdel/ros_ws/voxbloxpp_ws/src/tsdf-plusplus/tsdf_plusplus/src/mesh/mesh_integrator.cc: In member function ‘bool MOMeshIntegrator::generateMesh(bool, bool)’:
/d/qserdel/ros_ws/voxbloxpp_ws/src/tsdf-plusplus/tsdf_plusplus/src/mesh/mesh_integrator.cc:58:49: error: ‘Update’ has not been declared
   58 |     map_->getMapLayerPtr()->getAllUpdatedBlocks(Update::kMesh, &all_map_blocks);
      |                                                 ^~~~~~
/d/qserdel/ros_ws/voxbloxpp_ws/src/tsdf-plusplus/tsdf_plusplus/src/mesh/mesh_integrator.cc: In member function ‘void MOMeshIntegrator::generateMeshBlocksFunction(const BlockIndexList&, bool, voxblox::ThreadSafeIndex*)’:
/d/qserdel/ros_ws/voxbloxpp_ws/src/tsdf-plusplus/tsdf_plusplus/src/mesh/mesh_integrator.cc:104:24: error: ‘struct std::atomic<bool>’ has no member named ‘reset’
  104 |       block->updated().reset(Update::kMesh);
      |                        ^~~~~
/d/qserdel/ros_ws/voxbloxpp_ws/src/tsdf-plusplus/tsdf_plusplus/src/mesh/mesh_integrator.cc:104:30: error: ‘Update’ has not been declared
  104 |       block->updated().reset(Update::kMesh);
      |                              ^~~~~~
make[2]: *** [CMakeFiles/tsdf_plusplus.dir/build.make:89: CMakeFiles/tsdf_plusplus.dir/src/core/map.cc.o] Error 1
make[2]: *** Waiting for unfinished jobs....
/d/qserdel/ros_ws/voxbloxpp_ws/src/tsdf-plusplus/tsdf_plusplus/src/integrator/integrator.cc: In member function ‘MOVoxel* Integrator::allocateStorageAndGetVoxelPtr(const GlobalIndex&, voxblox::Block<MOVoxel>::Ptr*, voxblox::BlockIndex*)’:
/d/qserdel/ros_ws/voxbloxpp_ws/src/tsdf-plusplus/tsdf_plusplus/src/integrator/integrator.cc:435:28: error: ‘struct std::atomic<bool>’ has no member named ‘set’
  435 |   (*last_block)->updated().set();

ROS2 Support

If I would add ROS2 support to your project in a forked repo, would you be open to review it as a PR into your repo (either master or special ros2 branch) ?

How to run

Hi,
your work is amazing and thank you very much for the code!
Could you please provide some instructions on how to run it? I would really like to test it on some datasets.

Recommend Projects

  • React photo React

    A declarative, efficient, and flexible JavaScript library for building user interfaces.

  • Vue.js photo Vue.js

    🖖 Vue.js is a progressive, incrementally-adoptable JavaScript framework for building UI on the web.

  • Typescript photo Typescript

    TypeScript is a superset of JavaScript that compiles to clean JavaScript output.

  • TensorFlow photo TensorFlow

    An Open Source Machine Learning Framework for Everyone

  • Django photo Django

    The Web framework for perfectionists with deadlines.

  • D3 photo D3

    Bring data to life with SVG, Canvas and HTML. 📊📈🎉

Recommend Topics

  • javascript

    JavaScript (JS) is a lightweight interpreted programming language with first-class functions.

  • web

    Some thing interesting about web. New door for the world.

  • server

    A server is a program made to process requests and deliver data to clients.

  • Machine learning

    Machine learning is a way of modeling and interpreting data that allows a piece of software to respond intelligently.

  • Game

    Some thing interesting about game, make everyone happy.

Recommend Org

  • Facebook photo Facebook

    We are working to build community through open source technology. NB: members must have two-factor auth.

  • Microsoft photo Microsoft

    Open source projects and samples from Microsoft.

  • Google photo Google

    Google ❤️ Open Source for everyone.

  • D3 photo D3

    Data-Driven Documents codes.