Merge branch 'fix/useIsometryForTworldAndTrelative' into 'master'

Replace SLAM internal 6 DoF state vector by an homogeneous matrix.

See merge request !11
1 job for master in 24 seconds (queued for 3 seconds)