Update to use the ros service for IK, and solve the IK problem