add kalman filter
Merge https://github.com/clauniel/31015