MarineRoboticsGroup / cora

This is the official repository for the paper "Certifiably Correct Range-Aided SLAM"
14 stars 1 forks source link

Add a nice utility to align solutions to the origin #16

Closed alanpapalia closed 7 months ago

alanpapalia commented 7 months ago

Just a function to rotate such that the first rotation is the identity matrix and translate such that the first translation is at the origin (all zeros).

This accounts for the fact that there is not a unique reference frame for the solutions -- they can be identically rotated and translated. It is a simple convenience function.