Implement Kalman filter. DataProcessor: work in progress