skimap_ros

by m4nh

Ros implementation of Skimap

212 Stars 95 Forks Last release: Not found GNU General Public License v3.0 72 Commits 0 Releases

Available items

No Items, yet!

The developer of this repository has not created any items for sale yet. Need a bug fixed? Help with integration? A different license? Create a request here:

skimap_ros

Author: Daniele De Gregorio

This package contains the SkiMap Mapping Framework described here:

D. De Gregorio and L. Di Stefano, SkiMap: An efficient mapping framework for robot navigation, 2017 IEEE International Conference on Robotics and Automation (ICRA), Singapore, 2017, pp. 2569-2576. doi: 10.1109/ICRA.2017.7989299 LINK || PDF ARXIV

Watch the Video:

paper video

The framework si wrapped in a ROS package to maximize portability but, since it is an Header-Only library, can be easily used elsewhere.

This package is equipped with a sample BAG file: tiago_lar.bag . This bag was collected by means of a mobile robot with an head-mounting RGB-D camera. So it provides not only RGB-D frames but also a whole TF tree, including Odometry informations. For this reason this bag can be used as source for SkiMap mapping using Odometry to track Camera pose or as source for Slam+SkiMap duet where Camera is tracked by the Slam System.

Dependencies

  • OpenMP
  • Eigen3
  • OpenCV (2.4)
  • Boost

LICENSE

You may use, distribute and modify this code under the terms of the GNU GPLv3 license. If you use SkiMap in an academic work, please cite:

@inproceedings{degregorio2017skimap,
  title={SkiMap: An Efficient Mapping Framework for Robot Navigation},
  author={De Gregorio, Daniele and Di Stefano, Luigi},
  booktitle={Robotics and Automation (ICRA), 2017 IEEE International Conference on},
  year={2017}
}

Simple Example

The Tutorial: integrationofrandom_points.cpp is a simple tutorial for the use of SkiMap with your own software. The example just shows how to integrate random 3D points in the map and how to retrieve them (e.g. for visualization purposes). This example is intentionally unlinked from ROS library to show the usage of the data structure only.

SkiMap live mapping: skimap_live.launch

If the Camera 6-DOF pose is available (e.g. the camera is in a eye-to-hand configuration..) we can use SkiMap as a classical Mapping Framework. Furthermore, as described in the paper, if the Global Reference Frames of the Camera Poses lies on ground then SkiMap is able to perform also a 2D Map of the environment simultaneously with the 3D Map. The attached BAG is an useful example to understand the operation of this node because it is collected with a mobile robot with an head-mounted RGB-D camera so the Global Reference frame is certainly on the Ground (Odometry is the Global RF). To launch the example you have to run two separate commands:

1) roslaunch skimap_ros skimap_live.launch
2) rosbag play tiago_lar.bag --clock

If you want to run skimap_live.launch in your real context you have to change the Camera Topics parameters and the TF parameters in the launch file:






Remember to set as baseframename the name of the TF representing the World Frame, or the Fixed Frame, in which the cameraframename is represented. Should be noted that SkiMap is not responsible to produce these frames but it uses them to build the map, so the accuracy of the reconstruction depends on the accuracy of them.

SkiMap Service: skimapmapservice.launch

A less intrusive manner to use SkiMap is the Map Service launching skimapmapservice.launch. This service use SkimapIntegrationService.srv as interface to integrate new measurements in the global map. To understand how to create a client for this service you can take a look at SkiMapServiceClient.hpp (or you can just use it!). To instantiate our off-the-shelf client just do:

skimap_ros::SkimapServiceClient* skimap_service_client = new skimap_ros::SkimapServiceClient(&nh, "/skimap_map_service/integration_service");

Remember that the string /skimapmapservice/integration_service is the name of the service, in this case is the default name used also in the skimapmapservice.launch node. Once this client is ready you can just call the integratePoints method passing a vector filled with the points representing sensor measurements (in the sensor Reference Frame) and the geometry_msgs/Pose representing the 6-DOF pose of the sensor:

typedef skimap_ros::SkimapServiceClient::ColorPoint CPoint;
std::vector points;
//Fill vector with your points
geometry_msgs::Pose sensor_pose;
//Fill sensor_pose with your camera pose
skimap_service_client->integratePoints(points, sensor_pose);

This example Client is built with an asynchronous queue so the integratePoints method just appends your data to the queue, the real communication with SkiMap Map Service will be made in another thread. This technique is useful when your node requires real-time performance.

SkiMap with ORBSLAM2:

This Video:

paper video

shows an integration of the SkiMap (using the abovementioned SkiMap Map Service) with the popular ORBSLAM2 framework.

We use cookies. If you continue to browse the site, you agree to the use of cookies. For more information on our use of cookies please see our Privacy Policy.