- imu_orientation_quat[size=3] is fed to Quaternion[size=4] which causes an index-out-of-range problem