Fix typo by finishing implementation of move_to_pose method.