Correctly initialize state quaternion