Kinda works, but encounters singularity, large jumps. Uses first order retraction method from task constraint paper