Fix retrieval of base pose and body pose

[costashatz]

DART splits translation and orientation in FreeJoint movement (see here). In Robot class we assume use the exponential representation. This can lead in wrong computations. We should align with DART.