Xinverse kinematics v2