public override void SetCenterOfMassByPosRot(BulletBody pBody, Vector3 pos, Quaternion rot)
{
RigidBody body = (pBody as BulletBodyXNA).rigidBody;
IndexedQuaternion quat = new IndexedQuaternion(rot.X, rot.Y, rot.Z, rot.W);
IndexedMatrix mat = IndexedMatrix.CreateFromQuaternion(quat);
mat._origin = new IndexedVector3(pos.X, pos.Y, pos.Z);
body.SetCenterOfMassTransform(ref mat);
/* TODO: double check this */
}