Odometry Correction first draft

@author: Sid