Experiment of Pose Graph SLAM with loop closure is done on a simulated environment.
Ground Truth Trajectory.

Noisy Trajectory.

Noisy Trajectory with Loop closure edges.

Optimized Trajectory vs Ground Truth Trajectory.

Comparing all three trajectories.
