Code cleanups.
Extra failure case checks.
We do need to setToBindPose.