Error in kalman filter corrected (wrong reference to member function)