fixed kalman 12 bugs