Add some formulas on the kalman filter, add some references.