Fixed NAN matrix issue. Do not normalize quaternion if the norm is 0. DUH!