add measurement prediction and ekf update.