Fix IK for hydra hands.

The IK for hydra hands did not survive the conversion of JointState to store model-frame transforms.  This fixes it.
r0 and r1 were some debug variables that I had forgotten to clean up.