working on chapter 2 EKF intro