Moving pose_extractor from utils to here

Needed for `strands_hri` release but not only useful for hri. See https://github.com/strands-project/strands_hri/pull/73