Sim3 constraints in 1D factorgraph tested. Works intutively with scale 1. Either intution wrong or math wrong for other scales.
Sim3 constraints in 1D factorgraph tested.