/poseGraphOptimization_SGD

A python implementation of 2D (3 DOF) Pose Graph optimization using modified Gradient Descent

Primary LanguagePython

2D Pose Graph Optimization

This repository is an implementation of 2D (i.e, 3 degrees of freedom - x,y,theta) pose graph optimization in Python.
A modified gradient descent as authored by Olson et. al. found in refs is implemented.
The code has been tested on the Intel and Manhattan dataset's TORO version.

Odometry motion for Manhattan data

Odom M3500

Graph optimization for M3500

Optim M3500

Ground truth M3500 data

Manhattan dataset

Graph optimization for Intel data

Optim Intel

Ground truth Intel data

Intel dataset