Tutorial on pose graph optimization using g2o

Comparison of Robot poses before and after optimization
  1. This repository is the tutorial on the general edge types(EDGE_SE2 and EDGE_SE3) and vertex types(VERTEX_SE2 & VERTEX_SE3) found in g2o, using python. The accompanied documentation on results can be found in the notion page.
  2. We have covered two common scenarios found in SLAM: Pose Graph SLAM and Landmark based SLAM using synthetic dataset. The main goal is to cover how to formulate a graph based optimization problem in proper g2o format, using g2o’s vertices, edges and information matrix.
  3. Problem statement:
    1. Pose Graph SLAM: A robot is travelling in a oval trajectory. It is equipped with wheel odometry for odometry information and RGBD sensors for loop closure and ICP transformation. Due to noise in wheel odometry it generated a noisy estimate of the trajectory. Our task is to use loop closure pairs to correct the drift.
      Alt Text
    2. Landmark SLAM: A robot observes a cube from five different locations. The robot is equipped with RGBD sensors and would be using those to calculate odometry and the map of the cube. Due to noise in the sensors, it obtained a erroneous estimate of its poses and vertices of the cube. Our task is to couple odometry measurements and cube’s vertices(landmarks) measurements to generate a consistent and better estimate of those values.
      Alt Text
Udit Singh Parihar
Udit Singh Parihar
Deep Learning and SLAM Researcher

My research interests include intersection of 3D Computer Vision, Deep Learning and SLAM.

Related