Functional version

Some changes to ExtendedKalmanFilter to allow changing filter parameters
in flight