Added measuring state predictive error subtraction.

Calibration is still not finished.