public void SetState(RigidBodyState s)
 {
     this.SetMasterPosition(s.Position);
     this.SetMasterRotation(s.Rotation);
     this.Velocity = s.Velocity;
     this.AngularVelocity = s.AngularVelocity;
     this.IsFixed = s.IsFixed;
 }
        public RigidBodyState GetState()
        {
            RigidBodyState s = new RigidBodyState();
            s.Position = this.Position;
            s.Rotation = this.Rotation;
            s.Velocity = this.Velocity;
            s.AngularVelocity = this.AngularVelocity;
            s.IsFixed = this.IsFixed;

            return s;
        }