Fix final ik for reaching

Fix final ik for reaching.