add kalman algorithm