changed ik to use Pose message instead of Affine3ed