Sweeping !55468 from master to 22.0. set the covariance to infinite if no beampost constraint and check the cavariance of each vertex

set the covariance to infinite if no beampost constraint and check the cavariance of each vertex

See merge request !55468 (merged)