Fix Joint::setRestPosition()