public void MoveTo(Body BODY, Vector3 pos, Matrix orientation) { if (BODY.IsBodyEnabled && !BODY.IsActive) { BODY.SetActive(); } BODY.Position = pos; BODY.Orientation = orientation; BODY.CopyCurrentStateToOld(); if (BODY.CollisionSkin != null) BODY.CollisionSkin.SetTransform(ref BODY.oldTransform, ref BODY.transform); }