VoxelMap
VoxelMap copied to clipboard
About state covariance update
Great thanks to your project and I have a question about state covariance. At each period of GN iteration. After state update in j-th iteration, shouldn't the state covariance be updated? I think the initial cov of the state in j=0 and of the j-th are different in my mind. Hope for your answer.