updating after latest kalman work