first kalman update test