small changes in kalman, mean filter... some rafactoring