kalman filter on one centroid point is working