https://convtker.blogspot.com/2022/08/convert-quaternion-to-euler-matlab.html