Skip to content

Latest commit

 

History

History
19 lines (14 loc) · 716 Bytes

readme.MD

File metadata and controls

19 lines (14 loc) · 716 Bytes

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