This is a ROS package to systematically read sensor msgs from the UTIAS-dataset (UTIAS MRCLAM robots dataset) and perform Moving horizon least squares on it for cooperative localization using inter-robot measurements.
-
Make sure you have ros indigo installed
-
Make sure you have the following package installed and the message files provided in this package built.
-
Make sure you have latest versions of the following libraries installed
- boost
- eigen
- g2o
-
You might have to add the location of installed g2o libraries in the CMakeLists.txt of this package
-
catkin_make to build the package
-
inspect the launch files, the names are self-explanatory
-
run one of the launch files. Below is an example:
roslaunch mhls_utias_dataset fourRobotLocalization.launch MY_ID:=1 WINDOW_SIZE:=10 DECAY_LAMBDA:=10
-
In summary, all you provide as aruments s your robot id on which the estimation should run, window size of the moving horizon, decay lambda (see the publication) and the launch file which specifically says how many robots you want in the team.
See here: https://github.com/aamirahmad/utiasdata_to_rosbags
LICENSE: Please note that this package is released under the GNU GPLv3 License.
To-be added