IK completed and gravity compensation