OKVIS: Open Keyframe-based Visual-Inertial SLAM (ROS Version)
Welcome to OKVIS: Open Keyframe-based Visual-Inertial SLAM.
This is the Author's implementation of the  and  with more results in .
 Stefan Leutenegger, Simon Lynen, Michael Bosse, Roland Siegwart and Paul Timothy Furgale. Keyframe-based visual–inertial odometry using nonlinear optimization. The International Journal of Robotics Research, 2015.
 Stefan Leutenegger. Unmanned Solar Airplanes: Design and Algorithms for Efficient and Robust Autonomous Operation. Doctoral dissertation, 2014.
 Stefan Leutenegger, Paul Timothy Furgale, Vincent Rabaud, Margarita Chli, Kurt Konolige, Roland Siegwart. Keyframe-Based Visual-Inertial SLAM using Nonlinear Optimization. In Proceedings of Robotics: Science and Systems, 2013.
Note that the codebase that you are provided here is free of charge and without any warranty. This is bleeding edge research software.
Also note that the quaternion standard has been adapted to match Eigen/ROS, thus some related mathematical description in [1,2,3] will not match the implementation here.
If you publish work that relates to this software, please cite at least .
This is a catkin package that wraps the pure CMake project.
You will need to install the following dependencies,
ROS (currently supported: hydro, indigo and jade). Read the instructions in http://wiki.ros.org/indigo/Installation/Ubuntu. You will need the additional package pcl-ros as (assuming indigo)
sudo apt-get install ros-indigo-pcl-ros
google-glog + gflags,
sudo apt-get install libgoogle-glog-dev
The following should get installed through ROS anyway:
sudo apt-get install libatlas-base-dev libeigen3-dev libsuitesparse-dev sudo apt-get install libopencv-dev libboost-dev libboost-filesystem-dev
Optional: use the the package with the Skybotix VI sensor. Note that this requires a system install, not just as ROS package. Also note that Skybotix OSX support is experimental (checkout the feature/osx branch).
git clone https://github.com/ethz-asl/libvisensor.git cd libvisensor ./install_libvisensor.sh
then download and expand the archive into your catkin workspace:
wget https://www.doc.ic.ac.uk/~sleutene/software/okvis_ros-1.1.3.zip unzip okvis_ros-1.1.3.zip && rm okvis_ros-1.1.3.zip
Or, clone the repository from github into your catkin workspace:
git clone --recursive [email protected]:ethz-asl/okvis_ros.git
git clone --recursive https://github.com/ethz-asl/okvis_ros.git
From the catkin workspace root, type
You will find a demo application in okvis_apps. It can process datasets in the ASL/ETH format.
In order to run a minimal working example, follow the steps below:
Download a dataset of your choice from http://projects.asl.ethz.ch/datasets/doku.php?id=kmavvisualinertialdatasets. Assuming you downloaded MH01easy/. You will find a corresponding calibration / estimator configuration in the okvis/config folder.
Run the app as
./okvis_apps path/to/okvis_ros/okvis/config/config_fpga_p2_euroc.yaml path/to/MH_01_easy/
You can also run a dataset processing ros node that will publish topics that can be visualized with rviz
rosrun okvis_ros okvis_node_synchronous path/to/okvis_ros/okvis/config/config_fpga_p2_euroc.yaml path/to/MH_01_easy/
Use the rviz.rviz configuration in the okvis_ros/config/ directory to get the pose / landmark display.
If you want to run the live application connecting to a sensor, use the okvisnode application (modify the launch file launch/okvisnode.launch).
In terms of coordinate frames and notation,
The output of the okvis library is the pose T_WS as a position r_WS and quaternion q_WS, followed by the velocity in World frame v_W and gyro biases (bg) as well as accelerometer biases (ba). See the example application to get an idea on how to use the estimator and its outputs (callbacks returning states).
The okvis_node ROS application will publish a configurable state -- see just below.
The okvis/config folder contains example configuration files. Please read the documentation of the individual parameters in the yaml file carefully. You have various options to trade-off accuracy and computational expense as well as to enable online calibration. You also have various options concerning the things that will get published -- in particular weather or not landmarks should be published (may be important to turn off for on-bard operation). Moreover, you can specify how the body frame is specified (T_BS) or define a custom World frame. In other words, the final pose published will be T_Wc_B = T_Wc_W * T_WS * T_BS^(-1) . You have the option to express the velocity as well as the rotation rates in either B, S, or Wc.
If you would like to run the software/library on your own hardware setup, be aware that good results (or results at all) may only be obtained with appropriate calibration of the
To perform a calibration yourself, we recommend the following:
Get Kalibr by following the instructions here https://github.com/ethz-asl/kalibr/wiki/installation . If you decide to build from source and you run ROS indigo checkout pull request 3:
git fetch origin pull/3/head:request3 git checkout request3
Follow https://github.com/ethz-asl/kalibr/wiki/multiple-camera-calibration to calibrate intrinsic and extrinsic parameters of the cameras. If you receive an error message that the tool was unable to make an initial guess on focal length, make sure that your recorded dataset contains frames that have the whole calibration target in view.
Follow https://github.com/ethz-asl/kalibr/wiki/camera-imu-calibration to get estimates for the spatial parameters of the cameras with respect to the IMU.
Contact [email protected] to request access to the bitbucket repository.
Programming guidelines: please follow https://github.com/ethz-asl/programming_guidelines/wiki/Cpp-Coding-Style-Guidelines .
Writing tests: please write unit tests (gtest).
Code review: please create a pull request for all changes proposed. The pull request will be reviewed by an admin before merging.
The developpers will be happy to assist you or to consider bug reports / feature requests. But questions that can be answered reading this document will be ignored. Please contact [email protected]