- Figure out an alternative to frame.position, which uses g2o, to do keypoint matching - Implement Measurement class