Pose Graph optimization and trajectory evaluation

Course Project for Mobile RObotics