Extended Kalman Filter and Linear System implemented and tested.