I think we should add an automatic check for this that send an error in case we don't the math wrong. _Originally posted by @Remi-Gau in https://github.com/cpp-lln-lab/localizer_visual_motion/pull/25_