Finished basic sketch of EKF odometry motion model.
Started basic sketch of EKF point matching measurement model.