Refactor the SE(3) pose class

[aGotelli]

This class should use rotation matrix and not quaternion, as this is what we currently use.
It should host operators and handles to make its usage simpler and intuitive.