Pose graph optimization with g2o (0-10 pts):

Grading:
- correct optimizer setup (2)
- odometry poses and features as vertices (2)
- correct constraints as edges (2)
- optimization loop for poses (3)
- correct results (1)