IK Subproblem 0 works