From RigidBodyState to Affine3d.