Add set se(3) for Pose trait

[vadixidav]

Pose trait needs a way to set the pose in se(3). I added a way to move the pose in se(3) via a delta, but not get or set the pose as se(3). That needs to be added.