minor fix to kalman.c