Sim3 constraints in 2D tested. Scale variations tested. Round trip to origin tested in 4 steps.
Sim3 constraints in 2D tested. Scale variations tested. Round trip to origin tested in 4 steps.

devbharat/gtsam,devbharat/gtsam,devbharat/gtsam,devbharat/gtsam