Fixing bugs in the clustering.Added print statements to kalman filter.