added setting of custom link/joint parameters, added TransformQuaternionsSaver for saving state