added Quaternion class and QuatToMatrix method