Fixed quaternion calculation, Euler angle manipulation, it works like a charm