The normalization of quaternion rotation vector

[EC135]

I find that the quaternion donot get normalize after the update. I am wandering how to ensure the numerical stabilization？