Probabilistic Robotics KF - Laboratory exercise